/* $NetBSD: qv.c,v 1.38 2021/08/07 16:19:07 thorpej Exp $ */
/*
 * Copyright (c) 2015 Charles H. Dickman. All rights reserved.
 * Derived from smg.c
 * Copyright (c) 1998 Ludd, University of Lule}, Sweden.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. The name of the author may not be used to endorse or promote products
 *    derived from this software without specific prior written permission
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
/*       1         2         3         4         5         6         7        */
/*3456789012345678901234567890123456789012345678901234567890123456789012345678*/

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: qv.c,v 1.38 2021/08/07 16:19:07 thorpej Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <sys/conf.h>
#include <sys/cpu.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/kmem.h>
#include <sys/extent.h>		/***/
#include <sys/time.h>
#include <sys/bus.h>
#include <vax/include/pte.h>                /* temporary */
#include <machine/sid.h>
#include <dev/cons.h>
#include <dev/qbus/ubavar.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wscons_callbacks.h>
#include <dev/wsfont/wsfont.h>
#include <dev/wsfb/genfbvar.h>
#include <vax/include/sgmap.h> /***/

#include "uba_common.h"		/***/
#include "qv.h"
#include "qv_ic.h"
#include "qvaux.h"
#include "opt_wsfont.h"

#define QMEMBASE        0x30000000      
#define QVSIZE          0x40000
#define QV_SCANMAP      0x3F800
#define QV_CURSRAM      0x3FFE0

#define QV_CSR          0
#define QV_CSR_1        (1 << 2)
#define QV_CSR_2        (1 << 3)
#define QV_CSR_BANK     (15 << 11)
#define QV_CUR_X        2
#define QV_CRTC_AR      8
#define QV_CRTC_DR      10
#define QV_IC           12
#define QV_ICDR         QV_ICDR
#define QV_ICSR         (QV_ICDR + 2)

/* Screen hardware defs */
#define QV_COLS		128	/* char width of screen */
#define QV_ROWS		57	/* rows of char on screen */
#define QV_CHEIGHT	15	/* lines a char consists of */
#define QV_NEXTROW	(QV_COLS * QV_CHEIGHT)
#define	QV_YWIDTH	864
#define QV_XWIDTH	1024

/* hardware cursor */
#define CUR_BLINKN      0x00
#define CUR_BLANK       0x20
#define CUR_BLINKS      0x40
#define CUR_BLINKF      0x60
#define CUR_BLINKM      0x60
#define CUR_OFF         CUR_BLANK
#define CUR_ON          CUR_BLINKS
#define CUR_START       10
#define CUR_END         11
#define CUR_HI          14
#define CUR_LO          15

//static	uint16_t curcmd, curx, cury, hotX, hotY;
static	int     bgmask, fgmask;

static	int     qv_match(device_t, cfdata_t, void *);
static	void    qv_attach(device_t, device_t, void *);

static void	qv_cursor(void *, int, int, int);
static int	qv_mapchar(void *, int, unsigned int *);
static void	qv_putchar(void *, int, int, u_int, long);
static void	qv_copycols(void *, int, int, int,int);
static void	qv_erasecols(void *, int, int, int, long);
static void	qv_copyrows(void *, int, int, int);
static void	qv_eraserows(void *, int, int, long);
static int	qv_allocattr(void *, int, int, int, long *);

const struct wsdisplay_emulops qv_emulops = {
	.cursor = qv_cursor,
	.mapchar = qv_mapchar,
	.putchar = qv_putchar,
	.copycols = qv_copycols,
	.erasecols = qv_erasecols,
	.copyrows = qv_copyrows,
	.eraserows = qv_eraserows,
	.allocattr = qv_allocattr
};

struct _wsscreen_descr {
        const struct wsscreen_descr qv_stdscreen;       /* MUST BE FIRST */
        const uint16_t qv_crtc_param[16];
};

/*
 * Notes from the original Ultrix drivers
 *
 * Screen controller initialization parameters. The definations [sic] and use
 * of these parameters can be found in the Motorola 68045 [sic] crtc specs. In
 * essence they set the display parameters for the chip. The first set is
 * for the 15" screen and the second is for the 19" separate sync. There
 * is also a third set for a 19" composite sync monitor which we have not
 * tested and which is not supported.
 */

const struct _wsscreen_descr qv_stdscreen[] = {
        { { "80x30", 80, 30, &qv_emulops, 8, 
                QV_CHEIGHT, WSSCREEN_UNDERLINE|WSSCREEN_REVERSE },
            { 31, 25, 27, 0142, 31, 13, 30, 31, 4, 15, 040, 0, 0, 0, 0, 0 } },
        { { "120x55", 120, 55, &qv_emulops, 8, 
                QV_CHEIGHT, WSSCREEN_UNDERLINE|WSSCREEN_REVERSE },
            { 39, 30, 32, 0262, 55, 5, 54, 54, 4, 15, 040, 0, 0, 0, 0, 0 } },
        { { "128x57", QV_COLS, QV_ROWS, &qv_emulops, 8, 
                QV_CHEIGHT, WSSCREEN_UNDERLINE|WSSCREEN_REVERSE },
            { 39, 32, 33, 0264, 56, 5, 54, 54, 4, 15, 040, 0, 0, 0, 0, 0 } },
};

const struct wsscreen_descr *_qv_scrlist[] = {
	&qv_stdscreen[2].qv_stdscreen,	/* default */
	&qv_stdscreen[1].qv_stdscreen,
	&qv_stdscreen[0].qv_stdscreen, 
};

const struct wsscreen_list qv_screenlist = {
	.nscreens = __arraycount(_qv_scrlist),
	.screens = _qv_scrlist,
};

struct qv_softc {
        device_t sc_dev;                /* device pointer */
        bus_space_tag_t sc_iot;         /* register base */
        bus_space_handle_t sc_ioh;
        bus_space_tag_t sc_fbt;         /* frame buffer base */
        bus_space_handle_t sc_fbh;
        paddr_t sc_fbphys;              /* frame buffer phys addr */
        char *sc_fb;                    /* frame buffer virt addr */
	uint16_t *sc_scanmap;		/* scan map virt addr */
        char *sc_font;                  /* font glyph table */
        
        uint8_t sc_curon;               /* cursor on */
        uint16_t sc_curx;               /* cursor x position */
        uint16_t sc_cury;               /* cursor y position */
        uint16_t sc_curhotX;            /* cursor x hot spot */
        uint16_t sc_curhotY;            /* cursor y hot spot */

        struct qv_screen *sc_curscr;    /* current screen */
};

#if 0
struct genfb_qv_softc {
	struct genfb_softc      sc_gen;
	bus_space_tag_t         sc_iot;
	bus_space_handle_t	sc_ioh;
	uint32_t		sc_wstype;
};
#endif

static void     qv_crtc_wr(struct qv_softc *, uint16_t, uint16_t);
static void     qv_setcrtc(struct qv_softc *, const uint16_t *);

static int	qv_ioctl(void *, void *, u_long, void *, int, struct lwp *);
static paddr_t	qv_mmap(void *, void *, off_t, int);
static int	qv_alloc_screen(void *, const struct wsscreen_descr *,
                         void **, int *, int *, long *);
static void	qv_free_screen(void *, void *);
static int	qv_show_screen(void *, void *, int,
				     void (*) (void *, int, int), void *);
//static void	qv_crsr_blink(void *);

int             qvauxprint(void *, const char *);

const struct wsdisplay_accessops qv_accessops = {
	.ioctl = qv_ioctl,
	.mmap = qv_mmap,
	.alloc_screen = qv_alloc_screen,
	.free_screen = qv_free_screen,
	.show_screen = qv_show_screen,
};

struct	qv_screen {
        struct qv_softc *ss_sc;
        const struct wsscreen_descr *ss_type;
	int	        ss_curx;
	int	        ss_cury;
	u_char	        ss_image[QV_ROWS][QV_COLS];	/* Image of screen */
	u_char	        ss_attr[QV_ROWS][QV_COLS];	/* Reversed etc... */
};

static	struct qv_screen qv_conscreen; /* XXX no console support */

static	callout_t qv_cursor_ch;

CFATTACH_DECL_NEW(qv, sizeof(struct qv_softc),
    qv_match, qv_attach, NULL, NULL);
#if 0
static int	genfb_match_qv(device_t, cfdata_t, void *);
static void	genfb_attach_qv(device_t, device_t, void *);
static int	genfb_ioctl_qv(void *, void *, u_long, void *, int,
    struct lwp*);
static paddr_t	genfb_mmap_qv(void *, void *, off_t, int);
static int      genfb_borrow_qv(void *, bus_addr_t, bus_space_handle_t *);

CFATTACH_DECL_NEW(genfb_qv, sizeof(struct genfb_qv_softc),
    genfb_match_qv, genfb_attach_qv, NULL, NULL);
#endif

/*
 * autoconf match function
 */
int
qv_match(device_t parent, cfdata_t match, void *aux)
{
        struct uba_attach_args *ua = aux;
        struct uba_softc *uh = device_private(parent);

        /* set up interrupts so the vector can be detected */

 	/* initialize qv interrupt controller */
 	qv_ic_init(ua, QV_IC);
 	
        /* set vertical retrace interrupt */ 	
        qv_ic_setvec(ua, QV_IC, QV_SYNC_VEC, uh->uh_lastiv - 4);
        qv_ic_enable(ua, QV_IC, QV_SYNC_VEC, QV_IC_ENA);
        qv_ic_arm(ua, QV_IC, QV_SYNC_VEC);

        /* enable interrupts */
	bus_space_write_2(ua->ua_iot, ua->ua_ioh, QV_CSR,
	        bus_space_read_2(ua->ua_iot, ua->ua_ioh, QV_CSR) | (1 << 6));

        qv_ic_force(ua, QV_IC, QV_SYNC_VEC);

	DELAY(20000);
	
        /* disable interrupts */
        qv_ic_enable(ua, QV_IC, QV_SYNC_VEC, QV_IC_DIS);

        return 1;
}

/* controller register write helper function */
static inline void
qv_reg_wr(struct qv_softc *sc, uint16_t addr, uint16_t data)
{
        bus_space_write_2(sc->sc_iot, sc->sc_ioh, addr, data);
}

/* controller register read helper function */
static inline uint16_t
qv_reg_rd(struct qv_softc *sc, uint16_t addr)
{
        return bus_space_read_2(sc->sc_iot, sc->sc_ioh, addr);
}

/*
 * write a 6845 CRT controller register
 */
static  void
qv_crtc_wr(struct qv_softc *sc, uint16_t addr, uint16_t data)
{
        qv_reg_wr(sc, QV_CRTC_AR, addr);
        qv_reg_wr(sc, QV_CRTC_DR, data);
}

/*
 * write a set of a set of video timing parameters to the CRTC
 */
static void
qv_setcrtc(struct qv_softc *sc, const uint16_t *pp)
{
        int i;

        for (i = 0; i < 14; i++)
                qv_crtc_wr(sc, i, pp[i]);
}

static void inline
qv_ic_write(struct uba_attach_args *ua, bus_size_t offs, uint16_t value)
{
        bus_space_write_2(ua->ua_iot, ua->ua_ioh, offs, value);
}

void
qv_ic_init(struct uba_attach_args *ua, bus_size_t offs)
{
        static int initted;
        int i;
        
        if (!initted) {
		/* init the interrupt controller */
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_RESET);
		/* reset irr			 */
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_CLRIRR);
		/* specify individual vectors	 */
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_MODE);
		/* preset autoclear data	 */
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_ACREG);
		/* all setup as autoclear	 */
	        qv_ic_write(ua, QV_IC_DR + offs, 0xff);

		/* clear all vector addresses */
                for (i = 0; i < 8; i++)                         
                        qv_ic_setvec(ua, offs, i, 0);
        
                initted = 1;
        }
}

void
qv_ic_setvec(struct uba_attach_args *ua, bus_size_t offs, int ic_vec,
    int vecnum)
{
	/* preset vector address	*/
	qv_ic_write(ua, QV_IC_SR + offs, QV_IC_RMEM | RMEM_BC_1 | ic_vec);

	/* give it the vector number	*/
	qv_ic_write(ua, QV_IC_DR + offs, vecnum);
}

void
qv_ic_enable(struct uba_attach_args *ua, bus_size_t offs, int ic_vec,
    int enable)
{
        if (enable)
		/* enable the interrupt */        
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_CIMR | ic_vec);
        else
		/* disable the interrupt */
	        qv_ic_write(ua, QV_IC_SR + offs, QV_IC_SIMR | ic_vec);
}

void
qv_ic_arm(struct uba_attach_args *ua, bus_size_t offs, int arm)
{
        if (arm) 
		/* arm the interrupt ctrl	*/
                qv_ic_write(ua, QV_IC_SR + offs, QV_IC_ARM);
        else
		/* disarm the interrupt ctrl	*/
                qv_ic_write(ua, QV_IC_SR + offs, QV_IC_DISARM);
}

void
qv_ic_force(struct uba_attach_args *ua, bus_size_t offs, int ic_vec)
{
	/* force an interrupt	*/
	qv_ic_write(ua, QV_IC_SR + offs, QV_IC_SIRR | ic_vec);
}

/*
 * print attachment message
 */
int
qvauxprint(void *aux, const char *pnp)
{
        if (pnp) {
                aprint_normal("qvaux at %s", pnp);
                return (UNCONF);
        }
        return 0;
}

/*
 * autoconf attach function
 */
void
qv_attach(device_t parent, device_t self, void *aux)
{
        struct qv_softc *sc = device_private(self);
        struct uba_softc *uh = device_private(parent);
        struct uba_attach_args *ua = aux;
        struct uba_attach_args aa;
	int fcookie;
        struct wsemuldisplaydev_attach_args emulaa;
//        struct wsdisplaydev_attach_args dispaa;
        struct wsdisplay_font *console_font;
	int line;

        sc->sc_dev = self;
        sc->sc_iot = ua->ua_iot;
        sc->sc_ioh = ua->ua_ioh;
        sc->sc_fbt = sc->sc_iot;
        sc->sc_fbphys = QMEMBASE + ((qv_reg_rd(sc, QV_CSR) & QV_CSR_BANK) << 7);
	if (bus_space_map(sc->sc_fbt, sc->sc_fbphys, QVSIZE, 
			BUS_SPACE_MAP_LINEAR, &sc->sc_fbh)) {
		aprint_error_dev(self, "Couldn't alloc graphics memory.\n");
		return;
	}
	
	aprint_normal(": fb %8lo", sc->sc_fbphys & 0x3fffff);
	sc->sc_fb = bus_space_vaddr(sc->sc_fbt, sc->sc_fbh);
	sc->sc_scanmap = (uint16_t *)&sc->sc_fb[QV_SCANMAP];
#if 0
	if (extent_alloc_region(((struct uba_vsoftc*)uh)->uv_sgmap.aps_ex,
			sc->sc_fbphys & 0x3fffff, QVSIZE, EX_WAITOK)) {
		aprint_error_dev(self, 
			"Couldn't alloc graphics memory in sgmap.\n");
		return;
	}
#endif
	//aprint_normal(": fb 0x%08lx", sc->sc_fbphys & 0x3fffff);

	bzero(sc->sc_fb, QVSIZE);
	
	for (line = 0; line < QV_YWIDTH; line++) {
	        sc->sc_scanmap[line] = line;
	}

        /* program crtc */
        qv_setcrtc(sc, qv_stdscreen[2].qv_crtc_param);
                
        /* enable video output */
        qv_reg_wr(sc, QV_CSR, qv_reg_rd(sc, QV_CSR) | (1 << 2) | (1 << 3));
#if 0
	if (sc->sc_curscr == NULL)
		callout_init(&qv_cursor_ch, 0);
	sc->sc_curscr = &qv_conscreen;

	callout_reset(&qv_cursor_ch, hz / 2, qv_crsr_blink, sc);
#endif
        /* interrupt handlers - XXX */

        uh->uh_lastiv -= 4;

        wsfont_init();
	if ((fcookie = wsfont_find(NULL, 8, 15, 0, WSDISPLAY_FONTORDER_R2L,
	    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP)) < 0) {
		aprint_error_dev(self, "could not find 8x15 font\n");
		return;
	}
	if (wsfont_lock(fcookie, &console_font) != 0) {
		aprint_error_dev(self, "could not lock 8x15 font\n");
		return;
	}
	sc->sc_font = console_font->data;

        aprint_normal("\n");

	aa.ua_iot = ua->ua_iot;
	aa.ua_ioh = ua->ua_ioh + 32; // offset
	aa.ua_cvec = ua->ua_cvec - 4;
	if (config_search(self, &aa,
			  CFARGS(.iattr = "qv")) != NULL) {
	        config_found(self, &aa, qvauxprint,
		    CFARGS(.iattr = "qv"));
                uh->uh_lastiv -= 4;
	}

	emulaa.console = 0; /* Not console */ 
	emulaa.scrdata = &qv_screenlist;
	emulaa.accessops = &qv_accessops;
	emulaa.accesscookie = self;
	if (config_search(self, &emulaa,
			  CFARGS(.iattr = "wsemuldisplaydev")) != NULL) {
	        config_found(self, &emulaa, wsemuldisplaydevprint,
		    CFARGS(.iattr = "wsemuldisplaydev"));
	}

        //console_debugger();
	return;
}

/* QVSS frame buffer */

/*      uint_32 is stored little endian in frame buffer */
/*      bits are stored little endian in frame buffer   */

/*      uint_32 *fb;                                     */
/*      fb = (int *)phystova(0x303c0000);                */
/*      *fb = 0x00000001; */ /* sets bit in first column */

/* Frame Buffer Usage */

/* characters are 8 bits wide and QVHEIGHT high */
/* the scan map is allocated in terms of character height, */
/* so a pointer to the top line of a character can step to the */
/* next row without looking up the memory location in the scan map */

static	char *cursor;
static	int cur_on;

/*
 * return pointer to line in character glyph
 */
static inline char *
qv_font(struct qv_softc *sc, int c, int line)
{
        /* map char to font table offset */
        if (c < 32)
                c = 32;
        else if (c > 127)
                c -= 66;
        else
                c -= 32;
        
        /* return pointer line in font glyph */        
        return &sc->sc_font[c*QV_CHEIGHT + line];
}

/*
 * return pointer to character line in frame buffer
 */
static inline char *
qv_fbp(struct qv_softc *sc, int row, int col, int line)
{
        return &sc->sc_fb[col + sc->sc_scanmap[row*QV_CHEIGHT + line]*QV_COLS];
}

/*
 * callout callback function to blink cursor
 */
#if 0
static void
qv_crsr_blink(void *arg)
{
        struct qv_softc *sc = arg;
        
	if (cur_on)
		*cursor ^= 255;
	callout_reset(&qv_cursor_ch, hz / 2, qv_crsr_blink, sc);
}
#endif
/*
 * emulop cursor
 */
void
qv_cursor(void *id, int on, int row, int col)
{
	struct qv_screen * const ss = id;

	if (ss == ss->ss_sc->sc_curscr) {
		*qv_fbp(ss->ss_sc, ss->ss_cury, ss->ss_curx, 14)
		    = *qv_font(ss->ss_sc, 
		        ss->ss_image[ss->ss_cury][ss->ss_curx], 14);
		cursor = qv_fbp(ss->ss_sc, row, col, 14);
		if ((cur_on = on))
			*cursor ^= 255;
	}
	ss->ss_curx = col;
	ss->ss_cury = row;
}

/*
 * emulop mapchar
 */
int
qv_mapchar(void *id, int uni, unsigned int *index)
{
	if (uni < 256) {
		*index = uni;
		return (5);
	}
	*index = ' ';
	return (0);
}

/*
 * emulop putchar
 */
static void
qv_putchar(void *id, int row, int col, u_int c, long attr)
{
	struct qv_screen * const ss = id;
	int i;
        char *gp;
        char *fp;
        char rvid;
        
	c &= 0xff;

	ss->ss_image[row][col] = c;
	ss->ss_attr[row][col] = attr;
	if (ss != ss->ss_sc->sc_curscr)
		return;

        gp = qv_font(ss->ss_sc, c, 0);
        fp = qv_fbp(ss->ss_sc, row, col, 0);
        rvid = (attr & WSATTR_REVERSE) ? 0xff : 0x00;
        for (i = 0; i < QV_CHEIGHT; i++) {
                *fp = *gp++ ^ rvid;
                fp += QV_COLS;
        }

	if (attr & WSATTR_UNDERLINE)
	        *qv_fbp(ss->ss_sc, row, col, 14) 
	            ^= *qv_fbp(ss->ss_sc, row, col, 14);
}

/*
 * emulop copy columns - copies columns inside a row
 */
static void
qv_copycols(void *id, int row, int srccol, int dstcol, int ncols)
{
	struct qv_screen * const ss = id;
	int i;

	memcpy(&ss->ss_image[row][dstcol], &ss->ss_image[row][srccol], ncols);
	memcpy(&ss->ss_attr[row][dstcol], &ss->ss_attr[row][srccol], ncols);
	if (ss != ss->ss_sc->sc_curscr)
		return;
	for (i = 0; i < QV_CHEIGHT; i++)
	        memcpy(qv_fbp(ss->ss_sc, row, dstcol, i),
	            qv_fbp(ss->ss_sc, row, srccol, i), ncols);
}

/*
 * emulop erase columns - erases a bunch of chars inside one row
 */
static void
qv_erasecols(void *id, int row, int startcol, int ncols, long fillattr)
{
	struct qv_screen * const ss = id;
	int i;

	memset(&ss->ss_image[row][startcol], 0, ncols);
	memset(&ss->ss_attr[row][startcol], 0, ncols);
	if (ss != ss->ss_sc->sc_curscr)
		return;
	for (i = 0; i < QV_CHEIGHT; i++)
	        memset(qv_fbp(ss->ss_sc, row, startcol, i), 0, ncols);
}

/*
 * overlap check
 * return 0 if no overlap
 *        -1 if overlap and dst is less than src (move up)
 * 	  +1 if overlap and src is less than dst (move down)
 */
static inline int
qv_rows_overlap(int srcrow, int dstrow, int nrows)
{
	if (dstrow < srcrow) {
		if (dstrow + nrows <= srcrow)
			return 0;
		else
			return -1;
	}
	else {
		if (srcrow + nrows <= dstrow)
			return 0;
		else
			return 1;
	}
}

/*
 * emulop copyrows - copy entire rows
 */
static void
qv_copyrows(void *id, int srcrow, int dstrow, int nrows)
{
	struct qv_screen * const ss = id;
	int ol;
	int n;
	int line;
	int tmp;
	uint16_t *sp;
	uint16_t *dp;

	memcpy(&ss->ss_image[dstrow][0], &ss->ss_image[srcrow][0],
	    nrows * QV_COLS);
	memcpy(&ss->ss_attr[dstrow][0], &ss->ss_attr[srcrow][0],
	    nrows * QV_COLS);
	if (ss != ss->ss_sc->sc_curscr)
		return;
	
	ol = qv_rows_overlap(srcrow, dstrow, nrows);
	if (ol == 0)
		for (n = 0; n < nrows; n++)
			bcopy(qv_fbp(ss->ss_sc, srcrow + n, 0, 0),
	    		    qv_fbp(ss->ss_sc, dstrow + n, 0, 0), QV_NEXTROW);
	else if (ol < 0) {
	 	for (n = 0; n < nrows; n++) {
			dp = &ss->ss_sc->sc_scanmap[(dstrow + n)*QV_CHEIGHT];
			sp = &ss->ss_sc->sc_scanmap[(srcrow + n)*QV_CHEIGHT];
			for (line = 0; line < QV_CHEIGHT; line++) {
				tmp = *dp;
				*dp = *sp;
				*sp = tmp;
				dp++;
				sp++;
			}
		}	
		qv_copyrows(id, dstrow + nrows - srcrow + dstrow, 
		    dstrow + nrows, srcrow - dstrow);
	}
	else {
	 	for (n = nrows - 1; n >= 0; n--) {
			dp = &ss->ss_sc->sc_scanmap[(dstrow + n)*QV_CHEIGHT];
			sp = &ss->ss_sc->sc_scanmap[(srcrow + n)*QV_CHEIGHT];
			for (line = 0; line < QV_CHEIGHT; line++) {
				tmp = *dp;
				*dp = *sp;
				*sp = tmp;
				dp++;
				sp++;
			}
		}	
		qv_copyrows(id, srcrow, dstrow, dstrow - srcrow);
	}
}

/*
 * emulop eraserows - erase a number of entire rows
 */
static void
qv_eraserows(void *id, int startrow, int nrows, long fillattr)
{
	struct qv_screen * const ss = id;
	int row;

	memset(&ss->ss_image[startrow][0], 0, nrows * QV_COLS);
	memset(&ss->ss_attr[startrow][0], 0, nrows * QV_COLS);
	if (ss != ss->ss_sc->sc_curscr)
		return;
        
	for (row = startrow; row < startrow + nrows; row++) {
	        memset(qv_fbp(ss->ss_sc, row, 0, 0), 0, QV_NEXTROW);
	}
}

/*
 * emulop allocattr
 */
static int
qv_allocattr(void *id, int fg, int bg, int flags, long *attrp)
{
	*attrp = flags;
	return 0;
}

/*
 * emulop setcursor
 */
static void
qv_setcursor(struct qv_softc *sc, struct wsdisplay_cursor *v)
{
	uint16_t red, green, blue;
	uint32_t curfg[16], curmask[16];
	uint16_t *curp;
	int i;

	/* Enable cursor */
	if (v->which & WSDISPLAY_CURSOR_DOCUR) {
	        sc->sc_curon = (v->enable) ? CUR_ON : CUR_OFF;
	        qv_crtc_wr(sc, CUR_START, sc->sc_curon | (sc->sc_cury & 0x0f));
	}
	if (v->which & WSDISPLAY_CURSOR_DOHOT) {
		sc->sc_curhotX = v->hot.x;
		sc->sc_curhotY = v->hot.y;
	}
	if (v->which & WSDISPLAY_CURSOR_DOCMAP) {
		/* First background */
		if (copyin(v->cmap.red, &red, sizeof(red)) == 0 &&
		    copyin(v->cmap.green, &green, sizeof(green)) == 0 &&
		    copyin(v->cmap.blue, &blue, sizeof(blue)) == 0) {
			bgmask = (((30L * red + 59L * green + 11L * blue) >> 8)
			    >= (((1<<8)-1)*50)) ? ~0 : 0;
		}
		if (copyin(v->cmap.red + 2, &red, sizeof(red)) == 0 &&
		    copyin(v->cmap.green + 2, &green, sizeof(green)) == 0 &&
		    copyin(v->cmap.blue + 2, &blue, sizeof(blue)) == 0) {
			fgmask = (((30L * red + 59L * green + 11L * blue) >> 8)
			    >= (((1<<8)-1)*50)) ? ~0 : 0;
		}
	}
	if (v->which & WSDISPLAY_CURSOR_DOSHAPE) {
		copyin(v->image, curfg, sizeof(curfg));
		copyin(v->mask, curmask, sizeof(curmask));      /* not used */
	        curp = (uint16_t *) &(sc->sc_fb)[QV_CURSRAM];
		for (i = 0; i < sizeof(curfg)/sizeof(curfg[0]); i++) {
		        curp[i] = (uint16_t)curfg[i];
		}
	}
}

/*
 * emulop ioctl
 */
int
qv_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
{
	struct wsdisplay_fbinfo *fb = (void *)data;
	//static uint16_t curc;
        struct qv_softc *sc = device_private(v);

	switch (cmd) {
	case WSDISPLAYIO_GTYPE:
		*(u_int *)data = WSDISPLAY_TYPE_VAX_MONO;
		break;

	case WSDISPLAYIO_GINFO:
		fb->height = QV_YWIDTH;
		fb->width = QV_XWIDTH;
		fb->depth = 1;
		fb->cmsize = 2;
		break;

	case WSDISPLAYIO_SVIDEO:
		if (*(u_int *)data == WSDISPLAYIO_VIDEO_ON) {
                        /* enable video output */
  		        qv_reg_wr(sc, QV_CSR, 
  		            qv_reg_rd(sc, QV_CSR) | (1 << 2));
		} else {
                        /* disable video output */
                        qv_reg_wr(sc, QV_CSR, 
                            qv_reg_rd(sc, QV_CSR) & ~(1 << 2));
		}
		break;

	case WSDISPLAYIO_GVIDEO:
		*(u_int *)data = (qv_reg_rd(sc, QV_CSR) & (1 << 2))
		    ? WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
		break;

	case WSDISPLAYIO_SCURSOR:
		qv_setcursor(sc, (struct wsdisplay_cursor *)data);
		break;

	case WSDISPLAYIO_SCURPOS:
	        sc->sc_curx = ((struct wsdisplay_curpos *)data)->x;
		sc->sc_cury = ((struct wsdisplay_curpos *)data)->y;
                qv_crtc_wr(sc, CUR_START, CUR_OFF | (sc->sc_cury & 0x0f));
                qv_crtc_wr(sc, CUR_HI, sc->sc_cury >> 4);
                qv_reg_wr(sc, QV_CUR_X, sc->sc_curx);
                qv_crtc_wr(sc, CUR_START, 
                    sc->sc_curon | (sc->sc_cury & 0x0f));
		break;

	case WSDISPLAYIO_GCURPOS:
		((struct wsdisplay_curpos *)data)->x = sc->sc_curx;
		((struct wsdisplay_curpos *)data)->y = sc->sc_cury;
		break;

	case WSDISPLAYIO_GCURMAX:
		((struct wsdisplay_curpos *)data)->x = 16;
		((struct wsdisplay_curpos *)data)->y = 16;
		break;

	default:
		return EPASSTHROUGH;
	}
	return 0;
}

/*
 * emulop mmap
 */
static paddr_t
qv_mmap(void *v, void *vs, off_t offset, int prot)
{
        struct qv_softc *sc = device_private(v);
        
	if (offset >= QVSIZE || offset < 0)
		return -1;
	return (sc->sc_fbphys) >> PGSHIFT;
}

/*
 * emulop allocate screen
 */
int
qv_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    int *curxp, int *curyp, long *defattrp)
{
        struct qv_softc *sc = device_private(v);
        struct qv_screen *ss;

	ss = kmem_zalloc(sizeof(struct qv_screen), KM_SLEEP);
	ss->ss_sc = sc;
	ss->ss_type = type;
	*cookiep = ss;
	*curxp = *curyp = *defattrp = 0;
        printf("qv_alloc_screen: \"%s\" %p\n", type->name, ss);
	return 0;
}

/*
 * emulop free screen
 */
void
qv_free_screen(void *v, void *cookie)
{
        printf("qv_free_screen: %p\n", cookie);
        kmem_free(cookie, sizeof(struct qv_screen));
}

/*
 * emulop show screen
 */
int
qv_show_screen(void *v, void *cookie, int waitok,
    void (*cb)(void *, int, int), void *cbarg)
{
	struct qv_screen *ss = cookie;
	const struct _wsscreen_descr *descr;
	int row, col, line;
        printf("qv_show_screen: %p\n", cookie);

	if (ss == ss->ss_sc->sc_curscr)
		return (0);

        descr = (const struct _wsscreen_descr *)(ss->ss_type);
        qv_setcrtc(ss->ss_sc, descr->qv_crtc_param);
	for (row = 0; row < QV_ROWS; row++)
		for (line = 0; line < QV_CHEIGHT; line++) {
			for (col = 0; col < QV_COLS; col++) {
				u_char s, c = ss->ss_image[row][col];

				if (c < 32)
					c = 32;
				s = *qv_font(ss->ss_sc, c, line);
				if (ss->ss_attr[row][col] & WSATTR_REVERSE)
					s ^= 255;
				*qv_fbp(ss->ss_sc, row, col, line) = s;

				if (ss->ss_attr[row][col] & WSATTR_UNDERLINE)
					*qv_fbp(ss->ss_sc, row, col, line)
					    = 255;
			}
		}
        cursor = qv_fbp(ss->ss_sc, ss->ss_cury, ss->ss_curx, 14);
	ss->ss_sc->sc_curscr = ss;
	return (0);
}

#if 0
void
qv_reset_establish(void (*reset)(device_t), device_t dev)
{
        uba_reset_establish(reset, device_parent(dev));
}
#endif
cons_decl(qv);

void
qvcninit(struct consdev *cndev)
{
	int fcookie;
	struct wsdisplay_font *console_font;
	extern void lkccninit(struct consdev *);
	extern int lkccngetc(dev_t);
	extern int dz_vsbus_lk201_cnattach(int);

        //printf("qvcninit: \n");
	/* Clear screen */
	//memset(qv_addr, 0, 128*864);

	callout_init(&qv_cursor_ch, 0);
	//curscr = &qv_conscreen;
	wsdisplay_cnattach(&qv_stdscreen[0].qv_stdscreen, 
	    &qv_conscreen, 0, 0, 0);
	cn_tab->cn_pri = CN_INTERNAL;
	wsfont_init();
	if ((fcookie = wsfont_find(NULL, 8, 15, 0, WSDISPLAY_FONTORDER_R2L,
	    WSDISPLAY_FONTORDER_L2R, WSFONT_FIND_BITMAP)) < 0)
	{
		printf("qv: could not find 8x15 font\n");
		return;
	}
	if (wsfont_lock(fcookie, &console_font) != 0) {
		printf("qv: could not lock 8x15 font\n");
		return;
	}
	//qf = console_font->data;

#if NQVKBD > 0 && 0
	qvkbd_cnattach(0); /* Connect keyboard and screen together */
#endif
}

/*
 * Called very early to setup the glass tty as console.
 * Because it's called before the VM system is inited, virtual memory
 * for the framebuffer can be stolen directly without disturbing anything.
 */
void
qvcnprobe(struct consdev *cndev)
{
        printf("qvcnprobe: \n");
#if 0
	extern vaddr_t virtual_avail;
	extern const struct cdevsw wsdisplay_cdevsw;

	switch (vax_boardtype) {
	case VAX_BTYP_410:
	case VAX_BTYP_420:
	case VAX_BTYP_43:
		if ((vax_confdata & KA420_CFG_L3CON) ||
		    (vax_confdata & KA420_CFG_MULTU))
			break; /* doesn't use graphics console */
		qv_addr = (void *)virtual_avail;
		virtual_avail += QVSIZE;
		ioaccess((vaddr_t)qv_addr, QVADDR, (QVSIZE/VAX_NBPG));
		cndev->cn_pri = CN_INTERNAL;
		cndev->cn_dev = makedev(cdevsw_lookup_major(&wsdisplay_cdevsw),
					0);
		break;
	default:
		break;
	}
#endif 
}
