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