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