Home | History | Annotate | Line # | Download | only in tc
mfb.c revision 1.2
      1  1.2  nisimura /* $NetBSD: mfb.c,v 1.2 1998/10/30 00:53:12 nisimura Exp $ */
      2  1.2  nisimura 
      3  1.2  nisimura /*
      4  1.2  nisimura  * Copyright (c) 1996, 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.2  nisimura __KERNEL_RCSID(0, "$NetBSD: mfb.c,v 1.2 1998/10/30 00:53:12 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 #include <machine/autoconf.h>
     54  1.1  nisimura 
     55  1.1  nisimura #include <dev/tc/tcvar.h>
     56  1.1  nisimura #include <dev/ic/bt431reg.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_KSEG0_TO_PHYS(x)
     69  1.1  nisimura 
     70  1.1  nisimura struct bt455reg {
     71  1.1  nisimura 	u_int8_t	bt_reg;
     72  1.1  nisimura 	unsigned : 24;
     73  1.1  nisimura 	u_int8_t	bt_cmap;
     74  1.1  nisimura 	unsigned : 24;
     75  1.1  nisimura 	u_int8_t	bt_clr;
     76  1.1  nisimura 	unsigned : 24;
     77  1.1  nisimura 	u_int8_t	bt_ovly;
     78  1.1  nisimura };
     79  1.1  nisimura 
     80  1.1  nisimura /* it's really painful to manipulate 'twined' registers... */
     81  1.1  nisimura struct bt431reg {
     82  1.1  nisimura 	u_int16_t	bt_lo;
     83  1.1  nisimura 	unsigned : 16;
     84  1.1  nisimura 	u_int16_t	bt_hi;
     85  1.1  nisimura 	unsigned : 16;
     86  1.1  nisimura 	u_int16_t	bt_ram;
     87  1.1  nisimura 	unsigned : 16;
     88  1.1  nisimura 	u_int16_t	bt_ctl;
     89  1.1  nisimura };
     90  1.1  nisimura 
     91  1.1  nisimura #endif
     92  1.1  nisimura 
     93  1.1  nisimura #if defined(__alpha__) || defined(alpha)
     94  1.1  nisimura /*
     95  1.1  nisimura  * Digital UNIX never supports PMAG-AA
     96  1.1  nisimura  */
     97  1.1  nisimura #define machine_btop(x) alpha_btop(x)
     98  1.1  nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
     99  1.1  nisimura 
    100  1.1  nisimura struct bt455reg {
    101  1.1  nisimura 	u_int32_t	bt_reg;
    102  1.1  nisimura 	u_int32_t	bt_cmap;
    103  1.1  nisimura 	u_int32_t	bt_clr;
    104  1.1  nisimura 	u_int32_t	bt_ovly;
    105  1.1  nisimura };
    106  1.1  nisimura 
    107  1.1  nisimura /* it's really painful to manipulate 'twined' registers... */
    108  1.1  nisimura struct bt431reg {
    109  1.1  nisimura 	u_int32_t	bt_lo;
    110  1.1  nisimura 	u_int32_t	bt_hi;
    111  1.1  nisimura 	u_int32_t	bt_ram;
    112  1.1  nisimura 	u_int32_t	bt_ctl;
    113  1.1  nisimura };
    114  1.1  nisimura #endif
    115  1.1  nisimura 
    116  1.1  nisimura /* XXX XXX XXX */
    117  1.1  nisimura 
    118  1.1  nisimura struct fb_devconfig {
    119  1.1  nisimura 	vaddr_t dc_vaddr;		/* memory space virtual base address */
    120  1.1  nisimura 	paddr_t dc_paddr;		/* memory space physical base address */
    121  1.1  nisimura 	vsize_t dc_size;		/* size of slot memory */
    122  1.1  nisimura 	int	dc_wid;			/* width of frame buffer */
    123  1.1  nisimura 	int	dc_ht;			/* height of frame buffer */
    124  1.1  nisimura 	int	dc_depth;		/* depth, bits per pixel */
    125  1.1  nisimura 	int	dc_rowbytes;		/* bytes in a FB scan line */
    126  1.1  nisimura 	vaddr_t dc_videobase;		/* base of flat frame buffer */
    127  1.1  nisimura 	struct raster	dc_raster;	/* raster description */
    128  1.1  nisimura 	struct rcons	dc_rcons;	/* raster blitter control info */
    129  1.1  nisimura 	int	    dc_blanked;		/* currently has video disabled */
    130  1.1  nisimura };
    131  1.1  nisimura 
    132  1.1  nisimura struct hwcursor {
    133  1.1  nisimura 	struct wsdisplay_curpos cc_pos;
    134  1.1  nisimura 	struct wsdisplay_curpos cc_hot;
    135  1.1  nisimura 	struct wsdisplay_curpos cc_size;
    136  1.1  nisimura #define	CURSOR_MAX_SIZE	64
    137  1.1  nisimura 	u_int8_t cc_color[6];
    138  1.1  nisimura 	u_int64_t cc_image[64 + 64];
    139  1.1  nisimura };
    140  1.1  nisimura 
    141  1.1  nisimura struct mfb_softc {
    142  1.1  nisimura 	struct device sc_dev;
    143  1.1  nisimura 	struct fb_devconfig *sc_dc;	/* device configuration */
    144  1.1  nisimura 	struct hwcursor sc_cursor;	/* software copy of cursor */
    145  1.1  nisimura 	int sc_curenb;			/* cursor sprite enabled */
    146  1.1  nisimura 	int sc_changed;			/* need update of colormap */
    147  1.1  nisimura #define	DATA_ENB_CHANGED	0x01	/* cursor enable changed */
    148  1.1  nisimura #define	DATA_CURCMAP_CHANGED	0x02	/* cursor colormap changed */
    149  1.1  nisimura #define	DATA_CURSHAPE_CHANGED	0x04	/* cursor size, image, mask changed */
    150  1.1  nisimura #define	DATA_CMAP_CHANGED	0x08	/* colormap changed */
    151  1.1  nisimura #define	DATA_ALL_CHANGED	0x0f
    152  1.1  nisimura 	int nscreens;
    153  1.1  nisimura };
    154  1.1  nisimura 
    155  1.1  nisimura int  mfbmatch __P((struct device *, struct cfdata *, void *));
    156  1.1  nisimura void mfbattach __P((struct device *, struct device *, void *));
    157  1.1  nisimura 
    158  1.1  nisimura struct cfattach mfb_ca = {
    159  1.1  nisimura 	sizeof(struct mfb_softc), mfbmatch, mfbattach,
    160  1.1  nisimura };
    161  1.1  nisimura 
    162  1.1  nisimura void mfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
    163  1.1  nisimura struct fb_devconfig mfb_console_dc;
    164  1.1  nisimura tc_addr_t mfb_consaddr;
    165  1.1  nisimura 
    166  1.1  nisimura struct wsdisplay_emulops mfb_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 mfb_stdscreen = {
    178  1.1  nisimura 	"std", 0, 0,
    179  1.1  nisimura 	&mfb_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 *_mfb_scrlist[] = {
    185  1.1  nisimura 	&mfb_stdscreen,
    186  1.1  nisimura };
    187  1.1  nisimura 
    188  1.1  nisimura struct wsscreen_list mfb_screenlist = {
    189  1.1  nisimura 	sizeof(_mfb_scrlist) / sizeof(struct wsscreen_descr *), _mfb_scrlist
    190  1.1  nisimura };
    191  1.1  nisimura 
    192  1.1  nisimura int	mfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
    193  1.1  nisimura int	mfbmmap __P((void *, off_t, int));
    194  1.1  nisimura 
    195  1.1  nisimura int	mfb_alloc_screen __P((void *, const struct wsscreen_descr *,
    196  1.1  nisimura 				      void **, int *, int *, long *));
    197  1.1  nisimura void	mfb_free_screen __P((void *, void *));
    198  1.1  nisimura void	mfb_show_screen __P((void *, void *));
    199  1.1  nisimura int	mfb_load_font __P((void *, void *, int, int, int, void *));
    200  1.1  nisimura 
    201  1.1  nisimura struct wsdisplay_accessops mfb_accessops = {
    202  1.1  nisimura 	mfbioctl,
    203  1.1  nisimura 	mfbmmap,
    204  1.1  nisimura 	mfb_alloc_screen,
    205  1.1  nisimura 	mfb_free_screen,
    206  1.1  nisimura 	mfb_show_screen,
    207  1.1  nisimura 	mfb_load_font
    208  1.1  nisimura };
    209  1.1  nisimura 
    210  1.1  nisimura int  mfb_cnattach __P((tc_addr_t));
    211  1.1  nisimura int  mfbintr __P((void *));
    212  1.1  nisimura void mfbinit __P((struct fb_devconfig *));
    213  1.1  nisimura 
    214  1.1  nisimura static int  set_cursor __P((struct mfb_softc *, struct wsdisplay_cursor *));
    215  1.1  nisimura static int  get_cursor __P((struct mfb_softc *, struct wsdisplay_cursor *));
    216  1.1  nisimura static void set_curpos __P((struct mfb_softc *, struct wsdisplay_curpos *));
    217  1.1  nisimura void bt431_set_curpos __P((struct mfb_softc *));
    218  1.1  nisimura 
    219  1.1  nisimura #define	TWIN_LO(x) (twin = (x) & 0x00ff, twin << 8 | twin)
    220  1.1  nisimura #define	TWIN_HI(x) (twin = (x) & 0xff00, twin | twin >> 8)
    221  1.1  nisimura 
    222  1.1  nisimura /* XXX XXX XXX */
    223  1.1  nisimura #define	BT431_SELECT(curs, regno) do {	\
    224  1.1  nisimura 	u_int16_t twin;			\
    225  1.1  nisimura 	curs->bt_lo = TWIN_LO(regno);	\
    226  1.1  nisimura 	curs->bt_hi = TWIN_HI(regno);	\
    227  1.1  nisimura 	tc_wmb();			\
    228  1.1  nisimura    } while (0)
    229  1.1  nisimura 
    230  1.1  nisimura #define BT455_SELECT(vdac, index) do {	\
    231  1.1  nisimura 	vdac->bt_reg = index;		\
    232  1.1  nisimura 	vdac->bt_clr = 0;		\
    233  1.1  nisimura 	tc_wmb();			\
    234  1.1  nisimura    } while (0)
    235  1.1  nisimura /* XXX XXX XXX */
    236  1.1  nisimura 
    237  1.1  nisimura #define	MFB_FB_OFFSET		0x200000
    238  1.1  nisimura #define	MFB_FB_SIZE		 0x40000
    239  1.1  nisimura #define	MFB_BT455_OFFSET	0x100000
    240  1.1  nisimura #define	MFB_BT431_OFFSET	0x180000
    241  1.1  nisimura #define	MFB_IREQ_OFFSET		0x080000	/* Interrupt req. control */
    242  1.1  nisimura 
    243  1.1  nisimura int
    244  1.1  nisimura mfbmatch(parent, match, aux)
    245  1.1  nisimura 	struct device *parent;
    246  1.1  nisimura 	struct cfdata *match;
    247  1.1  nisimura 	void *aux;
    248  1.1  nisimura {
    249  1.1  nisimura 	struct tc_attach_args *ta = aux;
    250  1.1  nisimura 
    251  1.1  nisimura 	if (strncmp("PMAG-AA ", ta->ta_modname, TC_ROM_LLEN) != 0)
    252  1.1  nisimura 		return (0);
    253  1.1  nisimura 
    254  1.1  nisimura 	return (1);
    255  1.1  nisimura }
    256  1.1  nisimura 
    257  1.1  nisimura void
    258  1.1  nisimura mfb_getdevconfig(dense_addr, dc)
    259  1.1  nisimura 	tc_addr_t dense_addr;
    260  1.1  nisimura 	struct fb_devconfig *dc;
    261  1.1  nisimura {
    262  1.1  nisimura 	struct raster *rap;
    263  1.1  nisimura 	struct rcons *rcp;
    264  1.1  nisimura 	int i;
    265  1.1  nisimura 
    266  1.1  nisimura 	dc->dc_vaddr = dense_addr;
    267  1.1  nisimura 	dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr + MFB_FB_OFFSET);
    268  1.1  nisimura 
    269  1.1  nisimura 	dc->dc_wid = 1280;
    270  1.1  nisimura 	dc->dc_ht = 1024;
    271  1.1  nisimura 	dc->dc_depth = 1;
    272  1.1  nisimura 	dc->dc_rowbytes = 2048 / 8;
    273  1.1  nisimura 	dc->dc_videobase = dc->dc_vaddr + MFB_FB_OFFSET;
    274  1.1  nisimura 	dc->dc_blanked = 0;
    275  1.1  nisimura 
    276  1.1  nisimura 	/* initialize colormap and cursor resource */
    277  1.1  nisimura 	mfbinit(dc);
    278  1.1  nisimura 
    279  1.1  nisimura 	/* clear the screen */
    280  1.1  nisimura 	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
    281  1.1  nisimura 		*(u_int32_t *)(dc->dc_videobase + i) = 0;
    282  1.1  nisimura 
    283  1.1  nisimura 	/* initialize the raster */
    284  1.1  nisimura 	rap = &dc->dc_raster;
    285  1.1  nisimura 	rap->width = dc->dc_wid;
    286  1.1  nisimura 	rap->height = dc->dc_ht;
    287  1.1  nisimura 	rap->depth = dc->dc_depth;
    288  1.1  nisimura 	rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
    289  1.1  nisimura 	rap->pixels = (u_int32_t *)dc->dc_videobase;
    290  1.1  nisimura 
    291  1.1  nisimura 	/* initialize the raster console blitter */
    292  1.1  nisimura 	rcp = &dc->dc_rcons;
    293  1.1  nisimura 	rcp->rc_sp = rap;
    294  1.1  nisimura 	rcp->rc_crow = rcp->rc_ccol = -1;
    295  1.1  nisimura 	rcp->rc_crowp = &rcp->rc_crow;
    296  1.1  nisimura 	rcp->rc_ccolp = &rcp->rc_ccol;
    297  1.1  nisimura 	rcons_init(rcp, 34, 80);
    298  1.1  nisimura 
    299  1.1  nisimura 	mfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
    300  1.1  nisimura 	mfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
    301  1.1  nisimura }
    302  1.1  nisimura 
    303  1.1  nisimura void
    304  1.1  nisimura mfbattach(parent, self, aux)
    305  1.1  nisimura 	struct device *parent, *self;
    306  1.1  nisimura 	void *aux;
    307  1.1  nisimura {
    308  1.1  nisimura 	struct mfb_softc *sc = (struct mfb_softc *)self;
    309  1.1  nisimura 	struct tc_attach_args *ta = aux;
    310  1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    311  1.1  nisimura 	caddr_t mfbbase;
    312  1.1  nisimura 	int console;
    313  1.1  nisimura 	volatile register int junk;
    314  1.1  nisimura 
    315  1.1  nisimura 	console = (ta->ta_addr == mfb_consaddr);
    316  1.1  nisimura 	if (console) {
    317  1.1  nisimura 		sc->sc_dc = &mfb_console_dc;
    318  1.1  nisimura 		sc->nscreens = 1;
    319  1.1  nisimura 	}
    320  1.1  nisimura 	else {
    321  1.1  nisimura 		sc->sc_dc = (struct fb_devconfig *)
    322  1.1  nisimura 		    malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
    323  1.1  nisimura 		mfb_getdevconfig(ta->ta_addr, sc->sc_dc);
    324  1.1  nisimura 	}
    325  1.1  nisimura 	printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
    326  1.1  nisimura 	    sc->sc_dc->dc_depth);
    327  1.1  nisimura 
    328  1.1  nisimura         tc_intr_establish(parent, ta->ta_cookie, TC_IPL_TTY, mfbintr, sc);
    329  1.1  nisimura 
    330  1.1  nisimura 	mfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    331  1.1  nisimura 	*(u_int8_t *)(mfbbase + MFB_IREQ_OFFSET) = 0;
    332  1.1  nisimura 	junk = *(u_int8_t *)(mfbbase + MFB_IREQ_OFFSET);
    333  1.1  nisimura 	*(u_int8_t *)(mfbbase + MFB_IREQ_OFFSET) = 1;
    334  1.1  nisimura 
    335  1.1  nisimura 	waa.console = console;
    336  1.1  nisimura 	waa.scrdata = &mfb_screenlist;
    337  1.1  nisimura 	waa.accessops = &mfb_accessops;
    338  1.1  nisimura 	waa.accesscookie = sc;
    339  1.1  nisimura 
    340  1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    341  1.1  nisimura }
    342  1.1  nisimura 
    343  1.1  nisimura int
    344  1.1  nisimura mfbioctl(v, cmd, data, flag, p)
    345  1.1  nisimura 	void *v;
    346  1.1  nisimura 	u_long cmd;
    347  1.1  nisimura 	caddr_t data;
    348  1.1  nisimura 	int flag;
    349  1.1  nisimura 	struct proc *p;
    350  1.1  nisimura {
    351  1.1  nisimura 	struct mfb_softc *sc = v;
    352  1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    353  1.1  nisimura 	int turnoff;
    354  1.1  nisimura 
    355  1.1  nisimura 	switch (cmd) {
    356  1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    357  1.1  nisimura 		*(u_int *)data = WSDISPLAY_TYPE_MFB;
    358  1.1  nisimura 		return (0);
    359  1.1  nisimura 
    360  1.1  nisimura 	case WSDISPLAYIO_GINFO:
    361  1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    362  1.1  nisimura 		wsd_fbip->height = sc->sc_dc->dc_ht;
    363  1.1  nisimura 		wsd_fbip->width = sc->sc_dc->dc_wid;
    364  1.1  nisimura 		wsd_fbip->depth = sc->sc_dc->dc_depth;
    365  1.1  nisimura 		wsd_fbip->cmsize = 0;
    366  1.1  nisimura #undef fbt
    367  1.1  nisimura 		return (0);
    368  1.1  nisimura 
    369  1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    370  1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    371  1.1  nisimura 		return (ENOTTY);
    372  1.1  nisimura 
    373  1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    374  1.1  nisimura 		turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
    375  1.1  nisimura 		if ((dc->dc_blanked == 0) ^ turnoff) {
    376  1.1  nisimura 			/* sc->sc_changed |= DATA_ALL_CHANGED; */
    377  1.1  nisimura 			dc->dc_blanked = turnoff;
    378  1.1  nisimura 		}
    379  1.1  nisimura 		return (0);
    380  1.1  nisimura 
    381  1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    382  1.1  nisimura 		*(u_int *)data = dc->dc_blanked ?
    383  1.1  nisimura 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    384  1.1  nisimura 		return (0);
    385  1.1  nisimura 
    386  1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    387  1.1  nisimura 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    388  1.1  nisimura 		return (0);
    389  1.1  nisimura 
    390  1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    391  1.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    392  1.1  nisimura 		bt431_set_curpos(sc);
    393  1.1  nisimura 		return (0);
    394  1.1  nisimura 
    395  1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    396  1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    397  1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    398  1.1  nisimura 		return (0);
    399  1.1  nisimura 
    400  1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    401  1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    402  1.1  nisimura 
    403  1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    404  1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    405  1.1  nisimura 	}
    406  1.1  nisimura 	return ENOTTY;
    407  1.1  nisimura }
    408  1.1  nisimura 
    409  1.1  nisimura int
    410  1.1  nisimura mfbmmap(v, offset, prot)
    411  1.1  nisimura 	void *v;
    412  1.1  nisimura 	off_t offset;
    413  1.1  nisimura 	int prot;
    414  1.1  nisimura {
    415  1.1  nisimura 	struct mfb_softc *sc = v;
    416  1.1  nisimura 
    417  1.1  nisimura 	if (offset > MFB_FB_SIZE)
    418  1.1  nisimura 		return (-1);
    419  1.1  nisimura 	return machine_btop(sc->sc_dc->dc_paddr + offset);
    420  1.1  nisimura }
    421  1.1  nisimura 
    422  1.1  nisimura int
    423  1.1  nisimura mfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    424  1.1  nisimura 	void *v;
    425  1.1  nisimura 	const struct wsscreen_descr *type;
    426  1.1  nisimura 	void **cookiep;
    427  1.1  nisimura 	int *curxp, *curyp;
    428  1.1  nisimura 	long *attrp;
    429  1.1  nisimura {
    430  1.1  nisimura 	struct mfb_softc *sc = v;
    431  1.1  nisimura 	long defattr;
    432  1.1  nisimura 
    433  1.1  nisimura 	if (sc->nscreens > 0)
    434  1.1  nisimura 		return (ENOMEM);
    435  1.1  nisimura 
    436  1.1  nisimura 	*cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
    437  1.1  nisimura 	*curxp = 0;
    438  1.1  nisimura 	*curyp = 0;
    439  1.1  nisimura 	rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
    440  1.1  nisimura 	*attrp = defattr;
    441  1.1  nisimura 	sc->nscreens++;
    442  1.1  nisimura 	return (0);
    443  1.1  nisimura }
    444  1.1  nisimura 
    445  1.1  nisimura void
    446  1.1  nisimura mfb_free_screen(v, cookie)
    447  1.1  nisimura 	void *v;
    448  1.1  nisimura 	void *cookie;
    449  1.1  nisimura {
    450  1.1  nisimura 	struct mfb_softc *sc = v;
    451  1.1  nisimura 
    452  1.1  nisimura 	if (sc->sc_dc == &mfb_console_dc)
    453  1.1  nisimura 		panic("mfb_free_screen: console");
    454  1.1  nisimura 
    455  1.1  nisimura 	sc->nscreens--;
    456  1.1  nisimura }
    457  1.1  nisimura 
    458  1.1  nisimura void
    459  1.1  nisimura mfb_show_screen(v, cookie)
    460  1.1  nisimura 	void *v;
    461  1.1  nisimura 	void *cookie;
    462  1.1  nisimura {
    463  1.1  nisimura }
    464  1.1  nisimura 
    465  1.1  nisimura int
    466  1.1  nisimura mfb_load_font(v, cookie, first, num, stride, data)
    467  1.1  nisimura 	void *v;
    468  1.1  nisimura 	void *cookie;
    469  1.1  nisimura 	int first, num, stride;
    470  1.1  nisimura 	void *data;
    471  1.1  nisimura {
    472  1.1  nisimura 	return (EINVAL);
    473  1.1  nisimura }
    474  1.1  nisimura 
    475  1.1  nisimura int
    476  1.1  nisimura mfb_cnattach(addr)
    477  1.1  nisimura         tc_addr_t addr;
    478  1.1  nisimura {
    479  1.1  nisimura         struct fb_devconfig *dcp = &mfb_console_dc;
    480  1.1  nisimura         long defattr;
    481  1.1  nisimura 
    482  1.1  nisimura         mfb_getdevconfig(addr, dcp);
    483  1.1  nisimura 
    484  1.1  nisimura         rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
    485  1.1  nisimura 
    486  1.1  nisimura         wsdisplay_cnattach(&mfb_stdscreen, &dcp->dc_rcons,
    487  1.1  nisimura                            0, 0, defattr);
    488  1.1  nisimura         mfb_consaddr = addr;
    489  1.1  nisimura         return(0);
    490  1.1  nisimura }
    491  1.1  nisimura 
    492  1.1  nisimura 
    493  1.1  nisimura int
    494  1.1  nisimura mfbintr(arg)
    495  1.1  nisimura 	void *arg;
    496  1.1  nisimura {
    497  1.1  nisimura 	struct mfb_softc *sc = arg;
    498  1.1  nisimura 	caddr_t mfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    499  1.1  nisimura 	struct bt455reg *vdac;
    500  1.1  nisimura 	struct bt431reg *curs;
    501  1.1  nisimura 	int v;
    502  1.1  nisimura 	volatile register int junk;
    503  1.1  nisimura 
    504  1.1  nisimura 	junk = *(u_int8_t *)(mfbbase + MFB_IREQ_OFFSET);
    505  1.1  nisimura 	/* *(u_int8_t *)(mfbbase + MFB_IREQ_OFFSET) = 1; */
    506  1.1  nisimura 
    507  1.1  nisimura 	if (sc->sc_changed == 0)
    508  1.1  nisimura 		return (1);
    509  1.1  nisimura 
    510  1.1  nisimura 	vdac = (void *)(mfbbase + MFB_BT455_OFFSET);
    511  1.1  nisimura 	curs = (void *)(mfbbase + MFB_BT431_OFFSET);
    512  1.1  nisimura 
    513  1.1  nisimura 	v = sc->sc_changed;
    514  1.1  nisimura 	sc->sc_changed = 0;
    515  1.1  nisimura 	if (v & DATA_ENB_CHANGED) {
    516  1.1  nisimura 		BT431_SELECT(curs, BT431_REG_COMMAND);
    517  1.1  nisimura 		curs->bt_ctl = (sc->sc_curenb) ? 0x4444 : 0x0404;
    518  1.1  nisimura 	}
    519  1.1  nisimura 	if (v & DATA_CURSHAPE_CHANGED) {
    520  1.1  nisimura 		u_int8_t *bp1, *bp2;
    521  1.1  nisimura 		u_int16_t twin;
    522  1.1  nisimura 		int index;
    523  1.1  nisimura 
    524  1.1  nisimura 		bp1 = (u_int8_t *)&sc->sc_cursor.cc_image;
    525  1.1  nisimura 		bp2 = (u_int8_t *)(&sc->sc_cursor.cc_image + CURSOR_MAX_SIZE);
    526  1.1  nisimura 
    527  1.1  nisimura 		BT431_SELECT(curs, BT431_REG_CRAM_BASE+0);
    528  1.1  nisimura 		for (index = 0;
    529  1.1  nisimura 		    index < sizeof(sc->sc_cursor.cc_image)/sizeof(u_int16_t);
    530  1.1  nisimura 		    index++) {
    531  1.1  nisimura 			twin = *bp1++ | (*bp2++ << 8);
    532  1.1  nisimura 			curs->bt_ram = twin;
    533  1.1  nisimura 			tc_wmb();
    534  1.1  nisimura 		}
    535  1.1  nisimura 	}
    536  1.1  nisimura 	return (1);
    537  1.1  nisimura }
    538  1.1  nisimura 
    539  1.1  nisimura void
    540  1.1  nisimura mfbinit(dc)
    541  1.1  nisimura 	struct fb_devconfig *dc;
    542  1.1  nisimura {
    543  1.1  nisimura 	caddr_t mfbbase = (caddr_t)dc->dc_vaddr;
    544  1.1  nisimura 	struct bt431reg *curs = (void *)(mfbbase + MFB_BT431_OFFSET);
    545  1.1  nisimura 	struct bt455reg *vdac = (void *)(mfbbase + MFB_BT455_OFFSET);
    546  1.1  nisimura 	int i;
    547  1.1  nisimura 
    548  1.1  nisimura 	BT455_SELECT(vdac, 0);
    549  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    550  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    551  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    552  1.1  nisimura 
    553  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    554  1.1  nisimura 	vdac->bt_cmap = 0xff;	tc_wmb();
    555  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    556  1.1  nisimura 
    557  1.1  nisimura 	for (i = 2; i < 16; i++) {
    558  1.1  nisimura 		vdac->bt_cmap = 0;	tc_wmb();
    559  1.1  nisimura 		vdac->bt_cmap = 0;	tc_wmb();
    560  1.1  nisimura 		vdac->bt_cmap = 0;	tc_wmb();
    561  1.1  nisimura 	}
    562  1.1  nisimura 
    563  1.1  nisimura 	BT455_SELECT(vdac, 8);
    564  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    565  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    566  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    567  1.1  nisimura 
    568  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    569  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    570  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    571  1.1  nisimura 
    572  1.1  nisimura 	vdac->bt_ovly = 0;	tc_wmb();
    573  1.1  nisimura 	vdac->bt_ovly = 0xff;	tc_wmb();
    574  1.1  nisimura 	vdac->bt_ovly = 0;	tc_wmb();
    575  1.1  nisimura 
    576  1.1  nisimura 	BT431_SELECT(curs, BT431_REG_COMMAND);
    577  1.1  nisimura 	curs->bt_ctl = 0x0404;	tc_wmb();
    578  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    579  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    580  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    581  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    582  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    583  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    584  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    585  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    586  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    587  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    588  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    589  1.1  nisimura 	curs->bt_ctl = 0;	tc_wmb();
    590  1.1  nisimura }
    591  1.1  nisimura 
    592  1.1  nisimura static int
    593  1.1  nisimura set_cursor(sc, p)
    594  1.1  nisimura 	struct mfb_softc *sc;
    595  1.1  nisimura 	struct wsdisplay_cursor *p;
    596  1.1  nisimura {
    597  1.1  nisimura #define	cc (&sc->sc_cursor)
    598  1.1  nisimura 	int v, count;
    599  1.1  nisimura 
    600  1.1  nisimura 	v = p->which;
    601  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    602  1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    603  1.1  nisimura 			return (EINVAL);
    604  1.1  nisimura 		count = (CURSOR_MAX_SIZE / NBBY) * p->size.y;
    605  1.1  nisimura 		if (!useracc(p->image, count, B_READ) ||
    606  1.1  nisimura 		    !useracc(p->mask, count, B_READ))
    607  1.1  nisimura 			return (EFAULT);
    608  1.1  nisimura 	}
    609  1.1  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) {
    610  1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOCUR)
    611  1.1  nisimura 			cc->cc_hot = p->hot;
    612  1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOPOS)
    613  1.1  nisimura 			set_curpos(sc, &p->pos);
    614  1.1  nisimura 		bt431_set_curpos(sc);
    615  1.1  nisimura 	}
    616  1.1  nisimura 
    617  1.1  nisimura 	sc->sc_changed = 0;
    618  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    619  1.1  nisimura 		sc->sc_curenb = p->enable;
    620  1.1  nisimura 		sc->sc_changed |= DATA_ENB_CHANGED;
    621  1.1  nisimura 	}
    622  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    623  1.1  nisimura 		cc->cc_size = p->size;
    624  1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    625  1.1  nisimura 		copyin(p->image, (caddr_t)cc->cc_image, count);
    626  1.1  nisimura 		copyin(p->mask, (caddr_t)(cc->cc_image+CURSOR_MAX_SIZE), count);
    627  1.1  nisimura 		sc->sc_changed |= DATA_CURSHAPE_CHANGED;
    628  1.1  nisimura 	}
    629  1.1  nisimura 
    630  1.1  nisimura 	return (0);
    631  1.1  nisimura #undef cc
    632  1.1  nisimura }
    633  1.1  nisimura 
    634  1.1  nisimura static int
    635  1.1  nisimura get_cursor(sc, p)
    636  1.1  nisimura 	struct mfb_softc *sc;
    637  1.1  nisimura 	struct wsdisplay_cursor *p;
    638  1.1  nisimura {
    639  1.1  nisimura 	return (ENOTTY); /* XXX */
    640  1.1  nisimura }
    641  1.1  nisimura 
    642  1.1  nisimura static void
    643  1.1  nisimura set_curpos(sc, curpos)
    644  1.1  nisimura 	struct mfb_softc *sc;
    645  1.1  nisimura 	struct wsdisplay_curpos *curpos;
    646  1.1  nisimura {
    647  1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    648  1.1  nisimura 	int x = curpos->x, y = curpos->y;
    649  1.1  nisimura 
    650  1.1  nisimura 	if (y < 0)
    651  1.1  nisimura 		y = 0;
    652  1.1  nisimura 	else if (y > dc->dc_ht - sc->sc_cursor.cc_size.y - 1)
    653  1.1  nisimura 		y = dc->dc_ht - sc->sc_cursor.cc_size.y - 1;
    654  1.1  nisimura 	if (x < 0)
    655  1.1  nisimura 		x = 0;
    656  1.1  nisimura 	else if (x > dc->dc_wid - sc->sc_cursor.cc_size.x - 1)
    657  1.1  nisimura 		x = dc->dc_wid - sc->sc_cursor.cc_size.x - 1;
    658  1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    659  1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    660  1.1  nisimura }
    661  1.1  nisimura 
    662  1.1  nisimura void
    663  1.1  nisimura bt431_set_curpos(sc)
    664  1.1  nisimura 	struct mfb_softc *sc;
    665  1.1  nisimura {
    666  1.1  nisimura 	caddr_t mfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    667  1.1  nisimura 	struct bt431reg *curs = (void *)(mfbbase + MFB_BT431_OFFSET);
    668  1.1  nisimura 	int x = 360, y = 36; /* magic offset of MX coordinate */
    669  1.1  nisimura 	u_int16_t twin;
    670  1.1  nisimura 	int s;
    671  1.1  nisimura 
    672  1.1  nisimura 	x += sc->sc_cursor.cc_pos.x;
    673  1.1  nisimura 	y += sc->sc_cursor.cc_pos.y;
    674  1.1  nisimura 
    675  1.1  nisimura #if 0 /* MACH legend tells */
    676  1.1  nisimura 	/*
    677  1.1  nisimura 	 * Cx = x + D + H - P
    678  1.1  nisimura 	 *  P = 37 if 1:1, 52 if 4:1, 57 if 5:1
    679  1.1  nisimura 	 *  D = pixel skew between outdata and external data
    680  1.1  nisimura 	 *  H = pixels between HSYNCH falling and active video
    681  1.1  nisimura 	 *
    682  1.1  nisimura 	 * Cy = y + V - 32
    683  1.1  nisimura 	 *  V = scanlines between HSYNCH falling, two or more
    684  1.1  nisimura 	 *	clocks after VSYNCH falling, and active video
    685  1.1  nisimura 	 */
    686  1.1  nisimura #endif
    687  1.1  nisimura 	s = spltty();
    688  1.1  nisimura 
    689  1.1  nisimura 	BT431_SELECT(curs, BT431_REG_CURSOR_X_LOW);
    690  1.1  nisimura 	curs->bt_ctl = TWIN_LO(x);
    691  1.1  nisimura 	curs->bt_ctl = TWIN_HI(x);
    692  1.1  nisimura 	curs->bt_ctl = TWIN_LO(y);
    693  1.1  nisimura 	curs->bt_ctl = TWIN_HI(y);
    694  1.1  nisimura 
    695  1.1  nisimura 	splx(s);
    696  1.1  nisimura }
    697