Home | History | Annotate | Line # | Download | only in dev
summitfb.c revision 1.13
      1  1.13  riastrad /*	$NetBSD: summitfb.c,v 1.13 2024/12/07 21:56:37 riastradh Exp $	*/
      2   1.1  macallan 
      3   1.1  macallan /*	$OpenBSD: sti_pci.c,v 1.7 2009/02/06 22:51:04 miod Exp $	*/
      4   1.1  macallan 
      5   1.1  macallan /*
      6   1.1  macallan  * Copyright (c) 2006, 2007 Miodrag Vallat.
      7   1.1  macallan  ^                     2024 Michael Lorenz
      8   1.1  macallan  *
      9   1.1  macallan  * Permission to use, copy, modify, and distribute this software for any
     10   1.1  macallan  * purpose with or without fee is hereby granted, provided that the above
     11   1.1  macallan  * copyright notice, this permission notice, and the disclaimer below
     12   1.1  macallan  * appear in all copies.
     13   1.1  macallan  *
     14   1.1  macallan  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     15   1.1  macallan  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     16   1.1  macallan  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     17   1.1  macallan  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     18   1.1  macallan  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     19   1.1  macallan  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     20   1.1  macallan  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     21   1.1  macallan  */
     22   1.1  macallan 
     23   1.1  macallan /*
     24  1.10  macallan  * a native driver for HP Visualize FX graphics cards, so far tested only on
     25  1.10  macallan  * my FX4
     26   1.1  macallan  * STI portions are from Miodrag Vallat's sti_pci.c
     27   1.1  macallan  */
     28   1.1  macallan 
     29   1.2  riastrad #include <sys/cdefs.h>
     30  1.13  riastrad __KERNEL_RCSID(0, "$NetBSD: summitfb.c,v 1.13 2024/12/07 21:56:37 riastradh Exp $");
     31   1.2  riastrad 
     32   1.1  macallan #include <sys/param.h>
     33   1.1  macallan #include <sys/systm.h>
     34   1.1  macallan #include <sys/kmem.h>
     35   1.1  macallan #include <sys/device.h>
     36   1.1  macallan #include <sys/mutex.h>
     37   1.1  macallan 
     38   1.1  macallan #include <dev/pci/pcivar.h>
     39   1.1  macallan #include <dev/pci/pcireg.h>
     40   1.1  macallan #include <dev/pci/pcidevs.h>
     41   1.1  macallan #include <dev/pci/pciio.h>
     42   1.1  macallan 
     43   1.1  macallan #include <dev/wscons/wsdisplayvar.h>
     44   1.1  macallan #include <dev/wscons/wsconsio.h>
     45   1.1  macallan #include <dev/wsfont/wsfont.h>
     46   1.1  macallan #include <dev/rasops/rasops.h>
     47   1.1  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     48   1.1  macallan #include <dev/pci/wsdisplay_pci.h>
     49   1.1  macallan #include <dev/wscons/wsdisplay_glyphcachevar.h>
     50   1.1  macallan 
     51   1.1  macallan #include <dev/ic/stireg.h>
     52   1.5  macallan #include <dev/ic/summitreg.h>
     53   1.1  macallan #include <dev/ic/stivar.h>
     54   1.1  macallan 
     55   1.1  macallan #include "opt_summitfb.h"
     56   1.1  macallan 
     57   1.1  macallan #ifdef SUMMITFB_DEBUG
     58   1.3  riastrad #define	DPRINTF(s) printf s
     59   1.1  macallan #else
     60   1.2  riastrad #define	DPRINTF(s) __nothing
     61   1.1  macallan #endif
     62   1.1  macallan 
     63   1.1  macallan int	summitfb_match(device_t, cfdata_t, void *);
     64   1.1  macallan void	summitfb_attach(device_t, device_t, void *);
     65   1.1  macallan 
     66   1.1  macallan struct	summitfb_softc {
     67   1.1  macallan 	device_t		sc_dev;
     68   1.1  macallan 	pci_chipset_tag_t	sc_pc;
     69   1.1  macallan 	pcitag_t		sc_tag;
     70   1.1  macallan 
     71   1.1  macallan 	/* stuff we need in order to use the STI ROM */
     72   1.1  macallan 	struct sti_softc	sc_base;
     73   1.1  macallan 	struct sti_screen 	sc_scr;
     74   1.1  macallan 	bus_space_handle_t	sc_romh;
     75   1.1  macallan 
     76   1.1  macallan 	int sc_width, sc_height;
     77   1.1  macallan 	int sc_locked;
     78   1.1  macallan 	struct vcons_screen sc_console_screen;
     79   1.1  macallan 	struct wsscreen_descr sc_defaultscreen_descr;
     80   1.1  macallan 	const struct wsscreen_descr *sc_screens[1];
     81   1.1  macallan 	struct wsscreen_list sc_screenlist;
     82   1.1  macallan 	struct vcons_data vd;
     83   1.1  macallan 	int sc_mode;
     84   1.1  macallan 	u_char sc_cmap_red[256];
     85   1.1  macallan 	u_char sc_cmap_green[256];
     86   1.1  macallan 	u_char sc_cmap_blue[256];
     87   1.8  macallan 	uint32_t sc_write_mode;
     88   1.1  macallan 	/* cursor stuff */
     89   1.1  macallan 	int sc_cursor_x, sc_cursor_y;
     90   1.1  macallan 	int sc_hot_x, sc_hot_y, sc_enabled;
     91  1.12  macallan 	/* font-in-vram */
     92  1.12  macallan 	struct wsdisplay_font *sc_font;
     93  1.12  macallan 	int sc_font_start;	/* x of font area */
     94  1.12  macallan 	int sc_cols;		/* chars per line in font area */
     95  1.12  macallan 
     96   1.1  macallan 	int sc_video_on;
     97  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
     98  1.12  macallan 	void (*sc_putchar)(void *, int, int, u_int, long);
     99   1.1  macallan 	glyphcache sc_gc;
    100  1.12  macallan #endif
    101   1.1  macallan };
    102   1.1  macallan 
    103   1.1  macallan CFATTACH_DECL_NEW(summitfb, sizeof(struct summitfb_softc),
    104   1.1  macallan     summitfb_match, summitfb_attach, NULL, NULL);
    105   1.1  macallan 
    106   1.2  riastrad int	summitfb_readbar(struct sti_softc *, struct pci_attach_args *, u_int,
    107   1.2  riastrad 	    int);
    108   1.1  macallan int	summitfb_check_rom(struct summitfb_softc *, struct pci_attach_args *);
    109   1.1  macallan void	summitfb_enable_rom(struct sti_softc *);
    110   1.1  macallan void	summitfb_disable_rom(struct sti_softc *);
    111   1.1  macallan void	summitfb_enable_rom_internal(struct summitfb_softc *);
    112   1.1  macallan void	summitfb_disable_rom_internal(struct summitfb_softc *);
    113   1.1  macallan 
    114   1.1  macallan void 	summitfb_setup(struct summitfb_softc *);
    115   1.1  macallan 
    116   1.1  macallan /* XXX these really need to go into their own header */
    117   1.1  macallan int	sti_pci_is_console(struct pci_attach_args *, bus_addr_t *);
    118   1.1  macallan int	sti_rom_setup(struct sti_rom *, bus_space_tag_t, bus_space_tag_t,
    119   1.1  macallan 	    bus_space_handle_t, bus_addr_t *, u_int);
    120   1.1  macallan int	sti_screen_setup(struct sti_screen *, int);
    121   1.1  macallan void	sti_describe_screen(struct sti_softc *, struct sti_screen *);
    122   1.1  macallan 
    123   1.2  riastrad #define PCI_ROM_SIZE(mr)						      \
    124   1.2  riastrad 	(PCI_MAPREG_ROM_ADDR(mr) & -PCI_MAPREG_ROM_ADDR(mr))
    125   1.1  macallan 
    126   1.1  macallan /* wsdisplay stuff */
    127   1.1  macallan static int	summitfb_ioctl(void *, void *, u_long, void *, int,
    128   1.2  riastrad 		    struct lwp *);
    129   1.1  macallan static paddr_t	summitfb_mmap(void *, void *, off_t, int);
    130   1.2  riastrad static void	summitfb_init_screen(void *, struct vcons_screen *, int,
    131   1.2  riastrad 		    long *);
    132   1.1  macallan 
    133   1.2  riastrad static int	summitfb_putcmap(struct summitfb_softc *,
    134   1.2  riastrad 		    struct wsdisplay_cmap *);
    135   1.2  riastrad static int 	summitfb_getcmap(struct summitfb_softc *,
    136   1.2  riastrad 		    struct wsdisplay_cmap *);
    137   1.1  macallan static void	summitfb_restore_palette(struct summitfb_softc *);
    138   1.1  macallan static int 	summitfb_putpalreg(struct summitfb_softc *, uint8_t, uint8_t,
    139   1.2  riastrad 		    uint8_t, uint8_t);
    140   1.1  macallan 
    141   1.1  macallan static inline void summitfb_setup_fb(struct summitfb_softc *);
    142   1.1  macallan 
    143   1.1  macallan static void	summitfb_rectfill(struct summitfb_softc *, int, int, int, int,
    144   1.2  riastrad 		    uint32_t);
    145   1.1  macallan static void	summitfb_bitblt(void *, int, int, int, int, int,
    146   1.2  riastrad 		    int, int);
    147   1.1  macallan 
    148   1.6  macallan #if 0
    149   1.1  macallan static void	summitfb_cursor(void *, int, int, int);
    150   1.6  macallan #endif
    151   1.1  macallan static void	summitfb_putchar(void *, int, int, u_int, long);
    152  1.12  macallan static void	summitfb_putchar_fast(void *, int, int, u_int, long);
    153  1.12  macallan static void	summitfb_loadfont(struct summitfb_softc *);
    154  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    155   1.1  macallan static void	summitfb_putchar_aa(void *, int, int, u_int, long);
    156  1.12  macallan #endif
    157   1.1  macallan static void	summitfb_copycols(void *, int, int, int, int);
    158   1.1  macallan static void	summitfb_erasecols(void *, int, int, int, long);
    159   1.1  macallan static void	summitfb_copyrows(void *, int, int, int);
    160   1.1  macallan static void	summitfb_eraserows(void *, int, int, long);
    161   1.1  macallan 
    162   1.1  macallan static void	summitfb_move_cursor(struct summitfb_softc *, int, int);
    163   1.2  riastrad static int	summitfb_do_cursor(struct summitfb_softc *,
    164   1.2  riastrad 		    struct wsdisplay_cursor *);
    165   1.1  macallan 
    166   1.1  macallan static void	summitfb_set_video(struct summitfb_softc *, int);
    167   1.1  macallan 
    168   1.1  macallan struct wsdisplay_accessops summitfb_accessops = {
    169   1.2  riastrad 	.ioctl = summitfb_ioctl,
    170   1.2  riastrad 	.mmap = summitfb_mmap,
    171   1.2  riastrad 	.alloc_screen = NULL,
    172   1.2  riastrad 	.free_screen = NULL,
    173   1.2  riastrad 	.show_screen = NULL,
    174   1.2  riastrad 	.load_font = NULL,
    175   1.2  riastrad 	.pollc = NULL,
    176   1.2  riastrad 	.scroll = NULL,
    177   1.1  macallan };
    178   1.1  macallan 
    179   1.1  macallan static inline void summitfb_wait_fifo(struct summitfb_softc *, uint32_t);
    180   1.8  macallan static inline void summitfb_wait(struct summitfb_softc *);
    181   1.1  macallan 
    182   1.1  macallan int
    183   1.1  macallan summitfb_match(device_t parent, cfdata_t cf, void *aux)
    184   1.1  macallan {
    185   1.1  macallan 	struct pci_attach_args *paa = aux;
    186   1.1  macallan 
    187   1.1  macallan 	if (PCI_VENDOR(paa->pa_id) != PCI_VENDOR_HP)
    188   1.1  macallan 		return 0;
    189   1.1  macallan 
    190   1.1  macallan 	if (PCI_PRODUCT(paa->pa_id) == PCI_PRODUCT_HP_VISUALIZE_FX4)
    191   1.1  macallan 		return 10;	/* beat out sti at pci */
    192   1.1  macallan 
    193   1.1  macallan 	return 0;
    194   1.1  macallan }
    195   1.1  macallan 
    196   1.1  macallan static inline uint32_t
    197   1.1  macallan summitfb_read4(struct summitfb_softc *sc, uint32_t offset)
    198   1.1  macallan {
    199   1.1  macallan 	struct sti_rom *rom = sc->sc_base.sc_rom;
    200   1.1  macallan 	bus_space_tag_t memt = rom->memt;
    201   1.1  macallan 	bus_space_handle_t memh = rom->regh[2];
    202   1.2  riastrad 
    203   1.1  macallan 	return bus_space_read_stream_4(memt, memh, offset - 0x400000);
    204   1.1  macallan }
    205   1.1  macallan 
    206   1.1  macallan static inline void
    207   1.1  macallan summitfb_write4(struct summitfb_softc *sc, uint32_t offset, uint32_t val)
    208   1.1  macallan {
    209   1.1  macallan 	struct sti_rom *rom = sc->sc_base.sc_rom;
    210   1.1  macallan 	bus_space_tag_t memt = rom->memt;
    211   1.1  macallan 	bus_space_handle_t memh = rom->regh[2];
    212   1.2  riastrad 
    213   1.1  macallan 	bus_space_write_stream_4(memt, memh, offset - 0x400000, val);
    214   1.1  macallan }
    215   1.1  macallan 
    216   1.1  macallan void
    217   1.1  macallan summitfb_attach(device_t parent, device_t self, void *aux)
    218   1.1  macallan {
    219   1.1  macallan 	struct summitfb_softc *sc = device_private(self);
    220   1.1  macallan 	struct pci_attach_args *paa = aux;
    221   1.1  macallan 	struct sti_rom *rom;
    222   1.1  macallan 	struct rasops_info *ri;
    223   1.1  macallan 	struct wsemuldisplaydev_attach_args aa;
    224   1.1  macallan 	unsigned long defattr = 0;
    225   1.1  macallan 	int ret, is_console = 0;
    226   1.1  macallan 
    227   1.1  macallan 	sc->sc_dev = self;
    228   1.1  macallan 
    229   1.1  macallan 	sc->sc_pc = paa->pa_pc;
    230   1.1  macallan 	sc->sc_tag = paa->pa_tag;
    231   1.1  macallan 	sc->sc_base.sc_dev = self;
    232   1.1  macallan 	sc->sc_base.sc_enable_rom = summitfb_enable_rom;
    233   1.1  macallan 	sc->sc_base.sc_disable_rom = summitfb_disable_rom;
    234   1.1  macallan 
    235   1.1  macallan 	aprint_normal("\n");
    236   1.1  macallan 
    237   1.1  macallan 	if (summitfb_check_rom(sc, paa) != 0)
    238   1.1  macallan 		return;
    239   1.1  macallan 
    240   1.1  macallan 	ret = sti_pci_is_console(paa, sc->sc_base. bases);
    241   1.1  macallan 	if (ret != 0) {
    242   1.1  macallan 		sc->sc_base.sc_flags |= STI_CONSOLE;
    243   1.1  macallan 		is_console = 1;
    244   1.1  macallan 	}
    245   1.2  riastrad 	rom = kmem_zalloc(sizeof(*rom), KM_SLEEP);
    246   1.1  macallan 	rom->rom_softc = &sc->sc_base;
    247   1.1  macallan 	ret = sti_rom_setup(rom, paa->pa_iot, paa->pa_memt, sc->sc_romh,
    248   1.1  macallan 	    sc->sc_base.bases, STI_CODEBASE_MAIN);
    249   1.1  macallan 	if (ret != 0) {
    250   1.1  macallan 		kmem_free(rom, sizeof(*rom));
    251   1.1  macallan 		return;
    252   1.1  macallan 	}
    253   1.1  macallan 
    254   1.1  macallan 	sc->sc_base.sc_rom = rom;
    255   1.1  macallan 
    256   1.1  macallan 	sc->sc_scr.scr_rom = sc->sc_base.sc_rom;
    257   1.1  macallan 	ret = sti_screen_setup(&sc->sc_scr, STI_FBMODE);
    258   1.1  macallan 
    259   1.1  macallan 	sc->sc_width = sc->sc_scr.scr_cfg.scr_width;
    260   1.1  macallan 	sc->sc_height = sc->sc_scr.scr_cfg.scr_height;
    261   1.8  macallan 	sc->sc_write_mode = 0xffffffff;
    262   1.1  macallan 
    263   1.1  macallan 	aprint_normal_dev(sc->sc_dev, "%s at %dx%d\n", sc->sc_scr.name,
    264   1.1  macallan 	    sc->sc_width, sc->sc_height);
    265   1.1  macallan 
    266   1.1  macallan #ifdef SUMMITFB_DEBUG
    267   1.1  macallan 	sc->sc_height -= 200;
    268  1.12  macallan 	sc->sc_width -= 200;
    269   1.1  macallan #endif
    270   1.1  macallan 
    271   1.1  macallan 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    272   1.2  riastrad 		.name = "default",
    273   1.2  riastrad 		.ncols = 0, .nrows = 0,
    274   1.2  riastrad 		.textops = NULL,
    275   1.2  riastrad 		.fontwidth = 8, .fontheight = 16,
    276   1.2  riastrad 		.capabilities = WSSCREEN_WSCOLORS | WSSCREEN_HILIT |
    277   1.2  riastrad 		    WSSCREEN_UNDERLINE | WSSCREEN_RESIZE,
    278   1.2  riastrad 		.modecookie = NULL,
    279   1.1  macallan 	};
    280   1.1  macallan 
    281   1.1  macallan 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    282   1.1  macallan 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    283   1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    284   1.1  macallan 	sc->sc_locked = 0;
    285   1.1  macallan 
    286   1.1  macallan 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    287   1.1  macallan 	    &summitfb_accessops);
    288   1.1  macallan 	sc->vd.init_screen = summitfb_init_screen;
    289  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    290   1.1  macallan 	sc->vd.show_screen_cookie = &sc->sc_gc;
    291   1.1  macallan 	sc->vd.show_screen_cb = glyphcache_adapt;
    292  1.12  macallan #endif
    293   1.1  macallan 	ri = &sc->sc_console_screen.scr_ri;
    294   1.1  macallan 
    295  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    296   1.1  macallan 	sc->sc_gc.gc_bitblt = summitfb_bitblt;
    297   1.1  macallan 	sc->sc_gc.gc_blitcookie = sc;
    298   1.1  macallan 	sc->sc_gc.gc_rop = RopSrc;
    299  1.12  macallan #endif
    300  1.12  macallan 
    301  1.12  macallan 	summitfb_setup(sc);
    302  1.12  macallan 	summitfb_setup_fb(sc);
    303   1.1  macallan 
    304   1.1  macallan 	vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, &defattr);
    305   1.1  macallan 	sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    306   1.1  macallan 
    307   1.1  macallan 	sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    308   1.1  macallan 	sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    309   1.1  macallan 	sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    310   1.1  macallan 	sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    311   1.1  macallan 
    312  1.12  macallan 	/*
    313  1.12  macallan 	 * STI lies to us - it reports a 2048x2048 framebuffer but blitter
    314  1.12  macallan 	 * ops wrap around below 1024 and we seem to have only about 250
    315  1.13  riastrad 	 * usable columns to the right. Should still be enough to cache
    316  1.12  macallan 	 * a font or four.
    317  1.12  macallan 	 * So, the framebuffer seems to be 1536x1024, which is odd since the
    318  1.12  macallan 	 * FX4 is supposed to support resolutions higher than 1280x1024.
    319  1.12  macallan 	 * I guess video memory is allocated in 512x512 chunks
    320  1.12  macallan 	 */
    321  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    322  1.12  macallan 	glyphcache_init_x(&sc->sc_gc, sc->sc_width, 0,
    323  1.12  macallan 	    sc->sc_height,
    324  1.12  macallan 	    1536 - sc->sc_width - 4,
    325   1.2  riastrad 	    ri->ri_font->fontwidth,
    326   1.2  riastrad 	    ri->ri_font->fontheight,
    327   1.2  riastrad 	    defattr);
    328  1.12  macallan #endif
    329   1.1  macallan 
    330  1.12  macallan 	summitfb_setup(sc);
    331   1.1  macallan 	summitfb_restore_palette(sc);
    332   1.1  macallan 	summitfb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height,
    333   1.1  macallan 	    ri->ri_devcmap[(defattr >> 16) & 0xff]);
    334   1.1  macallan 	summitfb_setup_fb(sc);
    335   1.1  macallan 
    336   1.1  macallan 	if (is_console) {
    337   1.1  macallan 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    338   1.1  macallan 		    defattr);
    339   1.1  macallan 
    340   1.1  macallan 		vcons_replay_msgbuf(&sc->sc_console_screen);
    341   1.1  macallan 	}
    342   1.1  macallan 
    343   1.1  macallan 	/* no suspend/resume support yet */
    344   1.2  riastrad 	pmf_device_register(sc->sc_dev, NULL, NULL);
    345   1.1  macallan 
    346   1.1  macallan 	aa.console = is_console;
    347   1.1  macallan 	aa.scrdata = &sc->sc_screenlist;
    348   1.1  macallan 	aa.accessops = &summitfb_accessops;
    349   1.1  macallan 	aa.accesscookie = &sc->vd;
    350   1.1  macallan 
    351   1.1  macallan 	config_found(sc->sc_dev, &aa, wsemuldisplaydevprint, CFARGS_NONE);
    352   1.1  macallan }
    353   1.1  macallan 
    354   1.1  macallan /*
    355   1.1  macallan  * Grovel the STI ROM image.
    356   1.1  macallan  */
    357   1.1  macallan int
    358   1.1  macallan summitfb_check_rom(struct summitfb_softc *spc, struct pci_attach_args *pa)
    359   1.1  macallan {
    360   1.1  macallan 	struct sti_softc *sc = &spc->sc_base;
    361   1.1  macallan 	pcireg_t address, mask;
    362   1.1  macallan 	bus_space_handle_t romh;
    363   1.1  macallan 	bus_size_t romsize, subsize, stiromsize;
    364   1.1  macallan 	bus_addr_t selected, offs, suboffs;
    365   1.1  macallan 	uint32_t tmp;
    366   1.1  macallan 	int i;
    367   1.1  macallan 	int rc;
    368   1.1  macallan 
    369   1.1  macallan 	/* sort of inline sti_pci_enable_rom(sc) */
    370   1.1  macallan 	address = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM);
    371   1.1  macallan 	pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM,
    372   1.1  macallan 	    ~PCI_MAPREG_ROM_ENABLE);
    373   1.1  macallan 	mask = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM);
    374   1.1  macallan 	address |= PCI_MAPREG_ROM_ENABLE;
    375   1.1  macallan 	pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM, address);
    376   1.1  macallan 	sc->sc_flags |= STI_ROM_ENABLED;
    377   1.2  riastrad 
    378   1.1  macallan 	/*
    379   1.1  macallan 	 * Map the complete ROM for now.
    380   1.1  macallan 	 */
    381   1.1  macallan 	romsize = PCI_ROM_SIZE(mask);
    382   1.1  macallan 	DPRINTF(("%s: mapping rom @ %lx for %lx\n", __func__,
    383   1.1  macallan 	    (long)PCI_MAPREG_ROM_ADDR(address), (long)romsize));
    384   1.1  macallan 
    385   1.1  macallan 	rc = bus_space_map(pa->pa_memt, PCI_MAPREG_ROM_ADDR(address), romsize,
    386   1.1  macallan 	    0, &romh);
    387   1.1  macallan 	if (rc != 0) {
    388   1.1  macallan 		aprint_error_dev(sc->sc_dev, "can't map PCI ROM (%d)\n", rc);
    389   1.1  macallan 		goto fail2;
    390   1.1  macallan 	}
    391   1.1  macallan 
    392   1.1  macallan 	summitfb_disable_rom_internal(spc);
    393   1.1  macallan 	/*
    394   1.1  macallan 	 * Iterate over the ROM images, pick the best candidate.
    395   1.1  macallan 	 */
    396   1.1  macallan 
    397   1.1  macallan 	selected = (bus_addr_t)-1;
    398   1.1  macallan 	for (offs = 0; offs < romsize; offs += subsize) {
    399   1.1  macallan 		summitfb_enable_rom_internal(spc);
    400   1.1  macallan 		/*
    401   1.1  macallan 		 * Check for a valid ROM header.
    402   1.1  macallan 		 */
    403   1.1  macallan 		tmp = bus_space_read_4(pa->pa_memt, romh, offs + 0);
    404   1.1  macallan 		tmp = le32toh(tmp);
    405   1.1  macallan 		if (tmp != 0x55aa0000) {
    406   1.1  macallan 			summitfb_disable_rom_internal(spc);
    407   1.1  macallan 			if (offs == 0) {
    408   1.1  macallan 				aprint_error_dev(sc->sc_dev,
    409   1.2  riastrad 				    "invalid PCI ROM header signature"
    410   1.2  riastrad 				    " (%08x)\n", tmp);
    411   1.1  macallan 				rc = EINVAL;
    412   1.1  macallan 			}
    413   1.1  macallan 			break;
    414   1.1  macallan 		}
    415   1.1  macallan 
    416   1.1  macallan 		/*
    417   1.1  macallan 		 * Check ROM type.
    418   1.1  macallan 		 */
    419   1.1  macallan 		tmp = bus_space_read_4(pa->pa_memt, romh, offs + 4);
    420   1.1  macallan 		tmp = le32toh(tmp);
    421   1.1  macallan 		if (tmp != 0x00000001) {	/* 1 == STI ROM */
    422   1.1  macallan 			summitfb_disable_rom_internal(spc);
    423   1.1  macallan 			if (offs == 0) {
    424   1.1  macallan 				aprint_error_dev(sc->sc_dev,
    425   1.1  macallan 				    "invalid PCI ROM type (%08x)\n", tmp);
    426   1.1  macallan 				rc = EINVAL;
    427   1.1  macallan 			}
    428   1.1  macallan 			break;
    429   1.1  macallan 		}
    430   1.1  macallan 
    431   1.1  macallan 		subsize = (bus_addr_t)bus_space_read_2(pa->pa_memt, romh,
    432   1.1  macallan 		    offs + 0x0c);
    433   1.1  macallan 		subsize <<= 9;
    434   1.1  macallan 
    435   1.1  macallan #ifdef SUMMITFB_DEBUG
    436   1.1  macallan 		summitfb_disable_rom_internal(spc);
    437   1.1  macallan 		DPRINTF(("ROM offset %08x size %08x type %08x",
    438   1.1  macallan 		    (u_int)offs, (u_int)subsize, tmp));
    439   1.1  macallan 		summitfb_enable_rom_internal(spc);
    440   1.1  macallan #endif
    441   1.1  macallan 
    442   1.1  macallan 		/*
    443   1.1  macallan 		 * Check for a valid ROM data structure.
    444   1.1  macallan 		 * We do not need it except to know what architecture the ROM
    445   1.1  macallan 		 * code is for.
    446   1.1  macallan 		 */
    447   1.1  macallan 
    448   1.1  macallan 		suboffs = offs +(bus_addr_t)bus_space_read_2(pa->pa_memt, romh,
    449   1.1  macallan 		    offs + 0x18);
    450   1.1  macallan 		tmp = bus_space_read_4(pa->pa_memt, romh, suboffs + 0);
    451   1.1  macallan 		tmp = le32toh(tmp);
    452   1.1  macallan 		if (tmp != 0x50434952) {	/* PCIR */
    453   1.1  macallan 			summitfb_disable_rom_internal(spc);
    454   1.1  macallan 			if (offs == 0) {
    455   1.1  macallan 				aprint_error_dev(sc->sc_dev, "invalid PCI data"
    456   1.1  macallan 				    " signature (%08x)\n", tmp);
    457   1.1  macallan 				rc = EINVAL;
    458   1.1  macallan 			} else {
    459   1.1  macallan 				DPRINTF((" invalid PCI data signature %08x\n",
    460   1.1  macallan 				    tmp));
    461   1.1  macallan 				continue;
    462   1.1  macallan 			}
    463   1.1  macallan 		}
    464   1.1  macallan 
    465   1.1  macallan 		tmp = bus_space_read_1(pa->pa_memt, romh, suboffs + 0x14);
    466   1.1  macallan 		summitfb_disable_rom_internal(spc);
    467   1.1  macallan 		DPRINTF((" code %02x", tmp));
    468   1.1  macallan 
    469   1.1  macallan 		switch (tmp) {
    470   1.1  macallan #ifdef __hppa__
    471   1.1  macallan 		case 0x10:
    472   1.1  macallan 			if (selected == (bus_addr_t)-1)
    473   1.1  macallan 				selected = offs;
    474   1.1  macallan 			break;
    475   1.1  macallan #endif
    476   1.1  macallan #ifdef __i386__
    477   1.1  macallan 		case 0x00:
    478   1.1  macallan 			if (selected == (bus_addr_t)-1)
    479   1.1  macallan 				selected = offs;
    480   1.1  macallan 			break;
    481   1.1  macallan #endif
    482   1.1  macallan 		default:
    483   1.1  macallan 			DPRINTF((" (wrong architecture)"));
    484   1.1  macallan 			break;
    485   1.1  macallan 		}
    486   1.1  macallan 		DPRINTF(("%s\n", selected == offs ? " -> SELECTED" : ""));
    487   1.1  macallan 	}
    488   1.1  macallan 
    489   1.1  macallan 	if (selected == (bus_addr_t)-1) {
    490   1.1  macallan 		if (rc == 0) {
    491   1.1  macallan 			aprint_error_dev(sc->sc_dev, "found no ROM with "
    492   1.1  macallan 			    "correct microcode architecture\n");
    493   1.1  macallan 			rc = ENOEXEC;
    494   1.1  macallan 		}
    495   1.1  macallan 		goto fail;
    496   1.1  macallan 	}
    497   1.1  macallan 
    498   1.1  macallan 	/*
    499   1.1  macallan 	 * Read the STI region BAR assignments.
    500   1.1  macallan 	 */
    501   1.1  macallan 
    502   1.1  macallan 	summitfb_enable_rom_internal(spc);
    503   1.1  macallan 	offs = selected +
    504   1.1  macallan 	    (bus_addr_t)bus_space_read_2(pa->pa_memt, romh, selected + 0x0e);
    505   1.1  macallan 	for (i = 0; i < STI_REGION_MAX; i++) {
    506   1.1  macallan 		rc = summitfb_readbar(sc, pa, i,
    507   1.1  macallan 		    bus_space_read_1(pa->pa_memt, romh, offs + i));
    508   1.1  macallan 		if (rc != 0)
    509   1.1  macallan 			goto fail;
    510   1.1  macallan 	}
    511   1.1  macallan 
    512   1.1  macallan 	/*
    513   1.1  macallan 	 * Find out where the STI ROM itself lies, and its size.
    514   1.1  macallan 	 */
    515   1.1  macallan 
    516   1.1  macallan 	offs = selected +
    517   1.1  macallan 	    (bus_addr_t)bus_space_read_4(pa->pa_memt, romh, selected + 0x08);
    518   1.1  macallan 	stiromsize = (bus_addr_t)bus_space_read_4(pa->pa_memt, romh,
    519   1.1  macallan 	    offs + 0x18);
    520   1.1  macallan 	stiromsize = le32toh(stiromsize);
    521   1.1  macallan 	summitfb_disable_rom_internal(spc);
    522   1.1  macallan 
    523   1.1  macallan 	/*
    524   1.1  macallan 	 * Replace our mapping with a smaller mapping of only the area
    525   1.1  macallan 	 * we are interested in.
    526   1.1  macallan 	 */
    527   1.1  macallan 
    528   1.1  macallan 	DPRINTF(("remapping rom @ %lx for %lx\n",
    529   1.1  macallan 	    (long)(PCI_MAPREG_ROM_ADDR(address) + offs), (long)stiromsize));
    530   1.1  macallan 	bus_space_unmap(pa->pa_memt, romh, romsize);
    531   1.1  macallan 	rc = bus_space_map(pa->pa_memt, PCI_MAPREG_ROM_ADDR(address) + offs,
    532   1.1  macallan 	    stiromsize, 0, &spc->sc_romh);
    533   1.1  macallan 	if (rc != 0) {
    534   1.1  macallan 		aprint_error_dev(sc->sc_dev, "can't map STI ROM (%d)\n",
    535   1.1  macallan 		    rc);
    536   1.1  macallan 		goto fail2;
    537   1.1  macallan 	}
    538   1.1  macallan  	summitfb_disable_rom_internal(spc);
    539   1.1  macallan 	sc->sc_flags &= ~STI_ROM_ENABLED;
    540   1.1  macallan 
    541   1.1  macallan 	return 0;
    542   1.1  macallan 
    543   1.1  macallan fail:
    544   1.1  macallan 	bus_space_unmap(pa->pa_memt, romh, romsize);
    545   1.1  macallan fail2:
    546   1.1  macallan 	summitfb_disable_rom_internal(spc);
    547   1.1  macallan 
    548   1.1  macallan 	return rc;
    549   1.1  macallan }
    550   1.1  macallan 
    551   1.1  macallan /*
    552   1.1  macallan  * Decode a BAR register.
    553   1.1  macallan  */
    554   1.1  macallan int
    555   1.2  riastrad summitfb_readbar(struct sti_softc *sc, struct pci_attach_args *pa,
    556   1.2  riastrad     u_int region, int bar)
    557   1.1  macallan {
    558   1.1  macallan 	bus_addr_t addr;
    559   1.1  macallan 	bus_size_t size;
    560   1.1  macallan 	uint32_t cf;
    561   1.1  macallan 	int rc;
    562   1.1  macallan 
    563   1.1  macallan 	if (bar == 0) {
    564   1.1  macallan 		sc->bases[region] = 0;
    565   1.2  riastrad 		return 0;
    566   1.1  macallan 	}
    567   1.1  macallan 
    568   1.1  macallan #ifdef DIAGNOSTIC
    569   1.1  macallan 	if (bar < PCI_MAPREG_START || bar > PCI_MAPREG_PPB_END) {
    570   1.1  macallan 		summitfb_disable_rom(sc);
    571   1.1  macallan 		printf("%s: unexpected bar %02x for region %d\n",
    572   1.1  macallan 		    device_xname(sc->sc_dev), bar, region);
    573   1.1  macallan 		summitfb_enable_rom(sc);
    574   1.1  macallan 	}
    575   1.1  macallan #endif
    576   1.1  macallan 
    577   1.1  macallan 	cf = pci_conf_read(pa->pa_pc, pa->pa_tag, bar);
    578   1.1  macallan 
    579   1.1  macallan 	rc = pci_mapreg_info(pa->pa_pc, pa->pa_tag, bar, PCI_MAPREG_TYPE(cf),
    580   1.1  macallan 	    &addr, &size, NULL);
    581   1.1  macallan 
    582   1.1  macallan 	if (rc != 0) {
    583   1.1  macallan 		summitfb_disable_rom(sc);
    584   1.2  riastrad 		aprint_error_dev(sc->sc_dev, "invalid bar %02x"
    585   1.2  riastrad 		    " for region %d\n",
    586   1.1  macallan 		    bar, region);
    587   1.1  macallan 		summitfb_enable_rom(sc);
    588   1.2  riastrad 		return rc;
    589   1.1  macallan 	}
    590   1.1  macallan 
    591   1.1  macallan 	sc->bases[region] = addr;
    592   1.2  riastrad 	return 0;
    593   1.1  macallan }
    594   1.1  macallan 
    595   1.1  macallan /*
    596   1.1  macallan  * Enable PCI ROM.
    597   1.1  macallan  */
    598   1.1  macallan void
    599   1.1  macallan summitfb_enable_rom_internal(struct summitfb_softc *spc)
    600   1.1  macallan {
    601   1.1  macallan 	pcireg_t address;
    602   1.1  macallan 
    603   1.1  macallan 	KASSERT(spc != NULL);
    604   1.1  macallan 
    605   1.1  macallan 	address = pci_conf_read(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM);
    606   1.1  macallan 	address |= PCI_MAPREG_ROM_ENABLE;
    607   1.1  macallan 	pci_conf_write(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM, address);
    608   1.1  macallan }
    609   1.1  macallan 
    610   1.1  macallan void
    611   1.1  macallan summitfb_enable_rom(struct sti_softc *sc)
    612   1.1  macallan {
    613   1.1  macallan 	struct summitfb_softc *spc = device_private(sc->sc_dev);
    614   1.1  macallan 
    615   1.1  macallan 	if (!ISSET(sc->sc_flags, STI_ROM_ENABLED)) {
    616   1.1  macallan 		summitfb_enable_rom_internal(spc);
    617   1.1  macallan 	}
    618   1.1  macallan 	SET(sc->sc_flags, STI_ROM_ENABLED);
    619   1.1  macallan }
    620   1.1  macallan 
    621   1.1  macallan /*
    622   1.1  macallan  * Disable PCI ROM.
    623   1.1  macallan  */
    624   1.1  macallan void
    625   1.1  macallan summitfb_disable_rom_internal(struct summitfb_softc *spc)
    626   1.1  macallan {
    627   1.1  macallan 	pcireg_t address;
    628   1.1  macallan 
    629   1.1  macallan 	KASSERT(spc != NULL);
    630   1.1  macallan 
    631   1.1  macallan 	address = pci_conf_read(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM);
    632   1.1  macallan 	address &= ~PCI_MAPREG_ROM_ENABLE;
    633   1.1  macallan 	pci_conf_write(spc->sc_pc, spc->sc_tag, PCI_MAPREG_ROM, address);
    634   1.1  macallan }
    635   1.1  macallan 
    636   1.1  macallan void
    637   1.1  macallan summitfb_disable_rom(struct sti_softc *sc)
    638   1.1  macallan {
    639   1.1  macallan 	struct summitfb_softc *spc = device_private(sc->sc_dev);
    640   1.1  macallan 
    641   1.1  macallan 	if (ISSET(sc->sc_flags, STI_ROM_ENABLED)) {
    642   1.1  macallan 		summitfb_disable_rom_internal(spc);
    643   1.1  macallan 	}
    644   1.1  macallan 	CLR(sc->sc_flags, STI_ROM_ENABLED);
    645   1.1  macallan }
    646   1.1  macallan 
    647   1.1  macallan static inline void
    648   1.1  macallan summitfb_wait(struct summitfb_softc *sc)
    649   1.1  macallan {
    650   1.1  macallan 
    651   1.2  riastrad 	while (summitfb_read4(sc, VISFX_STATUS) != 0)
    652   1.2  riastrad 		continue;
    653   1.1  macallan }
    654   1.1  macallan 
    655   1.1  macallan static inline void
    656   1.8  macallan summitfb_write_mode(struct summitfb_softc *sc, uint32_t mode)
    657   1.8  macallan {
    658   1.8  macallan 	if (sc->sc_write_mode == mode) return;
    659   1.8  macallan 	summitfb_wait(sc);
    660   1.8  macallan 	summitfb_write4(sc, VISFX_VRAM_WRITE_MODE, mode);
    661   1.8  macallan 	sc->sc_write_mode = mode;
    662   1.8  macallan }
    663   1.8  macallan 
    664   1.8  macallan static inline void
    665   1.1  macallan summitfb_setup_fb(struct summitfb_softc *sc)
    666   1.1  macallan {
    667   1.2  riastrad 
    668   1.8  macallan 	summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
    669  1.12  macallan 	summitfb_write4(sc, VISFX_VRAM_READ_MODE, VISFX_READ_MODE_COPY);
    670   1.1  macallan }
    671   1.1  macallan 
    672   1.1  macallan void
    673   1.1  macallan summitfb_setup(struct summitfb_softc *sc)
    674   1.1  macallan {
    675   1.1  macallan 
    676   1.1  macallan 	sc->sc_hot_x = 0;
    677   1.1  macallan 	sc->sc_hot_y = 0;
    678   1.1  macallan 	sc->sc_enabled = 0;
    679   1.1  macallan 	sc->sc_video_on = 1;
    680   1.1  macallan 
    681   1.1  macallan 	/*
    682   1.1  macallan 	 * STI hands us the frame buffer in 32bit access mode,
    683   1.1  macallan 	 * one of these puts us into 8bit FB access mode
    684   1.1  macallan 	 */
    685   1.1  macallan #if 1
    686   1.2  riastrad 	summitfb_write4(sc, 0xb08044, 0x1b);
    687   1.1  macallan 	summitfb_write4(sc, 0xb08048, 0x1b);
    688  1.10  macallan 
    689  1.12  macallan 	summitfb_write4(sc, 0x920860, 0xe4);
    690   1.1  macallan 	summitfb_write4(sc, 0x921110, 0);
    691  1.10  macallan 	summitfb_write4(sc, 0x921114, 0);
    692   1.1  macallan 	summitfb_write4(sc, 0x9211d8, 0);
    693  1.10  macallan 
    694  1.10  macallan 	summitfb_write4(sc, 0xa00404, 0);
    695  1.10  macallan 	summitfb_write4(sc, 0xa00818, 0);
    696  1.10  macallan 	summitfb_write4(sc, 0xa0081c, 0);	/* fx4 */
    697  1.10  macallan 	summitfb_write4(sc, 0xa00850, 0);	/* fx4 */
    698   1.1  macallan 	summitfb_write4(sc, 0xa0086c, 0);
    699   1.1  macallan #endif
    700   1.1  macallan 
    701   1.9  riastrad 	summitfb_wait(sc);
    702  1.10  macallan 	summitfb_write4(sc, VISFX_APERTURE_ACCESS, VISFX_DEPTH_8);
    703   1.1  macallan 	summitfb_write4(sc, VISFX_PIXEL_MASK, 0xffffffff);
    704   1.1  macallan 	summitfb_write4(sc, VISFX_PLANE_MASK, 0xffffffff);
    705   1.8  macallan 	summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
    706   1.8  macallan 	summitfb_write4(sc, VISFX_VRAM_READ_MODE, VISFX_READ_MODE_COPY);
    707  1.10  macallan 	summitfb_write4(sc, VISFX_CLIP_TL, 0);
    708  1.11  riastrad 	summitfb_write4(sc, VISFX_CLIP_WH,
    709  1.10  macallan 	    ((sc->sc_scr.fbwidth + 1) << 16) | (sc->sc_scr.fbheight + 1));
    710   1.1  macallan 
    711   1.1  macallan 	summitfb_setup_fb(sc);
    712   1.1  macallan }
    713   1.1  macallan 
    714   1.1  macallan static int
    715   1.1  macallan summitfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    716   1.2  riastrad     struct lwp *l)
    717   1.1  macallan {
    718   1.1  macallan 	struct vcons_data *vd = v;
    719   1.1  macallan 	struct summitfb_softc *sc = vd->cookie;
    720   1.1  macallan 	struct wsdisplay_fbinfo *wdf;
    721   1.1  macallan 	struct vcons_screen *ms = vd->active;
    722   1.1  macallan 
    723   1.1  macallan 	switch (cmd) {
    724   1.1  macallan 	case WSDISPLAYIO_GTYPE:
    725   1.1  macallan 		*(u_int *)data = WSDISPLAY_TYPE_STI;
    726   1.1  macallan 		return 0;
    727   1.1  macallan 
    728   1.1  macallan 	case GCID:
    729   1.4  macallan 		*(u_int *)data = sc->sc_scr.scr_rom->rom_dd.dd_grid[0];
    730   1.1  macallan 		return 0;
    731   1.1  macallan 
    732   1.1  macallan 	/* PCI config read/write passthrough. */
    733   1.1  macallan 	case PCI_IOC_CFGREAD:
    734   1.1  macallan 	case PCI_IOC_CFGWRITE:
    735   1.1  macallan 		return pci_devioctl(sc->sc_pc, sc->sc_tag,
    736   1.1  macallan 		    cmd, data, flag, l);
    737   1.1  macallan 
    738   1.1  macallan 	case WSDISPLAYIO_GET_BUSID:
    739   1.1  macallan 		return wsdisplayio_busid_pci(sc->sc_dev, sc->sc_pc,
    740   1.1  macallan 		    sc->sc_tag, data);
    741   1.1  macallan 
    742   1.1  macallan 	case WSDISPLAYIO_GINFO:
    743   1.1  macallan 		if (ms == NULL)
    744   1.1  macallan 			return ENODEV;
    745   1.2  riastrad 		wdf = data;
    746   1.1  macallan 		wdf->height = ms->scr_ri.ri_height;
    747   1.1  macallan 		wdf->width = ms->scr_ri.ri_width;
    748   1.1  macallan 		wdf->depth = ms->scr_ri.ri_depth;
    749   1.1  macallan 		wdf->cmsize = 256;
    750   1.1  macallan 		return 0;
    751   1.1  macallan 
    752   1.1  macallan 	case WSDISPLAYIO_GETCMAP:
    753   1.1  macallan 		return summitfb_getcmap(sc,
    754   1.1  macallan 		    (struct wsdisplay_cmap *)data);
    755   1.1  macallan 
    756   1.1  macallan 	case WSDISPLAYIO_PUTCMAP:
    757   1.1  macallan 		return summitfb_putcmap(sc,
    758   1.1  macallan 		    (struct wsdisplay_cmap *)data);
    759   1.1  macallan 
    760   1.1  macallan 	case WSDISPLAYIO_LINEBYTES:
    761   1.1  macallan 		*(u_int *)data = 2048;
    762   1.1  macallan 		return 0;
    763   1.1  macallan 
    764   1.1  macallan 	case WSDISPLAYIO_SMODE: {
    765   1.2  riastrad 		int new_mode = *(int *)data;
    766   1.2  riastrad 
    767   1.1  macallan 		if (new_mode != sc->sc_mode) {
    768   1.1  macallan 			sc->sc_mode = new_mode;
    769   1.1  macallan 			if(new_mode == WSDISPLAYIO_MODE_EMUL) {
    770   1.1  macallan 				summitfb_setup(sc);
    771   1.1  macallan 				summitfb_restore_palette(sc);
    772  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    773  1.10  macallan 				glyphcache_wipe(&sc->sc_gc);
    774  1.12  macallan #endif
    775  1.12  macallan 				summitfb_loadfont(sc);
    776   1.1  macallan 				summitfb_rectfill(sc, 0, 0, sc->sc_width,
    777   1.1  macallan 				    sc->sc_height, ms->scr_ri.ri_devcmap[
    778   1.1  macallan 				    (ms->scr_defattr >> 16) & 0xff]);
    779   1.1  macallan 				vcons_redraw_screen(ms);
    780   1.1  macallan 				summitfb_set_video(sc, 1);
    781   1.1  macallan 			}
    782   1.8  macallan 			summitfb_setup_fb(sc);
    783   1.1  macallan 		}
    784   1.1  macallan 		return 0;
    785   1.2  riastrad 	}
    786   1.1  macallan 
    787   1.2  riastrad 	case WSDISPLAYIO_GET_FBINFO: {
    788   1.2  riastrad 		struct wsdisplayio_fbinfo *fbi = data;
    789   1.2  riastrad 		int ret;
    790   1.2  riastrad 
    791   1.2  riastrad 		ret = wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
    792   1.2  riastrad 		fbi->fbi_fbsize = sc->sc_scr.fbheight * 2048;
    793   1.2  riastrad 		return ret;
    794   1.2  riastrad 	}
    795   1.1  macallan 
    796   1.2  riastrad 	case WSDISPLAYIO_GCURPOS: {
    797   1.2  riastrad 		struct wsdisplay_curpos *cp = data;
    798   1.1  macallan 
    799   1.2  riastrad 		cp->x = sc->sc_cursor_x;
    800   1.2  riastrad 		cp->y = sc->sc_cursor_y;
    801   1.1  macallan 		return 0;
    802   1.2  riastrad 	}
    803   1.1  macallan 
    804   1.2  riastrad 	case WSDISPLAYIO_SCURPOS: {
    805   1.2  riastrad 		struct wsdisplay_curpos *cp = data;
    806   1.1  macallan 
    807   1.2  riastrad 		summitfb_move_cursor(sc, cp->x, cp->y);
    808   1.1  macallan 		return 0;
    809   1.2  riastrad 	}
    810   1.1  macallan 
    811   1.2  riastrad 	case WSDISPLAYIO_GCURMAX: {
    812   1.2  riastrad 		struct wsdisplay_curpos *cp = data;
    813   1.1  macallan 
    814   1.2  riastrad 		cp->x = 64;
    815   1.2  riastrad 		cp->y = 64;
    816   1.1  macallan 		return 0;
    817   1.2  riastrad 	}
    818   1.1  macallan 
    819   1.2  riastrad 	case WSDISPLAYIO_SCURSOR: {
    820   1.2  riastrad 		struct wsdisplay_cursor *cursor = data;
    821   1.1  macallan 
    822   1.2  riastrad 		return summitfb_do_cursor(sc, cursor);
    823   1.2  riastrad 	}
    824   1.1  macallan 
    825   1.1  macallan 	case WSDISPLAYIO_SVIDEO:
    826   1.1  macallan 		summitfb_set_video(sc, *(int *)data);
    827   1.1  macallan 		return 0;
    828   1.1  macallan 	case WSDISPLAYIO_GVIDEO:
    829   1.1  macallan 		*(u_int *)data = sc->sc_video_on ?
    830   1.1  macallan 		    WSDISPLAYIO_VIDEO_ON : WSDISPLAYIO_VIDEO_OFF;
    831   1.1  macallan 		return 0;
    832   1.1  macallan 	}
    833   1.1  macallan 	return EPASSTHROUGH;
    834   1.1  macallan }
    835   1.1  macallan 
    836   1.1  macallan static paddr_t
    837   1.1  macallan summitfb_mmap(void *v, void *vs, off_t offset, int prot)
    838   1.1  macallan {
    839   1.1  macallan 	struct vcons_data *vd = v;
    840   1.1  macallan 	struct summitfb_softc *sc = vd->cookie;
    841   1.1  macallan 	struct sti_rom *rom = sc->sc_base.sc_rom;
    842   1.1  macallan 	paddr_t pa = -1;
    843   1.1  macallan 
    844   1.1  macallan 	if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)
    845   1.1  macallan 		return -1;
    846   1.1  macallan 
    847   1.1  macallan 	if (offset >= 0 && offset < sc->sc_scr.fblen) {
    848   1.1  macallan 		/* framebuffer */
    849   1.1  macallan 		pa = bus_space_mmap(rom->memt, sc->sc_scr.fbaddr, offset,
    850   1.1  macallan 		    prot, BUS_SPACE_MAP_LINEAR);
    851   1.1  macallan 	} else if (offset >= 0x80000000 && offset < 0x80400000) {
    852   1.1  macallan 		/* blitter registers etc. */
    853   1.4  macallan 		pa = bus_space_mmap(rom->memt, rom->regh[0],
    854   1.1  macallan 		    offset - 0x80000000, prot, BUS_SPACE_MAP_LINEAR);
    855   1.1  macallan 	}
    856   1.1  macallan 
    857   1.1  macallan 	return pa;
    858   1.1  macallan }
    859   1.1  macallan 
    860   1.1  macallan static void
    861   1.1  macallan summitfb_init_screen(void *cookie, struct vcons_screen *scr,
    862   1.1  macallan     int existing, long *defattr)
    863   1.1  macallan {
    864   1.1  macallan 	struct summitfb_softc *sc = cookie;
    865   1.1  macallan 	struct rasops_info *ri = &scr->scr_ri;
    866   1.1  macallan 
    867   1.1  macallan 	ri->ri_depth = 8;
    868   1.1  macallan 	ri->ri_width = sc->sc_width;
    869   1.1  macallan 	ri->ri_height = sc->sc_height;
    870   1.1  macallan 	ri->ri_stride = 2048;
    871  1.12  macallan 	ri->ri_flg = RI_CENTER | RI_8BIT_IS_RGB
    872  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    873  1.12  macallan 	    | RI_ENABLE_ALPHA | RI_PREFER_ALPHA
    874  1.12  macallan #endif
    875  1.12  macallan 	    ;
    876   1.1  macallan 
    877   1.1  macallan 	ri->ri_bits = (void *)sc->sc_scr.fbaddr;
    878   1.1  macallan 	rasops_init(ri, 0, 0);
    879   1.1  macallan 	ri->ri_caps = WSSCREEN_WSCOLORS | WSSCREEN_HILIT | WSSCREEN_UNDERLINE |
    880   1.2  riastrad 	    WSSCREEN_RESIZE;
    881   1.6  macallan 	scr->scr_flags |= VCONS_LOADFONT | VCONS_NO_CURSOR;
    882   1.1  macallan 
    883   1.1  macallan 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    884   1.2  riastrad 	    sc->sc_width / ri->ri_font->fontwidth);
    885   1.1  macallan 
    886   1.1  macallan 	ri->ri_hw = scr;
    887   1.6  macallan 
    888   1.1  macallan 	ri->ri_ops.copyrows = summitfb_copyrows;
    889   1.1  macallan 	ri->ri_ops.copycols = summitfb_copycols;
    890   1.1  macallan 	ri->ri_ops.eraserows = summitfb_eraserows;
    891   1.1  macallan 	ri->ri_ops.erasecols = summitfb_erasecols;
    892   1.6  macallan 	//ri->ri_ops.cursor = summitfb_cursor;
    893  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
    894  1.12  macallan 	sc->sc_putchar = ri->ri_ops.putchar;
    895   1.1  macallan 	if (FONT_IS_ALPHA(ri->ri_font)) {
    896   1.1  macallan 		ri->ri_ops.putchar = summitfb_putchar_aa;
    897   1.1  macallan 	} else
    898  1.12  macallan #endif
    899  1.12  macallan 	{
    900  1.12  macallan 		int fbwidth = (sc->sc_width + 511) & ~511;
    901  1.12  macallan 		int fcols = (fbwidth - sc->sc_width - 2) / ri->ri_font->fontwidth;
    902  1.12  macallan 		int frows = sc->sc_height / ri->ri_font->fontheight;
    903  1.12  macallan 		sc->sc_font_start = sc->sc_width + 2;
    904  1.12  macallan 		if ((fcols * frows) >= ri->ri_font->numchars) {
    905  1.12  macallan 			/* ok, we can do this */
    906  1.12  macallan 			sc->sc_cols = fcols;
    907  1.12  macallan 			sc->sc_font = ri->ri_font;
    908  1.12  macallan 			summitfb_loadfont(sc);
    909  1.12  macallan 			ri->ri_ops.putchar = summitfb_putchar_fast;
    910  1.13  riastrad 		} else
    911  1.12  macallan 			ri->ri_ops.putchar = summitfb_putchar;
    912  1.12  macallan 	}
    913   1.1  macallan }
    914   1.1  macallan 
    915   1.1  macallan static int
    916   1.1  macallan summitfb_putcmap(struct summitfb_softc *sc, struct wsdisplay_cmap *cm)
    917   1.1  macallan {
    918   1.1  macallan 	u_char *r, *g, *b;
    919   1.1  macallan 	u_int index = cm->index;
    920   1.1  macallan 	u_int count = cm->count;
    921   1.1  macallan 	int i, error;
    922   1.1  macallan 	u_char rbuf[256], gbuf[256], bbuf[256];
    923   1.1  macallan 
    924   1.1  macallan 	if (cm->index >= 256 || cm->count > 256 ||
    925   1.1  macallan 	    (cm->index + cm->count) > 256)
    926   1.1  macallan 		return EINVAL;
    927   1.1  macallan 	error = copyin(cm->red, &rbuf[index], count);
    928   1.1  macallan 	if (error)
    929   1.1  macallan 		return error;
    930   1.1  macallan 	error = copyin(cm->green, &gbuf[index], count);
    931   1.1  macallan 	if (error)
    932   1.1  macallan 		return error;
    933   1.1  macallan 	error = copyin(cm->blue, &bbuf[index], count);
    934   1.1  macallan 	if (error)
    935   1.1  macallan 		return error;
    936   1.1  macallan 
    937   1.1  macallan 	memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
    938   1.1  macallan 	memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
    939   1.1  macallan 	memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
    940   1.1  macallan 
    941   1.1  macallan 	r = &sc->sc_cmap_red[index];
    942   1.1  macallan 	g = &sc->sc_cmap_green[index];
    943   1.1  macallan 	b = &sc->sc_cmap_blue[index];
    944   1.1  macallan 
    945   1.1  macallan 	for (i = 0; i < count; i++) {
    946   1.1  macallan 		summitfb_putpalreg(sc, index, *r, *g, *b);
    947   1.1  macallan 		index++;
    948   1.1  macallan 		r++, g++, b++;
    949   1.1  macallan 	}
    950   1.1  macallan 	return 0;
    951   1.1  macallan }
    952   1.1  macallan 
    953   1.1  macallan static int
    954   1.1  macallan summitfb_getcmap(struct summitfb_softc *sc, struct wsdisplay_cmap *cm)
    955   1.1  macallan {
    956   1.1  macallan 	u_int index = cm->index;
    957   1.1  macallan 	u_int count = cm->count;
    958   1.1  macallan 	int error;
    959   1.1  macallan 
    960   1.1  macallan 	if (index >= 255 || count > 256 || index + count > 256)
    961   1.1  macallan 		return EINVAL;
    962   1.1  macallan 
    963   1.1  macallan 	error = copyout(&sc->sc_cmap_red[index],   cm->red,   count);
    964   1.1  macallan 	if (error)
    965   1.1  macallan 		return error;
    966   1.1  macallan 	error = copyout(&sc->sc_cmap_green[index], cm->green, count);
    967   1.1  macallan 	if (error)
    968   1.1  macallan 		return error;
    969   1.1  macallan 	error = copyout(&sc->sc_cmap_blue[index],  cm->blue,  count);
    970   1.1  macallan 	if (error)
    971   1.1  macallan 		return error;
    972   1.1  macallan 
    973   1.1  macallan 	return 0;
    974   1.1  macallan }
    975   1.1  macallan 
    976   1.1  macallan static void
    977   1.1  macallan summitfb_restore_palette(struct summitfb_softc *sc)
    978   1.1  macallan {
    979   1.1  macallan 	uint8_t cmap[768];
    980   1.1  macallan 	int i, j;
    981   1.1  macallan 
    982   1.1  macallan 	j = 0;
    983   1.1  macallan 	rasops_get_cmap(&sc->sc_console_screen.scr_ri, cmap, sizeof(cmap));
    984   1.1  macallan 	for (i = 0; i < 256; i++) {
    985   1.1  macallan 		sc->sc_cmap_red[i] = cmap[j];
    986   1.1  macallan 		sc->sc_cmap_green[i] = cmap[j + 1];
    987   1.1  macallan 		sc->sc_cmap_blue[i] = cmap[j + 2];
    988   1.1  macallan 		summitfb_putpalreg(sc, i, cmap[j], cmap[j + 1], cmap[j + 2]);
    989   1.1  macallan 		j += 3;
    990   1.1  macallan 	}
    991   1.1  macallan }
    992   1.1  macallan 
    993   1.1  macallan static int
    994   1.2  riastrad summitfb_putpalreg(struct summitfb_softc *sc, uint8_t idx,
    995   1.2  riastrad     uint8_t r, uint8_t g, uint8_t b)
    996   1.1  macallan {
    997   1.2  riastrad 
    998   1.1  macallan 	summitfb_write4(sc, VISFX_COLOR_INDEX, 0xc0005100 + idx);
    999   1.1  macallan 	summitfb_write4(sc, VISFX_COLOR_VALUE, (r << 16) | ( g << 8) | b);
   1000   1.1  macallan 	summitfb_write4(sc, VISFX_COLOR_MASK, 0xff);
   1001   1.1  macallan 	summitfb_write4(sc, 0x80004c, 0xc);
   1002   1.1  macallan 	summitfb_write4(sc, 0x800000, 0);
   1003   1.1  macallan 	return 0;
   1004   1.1  macallan }
   1005   1.1  macallan 
   1006   1.1  macallan static inline void
   1007   1.1  macallan summitfb_wait_fifo(struct summitfb_softc *sc, uint32_t slots)
   1008   1.1  macallan {
   1009   1.1  macallan #if 0
   1010   1.1  macallan 	uint32_t reg;
   1011   1.2  riastrad 
   1012   1.1  macallan 	do {
   1013   1.1  macallan 		reg = summitfb_read4(sc, NGLE_REG_34);
   1014   1.1  macallan 	} while (reg < slots);
   1015   1.1  macallan #endif
   1016   1.1  macallan }
   1017   1.1  macallan 
   1018   1.1  macallan static void
   1019   1.1  macallan summitfb_rectfill(struct summitfb_softc *sc, int x, int y, int wi, int he,
   1020   1.2  riastrad     uint32_t bg)
   1021   1.1  macallan {
   1022   1.2  riastrad 
   1023   1.8  macallan 	summitfb_write_mode(sc, VISFX_WRITE_MODE_FILL);
   1024   1.1  macallan 	summitfb_write4(sc, VISFX_FG_COLOUR, bg);
   1025   1.1  macallan 	summitfb_write4(sc, VISFX_START, (x << 16) | y);
   1026   1.1  macallan 	summitfb_write4(sc, VISFX_SIZE, (wi << 16) | he);
   1027   1.1  macallan }
   1028   1.1  macallan 
   1029   1.1  macallan static void
   1030   1.1  macallan summitfb_bitblt(void *cookie, int xs, int ys, int xd, int yd, int wi,
   1031   1.2  riastrad     int he, int rop)
   1032   1.1  macallan {
   1033   1.1  macallan 	struct summitfb_softc *sc = cookie;
   1034   1.6  macallan 
   1035   1.6  macallan 	/* XXX no ROP support yet */
   1036  1.12  macallan 	if (rop != RopSrc) {
   1037  1.12  macallan 		summitfb_write_mode(sc, rop);
   1038  1.12  macallan 	} else
   1039  1.12  macallan 		summitfb_write_mode(sc, VISFX_WRITE_MODE_PLAIN);
   1040  1.12  macallan 	summitfb_write4(sc, VISFX_VRAM_READ_MODE, VISFX_WRITE_MODE_PLAIN);
   1041   1.6  macallan 	summitfb_write4(sc, VISFX_COPY_SRC, (xs << 16) | ys);
   1042   1.6  macallan 	summitfb_write4(sc, VISFX_COPY_WH, (wi << 16) | he);
   1043   1.6  macallan 	summitfb_write4(sc, VISFX_COPY_DST, (xd << 16) | yd);
   1044   1.6  macallan 
   1045   1.1  macallan }
   1046   1.1  macallan 
   1047   1.6  macallan #if 0
   1048   1.1  macallan static void
   1049   1.1  macallan summitfb_nuke_cursor(struct rasops_info *ri)
   1050   1.1  macallan {
   1051   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1052   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1053   1.1  macallan 	int wi, he, x, y;
   1054   1.1  macallan 
   1055   1.1  macallan 	if (ri->ri_flg & RI_CURSOR) {
   1056   1.1  macallan 		wi = ri->ri_font->fontwidth;
   1057   1.1  macallan 		he = ri->ri_font->fontheight;
   1058   1.1  macallan 		x = ri->ri_ccol * wi + ri->ri_xorigin;
   1059   1.1  macallan 		y = ri->ri_crow * he + ri->ri_yorigin;
   1060   1.6  macallan 		if (0) summitfb_bitblt(sc, x, y, x, y, wi, he, RopInv);
   1061   1.1  macallan 		ri->ri_flg &= ~RI_CURSOR;
   1062   1.1  macallan 	}
   1063   1.1  macallan }
   1064   1.1  macallan 
   1065   1.1  macallan static void
   1066   1.1  macallan summitfb_cursor(void *cookie, int on, int row, int col)
   1067   1.1  macallan {
   1068   1.1  macallan 	struct rasops_info *ri = cookie;
   1069   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1070   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1071   1.1  macallan 	int x, y, wi, he;
   1072   1.1  macallan 
   1073   1.1  macallan 	wi = ri->ri_font->fontwidth;
   1074   1.1  macallan 	he = ri->ri_font->fontheight;
   1075   1.1  macallan 
   1076   1.1  macallan 	if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
   1077   1.1  macallan 		if (on) {
   1078   1.1  macallan 			if (ri->ri_flg & RI_CURSOR) {
   1079   1.1  macallan 				summitfb_nuke_cursor(ri);
   1080   1.1  macallan 			}
   1081   1.1  macallan 			x = col * wi + ri->ri_xorigin;
   1082   1.1  macallan 			y = row * he + ri->ri_yorigin;
   1083   1.1  macallan 			summitfb_bitblt(sc, x, y, x, y, wi, he, RopInv);
   1084   1.1  macallan 			ri->ri_flg |= RI_CURSOR;
   1085   1.1  macallan 		}
   1086   1.1  macallan 		ri->ri_crow = row;
   1087   1.1  macallan 		ri->ri_ccol = col;
   1088   1.2  riastrad 	} else {
   1089   1.1  macallan 		ri->ri_crow = row;
   1090   1.1  macallan 		ri->ri_ccol = col;
   1091   1.1  macallan 		ri->ri_flg &= ~RI_CURSOR;
   1092   1.1  macallan 	}
   1093   1.1  macallan 
   1094   1.1  macallan }
   1095   1.6  macallan #endif
   1096   1.1  macallan 
   1097   1.1  macallan static void
   1098   1.1  macallan summitfb_putchar(void *cookie, int row, int col, u_int c, long attr)
   1099   1.1  macallan {
   1100   1.1  macallan 	struct rasops_info *ri = cookie;
   1101   1.1  macallan 	struct wsdisplay_font *font = PICK_FONT(ri, c);
   1102   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1103   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1104   1.6  macallan 	void *data;
   1105  1.12  macallan 	int i, x, y, wi, he;
   1106   1.1  macallan 	uint32_t bg, fg, mask;
   1107   1.1  macallan 
   1108   1.1  macallan 	if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
   1109   1.1  macallan 		return;
   1110   1.1  macallan 
   1111   1.1  macallan 	if (!CHAR_IN_FONT(c, font))
   1112   1.1  macallan 		return;
   1113   1.1  macallan 
   1114  1.10  macallan 	/* XXX as long as we use putchar() to draw the cursor */
   1115   1.6  macallan #if 0
   1116   1.1  macallan 	if (row == ri->ri_crow && col == ri->ri_ccol) {
   1117   1.1  macallan 		ri->ri_flg &= ~RI_CURSOR;
   1118   1.1  macallan 	}
   1119   1.6  macallan #endif
   1120   1.1  macallan 	wi = font->fontwidth;
   1121   1.1  macallan 	he = font->fontheight;
   1122   1.1  macallan 
   1123   1.1  macallan 	x = ri->ri_xorigin + col * wi;
   1124   1.1  macallan 	y = ri->ri_yorigin + row * he;
   1125   1.1  macallan 
   1126   1.1  macallan 	bg = ri->ri_devcmap[(attr >> 16) & 0xf];
   1127   1.1  macallan 
   1128   1.1  macallan 	/* if we're drawing a space we're done here */
   1129   1.1  macallan 	if (c == 0x20) {
   1130   1.1  macallan 		summitfb_rectfill(sc, x, y, wi, he, bg);
   1131   1.1  macallan 		return;
   1132   1.1  macallan 	}
   1133   1.1  macallan 
   1134   1.1  macallan 	fg = ri->ri_devcmap[(attr >> 24) & 0x0f];
   1135   1.1  macallan 
   1136   1.8  macallan 	summitfb_write_mode(sc, VISFX_WRITE_MODE_EXPAND);
   1137   1.6  macallan 	summitfb_write4(sc, VISFX_FG_COLOUR, fg);
   1138   1.6  macallan 	summitfb_write4(sc, VISFX_BG_COLOUR, bg);
   1139   1.6  macallan 	mask = 0xffffffff << (32 - wi);
   1140   1.6  macallan 	summitfb_write4(sc, VISFX_PIXEL_MASK, mask);
   1141   1.6  macallan 	/* not a tpyo, coordinates *are* backwards for this register */
   1142   1.6  macallan 	summitfb_write4(sc, VISFX_VRAM_WRITE_DEST, (y << 16) | x);
   1143   1.6  macallan 
   1144   1.6  macallan 	data = WSFONT_GLYPH(c, font);
   1145   1.6  macallan 
   1146   1.6  macallan 	if (ri->ri_font->stride == 1) {
   1147   1.6  macallan 		uint8_t *data8 = data;
   1148   1.6  macallan 		for (i = 0; i < he; i++) {
   1149   1.6  macallan 			mask = *data8;
   1150   1.9  riastrad 			summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
   1151   1.9  riastrad 			    mask << 24);
   1152   1.6  macallan 			data8++;
   1153   1.6  macallan 		}
   1154   1.6  macallan 	} else {
   1155   1.6  macallan 		uint16_t *data16 = data;
   1156   1.6  macallan 		for (i = 0; i < he; i++) {
   1157   1.6  macallan 			mask = *data16;
   1158   1.9  riastrad 			summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
   1159   1.9  riastrad 			    mask << 16);
   1160   1.6  macallan 			data16++;
   1161   1.6  macallan 		}
   1162   1.6  macallan 	}
   1163  1.12  macallan }
   1164  1.12  macallan 
   1165  1.12  macallan static void
   1166  1.12  macallan summitfb_loadfont(struct summitfb_softc *sc)
   1167  1.12  macallan {
   1168  1.12  macallan 	int i, c, x, y;
   1169  1.12  macallan 	uint8_t *data;
   1170  1.12  macallan 	uint16_t *data16;
   1171  1.12  macallan 	uint32_t mask;
   1172  1.12  macallan 
   1173  1.12  macallan 	summitfb_setup(sc);
   1174  1.12  macallan 	summitfb_write_mode(sc, VISFX_WRITE_MODE_EXPAND);
   1175  1.12  macallan 
   1176  1.12  macallan 	summitfb_write4(sc, VISFX_FG_COLOUR, 0xffffffff);
   1177  1.12  macallan 	summitfb_write4(sc, VISFX_BG_COLOUR, 0);
   1178  1.12  macallan 
   1179  1.12  macallan 	mask = 0xffffffff << (32 - sc->sc_font->fontwidth);
   1180  1.12  macallan 	summitfb_write4(sc, VISFX_PIXEL_MASK, mask);
   1181  1.12  macallan 
   1182  1.12  macallan 	for (c = 0; c < sc->sc_font->numchars; c++) {
   1183  1.12  macallan 		x = sc->sc_font_start + (c % sc->sc_cols) * sc->sc_font->fontwidth;
   1184  1.12  macallan 		y = (c / sc->sc_cols) * sc->sc_font->fontheight;
   1185  1.12  macallan 		data = WSFONT_GLYPH(sc->sc_font->firstchar + c, sc->sc_font);
   1186  1.12  macallan 		summitfb_write4(sc, VISFX_VRAM_WRITE_DEST, (y << 16) | x);
   1187  1.12  macallan 		if (sc->sc_font->stride == 1) {
   1188  1.12  macallan 			for (i = 0; i < sc->sc_font->fontheight; i++) {
   1189  1.12  macallan 				mask = *data;
   1190  1.12  macallan 				summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
   1191  1.12  macallan 				    mask << 24);
   1192  1.12  macallan 				data++;
   1193  1.12  macallan 			}
   1194  1.12  macallan 		} else {
   1195  1.12  macallan 			data16 = (uint16_t *)data;
   1196  1.12  macallan 			for (i = 0; i < sc->sc_font->fontheight; i++) {
   1197  1.12  macallan 				mask = *data16;
   1198  1.12  macallan 				summitfb_write4(sc, VISFX_VRAM_WRITE_DATA_INCRY,
   1199  1.12  macallan 				    mask << 16);
   1200  1.12  macallan 				data16++;
   1201  1.12  macallan 			}
   1202  1.12  macallan 		}
   1203  1.12  macallan 	}
   1204  1.12  macallan }
   1205  1.12  macallan 
   1206  1.12  macallan static void
   1207  1.12  macallan summitfb_putchar_fast(void *cookie, int row, int col, u_int c, long attr)
   1208  1.12  macallan {
   1209  1.12  macallan 	struct rasops_info *ri = cookie;
   1210  1.12  macallan 	struct wsdisplay_font *font = PICK_FONT(ri, c);
   1211  1.12  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1212  1.12  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1213  1.12  macallan 	int i, x, y, wi, he, xs, ys;
   1214  1.12  macallan 	uint32_t bg, fg;
   1215  1.12  macallan 
   1216  1.12  macallan 	if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
   1217  1.12  macallan 		return;
   1218  1.12  macallan 
   1219  1.12  macallan 	if (!CHAR_IN_FONT(c, font))
   1220  1.12  macallan 		return;
   1221  1.12  macallan 
   1222  1.12  macallan 	/* for autogenerated line drawing characters */
   1223  1.12  macallan 	if (font != sc->sc_font) {
   1224  1.12  macallan 		summitfb_putchar(cookie, row, col, c, attr);
   1225  1.12  macallan 		return;
   1226  1.12  macallan 	}
   1227  1.12  macallan 
   1228  1.12  macallan 	/* XXX as long as we use putchar() to draw the cursor */
   1229   1.6  macallan #if 0
   1230  1.12  macallan 	if (row == ri->ri_crow && col == ri->ri_ccol) {
   1231  1.12  macallan 		ri->ri_flg &= ~RI_CURSOR;
   1232  1.12  macallan 	}
   1233   1.1  macallan #endif
   1234  1.12  macallan 	wi = font->fontwidth;
   1235  1.12  macallan 	he = font->fontheight;
   1236  1.12  macallan 
   1237  1.12  macallan 	x = ri->ri_xorigin + col * wi;
   1238  1.12  macallan 	y = ri->ri_yorigin + row * he;
   1239  1.12  macallan 
   1240  1.12  macallan 	bg = ri->ri_devcmap[(attr >> 16) & 0xf];
   1241  1.12  macallan 
   1242  1.12  macallan 	/* if we're drawing a space we're done here */
   1243  1.12  macallan 	if (c == 0x20) {
   1244  1.12  macallan 		summitfb_rectfill(sc, x, y, wi, he, bg);
   1245  1.12  macallan 		return;
   1246  1.12  macallan 	}
   1247  1.12  macallan 
   1248  1.12  macallan 	fg = ri->ri_devcmap[(attr >> 24) & 0x0f];
   1249  1.12  macallan 
   1250  1.12  macallan 	summitfb_write_mode(sc, 0x050000c0);
   1251  1.12  macallan 	summitfb_write4(sc, VISFX_VRAM_READ_MODE, 0x05000400);
   1252  1.12  macallan 	summitfb_write4(sc, VISFX_FG_COLOUR, fg);
   1253  1.12  macallan 	summitfb_write4(sc, VISFX_BG_COLOUR, bg);
   1254  1.12  macallan 
   1255  1.12  macallan 	i = c - font->firstchar;
   1256  1.12  macallan 	xs = sc->sc_font_start + (i % sc->sc_cols) * sc->sc_font->fontwidth;
   1257  1.12  macallan 	ys = (i / sc->sc_cols) * sc->sc_font->fontheight;
   1258  1.12  macallan 
   1259  1.12  macallan 	summitfb_write4(sc, VISFX_COPY_SRC, (xs << 16) | ys);
   1260  1.12  macallan 	summitfb_write4(sc, VISFX_COPY_WH, (wi << 16) | he);
   1261  1.12  macallan 	summitfb_write4(sc, VISFX_COPY_DST, (x << 16) | y);
   1262  1.12  macallan 
   1263   1.1  macallan }
   1264   1.1  macallan 
   1265  1.12  macallan #ifdef SUMMITFB_ENABLE_GC
   1266   1.1  macallan static void
   1267   1.1  macallan summitfb_putchar_aa(void *cookie, int row, int col, u_int c, long attr)
   1268   1.1  macallan {
   1269   1.1  macallan 	struct rasops_info *ri = cookie;
   1270   1.1  macallan 	struct wsdisplay_font *font = PICK_FONT(ri, c);
   1271   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1272   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1273   1.1  macallan 	int x, y, wi, he, rv = GC_NOPE;
   1274   1.1  macallan 	uint32_t bg;
   1275   1.1  macallan 
   1276   1.1  macallan 	if (sc->sc_mode != WSDISPLAYIO_MODE_EMUL)
   1277   1.1  macallan 		return;
   1278   1.1  macallan 
   1279   1.1  macallan 	if (!CHAR_IN_FONT(c, font))
   1280   1.1  macallan 		return;
   1281   1.1  macallan 
   1282   1.1  macallan 	if (row == ri->ri_crow && col == ri->ri_ccol) {
   1283   1.1  macallan 		ri->ri_flg &= ~RI_CURSOR;
   1284   1.1  macallan 	}
   1285   1.1  macallan 
   1286   1.1  macallan 	wi = font->fontwidth;
   1287   1.1  macallan 	he = font->fontheight;
   1288   1.1  macallan 
   1289   1.1  macallan 	x = ri->ri_xorigin + col * wi;
   1290   1.1  macallan 	y = ri->ri_yorigin + row * he;
   1291   1.1  macallan 
   1292   1.1  macallan 	bg = ri->ri_devcmap[(attr >> 16) & 0xf];
   1293   1.1  macallan 
   1294   1.1  macallan 	if (c == 0x20) {
   1295   1.1  macallan 		summitfb_rectfill(sc, x, y, wi, he, bg);
   1296   1.1  macallan 		return;
   1297   1.1  macallan 	}
   1298   1.1  macallan 
   1299   1.1  macallan 	rv = glyphcache_try(&sc->sc_gc, c, x, y, attr);
   1300   1.1  macallan 	if (rv == GC_OK)
   1301   1.1  macallan 		return;
   1302   1.1  macallan 
   1303   1.8  macallan 	summitfb_setup_fb(sc);
   1304  1.10  macallan 	summitfb_wait(sc);
   1305   1.1  macallan 	sc->sc_putchar(cookie, row, col, c, attr);
   1306   1.1  macallan 
   1307   1.1  macallan 	if (rv == GC_ADD)
   1308   1.1  macallan 		glyphcache_add(&sc->sc_gc, c, x, y);
   1309   1.1  macallan }
   1310  1.12  macallan #endif
   1311   1.1  macallan 
   1312   1.1  macallan static void
   1313   1.1  macallan summitfb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
   1314   1.1  macallan {
   1315   1.1  macallan 	struct rasops_info *ri = cookie;
   1316   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1317   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1318   1.1  macallan 	int32_t xs, xd, y, width, height;
   1319   1.1  macallan 
   1320   1.1  macallan 	if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
   1321   1.6  macallan #if 0
   1322   1.1  macallan 		if (ri->ri_crow == row &&
   1323   1.2  riastrad 		    ri->ri_ccol >= srccol && ri->ri_ccol < (srccol + ncols) &&
   1324   1.2  riastrad 		    (ri->ri_flg & RI_CURSOR)) {
   1325   1.1  macallan 			summitfb_nuke_cursor(ri);
   1326   1.1  macallan 		}
   1327   1.6  macallan #endif
   1328   1.1  macallan 		xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
   1329   1.1  macallan 		xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
   1330   1.1  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
   1331   1.1  macallan 		width = ri->ri_font->fontwidth * ncols;
   1332   1.1  macallan 		height = ri->ri_font->fontheight;
   1333   1.1  macallan 		summitfb_bitblt(sc, xs, y, xd, y, width, height, RopSrc);
   1334   1.6  macallan 
   1335   1.1  macallan 		if (ri->ri_crow == row &&
   1336   1.2  riastrad 		    ri->ri_ccol >= dstcol && ri->ri_ccol < (dstcol + ncols))
   1337   1.1  macallan 			ri->ri_flg &= ~RI_CURSOR;
   1338   1.1  macallan 	}
   1339   1.1  macallan }
   1340   1.1  macallan 
   1341   1.1  macallan static void
   1342   1.2  riastrad summitfb_erasecols(void *cookie, int row, int startcol, int ncols,
   1343   1.2  riastrad     long fillattr)
   1344   1.1  macallan {
   1345   1.1  macallan 	struct rasops_info *ri = cookie;
   1346   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1347   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1348   1.1  macallan 	int32_t x, y, width, height, fg, bg, ul;
   1349   1.1  macallan 
   1350   1.1  macallan 	if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
   1351   1.1  macallan 		x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
   1352   1.1  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
   1353   1.1  macallan 		width = ri->ri_font->fontwidth * ncols;
   1354   1.1  macallan 		height = ri->ri_font->fontheight;
   1355   1.1  macallan 		rasops_unpack_attr(fillattr, &fg, &bg, &ul);
   1356   1.1  macallan 
   1357   1.1  macallan 		summitfb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
   1358   1.6  macallan 
   1359   1.1  macallan 		if (ri->ri_crow == row &&
   1360   1.2  riastrad 		    ri->ri_ccol >= startcol &&
   1361   1.2  riastrad 		    ri->ri_ccol < (startcol + ncols))
   1362   1.1  macallan 			ri->ri_flg &= ~RI_CURSOR;
   1363   1.1  macallan 	}
   1364   1.1  macallan }
   1365   1.1  macallan 
   1366   1.1  macallan static void
   1367   1.1  macallan summitfb_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
   1368   1.1  macallan {
   1369   1.1  macallan 	struct rasops_info *ri = cookie;
   1370   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1371   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1372   1.1  macallan 	int32_t x, ys, yd, width, height;
   1373   1.1  macallan 
   1374   1.1  macallan 	if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
   1375   1.6  macallan #if 0
   1376   1.2  riastrad 		if (ri->ri_crow >= srcrow && ri->ri_crow < (srcrow + nrows) &&
   1377   1.2  riastrad 		    (ri->ri_flg & RI_CURSOR)) {
   1378   1.1  macallan 			summitfb_nuke_cursor(ri);
   1379   1.1  macallan 		}
   1380   1.6  macallan #endif
   1381   1.1  macallan 		x = ri->ri_xorigin;
   1382   1.1  macallan 		ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
   1383   1.1  macallan 		yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
   1384   1.1  macallan 		width = ri->ri_emuwidth;
   1385   1.1  macallan 		height = ri->ri_font->fontheight * nrows;
   1386   1.1  macallan 		summitfb_bitblt(sc, x, ys, x, yd, width, height, RopSrc);
   1387   1.6  macallan 
   1388   1.1  macallan 		if (ri->ri_crow >= dstrow && ri->ri_crow < (dstrow + nrows))
   1389   1.1  macallan 			ri->ri_flg &= ~RI_CURSOR;
   1390   1.1  macallan 	}
   1391   1.1  macallan }
   1392   1.1  macallan 
   1393   1.1  macallan static void
   1394   1.1  macallan summitfb_eraserows(void *cookie, int row, int nrows, long fillattr)
   1395   1.1  macallan {
   1396   1.1  macallan 	struct rasops_info *ri = cookie;
   1397   1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
   1398   1.1  macallan 	struct summitfb_softc *sc = scr->scr_cookie;
   1399   1.1  macallan 	int32_t x, y, width, height, fg, bg, ul;
   1400   1.1  macallan 
   1401   1.1  macallan 	if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
   1402   1.1  macallan 		x = ri->ri_xorigin;
   1403   1.1  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
   1404   1.1  macallan 		width = ri->ri_emuwidth;
   1405   1.1  macallan 		height = ri->ri_font->fontheight * nrows;
   1406   1.1  macallan 		rasops_unpack_attr(fillattr, &fg, &bg, &ul);
   1407   1.1  macallan 
   1408   1.1  macallan 		summitfb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
   1409   1.1  macallan 
   1410   1.1  macallan 		if (ri->ri_crow >= row && ri->ri_crow < (row + nrows))
   1411   1.1  macallan 			ri->ri_flg &= ~RI_CURSOR;
   1412   1.1  macallan 	}
   1413   1.1  macallan }
   1414   1.1  macallan 
   1415   1.1  macallan static void
   1416   1.1  macallan summitfb_move_cursor(struct summitfb_softc *sc, int x, int y)
   1417   1.1  macallan {
   1418   1.1  macallan 	uint32_t pos;
   1419   1.1  macallan 
   1420   1.1  macallan 	sc->sc_cursor_x = x;
   1421   1.1  macallan 	x -= sc->sc_hot_x;
   1422   1.1  macallan 	sc->sc_cursor_y = y;
   1423   1.1  macallan 	y -= sc->sc_hot_y;
   1424   1.1  macallan 
   1425   1.1  macallan 	if (x < 0) x = 0x1000 - x;
   1426   1.1  macallan 	if (y < 0) y = 0x1000 - y;
   1427   1.1  macallan 	pos = (x << 16) | y;
   1428   1.1  macallan 	if (sc->sc_enabled) pos |= 0x80000000;
   1429   1.4  macallan 	summitfb_write4(sc, VISFX_CURSOR_POS, pos);
   1430   1.1  macallan }
   1431   1.1  macallan 
   1432   1.1  macallan static int
   1433   1.1  macallan summitfb_do_cursor(struct summitfb_softc *sc, struct wsdisplay_cursor *cur)
   1434   1.1  macallan {
   1435   1.2  riastrad 
   1436   1.1  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
   1437   1.1  macallan 		sc->sc_enabled = cur->enable;
   1438   1.1  macallan 		cur->which |= WSDISPLAY_CURSOR_DOPOS;
   1439   1.1  macallan 	}
   1440   1.1  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
   1441   1.1  macallan 		sc->sc_hot_x = cur->hot.x;
   1442   1.1  macallan 		sc->sc_hot_y = cur->hot.y;
   1443   1.1  macallan 		cur->which |= WSDISPLAY_CURSOR_DOPOS;
   1444   1.1  macallan 	}
   1445   1.1  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
   1446   1.1  macallan 		summitfb_move_cursor(sc, cur->pos.x, cur->pos.y);
   1447   1.1  macallan 	}
   1448   1.1  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
   1449   1.4  macallan 		uint32_t rgb;
   1450   1.1  macallan 		uint8_t r[2], g[2], b[2];
   1451   1.1  macallan 
   1452   1.1  macallan 		copyin(cur->cmap.blue, b, 2);
   1453   1.1  macallan 		copyin(cur->cmap.green, g, 2);
   1454   1.1  macallan 		copyin(cur->cmap.red, r, 2);
   1455   1.4  macallan 		summitfb_write4(sc, VISFX_CURSOR_INDEX, 0);
   1456   1.4  macallan 		rgb = r[0] << 16 | g[0] << 8 | b[0];
   1457   1.4  macallan 		summitfb_write4(sc, VISFX_CURSOR_COLOR, rgb);
   1458   1.4  macallan 		rgb = r[1] << 16 | g[1] << 8 | b[1];
   1459   1.6  macallan 		/* this isn't right */
   1460   1.4  macallan 		summitfb_write4(sc, VISFX_CURSOR_COLOR + 4, rgb);
   1461   1.6  macallan 
   1462   1.1  macallan 	}
   1463   1.1  macallan 	if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {
   1464   1.4  macallan 
   1465   1.1  macallan 		uint32_t buffer[128], latch, tmp;
   1466   1.1  macallan 		int i;
   1467   1.1  macallan 
   1468   1.1  macallan 		copyin(cur->mask, buffer, 512);
   1469   1.4  macallan 		summitfb_write4(sc, VISFX_CURSOR_INDEX, 0);
   1470   1.1  macallan 		for (i = 0; i < 128; i += 2) {
   1471   1.1  macallan 			latch = 0;
   1472   1.1  macallan 			tmp = buffer[i] & 0x80808080;
   1473   1.1  macallan 			latch |= tmp >> 7;
   1474   1.1  macallan 			tmp = buffer[i] & 0x40404040;
   1475   1.1  macallan 			latch |= tmp >> 5;
   1476   1.1  macallan 			tmp = buffer[i] & 0x20202020;
   1477   1.1  macallan 			latch |= tmp >> 3;
   1478   1.1  macallan 			tmp = buffer[i] & 0x10101010;
   1479   1.1  macallan 			latch |= tmp >> 1;
   1480   1.1  macallan 			tmp = buffer[i] & 0x08080808;
   1481   1.1  macallan 			latch |= tmp << 1;
   1482   1.1  macallan 			tmp = buffer[i] & 0x04040404;
   1483   1.1  macallan 			latch |= tmp << 3;
   1484   1.1  macallan 			tmp = buffer[i] & 0x02020202;
   1485   1.1  macallan 			latch |= tmp << 5;
   1486   1.1  macallan 			tmp = buffer[i] & 0x01010101;
   1487   1.1  macallan 			latch |= tmp << 7;
   1488   1.4  macallan 			summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
   1489   1.1  macallan 			latch = 0;
   1490   1.1  macallan 			tmp = buffer[i + 1] & 0x80808080;
   1491   1.1  macallan 			latch |= tmp >> 7;
   1492   1.1  macallan 			tmp = buffer[i + 1] & 0x40404040;
   1493   1.1  macallan 			latch |= tmp >> 5;
   1494   1.1  macallan 			tmp = buffer[i + 1] & 0x20202020;
   1495   1.1  macallan 			latch |= tmp >> 3;
   1496   1.1  macallan 			tmp = buffer[i + 1] & 0x10101010;
   1497   1.1  macallan 			latch |= tmp >> 1;
   1498   1.1  macallan 			tmp = buffer[i + 1] & 0x08080808;
   1499   1.1  macallan 			latch |= tmp << 1;
   1500   1.1  macallan 			tmp = buffer[i + 1] & 0x04040404;
   1501   1.1  macallan 			latch |= tmp << 3;
   1502   1.1  macallan 			tmp = buffer[i + 1] & 0x02020202;
   1503   1.1  macallan 			latch |= tmp << 5;
   1504   1.1  macallan 			tmp = buffer[i + 1] & 0x01010101;
   1505   1.1  macallan 			latch |= tmp << 7;
   1506   1.4  macallan 			summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
   1507   1.1  macallan 		}
   1508   1.1  macallan 
   1509   1.4  macallan 		summitfb_write4(sc, VISFX_CURSOR_INDEX, 0x80);
   1510   1.1  macallan 		copyin(cur->image, buffer, 512);
   1511   1.1  macallan 		for (i = 0; i < 128; i += 2) {
   1512   1.1  macallan 			latch = 0;
   1513   1.1  macallan 			tmp = buffer[i] & 0x80808080;
   1514   1.1  macallan 			latch |= tmp >> 7;
   1515   1.1  macallan 			tmp = buffer[i] & 0x40404040;
   1516   1.1  macallan 			latch |= tmp >> 5;
   1517   1.1  macallan 			tmp = buffer[i] & 0x20202020;
   1518   1.1  macallan 			latch |= tmp >> 3;
   1519   1.1  macallan 			tmp = buffer[i] & 0x10101010;
   1520   1.1  macallan 			latch |= tmp >> 1;
   1521   1.1  macallan 			tmp = buffer[i] & 0x08080808;
   1522   1.1  macallan 			latch |= tmp << 1;
   1523   1.1  macallan 			tmp = buffer[i] & 0x04040404;
   1524   1.1  macallan 			latch |= tmp << 3;
   1525   1.1  macallan 			tmp = buffer[i] & 0x02020202;
   1526   1.1  macallan 			latch |= tmp << 5;
   1527   1.1  macallan 			tmp = buffer[i] & 0x01010101;
   1528   1.1  macallan 			latch |= tmp << 7;
   1529   1.4  macallan 			summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
   1530   1.1  macallan 			latch = 0;
   1531   1.1  macallan 			tmp = buffer[i + 1] & 0x80808080;
   1532   1.1  macallan 			latch |= tmp >> 7;
   1533   1.1  macallan 			tmp = buffer[i + 1] & 0x40404040;
   1534   1.1  macallan 			latch |= tmp >> 5;
   1535   1.1  macallan 			tmp = buffer[i + 1] & 0x20202020;
   1536   1.1  macallan 			latch |= tmp >> 3;
   1537   1.1  macallan 			tmp = buffer[i + 1] & 0x10101010;
   1538   1.1  macallan 			latch |= tmp >> 1;
   1539   1.1  macallan 			tmp = buffer[i + 1] & 0x08080808;
   1540   1.1  macallan 			latch |= tmp << 1;
   1541   1.1  macallan 			tmp = buffer[i + 1] & 0x04040404;
   1542   1.1  macallan 			latch |= tmp << 3;
   1543   1.1  macallan 			tmp = buffer[i + 1] & 0x02020202;
   1544   1.1  macallan 			latch |= tmp << 5;
   1545   1.1  macallan 			tmp = buffer[i + 1] & 0x01010101;
   1546   1.1  macallan 			latch |= tmp << 7;
   1547   1.4  macallan 			summitfb_write4(sc, VISFX_CURSOR_DATA, latch);
   1548   1.1  macallan 		}
   1549   1.4  macallan 		summitfb_setup_fb(sc);
   1550   1.1  macallan 	}
   1551   1.1  macallan 
   1552   1.1  macallan 	return 0;
   1553   1.1  macallan }
   1554   1.1  macallan 
   1555   1.1  macallan static void
   1556   1.1  macallan summitfb_set_video(struct summitfb_softc *sc, int on)
   1557   1.1  macallan {
   1558   1.2  riastrad 
   1559   1.1  macallan 	if (sc->sc_video_on == on)
   1560   1.1  macallan 		return;
   1561   1.1  macallan 
   1562   1.1  macallan 	sc->sc_video_on = on;
   1563   1.1  macallan 
   1564   1.1  macallan 	summitfb_wait(sc);
   1565   1.1  macallan 	if (on) {
   1566   1.1  macallan 	} else {
   1567   1.1  macallan 	}
   1568   1.1  macallan }
   1569