Home | History | Annotate | Line # | Download | only in sbus
mgx.c revision 1.12.4.1
      1  1.12.4.1  pgoyette /*	$NetBSD: mgx.c,v 1.12.4.1 2018/03/30 06:20:15 pgoyette Exp $ */
      2       1.1  macallan 
      3       1.1  macallan /*-
      4       1.1  macallan  * Copyright (c) 2014 Michael Lorenz
      5       1.1  macallan  * All rights reserved.
      6       1.1  macallan  *
      7       1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8       1.1  macallan  * modification, are permitted provided that the following conditions
      9       1.1  macallan  * are met:
     10       1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11       1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12       1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14       1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15       1.1  macallan  *
     16       1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17       1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18       1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19       1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20       1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21       1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22       1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23       1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24       1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25       1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26       1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     27       1.1  macallan  */
     28       1.1  macallan 
     29       1.1  macallan /* a console driver for the SSB 4096V-MGX graphics card */
     30       1.1  macallan 
     31       1.1  macallan #include <sys/cdefs.h>
     32  1.12.4.1  pgoyette __KERNEL_RCSID(0, "$NetBSD: mgx.c,v 1.12.4.1 2018/03/30 06:20:15 pgoyette Exp $");
     33       1.1  macallan 
     34       1.1  macallan #include <sys/param.h>
     35       1.1  macallan #include <sys/systm.h>
     36       1.1  macallan #include <sys/buf.h>
     37       1.1  macallan #include <sys/device.h>
     38       1.1  macallan #include <sys/ioctl.h>
     39       1.1  macallan #include <sys/conf.h>
     40       1.1  macallan #include <sys/kmem.h>
     41       1.8  macallan #include <sys/kauth.h>
     42      1.10  macallan #include <sys/atomic.h>
     43       1.1  macallan 
     44       1.1  macallan #include <sys/bus.h>
     45       1.1  macallan #include <machine/autoconf.h>
     46       1.1  macallan 
     47       1.1  macallan #include <dev/sbus/sbusvar.h>
     48       1.1  macallan #include <dev/sun/fbio.h>
     49       1.1  macallan #include <dev/sun/fbvar.h>
     50       1.1  macallan 
     51       1.1  macallan #include <dev/wscons/wsdisplayvar.h>
     52       1.1  macallan #include <dev/wscons/wsconsio.h>
     53       1.1  macallan #include <dev/wsfont/wsfont.h>
     54       1.1  macallan #include <dev/rasops/rasops.h>
     55       1.1  macallan 
     56       1.1  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     57       1.2  macallan #include <dev/wscons/wsdisplay_glyphcachevar.h>
     58       1.1  macallan 
     59       1.1  macallan #include <dev/ic/vgareg.h>
     60       1.1  macallan #include <dev/sbus/mgxreg.h>
     61       1.1  macallan 
     62       1.9  macallan #include "ioconf.h"
     63       1.9  macallan 
     64       1.1  macallan #include "opt_wsemul.h"
     65       1.5  macallan #include "opt_mgx.h"
     66       1.1  macallan 
     67       1.1  macallan struct mgx_softc {
     68       1.1  macallan 	device_t	sc_dev;
     69       1.9  macallan 	struct fbdevice	sc_fb;		/* frame buffer device */
     70       1.1  macallan 	bus_space_tag_t sc_tag;
     71       1.1  macallan 	bus_space_handle_t sc_blith;
     72       1.1  macallan 	bus_space_handle_t sc_vgah;
     73       1.8  macallan 	bus_addr_t	sc_paddr, sc_rpaddr;
     74       1.1  macallan 	void		*sc_fbaddr;
     75       1.6  macallan 	uint8_t		*sc_cursor;
     76       1.1  macallan 	int		sc_width;
     77       1.1  macallan 	int		sc_height;
     78       1.1  macallan 	int		sc_stride;
     79       1.5  macallan 	int		sc_depth;
     80       1.1  macallan 	int		sc_fbsize;
     81       1.1  macallan 	int		sc_mode;
     82       1.5  macallan 	char		sc_name[8];
     83       1.2  macallan 	uint32_t	sc_dec;
     84       1.1  macallan 	u_char		sc_cmap_red[256];
     85       1.1  macallan 	u_char		sc_cmap_green[256];
     86       1.1  macallan 	u_char		sc_cmap_blue[256];
     87       1.6  macallan 	int		sc_cursor_x, sc_cursor_y;
     88       1.6  macallan 	int		sc_hotspot_x, sc_hotspot_y;
     89      1.10  macallan 	int		sc_video, sc_buf;
     90       1.2  macallan 	void (*sc_putchar)(void *, int, int, u_int, long);
     91       1.1  macallan 	struct vcons_screen sc_console_screen;
     92       1.1  macallan 	struct wsscreen_descr sc_defaultscreen_descr;
     93       1.1  macallan 	const struct wsscreen_descr *sc_screens[1];
     94       1.1  macallan 	struct wsscreen_list sc_screenlist;
     95       1.1  macallan 	struct vcons_data vd;
     96       1.2  macallan 	glyphcache 	sc_gc;
     97      1.12  macallan 	uint8_t		sc_in[256];
     98       1.1  macallan };
     99       1.1  macallan 
    100       1.1  macallan static int	mgx_match(device_t, cfdata_t, void *);
    101       1.1  macallan static void	mgx_attach(device_t, device_t, void *);
    102       1.1  macallan static int	mgx_ioctl(void *, void *, u_long, void *, int,
    103       1.1  macallan 				 struct lwp*);
    104       1.1  macallan static paddr_t	mgx_mmap(void *, void *, off_t, int);
    105       1.1  macallan static void	mgx_init_screen(void *, struct vcons_screen *, int,
    106       1.1  macallan 				 long *);
    107       1.1  macallan static void	mgx_write_dac(struct mgx_softc *, int, int, int, int);
    108       1.1  macallan static void	mgx_setup(struct mgx_softc *, int);
    109       1.1  macallan static void	mgx_init_palette(struct mgx_softc *);
    110       1.4  macallan static int	mgx_putcmap(struct mgx_softc *, struct wsdisplay_cmap *);
    111       1.4  macallan static int 	mgx_getcmap(struct mgx_softc *, struct wsdisplay_cmap *);
    112       1.2  macallan static int	mgx_wait_engine(struct mgx_softc *);
    113       1.7     joerg __unused static int	mgx_wait_host(struct mgx_softc *);
    114      1.12  macallan /*static*/ int	mgx_wait_fifo(struct mgx_softc *, unsigned int);
    115       1.2  macallan 
    116       1.2  macallan static void	mgx_bitblt(void *, int, int, int, int, int, int, int);
    117       1.2  macallan static void 	mgx_rectfill(void *, int, int, int, int, long);
    118       1.2  macallan 
    119      1.10  macallan static void	mgx_putchar_aa(void *, int, int, u_int, long);
    120      1.10  macallan static void	mgx_putchar_mono(void *, int, int, u_int, long);
    121       1.2  macallan static void	mgx_cursor(void *, int, int, int);
    122       1.2  macallan static void	mgx_copycols(void *, int, int, int, int);
    123       1.2  macallan static void	mgx_erasecols(void *, int, int, int, long);
    124       1.2  macallan static void	mgx_copyrows(void *, int, int, int);
    125       1.2  macallan static void	mgx_eraserows(void *, int, int, long);
    126      1.12  macallan static void	mgx_adapt(struct vcons_screen *, void *);
    127       1.1  macallan 
    128       1.6  macallan static int	mgx_do_cursor(struct mgx_softc *, struct wsdisplay_cursor *);
    129       1.6  macallan static void	mgx_set_cursor(struct mgx_softc *);
    130       1.6  macallan static void	mgx_set_video(struct mgx_softc *, int);
    131       1.6  macallan 
    132       1.1  macallan CFATTACH_DECL_NEW(mgx, sizeof(struct mgx_softc),
    133       1.1  macallan     mgx_match, mgx_attach, NULL, NULL);
    134       1.1  macallan 
    135       1.1  macallan struct wsdisplay_accessops mgx_accessops = {
    136       1.1  macallan 	mgx_ioctl,
    137       1.1  macallan 	mgx_mmap,
    138       1.1  macallan 	NULL,	/* vcons_alloc_screen */
    139       1.1  macallan 	NULL,	/* vcons_free_screen */
    140       1.1  macallan 	NULL,	/* vcons_show_screen */
    141       1.1  macallan 	NULL,	/* load_font */
    142       1.1  macallan 	NULL,	/* polls */
    143       1.1  macallan 	NULL,	/* scroll */
    144       1.1  macallan };
    145       1.1  macallan 
    146       1.9  macallan static void	mgx_unblank(device_t);
    147       1.9  macallan 
    148       1.9  macallan dev_type_open(mgxopen);
    149       1.9  macallan dev_type_close(mgxclose);
    150       1.9  macallan dev_type_ioctl(mgxioctl);
    151       1.9  macallan dev_type_mmap(mgxmmap);
    152       1.9  macallan 
    153       1.9  macallan const struct cdevsw mgx_cdevsw = {
    154       1.9  macallan 	.d_open = mgxopen,
    155       1.9  macallan 	.d_close = mgxclose,
    156       1.9  macallan 	.d_read = noread,
    157       1.9  macallan 	.d_write = nowrite,
    158       1.9  macallan 	.d_ioctl = mgxioctl,
    159       1.9  macallan 	.d_stop = nostop,
    160       1.9  macallan 	.d_tty = notty,
    161       1.9  macallan 	.d_poll = nopoll,
    162       1.9  macallan 	.d_mmap = mgxmmap,
    163       1.9  macallan 	.d_kqfilter = nokqfilter,
    164       1.9  macallan 	.d_discard = nodiscard,
    165       1.9  macallan 	.d_flag = D_OTHER
    166       1.9  macallan };
    167       1.9  macallan 
    168       1.9  macallan /* frame buffer generic driver */
    169       1.9  macallan static struct fbdriver mgx_fbdriver = {
    170       1.9  macallan 	mgx_unblank, mgxopen, mgxclose, mgxioctl, nopoll, mgxmmap,
    171       1.9  macallan 	nokqfilter
    172       1.9  macallan };
    173       1.9  macallan 
    174       1.9  macallan 
    175       1.5  macallan static inline void
    176       1.5  macallan mgx_write_vga(struct mgx_softc *sc, uint32_t reg, uint8_t val)
    177       1.5  macallan {
    178       1.5  macallan 	bus_space_write_1(sc->sc_tag, sc->sc_vgah, reg ^ 3, val);
    179       1.5  macallan }
    180       1.5  macallan 
    181       1.5  macallan static inline uint8_t
    182       1.5  macallan mgx_read_vga(struct mgx_softc *sc, uint32_t reg)
    183       1.5  macallan {
    184       1.5  macallan 	return bus_space_read_1(sc->sc_tag, sc->sc_vgah, reg ^ 3);
    185       1.5  macallan }
    186       1.5  macallan 
    187       1.5  macallan static inline void
    188       1.5  macallan mgx_write_1(struct mgx_softc *sc, uint32_t reg, uint8_t val)
    189       1.5  macallan {
    190       1.5  macallan 	bus_space_write_1(sc->sc_tag, sc->sc_blith, reg ^ 3, val);
    191       1.5  macallan }
    192       1.5  macallan 
    193       1.5  macallan static inline uint8_t
    194       1.5  macallan mgx_read_1(struct mgx_softc *sc, uint32_t reg)
    195       1.5  macallan {
    196       1.5  macallan 	return bus_space_read_1(sc->sc_tag, sc->sc_blith, reg ^ 3);
    197       1.5  macallan }
    198       1.5  macallan 
    199       1.8  macallan #if 0
    200       1.8  macallan static inline uint32_t
    201       1.8  macallan mgx_read_4(struct mgx_softc *sc, uint32_t reg)
    202       1.8  macallan {
    203       1.8  macallan 	return bus_space_read_4(sc->sc_tag, sc->sc_blith, reg);
    204       1.8  macallan }
    205       1.8  macallan #endif
    206       1.8  macallan 
    207       1.5  macallan static inline void
    208       1.6  macallan mgx_write_2(struct mgx_softc *sc, uint32_t reg, uint16_t val)
    209       1.6  macallan {
    210       1.6  macallan 	bus_space_write_2(sc->sc_tag, sc->sc_blith, reg ^ 2, val);
    211       1.6  macallan }
    212       1.6  macallan 
    213       1.6  macallan static inline void
    214       1.5  macallan mgx_write_4(struct mgx_softc *sc, uint32_t reg, uint32_t val)
    215       1.5  macallan {
    216       1.5  macallan 	bus_space_write_4(sc->sc_tag, sc->sc_blith, reg, val);
    217       1.5  macallan }
    218       1.5  macallan 
    219       1.1  macallan static int
    220       1.1  macallan mgx_match(device_t parent, cfdata_t cf, void *aux)
    221       1.1  macallan {
    222       1.1  macallan 	struct sbus_attach_args *sa = aux;
    223       1.1  macallan 
    224       1.1  macallan 	if (strcmp("SMSI,mgx", sa->sa_name) == 0)
    225       1.1  macallan 		return 100;
    226       1.1  macallan 	return 0;
    227       1.1  macallan }
    228       1.1  macallan 
    229       1.1  macallan /*
    230       1.1  macallan  * Attach a display.  We need to notice if it is the console, too.
    231       1.1  macallan  */
    232       1.1  macallan static void
    233       1.1  macallan mgx_attach(device_t parent, device_t self, void *args)
    234       1.1  macallan {
    235       1.1  macallan 	struct mgx_softc *sc = device_private(self);
    236       1.1  macallan 	struct sbus_attach_args *sa = args;
    237       1.1  macallan 	struct wsemuldisplaydev_attach_args aa;
    238       1.9  macallan 	struct fbdevice *fb = &sc->sc_fb;
    239       1.1  macallan 	struct rasops_info *ri;
    240       1.1  macallan 	unsigned long defattr;
    241       1.1  macallan 	bus_space_handle_t bh;
    242      1.12  macallan 	int node = sa->sa_node, bsize;
    243       1.1  macallan 	int isconsole;
    244       1.1  macallan 
    245       1.1  macallan 	aprint_normal("\n");
    246       1.1  macallan 	sc->sc_dev = self;
    247       1.1  macallan 	sc->sc_tag = sa->sa_bustag;
    248       1.1  macallan 
    249       1.1  macallan 	sc->sc_paddr = sbus_bus_addr(sa->sa_bustag, sa->sa_slot,
    250       1.1  macallan 	    sa->sa_reg[8].oa_base);
    251       1.8  macallan 	sc->sc_rpaddr = sbus_bus_addr(sa->sa_bustag, sa->sa_slot,
    252       1.8  macallan 	    sa->sa_reg[5].oa_base + MGX_REG_ATREG_OFFSET);
    253       1.1  macallan 
    254       1.1  macallan 	/* read geometry information from the device tree */
    255       1.1  macallan 	sc->sc_width = prom_getpropint(sa->sa_node, "width", 1152);
    256       1.1  macallan 	sc->sc_height = prom_getpropint(sa->sa_node, "height", 900);
    257       1.5  macallan 	sc->sc_stride = prom_getpropint(sa->sa_node, "linebytes", 1152);
    258       1.5  macallan 	sc->sc_fbsize = prom_getpropint(sa->sa_node, "fb_size", 0x00400000);
    259       1.2  macallan 	sc->sc_fbaddr = NULL;
    260       1.1  macallan 	if (sc->sc_fbaddr == NULL) {
    261       1.1  macallan 		if (sbus_bus_map(sa->sa_bustag,
    262       1.1  macallan 			 sa->sa_slot,
    263       1.1  macallan 			 sa->sa_reg[8].oa_base,
    264       1.1  macallan 			 sc->sc_fbsize,
    265       1.2  macallan 			 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
    266       1.2  macallan 			 &bh) != 0) {
    267       1.5  macallan 			aprint_error_dev(self, "couldn't map framebuffer\n");
    268       1.1  macallan 			return;
    269       1.1  macallan 		}
    270       1.1  macallan 		sc->sc_fbaddr = bus_space_vaddr(sa->sa_bustag, bh);
    271       1.1  macallan 	}
    272      1.12  macallan 
    273       1.1  macallan 	if (sbus_bus_map(sa->sa_bustag,
    274       1.1  macallan 			 sa->sa_slot,
    275       1.1  macallan 			 sa->sa_reg[4].oa_base, 0x1000, 0,
    276       1.1  macallan 			 &sc->sc_vgah) != 0) {
    277       1.1  macallan 		aprint_error("%s: couldn't map VGA registers\n",
    278       1.1  macallan 		    device_xname(sc->sc_dev));
    279       1.1  macallan 		return;
    280       1.1  macallan 	}
    281       1.1  macallan 
    282       1.1  macallan 	if (sbus_bus_map(sa->sa_bustag,
    283       1.1  macallan 			 sa->sa_slot,
    284       1.2  macallan 			 sa->sa_reg[5].oa_base + MGX_REG_ATREG_OFFSET, 0x1000,
    285       1.2  macallan 			 0, &sc->sc_blith) != 0) {
    286       1.1  macallan 		aprint_error("%s: couldn't map blitter registers\n",
    287       1.1  macallan 		    device_xname(sc->sc_dev));
    288       1.1  macallan 		return;
    289       1.1  macallan 	}
    290       1.1  macallan 
    291       1.5  macallan 	mgx_setup(sc, MGX_DEPTH);
    292       1.5  macallan 
    293       1.5  macallan 	aprint_normal_dev(self, "[%s] %d MB framebuffer, %d x %d\n",
    294       1.5  macallan 		sc->sc_name, sc->sc_fbsize >> 20, sc->sc_width, sc->sc_height);
    295       1.5  macallan 
    296       1.1  macallan 
    297       1.1  macallan 	sc->sc_defaultscreen_descr = (struct wsscreen_descr) {
    298       1.1  macallan 		"default",
    299       1.1  macallan 		0, 0,
    300       1.1  macallan 		NULL,
    301       1.1  macallan 		8, 16,
    302      1.10  macallan 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_UNDERLINE |
    303      1.10  macallan 		WSSCREEN_RESIZE,
    304       1.1  macallan 		NULL
    305       1.1  macallan 	};
    306       1.6  macallan 
    307       1.6  macallan 	sc->sc_cursor_x = 0;
    308       1.6  macallan 	sc->sc_cursor_y = 0;
    309       1.6  macallan 	sc->sc_hotspot_x = 0;
    310       1.6  macallan 	sc->sc_hotspot_y = 0;
    311       1.6  macallan 	sc->sc_video = WSDISPLAYIO_VIDEO_ON;
    312       1.6  macallan 
    313       1.1  macallan 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    314       1.1  macallan 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    315       1.1  macallan 
    316       1.1  macallan 	isconsole = fb_is_console(node);
    317       1.1  macallan 
    318       1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    319       1.1  macallan 	wsfont_init();
    320       1.1  macallan 
    321       1.1  macallan 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr, &mgx_accessops);
    322       1.1  macallan 	sc->vd.init_screen = mgx_init_screen;
    323      1.12  macallan 	sc->vd.show_screen_cookie = sc;
    324      1.12  macallan 	sc->vd.show_screen_cb = mgx_adapt;
    325       1.1  macallan 
    326       1.1  macallan 	vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, &defattr);
    327       1.1  macallan 	sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    328       1.1  macallan 
    329       1.1  macallan 	ri = &sc->sc_console_screen.scr_ri;
    330       1.1  macallan 
    331       1.1  macallan 	sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    332       1.1  macallan 	sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    333       1.1  macallan 	sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    334       1.1  macallan 	sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    335       1.1  macallan 
    336       1.2  macallan 	sc->sc_gc.gc_bitblt = mgx_bitblt;
    337       1.2  macallan 	sc->sc_gc.gc_rectfill = mgx_rectfill;
    338       1.2  macallan 	sc->sc_gc.gc_blitcookie = sc;
    339       1.2  macallan 	sc->sc_gc.gc_rop = ROP_SRC;
    340       1.2  macallan 
    341      1.10  macallan 	/*
    342      1.10  macallan 	 * leave some room between visible screen and glyph cache for upload
    343      1.10  macallan 	 * buffers used by putchar_mono()
    344      1.10  macallan 	 */
    345      1.12  macallan 	bsize = (32 * 1024 * sc->sc_stride - 1) / sc->sc_stride;
    346       1.2  macallan 	glyphcache_init(&sc->sc_gc,
    347      1.12  macallan 	    sc->sc_height + bsize,
    348      1.12  macallan 	    (0x400000 / sc->sc_stride) - (sc->sc_height + bsize),
    349       1.2  macallan 	    sc->sc_width,
    350       1.2  macallan 	    ri->ri_font->fontwidth,
    351       1.2  macallan 	    ri->ri_font->fontheight,
    352       1.2  macallan 	    defattr);
    353       1.2  macallan 
    354       1.1  macallan 	mgx_init_palette(sc);
    355       1.1  macallan 
    356       1.1  macallan 	if(isconsole) {
    357       1.2  macallan 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    358       1.2  macallan 		    defattr);
    359       1.1  macallan 		vcons_replay_msgbuf(&sc->sc_console_screen);
    360       1.1  macallan 	}
    361       1.1  macallan 
    362       1.1  macallan 	aa.console = isconsole;
    363       1.1  macallan 	aa.scrdata = &sc->sc_screenlist;
    364       1.1  macallan 	aa.accessops = &mgx_accessops;
    365       1.1  macallan 	aa.accesscookie = &sc->vd;
    366       1.1  macallan 
    367       1.1  macallan 	config_found(self, &aa, wsemuldisplaydevprint);
    368       1.1  macallan 
    369       1.9  macallan 	/* now the Sun fb goop */
    370       1.9  macallan 	fb->fb_driver = &mgx_fbdriver;
    371       1.9  macallan 	fb->fb_device = sc->sc_dev;
    372       1.9  macallan 	fb->fb_flags = device_cfdata(sc->sc_dev)->cf_flags & FB_USERMASK;
    373       1.9  macallan 	fb->fb_type.fb_type = FBTYPE_MGX;
    374       1.9  macallan 	fb->fb_pixels = NULL;
    375       1.9  macallan 
    376       1.9  macallan 	fb->fb_type.fb_depth = 32;
    377       1.9  macallan 	fb->fb_type.fb_width = sc->sc_width;
    378       1.9  macallan 	fb->fb_type.fb_height = sc->sc_height;
    379       1.9  macallan 	fb->fb_linebytes = sc->sc_stride * 4;
    380       1.9  macallan 
    381       1.9  macallan 	fb->fb_type.fb_cmsize = 256;
    382       1.9  macallan 	fb->fb_type.fb_size = sc->sc_fbsize;
    383       1.9  macallan 	fb_attach(&sc->sc_fb, isconsole);
    384       1.2  macallan }
    385       1.2  macallan 
    386       1.1  macallan static void
    387       1.1  macallan mgx_write_dac(struct mgx_softc *sc, int idx, int r, int g, int b)
    388       1.1  macallan {
    389       1.1  macallan 	mgx_write_vga(sc, VGA_BASE + VGA_DAC_ADDRW, idx);
    390       1.1  macallan 	mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, r);
    391       1.1  macallan 	mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, g);
    392       1.1  macallan 	mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, b);
    393       1.1  macallan }
    394       1.1  macallan 
    395       1.1  macallan static void
    396       1.1  macallan mgx_init_palette(struct mgx_softc *sc)
    397       1.1  macallan {
    398       1.1  macallan 	struct rasops_info *ri = &sc->sc_console_screen.scr_ri;
    399       1.1  macallan 	int i, j = 0;
    400       1.1  macallan 	uint8_t cmap[768];
    401       1.1  macallan 
    402       1.5  macallan 	if (sc->sc_depth == 8) {
    403       1.5  macallan 		rasops_get_cmap(ri, cmap, sizeof(cmap));
    404       1.5  macallan 		for (i = 0; i < 256; i++) {
    405       1.5  macallan 			sc->sc_cmap_red[i] = cmap[j];
    406       1.5  macallan 			sc->sc_cmap_green[i] = cmap[j + 1];
    407       1.5  macallan 			sc->sc_cmap_blue[i] = cmap[j + 2];
    408       1.5  macallan 			mgx_write_dac(sc, i, cmap[j], cmap[j + 1], cmap[j + 2]);
    409       1.5  macallan 			j += 3;
    410       1.5  macallan 		}
    411       1.5  macallan 	} else {
    412       1.5  macallan 		/* linear ramp for true colour modes */
    413       1.5  macallan 		for (i = 0; i < 256; i++) {
    414       1.5  macallan 			mgx_write_dac(sc, i, i, i, i);
    415       1.5  macallan 		}
    416       1.1  macallan 	}
    417       1.1  macallan }
    418       1.1  macallan 
    419       1.2  macallan static int
    420       1.4  macallan mgx_putcmap(struct mgx_softc *sc, struct wsdisplay_cmap *cm)
    421       1.4  macallan {
    422       1.4  macallan 	u_char *r, *g, *b;
    423       1.4  macallan 	u_int index = cm->index;
    424       1.4  macallan 	u_int count = cm->count;
    425       1.4  macallan 	int i, error;
    426       1.4  macallan 	u_char rbuf[256], gbuf[256], bbuf[256];
    427       1.4  macallan 
    428       1.4  macallan 	if (cm->index >= 256 || cm->count > 256 ||
    429       1.4  macallan 	    (cm->index + cm->count) > 256)
    430       1.4  macallan 		return EINVAL;
    431       1.4  macallan 	error = copyin(cm->red, &rbuf[index], count);
    432       1.4  macallan 	if (error)
    433       1.4  macallan 		return error;
    434       1.4  macallan 	error = copyin(cm->green, &gbuf[index], count);
    435       1.4  macallan 	if (error)
    436       1.4  macallan 		return error;
    437       1.4  macallan 	error = copyin(cm->blue, &bbuf[index], count);
    438       1.4  macallan 	if (error)
    439       1.4  macallan 		return error;
    440       1.4  macallan 
    441       1.4  macallan 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    442       1.4  macallan 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    443       1.4  macallan 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    444       1.4  macallan 
    445       1.4  macallan 	r = &sc->sc_cmap_red[index];
    446       1.4  macallan 	g = &sc->sc_cmap_green[index];
    447       1.4  macallan 	b = &sc->sc_cmap_blue[index];
    448       1.4  macallan 
    449       1.4  macallan 	for (i = 0; i < count; i++) {
    450       1.4  macallan 		mgx_write_dac(sc, index, *r, *g, *b);
    451       1.4  macallan 		index++;
    452       1.4  macallan 		r++, g++, b++;
    453       1.4  macallan 	}
    454       1.4  macallan 	return 0;
    455       1.4  macallan }
    456       1.4  macallan 
    457       1.4  macallan static int
    458       1.4  macallan mgx_getcmap(struct mgx_softc *sc, struct wsdisplay_cmap *cm)
    459       1.4  macallan {
    460       1.4  macallan 	u_int index = cm->index;
    461       1.4  macallan 	u_int count = cm->count;
    462       1.4  macallan 	int error;
    463       1.4  macallan 
    464       1.4  macallan 	if (index >= 255 || count > 256 || index + count > 256)
    465       1.4  macallan 		return EINVAL;
    466       1.4  macallan 
    467       1.4  macallan 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    468       1.4  macallan 	if (error)
    469       1.4  macallan 		return error;
    470       1.4  macallan 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    471       1.4  macallan 	if (error)
    472       1.4  macallan 		return error;
    473       1.4  macallan 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    474       1.4  macallan 	if (error)
    475       1.4  macallan 		return error;
    476       1.4  macallan 
    477       1.4  macallan 	return 0;
    478       1.4  macallan }
    479       1.4  macallan 
    480       1.4  macallan static int
    481       1.2  macallan mgx_wait_engine(struct mgx_softc *sc)
    482       1.2  macallan {
    483       1.2  macallan 	unsigned int i;
    484       1.2  macallan 	uint8_t stat;
    485       1.2  macallan 
    486       1.2  macallan 	for (i = 100000; i != 0; i--) {
    487       1.2  macallan 		stat = mgx_read_1(sc, ATR_BLT_STATUS);
    488       1.2  macallan 		if ((stat & (BLT_HOST_BUSY | BLT_ENGINE_BUSY)) == 0)
    489       1.2  macallan 			break;
    490       1.2  macallan 	}
    491       1.2  macallan 
    492       1.2  macallan 	return i;
    493       1.2  macallan }
    494       1.2  macallan 
    495       1.5  macallan static inline int
    496       1.5  macallan mgx_wait_host(struct mgx_softc *sc)
    497       1.5  macallan {
    498       1.5  macallan 	unsigned int i;
    499       1.5  macallan 	uint8_t stat;
    500       1.5  macallan 
    501       1.5  macallan 	for (i = 10000; i != 0; i--) {
    502       1.5  macallan 		stat = mgx_read_1(sc, ATR_BLT_STATUS);
    503       1.5  macallan 		if ((stat & BLT_HOST_BUSY) == 0)
    504       1.5  macallan 			break;
    505       1.5  macallan 	}
    506       1.5  macallan 
    507       1.5  macallan 	return i;
    508       1.5  macallan }
    509       1.5  macallan 
    510      1.12  macallan /*static inline*/ int
    511       1.2  macallan mgx_wait_fifo(struct mgx_softc *sc, unsigned int nfifo)
    512       1.2  macallan {
    513       1.2  macallan 	unsigned int i;
    514       1.2  macallan 	uint8_t stat;
    515       1.2  macallan 
    516       1.2  macallan 	for (i = 100000; i != 0; i--) {
    517       1.2  macallan 		stat = mgx_read_1(sc, ATR_FIFO_STATUS);
    518       1.2  macallan 		stat = (stat & FIFO_MASK) >> FIFO_SHIFT;
    519       1.2  macallan 		if (stat >= nfifo)
    520       1.2  macallan 			break;
    521       1.2  macallan 		mgx_write_1(sc, ATR_FIFO_STATUS, 0);
    522       1.2  macallan 	}
    523       1.2  macallan 
    524       1.2  macallan 	return i;
    525       1.2  macallan }
    526       1.2  macallan 
    527       1.1  macallan static void
    528       1.1  macallan mgx_setup(struct mgx_softc *sc, int depth)
    529       1.1  macallan {
    530       1.5  macallan 	uint32_t stride;
    531       1.5  macallan 	int i;
    532       1.5  macallan 	uint8_t reg;
    533       1.5  macallan 
    534       1.2  macallan 	/* wait for everything to go idle */
    535       1.2  macallan 	if (mgx_wait_engine(sc) == 0)
    536       1.2  macallan 		return;
    537       1.2  macallan 	if (mgx_wait_fifo(sc, FIFO_AT24) == 0)
    538       1.2  macallan 		return;
    539       1.5  macallan 
    540      1.10  macallan 	sc->sc_buf = 0;
    541       1.5  macallan 	/* read name from sequencer */
    542       1.5  macallan 	for (i = 0; i < 8; i++) {
    543       1.5  macallan 		mgx_write_vga(sc, SEQ_INDEX, i + 0x11);
    544       1.5  macallan 		sc->sc_name[i] = mgx_read_vga(sc, SEQ_DATA);
    545       1.5  macallan 	}
    546       1.5  macallan 	sc->sc_name[7] = 0;
    547       1.5  macallan 
    548       1.5  macallan 	reg = mgx_read_1(sc, ATR_PIXEL);
    549       1.5  macallan 	reg &= ~PIXEL_DEPTH_MASK;
    550       1.2  macallan 
    551       1.2  macallan 	switch (depth) {
    552       1.2  macallan 		case 8:
    553       1.2  macallan 			sc->sc_dec = DEC_DEPTH_8 << DEC_DEPTH_SHIFT;
    554       1.5  macallan 			reg |= PIXEL_8;
    555       1.2  macallan 			break;
    556       1.2  macallan 		case 15:
    557       1.5  macallan 			sc->sc_dec = DEC_DEPTH_16 << DEC_DEPTH_SHIFT;
    558       1.5  macallan 			reg |= PIXEL_15;
    559       1.5  macallan 			break;
    560       1.2  macallan 		case 16:
    561       1.2  macallan 			sc->sc_dec = DEC_DEPTH_16 << DEC_DEPTH_SHIFT;
    562       1.5  macallan 			reg |= PIXEL_16;
    563       1.2  macallan 			break;
    564       1.2  macallan 		case 32:
    565       1.2  macallan 			sc->sc_dec = DEC_DEPTH_32 << DEC_DEPTH_SHIFT;
    566       1.5  macallan 			reg |= PIXEL_32;
    567       1.2  macallan 			break;
    568       1.2  macallan 		default:
    569       1.2  macallan 			return; /* not supported */
    570       1.2  macallan 	}
    571       1.2  macallan 
    572       1.5  macallan 	/* the chip wants stride in units of 8 bytes */
    573       1.5  macallan 	sc->sc_stride = sc->sc_width * (depth >> 3);
    574       1.5  macallan 	stride = sc->sc_stride >> 3;
    575       1.5  macallan #ifdef MGX_DEBUG
    576      1.12  macallan 	sc->sc_height -= 150;
    577       1.5  macallan #endif
    578       1.5  macallan 
    579       1.5  macallan 	sc->sc_depth = depth;
    580       1.5  macallan 
    581       1.5  macallan 	switch (sc->sc_width) {
    582       1.2  macallan 		case 640:
    583       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_640 << DEC_WIDTH_SHIFT;
    584       1.2  macallan 			break;
    585       1.2  macallan 		case 800:
    586       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_800 << DEC_WIDTH_SHIFT;
    587       1.2  macallan 			break;
    588       1.2  macallan 		case 1024:
    589       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_1024 << DEC_WIDTH_SHIFT;
    590       1.2  macallan 			break;
    591       1.2  macallan 		case 1152:
    592       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_1152 << DEC_WIDTH_SHIFT;
    593       1.2  macallan 			break;
    594       1.2  macallan 		case 1280:
    595       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_1280 << DEC_WIDTH_SHIFT;
    596       1.2  macallan 			break;
    597       1.2  macallan 		case 1600:
    598       1.2  macallan 			sc->sc_dec |= DEC_WIDTH_1600 << DEC_WIDTH_SHIFT;
    599       1.2  macallan 			break;
    600       1.2  macallan 		default:
    601       1.2  macallan 			return; /* not supported */
    602       1.2  macallan 	}
    603      1.10  macallan 	mgx_wait_fifo(sc, 4);
    604       1.2  macallan 	mgx_write_1(sc, ATR_CLIP_CONTROL, 0);
    605       1.2  macallan 	mgx_write_1(sc, ATR_BYTEMASK, 0xff);
    606       1.5  macallan 	mgx_write_1(sc, ATR_PIXEL, reg);
    607      1.10  macallan 	mgx_write_4(sc, ATR_OFFSET, 0);
    608      1.10  macallan 	mgx_wait_fifo(sc, 4);
    609       1.5  macallan 	mgx_write_vga(sc, CRTC_INDEX, 0x13);
    610       1.5  macallan 	mgx_write_vga(sc, CRTC_DATA, stride & 0xff);
    611       1.5  macallan 	mgx_write_vga(sc, CRTC_INDEX, 0x1c);
    612       1.5  macallan 	mgx_write_vga(sc, CRTC_DATA, (stride & 0xf00) >> 4);
    613       1.6  macallan 
    614       1.6  macallan 	/* clean up the screen if we're switching to != 8bit */
    615       1.6  macallan 	if (depth != MGX_DEPTH)
    616       1.6  macallan 		mgx_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height, 0);
    617       1.6  macallan 
    618      1.10  macallan 	mgx_wait_fifo(sc, 4);
    619       1.6  macallan 	/* initialize hardware cursor stuff */
    620       1.6  macallan 	mgx_write_2(sc, ATR_CURSOR_ADDRESS, (sc->sc_fbsize - 1024) >> 10);
    621       1.6  macallan 	mgx_write_1(sc, ATR_CURSOR_ENABLE, 0);
    622       1.6  macallan 	sc->sc_cursor = (uint8_t *)sc->sc_fbaddr + sc->sc_fbsize - 1024;
    623       1.6  macallan 	memset(sc->sc_cursor, 0xf0, 1024);
    624      1.12  macallan 	memset(sc->sc_in, 0, sizeof(sc->sc_in));
    625       1.2  macallan }
    626       1.2  macallan 
    627       1.2  macallan static void
    628       1.2  macallan mgx_bitblt(void *cookie, int xs, int ys, int xd, int yd, int wi, int he,
    629       1.2  macallan              int rop)
    630       1.2  macallan {
    631       1.2  macallan 	struct mgx_softc *sc = cookie;
    632       1.2  macallan 	uint32_t dec = sc->sc_dec;
    633       1.2  macallan 
    634       1.2  macallan         dec |= (DEC_COMMAND_BLT << DEC_COMMAND_SHIFT) |
    635       1.2  macallan 	       (DEC_START_DIMX << DEC_START_SHIFT);
    636       1.2  macallan 	if (xs < xd) {
    637       1.2  macallan 		xs += wi - 1;
    638       1.2  macallan 		xd += wi - 1;
    639       1.2  macallan 		dec |= DEC_DIR_X_REVERSE;
    640       1.2  macallan 	}
    641       1.2  macallan 	if (ys < yd) {
    642       1.2  macallan 		ys += he - 1;
    643       1.2  macallan 		yd += he - 1;
    644       1.2  macallan 		dec |= DEC_DIR_Y_REVERSE;
    645       1.2  macallan 	}
    646       1.2  macallan 	mgx_wait_fifo(sc, 5);
    647       1.2  macallan 	mgx_write_1(sc, ATR_ROP, rop);
    648       1.2  macallan 	mgx_write_4(sc, ATR_DEC, dec);
    649       1.2  macallan 	mgx_write_4(sc, ATR_SRC_XY, (ys << 16) | xs);
    650       1.2  macallan 	mgx_write_4(sc, ATR_DST_XY, (yd << 16) | xd);
    651       1.2  macallan 	mgx_write_4(sc, ATR_WH, (he << 16) | wi);
    652       1.2  macallan }
    653       1.2  macallan 
    654       1.2  macallan static void
    655       1.2  macallan mgx_rectfill(void *cookie, int x, int y, int wi, int he, long fg)
    656       1.2  macallan {
    657       1.2  macallan 	struct mgx_softc *sc = cookie;
    658       1.2  macallan 	struct vcons_screen *scr = sc->vd.active;
    659       1.2  macallan 	uint32_t dec = sc->sc_dec;
    660       1.2  macallan 	uint32_t col;
    661       1.2  macallan 
    662       1.2  macallan 	if (scr == NULL)
    663       1.2  macallan 		return;
    664       1.2  macallan 	col = scr->scr_ri.ri_devcmap[fg];
    665       1.2  macallan 
    666       1.2  macallan 	dec = sc->sc_dec;
    667       1.2  macallan 	dec |= (DEC_COMMAND_RECT << DEC_COMMAND_SHIFT) |
    668       1.2  macallan 	       (DEC_START_DIMX << DEC_START_SHIFT);
    669       1.2  macallan 	mgx_wait_fifo(sc, 5);
    670       1.2  macallan 	mgx_write_1(sc, ATR_ROP, ROP_SRC);
    671       1.2  macallan 	mgx_write_4(sc, ATR_FG, col);
    672       1.2  macallan 	mgx_write_4(sc, ATR_DEC, dec);
    673       1.2  macallan 	mgx_write_4(sc, ATR_DST_XY, (y << 16) | x);
    674       1.2  macallan 	mgx_write_4(sc, ATR_WH, (he << 16) | wi);
    675       1.2  macallan }
    676       1.2  macallan 
    677       1.2  macallan static void
    678      1.10  macallan mgx_putchar_aa(void *cookie, int row, int col, u_int c, long attr)
    679       1.2  macallan {
    680       1.2  macallan 	struct rasops_info *ri = cookie;
    681       1.2  macallan 	struct wsdisplay_font *font = PICK_FONT(ri, c);
    682       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    683       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    684       1.2  macallan 	uint32_t fg, bg;
    685       1.2  macallan 	int x, y, wi, he, rv;
    686       1.2  macallan 
    687       1.2  macallan 	wi = font->fontwidth;
    688       1.2  macallan 	he = font->fontheight;
    689       1.2  macallan 
    690       1.2  macallan 	bg = (attr >> 16) & 0xf;
    691       1.2  macallan 	fg = (attr >> 24) & 0xf;
    692       1.2  macallan 
    693       1.2  macallan 	x = ri->ri_xorigin + col * wi;
    694       1.2  macallan 	y = ri->ri_yorigin + row * he;
    695       1.2  macallan 
    696       1.2  macallan 	if (c == 0x20) {
    697       1.2  macallan 		mgx_rectfill(sc, x, y, wi, he, bg);
    698       1.2  macallan 		if (attr & 1)
    699       1.2  macallan 			mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
    700       1.2  macallan 		return;
    701       1.2  macallan 	}
    702      1.10  macallan 
    703       1.2  macallan 	rv = glyphcache_try(&sc->sc_gc, c, x, y, attr);
    704       1.3  macallan 	if (rv != GC_OK) {
    705       1.3  macallan 		volatile uint32_t junk;
    706       1.2  macallan 
    707       1.3  macallan 		mgx_wait_engine(sc);
    708       1.3  macallan 		sc->sc_putchar(cookie, row, col, c, attr & ~1);
    709       1.5  macallan 		if (rv == GC_ADD) {
    710       1.8  macallan 			/*
    711       1.8  macallan 			 * try to make sure the glyph made it all the way to
    712       1.8  macallan 			 * video memory before trying to blit it into the cache
    713       1.8  macallan 			 */
    714       1.5  macallan 			junk = *(uint32_t *)sc->sc_fbaddr;
    715       1.5  macallan 			__USE(junk);
    716       1.3  macallan 			glyphcache_add(&sc->sc_gc, c, x, y);
    717       1.5  macallan 		}
    718       1.2  macallan 	}
    719       1.3  macallan 	if (attr & 1)
    720       1.3  macallan 		mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
    721       1.2  macallan }
    722       1.2  macallan 
    723       1.2  macallan static void
    724      1.10  macallan mgx_putchar_mono(void *cookie, int row, int col, u_int c, long attr)
    725      1.10  macallan {
    726      1.10  macallan 	struct rasops_info *ri = cookie;
    727      1.10  macallan 	struct wsdisplay_font *font = PICK_FONT(ri, c);
    728      1.10  macallan 	struct vcons_screen *scr = ri->ri_hw;
    729      1.10  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    730      1.12  macallan 	uint8_t *s, *d;
    731      1.12  macallan 	uint32_t fg, bg, scratch = ((sc->sc_stride * sc->sc_height) + 7) & ~7;
    732      1.12  macallan 	int x, y, wi, he, len, i;
    733      1.10  macallan 
    734      1.10  macallan 	wi = font->fontwidth;
    735      1.10  macallan 	he = font->fontheight;
    736      1.10  macallan 
    737      1.10  macallan 	bg = (attr >> 16) & 0xf;
    738      1.10  macallan 	fg = (attr >> 24) & 0xf;
    739      1.10  macallan 
    740      1.10  macallan 	x = ri->ri_xorigin + col * wi;
    741      1.10  macallan 	y = ri->ri_yorigin + row * he;
    742      1.10  macallan 
    743      1.12  macallan 	if (!CHAR_IN_FONT(c, font)) {
    744      1.12  macallan 		c = 0x20;
    745      1.12  macallan #ifdef MGX_DEBUG
    746      1.12  macallan 		bg = WSCOL_LIGHT_BLUE;
    747      1.12  macallan #endif
    748      1.12  macallan 	}
    749      1.10  macallan 	if (c == 0x20) {
    750      1.10  macallan 		mgx_rectfill(sc, x, y, wi, he, bg);
    751      1.10  macallan 		if (attr & 1)
    752      1.10  macallan 			mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
    753      1.10  macallan 		return;
    754      1.10  macallan 	}
    755      1.10  macallan 
    756      1.12  macallan 	mgx_wait_fifo(sc, 3);
    757      1.12  macallan 	mgx_write_4(sc, ATR_FG, ri->ri_devcmap[fg]);
    758      1.12  macallan 	mgx_write_4(sc, ATR_BG, ri->ri_devcmap[bg]);
    759      1.12  macallan 	mgx_write_1(sc, ATR_ROP, ROP_SRC);
    760      1.12  macallan 
    761      1.10  macallan 	/*
    762      1.10  macallan 	 * do hardware colour expansion
    763      1.12  macallan 	 * there has to be an upload port somewhere, since there are host blit
    764      1.10  macallan 	 * commands, but it's not used or mentioned in the xf86-video-apm driver
    765      1.10  macallan 	 * so for now we use the vram-to-vram blits to draw characters.
    766      1.12  macallan 	 * stash most of the font in vram for speed, also:
    767      1.12  macallan 	 * - the sbus-pci bridge doesn't seem to support 64bit accesses,
    768      1.12  macallan 	 *   they will cause occasional data corruption and all sorts of weird
    769      1.12  macallan 	 *   side effects, so copy font bitmaps byte-wise
    770      1.12  macallan 	 * - at least it doesn't seem to need any kind of buffer flushing
    771      1.12  macallan 	 * - still use rotation buffers for characters that don't fall into the
    772      1.12  macallan 	 *   8 bit range
    773      1.10  macallan 	 */
    774      1.12  macallan 
    775      1.12  macallan 	len = (ri->ri_fontscale + 7) & ~7;
    776      1.10  macallan 	s = WSFONT_GLYPH(c, font);
    777      1.12  macallan 	if ((c > 32) && (c < 256)) {
    778      1.12  macallan 		scratch += len * c;
    779      1.12  macallan 		if (sc->sc_in[c] == 0) {
    780      1.12  macallan 			d = (uint8_t *)sc->sc_fbaddr + scratch;
    781      1.12  macallan 			for (i = 0; i < ri->ri_fontscale; i++)
    782      1.12  macallan 				d[i] = s[i];
    783      1.12  macallan 			sc->sc_in[c] = 1;
    784      1.12  macallan 		}
    785      1.12  macallan 	} else {
    786      1.12  macallan 		sc->sc_buf = (sc->sc_buf + 1) & 7; /* rotate through 8 buffers */
    787      1.12  macallan 		scratch += sc->sc_buf * len;
    788      1.12  macallan 		d = (uint8_t *)sc->sc_fbaddr + scratch;
    789      1.12  macallan 		for (i = 0; i < ri->ri_fontscale; i++)
    790      1.12  macallan 			d[i] = s[i];
    791      1.12  macallan 	}
    792      1.10  macallan 	mgx_wait_fifo(sc, 5);
    793      1.10  macallan 	mgx_write_4(sc, ATR_DEC, sc->sc_dec | (DEC_COMMAND_BLT << DEC_COMMAND_SHIFT) |
    794      1.10  macallan 	       (DEC_START_DIMX << DEC_START_SHIFT) |
    795      1.10  macallan 	       DEC_SRC_LINEAR | DEC_SRC_CONTIGUOUS | DEC_MONOCHROME);
    796      1.10  macallan 	mgx_write_4(sc, ATR_SRC_XY, ((scratch & 0xfff000) << 4) | (scratch & 0xfff));
    797      1.10  macallan 	mgx_write_4(sc, ATR_DST_XY, (y << 16) | x);
    798      1.10  macallan 	mgx_write_4(sc, ATR_WH, (he << 16) | wi);
    799      1.10  macallan 
    800      1.10  macallan 	if (attr & 1)
    801      1.10  macallan 		mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
    802      1.10  macallan }
    803      1.10  macallan 
    804      1.10  macallan static void
    805       1.2  macallan mgx_cursor(void *cookie, int on, int row, int col)
    806       1.2  macallan {
    807       1.2  macallan 	struct rasops_info *ri = cookie;
    808       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    809       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    810       1.2  macallan 	int x, y, wi,he;
    811       1.2  macallan 
    812       1.2  macallan 	wi = ri->ri_font->fontwidth;
    813       1.2  macallan 	he = ri->ri_font->fontheight;
    814       1.2  macallan 
    815       1.2  macallan 	if (ri->ri_flg & RI_CURSOR) {
    816       1.2  macallan 		x = ri->ri_ccol * wi + ri->ri_xorigin;
    817       1.2  macallan 		y = ri->ri_crow * he + ri->ri_yorigin;
    818       1.2  macallan 		mgx_bitblt(sc, x, y, x, y, wi, he, ROP_INV);
    819       1.2  macallan 		ri->ri_flg &= ~RI_CURSOR;
    820       1.2  macallan 	}
    821       1.2  macallan 
    822       1.2  macallan 	ri->ri_crow = row;
    823       1.2  macallan 	ri->ri_ccol = col;
    824       1.2  macallan 
    825       1.2  macallan 	if (on)
    826       1.2  macallan 	{
    827       1.2  macallan 		x = ri->ri_ccol * wi + ri->ri_xorigin;
    828       1.2  macallan 		y = ri->ri_crow * he + ri->ri_yorigin;
    829       1.2  macallan 		mgx_bitblt(sc, x, y, x, y, wi, he, ROP_INV);
    830       1.2  macallan 		ri->ri_flg |= RI_CURSOR;
    831       1.2  macallan 	}
    832       1.2  macallan }
    833       1.2  macallan 
    834       1.2  macallan static void
    835       1.2  macallan mgx_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
    836       1.2  macallan {
    837       1.2  macallan 	struct rasops_info *ri = cookie;
    838       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    839       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    840       1.2  macallan 	int32_t xs, xd, y, width, height;
    841       1.2  macallan 
    842       1.2  macallan 	xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
    843       1.2  macallan 	xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
    844       1.2  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    845       1.2  macallan 	width = ri->ri_font->fontwidth * ncols;
    846       1.2  macallan 	height = ri->ri_font->fontheight;
    847       1.2  macallan 	mgx_bitblt(sc, xs, y, xd, y, width, height, ROP_SRC);
    848       1.2  macallan }
    849       1.2  macallan 
    850       1.2  macallan static void
    851       1.2  macallan mgx_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
    852       1.2  macallan {
    853       1.2  macallan 	struct rasops_info *ri = cookie;
    854       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    855       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    856       1.2  macallan 	int32_t x, y, width, height, bg;
    857       1.2  macallan 
    858       1.2  macallan 	x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
    859       1.2  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    860       1.2  macallan 	width = ri->ri_font->fontwidth * ncols;
    861       1.2  macallan 	height = ri->ri_font->fontheight;
    862       1.2  macallan 	bg = (fillattr >> 16) & 0xff;
    863       1.2  macallan 	mgx_rectfill(sc, x, y, width, height, bg);
    864       1.2  macallan }
    865       1.2  macallan 
    866       1.2  macallan static void
    867       1.2  macallan mgx_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
    868       1.2  macallan {
    869       1.2  macallan 	struct rasops_info *ri = cookie;
    870       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    871       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    872       1.2  macallan 	int32_t x, ys, yd, width, height;
    873       1.2  macallan 
    874       1.2  macallan 	x = ri->ri_xorigin;
    875       1.2  macallan 	ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
    876       1.2  macallan 	yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
    877       1.2  macallan 	width = ri->ri_emuwidth;
    878       1.2  macallan 	height = ri->ri_font->fontheight * nrows;
    879       1.2  macallan 	mgx_bitblt(sc, x, ys, x, yd, width, height, ROP_SRC);
    880       1.2  macallan }
    881       1.2  macallan 
    882       1.2  macallan static void
    883       1.2  macallan mgx_eraserows(void *cookie, int row, int nrows, long fillattr)
    884       1.2  macallan {
    885       1.2  macallan 	struct rasops_info *ri = cookie;
    886       1.2  macallan 	struct vcons_screen *scr = ri->ri_hw;
    887       1.2  macallan 	struct mgx_softc *sc = scr->scr_cookie;
    888       1.2  macallan 	int32_t x, y, width, height, bg;
    889       1.2  macallan 
    890       1.2  macallan 	if ((row == 0) && (nrows == ri->ri_rows)) {
    891       1.2  macallan 		x = y = 0;
    892       1.2  macallan 		width = ri->ri_width;
    893       1.2  macallan 		height = ri->ri_height;
    894       1.2  macallan 	} else {
    895       1.2  macallan 		x = ri->ri_xorigin;
    896       1.2  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    897       1.2  macallan 		width = ri->ri_emuwidth;
    898       1.2  macallan 		height = ri->ri_font->fontheight * nrows;
    899       1.2  macallan 	}
    900       1.2  macallan 	bg = (fillattr >> 16) & 0xff;
    901       1.2  macallan 	mgx_rectfill(sc, x, y, width, height, bg);
    902       1.1  macallan }
    903       1.1  macallan 
    904       1.1  macallan static void
    905      1.12  macallan mgx_adapt(struct vcons_screen *scr, void *cookie)
    906      1.12  macallan {
    907      1.12  macallan 	struct mgx_softc *sc = cookie;
    908      1.12  macallan 	memset(sc->sc_in, 0, sizeof(sc->sc_in));
    909      1.12  macallan 	glyphcache_adapt(scr, &sc->sc_gc);
    910      1.12  macallan }
    911      1.12  macallan 
    912      1.12  macallan static void
    913       1.1  macallan mgx_init_screen(void *cookie, struct vcons_screen *scr,
    914       1.1  macallan     int existing, long *defattr)
    915       1.1  macallan {
    916       1.1  macallan 	struct mgx_softc *sc = cookie;
    917       1.1  macallan 	struct rasops_info *ri = &scr->scr_ri;
    918       1.1  macallan 
    919       1.5  macallan 	ri->ri_depth = sc->sc_depth;
    920       1.1  macallan 	ri->ri_width = sc->sc_width;
    921       1.1  macallan 	ri->ri_height = sc->sc_height;
    922       1.1  macallan 	ri->ri_stride = sc->sc_stride;
    923       1.3  macallan 	ri->ri_flg = RI_CENTER | RI_ENABLE_ALPHA;
    924       1.1  macallan 
    925       1.1  macallan 	if (ri->ri_depth == 8)
    926       1.3  macallan 		ri->ri_flg |= RI_8BIT_IS_RGB;
    927       1.1  macallan 
    928       1.5  macallan #ifdef MGX_NOACCEL
    929       1.5  macallan 	scr->scr_flags |= VCONS_DONT_READ;
    930       1.5  macallan #endif
    931      1.10  macallan 	scr->scr_flags |= VCONS_LOADFONT;
    932       1.5  macallan 
    933       1.5  macallan 	ri->ri_rnum = 8;
    934       1.5  macallan 	ri->ri_rpos = 0;
    935       1.5  macallan 	ri->ri_gnum = 8;
    936       1.5  macallan 	ri->ri_gpos = 8;
    937       1.5  macallan 	ri->ri_bnum = 8;
    938       1.5  macallan 	ri->ri_bpos = 16;
    939       1.5  macallan 
    940       1.1  macallan 	ri->ri_bits = sc->sc_fbaddr;
    941       1.1  macallan 
    942       1.1  macallan 	rasops_init(ri, 0, 0);
    943       1.1  macallan 
    944  1.12.4.1  pgoyette 	ri->ri_caps = WSSCREEN_REVERSE | WSSCREEN_WSCOLORS |
    945  1.12.4.1  pgoyette 		      WSSCREEN_UNDERLINE | WSSCREEN_RESIZE;
    946       1.1  macallan 
    947       1.1  macallan 	rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight,
    948       1.1  macallan 		    ri->ri_width / ri->ri_font->fontwidth);
    949       1.2  macallan 
    950       1.2  macallan 	ri->ri_hw = scr;
    951      1.12  macallan 
    952       1.5  macallan #ifdef MGX_NOACCEL
    953       1.5  macallan if (0)
    954       1.5  macallan #endif
    955       1.5  macallan 	{
    956      1.10  macallan 		if (FONT_IS_ALPHA(ri->ri_font)) {
    957      1.10  macallan 			sc->sc_putchar = ri->ri_ops.putchar;
    958      1.10  macallan 			ri->ri_ops.putchar   = mgx_putchar_aa;
    959      1.10  macallan 		} else {
    960      1.10  macallan 			ri->ri_ops.putchar   = mgx_putchar_mono;
    961      1.10  macallan 		}
    962       1.5  macallan 		ri->ri_ops.cursor    = mgx_cursor;
    963       1.5  macallan 		ri->ri_ops.copyrows  = mgx_copyrows;
    964       1.5  macallan 		ri->ri_ops.eraserows = mgx_eraserows;
    965       1.5  macallan 		ri->ri_ops.copycols  = mgx_copycols;
    966       1.5  macallan 		ri->ri_ops.erasecols = mgx_erasecols;
    967       1.5  macallan 	}
    968       1.1  macallan }
    969       1.1  macallan 
    970       1.1  macallan static int
    971       1.1  macallan mgx_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    972       1.1  macallan     struct lwp *l)
    973       1.1  macallan {
    974       1.1  macallan 	struct vcons_data *vd = v;
    975       1.1  macallan 	struct mgx_softc *sc = vd->cookie;
    976       1.1  macallan 	struct wsdisplay_fbinfo *wdf;
    977       1.1  macallan 	struct vcons_screen *ms = vd->active;
    978       1.1  macallan 
    979       1.1  macallan 	switch (cmd) {
    980       1.1  macallan 		case WSDISPLAYIO_GTYPE:
    981       1.1  macallan 			*(u_int *)data = WSDISPLAY_TYPE_MGX;
    982       1.1  macallan 			return 0;
    983       1.1  macallan 
    984       1.1  macallan 		case WSDISPLAYIO_GINFO:
    985       1.1  macallan 			wdf = (void *)data;
    986       1.1  macallan 			wdf->height = sc->sc_height;
    987       1.1  macallan 			wdf->width = sc->sc_width;
    988       1.1  macallan 			wdf->depth = 8;
    989       1.1  macallan 			wdf->cmsize = 256;
    990       1.1  macallan 			return 0;
    991       1.1  macallan 
    992       1.9  macallan 	case FBIOGTYPE:
    993       1.9  macallan 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    994       1.9  macallan 		break;
    995       1.9  macallan 
    996       1.9  macallan 	case FBIOGATTR:
    997       1.9  macallan #define fba ((struct fbgattr *)data)
    998       1.9  macallan 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    999       1.9  macallan 		fba->owner = 0;		/* XXX ??? */
   1000       1.9  macallan 		fba->fbtype = sc->sc_fb.fb_type;
   1001       1.9  macallan 		fba->sattr.flags = 0;
   1002       1.9  macallan 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
   1003       1.9  macallan 		fba->sattr.dev_specific[0] = -1;
   1004       1.9  macallan 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
   1005       1.9  macallan 		fba->emu_types[1] = -1;
   1006       1.9  macallan #undef fba
   1007       1.9  macallan 		break;
   1008       1.1  macallan 		case FBIOGVIDEO:
   1009       1.1  macallan 		case WSDISPLAYIO_GVIDEO:
   1010       1.6  macallan 			*(int *)data = sc->sc_video;
   1011       1.1  macallan 			return 0;
   1012       1.1  macallan 
   1013       1.1  macallan 		case WSDISPLAYIO_SVIDEO:
   1014       1.1  macallan 		case FBIOSVIDEO:
   1015       1.6  macallan 			mgx_set_video(sc, *(int *)data);
   1016       1.1  macallan 			return 0;
   1017       1.1  macallan 
   1018       1.1  macallan 		case WSDISPLAYIO_LINEBYTES:
   1019       1.1  macallan 			{
   1020       1.1  macallan 				int *ret = (int *)data;
   1021       1.1  macallan 				*ret = sc->sc_stride;
   1022       1.1  macallan 			}
   1023       1.1  macallan 			return 0;
   1024       1.1  macallan 
   1025       1.1  macallan 		case WSDISPLAYIO_SMODE:
   1026       1.1  macallan 			{
   1027       1.1  macallan 				int new_mode = *(int*)data;
   1028       1.1  macallan 				if (new_mode != sc->sc_mode)
   1029       1.1  macallan 				{
   1030       1.1  macallan 					sc->sc_mode = new_mode;
   1031       1.1  macallan 					if (new_mode == WSDISPLAYIO_MODE_EMUL)
   1032       1.1  macallan 					{
   1033       1.5  macallan 						mgx_setup(sc, MGX_DEPTH);
   1034       1.4  macallan 						glyphcache_wipe(&sc->sc_gc);
   1035       1.4  macallan 						mgx_init_palette(sc);
   1036       1.1  macallan 						vcons_redraw_screen(ms);
   1037       1.1  macallan 					} else {
   1038       1.1  macallan 						mgx_setup(sc, 32);
   1039       1.5  macallan 						mgx_init_palette(sc);
   1040       1.1  macallan 					}
   1041       1.1  macallan 				}
   1042       1.1  macallan 			}
   1043       1.4  macallan 			return 0;
   1044       1.4  macallan 
   1045       1.4  macallan 		case WSDISPLAYIO_GETCMAP:
   1046       1.4  macallan 			return mgx_getcmap(sc, (struct wsdisplay_cmap *)data);
   1047       1.4  macallan 
   1048       1.4  macallan 		case WSDISPLAYIO_PUTCMAP:
   1049       1.4  macallan 			return mgx_putcmap(sc, (struct wsdisplay_cmap *)data);
   1050       1.4  macallan 
   1051       1.6  macallan 		case WSDISPLAYIO_GCURPOS:
   1052       1.6  macallan 			{
   1053       1.6  macallan 				struct wsdisplay_curpos *cp = (void *)data;
   1054       1.6  macallan 
   1055       1.6  macallan 				cp->x = sc->sc_cursor_x;
   1056       1.6  macallan 				cp->y = sc->sc_cursor_y;
   1057       1.6  macallan 			}
   1058       1.6  macallan 			return 0;
   1059       1.6  macallan 
   1060       1.6  macallan 		case WSDISPLAYIO_SCURPOS:
   1061       1.6  macallan 			{
   1062       1.6  macallan 				struct wsdisplay_curpos *cp = (void *)data;
   1063       1.6  macallan 
   1064       1.6  macallan 				sc->sc_cursor_x = cp->x;
   1065       1.6  macallan 				sc->sc_cursor_y = cp->y;
   1066       1.6  macallan 				mgx_set_cursor(sc);
   1067       1.6  macallan 			}
   1068       1.6  macallan 			return 0;
   1069       1.6  macallan 
   1070       1.6  macallan 		case WSDISPLAYIO_GCURMAX:
   1071       1.6  macallan 			{
   1072       1.6  macallan 				struct wsdisplay_curpos *cp = (void *)data;
   1073       1.6  macallan 
   1074       1.6  macallan 				cp->x = 64;
   1075       1.6  macallan 				cp->y = 64;
   1076       1.6  macallan 			}
   1077       1.6  macallan 			return 0;
   1078       1.6  macallan 
   1079       1.6  macallan 		case WSDISPLAYIO_SCURSOR:
   1080       1.6  macallan 			{
   1081       1.6  macallan 				struct wsdisplay_cursor *cursor = (void *)data;
   1082       1.6  macallan 
   1083       1.6  macallan 				return mgx_do_cursor(sc, cursor);
   1084       1.6  macallan 			}
   1085       1.4  macallan 		case WSDISPLAYIO_GET_FBINFO:
   1086       1.4  macallan 			{
   1087       1.4  macallan 				struct wsdisplayio_fbinfo *fbi = data;
   1088       1.8  macallan 
   1089       1.6  macallan 				fbi->fbi_fbsize = sc->sc_fbsize - 1024;
   1090       1.5  macallan 				fbi->fbi_width = sc->sc_width;
   1091       1.5  macallan 				fbi->fbi_height = sc->sc_height;
   1092       1.5  macallan 				fbi->fbi_bitsperpixel = sc->sc_depth;
   1093       1.5  macallan 				fbi->fbi_stride = sc->sc_stride;
   1094       1.5  macallan 				fbi->fbi_pixeltype = WSFB_RGB;
   1095       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.red_offset = 8;
   1096       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.red_size = 8;
   1097       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.green_offset = 16;
   1098       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.green_size = 8;
   1099       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.blue_offset = 24;
   1100       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.blue_size = 8;
   1101       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.alpha_offset = 0;
   1102       1.5  macallan 				fbi->fbi_subtype.fbi_rgbmasks.alpha_size = 8;
   1103       1.5  macallan 				return 0;
   1104       1.4  macallan 			}
   1105       1.1  macallan 	}
   1106       1.1  macallan 	return EPASSTHROUGH;
   1107       1.1  macallan }
   1108       1.1  macallan 
   1109       1.1  macallan static paddr_t
   1110       1.1  macallan mgx_mmap(void *v, void *vs, off_t offset, int prot)
   1111       1.1  macallan {
   1112       1.1  macallan 	struct vcons_data *vd = v;
   1113       1.1  macallan 	struct mgx_softc *sc = vd->cookie;
   1114       1.1  macallan 
   1115       1.1  macallan 	/* regular fb mapping at 0 */
   1116       1.5  macallan 	if ((offset >= 0) && (offset < sc->sc_fbsize)) {
   1117       1.1  macallan 		return bus_space_mmap(sc->sc_tag, sc->sc_paddr,
   1118       1.1  macallan 		    offset, prot, BUS_SPACE_MAP_LINEAR);
   1119       1.1  macallan 	}
   1120       1.1  macallan 
   1121       1.8  macallan 	/*
   1122       1.8  macallan 	 * Blitter registers at 0x80000000, only in mapped mode.
   1123       1.8  macallan 	 * Restrict to root, even though I'm fairly sure the DMA engine lives
   1124       1.8  macallan 	 * elsewhere ( and isn't documented anyway )
   1125       1.8  macallan 	 */
   1126       1.8  macallan 	if (kauth_authorize_machdep(kauth_cred_get(),
   1127       1.8  macallan 	    KAUTH_MACHDEP_UNMANAGEDMEM,
   1128       1.8  macallan 	    NULL, NULL, NULL, NULL) != 0) {
   1129       1.8  macallan 		aprint_normal("%s: mmap() rejected.\n",
   1130       1.8  macallan 		    device_xname(sc->sc_dev));
   1131       1.8  macallan 		return -1;
   1132       1.8  macallan 	}
   1133       1.8  macallan 	if ((sc->sc_mode == WSDISPLAYIO_MODE_MAPPED) &&
   1134       1.8  macallan 	    (offset >= 0x80000000) && (offset < 0x80001000)) {
   1135       1.8  macallan 		return bus_space_mmap(sc->sc_tag, sc->sc_rpaddr,
   1136       1.8  macallan 		    offset, prot, BUS_SPACE_MAP_LINEAR);
   1137       1.8  macallan 	}
   1138       1.1  macallan 	return -1;
   1139       1.1  macallan }
   1140       1.6  macallan 
   1141       1.6  macallan static int
   1142       1.6  macallan mgx_do_cursor(struct mgx_softc *sc, struct wsdisplay_cursor *cur)
   1143       1.6  macallan {
   1144       1.6  macallan 	int i;
   1145       1.6  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
   1146       1.6  macallan 
   1147       1.6  macallan 		if (cur->enable) {
   1148       1.6  macallan 			mgx_set_cursor(sc);
   1149       1.6  macallan 			mgx_write_1(sc, ATR_CURSOR_ENABLE, 1);
   1150       1.6  macallan 		} else {
   1151       1.6  macallan 			mgx_write_1(sc, ATR_CURSOR_ENABLE, 0);
   1152       1.6  macallan 		}
   1153       1.6  macallan 	}
   1154       1.6  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
   1155       1.6  macallan 
   1156       1.6  macallan 		sc->sc_hotspot_x = cur->hot.x;
   1157       1.6  macallan 		sc->sc_hotspot_y = cur->hot.y;
   1158       1.6  macallan 		mgx_set_cursor(sc);
   1159       1.6  macallan 	}
   1160       1.6  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
   1161       1.6  macallan 
   1162       1.6  macallan 		sc->sc_cursor_x = cur->pos.x;
   1163       1.6  macallan 		sc->sc_cursor_y = cur->pos.y;
   1164       1.6  macallan 		mgx_set_cursor(sc);
   1165       1.6  macallan 	}
   1166       1.6  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
   1167       1.6  macallan 		int cnt = min(2, cur->cmap.count);
   1168       1.6  macallan 		uint8_t c;
   1169       1.6  macallan 		uint8_t r[2], g[2], b[2];
   1170       1.6  macallan 
   1171       1.6  macallan 		copyin(cur->cmap.red, r, cnt);
   1172       1.6  macallan 		copyin(cur->cmap.green, g, cnt);
   1173       1.6  macallan 		copyin(cur->cmap.blue, b, cnt);
   1174       1.6  macallan 
   1175       1.6  macallan 		for (i = 0; i < cnt; i++) {
   1176       1.6  macallan 			c = r[i] & 0xe0;
   1177       1.6  macallan 			c |= (g[i] & 0xe0) >> 3;
   1178       1.6  macallan 			c |= (b[i] & 0xc0) >> 6;
   1179       1.6  macallan 			mgx_write_1(sc, ATR_CURSOR_FG + i, c);
   1180       1.6  macallan 		}
   1181       1.6  macallan 	}
   1182       1.6  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {
   1183       1.6  macallan 		int j;
   1184       1.6  macallan 		uint8_t *fb = sc->sc_cursor;
   1185       1.6  macallan 		uint8_t temp;
   1186       1.6  macallan 		uint8_t im, ma, px;
   1187       1.6  macallan 
   1188       1.6  macallan 		for (i = 0; i < 512; i++) {
   1189       1.6  macallan 			temp = 0;
   1190       1.6  macallan 			copyin(&cur->image[i], &im, 1);
   1191       1.6  macallan 			copyin(&cur->mask[i], &ma, 1);
   1192       1.6  macallan 			for (j = 0; j < 4; j++) {
   1193       1.6  macallan 				temp >>= 2;
   1194       1.6  macallan 				px = (ma & 1) ? 0 : 0x80;
   1195       1.6  macallan 				if (px == 0)
   1196       1.6  macallan 					px |= (im & 1) ? 0 : 0x40;
   1197       1.6  macallan 				temp |= px;
   1198       1.6  macallan 				im >>= 1;
   1199       1.6  macallan 				ma >>= 1;
   1200       1.6  macallan 			}
   1201       1.6  macallan 			*fb = temp;
   1202       1.6  macallan 			fb++;
   1203       1.6  macallan 			temp = 0;
   1204       1.6  macallan 			for (j = 0; j < 4; j++) {
   1205       1.6  macallan 				temp >>= 2;
   1206       1.6  macallan 				px = (ma & 1) ? 0 : 0x80;
   1207       1.6  macallan 				if (px == 0)
   1208       1.6  macallan 					px |= (im & 1) ? 0 : 0x40;
   1209       1.6  macallan 				temp |= px;
   1210       1.6  macallan 				im >>= 1;
   1211       1.6  macallan 				ma >>= 1;
   1212       1.6  macallan 			}
   1213       1.6  macallan 			*fb = temp;
   1214       1.6  macallan 			fb++;
   1215       1.6  macallan 		}
   1216       1.6  macallan 	}
   1217       1.6  macallan 	return 0;
   1218       1.6  macallan }
   1219       1.6  macallan 
   1220       1.6  macallan static void
   1221       1.6  macallan mgx_set_cursor(struct mgx_softc *sc)
   1222       1.6  macallan {
   1223       1.6  macallan 	uint32_t reg;
   1224       1.6  macallan 	uint16_t hot;
   1225       1.6  macallan 
   1226       1.6  macallan 	reg = (sc->sc_cursor_y << 16) | (sc->sc_cursor_x & 0xffff);
   1227       1.6  macallan 	mgx_write_4(sc, ATR_CURSOR_POSITION, reg);
   1228       1.6  macallan 	hot = (sc->sc_hotspot_y << 8) | (sc->sc_hotspot_x & 0xff);
   1229       1.6  macallan 	mgx_write_2(sc, ATR_CURSOR_HOTSPOT, hot);
   1230       1.6  macallan }
   1231       1.6  macallan 
   1232       1.6  macallan static void
   1233       1.6  macallan mgx_set_video(struct mgx_softc *sc, int v)
   1234       1.6  macallan {
   1235       1.6  macallan 	uint8_t reg;
   1236       1.6  macallan 
   1237       1.6  macallan 	if (sc->sc_video == v)
   1238       1.6  macallan 		return;
   1239       1.6  macallan 
   1240       1.6  macallan 	sc->sc_video = v;
   1241       1.6  macallan 	reg = mgx_read_1(sc, ATR_DPMS);
   1242       1.6  macallan 
   1243       1.6  macallan 	if (v == WSDISPLAYIO_VIDEO_ON) {
   1244       1.6  macallan 		reg &= ~DPMS_SYNC_DISABLE_ALL;
   1245       1.6  macallan 	} else {
   1246       1.6  macallan 		reg |= DPMS_SYNC_DISABLE_ALL;
   1247       1.6  macallan 	}
   1248       1.6  macallan 	mgx_write_1(sc, ATR_DPMS, reg);
   1249       1.6  macallan }
   1250       1.9  macallan 
   1251       1.9  macallan /* Sun fb dev goop */
   1252       1.9  macallan static void
   1253       1.9  macallan mgx_unblank(device_t dev)
   1254       1.9  macallan {
   1255       1.9  macallan 	struct mgx_softc *sc = device_private(dev);
   1256       1.9  macallan 
   1257       1.9  macallan 	mgx_set_video(sc, WSDISPLAYIO_VIDEO_ON);
   1258       1.9  macallan }
   1259       1.9  macallan 
   1260       1.9  macallan paddr_t
   1261       1.9  macallan mgxmmap(dev_t dev, off_t offset, int prot)
   1262       1.9  macallan {
   1263       1.9  macallan 	struct mgx_softc *sc = device_lookup_private(&mgx_cd, minor(dev));
   1264       1.9  macallan 
   1265       1.9  macallan 	/* regular fb mapping at 0 */
   1266       1.9  macallan 	if ((offset >= 0) && (offset < sc->sc_fbsize)) {
   1267       1.9  macallan 		return bus_space_mmap(sc->sc_tag, sc->sc_paddr,
   1268       1.9  macallan 		    offset, prot, BUS_SPACE_MAP_LINEAR);
   1269       1.9  macallan 	}
   1270       1.9  macallan 
   1271       1.9  macallan 	/*
   1272       1.9  macallan 	 * Blitter registers at 0x80000000, only in mapped mode.
   1273       1.9  macallan 	 * Restrict to root, even though I'm fairly sure the DMA engine lives
   1274       1.9  macallan 	 * elsewhere ( and isn't documented anyway )
   1275       1.9  macallan 	 */
   1276       1.9  macallan 	if (kauth_authorize_machdep(kauth_cred_get(),
   1277       1.9  macallan 	    KAUTH_MACHDEP_UNMANAGEDMEM,
   1278       1.9  macallan 	    NULL, NULL, NULL, NULL) != 0) {
   1279       1.9  macallan 		aprint_normal("%s: mmap() rejected.\n",
   1280       1.9  macallan 		    device_xname(sc->sc_dev));
   1281       1.9  macallan 		return -1;
   1282       1.9  macallan 	}
   1283       1.9  macallan 	if ((sc->sc_mode == WSDISPLAYIO_MODE_MAPPED) &&
   1284       1.9  macallan 	    (offset >= 0x80000000) && (offset < 0x80001000)) {
   1285       1.9  macallan 		return bus_space_mmap(sc->sc_tag, sc->sc_rpaddr,
   1286       1.9  macallan 		    offset, prot, BUS_SPACE_MAP_LINEAR);
   1287       1.9  macallan 	}
   1288       1.9  macallan 	return -1;
   1289       1.9  macallan }
   1290       1.9  macallan 
   1291       1.9  macallan int
   1292       1.9  macallan mgxopen(dev_t dev, int flags, int mode, struct lwp *l)
   1293       1.9  macallan {
   1294       1.9  macallan 	device_t dv = device_lookup(&mgx_cd, minor(dev));
   1295       1.9  macallan 	struct mgx_softc *sc = device_private(dv);
   1296       1.9  macallan 
   1297       1.9  macallan 	if (dv == NULL)
   1298       1.9  macallan 		return ENXIO;
   1299       1.9  macallan 	if (sc->sc_mode == WSDISPLAYIO_MODE_MAPPED)
   1300       1.9  macallan 		return 0;
   1301       1.9  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_MAPPED;
   1302       1.9  macallan 	mgx_setup(sc, 32);
   1303       1.9  macallan 	mgx_init_palette(sc);
   1304       1.9  macallan 	return 0;
   1305       1.9  macallan }
   1306       1.9  macallan 
   1307       1.9  macallan int
   1308       1.9  macallan mgxclose(dev_t dev, int flags, int mode, struct lwp *l)
   1309       1.9  macallan {
   1310       1.9  macallan 	device_t dv = device_lookup(&mgx_cd, minor(dev));
   1311       1.9  macallan 	struct mgx_softc *sc = device_private(dv);
   1312       1.9  macallan 	struct vcons_screen *ms = sc->vd.active;
   1313       1.9  macallan 
   1314       1.9  macallan 	if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)
   1315       1.9  macallan 		return 0;
   1316       1.9  macallan 
   1317       1.9  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
   1318       1.9  macallan 
   1319       1.9  macallan 	mgx_setup(sc, MGX_DEPTH);
   1320       1.9  macallan 	glyphcache_wipe(&sc->sc_gc);
   1321       1.9  macallan 	mgx_init_palette(sc);
   1322       1.9  macallan 	if (ms != NULL) {
   1323       1.9  macallan 		vcons_redraw_screen(ms);
   1324       1.9  macallan 	}
   1325       1.9  macallan 	return 0;
   1326       1.9  macallan }
   1327       1.9  macallan 
   1328       1.9  macallan int
   1329       1.9  macallan mgxioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
   1330       1.9  macallan {
   1331       1.9  macallan 	struct mgx_softc *sc = device_lookup_private(&mgx_cd, minor(dev));
   1332       1.9  macallan 
   1333       1.9  macallan 	return mgx_ioctl(&sc->vd, NULL, cmd, data, flags, l);
   1334       1.9  macallan }
   1335