Home | History | Annotate | Line # | Download | only in tc
cfb.c revision 1.29
      1  1.29  nisimura /* $NetBSD: cfb.c,v 1.29 2001/08/22 02:24:29 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.1  nisimura #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
     34   1.1  nisimura 
     35  1.29  nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.29 2001/08/22 02:24:29 nisimura Exp $");
     36   1.1  nisimura 
     37   1.1  nisimura #include <sys/param.h>
     38   1.1  nisimura #include <sys/systm.h>
     39   1.1  nisimura #include <sys/kernel.h>
     40   1.1  nisimura #include <sys/device.h>
     41   1.1  nisimura #include <sys/malloc.h>
     42   1.1  nisimura #include <sys/buf.h>
     43   1.1  nisimura #include <sys/ioctl.h>
     44   1.1  nisimura 
     45   1.1  nisimura #include <machine/bus.h>
     46   1.1  nisimura #include <machine/intr.h>
     47   1.1  nisimura 
     48   1.1  nisimura #include <dev/wscons/wsconsio.h>
     49   1.1  nisimura #include <dev/wscons/wsdisplayvar.h>
     50   1.1  nisimura 
     51  1.18  nisimura #include <dev/rasops/rasops.h>
     52  1.18  nisimura #include <dev/wsfont/wsfont.h>
     53  1.18  nisimura 
     54   1.1  nisimura #include <dev/tc/tcvar.h>
     55   1.1  nisimura #include <dev/ic/bt459reg.h>
     56   1.1  nisimura 
     57   1.1  nisimura #include <uvm/uvm_extern.h>
     58   1.1  nisimura 
     59   1.7   thorpej #if defined(pmax)
     60  1.29  nisimura #define	machine_btop(x) mips_btop(MIPS_KSEG1_TO_PHYS(x))
     61   1.1  nisimura #endif
     62   1.1  nisimura 
     63  1.26  nisimura #if defined(alpha)
     64  1.29  nisimura #define	machine_btop(x) alpha_btop(ALPHA_K0SEG_TO_PHYS(x))
     65   1.1  nisimura #endif
     66   1.1  nisimura 
     67   1.1  nisimura /*
     68   1.1  nisimura  * N.B., Bt459 registers are 8bit width.  Some of TC framebuffers have
     69   1.3  nisimura  * obscure register layout such as 2nd and 3rd Bt459 registers are
     70   1.3  nisimura  * adjacent each other in a word, i.e.,
     71   1.1  nisimura  *	struct bt459triplet {
     72   1.1  nisimura  * 		struct {
     73   1.1  nisimura  *			u_int8_t u0;
     74   1.1  nisimura  *			u_int8_t u1;
     75   1.1  nisimura  *			u_int8_t u2;
     76  1.29  nisimura  *			unsigned :8;
     77   1.1  nisimura  *		} bt_lo;
     78   1.1  nisimura  *		...
     79   1.1  nisimura  * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
     80  1.26  nisimura  *	struct bt459reg {
     81  1.26  nisimura  *		   u_int32_t	   bt_lo;
     82  1.26  nisimura  *		   u_int32_t	   bt_hi;
     83  1.26  nisimura  *		   u_int32_t	   bt_reg;
     84  1.26  nisimura  *		   u_int32_t	   bt_cmap;
     85  1.26  nisimura  *	};
     86   1.1  nisimura  */
     87   1.2  nisimura 
     88  1.12  nisimura /* Bt459 hardware registers */
     89  1.29  nisimura #define	bt_lo	0
     90  1.29  nisimura #define	bt_hi	1
     91  1.29  nisimura #define	bt_reg	2
     92  1.29  nisimura #define	bt_cmap 3
     93  1.12  nisimura 
     94  1.29  nisimura #define	REG(base, index)	*((u_int32_t *)(base) + (index))
     95  1.29  nisimura #define	SELECT(vdac, regno) do {			\
     96  1.12  nisimura 	REG(vdac, bt_lo) = ((regno) & 0x00ff);		\
     97  1.12  nisimura 	REG(vdac, bt_hi) = ((regno) & 0x0f00) >> 8;	\
     98  1.12  nisimura 	tc_wmb();					\
     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.1  nisimura 	u_int64_t cc_image[64 + 64];
    116   1.1  nisimura };
    117   1.1  nisimura 
    118   1.1  nisimura struct cfb_softc {
    119   1.1  nisimura 	struct device sc_dev;
    120  1.29  nisimura 	vaddr_t sc_vaddr;
    121  1.29  nisimura 	size_t sc_size;
    122  1.29  nisimura 	struct rasops_info *sc_ri;
    123  1.11  nisimura 	struct hwcmap256 sc_cmap;	/* software copy of colormap */
    124  1.11  nisimura 	struct hwcursor64 sc_cursor;	/* software copy of cursor */
    125  1.29  nisimura 	int sc_blanked;
    126   1.1  nisimura 	int sc_curenb;			/* cursor sprite enabled */
    127  1.26  nisimura 	int sc_changed;			/* need update of hardware */
    128  1.26  nisimura #define	WSDISPLAY_CMAP_DOLUT	0x20
    129   1.1  nisimura 	int nscreens;
    130  1.11  nisimura };
    131  1.11  nisimura 
    132  1.12  nisimura #define	CX_MAGIC_X	220
    133  1.12  nisimura #define	CX_MAGIC_Y 	35
    134   1.1  nisimura 
    135   1.3  nisimura #define	CX_FB_OFFSET	0x000000
    136   1.3  nisimura #define	CX_FB_SIZE	0x100000
    137   1.3  nisimura #define	CX_BT459_OFFSET	0x200000
    138   1.3  nisimura #define	CX_OFFSET_IREQ	0x300000	/* Interrupt req. control */
    139   1.3  nisimura 
    140  1.14  nisimura static int  cfbmatch __P((struct device *, struct cfdata *, void *));
    141  1.14  nisimura static void cfbattach __P((struct device *, struct device *, void *));
    142   1.1  nisimura 
    143  1.14  nisimura const struct cfattach cfb_ca = {
    144   1.1  nisimura 	sizeof(struct cfb_softc), cfbmatch, cfbattach,
    145   1.1  nisimura };
    146   1.1  nisimura 
    147  1.29  nisimura static void cfb_common_init __P((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.21    simonb static int	cfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
    167  1.21    simonb static paddr_t	cfbmmap __P((void *, off_t, int));
    168   1.1  nisimura 
    169  1.21    simonb static int	cfb_alloc_screen __P((void *, const struct wsscreen_descr *,
    170   1.1  nisimura 				      void **, int *, int *, long *));
    171  1.21    simonb static void	cfb_free_screen __P((void *, void *));
    172  1.21    simonb static int	cfb_show_screen __P((void *, void *, int,
    173  1.21    simonb 				     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.1  nisimura int  cfb_cnattach __P((tc_addr_t));
    185  1.14  nisimura static int  cfbintr __P((void *));
    186  1.29  nisimura static void cfbhwinit __P((caddr_t));
    187   1.1  nisimura 
    188   1.1  nisimura static int  get_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
    189   1.1  nisimura static int  set_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
    190   1.1  nisimura static int  set_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
    191   1.1  nisimura static int  get_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
    192   1.1  nisimura static void set_curpos __P((struct cfb_softc *, struct wsdisplay_curpos *));
    193   1.1  nisimura 
    194   1.3  nisimura /*
    195   1.3  nisimura  * Compose 2 bit/pixel cursor image.  Bit order will be reversed.
    196   1.3  nisimura  *   M M M M I I I I		M I M I M I M I
    197   1.3  nisimura  *	[ before ]		   [ after ]
    198   1.3  nisimura  *   3 2 1 0 3 2 1 0		0 0 1 1 2 2 3 3
    199   1.3  nisimura  *   7 6 5 4 7 6 5 4		4 4 5 5 6 6 7 7
    200   1.3  nisimura  */
    201  1.14  nisimura static const u_int8_t shuffle[256] = {
    202   1.3  nisimura 	0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
    203   1.3  nisimura 	0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
    204   1.3  nisimura 	0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
    205   1.3  nisimura 	0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
    206   1.3  nisimura 	0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
    207   1.3  nisimura 	0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
    208   1.3  nisimura 	0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
    209   1.3  nisimura 	0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
    210   1.3  nisimura 	0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
    211   1.3  nisimura 	0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
    212   1.3  nisimura 	0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
    213   1.3  nisimura 	0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
    214   1.3  nisimura 	0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
    215   1.3  nisimura 	0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
    216   1.3  nisimura 	0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
    217   1.3  nisimura 	0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
    218   1.3  nisimura 	0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
    219   1.3  nisimura 	0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
    220   1.3  nisimura 	0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
    221   1.3  nisimura 	0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
    222   1.3  nisimura 	0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
    223   1.3  nisimura 	0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
    224   1.3  nisimura 	0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
    225   1.3  nisimura 	0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
    226   1.3  nisimura 	0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
    227   1.3  nisimura 	0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
    228   1.3  nisimura 	0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
    229   1.3  nisimura 	0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
    230   1.3  nisimura 	0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
    231   1.3  nisimura 	0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
    232   1.3  nisimura 	0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
    233   1.3  nisimura 	0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
    234   1.3  nisimura };
    235   1.1  nisimura 
    236  1.14  nisimura static int
    237   1.1  nisimura cfbmatch(parent, match, aux)
    238   1.1  nisimura 	struct device *parent;
    239   1.1  nisimura 	struct cfdata *match;
    240   1.1  nisimura 	void *aux;
    241   1.1  nisimura {
    242   1.1  nisimura 	struct tc_attach_args *ta = aux;
    243   1.1  nisimura 
    244   1.1  nisimura 	if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
    245   1.1  nisimura 		return (0);
    246   1.1  nisimura 
    247   1.1  nisimura 	return (1);
    248   1.1  nisimura }
    249   1.1  nisimura 
    250  1.14  nisimura static void
    251   1.1  nisimura cfbattach(parent, self, aux)
    252   1.1  nisimura 	struct device *parent, *self;
    253   1.1  nisimura 	void *aux;
    254   1.1  nisimura {
    255   1.1  nisimura 	struct cfb_softc *sc = (struct cfb_softc *)self;
    256   1.1  nisimura 	struct tc_attach_args *ta = aux;
    257  1.29  nisimura 	struct rasops_info *ri;
    258   1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    259  1.24  nisimura 	struct hwcmap256 *cm;
    260  1.24  nisimura 	const u_int8_t *p;
    261  1.24  nisimura 	int console, index;
    262   1.1  nisimura 
    263   1.1  nisimura 	console = (ta->ta_addr == cfb_consaddr);
    264   1.1  nisimura 	if (console) {
    265  1.29  nisimura 		sc->sc_ri = ri = &cfb_console_ri;
    266   1.1  nisimura 		sc->nscreens = 1;
    267   1.1  nisimura 	}
    268   1.1  nisimura 	else {
    269  1.29  nisimura 		MALLOC(ri, struct rasops_info *, sizeof(struct rasops_info),
    270  1.29  nisimura 			M_DEVBUF, M_NOWAIT);
    271  1.29  nisimura 		if (ri == NULL) {
    272  1.29  nisimura 			printf(": can't alloc memory\n");
    273  1.29  nisimura 			return;
    274  1.29  nisimura 		}
    275  1.29  nisimura 		memset(ri, 0, sizeof(struct rasops_info));
    276  1.29  nisimura 
    277  1.29  nisimura 		ri->ri_hw = (void *)ta->ta_addr;
    278  1.29  nisimura 		cfb_common_init(ri);
    279  1.29  nisimura 		sc->sc_ri = ri;
    280   1.1  nisimura 	}
    281  1.29  nisimura 	printf(": %dx%d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    282   1.1  nisimura 
    283  1.24  nisimura 	cm = &sc->sc_cmap;
    284  1.24  nisimura 	p = rasops_cmap;
    285  1.25  nisimura 	for (index = 0; index < CMAP_SIZE; index++, p += 3) {
    286  1.24  nisimura 		cm->r[index] = p[0];
    287  1.24  nisimura 		cm->g[index] = p[1];
    288  1.24  nisimura 		cm->b[index] = p[2];
    289  1.24  nisimura 	}
    290  1.11  nisimura 
    291  1.29  nisimura 	sc->sc_vaddr = ta->ta_addr;
    292  1.11  nisimura 	sc->sc_cursor.cc_magic.x = CX_MAGIC_X;
    293  1.11  nisimura 	sc->sc_cursor.cc_magic.y = CX_MAGIC_Y;
    294  1.29  nisimura 	sc->sc_blanked = sc->sc_curenb = 0;
    295   1.1  nisimura 
    296  1.14  nisimura 	tc_intr_establish(parent, ta->ta_cookie, IPL_TTY, cfbintr, sc);
    297  1.29  nisimura 
    298  1.29  nisimura 	/* clear any pending interrupts */
    299  1.29  nisimura 	*(u_int8_t *)((caddr_t)ri->ri_hw + CX_OFFSET_IREQ) = 0;
    300   1.1  nisimura 
    301   1.1  nisimura 	waa.console = console;
    302   1.1  nisimura 	waa.scrdata = &cfb_screenlist;
    303   1.1  nisimura 	waa.accessops = &cfb_accessops;
    304   1.1  nisimura 	waa.accesscookie = sc;
    305   1.1  nisimura 
    306   1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    307   1.1  nisimura }
    308   1.1  nisimura 
    309  1.29  nisimura static void
    310  1.29  nisimura cfb_common_init(ri)
    311  1.29  nisimura 	struct rasops_info *ri;
    312  1.29  nisimura {
    313  1.29  nisimura 	caddr_t base;
    314  1.29  nisimura 	int cookie;
    315  1.29  nisimura 
    316  1.29  nisimura 	base = (caddr_t)ri->ri_hw;
    317  1.29  nisimura 
    318  1.29  nisimura 	/* initialize colormap and cursor hardware */
    319  1.29  nisimura 	cfbhwinit(base);
    320  1.29  nisimura 
    321  1.29  nisimura 	ri->ri_flg = RI_CENTER;
    322  1.29  nisimura 	ri->ri_depth = 8;
    323  1.29  nisimura 	ri->ri_width = 1024;
    324  1.29  nisimura 	ri->ri_height = 864;
    325  1.29  nisimura 	ri->ri_stride = 1024;
    326  1.29  nisimura 	ri->ri_bits = base + CX_FB_OFFSET;
    327  1.29  nisimura 
    328  1.29  nisimura 	/* clear the screen */
    329  1.29  nisimura 	memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    330  1.29  nisimura 
    331  1.29  nisimura 	wsfont_init();
    332  1.29  nisimura 	/* prefer 12 pixel wide font */
    333  1.29  nisimura 	if ((cookie = wsfont_find(NULL, 12, 0, 0)) <= 0)
    334  1.29  nisimura 		cookie = wsfont_find(NULL, 0, 0, 0);
    335  1.29  nisimura 	if (cookie <= 0) {
    336  1.29  nisimura 		printf("cfb: font table is empty\n");
    337  1.29  nisimura 		return;
    338  1.29  nisimura 	}
    339  1.29  nisimura 
    340  1.29  nisimura 	if (wsfont_lock(cookie, &ri->ri_font,
    341  1.29  nisimura 	    WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R) <= 0) {
    342  1.29  nisimura 		printf("cfb: couldn't lock font\n");
    343  1.29  nisimura 		return;
    344  1.29  nisimura 	}
    345  1.29  nisimura 	ri->ri_wsfcookie = cookie;
    346  1.29  nisimura 
    347  1.29  nisimura 	rasops_init(ri, 34, 80);
    348  1.29  nisimura 
    349  1.29  nisimura 	/* XXX shouldn't be global */
    350  1.29  nisimura 	cfb_stdscreen.nrows = ri->ri_rows;
    351  1.29  nisimura 	cfb_stdscreen.ncols = ri->ri_cols;
    352  1.29  nisimura 	cfb_stdscreen.textops = &ri->ri_ops;
    353  1.29  nisimura 	cfb_stdscreen.capabilities = ri->ri_caps;
    354  1.29  nisimura }
    355  1.29  nisimura 
    356  1.14  nisimura static int
    357   1.1  nisimura cfbioctl(v, cmd, data, flag, p)
    358   1.1  nisimura 	void *v;
    359   1.1  nisimura 	u_long cmd;
    360   1.1  nisimura 	caddr_t data;
    361   1.1  nisimura 	int flag;
    362   1.1  nisimura 	struct proc *p;
    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.1  nisimura 	int turnoff;
    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.29  nisimura 		if ((sc->sc_blanked == 0) ^ 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.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    407  1.27   reinoud 		sc->sc_changed |= WSDISPLAY_CURSOR_DOPOS;
    408   1.1  nisimura 		return (0);
    409   1.1  nisimura 
    410   1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    411   1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    412   1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    413   1.1  nisimura 		return (0);
    414   1.1  nisimura 
    415   1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    416   1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    417   1.1  nisimura 
    418   1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    419   1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    420   1.1  nisimura 	}
    421   1.1  nisimura 	return ENOTTY;
    422   1.1  nisimura }
    423   1.1  nisimura 
    424  1.21    simonb paddr_t
    425   1.1  nisimura cfbmmap(v, offset, prot)
    426   1.1  nisimura 	void *v;
    427   1.1  nisimura 	off_t offset;
    428   1.1  nisimura 	int prot;
    429   1.1  nisimura {
    430   1.1  nisimura 	struct cfb_softc *sc = v;
    431   1.1  nisimura 
    432   1.5       mrg 	if (offset >= CX_FB_SIZE || offset < 0)
    433   1.1  nisimura 		return (-1);
    434  1.29  nisimura 	return machine_btop(sc->sc_vaddr + CX_FB_OFFSET + offset);
    435   1.1  nisimura }
    436   1.1  nisimura 
    437  1.14  nisimura static int
    438   1.1  nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    439   1.1  nisimura 	void *v;
    440   1.1  nisimura 	const struct wsscreen_descr *type;
    441   1.1  nisimura 	void **cookiep;
    442   1.1  nisimura 	int *curxp, *curyp;
    443   1.1  nisimura 	long *attrp;
    444   1.1  nisimura {
    445   1.1  nisimura 	struct cfb_softc *sc = v;
    446  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    447   1.1  nisimura 	long defattr;
    448   1.1  nisimura 
    449   1.1  nisimura 	if (sc->nscreens > 0)
    450   1.1  nisimura 		return (ENOMEM);
    451   1.1  nisimura 
    452  1.29  nisimura 	*cookiep = ri;	 /* one and only for now */
    453   1.1  nisimura 	*curxp = 0;
    454   1.1  nisimura 	*curyp = 0;
    455  1.29  nisimura 	(*ri->ri_ops.alloc_attr)(ri, 0, 0, 0, &defattr);
    456   1.1  nisimura 	*attrp = defattr;
    457   1.1  nisimura 	sc->nscreens++;
    458   1.1  nisimura 	return (0);
    459   1.1  nisimura }
    460   1.1  nisimura 
    461  1.14  nisimura static void
    462   1.1  nisimura cfb_free_screen(v, cookie)
    463   1.1  nisimura 	void *v;
    464   1.1  nisimura 	void *cookie;
    465   1.1  nisimura {
    466   1.1  nisimura 	struct cfb_softc *sc = v;
    467   1.1  nisimura 
    468  1.29  nisimura 	if (sc->sc_ri == &cfb_console_ri)
    469   1.1  nisimura 		panic("cfb_free_screen: console");
    470   1.1  nisimura 
    471   1.1  nisimura 	sc->nscreens--;
    472   1.1  nisimura }
    473   1.1  nisimura 
    474  1.15  drochner static int
    475  1.16  nisimura cfb_show_screen(v, cookie, waitok, cb, cbarg)
    476   1.1  nisimura 	void *v;
    477   1.1  nisimura 	void *cookie;
    478  1.15  drochner 	int waitok;
    479  1.15  drochner 	void (*cb) __P((void *, int, int));
    480  1.15  drochner 	void *cbarg;
    481   1.1  nisimura {
    482  1.15  drochner 
    483  1.15  drochner 	return (0);
    484   1.1  nisimura }
    485   1.1  nisimura 
    486  1.14  nisimura /* EXPORT */ int
    487   1.1  nisimura cfb_cnattach(addr)
    488  1.18  nisimura 	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.29  nisimura 	(*ri->ri_ops.alloc_attr)(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.1  nisimura cfbintr(arg)
    504   1.1  nisimura 	void *arg;
    505   1.1  nisimura {
    506   1.1  nisimura 	struct cfb_softc *sc = arg;
    507  1.29  nisimura 	caddr_t base, vdac;
    508   1.1  nisimura 	int v;
    509   1.1  nisimura 
    510  1.29  nisimura 	base = (caddr_t)sc->sc_ri->ri_hw;
    511  1.29  nisimura 	*(u_int8_t *)(base + CX_OFFSET_IREQ) = 0;
    512   1.1  nisimura 	if (sc->sc_changed == 0)
    513   1.1  nisimura 		return (1);
    514   1.1  nisimura 
    515  1.29  nisimura 	vdac = base + CX_BT459_OFFSET;
    516   1.1  nisimura 	v = sc->sc_changed;
    517  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    518  1.17        ad 		SELECT(vdac, BT459_IREG_CCR);
    519  1.12  nisimura 		REG(vdac, bt_reg) = (sc->sc_curenb) ? 0xc0 : 0x00;
    520   1.1  nisimura 	}
    521  1.26  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
    522  1.26  nisimura 		int x, y;
    523  1.26  nisimura 
    524  1.26  nisimura 		x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
    525  1.26  nisimura 		y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
    526  1.26  nisimura 
    527  1.26  nisimura 		x += sc->sc_cursor.cc_magic.x;
    528  1.26  nisimura 		y += sc->sc_cursor.cc_magic.y;
    529  1.26  nisimura 
    530  1.26  nisimura 		SELECT(vdac, BT459_IREG_CURSOR_X_LOW);
    531  1.26  nisimura 		REG(vdac, bt_reg) = x;		tc_wmb();
    532  1.26  nisimura 		REG(vdac, bt_reg) = x >> 8;	tc_wmb();
    533  1.26  nisimura 		REG(vdac, bt_reg) = y;		tc_wmb();
    534  1.26  nisimura 		REG(vdac, bt_reg) = y >> 8;	tc_wmb();
    535  1.26  nisimura 	}
    536  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    537   1.1  nisimura 		u_int8_t *cp = sc->sc_cursor.cc_color;
    538   1.1  nisimura 
    539  1.17        ad 		SELECT(vdac, BT459_IREG_CCOLOR_2);
    540  1.12  nisimura 		REG(vdac, bt_reg) = cp[1];	tc_wmb();
    541  1.12  nisimura 		REG(vdac, bt_reg) = cp[3];	tc_wmb();
    542  1.12  nisimura 		REG(vdac, bt_reg) = cp[5];	tc_wmb();
    543  1.12  nisimura 
    544  1.12  nisimura 		REG(vdac, bt_reg) = cp[0];	tc_wmb();
    545  1.12  nisimura 		REG(vdac, bt_reg) = cp[2];	tc_wmb();
    546  1.12  nisimura 		REG(vdac, bt_reg) = cp[4];	tc_wmb();
    547   1.1  nisimura 	}
    548  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    549   1.3  nisimura 		u_int8_t *ip, *mp, img, msk;
    550   1.3  nisimura 		u_int8_t u;
    551   1.3  nisimura 		int bcnt;
    552   1.3  nisimura 
    553   1.3  nisimura 		ip = (u_int8_t *)sc->sc_cursor.cc_image;
    554   1.3  nisimura 		mp = (u_int8_t *)(sc->sc_cursor.cc_image + CURSOR_MAX_SIZE);
    555   1.3  nisimura 
    556   1.3  nisimura 		bcnt = 0;
    557  1.17        ad 		SELECT(vdac, BT459_IREG_CRAM_BASE+0);
    558   1.3  nisimura 		/* 64 pixel scan line is consisted with 16 byte cursor ram */
    559   1.3  nisimura 		while (bcnt < sc->sc_cursor.cc_size.y * 16) {
    560   1.3  nisimura 			/* pad right half 32 pixel when smaller than 33 */
    561   1.3  nisimura 			if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
    562  1.12  nisimura 				REG(vdac, bt_reg) = 0; tc_wmb();
    563  1.12  nisimura 				REG(vdac, bt_reg) = 0; tc_wmb();
    564   1.3  nisimura 			}
    565   1.3  nisimura 			else {
    566   1.3  nisimura 				img = *ip++;
    567   1.3  nisimura 				msk = *mp++;
    568   1.3  nisimura 				img &= msk;	/* cookie off image */
    569   1.3  nisimura 				u = (msk & 0x0f) << 4 | (img & 0x0f);
    570  1.12  nisimura 				REG(vdac, bt_reg) = shuffle[u];	tc_wmb();
    571   1.3  nisimura 				u = (msk & 0xf0) | (img & 0xf0) >> 4;
    572  1.12  nisimura 				REG(vdac, bt_reg) = shuffle[u];	tc_wmb();
    573   1.3  nisimura 			}
    574   1.3  nisimura 			bcnt += 2;
    575   1.3  nisimura 		}
    576   1.3  nisimura 		/* pad unoccupied scan lines */
    577   1.3  nisimura 		while (bcnt < CURSOR_MAX_SIZE * 16) {
    578  1.12  nisimura 			REG(vdac, bt_reg) = 0; tc_wmb();
    579  1.12  nisimura 			REG(vdac, bt_reg) = 0; tc_wmb();
    580   1.3  nisimura 			bcnt += 2;
    581   1.1  nisimura 		}
    582   1.1  nisimura 	}
    583  1.26  nisimura 	if (v & WSDISPLAY_CMAP_DOLUT) {
    584  1.11  nisimura 		struct hwcmap256 *cm = &sc->sc_cmap;
    585   1.1  nisimura 		int index;
    586   1.1  nisimura 
    587  1.12  nisimura 		SELECT(vdac, 0);
    588   1.1  nisimura 		for (index = 0; index < CMAP_SIZE; index++) {
    589  1.12  nisimura 			REG(vdac, bt_cmap) = cm->r[index];	tc_wmb();
    590  1.12  nisimura 			REG(vdac, bt_cmap) = cm->g[index];	tc_wmb();
    591  1.12  nisimura 			REG(vdac, bt_cmap) = cm->b[index];	tc_wmb();
    592   1.1  nisimura 		}
    593   1.1  nisimura 	}
    594  1.26  nisimura 	sc->sc_changed = 0;
    595   1.1  nisimura 	return (1);
    596   1.1  nisimura }
    597   1.1  nisimura 
    598  1.14  nisimura static void
    599  1.29  nisimura cfbhwinit(cfbbase)
    600  1.29  nisimura 	caddr_t cfbbase;
    601   1.1  nisimura {
    602  1.29  nisimura 	caddr_t vdac = cfbbase + CX_BT459_OFFSET;
    603  1.24  nisimura 	const u_int8_t *p;
    604   1.1  nisimura 	int i;
    605   1.1  nisimura 
    606  1.17        ad 	SELECT(vdac, BT459_IREG_COMMAND_0);
    607  1.12  nisimura 	REG(vdac, bt_reg) = 0x40; /* CMD0 */	tc_wmb();
    608  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* CMD1 */	tc_wmb();
    609  1.12  nisimura 	REG(vdac, bt_reg) = 0xc0; /* CMD2 */	tc_wmb();
    610  1.12  nisimura 	REG(vdac, bt_reg) = 0xff; /* PRM */	tc_wmb();
    611  1.12  nisimura 	REG(vdac, bt_reg) = 0;    /* 205 */	tc_wmb();
    612  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* PBM */	tc_wmb();
    613  1.12  nisimura 	REG(vdac, bt_reg) = 0;    /* 207 */	tc_wmb();
    614  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* ORM */	tc_wmb();
    615  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* OBM */	tc_wmb();
    616  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* ILV */	tc_wmb();
    617  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;  /* TEST */	tc_wmb();
    618  1.12  nisimura 
    619  1.17        ad 	SELECT(vdac, BT459_IREG_CCR);
    620  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    621  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    622  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    623  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    624  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    625  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    626  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    627  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    628  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    629  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    630  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    631  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    632  1.12  nisimura 	REG(vdac, bt_reg) = 0x0;	tc_wmb();
    633   1.3  nisimura 
    634   1.3  nisimura 	/* build sane colormap */
    635  1.12  nisimura 	SELECT(vdac, 0);
    636  1.24  nisimura 	p = rasops_cmap;
    637  1.25  nisimura 	for (i = 0; i < CMAP_SIZE; i++, p += 3) {
    638  1.24  nisimura 		REG(vdac, bt_cmap) = p[0];	tc_wmb();
    639  1.24  nisimura 		REG(vdac, bt_cmap) = p[1];	tc_wmb();
    640  1.24  nisimura 		REG(vdac, bt_cmap) = p[2];	tc_wmb();
    641   1.3  nisimura 	}
    642   1.3  nisimura 
    643   1.3  nisimura 	/* clear out cursor image */
    644  1.17        ad 	SELECT(vdac, BT459_IREG_CRAM_BASE);
    645   1.3  nisimura 	for (i = 0; i < 1024; i++)
    646  1.12  nisimura 		REG(vdac, bt_reg) = 0xff;	tc_wmb();
    647   1.3  nisimura 
    648   1.3  nisimura 	/*
    649   1.3  nisimura 	 * 2 bit/pixel cursor.  Assign MSB for cursor mask and LSB for
    650   1.3  nisimura 	 * cursor image.  CCOLOR_2 for mask color, while CCOLOR_3 for
    651   1.3  nisimura 	 * image color.  CCOLOR_1 will be never used.
    652   1.3  nisimura 	 */
    653  1.17        ad 	SELECT(vdac, BT459_IREG_CCOLOR_1);
    654  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    655  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    656  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    657  1.12  nisimura 
    658  1.12  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    659  1.12  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    660  1.12  nisimura 	REG(vdac, bt_reg) = 0;	tc_wmb();
    661  1.12  nisimura 
    662  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    663  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    664  1.12  nisimura 	REG(vdac, bt_reg) = 0xff;	tc_wmb();
    665   1.1  nisimura }
    666   1.1  nisimura 
    667   1.1  nisimura static int
    668   1.1  nisimura get_cmap(sc, p)
    669   1.1  nisimura 	struct cfb_softc *sc;
    670   1.1  nisimura 	struct wsdisplay_cmap *p;
    671   1.1  nisimura {
    672   1.1  nisimura 	u_int index = p->index, count = p->count;
    673   1.1  nisimura 
    674   1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    675   1.1  nisimura 		return (EINVAL);
    676   1.1  nisimura 
    677   1.9       mrg 	if (!uvm_useracc(p->red, count, B_WRITE) ||
    678   1.9       mrg 	    !uvm_useracc(p->green, count, B_WRITE) ||
    679   1.9       mrg 	    !uvm_useracc(p->blue, count, B_WRITE))
    680   1.1  nisimura 		return (EFAULT);
    681   1.1  nisimura 
    682   1.1  nisimura 	copyout(&sc->sc_cmap.r[index], p->red, count);
    683   1.1  nisimura 	copyout(&sc->sc_cmap.g[index], p->green, count);
    684   1.1  nisimura 	copyout(&sc->sc_cmap.b[index], p->blue, count);
    685   1.1  nisimura 
    686   1.1  nisimura 	return (0);
    687   1.1  nisimura }
    688   1.1  nisimura 
    689   1.1  nisimura static int
    690   1.1  nisimura set_cmap(sc, p)
    691   1.1  nisimura 	struct cfb_softc *sc;
    692   1.1  nisimura 	struct wsdisplay_cmap *p;
    693   1.1  nisimura {
    694   1.1  nisimura 	u_int index = p->index, count = p->count;
    695   1.1  nisimura 
    696   1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    697   1.1  nisimura 		return (EINVAL);
    698   1.1  nisimura 
    699   1.9       mrg 	if (!uvm_useracc(p->red, count, B_READ) ||
    700   1.9       mrg 	    !uvm_useracc(p->green, count, B_READ) ||
    701   1.9       mrg 	    !uvm_useracc(p->blue, count, B_READ))
    702   1.1  nisimura 		return (EFAULT);
    703   1.1  nisimura 
    704   1.1  nisimura 	copyin(p->red, &sc->sc_cmap.r[index], count);
    705   1.1  nisimura 	copyin(p->green, &sc->sc_cmap.g[index], count);
    706   1.1  nisimura 	copyin(p->blue, &sc->sc_cmap.b[index], count);
    707  1.26  nisimura 	sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
    708   1.1  nisimura 	return (0);
    709   1.1  nisimura }
    710   1.1  nisimura 
    711   1.1  nisimura static int
    712   1.1  nisimura set_cursor(sc, p)
    713   1.1  nisimura 	struct cfb_softc *sc;
    714   1.1  nisimura 	struct wsdisplay_cursor *p;
    715   1.1  nisimura {
    716   1.1  nisimura #define	cc (&sc->sc_cursor)
    717  1.28  jdolecek 	u_int v, index, count, icount;
    718   1.1  nisimura 
    719   1.1  nisimura 	v = p->which;
    720   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    721   1.1  nisimura 		index = p->cmap.index;
    722   1.1  nisimura 		count = p->cmap.count;
    723   1.1  nisimura 		if (index >= 2 || (index + count) > 2)
    724   1.1  nisimura 			return (EINVAL);
    725   1.9       mrg 		if (!uvm_useracc(p->cmap.red, count, B_READ) ||
    726   1.9       mrg 		    !uvm_useracc(p->cmap.green, count, B_READ) ||
    727   1.9       mrg 		    !uvm_useracc(p->cmap.blue, count, B_READ))
    728   1.1  nisimura 			return (EFAULT);
    729   1.1  nisimura 	}
    730   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    731   1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    732   1.1  nisimura 			return (EINVAL);
    733   1.4  nisimura 		icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
    734   1.9       mrg 		if (!uvm_useracc(p->image, icount, B_READ) ||
    735   1.9       mrg 		    !uvm_useracc(p->mask, icount, B_READ))
    736   1.1  nisimura 			return (EFAULT);
    737   1.1  nisimura 	}
    738   1.1  nisimura 
    739  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR)
    740   1.1  nisimura 		sc->sc_curenb = p->enable;
    741  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOPOS)
    742  1.26  nisimura 		set_curpos(sc, &p->pos);
    743  1.26  nisimura 	if (v & WSDISPLAY_CURSOR_DOHOT)
    744  1.26  nisimura 		cc->cc_hot = p->hot;
    745   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    746   1.1  nisimura 		copyin(p->cmap.red, &cc->cc_color[index], count);
    747   1.1  nisimura 		copyin(p->cmap.green, &cc->cc_color[index + 2], count);
    748   1.1  nisimura 		copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
    749   1.1  nisimura 	}
    750   1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    751   1.1  nisimura 		cc->cc_size = p->size;
    752   1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    753   1.4  nisimura 		copyin(p->image, cc->cc_image, icount);
    754   1.4  nisimura 		copyin(p->mask, cc->cc_image+CURSOR_MAX_SIZE, icount);
    755   1.1  nisimura 	}
    756  1.27   reinoud 	sc->sc_changed |= v;
    757   1.1  nisimura 
    758   1.1  nisimura 	return (0);
    759   1.1  nisimura #undef cc
    760   1.1  nisimura }
    761   1.1  nisimura 
    762   1.1  nisimura static int
    763   1.1  nisimura get_cursor(sc, p)
    764   1.1  nisimura 	struct cfb_softc *sc;
    765   1.1  nisimura 	struct wsdisplay_cursor *p;
    766   1.1  nisimura {
    767   1.1  nisimura 	return (ENOTTY); /* XXX */
    768   1.1  nisimura }
    769   1.1  nisimura 
    770   1.1  nisimura static void
    771   1.1  nisimura set_curpos(sc, curpos)
    772   1.1  nisimura 	struct cfb_softc *sc;
    773   1.1  nisimura 	struct wsdisplay_curpos *curpos;
    774   1.1  nisimura {
    775  1.29  nisimura 	struct rasops_info *ri = sc->sc_ri;
    776   1.1  nisimura 	int x = curpos->x, y = curpos->y;
    777   1.1  nisimura 
    778   1.1  nisimura 	if (y < 0)
    779   1.1  nisimura 		y = 0;
    780  1.29  nisimura 	else if (y > ri->ri_height)
    781  1.29  nisimura 		y = ri->ri_height;
    782   1.1  nisimura 	if (x < 0)
    783   1.1  nisimura 		x = 0;
    784  1.29  nisimura 	else if (x > ri->ri_width)
    785  1.29  nisimura 		x = ri->ri_width;
    786   1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    787   1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    788   1.1  nisimura }
    789