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