Home | History | Annotate | Line # | Download | only in dev
vncfb.c revision 1.12.66.2
      1  1.12.66.2   thorpej /* $NetBSD: vncfb.c,v 1.12.66.2 2021/04/02 22:17:42 thorpej Exp $ */
      2        1.1  jmcneill 
      3        1.1  jmcneill /*-
      4        1.1  jmcneill  * Copyright (c) 2011 Jared D. McNeill <jmcneill (at) invisible.ca>
      5        1.1  jmcneill  * All rights reserved.
      6        1.1  jmcneill  *
      7        1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8        1.1  jmcneill  * modification, are permitted provided that the following conditions
      9        1.1  jmcneill  * are met:
     10        1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11        1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12        1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13        1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14        1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15        1.1  jmcneill  * 3. All advertising materials mentioning features or use of this software
     16        1.1  jmcneill  *    must display the following acknowledgement:
     17        1.1  jmcneill  *        This product includes software developed by Jared D. McNeill.
     18        1.1  jmcneill  * 4. Neither the name of The NetBSD Foundation nor the names of its
     19        1.1  jmcneill  *    contributors may be used to endorse or promote products derived
     20        1.1  jmcneill  *    from this software without specific prior written permission.
     21        1.1  jmcneill  *
     22        1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     23        1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     24        1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     25        1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     26        1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     27        1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     28        1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     29        1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     30        1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     31        1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     32        1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     33        1.1  jmcneill  */
     34        1.1  jmcneill 
     35        1.1  jmcneill #include "opt_wsemul.h"
     36        1.1  jmcneill 
     37        1.1  jmcneill #include <sys/cdefs.h>
     38  1.12.66.2   thorpej __KERNEL_RCSID(0, "$NetBSD: vncfb.c,v 1.12.66.2 2021/04/02 22:17:42 thorpej Exp $");
     39        1.1  jmcneill 
     40        1.1  jmcneill #include <sys/param.h>
     41        1.1  jmcneill #include <sys/systm.h>
     42        1.1  jmcneill #include <sys/kernel.h>
     43        1.1  jmcneill #include <sys/device.h>
     44        1.1  jmcneill #include <sys/kmem.h>
     45        1.1  jmcneill 
     46        1.9  jmcneill #include <uvm/uvm_extern.h>
     47        1.9  jmcneill 
     48        1.1  jmcneill #include <dev/wscons/wsconsio.h>
     49        1.1  jmcneill 
     50        1.1  jmcneill #include <dev/wscons/wsdisplayvar.h>
     51        1.1  jmcneill #include <dev/wsfont/wsfont.h>
     52        1.1  jmcneill #include <dev/rasops/rasops.h>
     53        1.1  jmcneill #include <dev/wscons/wsdisplay_vconsvar.h>
     54        1.1  jmcneill 
     55        1.1  jmcneill #include <dev/wscons/wskbdvar.h>
     56        1.1  jmcneill #include <dev/wscons/wsksymdef.h>
     57        1.1  jmcneill #include <dev/wscons/wsksymvar.h>
     58        1.1  jmcneill 
     59       1.10  jmcneill #include <dev/wscons/wsmousevar.h>
     60       1.10  jmcneill 
     61        1.1  jmcneill #include <machine/mainbus.h>
     62        1.1  jmcneill #include <machine/thunk.h>
     63        1.1  jmcneill 
     64        1.9  jmcneill #define VNCFB_REFRESH_INTERVAL	33	/* fb refresh interval when mapped */
     65        1.9  jmcneill 
     66        1.1  jmcneill struct vncfb_fbops {
     67        1.1  jmcneill 	void	(*copycols)(void *, int, int, int, int);
     68        1.1  jmcneill 	void	(*erasecols)(void *, int, int, int, long);
     69        1.1  jmcneill 	void	(*copyrows)(void *, int, int, int);
     70        1.1  jmcneill 	void	(*eraserows)(void *, int, int, long);
     71        1.1  jmcneill 	void	(*putchar)(void *, int, int, u_int, long);
     72        1.2  jmcneill 	void	(*cursor)(void *, int, int, int);
     73        1.1  jmcneill };
     74        1.1  jmcneill 
     75        1.1  jmcneill struct vncfb_softc {
     76        1.1  jmcneill 	device_t		sc_dev;
     77        1.1  jmcneill 	device_t		sc_wskbddev;
     78       1.10  jmcneill 	device_t		sc_wsmousedev;
     79        1.1  jmcneill 	thunk_rfb_t		sc_rfb;
     80        1.1  jmcneill 	unsigned int		sc_width;
     81        1.1  jmcneill 	unsigned int		sc_height;
     82        1.1  jmcneill 	unsigned int		sc_depth;
     83        1.1  jmcneill 	int			sc_mode;
     84        1.9  jmcneill 	uint8_t *		sc_mem;
     85        1.9  jmcneill 	size_t			sc_memsize;
     86        1.1  jmcneill 	uint8_t *		sc_framebuf;
     87        1.9  jmcneill 	size_t			sc_framebufsize;
     88        1.1  jmcneill 	struct vcons_data	sc_vd;
     89        1.1  jmcneill 	struct vncfb_fbops	sc_ops;
     90        1.1  jmcneill 
     91        1.1  jmcneill 	int			sc_kbd_enable;
     92       1.10  jmcneill 	int			sc_mouse_enable;
     93        1.1  jmcneill 
     94        1.4  jmcneill 	void			*sc_ih;
     95        1.1  jmcneill 	void			*sc_sih;
     96        1.9  jmcneill 
     97        1.9  jmcneill 	callout_t		sc_callout;
     98        1.9  jmcneill 	void			*sc_refresh_sih;
     99        1.1  jmcneill };
    100        1.1  jmcneill 
    101        1.1  jmcneill static int	vncfb_match(device_t, cfdata_t, void *);
    102        1.1  jmcneill static void	vncfb_attach(device_t, device_t, void *);
    103        1.1  jmcneill 
    104        1.1  jmcneill CFATTACH_DECL_NEW(vncfb, sizeof(struct vncfb_softc),
    105        1.1  jmcneill     vncfb_match, vncfb_attach, NULL, NULL);
    106        1.1  jmcneill 
    107        1.1  jmcneill static void	vncfb_putchar(void *, int, int, u_int, long);
    108        1.1  jmcneill static void	vncfb_copycols(void *, int, int, int, int);
    109        1.1  jmcneill static void	vncfb_erasecols(void *, int, int, int, long);
    110        1.1  jmcneill static void	vncfb_copyrows(void *, int, int, int);
    111        1.1  jmcneill static void	vncfb_eraserows(void *, int, int, long);
    112        1.2  jmcneill static void	vncfb_cursor(void *, int, int, int);
    113        1.1  jmcneill 
    114        1.1  jmcneill static int	vncfb_ioctl(void *, void *, u_long, void *, int, lwp_t *);
    115        1.1  jmcneill static paddr_t	vncfb_mmap(void *, void *, off_t, int);
    116        1.1  jmcneill 
    117        1.1  jmcneill static void	vncfb_init_screen(void *, struct vcons_screen *, int, long *);
    118        1.1  jmcneill 
    119        1.1  jmcneill static void	vncfb_update(struct vncfb_softc *, int, int, int, int);
    120        1.7  jmcneill static void	vncfb_copyrect(struct vncfb_softc *, int, int, int, int, int, int);
    121        1.7  jmcneill static void	vncfb_fillrect(struct vncfb_softc *, int, int, int, int, uint32_t);
    122        1.4  jmcneill static int	vncfb_intr(void *);
    123        1.1  jmcneill static void	vncfb_softintr(void *);
    124        1.9  jmcneill static void	vncfb_refresh(void *);
    125        1.9  jmcneill static void	vncfb_softrefresh(void *);
    126        1.1  jmcneill 
    127        1.1  jmcneill static int	vncfb_kbd_enable(void *, int);
    128        1.1  jmcneill static void	vncfb_kbd_set_leds(void *, int);
    129        1.1  jmcneill static int	vncfb_kbd_ioctl(void *, u_long, void *, int, lwp_t *);
    130        1.1  jmcneill 
    131        1.1  jmcneill static void	vncfb_kbd_cngetc(void *, u_int *, int *);
    132        1.1  jmcneill static void	vncfb_kbd_cnpollc(void *, int);
    133        1.5  jmcneill static void	vncfb_kbd_bell(void *, u_int, u_int, u_int);
    134        1.1  jmcneill 
    135       1.10  jmcneill static int	vncfb_mouse_enable(void *);
    136       1.10  jmcneill static int	vncfb_mouse_ioctl(void *, u_long, void *, int, lwp_t *);
    137       1.10  jmcneill static void	vncfb_mouse_disable(void *);
    138       1.10  jmcneill 
    139        1.1  jmcneill static struct vcons_screen vncfb_console_screen;
    140        1.1  jmcneill 
    141        1.1  jmcneill static struct wsscreen_descr vncfb_defaultscreen = {
    142        1.1  jmcneill 	.name = "default",
    143        1.1  jmcneill 	.fontwidth = 8,
    144        1.1  jmcneill 	.fontheight = 16,
    145        1.1  jmcneill 	.capabilities = WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    146        1.1  jmcneill };
    147        1.1  jmcneill 
    148        1.1  jmcneill static const struct wsscreen_descr *vncfb_screens[] = {
    149        1.1  jmcneill 	&vncfb_defaultscreen,
    150        1.1  jmcneill };
    151        1.1  jmcneill 
    152        1.1  jmcneill static struct wsscreen_list vncfb_screenlist = {
    153        1.1  jmcneill 	.screens = vncfb_screens,
    154        1.1  jmcneill 	.nscreens = __arraycount(vncfb_screens),
    155        1.1  jmcneill };
    156        1.1  jmcneill 
    157        1.1  jmcneill static struct wsdisplay_accessops vncfb_accessops = {
    158        1.1  jmcneill 	.ioctl = vncfb_ioctl,
    159        1.1  jmcneill 	.mmap = vncfb_mmap,
    160        1.1  jmcneill };
    161        1.1  jmcneill 
    162        1.1  jmcneill extern const struct wscons_keydesc vnckbd_keydesctab[];
    163        1.1  jmcneill 
    164        1.1  jmcneill static const struct wskbd_mapdata vncfb_keymapdata = {
    165        1.1  jmcneill 	vnckbd_keydesctab,
    166        1.1  jmcneill 	KB_US,
    167        1.1  jmcneill };
    168        1.1  jmcneill 
    169        1.1  jmcneill static struct wskbd_accessops vncfb_kbd_accessops = {
    170        1.1  jmcneill 	vncfb_kbd_enable,
    171        1.1  jmcneill 	vncfb_kbd_set_leds,
    172        1.1  jmcneill 	vncfb_kbd_ioctl,
    173        1.1  jmcneill };
    174        1.1  jmcneill 
    175        1.1  jmcneill static const struct wskbd_consops vncfb_kbd_consops = {
    176        1.1  jmcneill 	vncfb_kbd_cngetc,
    177        1.1  jmcneill 	vncfb_kbd_cnpollc,
    178        1.5  jmcneill 	vncfb_kbd_bell,
    179        1.1  jmcneill };
    180        1.1  jmcneill 
    181       1.10  jmcneill static const struct wsmouse_accessops vncfb_mouse_accessops = {
    182       1.10  jmcneill 	vncfb_mouse_enable,
    183       1.10  jmcneill 	vncfb_mouse_ioctl,
    184       1.10  jmcneill 	vncfb_mouse_disable,
    185       1.10  jmcneill };
    186       1.10  jmcneill 
    187        1.1  jmcneill static int
    188        1.1  jmcneill vncfb_match(device_t parent, cfdata_t match, void *priv)
    189        1.1  jmcneill {
    190        1.1  jmcneill 	struct thunkbus_attach_args *taa = priv;
    191        1.1  jmcneill 
    192        1.1  jmcneill 	return taa->taa_type == THUNKBUS_TYPE_VNCFB;
    193        1.1  jmcneill }
    194        1.1  jmcneill 
    195        1.1  jmcneill static void
    196        1.1  jmcneill vncfb_attach(device_t parent, device_t self, void *priv)
    197        1.1  jmcneill {
    198        1.1  jmcneill 	struct vncfb_softc *sc = device_private(self);
    199        1.1  jmcneill 	struct thunkbus_attach_args *taa = priv;
    200        1.1  jmcneill 	struct wsemuldisplaydev_attach_args waa;
    201        1.1  jmcneill 	struct wskbddev_attach_args kaa;
    202       1.10  jmcneill 	struct wsmousedev_attach_args maa;
    203        1.1  jmcneill 	struct rasops_info *ri;
    204        1.1  jmcneill 	unsigned long defattr;
    205        1.1  jmcneill 
    206        1.1  jmcneill 	sc->sc_dev = self;
    207        1.1  jmcneill 	sc->sc_width = taa->u.vnc.width;
    208        1.1  jmcneill 	sc->sc_height = taa->u.vnc.height;
    209        1.1  jmcneill 	sc->sc_depth = 32;
    210        1.1  jmcneill 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    211        1.1  jmcneill #if notyet
    212        1.1  jmcneill 	sc->sc_sockfd = thunk_vnc_open_socket(taa->u.vnc.port);
    213        1.1  jmcneill 	if (sc->sc_sockfd == -1)
    214        1.1  jmcneill 		panic("couldn't open VNC socket");
    215        1.1  jmcneill #endif
    216        1.1  jmcneill 
    217        1.9  jmcneill 	sc->sc_framebufsize = sc->sc_width * sc->sc_height * (sc->sc_depth / 8);
    218        1.9  jmcneill 	sc->sc_memsize = sc->sc_framebufsize + PAGE_SIZE;
    219        1.9  jmcneill 
    220        1.9  jmcneill 	sc->sc_mem = kmem_zalloc(sc->sc_memsize, KM_SLEEP);
    221        1.9  jmcneill 	sc->sc_framebuf = (void *)round_page((vaddr_t)sc->sc_mem);
    222        1.1  jmcneill 
    223        1.1  jmcneill 	aprint_naive("\n");
    224        1.1  jmcneill 	aprint_normal(": %ux%u %ubpp (port %u)\n",
    225        1.1  jmcneill 	    sc->sc_width, sc->sc_height, sc->sc_depth, taa->u.vnc.port);
    226        1.1  jmcneill 
    227        1.1  jmcneill 	sc->sc_rfb.width = sc->sc_width;
    228        1.1  jmcneill 	sc->sc_rfb.height = sc->sc_height;
    229        1.1  jmcneill 	sc->sc_rfb.depth = sc->sc_depth;
    230        1.1  jmcneill 	sc->sc_rfb.framebuf = sc->sc_framebuf;
    231        1.1  jmcneill 	snprintf(sc->sc_rfb.name, sizeof(sc->sc_rfb.name),
    232        1.1  jmcneill 	    "NetBSD/usermode %d.%d.%d",
    233        1.1  jmcneill 	    __NetBSD_Version__ / 100000000,
    234        1.1  jmcneill 	    (__NetBSD_Version__ / 1000000) % 100,
    235        1.1  jmcneill 	    (__NetBSD_Version__ / 100) % 100);
    236        1.1  jmcneill 	if (thunk_rfb_open(&sc->sc_rfb, taa->u.vnc.port) != 0)
    237        1.1  jmcneill 		panic("couldn't open rfb server");
    238        1.1  jmcneill 
    239        1.1  jmcneill 	sc->sc_sih = softint_establish(SOFTINT_SERIAL, vncfb_softintr, sc);
    240        1.4  jmcneill 	sc->sc_ih = sigio_intr_establish(vncfb_intr, sc);
    241        1.1  jmcneill 
    242        1.9  jmcneill 	sc->sc_refresh_sih = softint_establish(SOFTINT_SERIAL,
    243        1.9  jmcneill 	    vncfb_softrefresh, sc);
    244        1.9  jmcneill 
    245        1.9  jmcneill 	callout_init(&sc->sc_callout, 0);
    246        1.9  jmcneill 	callout_setfunc(&sc->sc_callout, vncfb_refresh, sc);
    247        1.9  jmcneill 
    248        1.1  jmcneill 	vcons_init(&sc->sc_vd, sc, &vncfb_defaultscreen, &vncfb_accessops);
    249        1.1  jmcneill 	sc->sc_vd.init_screen = vncfb_init_screen;
    250        1.1  jmcneill 
    251        1.1  jmcneill 	ri = &vncfb_console_screen.scr_ri;
    252        1.1  jmcneill 	vcons_init_screen(&sc->sc_vd, &vncfb_console_screen, 1, &defattr);
    253        1.1  jmcneill 	vncfb_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    254        1.1  jmcneill 	vncfb_defaultscreen.textops = &ri->ri_ops;
    255        1.1  jmcneill 	vncfb_defaultscreen.capabilities = ri->ri_caps;
    256        1.1  jmcneill 	vncfb_defaultscreen.nrows = ri->ri_rows;
    257        1.1  jmcneill 	vncfb_defaultscreen.ncols = ri->ri_cols;
    258        1.1  jmcneill 	wsdisplay_cnattach(&vncfb_defaultscreen, ri, 0, 0, defattr);
    259        1.1  jmcneill 
    260        1.1  jmcneill 	vcons_replay_msgbuf(&vncfb_console_screen);
    261        1.1  jmcneill 
    262        1.1  jmcneill 	waa.console = true;
    263        1.1  jmcneill 	waa.scrdata = &vncfb_screenlist;
    264        1.1  jmcneill 	waa.accessops = &vncfb_accessops;
    265        1.1  jmcneill 	waa.accesscookie = &sc->sc_vd;
    266        1.1  jmcneill 
    267  1.12.66.1   thorpej 	config_found(self, &waa, wsemuldisplaydevprint, CFARG_EOL);
    268        1.1  jmcneill 
    269        1.1  jmcneill 	wskbd_cnattach(&vncfb_kbd_consops, sc, &vncfb_keymapdata);
    270        1.1  jmcneill 
    271        1.1  jmcneill 	kaa.console = true;
    272        1.1  jmcneill 	kaa.keymap = &vncfb_keymapdata;
    273        1.1  jmcneill 	kaa.accessops = &vncfb_kbd_accessops;
    274        1.1  jmcneill 	kaa.accesscookie = sc;
    275        1.1  jmcneill 
    276  1.12.66.2   thorpej 	sc->sc_wskbddev = config_found(self, &kaa, wskbddevprint,
    277  1.12.66.2   thorpej 	    CFARG_IATTR, "wskbddev",
    278  1.12.66.2   thorpej 	    CFARG_EOL);
    279       1.10  jmcneill 
    280       1.10  jmcneill 	maa.accessops = &vncfb_mouse_accessops;
    281       1.10  jmcneill 	maa.accesscookie = sc;
    282       1.10  jmcneill 
    283  1.12.66.2   thorpej 	sc->sc_wsmousedev = config_found(self, &maa, wsmousedevprint,
    284  1.12.66.2   thorpej 	    CFARG_IATTR, "wsmousedev",
    285  1.12.66.2   thorpej 	    CFARG_EOL);
    286        1.1  jmcneill }
    287        1.1  jmcneill 
    288        1.1  jmcneill static void
    289        1.1  jmcneill vncfb_init_screen(void *priv, struct vcons_screen *scr, int existing,
    290        1.1  jmcneill     long *defattr)
    291        1.1  jmcneill {
    292        1.1  jmcneill 	struct vncfb_softc *sc = priv;
    293        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    294        1.1  jmcneill 	struct rasops_info *ri = &scr->scr_ri;
    295        1.1  jmcneill 
    296        1.1  jmcneill 	ri->ri_width = sc->sc_width;
    297        1.1  jmcneill 	ri->ri_height = sc->sc_height;
    298        1.1  jmcneill 	ri->ri_depth = sc->sc_depth;
    299        1.1  jmcneill 	ri->ri_stride = sc->sc_width * ri->ri_depth / 8;
    300        1.1  jmcneill 	ri->ri_bits = sc->sc_framebuf;
    301        1.1  jmcneill 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    302        1.1  jmcneill 	if (existing)
    303        1.1  jmcneill 		ri->ri_flg |= RI_CLEAR;
    304        1.1  jmcneill 
    305        1.1  jmcneill 	rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
    306        1.1  jmcneill 	ri->ri_caps = WSSCREEN_WSCOLORS;
    307        1.1  jmcneill 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    308        1.1  jmcneill 	    sc->sc_width / ri->ri_font->fontwidth);
    309        1.1  jmcneill 
    310        1.1  jmcneill 	ri->ri_hw = scr;
    311        1.1  jmcneill 
    312        1.1  jmcneill 	ops->putchar = ri->ri_ops.putchar;
    313        1.1  jmcneill 	ops->copyrows = ri->ri_ops.copyrows;
    314        1.1  jmcneill 	ops->eraserows = ri->ri_ops.eraserows;
    315        1.1  jmcneill 	ops->copycols = ri->ri_ops.copycols;
    316        1.1  jmcneill 	ops->erasecols = ri->ri_ops.erasecols;
    317        1.2  jmcneill 	ops->cursor = ri->ri_ops.cursor;
    318        1.1  jmcneill 
    319        1.1  jmcneill 	ri->ri_ops.copyrows = vncfb_copyrows;
    320        1.1  jmcneill 	ri->ri_ops.copycols = vncfb_copycols;
    321        1.1  jmcneill 	ri->ri_ops.eraserows = vncfb_eraserows;
    322        1.1  jmcneill 	ri->ri_ops.erasecols = vncfb_erasecols;
    323        1.1  jmcneill 	ri->ri_ops.putchar = vncfb_putchar;
    324        1.2  jmcneill 	ri->ri_ops.cursor = vncfb_cursor;
    325        1.1  jmcneill }
    326        1.1  jmcneill 
    327        1.1  jmcneill static void
    328        1.1  jmcneill vncfb_putchar(void *priv, int row, int col, u_int c, long attr)
    329        1.1  jmcneill {
    330        1.1  jmcneill 	struct rasops_info *ri = priv;
    331        1.1  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    332        1.1  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    333        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    334        1.1  jmcneill 	int x, y, w, h;
    335        1.1  jmcneill 
    336        1.1  jmcneill 	ops->putchar(ri, row, col, c, attr);
    337        1.1  jmcneill 
    338        1.1  jmcneill 	x = ri->ri_xorigin + (col * ri->ri_font->fontwidth);
    339        1.1  jmcneill 	y = ri->ri_yorigin + (row * ri->ri_font->fontheight);
    340        1.1  jmcneill 	w = ri->ri_font->fontwidth;
    341        1.1  jmcneill 	h = ri->ri_font->fontheight;
    342        1.1  jmcneill 
    343        1.1  jmcneill 	vncfb_update(sc, x, y, w, h);
    344        1.1  jmcneill }
    345        1.1  jmcneill 
    346        1.1  jmcneill static void
    347        1.1  jmcneill vncfb_copycols(void *priv, int row, int srccol, int dstcol, int ncols)
    348        1.1  jmcneill {
    349        1.1  jmcneill 	struct rasops_info *ri = priv;
    350        1.1  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    351        1.1  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    352        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    353        1.1  jmcneill 	int x, y, w, h;
    354        1.1  jmcneill 
    355        1.1  jmcneill 	ops->copycols(ri, row, srccol, dstcol, ncols);
    356        1.1  jmcneill 
    357        1.1  jmcneill 	y = ri->ri_yorigin + (row * ri->ri_font->fontheight);
    358        1.1  jmcneill 	h = ri->ri_font->fontheight;
    359        1.1  jmcneill 	if (srccol < dstcol) {
    360        1.1  jmcneill 		x = ri->ri_xorigin + (srccol * ri->ri_font->fontwidth);
    361        1.1  jmcneill 		w = (dstcol - srccol) * ri->ri_font->fontwidth;
    362        1.1  jmcneill 
    363        1.1  jmcneill 	} else {
    364        1.1  jmcneill 		x = ri->ri_xorigin + (dstcol * ri->ri_font->fontwidth);
    365        1.1  jmcneill 		w = (srccol - dstcol) * ri->ri_font->fontwidth;
    366        1.1  jmcneill 	}
    367        1.1  jmcneill 
    368        1.1  jmcneill 	vncfb_update(sc, x, y, w, h);
    369        1.1  jmcneill }
    370        1.1  jmcneill 
    371        1.1  jmcneill static void
    372        1.1  jmcneill vncfb_erasecols(void *priv, int row, int startcol, int ncols, long fillattr)
    373        1.1  jmcneill {
    374        1.1  jmcneill 	struct rasops_info *ri = priv;
    375        1.1  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    376        1.1  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    377        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    378        1.7  jmcneill 	int x, y, w, h, c;
    379        1.1  jmcneill 
    380        1.1  jmcneill 	ops->erasecols(ri, row, startcol, ncols, fillattr);
    381        1.1  jmcneill 
    382        1.1  jmcneill 	y = ri->ri_yorigin + (row * ri->ri_font->fontheight);
    383        1.1  jmcneill 	h = ri->ri_font->fontheight;
    384        1.1  jmcneill 	x = ri->ri_xorigin + (startcol * ri->ri_font->fontwidth);
    385        1.1  jmcneill 	w = ncols * ri->ri_font->fontwidth;
    386        1.7  jmcneill 	c = ri->ri_devcmap[(fillattr >> 16) & 0xf] & 0xffffff;
    387        1.1  jmcneill 
    388        1.7  jmcneill 	vncfb_fillrect(sc, x, y, w, h, c);
    389        1.1  jmcneill }
    390        1.1  jmcneill 
    391        1.1  jmcneill static void
    392        1.1  jmcneill vncfb_copyrows(void *priv, int srcrow, int dstrow, int nrows)
    393        1.1  jmcneill {
    394        1.1  jmcneill 	struct rasops_info *ri = priv;
    395        1.1  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    396        1.1  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    397        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    398        1.6   reinoud 	int x, y, w, h, srcx, srcy;
    399        1.6   reinoud 	int fontheight;
    400        1.1  jmcneill 
    401        1.7  jmcneill 	/* barrier */
    402        1.7  jmcneill 	while (sc->sc_rfb.nupdates > 0)
    403        1.8  jmcneill 		if (thunk_rfb_poll(&sc->sc_rfb, NULL) == -1)
    404        1.8  jmcneill 			break;
    405        1.7  jmcneill 
    406        1.1  jmcneill 	ops->copyrows(ri, srcrow, dstrow, nrows);
    407        1.1  jmcneill 
    408        1.6   reinoud 	fontheight = ri->ri_font->fontheight;
    409        1.1  jmcneill 	x = ri->ri_xorigin;
    410        1.6   reinoud 	y = ri->ri_yorigin + dstrow * fontheight;
    411        1.1  jmcneill 	w = ri->ri_width;
    412        1.6   reinoud 	h = nrows * fontheight;
    413        1.6   reinoud 
    414        1.6   reinoud 	srcx = ri->ri_xorigin;
    415        1.6   reinoud 	srcy = ri->ri_yorigin + srcrow * fontheight;
    416        1.1  jmcneill 
    417        1.6   reinoud 	vncfb_copyrect(sc, x, y, w, h, srcx, srcy);
    418        1.1  jmcneill }
    419        1.1  jmcneill 
    420        1.1  jmcneill static void
    421        1.1  jmcneill vncfb_eraserows(void *priv, int row, int nrows, long fillattr)
    422        1.1  jmcneill {
    423        1.1  jmcneill 	struct rasops_info *ri = priv;
    424        1.1  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    425        1.1  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    426        1.1  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    427        1.7  jmcneill 	int x, y, w, h, c;
    428        1.1  jmcneill 
    429        1.1  jmcneill 	ops->eraserows(ri, row, nrows, fillattr);
    430        1.1  jmcneill 
    431        1.1  jmcneill 	y = ri->ri_yorigin + (row * ri->ri_font->fontheight);
    432        1.1  jmcneill 	h = nrows * ri->ri_font->fontheight;
    433        1.1  jmcneill 	x = ri->ri_xorigin;
    434        1.1  jmcneill 	w = ri->ri_width;
    435        1.7  jmcneill 	c = ri->ri_devcmap[(fillattr >> 16) & 0xf] & 0xffffff;
    436        1.1  jmcneill 
    437        1.7  jmcneill 	vncfb_fillrect(sc, x, y, w, h, c);
    438        1.1  jmcneill }
    439        1.1  jmcneill 
    440        1.2  jmcneill static void
    441        1.2  jmcneill vncfb_cursor(void *priv, int on, int row, int col)
    442        1.2  jmcneill {
    443        1.2  jmcneill 	struct rasops_info *ri = priv;
    444        1.2  jmcneill 	struct vcons_screen *scr = ri->ri_hw;
    445        1.2  jmcneill 	struct vncfb_softc *sc = scr->scr_cookie;
    446        1.2  jmcneill 	struct vncfb_fbops *ops = &sc->sc_ops;
    447        1.2  jmcneill 	int ox, oy, x, y, w, h;
    448        1.2  jmcneill 
    449        1.2  jmcneill 	w = ri->ri_font->fontwidth;
    450        1.2  jmcneill 	h = ri->ri_font->fontheight;
    451        1.2  jmcneill 
    452        1.2  jmcneill 	ox = ri->ri_ccol * w + ri->ri_xorigin;
    453        1.2  jmcneill 	oy = ri->ri_crow * h + ri->ri_yorigin;
    454        1.2  jmcneill 
    455        1.2  jmcneill 	ops->cursor(ri, on, row, col);
    456        1.2  jmcneill 
    457        1.2  jmcneill 	x = ri->ri_ccol * w + ri->ri_xorigin;
    458        1.2  jmcneill 	y = ri->ri_crow * h + ri->ri_yorigin;
    459        1.2  jmcneill 
    460        1.2  jmcneill 	vncfb_update(sc, ox, oy, w, h);
    461        1.2  jmcneill 	vncfb_update(sc, x, y, w, h);
    462        1.2  jmcneill }
    463        1.2  jmcneill 
    464        1.1  jmcneill static int
    465        1.1  jmcneill vncfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, lwp_t *l)
    466        1.1  jmcneill {
    467        1.1  jmcneill 	struct vcons_data *vd = v;
    468        1.1  jmcneill 	struct vncfb_softc *sc = vd->cookie;
    469        1.1  jmcneill 	struct wsdisplay_fbinfo *wdf;
    470        1.1  jmcneill 	struct vcons_screen *ms = vd->active;
    471        1.1  jmcneill 	int new_mode;
    472        1.1  jmcneill 
    473        1.1  jmcneill 	switch (cmd) {
    474        1.1  jmcneill 	case WSDISPLAYIO_GTYPE:
    475        1.1  jmcneill 		*(u_int *)data = WSDISPLAY_TYPE_VNC;
    476        1.1  jmcneill 		return 0;
    477        1.1  jmcneill 	case WSDISPLAYIO_GINFO:
    478        1.1  jmcneill 		wdf = data;
    479        1.1  jmcneill 		wdf->height = ms->scr_ri.ri_height;
    480        1.1  jmcneill 		wdf->width = ms->scr_ri.ri_width;
    481        1.1  jmcneill 		wdf->depth = ms->scr_ri.ri_depth;
    482        1.1  jmcneill 		wdf->cmsize = 256;
    483        1.1  jmcneill 		return 0;
    484        1.9  jmcneill 	case WSDISPLAYIO_LINEBYTES:
    485        1.9  jmcneill 		*(u_int *)data = sc->sc_width * (sc->sc_depth / 8);
    486        1.9  jmcneill 		return 0;
    487        1.1  jmcneill 	case WSDISPLAYIO_SMODE:
    488        1.1  jmcneill 		new_mode = *(int *)data;
    489        1.1  jmcneill 		if (sc->sc_mode != new_mode) {
    490        1.1  jmcneill 			sc->sc_mode = new_mode;
    491        1.9  jmcneill 			if (new_mode == WSDISPLAYIO_MODE_EMUL) {
    492        1.9  jmcneill 				callout_halt(&sc->sc_callout, NULL);
    493        1.1  jmcneill 				vcons_redraw_screen(ms);
    494        1.9  jmcneill 			} else {
    495        1.9  jmcneill 				callout_schedule(&sc->sc_callout, 1);
    496        1.9  jmcneill 			}
    497        1.1  jmcneill 		}
    498        1.1  jmcneill 		return 0;
    499        1.1  jmcneill 	default:
    500        1.1  jmcneill 		return EPASSTHROUGH;
    501        1.1  jmcneill 	}
    502        1.1  jmcneill }
    503        1.1  jmcneill 
    504        1.1  jmcneill static paddr_t
    505        1.1  jmcneill vncfb_mmap(void *v, void *vs, off_t offset, int prot)
    506        1.1  jmcneill {
    507        1.9  jmcneill 	struct vcons_data *vd = v;
    508        1.9  jmcneill 	struct vncfb_softc *sc = vd->cookie;
    509        1.9  jmcneill 	paddr_t pa;
    510        1.9  jmcneill 	vaddr_t va;
    511        1.9  jmcneill 
    512       1.11  jmcneill 	if (offset < 0 || offset >= sc->sc_framebufsize) {
    513        1.9  jmcneill 		device_printf(sc->sc_dev, "mmap: offset 0x%x, fbsize 0x%x"
    514        1.9  jmcneill 		    " out of range!\n",
    515        1.9  jmcneill 		    (unsigned int)offset, (unsigned int)sc->sc_framebufsize);
    516        1.9  jmcneill 		return -1;
    517        1.9  jmcneill 	}
    518        1.9  jmcneill 
    519        1.9  jmcneill 	va = trunc_page((vaddr_t)sc->sc_framebuf + offset);
    520        1.9  jmcneill 
    521        1.9  jmcneill 	if (pmap_extract(pmap_kernel(), va, &pa) == false) {
    522        1.9  jmcneill 		device_printf(sc->sc_dev, "mmap: pmap_extract failed!\n");
    523        1.9  jmcneill 		return -1;
    524        1.9  jmcneill 	}
    525        1.9  jmcneill 
    526        1.9  jmcneill 	return atop(pa);
    527        1.1  jmcneill }
    528        1.1  jmcneill 
    529        1.1  jmcneill static void
    530        1.1  jmcneill vncfb_update(struct vncfb_softc *sc, int x, int y, int w, int h)
    531        1.1  jmcneill {
    532        1.1  jmcneill 	thunk_rfb_update(&sc->sc_rfb, x, y, w, h);
    533        1.4  jmcneill 	softint_schedule(sc->sc_sih);
    534        1.1  jmcneill }
    535        1.1  jmcneill 
    536        1.6   reinoud static void
    537        1.6   reinoud vncfb_copyrect(struct vncfb_softc *sc, int x, int y, int w, int h,
    538        1.6   reinoud 	int srcx, int srcy)
    539        1.6   reinoud {
    540        1.6   reinoud 	thunk_rfb_copyrect(&sc->sc_rfb, x, y, w, h, srcx, srcy);
    541        1.6   reinoud 	softint_schedule(sc->sc_sih);
    542        1.6   reinoud }
    543        1.6   reinoud 
    544        1.7  jmcneill static void
    545        1.7  jmcneill vncfb_fillrect(struct vncfb_softc *sc, int x, int y, int w, int h, uint32_t c)
    546        1.7  jmcneill {
    547        1.7  jmcneill 
    548        1.7  jmcneill 	thunk_rfb_fillrect(&sc->sc_rfb, x, y, w, h, (uint8_t *)&c);
    549        1.7  jmcneill 	softint_schedule(sc->sc_sih);
    550        1.7  jmcneill }
    551        1.7  jmcneill 
    552        1.4  jmcneill static int
    553        1.4  jmcneill vncfb_intr(void *priv)
    554        1.1  jmcneill {
    555        1.1  jmcneill 	struct vncfb_softc *sc = priv;
    556        1.1  jmcneill 
    557        1.1  jmcneill 	softint_schedule(sc->sc_sih);
    558        1.4  jmcneill 
    559        1.4  jmcneill 	return 0;
    560        1.1  jmcneill }
    561        1.1  jmcneill 
    562        1.1  jmcneill static void
    563        1.1  jmcneill vncfb_softintr(void *priv)
    564        1.1  jmcneill {
    565        1.1  jmcneill 	struct vncfb_softc *sc = priv;
    566        1.1  jmcneill 	thunk_rfb_event_t event;
    567        1.1  jmcneill 	int s;
    568        1.1  jmcneill 
    569        1.1  jmcneill 	while (thunk_rfb_poll(&sc->sc_rfb, &event) > 0) {
    570        1.1  jmcneill 		switch (event.message_type) {
    571        1.1  jmcneill 		case THUNK_RFB_KEY_EVENT:
    572        1.1  jmcneill 			s = spltty();
    573        1.1  jmcneill 			wskbd_input(sc->sc_wskbddev,
    574        1.1  jmcneill 			    event.data.key_event.down_flag ?
    575        1.1  jmcneill 			     WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP,
    576        1.1  jmcneill 			    event.data.key_event.keysym & 0xfff);
    577        1.1  jmcneill 			splx(s);
    578        1.1  jmcneill 			break;
    579       1.10  jmcneill 		case THUNK_RFB_POINTER_EVENT:
    580       1.10  jmcneill 			s = spltty();
    581       1.10  jmcneill 			wsmouse_input(sc->sc_wsmousedev,
    582       1.10  jmcneill 			    event.data.pointer_event.button_mask,
    583       1.10  jmcneill 			    event.data.pointer_event.absx,
    584       1.10  jmcneill 			    event.data.pointer_event.absy,
    585       1.10  jmcneill 			    0, 0,
    586       1.10  jmcneill 			    WSMOUSE_INPUT_ABSOLUTE_X|WSMOUSE_INPUT_ABSOLUTE_Y);
    587       1.10  jmcneill 			splx(s);
    588        1.1  jmcneill 		default:
    589        1.1  jmcneill 			break;
    590        1.1  jmcneill 		}
    591        1.1  jmcneill 	}
    592        1.1  jmcneill }
    593        1.1  jmcneill 
    594        1.9  jmcneill static void
    595        1.9  jmcneill vncfb_refresh(void *priv)
    596        1.9  jmcneill {
    597        1.9  jmcneill 	struct vncfb_softc *sc = priv;
    598        1.9  jmcneill 
    599        1.9  jmcneill 	softint_schedule(sc->sc_refresh_sih);
    600        1.9  jmcneill }
    601        1.9  jmcneill 
    602        1.9  jmcneill static void
    603        1.9  jmcneill vncfb_softrefresh(void *priv)
    604        1.9  jmcneill {
    605        1.9  jmcneill 	struct vncfb_softc *sc = priv;
    606        1.9  jmcneill 
    607        1.9  jmcneill 	if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)
    608        1.9  jmcneill 		return;
    609        1.9  jmcneill 
    610        1.9  jmcneill 	/* update the screen */
    611        1.9  jmcneill 	vncfb_update(sc, 0, 0, sc->sc_width, sc->sc_height);
    612        1.9  jmcneill 
    613        1.9  jmcneill 	/* flush the pending drawing op */
    614        1.9  jmcneill 	while (thunk_rfb_poll(&sc->sc_rfb, NULL) > 0)
    615        1.9  jmcneill 		;
    616        1.9  jmcneill 
    617        1.9  jmcneill 	callout_schedule(&sc->sc_callout, mstohz(VNCFB_REFRESH_INTERVAL));
    618        1.9  jmcneill }
    619        1.9  jmcneill 
    620        1.1  jmcneill static int
    621        1.1  jmcneill vncfb_kbd_enable(void *priv, int on)
    622        1.1  jmcneill {
    623        1.1  jmcneill 	struct vncfb_softc *sc = priv;
    624        1.1  jmcneill 
    625        1.1  jmcneill 	sc->sc_kbd_enable = on;
    626        1.1  jmcneill 
    627        1.1  jmcneill 	return 0;
    628        1.1  jmcneill }
    629        1.1  jmcneill 
    630        1.1  jmcneill static void
    631        1.1  jmcneill vncfb_kbd_set_leds(void *priv, int leds)
    632        1.1  jmcneill {
    633        1.1  jmcneill }
    634        1.1  jmcneill 
    635        1.1  jmcneill static int
    636        1.1  jmcneill vncfb_kbd_ioctl(void *priv, u_long cmd, void *data, int flag, lwp_t *l)
    637        1.1  jmcneill {
    638        1.5  jmcneill 	struct wskbd_bell_data *bd;
    639        1.5  jmcneill 
    640        1.1  jmcneill 	switch (cmd) {
    641        1.1  jmcneill 	case WSKBDIO_GTYPE:
    642        1.1  jmcneill 		*(int *)data = WSKBD_TYPE_RFB;
    643        1.1  jmcneill 		return 0;
    644        1.5  jmcneill 	case WSKBDIO_COMPLEXBELL:
    645        1.5  jmcneill 		bd = data;
    646        1.5  jmcneill 		vncfb_kbd_bell(priv, bd->pitch, bd->period, bd->volume);
    647        1.5  jmcneill 		return 0;
    648        1.1  jmcneill 	default:
    649        1.1  jmcneill 		return EPASSTHROUGH;
    650        1.1  jmcneill 	}
    651        1.1  jmcneill }
    652        1.1  jmcneill 
    653        1.1  jmcneill static void
    654        1.1  jmcneill vncfb_kbd_cngetc(void *priv, u_int *type, int *data)
    655        1.1  jmcneill {
    656       1.12  jmcneill 	struct vncfb_softc *sc = priv;
    657       1.12  jmcneill 	thunk_rfb_event_t event;
    658       1.12  jmcneill 
    659       1.12  jmcneill 	for (;;) {
    660       1.12  jmcneill 		if (thunk_rfb_poll(&sc->sc_rfb, &event) > 0) {
    661       1.12  jmcneill 			if (event.message_type == THUNK_RFB_KEY_EVENT) {
    662       1.12  jmcneill 				*type = event.data.key_event.down_flag ?
    663       1.12  jmcneill 				    WSCONS_EVENT_KEY_DOWN : WSCONS_EVENT_KEY_UP;
    664       1.12  jmcneill 				*data = event.data.key_event.keysym & 0xfff;
    665       1.12  jmcneill 				return;
    666       1.12  jmcneill 			}
    667       1.12  jmcneill 		}
    668       1.12  jmcneill 	}
    669        1.1  jmcneill }
    670        1.1  jmcneill 
    671        1.1  jmcneill static void
    672        1.1  jmcneill vncfb_kbd_cnpollc(void *priv, int on)
    673        1.1  jmcneill {
    674       1.12  jmcneill 	struct vncfb_softc *sc = priv;
    675       1.12  jmcneill 
    676       1.12  jmcneill 	if (!on) {
    677       1.12  jmcneill 		vncfb_intr(sc);
    678       1.12  jmcneill 	}
    679        1.1  jmcneill }
    680        1.5  jmcneill 
    681        1.5  jmcneill static void
    682        1.5  jmcneill vncfb_kbd_bell(void *priv, u_int pitch, u_int period, u_int volume)
    683        1.5  jmcneill {
    684        1.5  jmcneill 	struct vncfb_softc *sc = priv;
    685        1.5  jmcneill 
    686        1.5  jmcneill 	thunk_rfb_bell(&sc->sc_rfb);
    687        1.5  jmcneill 	softint_schedule(sc->sc_sih);
    688        1.5  jmcneill }
    689       1.10  jmcneill 
    690       1.10  jmcneill static int
    691       1.10  jmcneill vncfb_mouse_enable(void *priv)
    692       1.10  jmcneill {
    693       1.10  jmcneill 	struct vncfb_softc *sc = priv;
    694       1.10  jmcneill 
    695       1.10  jmcneill 	sc->sc_mouse_enable = 1;
    696       1.10  jmcneill 
    697       1.10  jmcneill 	return 0;
    698       1.10  jmcneill }
    699       1.10  jmcneill 
    700       1.10  jmcneill static int
    701       1.10  jmcneill vncfb_mouse_ioctl(void *priv, u_long cmd, void *data, int flag, lwp_t *l)
    702       1.10  jmcneill {
    703       1.10  jmcneill 	switch (cmd) {
    704       1.10  jmcneill 	case WSMOUSEIO_GTYPE:
    705       1.10  jmcneill 		*(u_int *)data = WSMOUSE_TYPE_PSEUDO;
    706       1.10  jmcneill 		return 0;
    707       1.10  jmcneill 	default:
    708       1.10  jmcneill 		return EPASSTHROUGH;
    709       1.10  jmcneill 	}
    710       1.10  jmcneill }
    711       1.10  jmcneill 
    712       1.10  jmcneill static void
    713       1.10  jmcneill vncfb_mouse_disable(void *priv)
    714       1.10  jmcneill {
    715       1.10  jmcneill 	struct vncfb_softc *sc = priv;
    716       1.10  jmcneill 
    717       1.10  jmcneill 	sc->sc_mouse_enable = 0;
    718       1.10  jmcneill }
    719