/*      $NetBSD: summitfb.c,v 1.43 2026/07/12 10:16:36 macallan Exp $   */

/*      $OpenBSD: sti_pci.c,v 1.7 2009/02/06 22:51:04 miod Exp $        */

/*
 * Copyright (c) 2006, 2007 Miodrag Vallat.
 ^                     2024 Michael Lorenz
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice, this permission notice, and the disclaimer below
 * appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

/*
 * a native driver for HP Visualize FX graphics cards, so far tested only on
 * my FX4
 * STI portions are from Miodrag Vallat's sti_pci.c
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: summitfb.c,v 1.43 2026/07/12 10:16:36 macallan Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kmem.h>
#include <sys/device.h>
#include <sys/mutex.h>

#include <dev/pci/pcivar.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/pciio.h>

#include <dev/wscons/wsdisplayvar.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wsfont/wsfont.h>
#include <dev/rasops/rasops.h>
#include <dev/wscons/wsdisplay_vconsvar.h>
#include <dev/pci/wsdisplay_pci.h>
#include <dev/wscons/wsdisplay_glyphcachevar.h>

#include <dev/ic/stireg.h>
#include <dev/ic/summitreg.h>
#include <dev/ic/stivar.h>
#include <hppa/dev/sti_pci_var.h>

#include "opt_summitfb.h"

#ifdef SUMMITFB_DEBUG
#define DPRINTF(s) printf s
#else
#define DPRINTF(s) __nothing
#endif

int     summitfb_match(device_t, cfdata_t, void *);
void    summitfb_attach(device_t, device_t, void *);

struct  summitfb_softc {
        device_t                sc_dev;
        pci_chipset_tag_t       sc_pc;
        pcitag_t                sc_tag;

        /* stuff we need in order to use the STI ROM */
        struct sti_softc        sc_base;
        struct sti_screen       sc_scr;
        bus_space_handle_t      sc_romh;
        uint32_t                sc_gid;

        int sc_width, sc_height;
        int sc_locked, sc_is_lego;
        struct vcons_screen sc_console_screen;
        struct wsscreen_descr sc_defaultscreen_descr;
        const struct wsscreen_descr *sc_screens[1];
        struct wsscreen_list sc_screenlist;
        struct vcons_data vd;
        int sc_mode, sc_fbdepth;
        u_char sc_cmap_red[256];
        u_char sc_cmap_green[256];
        u_char sc_cmap_blue[256];
        uint32_t sc_write_mode, sc_read_mode;
        /* cursor stuff */
        int sc_cursor_x, sc_cursor_y;
        int sc_hot_x, sc_hot_y, sc_enabled;
        uint32_t sc_palette[16];
        int sc_video_on;
        glyphcache sc_gc;
};

CFATTACH_DECL_NEW(summitfb, sizeof(struct summitfb_softc),
    summitfb_match, summitfb_attach, NULL, NULL);

void    summitfb_enable_rom(struct sti_softc *);
void    summitfb_disable_rom(struct sti_softc *);

void    summitfb_setup(struct summitfb_softc *);

/* XXX these really need to go into their own header */
int     sti_rom_setup(struct sti_rom *, bus_space_tag_t, bus_space_tag_t,
            bus_space_handle_t, bus_addr_t *, u_int);
int     sti_screen_setup(struct sti_screen *, int);
void    sti_describe_screen(struct sti_softc *, struct sti_screen *);

/* wsdisplay stuff */
static int      summitfb_ioctl(void *, void *, u_long, void *, int,
                    struct lwp *);
static paddr_t  summitfb_mmap(void *, void *, off_t, int);
static void     summitfb_init_screen(void *, struct vcons_screen *, int,
                    long *);

static int      summitfb_putcmap(struct summitfb_softc *,
                    struct wsdisplay_cmap *);
static int      summitfb_getcmap(struct summitfb_softc *,
                    struct wsdisplay_cmap *);
static void     summitfb_restore_palette(struct summitfb_softc *);
static int      summitfb_putpalreg(struct summitfb_softc *, uint8_t, uint8_t,
                    uint8_t, uint8_t);

static inline void summitfb_setup_fb(struct summitfb_softc *);
static void     summitfb_clearfb(struct summitfb_softc *);
static void     summitfb_rectfill(struct summitfb_softc *, int, int, int, int,
                    uint32_t);
static void     summitfb_rectfill_a(void *, int, int, int, int, long);
static void     summitfb_bitblt(void *, int, int, int, int, int,
                    int, int);

static void     summitfb_cursor(void *, int, int, int);
static void     summitfb_putchar(void *, int, int, u_int, long);
static void     summitfb_putchar_aa(void *, int, int, u_int, long);
static int      summitfb_allocattr(void *, int, int, int, long *);
static void     summitfb_copycols(void *, int, int, int, int);
static void     summitfb_erasecols(void *, int, int, int, long);
static void     summitfb_copyrows(void *, int, int, int);
static void     summitfb_eraserows(void *, int, int, long);

static void     summitfb_move_cursor(struct summitfb_softc *, int, int);
static int      summitfb_do_cursor(struct summitfb_softc *,
                    struct wsdisplay_cursor *);

static void     summitfb_set_video(struct summitfb_softc *, int);

static void     summitfb_copyfont(struct summitfb_softc *);

struct wsdisplay_accessops summitfb_accessops = {
        .ioctl = summitfb_ioctl,
        .mmap = summitfb_mmap,
        .alloc_screen = NULL,
        .free_screen = NULL,
        .show_screen = NULL,
        .load_font = NULL,
        .pollc = NULL,
        .scroll = NULL,
};

static inline void summitfb_wait_fifo(struct summitfb_softc *, uint32_t);
static inline void summitfb_wait(struct summitfb_softc *);

int     sti_fetchfonts(struct sti_screen *, struct sti_inqconfout *, uint32_t,
            u_int);

int
summitfb_match(device_t parent, cfdata_t cf, void *aux)
{
        struct pci_attach_args *paa = aux;

        if (PCI_VENDOR(paa->pa_id) != PCI_VENDOR_HP)
                return 0;

        if (PCI_PRODUCT(paa->pa_id) == PCI_PRODUCT_HP_VISUALIZE_FX4)
                return 10;      /* beat out sti at pci */

        return 0;
}

static inline uint32_t
summitfb_read4(struct summitfb_softc *sc, uint32_t offset)
{
        struct sti_rom *rom = sc->sc_base.sc_rom;
        bus_space_tag_t memt = rom->memt;
        bus_space_handle_t memh = rom->regh[2];

        return bus_space_read_stream_4(memt, memh, offset - 0x400000);
}

static inline void
summitfb_write4(struct summitfb_softc *sc, uint32_t offset, uint32_t val)
{
        struct sti_rom *rom = sc->sc_base.sc_rom;
        bus_space_tag_t memt = rom->memt;
        bus_space_handle_t memh = rom->regh[2];

        bus_space_write_stream_4(memt, memh, offset - 0x400000, val);
}

static inline void
summitfb_write_mode(struct summitfb_softc *sc, uint32_t mode)
{
        if (sc->sc_write_mode == mode)
                return;
        summitfb_wait(sc);
        summitfb_write4(sc, VISFX_VRAM_WRITE_MODE, mode);
        sc->sc_write_mode = mode;
}

static inline void
summitfb_read_mode(struct summitfb_softc *sc, uint32_t mode)
{
        if (sc->sc_read_mode == mode)
                return;
        summitfb_wait(sc);
        summitfb_write4(sc, VISFX_VRAM_READ_MODE, mode);
        sc->sc_read_mode = mode;
}

void
summitfb_attach(device_t parent, device_t self, void *aux)
{
        struct summitfb_softc *sc = device_private(self);
        struct pci_attach_args *paa = aux;
        struct sti_rom *rom;
        struct rasops_info *ri;
        struct wsemuldisplaydev_attach_args aa;
        struct sti_dd *dd;
        bus_size_t romsize;
        unsigned long defattr = 0;
        int ret, is_console = 0;

        sc->sc_dev = self;

        sc->sc_pc = paa->pa_pc;
        sc->sc_tag = paa->pa_tag;
        sc->sc_base.sc_dev = self;
        sc->sc_base.sc_enable_rom = summitfb_enable_rom;
        sc->sc_base.sc_disable_rom = summitfb_disable_rom;

        aprint_normal("\n");

        if (sti_pci_check_rom(&sc->sc_base, paa, &sc->sc_romh, &romsize) != 0)
                return;

        ret = sti_pci_is_console(paa, sc->sc_base. bases);
        if (ret != 0) {
                sc->sc_base.sc_flags |= STI_CONSOLE;
                is_console = 1;
        }
        rom = kmem_zalloc(sizeof(*rom), KM_SLEEP);
        rom->rom_softc = &sc->sc_base;
        ret = sti_rom_setup(rom, paa->pa_iot, paa->pa_memt, sc->sc_romh,
            sc->sc_base.bases, STI_CODEBASE_MAIN);
        if (ret != 0) {
                kmem_free(rom, sizeof(*rom));
                return;
        }

        sc->sc_base.sc_rom = rom;
        dd = &rom->rom_dd;

        sc->sc_scr.scr_rom = sc->sc_base.sc_rom;
        ret = sti_screen_setup(&sc->sc_scr, STI_FBMODE);

        sti_fetchfonts(&sc->sc_scr, NULL, dd->dd_fntaddr, 0);
        wsfont_init();
        summitfb_copyfont(sc);
        sc->sc_gid = sc->sc_scr.scr_rom->rom_dd.dd_grid[0];
        /* see if this is a FX2/4/6 or FX5/10 */
        sc->sc_is_lego = sc->sc_gid == STI_DD_LEGO;
        printf("%s: gid %08x lego %d\n", __func__,
            sc->sc_gid, sc->sc_is_lego); 

        //bus_space_unmap(paa->pa_memt, sc->sc_romh, romsize);

        sc->sc_width = sc->sc_scr.scr_cfg.scr_width;
        sc->sc_height = sc->sc_scr.scr_cfg.scr_height;
        sc->sc_write_mode = 0xffffffff;
        sc->sc_read_mode = 0xffffffff;

#ifdef SUMMITFB_DEBUG
        sc->sc_height -= 200;
#endif

        sc->sc_defaultscreen_descr = (struct wsscreen_descr){
                .name = "default",
                .ncols = 0, .nrows = 0,
                .textops = NULL,
                .fontwidth = 8, .fontheight = 16,
                .capabilities = WSSCREEN_WSCOLORS | WSSCREEN_HILIT |
                    WSSCREEN_UNDERLINE | WSSCREEN_RESIZE,
                .modecookie = NULL,
        };

        sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
        sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
        sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
        sc->sc_fbdepth = 32;
        sc->sc_locked = 0;

        vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
            &summitfb_accessops);
        sc->vd.init_screen = summitfb_init_screen;
        sc->vd.show_screen_cookie = &sc->sc_gc;
        sc->vd.show_screen_cb = glyphcache_adapt;
        ri = &sc->sc_console_screen.scr_ri;

        sc->sc_gc.gc_bitblt = summitfb_bitblt;
        sc->sc_gc.gc_rectfill = summitfb_rectfill_a;
        sc->sc_gc.gc_blitcookie = sc;
        sc->sc_gc.gc_rop = RopSrc;

        summitfb_setup(sc);

        vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, &defattr);
        sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;

        sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
        sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
        sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
        sc->sc_defaultscreen_descr.ncols = ri->ri_cols;

        /*
         * STI lies to us - it reports a 2048x2048 framebuffer but blitter
         * ops wrap around below 1024 and we seem to have only about 250
         * usable columns to the right. Should still be enough to cache
         * a font or four.
         * So, the framebuffer seems to be 1536x1024, which is odd since the
         * FX4 is supposed to support resolutions higher than 1280x1024.
         * I guess video memory is allocated in 512x512 chunks
         */
        glyphcache_init(&sc->sc_gc,
            sc->sc_height,
            sc->sc_height,
            (sc->sc_width + 511) & (~511),
            ri->ri_font->fontwidth,
            ri->ri_font->fontheight,
            defattr);

        summitfb_restore_palette(sc);
        summitfb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height,
            ri->ri_devcmap[(defattr >> 16) & 0xff]);
        summitfb_setup_fb(sc);

        if (is_console) {
                wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
                    defattr);

                vcons_replay_msgbuf(&sc->sc_console_screen);
        }

        aprint_normal_dev(sc->sc_dev, "%s at %dx%d\n", sc->sc_scr.name,
            sc->sc_width, sc->sc_height);

        /* no suspend/resume support yet */
        pmf_device_register(sc->sc_dev, NULL, NULL);

        aa.console = is_console;
        aa.scrdata = &sc->sc_screenlist;
        aa.accessops = &summitfb_accessops;
        aa.accesscookie = &sc->vd;

        config_found(sc->sc_dev, &aa, wsemuldisplaydevprint, CFARGS_NONE);
}

/*
 * Enable PCI ROM.
 */

void
summitfb_enable_rom(struct sti_softc *sc)
{
        struct summitfb_softc *spc = device_private(sc->sc_dev);
        uint32_t address;

        if (!ISSET(sc->sc_flags, STI_ROM_ENABLED)) {
                address = pci_conf_read(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM);
                address |= PCI_MAPREG_ROM_ENABLE;
                pci_conf_write(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM, address);
        }
        SET(sc->sc_flags, STI_ROM_ENABLED);
}

/*
 * Disable PCI ROM.
 */

void
summitfb_disable_rom(struct sti_softc *sc)
{
        struct summitfb_softc *spc = device_private(sc->sc_dev);
        uint32_t address;

        if (ISSET(sc->sc_flags, STI_ROM_ENABLED)) {
                address = pci_conf_read(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM);
                address &= ~PCI_MAPREG_ROM_ENABLE;
                pci_conf_write(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM, address);
        }
        CLR(sc->sc_flags, STI_ROM_ENABLED);
}

static inline void
summitfb_wait(struct summitfb_softc *sc)
{

        while (summitfb_read4(sc, VISFX_STATUS) != 0)
                continue;
}

static inline void
summitfb_setup_fb(struct summitfb_softc *sc)
{

        summitfb_wait(sc);
        if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
                if (sc->sc_is_lego) {
                        // turn off swapping
                        summitfb_write4(sc, B2_DMA_BSCFB, SWAP_0123);
                        summitfb_write4(sc, B2_PDU_BSCFB, SWAP_0123);
                }
                summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
                summitfb_read_mode(sc, VISFX_WRITE_MODE_PLAIN);
                summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_8);
                /* make overlay opaque */
                summitfb_write4(sc, VISFX_OTR, OTR_T | OTR_L1 | OTR_L0);
        } else {
                if (sc->sc_is_lego) {
                        /* on FX5/10 we use the image planes in 8bit for now */ 
                        summitfb_write_mode(sc, OTC04 | BIN8I | BUFFL);
                        summitfb_read_mode(sc, OTC04 | BIN8I | BUFFL);
                        summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_8);
                        /* turn off overlay */
                        summitfb_write4(sc, VISFX_OTR, OTR_A);
                        /* turn on swapping */
                        summitfb_write4(sc, B2_DMA_BSCFB, SWAP_3210);
                        summitfb_write4(sc, B2_PDU_BSCFB, SWAP_3210);
                } else {
                        /*
                         * on FX2/4/6 turn off the overlay and expose the
                         * 24bit framebuffer
                         */
                        if (sc->sc_fbdepth == 32) {
                                summitfb_write_mode(sc, OTC01 | BIN8F | BUFFL);
                                summitfb_read_mode(sc, OTC01 | BIN8F | BUFFL);
                                summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_32);
                                /* make overlay transparent */
                                summitfb_write4(sc, VISFX_OTR, OTR_A);
                        } else {
                                summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
                                summitfb_read_mode(sc, VISFX_WRITE_MODE_PLAIN);
                                summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_8);
                                /* make overlay opaque */
                                summitfb_write4(sc, VISFX_OTR, OTR_T | OTR_L1 | OTR_L0);

                        }
                }
        }
        summitfb_write4(sc, VISFX_IBO, RopSrc);
}

void
summitfb_setup(struct summitfb_softc *sc)
{
        int i;

        sc->sc_hot_x = 0;
        sc->sc_hot_y = 0;
        sc->sc_enabled = 0;
        sc->sc_video_on = 1;

        summitfb_wait(sc);
#if 1
        /* these control byte swapping */
        if(sc->sc_is_lego) {
                /* disable blanket swapper */
                summitfb_write4(sc, B2_DMA_BSCSAV, 0);
                summitfb_write4(sc, B2_DMA_BSCBLK, 0);
                /* no swapping for buffered access */
                summitfb_write4(sc, B2_DMA_BSCFB, SWAP_0123);
                summitfb_write4(sc, B2_PDU_BSCFB, SWAP_0123);
                /* no swapping for unbuffered */
                summitfb_write4(sc, UB_DMA_UBSCFB, SWAP_0123);
                summitfb_write4(sc, UB_PDU_UBSCFB, SWAP_0123);
                /* don't swap register accesses */
                summitfb_write4(sc, B2_MFU_BSCTD, SWAP_0123);
                summitfb_write4(sc, B2_MFU_BSCCTL, SWAP_0123);
                /*  */
                summitfb_write4(sc, VISFX_RBS, SWAP_3210);
        } else {
                summitfb_write4(sc, B2_MFU_BSCTD, 0x1b);
                summitfb_write4(sc, B2_MFU_BSCCTL, 0x1b);
                summitfb_write4(sc, 0x920860, 0xe4);    /* FBC_RBS */
        }

        summitfb_write4(sc, 0x921114, 0);       /* CPE, clip plane enable */
        summitfb_write4(sc, 0x9211d8, 0);       /* FCDA */

        summitfb_write4(sc, 0xa00818, 0);       /* WORG window origin */
        summitfb_write4(sc, 0xa0081c, 0);       /* FBS front buffer select*/
        summitfb_write4(sc, 0xa00850, 0);       /* MISC_CTL */
        summitfb_write4(sc, 0xa0086c, 0);       /* WCE window clipping enable */
#endif
        /* initialize drawing engine */
        summitfb_wait(sc);
        summitfb_write4(sc, VISFX_CONTROL, 0);  // clear WFC
        summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_8);
        summitfb_write4(sc, VISFX_PIXEL_MASK, 0xffffffff);
        summitfb_write4(sc, VISFX_PLANE_MASK, 0xffffffff);
        summitfb_write4(sc, VISFX_FOE, FOE_BLEND_ROP);
        summitfb_write4(sc, VISFX_IBO, RopSrc);
        summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
        summitfb_read_mode(sc, OTC04 | BIN8I | BUFovl);
        summitfb_write4(sc, VISFX_CLIP_TL, 0);
        summitfb_write4(sc, VISFX_CLIP_WH,
            ((sc->sc_scr.fbwidth) << 16) | (sc->sc_scr.fbheight));
        /* turn off the cursor sprite */
        summitfb_write4(sc, VISFX_CURSOR_POS, 0);
        /* disable throttling by moving the throttle window way off screen */
        summitfb_write4(sc, VISFX_TCR, 0x10001000);

        /* make sure the overlay is opaque */
        summitfb_write4(sc, VISFX_OTR, OTR_T | OTR_L1 | OTR_L0);

        /* zero the attribute plane */
        summitfb_write_mode(sc, OTC32 | BINapln);
        summitfb_wait_fifo(sc, 12);
        summitfb_write4(sc, VISFX_PLANE_MASK, 0xff);
        summitfb_write4(sc, VISFX_IBO, RopSrc);
        summitfb_write4(sc, VISFX_FG_COLOUR, 0);
        summitfb_write4(sc, VISFX_START, 0);
        summitfb_write4(sc, VISFX_SIZE, (sc->sc_width << 16) | sc->sc_height);
        summitfb_wait(sc);
        summitfb_write4(sc, VISFX_PLANE_MASK, 0xffffffff);

        /*
         * initialize XLUT, I mean attribute table
         * set all to 24bit, CFS1
         */
        if (!sc->sc_is_lego) {
                /*
                 * we don't know (yet) how any of this works on FX5/10, so only
                 * do it on FX2/4/6
                 */
                for (i = 0; i < 16; i++) {
                        summitfb_write4(sc, VISFX_IAA(i), IAA_8F | IAA_CFS1);
                        /* RGB8, no LUT */
                        summitfb_write4(sc, VISFX_CFS(i), CFS_8F | CFS_BYPASS);
                }
                /* overlay is 8bit, uses RGB332 */
                summitfb_write4(sc, VISFX_CFS(16), CFS_332 | CFS_BYPASS);
                summitfb_write4(sc, VISFX_CFS(17), CFS_332 | CFS_BYPASS);


                /* turn off force attr so the above takes effect */
                summitfb_write4(sc, VISFX_FATTR, 0);
        } else {
                summitfb_write4(sc, VISFX_CFS(1), CFS_8I | CFS_LUT1);
                summitfb_write4(sc, VISFX_FATTR, 0x91919191);
        }
        summitfb_setup_fb(sc);
}

static int
summitfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    struct lwp *l)
{
        struct vcons_data *vd = v;
        struct summitfb_softc *sc = vd->cookie;
        struct wsdisplay_fbinfo *wdf;
        struct vcons_screen *ms = vd->active;

        switch (cmd) {
        case WSDISPLAYIO_GTYPE:
                *(u_int *)data = WSDISPLAY_TYPE_STI;
                return 0;

        case GCID:
                *(u_int *)data = sc->sc_gid;
                return 0;

        /* PCI config read/write passthrough. */
        case PCI_IOC_CFGREAD:
        case PCI_IOC_CFGWRITE:
                return pci_devioctl(sc->sc_pc, sc->sc_tag,
                    cmd, data, flag, l);

        case WSDISPLAYIO_GET_BUSID:
                return wsdisplayio_busid_pci(sc->sc_dev, sc->sc_pc,
                    sc->sc_tag, data);

        case WSDISPLAYIO_GINFO:
                if (ms == NULL)
                        return ENODEV;
                wdf = data;
                wdf->height = ms->scr_ri.ri_height;
                wdf->width = ms->scr_ri.ri_width;
                wdf->depth = ms->scr_ri.ri_depth;
                wdf->cmsize = 256;
                return 0;

        case WSDISPLAYIO_GETCMAP:
                return summitfb_getcmap(sc,
                    (struct wsdisplay_cmap *)data);

        case WSDISPLAYIO_PUTCMAP:
                return summitfb_putcmap(sc,
                    (struct wsdisplay_cmap *)data);

        case WSDISPLAYIO_LINEBYTES:
                *(u_int *)data = 2048;
                return 0;

        case WSDISPLAYIO_SMODE: {
                int new_mode = *(int *)data;

                if (new_mode != sc->sc_mode) {
                        sc->sc_mode = new_mode;
                        if(new_mode == WSDISPLAYIO_MODE_EMUL) {
                                summitfb_setup(sc);
                                summitfb_restore_palette(sc);
                                glyphcache_wipe(&sc->sc_gc);
                                summitfb_rectfill(sc, 0, 0, sc->sc_width,
                                    sc->sc_height, ms->scr_ri.ri_devcmap[
                                    (ms->scr_defattr >> 16) & 0xff]);
                                vcons_redraw_screen(ms);
                                summitfb_set_video(sc, 1);
                        } else {
                                int i;
                                for (i =0; i < 256; i++)
                                        summitfb_putpalreg(sc, i, i, i, i);
                                summitfb_clearfb(sc);
                        }
                        summitfb_setup_fb(sc);
                }
                return 0;
        }

        case WSDISPLAYIO_GET_FBINFO: {
                struct wsdisplayio_fbinfo *fbi = data;
                int ret;

                ret = wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
                if (sc->sc_is_lego) {
                        /* on FX5/10 we can't use 24bit yet */
                        fbi->fbi_stride = 2048;
                        /* not sure yet how much VRAM is accessible */
                        fbi->fbi_fbsize = sc->sc_scr.fbheight * 2048;
                } else {
                        /* on FX2/4/6 we switch to 24bit */
                        if (sc->sc_fbdepth == 32) {
                                fbi->fbi_stride = 8192;
                                fbi->fbi_bitsperpixel = 32;
                                fbi->fbi_fbsize = sc->sc_scr.fbheight * 8192;
                                fbi->fbi_pixeltype = WSFB_RGB;
                                fbi->fbi_subtype.fbi_rgbmasks.red_offset = 16;
                                fbi->fbi_subtype.fbi_rgbmasks.red_size = 8;
                                fbi->fbi_subtype.fbi_rgbmasks.green_offset = 8;
                                fbi->fbi_subtype.fbi_rgbmasks.green_size = 8;
                                fbi->fbi_subtype.fbi_rgbmasks.blue_offset = 0;
                                fbi->fbi_subtype.fbi_rgbmasks.blue_size = 8;
                                fbi->fbi_subtype.fbi_rgbmasks.alpha_size = 0;
                        } else {
                                fbi->fbi_stride = 2048;
                                fbi->fbi_bitsperpixel = 8;
                                fbi->fbi_fbsize = sc->sc_scr.fbheight * 2048;
                                fbi->fbi_pixeltype = WSFB_CI;
                                fbi->fbi_subtype.fbi_cmapinfo.cmap_entries = 256;
                        }
                }
                return ret;
        }

        case WSDISPLAYIO_SET_DEPTH:
        {
                int new_depth = *(int*)data;
                if ((new_depth == 8) || (new_depth == 32)) {
                        sc->sc_fbdepth = new_depth;
                        return 0;
                }
                return EINVAL;
        }

        case WSDISPLAYIO_GCURPOS: {
                struct wsdisplay_curpos *cp = data;

                cp->x = sc->sc_cursor_x;
                cp->y = sc->sc_cursor_y;
                return 0;
        }

        case WSDISPLAYIO_SCURPOS: {
                struct wsdisplay_curpos *cp = data;

                summitfb_move_cursor(sc, cp->x, cp->y);
                return 0;
        }

        case WSDISPLAYIO_GCURMAX: {
                struct wsdisplay_curpos *cp = data;

                cp->x = 64;
                cp->y = 64;
                return 0;
        }

        case WSDISPLAYIO_SCURSOR: {
                struct wsdisplay_cursor *cursor = data;

                return summitfb_do_cursor(sc, cursor);
        }

        case WSDISPLAYIO_SVIDEO:
                summitfb_set_video(sc, *(int *)data);
                return 0;
        case WSDISPLAYIO_GVIDEO:
                *(u_int *)data = sc->sc_video_on ?
                    WSDISPLAYIO_VIDEO_ON : WSDISPLAYIO_VIDEO_OFF;
                return 0;
        }
        return EPASSTHROUGH;
}

static paddr_t
summitfb_mmap(void *v, void *vs, off_t offset, int prot)
{
        struct vcons_data *vd = v;
        struct summitfb_softc *sc = vd->cookie;
        struct sti_rom *rom = sc->sc_base.sc_rom;
        paddr_t pa = -1;

        if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)
                return -1;

        if (offset >= 0 && offset < 0x01000000) {
                /* framebuffer */
                pa = bus_space_mmap(rom->memt, sc->sc_scr.fbaddr, offset,
                    prot, BUS_SPACE_MAP_LINEAR);
        } else if (offset >= 0x80000000 && offset < 0x81000000) {
                /* blitter registers etc. */
                pa = bus_space_mmap(rom->memt, rom->regh[0],
                    offset - 0x80000000, prot, BUS_SPACE_MAP_LINEAR);
        }

        return pa;
}

static void
summitfb_init_screen(void *cookie, struct vcons_screen *scr,
    int existing, long *defattr)
{
        struct summitfb_softc *sc = cookie;
        struct rasops_info *ri = &scr->scr_ri;

        ri->ri_depth = 8;
        ri->ri_width = sc->sc_width;
        ri->ri_height = sc->sc_height;
        ri->ri_stride = 2048;
        ri->ri_flg = RI_CENTER | RI_8BIT_IS_RGB | RI_FULLCLEAR;
        if (sc->sc_is_lego) {
                /* until we can use ROPs, use putchar() based cursor() */
                scr->scr_flags = VCONS_NO_CURSOR;
        } else {
                /*
                 * only enable alpha fonts on FX4, until we figure out how this
                 * works on FX5/10
                 */
                ri->ri_flg |= RI_ENABLE_ALPHA | RI_PREFER_ALPHA;
        }

        ri->ri_bits = (void *)sc->sc_scr.fbaddr;
        rasops_init(ri, 0, 0);
        ri->ri_caps = WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_UNDERLINE |
            WSSCREEN_RESIZE;
        scr->scr_flags |= VCONS_LOADFONT;

        rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
            sc->sc_width / ri->ri_font->fontwidth);

        ri->ri_hw = scr;

        ri->ri_ops.copyrows = summitfb_copyrows;
        ri->ri_ops.copycols = summitfb_copycols;
        ri->ri_ops.eraserows = summitfb_eraserows;
        ri->ri_ops.erasecols = summitfb_erasecols;
        ri->ri_ops.cursor = summitfb_cursor;
        ri->ri_ops.allocattr = summitfb_allocattr;
        if (FONT_IS_ALPHA(ri->ri_font)) {
                ri->ri_ops.putchar = summitfb_putchar_aa;
        } else
                ri->ri_ops.putchar = summitfb_putchar;
}

static int
summitfb_putcmap(struct summitfb_softc *sc, struct wsdisplay_cmap *cm)
{
        u_char *r, *g, *b;
        u_int index = cm->index;
        u_int count = cm->count;
        int i, error;
        u_char rbuf[256], gbuf[256], bbuf[256];

        if (cm->index >= 256 || cm->count > 256 ||
            (cm->index + cm->count) > 256)
                return EINVAL;
        error = copyin(cm->red, &rbuf[index], count);
        if (error)
                return error;
        error = copyin(cm->green, &gbuf[index], count);
        if (error)
                return error;
        error = copyin(cm->blue, &bbuf[index], count);
        if (error)
                return error;

        memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
        memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
        memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);

        r = &sc->sc_cmap_red[index];
        g = &sc->sc_cmap_green[index];
        b = &sc->sc_cmap_blue[index];

        for (i = 0; i < count; i++) {
                summitfb_putpalreg(sc, index, *r, *g, *b);
                index++;
                r++, g++, b++;
        }
        return 0;
}

static int
summitfb_getcmap(struct summitfb_softc *sc, struct wsdisplay_cmap *cm)
{
        u_int index = cm->index;
        u_int count = cm->count;
        int error;

        if (index >= 255 || count > 256 || index + count > 256)
                return EINVAL;

        error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
        if (error)
                return error;
        error = copyout(&sc->sc_cmap_green[index], cm->green, count);
        if (error)
                return error;
        error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
        if (error)
                return error;

        return 0;
}

static void
summitfb_restore_palette(struct summitfb_softc *sc)
{
        uint8_t cmap[768];
        int i, j;

        j = 0;
        rasops_get_cmap(&sc->sc_console_screen.scr_ri, cmap, sizeof(cmap));
        for (i = 0; i < 256; i++) {
                sc->sc_cmap_red[i] = cmap[j];
                sc->sc_cmap_green[i] = cmap[j + 1];
                sc->sc_cmap_blue[i] = cmap[j + 2];
                summitfb_putpalreg(sc, i, cmap[j], cmap[j + 1], cmap[j + 2]);
                j += 3;
        }
        for (i = 0; i < 16; i++) {
                sc->sc_palette[i] = (rasops_cmap[i * 3] << 16) |
                                    (rasops_cmap[i * 3 + 1] << 8) |
                                     rasops_cmap[i * 3 + 2];
        }

}

static int
summitfb_putpalreg(struct summitfb_softc *sc, uint8_t idx,
    uint8_t r, uint8_t g, uint8_t b)
{

        summitfb_write4(sc, VISFX_COLOR_INDEX, idx);
        summitfb_write4(sc, VISFX_COLOR_VALUE, (r << 16) | ( g << 8) | b);
        summitfb_write4(sc, VISFX_COLOR_MASK, 0xff);
        return 0;
}

static inline void
summitfb_wait_fifo(struct summitfb_softc *sc, uint32_t slots)
{
        uint32_t reg;

        do {
                reg = summitfb_read4(sc, VISFX_FIFO);
        } while (reg < slots);
}

static void
summitfb_clearfb(struct summitfb_softc *sc)
{
        summitfb_write_mode(sc, OTC32 | BIN8F | BUFBL | BUFFL | 0x8c0);
        summitfb_wait_fifo(sc, 10);
        summitfb_write4(sc, VISFX_IBO, RopSrc);
        summitfb_write4(sc, VISFX_FG_COLOUR, 0);
        summitfb_write4(sc, VISFX_START, 0);
        summitfb_write4(sc, VISFX_SIZE, (sc->sc_width << 16) | sc->sc_height);
}

static void
summitfb_rectfill(struct summitfb_softc *sc, int x, int y, int wi, int he,
    uint32_t bg)
{

        summitfb_write_mode(sc, VISFX_WRITE_MODE_FILL);
        summitfb_wait_fifo(sc, 10);
        summitfb_write4(sc, VISFX_IBO, RopSrc);
        summitfb_write4(sc, VISFX_FG_COLOUR, bg);
        summitfb_write4(sc, VISFX_START, (x << 16) | y);
        summitfb_write4(sc, VISFX_SIZE, (wi << 16) | he);
}

static void
summitfb_rectfill_a(void *cookie, int dstx, int dsty,
    int width, int height, long attr)
{
        struct summitfb_softc *sc = cookie;

        summitfb_rectfill(sc, dstx, dsty, width, height,
            sc->vd.active->scr_ri.ri_devcmap[(attr >> 24 & 0xf)]);
}

static void
summitfb_bitblt(void *cookie, int xs, int ys, int xd, int yd, int wi,
    int he, int rop)
{
        struct summitfb_softc *sc = cookie;
        uint32_t read_mode, write_mode;

        read_mode = OTC04 | BIN8I;
        write_mode = OTC04 | BIN8I;
        if (ys >= sc->sc_height) {
                read_mode |= BUFBL;
                ys -= sc->sc_height;
        }
        if (yd >= sc->sc_height) {
                write_mode |= BUFBL;
                yd -= sc->sc_height;
        }
        summitfb_write_mode(sc, write_mode);
        summitfb_read_mode(sc, read_mode);
        summitfb_wait_fifo(sc, 10);
        summitfb_write4(sc, VISFX_IBO, rop);
        summitfb_write4(sc, VISFX_COPY_SRC, (xs << 16) | ys);
        summitfb_write4(sc, VISFX_COPY_WH, (wi << 16) | he);
        summitfb_write4(sc, VISFX_COPY_DST, (xd << 16) | yd);

}

static void
summitfb_nuke_cursor(struct rasops_info *ri)
{
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int wi, he, x, y;

        if (ri->ri_flg & RI_CURSOR) {
                wi = ri->ri_font->fontwidth;
                he = ri->ri_font->fontheight;
                x = ri->ri_ccol * wi + ri->ri_xorigin;
                y = ri->ri_crow * he + ri->ri_yorigin;
                summitfb_bitblt(sc, x, y, x, y, wi, he, RopInv);
                ri->ri_flg &= ~RI_CURSOR;
        }
}

static void
summitfb_cursor(void *cookie, int on, int row, int col)
{
        struct rasops_info *ri = cookie;
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int x, y, wi, he;

        wi = ri->ri_font->fontwidth;
        he = ri->ri_font->fontheight;

        if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
                if (on) {
                        if (ri->ri_flg & RI_CURSOR) {
                                summitfb_nuke_cursor(ri);
                        }
                        x = col * wi + ri->ri_xorigin;
                        y = row * he + ri->ri_yorigin;
                        summitfb_bitblt(sc, x, y, x, y, wi, he, RopInv);
                        ri->ri_flg |= RI_CURSOR;
                }
                ri->ri_crow = row;
                ri->ri_ccol = col;
        } else {
                ri->ri_crow = row;
                ri->ri_ccol = col;
                ri->ri_flg &= ~RI_CURSOR;
        }

}

static void
summitfb_putchar(void *cookie, int row, int col, u_int c, long attr)
{
        struct rasops_info *ri = cookie;
        struct wsdisplay_font *font = PICK_FONT(ri, c);
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        void *data;
        int i, x, y, wi, he, ul;
        uint32_t bg, fg, mask;

        if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
                return;

        if (!CHAR_IN_FONT(c, font))
                return;

        if (row == ri->ri_crow && col == ri->ri_ccol) {
                ri->ri_flg &= ~RI_CURSOR;
        }

        wi = font->fontwidth;
        he = font->fontheight;

        x = ri->ri_xorigin + col * wi;
        y = ri->ri_yorigin + row * he;

        ul = he - ((he < 16) ? 1 : 2);

        bg = ri->ri_devcmap[(attr >> 16) & 0xf];
        fg = ri->ri_devcmap[(attr >> 24) & 0x0f];

        /* if we're drawing a space we're done here */
        if (c == 0x20) {
                summitfb_rectfill(sc, x, y, wi, he, bg);
                if (attr & WSATTR_UNDERLINE)
                        summitfb_rectfill(sc, x, y + ul, wi, 1, fg);
                return;
        }

        summitfb_write_mode(sc, VISFX_WRITE_MODE_EXPAND);
        summitfb_wait_fifo(sc, 12);
        summitfb_write4(sc, VISFX_IBO, RopSrc);
        summitfb_write4(sc, VISFX_FG_COLOUR, fg);
        summitfb_write4(sc, VISFX_BG_COLOUR, bg);
        mask = 0xffffffff << (32 - wi);
        summitfb_write4(sc, VISFX_PIXEL_MASK, mask);
        /* not a tpyo, coordinates *are* backwards for this register */
        summitfb_write4(sc, VISFX_VRAM_WRITE_DEST, (y << 16) | x);

        data = WSFONT_GLYPH(c, font);

        if (attr & WSATTR_HILIT) {
                if (ri->ri_font->stride == 1) {
                        uint8_t *data8 = data;
                        for (i = 0; i < he; i++) {
                                mask = *data8;
                                mask |= mask >> 1;
                                summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
                                    mask << 24);
                                data8++;
                        }
                } else {
                        uint16_t *data16 = data;
                        for (i = 0; i < he; i++) {
                                mask = *data16;
                                mask |= mask >> 1;
                                summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
                                    mask << 16);
                                data16++;
                        }
                }
        } else {
                if (ri->ri_font->stride == 1) {
                        uint8_t *data8 = data;
                        for (i = 0; i < he; i++) {
                                mask = *data8;
                                summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
                                    mask << 24);
                                data8++;
                        }
                } else {
                        uint16_t *data16 = data;
                        for (i = 0; i < he; i++) {
                                mask = *data16;
                                summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
                                    mask << 16);
                                data16++;
                        }
                }
        }
        if (attr & WSATTR_UNDERLINE) {
                summitfb_wait_fifo(sc, 2);
                summitfb_write4(sc, VISFX_VRAM_WRITE_DEST,
                    ((y + ul) << 16) | x);
                summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
                    0xffffffff << (32 - wi));
        }
}

static void
summitfb_putchar_aa(void *cookie, int row, int col, u_int c, long attr)
{
        struct rasops_info *ri = cookie;
        struct wsdisplay_font *font = PICK_FONT(ri, c);
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int x, y, wi, he, rv = GC_NOPE, i, j;
        uint32_t bg, fg24, tmp;
        uint8_t *data;

        if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
                return;

        if (!CHAR_IN_FONT(c, font))
                return;

        if (row == ri->ri_crow && col == ri->ri_ccol) {
                ri->ri_flg &= ~RI_CURSOR;
        }

        wi = font->fontwidth;
        he = font->fontheight;

        x = ri->ri_xorigin + col * wi;
        y = ri->ri_yorigin + row * he;

        bg = ri->ri_devcmap[(attr >> 16) & 0xf];

        if (c == 0x20) {
                summitfb_rectfill(sc, x, y, wi, he, bg);
                if (attr & WSATTR_UNDERLINE)
                        glyphcache_underline(&sc->sc_gc, x, y, attr);
                return;
        }

        rv = glyphcache_try(&sc->sc_gc, c, x, y, attr);
        if (rv == GC_OK)
                return;

        /*
         * first we clear the background - we should be able to use the CBR
         * register as constant background but so far I couldn't make that work
         */
        summitfb_rectfill(sc, x, y, wi, he, bg);

        summitfb_write_mode(sc, OTC01 | BIN332F | BUFovl);
        /* we need the foreground colour as full RGB8 */
        fg24 = sc->sc_palette[(attr >> 24) & 0xf];

        /*
         * set the blending equation to
         * src_color * src_alpha + dst_color * (1 - src_alpha)
         */
        summitfb_write4(sc, VISFX_IBO,
            IBO_ADD | SRC(IBO_SRC) | DST(IBO_ONE_MINUS_SRC));
        summitfb_write4(sc, VISFX_FOE, FOE_BLEND_ROP | FOE_DITHER);

        /* get the glyph */
        data = WSFONT_GLYPH(c, font);
        for (i = 0; i < he; i++) {
                /*
                 * make some room in the pipeline
                 * with just plain ROPs we can just hammer the FIFO without
                 * having to worry about overflowing it but I suspect with
                 * alpha blending enabled things may be a little slower
                 */
                summitfb_wait_fifo(sc, wi * 2);
                /* start a new line */
                summitfb_write4(sc, VISFX_VRAM_WRITE_DEST, ((y + i) << 16) | x);
                for (j = 0; j < wi; j++) {
                        tmp = *data;
                        /* alpha & RGB -> ARGB */
                        summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRX,
                            (tmp << 24) | fg24);
                        data++;
                }
        }

        if (rv == GC_ADD) {
                glyphcache_add(&sc->sc_gc, c, x, y);
        }
        if (attr & WSATTR_UNDERLINE)
                glyphcache_underline(&sc->sc_gc, x, y, attr);

}

static int
summitfb_allocattr(void *cookie, int fg0, int bg0, int flg, long *attr)
{
        struct rasops_info *ri = cookie;
        int fg = fg0, bg = bg0;

        if ((flg & WSATTR_BLINK) != 0)
                return EINVAL;

        if ((flg & WSATTR_REVERSE) != 0) {
                fg = bg0;
                bg = fg0;
        }

        if (FONT_IS_ALPHA(ri->ri_font) && ((flg & WSATTR_HILIT) != 0)) {
                fg = fg0 < 8 ? fg0 + 8 : fg0;
        }

        *attr = (bg << 16) | (fg << 24) | flg;
        return 0;
}

static void
summitfb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
{
        struct rasops_info *ri = cookie;
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int32_t xs, xd, y, width, height;

        if (sc->sc_locked == 0 && sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {

                if (ri->ri_crow == row &&
                    ri->ri_ccol >= srccol && ri->ri_ccol < (srccol + ncols) &&
                    (ri->ri_flg & RI_CURSOR)) {
                        summitfb_nuke_cursor(ri);
                }

                xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
                xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
                y = ri->ri_yorigin + ri->ri_font->fontheight * row;
                width = ri->ri_font->fontwidth * ncols;
                height = ri->ri_font->fontheight;
                summitfb_bitblt(sc, xs, y, xd, y, width, height, RopSrc);

                if (ri->ri_crow == row &&
                    ri->ri_ccol >= dstcol && ri->ri_ccol < (dstcol + ncols))
                        ri->ri_flg &= ~RI_CURSOR;
        }
}

static void
summitfb_erasecols(void *cookie, int row, int startcol, int ncols,
    long fillattr)
{
        struct rasops_info *ri = cookie;
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int32_t x, y, width, height, fg, bg, ul;

        if (sc->sc_locked == 0 && sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
                x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
                y = ri->ri_yorigin + ri->ri_font->fontheight * row;
                width = ri->ri_font->fontwidth * ncols;
                height = ri->ri_font->fontheight;
                rasops_unpack_attr(fillattr, &fg, &bg, &ul);

                summitfb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);

                if (ri->ri_crow == row &&
                    ri->ri_ccol >= startcol &&
                    ri->ri_ccol < (startcol + ncols))
                        ri->ri_flg &= ~RI_CURSOR;
        }
}

static void
summitfb_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
{
        struct rasops_info *ri = cookie;
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int32_t x, ys, yd, width, height;

        if (sc->sc_locked == 0 && sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {

                if (ri->ri_crow >= srcrow && ri->ri_crow < (srcrow + nrows) &&
                    (ri->ri_flg & RI_CURSOR)) {
                        summitfb_nuke_cursor(ri);
                }

                x = ri->ri_xorigin;
                ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
                yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
                width = ri->ri_emuwidth;
                height = ri->ri_font->fontheight * nrows;
                summitfb_bitblt(sc, x, ys, x, yd, width, height, RopSrc);

                if (ri->ri_crow >= dstrow && ri->ri_crow < (dstrow + nrows))
                        ri->ri_flg &= ~RI_CURSOR;
        }
}

static void
summitfb_eraserows(void *cookie, int row, int nrows, long fillattr)
{
        struct rasops_info *ri = cookie;
        struct vcons_screen *scr = ri->ri_hw;
        struct summitfb_softc *sc = scr->scr_cookie;
        int32_t x, y, width, height, fg, bg, ul;

        if (sc->sc_locked == 0 && sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
                if (row == 0 && nrows == ri->ri_rows) {
                        x = 0;
                        y = 0;
                        width = sc->sc_width;
                        height = sc->sc_height;
                } else {
                        x = ri->ri_xorigin;
                        y = ri->ri_yorigin + ri->ri_font->fontheight * row;
                        width = ri->ri_emuwidth;
                        height = ri->ri_font->fontheight * nrows;
                }
                rasops_unpack_attr(fillattr, &fg, &bg, &ul);

                summitfb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);

                if (ri->ri_crow >= row && ri->ri_crow < (row + nrows))
                        ri->ri_flg &= ~RI_CURSOR;
        }
}

static void
summitfb_move_cursor(struct summitfb_softc *sc, int x, int y)
{
        uint32_t pos;

        sc->sc_cursor_x = x;
        x -= sc->sc_hot_x;
        sc->sc_cursor_y = y;
        y -= sc->sc_hot_y;

        if (x < 0)
                x = 0x1000 - x;
        if (y < 0)
                y = 0x1000 - y;
        pos = (x << 16) | y;
        if (sc->sc_enabled)
                pos |= 0x80000000;
        summitfb_write4(sc, VISFX_CURSOR_POS, pos);
}

static int
summitfb_do_cursor(struct summitfb_softc *sc, struct wsdisplay_cursor *cur)
{

        if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
                sc->sc_enabled = cur->enable;
                cur->which |= WSDISPLAY_CURSOR_DOPOS;
        }
        if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
                sc->sc_hot_x = cur->hot.x;
                sc->sc_hot_y = cur->hot.y;
                cur->which |= WSDISPLAY_CURSOR_DOPOS;
        }
        if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
                summitfb_move_cursor(sc, cur->pos.x, cur->pos.y);
        }
        if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
                uint32_t rgb;
                uint8_t r[2], g[2], b[2];

                copyin(cur->cmap.blue, b, 2);
                copyin(cur->cmap.green, g, 2);
                copyin(cur->cmap.red, r, 2);
                summitfb_write4(sc, VISFX_CURSOR_INDEX, 0);
                rgb = r[0] << 16 | g[0] << 8 | b[0];
                summitfb_write4(sc, VISFX_CURSOR_BG, rgb);
                rgb = r[1] << 16 | g[1] << 8 | b[1];
                summitfb_write4(sc, VISFX_CURSOR_FG, rgb);

        }
        if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {

                uint32_t buffer[128], latch, tmp;
                int i;

                copyin(cur->mask, buffer, 512);
                summitfb_write4(sc, VISFX_CURSOR_INDEX, 0);
                for (i = 0; i < 128; i += 2) {
                        latch = 0;
                        tmp = buffer[i] & 0x80808080;
                        latch |= tmp >> 7;
                        tmp = buffer[i] & 0x40404040;
                        latch |= tmp >> 5;
                        tmp = buffer[i] & 0x20202020;
                        latch |= tmp >> 3;
                        tmp = buffer[i] & 0x10101010;
                        latch |= tmp >> 1;
                        tmp = buffer[i] & 0x08080808;
                        latch |= tmp << 1;
                        tmp = buffer[i] & 0x04040404;
                        latch |= tmp << 3;
                        tmp = buffer[i] & 0x02020202;
                        latch |= tmp << 5;
                        tmp = buffer[i] & 0x01010101;
                        latch |= tmp << 7;
                        summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
                        latch = 0;
                        tmp = buffer[i + 1] & 0x80808080;
                        latch |= tmp >> 7;
                        tmp = buffer[i + 1] & 0x40404040;
                        latch |= tmp >> 5;
                        tmp = buffer[i + 1] & 0x20202020;
                        latch |= tmp >> 3;
                        tmp = buffer[i + 1] & 0x10101010;
                        latch |= tmp >> 1;
                        tmp = buffer[i + 1] & 0x08080808;
                        latch |= tmp << 1;
                        tmp = buffer[i + 1] & 0x04040404;
                        latch |= tmp << 3;
                        tmp = buffer[i + 1] & 0x02020202;
                        latch |= tmp << 5;
                        tmp = buffer[i + 1] & 0x01010101;
                        latch |= tmp << 7;
                        summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
                }

                summitfb_write4(sc, VISFX_CURSOR_INDEX, 0x80);
                copyin(cur->image, buffer, 512);
                for (i = 0; i < 128; i += 2) {
                        latch = 0;
                        tmp = buffer[i] & 0x80808080;
                        latch |= tmp >> 7;
                        tmp = buffer[i] & 0x40404040;
                        latch |= tmp >> 5;
                        tmp = buffer[i] & 0x20202020;
                        latch |= tmp >> 3;
                        tmp = buffer[i] & 0x10101010;
                        latch |= tmp >> 1;
                        tmp = buffer[i] & 0x08080808;
                        latch |= tmp << 1;
                        tmp = buffer[i] & 0x04040404;
                        latch |= tmp << 3;
                        tmp = buffer[i] & 0x02020202;
                        latch |= tmp << 5;
                        tmp = buffer[i] & 0x01010101;
                        latch |= tmp << 7;
                        summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
                        latch = 0;
                        tmp = buffer[i + 1] & 0x80808080;
                        latch |= tmp >> 7;
                        tmp = buffer[i + 1] & 0x40404040;
                        latch |= tmp >> 5;
                        tmp = buffer[i + 1] & 0x20202020;
                        latch |= tmp >> 3;
                        tmp = buffer[i + 1] & 0x10101010;
                        latch |= tmp >> 1;
                        tmp = buffer[i + 1] & 0x08080808;
                        latch |= tmp << 1;
                        tmp = buffer[i + 1] & 0x04040404;
                        latch |= tmp << 3;
                        tmp = buffer[i + 1] & 0x02020202;
                        latch |= tmp << 5;
                        tmp = buffer[i + 1] & 0x01010101;
                        latch |= tmp << 7;
                        summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
                }
        }

        return 0;
}

static void
summitfb_set_video(struct summitfb_softc *sc, int on)
{

        if (sc->sc_video_on == on)
                return;

        sc->sc_video_on = on;

        summitfb_wait(sc);
        if (on) {
                summitfb_write4(sc, VISFX_MPC, MPC_VIDEO_ON);
        } else {
                summitfb_write4(sc, VISFX_MPC, MPC_VSYNC_OFF | MPC_HSYNC_OFF);
        }
}

static void
summitfb_copyfont(struct summitfb_softc *sc)
{
        struct sti_font *fp = &sc->sc_scr.scr_curfont;
        uint8_t *font = sc->sc_scr.scr_romfont;
        uint8_t *fontbuf, *fontdata, *src, *dst;
        struct wsdisplay_font *f;
        int bufsize, i, si;

        if (font == NULL)
                return;

        bufsize = sizeof(struct wsdisplay_font) + 32 + fp->bpc * (fp->last - fp->first);
        DPRINTF(("%s: %dx%d %d\n", __func__, fp->width, fp->height, bufsize));
        fontbuf = kmem_alloc(bufsize, KM_SLEEP);
        f = (struct wsdisplay_font *)fontbuf;
        f->name = fontbuf + sizeof(struct wsdisplay_font);
        fontdata = fontbuf + sizeof(struct wsdisplay_font) + 32;
        strcpy(fontbuf + sizeof(struct wsdisplay_font), "HP ROM");
        f->firstchar = fp->first;
        f->numchars = (fp->last + 1) - fp->first;
        f->encoding = WSDISPLAY_FONTENC_ISO;
        f->fontwidth = fp->width;
        f->fontheight = fp->height;
        f->stride = (fp->width + 7) >> 3;
        f->bitorder = WSDISPLAY_FONTORDER_L2R;
        f->byteorder = WSDISPLAY_FONTORDER_L2R;
        f->data = fontdata;
        /* skip over font struct */
        font += sizeof(struct sti_font);
        /* now copy and rearrange the glyphs into ISO order */
        /* first, copy the characters up to 0x7f */
        memcpy(fontdata, font, (0x80 - fp->first) * fp->bpc);
        /* zero 0x80 to 0x9f */
        memset(fontdata + 0x80 * fp->bpc, 0, 0x20 * fp->bpc);
        /* rearrange 0xa0 till last */
        for (i = 0xa0; i < (fp->last + 1); i++) {
                dst = fontdata + fp->bpc * i;
                si = sti_unitoroman[i - 0xa0];
                if (si != 0) {
                        src = font + fp->bpc * si;
                        memcpy(dst, src, fp->bpc);
                } else {
                        /* no mapping - zero this cell */
                        memset(dst, 0, fp->bpc);
                }
        }
        wsfont_add(f, 0);
}