Home | History | Annotate | Line # | Download | only in sbus
zx.c revision 1.33
      1  1.33   tsutsui /*	$NetBSD: zx.c,v 1.33 2009/09/19 11:55:09 tsutsui Exp $	*/
      2   1.1        ad 
      3   1.1        ad /*
      4   1.1        ad  *  Copyright (c) 2002 The NetBSD Foundation, Inc.
      5   1.1        ad  *  All rights reserved.
      6   1.1        ad  *
      7   1.1        ad  *  This code is derived from software contributed to The NetBSD Foundation
      8   1.1        ad  *  by Andrew Doran.
      9   1.1        ad  *
     10   1.1        ad  *  Redistribution and use in source and binary forms, with or without
     11   1.1        ad  *  modification, are permitted provided that the following conditions
     12   1.1        ad  *  are met:
     13   1.1        ad  *  1. Redistributions of source code must retain the above copyright
     14   1.1        ad  *     notice, this list of conditions and the following disclaimer.
     15   1.1        ad  *  2. Redistributions in binary form must reproduce the above copyright
     16   1.1        ad  *     notice, this list of conditions and the following disclaimer in the
     17   1.1        ad  *     documentation and/or other materials provided with the distribution.
     18   1.1        ad  *
     19   1.1        ad  *  THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20   1.1        ad  *  ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21   1.1        ad  *  TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22   1.1        ad  *  PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23   1.1        ad  *  BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24   1.1        ad  *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25   1.1        ad  *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26   1.1        ad  *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27   1.1        ad  *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28   1.1        ad  *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29   1.1        ad  *  POSSIBILITY OF SUCH DAMAGE.
     30   1.1        ad  */
     31   1.1        ad 
     32   1.1        ad /*
     33   1.1        ad  * Driver for the Sun ZX display adapter.  This would be called 'leo', but
     34   1.1        ad  * NetBSD/amiga already has a driver by that name.  The XFree86 and Linux
     35   1.1        ad  * drivers were used as "living documentation" when writing this; thanks
     36   1.1        ad  * to the authors.
     37   1.1        ad  *
     38   1.1        ad  * Issues (which can be solved with wscons, happily enough):
     39   1.1        ad  *
     40   1.1        ad  * o There is lots of unnecessary mucking about rasops in here, primarily
     41   1.1        ad  *   to appease the sparc fb code.
     42   1.1        ad  *
     43   1.1        ad  * o RASTERCONSOLE is required.  X needs the board set up correctly, and
     44   1.1        ad  *   that's difficult to reconcile with using the PROM for output.
     45   1.1        ad  */
     46   1.1        ad 
     47   1.1        ad #include <sys/cdefs.h>
     48  1.33   tsutsui __KERNEL_RCSID(0, "$NetBSD: zx.c,v 1.33 2009/09/19 11:55:09 tsutsui Exp $");
     49   1.1        ad 
     50   1.1        ad #include <sys/param.h>
     51   1.1        ad #include <sys/systm.h>
     52   1.1        ad #include <sys/device.h>
     53   1.1        ad #include <sys/ioctl.h>
     54   1.1        ad #include <sys/malloc.h>
     55   1.1        ad #include <sys/mman.h>
     56   1.1        ad #include <sys/tty.h>
     57   1.1        ad #include <sys/conf.h>
     58   1.1        ad #include <sys/syslog.h>
     59   1.1        ad #include <sys/buf.h>
     60   1.1        ad 
     61  1.20        ad #include <sys/bus.h>
     62   1.1        ad #include <machine/autoconf.h>
     63   1.1        ad 
     64   1.1        ad #include <uvm/uvm_extern.h>
     65   1.1        ad 
     66   1.1        ad #include <dev/sun/fbio.h>
     67   1.1        ad #include <dev/sun/fbvar.h>
     68   1.1        ad 
     69  1.27  macallan #include "wsdisplay.h"
     70  1.27  macallan #if NWSDISPLAY > 0
     71  1.27  macallan #include <dev/wscons/wsconsio.h>
     72  1.27  macallan #include <dev/wsfont/wsfont.h>
     73  1.27  macallan #include <dev/rasops/rasops.h>
     74  1.27  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     75  1.27  macallan 
     76  1.27  macallan #include "opt_wsemul.h"
     77  1.27  macallan #endif
     78  1.27  macallan 
     79   1.1        ad #include <dev/sbus/zxreg.h>
     80   1.1        ad #include <dev/sbus/zxvar.h>
     81   1.1        ad #include <dev/sbus/sbusvar.h>
     82   1.1        ad 
     83   1.1        ad #include <dev/wscons/wsconsio.h>
     84   1.1        ad 
     85  1.32   tsutsui #include "ioconf.h"
     86  1.32   tsutsui 
     87  1.27  macallan #if (NWSDISPLAY == 0) && !defined(RASTERCONSOLE)
     88  1.27  macallan #error Sorry, this driver needs WSCONS or RASTERCONSOLE
     89  1.27  macallan #endif
     90  1.27  macallan 
     91  1.27  macallan #if (NWSDISPLAY > 0) && defined(RASTERCONSOLE)
     92  1.27  macallan #error Sorry, RASTERCONSOLE and WSCONS are mutually exclusive
     93   1.1        ad #endif
     94   1.1        ad 
     95   1.1        ad #define	ZX_STD_ROP	(ZX_ROP_NEW | ZX_ATTR_WE_ENABLE | \
     96   1.1        ad     ZX_ATTR_OE_ENABLE | ZX_ATTR_FORCE_WID)
     97   1.1        ad 
     98  1.27  macallan static void	zx_attach(device_t, device_t, void *);
     99  1.29    cegger static int	zx_match(device_t, cfdata_t, void *);
    100   1.1        ad 
    101  1.27  macallan static void	zx_blank(device_t);
    102  1.27  macallan static int	zx_cmap_put(struct zx_softc *);
    103  1.27  macallan static void	zx_copyrect(struct zx_softc *, int, int, int, int, int, int);
    104  1.27  macallan static int	zx_cross_loadwid(struct zx_softc *, u_int, u_int, u_int);
    105  1.27  macallan static int	zx_cross_wait(struct zx_softc *);
    106  1.27  macallan static void	zx_fillrect(struct zx_softc *, int, int, int, int, uint32_t, int);
    107  1.27  macallan static int	zx_intr(void *);
    108  1.27  macallan static void	zx_reset(struct zx_softc *);
    109  1.27  macallan static void	zx_unblank(device_t);
    110  1.27  macallan 
    111  1.27  macallan static void	zx_cursor_blank(struct zx_softc *);
    112  1.27  macallan static void	zx_cursor_color(struct zx_softc *);
    113  1.27  macallan static void	zx_cursor_move(struct zx_softc *);
    114  1.27  macallan static void	zx_cursor_set(struct zx_softc *);
    115  1.27  macallan static void	zx_cursor_unblank(struct zx_softc *);
    116  1.27  macallan 
    117  1.27  macallan static void	zx_copycols(void *, int, int, int, int);
    118  1.27  macallan static void	zx_copyrows(void *, int, int, int);
    119  1.27  macallan static void	zx_do_cursor(void *, int, int, int);
    120  1.27  macallan static void	zx_erasecols(void *, int, int, int, long);
    121  1.27  macallan static void	zx_eraserows(void *, int, int, long);
    122  1.27  macallan static void	zx_putchar(void *, int, int, u_int, long);
    123   1.1        ad 
    124   1.1        ad struct zx_mmo {
    125   1.1        ad 	off_t	mo_va;
    126   1.1        ad 	off_t	mo_pa;
    127   1.1        ad 	off_t	mo_size;
    128   1.1        ad } static const zx_mmo[] = {
    129   1.1        ad 	{ ZX_FB0_VOFF,		ZX_OFF_SS0,		0x00800000 },
    130   1.1        ad 	{ ZX_LC0_VOFF,		ZX_OFF_LC_SS0_USR,	0x00001000 },
    131   1.1        ad 	{ ZX_LD0_VOFF,		ZX_OFF_LD_SS0,		0x00001000 },
    132   1.1        ad 	{ ZX_LX0_CURSOR_VOFF,	ZX_OFF_LX_CURSOR,	0x00001000 },
    133   1.1        ad 	{ ZX_FB1_VOFF,		ZX_OFF_SS1,		0x00800000 },
    134   1.1        ad 	{ ZX_LC1_VOFF,		ZX_OFF_LC_SS1_USR,	0x00001000 },
    135   1.1        ad 	{ ZX_LD1_VOFF,		ZX_OFF_LD_SS1,		0x00001000 },
    136   1.1        ad 	{ ZX_LX_KRN_VOFF,	ZX_OFF_LX_CROSS,	0x00001000 },
    137   1.1        ad 	{ ZX_LC0_KRN_VOFF,	ZX_OFF_LC_SS0_KRN,	0x00001000 },
    138   1.1        ad 	{ ZX_LC1_KRN_VOFF,	ZX_OFF_LC_SS1_KRN,	0x00001000 },
    139   1.1        ad 	{ ZX_LD_GBL_VOFF,	ZX_OFF_LD_GBL,		0x00001000 },
    140  1.14     perry };
    141   1.1        ad 
    142  1.27  macallan CFATTACH_DECL_NEW(zx, sizeof(struct zx_softc),
    143   1.5   thorpej     zx_match, zx_attach, NULL, NULL);
    144   1.1        ad 
    145  1.27  macallan static dev_type_open(zxopen);
    146  1.27  macallan static dev_type_close(zxclose);
    147  1.27  macallan static dev_type_ioctl(zxioctl);
    148  1.27  macallan static dev_type_mmap(zxmmap);
    149   1.1        ad 
    150   1.1        ad static struct fbdriver zx_fbdriver = {
    151   1.1        ad 	zx_unblank, zxopen, zxclose, zxioctl, nopoll, zxmmap
    152   1.1        ad };
    153   1.1        ad 
    154  1.27  macallan #if NWSDISPLAY > 0
    155  1.27  macallan struct wsscreen_descr zx_defaultscreen = {
    156  1.27  macallan 	"std",
    157  1.27  macallan 	0, 0,	/* will be filled in -- XXX shouldn't, it's global */
    158  1.27  macallan 		/* doesn't matter - you can't really have more than one leo */
    159  1.27  macallan 	NULL,		/* textops */
    160  1.27  macallan 	8, 16,	/* font width/height */
    161  1.27  macallan 	WSSCREEN_WSCOLORS,	/* capabilities */
    162  1.27  macallan 	NULL	/* modecookie */
    163  1.27  macallan };
    164  1.27  macallan 
    165  1.27  macallan static int 	zx_ioctl(void *, void *, u_long, void *, int, struct lwp *);
    166  1.27  macallan static paddr_t	zx_mmap(void *, void *, off_t, int);
    167  1.27  macallan static void	zx_init_screen(void *, struct vcons_screen *, int, long *);
    168  1.27  macallan 
    169  1.27  macallan static int	zx_putcmap(struct zx_softc *, struct wsdisplay_cmap *);
    170  1.27  macallan static int	zx_getcmap(struct zx_softc *, struct wsdisplay_cmap *);
    171  1.27  macallan 
    172  1.27  macallan struct wsdisplay_accessops zx_accessops = {
    173  1.27  macallan 	zx_ioctl,
    174  1.27  macallan 	zx_mmap,
    175  1.27  macallan 	NULL,	/* alloc_screen */
    176  1.27  macallan 	NULL,	/* free_screen */
    177  1.27  macallan 	NULL,	/* show_screen */
    178  1.27  macallan 	NULL, 	/* load_font */
    179  1.27  macallan 	NULL,	/* pollc */
    180  1.27  macallan 	NULL	/* scroll */
    181  1.27  macallan };
    182  1.27  macallan 
    183  1.27  macallan const struct wsscreen_descr *_zx_scrlist[] = {
    184  1.27  macallan 	&zx_defaultscreen
    185  1.27  macallan };
    186  1.27  macallan 
    187  1.27  macallan struct wsscreen_list zx_screenlist = {
    188  1.27  macallan 	sizeof(_zx_scrlist) / sizeof(struct wsscreen_descr *),
    189  1.27  macallan 	_zx_scrlist
    190  1.27  macallan };
    191  1.27  macallan 
    192  1.27  macallan 
    193  1.27  macallan extern const u_char rasops_cmap[768];
    194  1.27  macallan 
    195  1.27  macallan static struct vcons_screen zx_console_screen;
    196  1.27  macallan #endif /* NWSDISPLAY > 0 */
    197  1.27  macallan 
    198  1.27  macallan static int
    199  1.29    cegger zx_match(device_t parent, cfdata_t cf, void *aux)
    200   1.1        ad {
    201   1.1        ad 	struct sbus_attach_args *sa;
    202  1.14     perry 
    203   1.1        ad 	sa = (struct sbus_attach_args *)aux;
    204   1.1        ad 
    205   1.1        ad 	return (strcmp(sa->sa_name, "SUNW,leo") == 0);
    206   1.1        ad }
    207   1.1        ad 
    208  1.27  macallan static void
    209  1.27  macallan zx_attach(device_t parent, device_t self, void *args)
    210   1.1        ad {
    211   1.1        ad 	struct zx_softc *sc;
    212   1.1        ad 	struct sbus_attach_args *sa;
    213   1.1        ad 	bus_space_handle_t bh;
    214   1.1        ad 	bus_space_tag_t bt;
    215   1.1        ad 	struct fbdevice *fb;
    216  1.27  macallan #if NWSDISPLAY > 0
    217  1.27  macallan 	struct wsemuldisplaydev_attach_args aa;
    218  1.27  macallan 	struct rasops_info *ri = &zx_console_screen.scr_ri;
    219  1.27  macallan 	unsigned long defattr;
    220  1.27  macallan #endif
    221  1.28  macallan 	int isconsole, width, height;
    222   1.1        ad 
    223  1.24  drochner 	sc = device_private(self);
    224  1.27  macallan 	sc->sc_dv = self;
    225  1.27  macallan 
    226   1.1        ad 	sa = args;
    227   1.1        ad 	fb = &sc->sc_fb;
    228   1.1        ad 	bt = sa->sa_bustag;
    229   1.1        ad 	sc->sc_bt = bt;
    230   1.1        ad 	sc->sc_paddr = sbus_bus_addr(bt, sa->sa_slot, sa->sa_offset);
    231   1.1        ad 
    232  1.30  macallan 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_SS0,
    233  1.30  macallan 	    0x800000, BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE, &bh) != 0) {
    234  1.21    cegger 		aprint_error_dev(self, "can't map bits\n");
    235   1.1        ad 		return;
    236   1.1        ad 	}
    237  1.19  christos 	fb->fb_pixels = (void *)bus_space_vaddr(bt, bh);
    238  1.33   tsutsui 	sc->sc_pixels = (uint32_t *)fb->fb_pixels;
    239   1.1        ad 
    240   1.1        ad 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_LC_SS0_USR,
    241   1.1        ad 	    PAGE_SIZE, BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    242  1.21    cegger 		aprint_error_dev(self, "can't map zc\n");
    243   1.1        ad 		return;
    244   1.1        ad 	}
    245  1.27  macallan 
    246  1.25   tsutsui 	sc->sc_bhzc = bh;
    247   1.1        ad 
    248   1.1        ad 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_LD_SS0,
    249   1.1        ad 	    PAGE_SIZE, BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    250  1.21    cegger 		aprint_error_dev(self, "can't map ld/ss0\n");
    251   1.1        ad 		return;
    252   1.1        ad 	}
    253  1.25   tsutsui 	sc->sc_bhzdss0 = bh;
    254   1.1        ad 
    255   1.1        ad 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_LD_SS1,
    256   1.1        ad 	    PAGE_SIZE, BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    257  1.21    cegger 		aprint_error_dev(self, "can't map ld/ss1\n");
    258   1.1        ad 		return;
    259   1.1        ad 	}
    260  1.25   tsutsui 	sc->sc_bhzdss1 = bh;
    261   1.1        ad 
    262   1.1        ad 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_LX_CROSS,
    263   1.1        ad 	    PAGE_SIZE, BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    264  1.21    cegger 		aprint_error_dev(self, "can't map zx\n");
    265   1.1        ad 		return;
    266   1.1        ad 	}
    267  1.25   tsutsui 	sc->sc_bhzx = bh;
    268   1.1        ad 
    269   1.1        ad 	if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + ZX_OFF_LX_CURSOR,
    270   1.1        ad 	    PAGE_SIZE, BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    271  1.21    cegger 		aprint_error_dev(self, "can't map zcu\n");
    272   1.1        ad 		return;
    273   1.1        ad 	}
    274  1.25   tsutsui 	sc->sc_bhzcu = bh;
    275   1.1        ad 
    276   1.1        ad 	fb->fb_driver = &zx_fbdriver;
    277  1.27  macallan 	fb->fb_device = sc->sc_dv;
    278  1.27  macallan 	fb->fb_flags = device_cfdata(sc->sc_dv)->cf_flags & FB_USERMASK;
    279   1.1        ad 	fb->fb_pfour = NULL;
    280  1.26   tsutsui 	fb->fb_linebytes = prom_getpropint(sa->sa_node, "linebytes", 8192);
    281   1.1        ad 
    282  1.26   tsutsui 	width = prom_getpropint(sa->sa_node, "width", 1280);
    283  1.26   tsutsui 	height = prom_getpropint(sa->sa_node, "height", 1024);
    284  1.26   tsutsui 	fb_setsize_obp(fb, 32, width, height, sa->sa_node);
    285   1.1        ad 
    286   1.1        ad 	fb->fb_type.fb_cmsize = 256;
    287   1.1        ad 	fb->fb_type.fb_depth = 32;
    288   1.1        ad 	fb->fb_type.fb_size = fb->fb_type.fb_height * fb->fb_linebytes;
    289   1.1        ad 	fb->fb_type.fb_type = FBTYPE_SUNLEO;
    290   1.1        ad 
    291   1.1        ad 	printf(": %d x %d", fb->fb_type.fb_width, fb->fb_type.fb_height);
    292   1.1        ad 	isconsole = fb_is_console(sa->sa_node);
    293   1.1        ad 	if (isconsole)
    294   1.1        ad 		printf(" (console)");
    295   1.1        ad 	printf("\n");
    296   1.1        ad 
    297   1.1        ad 	if (sa->sa_nintr != 0)
    298   1.6        pk 		bus_intr_establish(bt, sa->sa_pri, IPL_NONE, zx_intr, sc);
    299   1.1        ad 
    300   1.1        ad 	sc->sc_cmap = malloc(768, M_DEVBUF, M_NOWAIT);
    301   1.1        ad 	zx_reset(sc);
    302   1.1        ad 
    303  1.27  macallan #if NWSDISPLAY > 0
    304  1.27  macallan 	sc->sc_width = fb->fb_type.fb_width;
    305  1.27  macallan 	sc->sc_stride = 8192; /* 32 bit */
    306  1.27  macallan 	sc->sc_height = fb->fb_type.fb_height;
    307  1.27  macallan 
    308  1.27  macallan 	/* setup rasops and so on for wsdisplay */
    309  1.27  macallan 	wsfont_init();
    310  1.27  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    311  1.27  macallan 	sc->sc_bg = WS_DEFAULT_BG;
    312  1.27  macallan 
    313  1.27  macallan 	vcons_init(&sc->vd, sc, &zx_defaultscreen, &zx_accessops);
    314  1.27  macallan 	sc->vd.init_screen = zx_init_screen;
    315  1.27  macallan 
    316  1.27  macallan 	if (isconsole) {
    317  1.27  macallan 		/* we mess with zx_console_screen only once */
    318  1.27  macallan 		vcons_init_screen(&sc->vd, &zx_console_screen, 1,
    319  1.27  macallan 		    &defattr);
    320  1.27  macallan 		zx_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    321  1.27  macallan 
    322  1.27  macallan 		zx_defaultscreen.textops = &ri->ri_ops;
    323  1.27  macallan 		zx_defaultscreen.capabilities = WSSCREEN_WSCOLORS;
    324  1.27  macallan 		zx_defaultscreen.nrows = ri->ri_rows;
    325  1.27  macallan 		zx_defaultscreen.ncols = ri->ri_cols;
    326  1.28  macallan 		zx_fillrect(sc, 0, 0, width, height,
    327  1.28  macallan 		     ri->ri_devcmap[defattr >> 16], ZX_STD_ROP);
    328  1.27  macallan 		wsdisplay_cnattach(&zx_defaultscreen, ri, 0, 0, defattr);
    329  1.27  macallan 	} else {
    330  1.27  macallan 		/*
    331  1.27  macallan 		 * we're not the console so we just clear the screen and don't
    332  1.27  macallan 		 * set up any sort of text display
    333  1.27  macallan 		 */
    334  1.27  macallan 		if (zx_defaultscreen.textops == NULL) {
    335  1.27  macallan 			/*
    336  1.27  macallan 			 * ugly, but...
    337  1.27  macallan 			 * we want the console settings to win, so we only
    338  1.27  macallan 			 * touch anything when we find an untouched screen
    339  1.27  macallan 			 * definition. In this case we fill it from fb to
    340  1.27  macallan 			 * avoid problems in case no zx is the console
    341  1.27  macallan 			 */
    342  1.27  macallan 			ri = &sc->sc_fb.fb_rinfo;
    343  1.27  macallan 			zx_defaultscreen.textops = &ri->ri_ops;
    344  1.27  macallan 			zx_defaultscreen.capabilities = ri->ri_caps;
    345  1.27  macallan 			zx_defaultscreen.nrows = ri->ri_rows;
    346  1.27  macallan 			zx_defaultscreen.ncols = ri->ri_cols;
    347  1.27  macallan 		}
    348  1.27  macallan 	}
    349   1.1        ad 
    350  1.27  macallan 	aa.scrdata = &zx_screenlist;
    351  1.27  macallan 	aa.console = isconsole;
    352  1.27  macallan 	aa.accessops = &zx_accessops;
    353  1.27  macallan 	aa.accesscookie = &sc->vd;
    354  1.27  macallan 	config_found(sc->sc_dv, &aa, wsemuldisplaydevprint);
    355  1.27  macallan #endif
    356  1.27  macallan 	fb_attach(&sc->sc_fb, isconsole);
    357   1.1        ad }
    358   1.1        ad 
    359  1.27  macallan static int
    360  1.16  christos zxopen(dev_t dev, int flags, int mode, struct lwp *l)
    361   1.1        ad {
    362   1.1        ad 
    363   1.1        ad 	if (device_lookup(&zx_cd, minor(dev)) == NULL)
    364   1.1        ad 		return (ENXIO);
    365   1.1        ad 	return (0);
    366   1.1        ad }
    367   1.1        ad 
    368  1.27  macallan static int
    369  1.16  christos zxclose(dev_t dev, int flags, int mode, struct lwp *l)
    370   1.1        ad {
    371   1.1        ad 	struct zx_softc *sc;
    372   1.1        ad 
    373  1.23    cegger 	sc = device_lookup_private(&zx_cd, minor(dev));
    374   1.1        ad 
    375   1.1        ad 	zx_reset(sc);
    376   1.1        ad 	zx_cursor_blank(sc);
    377   1.1        ad 	return (0);
    378   1.1        ad }
    379   1.1        ad 
    380  1.27  macallan static int
    381  1.19  christos zxioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
    382   1.1        ad {
    383   1.1        ad 	struct zx_softc *sc;
    384   1.1        ad 	struct fbcmap *cm;
    385   1.1        ad 	struct fbcursor *cu;
    386  1.13       chs 	uint32_t curbits[2][32];
    387   1.1        ad 	int rv, v, count, i;
    388   1.1        ad 
    389  1.23    cegger 	sc = device_lookup_private(&zx_cd, minor(dev));
    390  1.14     perry 
    391   1.1        ad 	switch (cmd) {
    392   1.1        ad 	case FBIOGTYPE:
    393   1.1        ad 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    394   1.1        ad 		break;
    395   1.1        ad 
    396   1.1        ad 	case FBIOGATTR:
    397   1.1        ad #define fba ((struct fbgattr *)data)
    398   1.1        ad 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    399   1.1        ad 		fba->owner = 0;		/* XXX ??? */
    400   1.1        ad 		fba->fbtype = sc->sc_fb.fb_type;
    401   1.1        ad 		fba->sattr.flags = 0;
    402   1.1        ad 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    403   1.1        ad 		fba->sattr.dev_specific[0] = -1;
    404   1.1        ad 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    405   1.1        ad 		fba->emu_types[1] = -1;
    406   1.1        ad 		fba->emu_types[2] = -1;
    407   1.1        ad #undef fba
    408   1.1        ad 		break;
    409   1.1        ad 
    410   1.1        ad 	case FBIOGVIDEO:
    411   1.1        ad 		*(int *)data = ((sc->sc_flags & ZX_BLANKED) != 0);
    412   1.1        ad 		break;
    413   1.1        ad 
    414   1.1        ad 	case FBIOSVIDEO:
    415   1.1        ad 		if (*(int *)data)
    416  1.27  macallan 			zx_unblank(sc->sc_dv);
    417   1.1        ad 		else
    418  1.27  macallan 			zx_blank(sc->sc_dv);
    419   1.1        ad 		break;
    420   1.1        ad 
    421   1.1        ad 	case FBIOGETCMAP:
    422   1.1        ad 		cm = (struct fbcmap *)data;
    423   1.1        ad 		if (cm->index > 256 || cm->count > 256 - cm->index)
    424   1.1        ad 			return (EINVAL);
    425   1.1        ad 		rv = copyout(sc->sc_cmap + cm->index, cm->red, cm->count);
    426   1.2        ad 		if (rv == 0)
    427   1.1        ad 			rv = copyout(sc->sc_cmap + 256 + cm->index, cm->green,
    428   1.1        ad 			    cm->count);
    429   1.2        ad 		if (rv == 0)
    430   1.1        ad 			rv = copyout(sc->sc_cmap + 512 + cm->index, cm->blue,
    431   1.1        ad 			    cm->count);
    432   1.1        ad 		return (rv);
    433   1.1        ad 
    434   1.1        ad 	case FBIOPUTCMAP:
    435   1.1        ad 		cm = (struct fbcmap *)data;
    436   1.1        ad 		if (cm->index > 256 || cm->count > 256 - cm->index)
    437   1.1        ad 			return (EINVAL);
    438   1.1        ad 		rv = copyin(cm->red, sc->sc_cmap + cm->index, cm->count);
    439   1.2        ad 		if (rv == 0)
    440   1.1        ad 			rv = copyin(cm->green, sc->sc_cmap + 256 + cm->index,
    441   1.1        ad 			    cm->count);
    442   1.2        ad 		if (rv == 0)
    443   1.1        ad 			rv = copyin(cm->blue, sc->sc_cmap + 512 + cm->index,
    444   1.1        ad 			    cm->count);
    445   1.1        ad 		zx_cmap_put(sc);
    446   1.1        ad 		return (rv);
    447   1.1        ad 
    448   1.1        ad 	case FBIOGCURPOS:
    449   1.1        ad 		*(struct fbcurpos *)data = sc->sc_curpos;
    450   1.1        ad 		break;
    451   1.1        ad 
    452   1.1        ad 	case FBIOSCURPOS:
    453   1.1        ad 		sc->sc_curpos = *(struct fbcurpos *)data;
    454   1.1        ad 		zx_cursor_move(sc);
    455   1.1        ad 		break;
    456   1.1        ad 
    457   1.1        ad 	case FBIOGCURMAX:
    458   1.1        ad 		((struct fbcurpos *)data)->x = 32;
    459   1.1        ad 		((struct fbcurpos *)data)->y = 32;
    460   1.1        ad 		break;
    461   1.1        ad 
    462   1.1        ad 	case FBIOSCURSOR:
    463   1.1        ad 		cu = (struct fbcursor *)data;
    464   1.1        ad 		v = cu->set;
    465   1.1        ad 
    466   1.1        ad 		if ((v & FB_CUR_SETSHAPE) != 0) {
    467   1.1        ad 			if ((u_int)cu->size.x > 32 || (u_int)cu->size.y > 32)
    468   1.1        ad 				return (EINVAL);
    469   1.1        ad 			count = cu->size.y * 4;
    470  1.13       chs 			rv = copyin(cu->mask, curbits[0], count);
    471  1.13       chs 			if (rv)
    472  1.13       chs 				return rv;
    473  1.13       chs 			rv = copyin(cu->image, curbits[1], count);
    474  1.13       chs 			if (rv)
    475  1.13       chs 				return rv;
    476   1.1        ad 		}
    477   1.1        ad 		if ((v & FB_CUR_SETCUR) != 0) {
    478   1.1        ad 			if (cu->enable)
    479   1.1        ad 				zx_cursor_unblank(sc);
    480   1.1        ad 			else
    481   1.1        ad 				zx_cursor_blank(sc);
    482   1.1        ad 		}
    483   1.1        ad 		if ((v & (FB_CUR_SETPOS | FB_CUR_SETHOT)) != 0) {
    484   1.1        ad 			if ((v & FB_CUR_SETPOS) != 0)
    485   1.1        ad 				sc->sc_curpos = cu->pos;
    486   1.1        ad 			if ((v & FB_CUR_SETHOT) != 0)
    487   1.1        ad 				sc->sc_curhot = cu->hot;
    488   1.1        ad 			zx_cursor_move(sc);
    489   1.1        ad 		}
    490   1.1        ad 		if ((v & FB_CUR_SETCMAP) != 0) {
    491   1.1        ad 			if (cu->cmap.index > 2 ||
    492   1.1        ad 			    cu->cmap.count > 2 - cu->cmap.index)
    493   1.1        ad 				return (EINVAL);
    494   1.1        ad 			for (i = 0; i < cu->cmap.count; i++) {
    495   1.1        ad 				if ((v = fubyte(&cu->cmap.red[i])) < 0)
    496   1.1        ad 					return (EFAULT);
    497   1.1        ad 				sc->sc_curcmap[i + cu->cmap.index + 0] = v;
    498   1.1        ad 				if ((v = fubyte(&cu->cmap.green[i])) < 0)
    499   1.1        ad 					return (EFAULT);
    500   1.1        ad 				sc->sc_curcmap[i + cu->cmap.index + 2] = v;
    501   1.1        ad 				if ((v = fubyte(&cu->cmap.blue[i])) < 0)
    502   1.1        ad 					return (EFAULT);
    503   1.1        ad 				sc->sc_curcmap[i + cu->cmap.index + 4] = v;
    504   1.1        ad 			}
    505   1.1        ad 			zx_cursor_color(sc);
    506   1.1        ad 		}
    507   1.1        ad 		if ((v & FB_CUR_SETSHAPE) != 0) {
    508   1.1        ad 			sc->sc_cursize = cu->size;
    509   1.1        ad 			count = cu->size.y * 4;
    510   1.1        ad 			memset(sc->sc_curbits, 0, sizeof(sc->sc_curbits));
    511  1.13       chs 			memcpy(sc->sc_curbits[0], curbits[0], count);
    512  1.13       chs 			memcpy(sc->sc_curbits[1], curbits[1], count);
    513   1.1        ad 			zx_cursor_set(sc);
    514   1.1        ad 		}
    515   1.1        ad 		break;
    516   1.1        ad 
    517   1.1        ad 	case FBIOGCURSOR:
    518   1.1        ad 		cu = (struct fbcursor *)data;
    519   1.1        ad 
    520   1.1        ad 		cu->set = FB_CUR_SETALL;
    521   1.1        ad 		cu->enable = ((sc->sc_flags & ZX_CURSOR) != 0);
    522   1.1        ad 		cu->pos = sc->sc_curpos;
    523   1.1        ad 		cu->hot = sc->sc_curhot;
    524   1.1        ad 		cu->size = sc->sc_cursize;
    525   1.1        ad 
    526   1.1        ad 		if (cu->image != NULL) {
    527   1.1        ad 			count = sc->sc_cursize.y * 4;
    528  1.13       chs 			rv = copyout(sc->sc_curbits[1], cu->image, count);
    529   1.1        ad 			if (rv)
    530   1.1        ad 				return (rv);
    531  1.13       chs 			rv = copyout(sc->sc_curbits[0], cu->mask, count);
    532   1.1        ad 			if (rv)
    533   1.1        ad 				return (rv);
    534   1.1        ad 		}
    535   1.1        ad 		if (cu->cmap.red != NULL) {
    536   1.1        ad 			if (cu->cmap.index > 2 ||
    537   1.1        ad 			    cu->cmap.count > 2 - cu->cmap.index)
    538   1.1        ad 				return (EINVAL);
    539   1.1        ad 			for (i = 0; i < cu->cmap.count; i++) {
    540   1.1        ad 				v = sc->sc_curcmap[i + cu->cmap.index + 0];
    541   1.1        ad 				if (subyte(&cu->cmap.red[i], v))
    542   1.1        ad 					return (EFAULT);
    543   1.1        ad 				v = sc->sc_curcmap[i + cu->cmap.index + 2];
    544   1.1        ad 				if (subyte(&cu->cmap.green[i], v))
    545   1.1        ad 					return (EFAULT);
    546   1.1        ad 				v = sc->sc_curcmap[i + cu->cmap.index + 4];
    547   1.1        ad 				if (subyte(&cu->cmap.blue[i], v))
    548   1.1        ad 					return (EFAULT);
    549   1.1        ad 			}
    550   1.1        ad 		} else {
    551   1.1        ad 			cu->cmap.index = 0;
    552   1.1        ad 			cu->cmap.count = 2;
    553   1.1        ad 		}
    554   1.1        ad 		break;
    555   1.1        ad 
    556   1.1        ad 	default:
    557   1.1        ad #ifdef DEBUG
    558   1.1        ad 		log(LOG_NOTICE, "zxioctl(0x%lx) (%s[%d])\n", cmd,
    559  1.18       jdc 		    l->l_proc->p_comm, l->l_proc->p_pid);
    560   1.1        ad #endif
    561   1.1        ad 		return (ENOTTY);
    562   1.1        ad 	}
    563   1.1        ad 
    564   1.1        ad 	return (0);
    565   1.1        ad }
    566   1.1        ad 
    567  1.27  macallan static int
    568   1.1        ad zx_intr(void *cookie)
    569   1.1        ad {
    570   1.1        ad 
    571   1.1        ad 	return (1);
    572   1.1        ad }
    573   1.1        ad 
    574  1.27  macallan static void
    575   1.1        ad zx_reset(struct zx_softc *sc)
    576   1.1        ad {
    577   1.1        ad 	struct fbtype *fbt;
    578   1.1        ad 	u_int i;
    579   1.1        ad 
    580   1.1        ad 	fbt = &sc->sc_fb.fb_type;
    581   1.1        ad 
    582   1.1        ad 	zx_cross_loadwid(sc, ZX_WID_DBL_8, 0, 0x2c0);
    583   1.1        ad 	zx_cross_loadwid(sc, ZX_WID_DBL_8, 1, 0x30);
    584   1.1        ad 	zx_cross_loadwid(sc, ZX_WID_DBL_8, 2, 0x20);
    585   1.1        ad 	zx_cross_loadwid(sc, ZX_WID_DBL_24, 1, 0x30);
    586   1.1        ad 
    587  1.25   tsutsui 	i = bus_space_read_4(sc->sc_bt, sc->sc_bhzdss1, zd_misc);
    588   1.1        ad 	i |= ZX_SS1_MISC_ENABLE;
    589  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss1, zd_misc, i);
    590   1.1        ad 
    591  1.27  macallan 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_wid, 1);
    592  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_widclip, 0);
    593  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_wmask, 0xffff);
    594  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_vclipmin, 0);
    595  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_vclipmax,
    596   1.1        ad 	    (fbt->fb_width - 1) | ((fbt->fb_height - 1) << 16));
    597  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_fg, 0);
    598  1.27  macallan 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_planemask, 0xffffffff);
    599  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_rop, ZX_STD_ROP);
    600   1.1        ad 
    601  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_extent,
    602   1.1        ad 	    (fbt->fb_width - 1) | ((fbt->fb_height - 1) << 11));
    603  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_addrspace,
    604  1.25   tsutsui 	    ZX_ADDRSPC_FONT_OBGR);
    605  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_fontt, 0);
    606   1.1        ad 
    607   1.1        ad 	for (i = 0; i < 256; i++) {
    608   1.1        ad 		sc->sc_cmap[i] = rasops_cmap[i * 3];
    609   1.1        ad 		sc->sc_cmap[i + 256] = rasops_cmap[i * 3 + 1];
    610   1.1        ad 		sc->sc_cmap[i + 512] = rasops_cmap[i * 3 + 2];
    611   1.1        ad 	}
    612   1.1        ad 
    613   1.1        ad 	zx_cmap_put(sc);
    614   1.1        ad }
    615   1.1        ad 
    616  1.27  macallan static int
    617   1.1        ad zx_cross_wait(struct zx_softc *sc)
    618   1.1        ad {
    619   1.1        ad 	int i;
    620   1.1        ad 
    621   1.1        ad 	for (i = 300000; i != 0; i--) {
    622  1.25   tsutsui 		if ((bus_space_read_4(sc->sc_bt, sc->sc_bhzx, zx_csr) &
    623  1.25   tsutsui 		    ZX_CROSS_CSR_PROGRESS) == 0)
    624   1.1        ad 			break;
    625   1.1        ad 		DELAY(1);
    626   1.1        ad 	}
    627   1.1        ad 
    628   1.1        ad 	if (i == 0)
    629   1.1        ad 		printf("zx_cross_wait: timed out\n");
    630   1.1        ad 
    631   1.1        ad 	return (i);
    632   1.1        ad }
    633   1.1        ad 
    634  1.27  macallan static int
    635   1.1        ad zx_cross_loadwid(struct zx_softc *sc, u_int type, u_int index, u_int value)
    636   1.1        ad {
    637  1.12       chs 	u_int tmp = 0;
    638   1.1        ad 
    639  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_WID);
    640   1.1        ad 
    641   1.1        ad 	if (zx_cross_wait(sc))
    642   1.1        ad 		return (1);
    643   1.1        ad 
    644   1.1        ad 	if (type == ZX_WID_DBL_8)
    645   1.1        ad 		tmp = (index & 0x0f) + 0x40;
    646   1.1        ad 	else if (type == ZX_WID_DBL_24)
    647   1.1        ad 		tmp = index & 0x3f;
    648   1.1        ad 
    649  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, 0x5800 + tmp);
    650  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_value, value);
    651  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_WID);
    652  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_csr,
    653  1.25   tsutsui 	    ZX_CROSS_CSR_UNK | ZX_CROSS_CSR_UNK2);
    654   1.1        ad 
    655   1.1        ad 	return (0);
    656   1.1        ad }
    657   1.1        ad 
    658  1.27  macallan static int
    659   1.1        ad zx_cmap_put(struct zx_softc *sc)
    660   1.1        ad {
    661   1.1        ad 	const u_char *b;
    662   1.1        ad 	u_int i, t;
    663   1.1        ad 
    664  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_CLUT0);
    665  1.27  macallan 
    666  1.27  macallan 	zx_cross_wait(sc);
    667   1.1        ad 
    668  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type,
    669  1.25   tsutsui 	    ZX_CROSS_TYPE_CLUTDATA);
    670   1.1        ad 
    671   1.1        ad 	for (i = 0, b = sc->sc_cmap; i < 256; i++) {
    672   1.1        ad 		t = b[i];
    673   1.1        ad 		t |= b[i + 256] << 8;
    674   1.1        ad 		t |= b[i + 512] << 16;
    675  1.25   tsutsui 		bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_value, t);
    676   1.1        ad 	}
    677   1.1        ad 
    678  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_CLUT0);
    679  1.25   tsutsui 	i = bus_space_read_4(sc->sc_bt, sc->sc_bhzx, zx_csr);
    680   1.1        ad 	i = i | ZX_CROSS_CSR_UNK | ZX_CROSS_CSR_UNK2;
    681  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_csr, i);
    682   1.1        ad 	return (0);
    683   1.1        ad }
    684   1.1        ad 
    685  1.27  macallan static void
    686   1.1        ad zx_cursor_move(struct zx_softc *sc)
    687   1.1        ad {
    688   1.1        ad 	int sx, sy, x, y;
    689   1.1        ad 
    690   1.1        ad 	x = sc->sc_curpos.x - sc->sc_curhot.x;
    691   1.1        ad 	y = sc->sc_curpos.y - sc->sc_curhot.y;
    692   1.1        ad 
    693   1.1        ad 	if (x < 0) {
    694   1.1        ad 		sx = min(-x, 32);
    695   1.1        ad 		x = 0;
    696   1.1        ad 	} else
    697   1.1        ad 		sx = 0;
    698   1.1        ad 
    699   1.1        ad 	if (y < 0) {
    700   1.1        ad 		sy = min(-y, 32);
    701   1.1        ad 		y = 0;
    702   1.1        ad 	} else
    703   1.1        ad 		sy = 0;
    704   1.1        ad 
    705   1.1        ad 	if (sx != sc->sc_shiftx || sy != sc->sc_shifty) {
    706   1.1        ad 		sc->sc_shiftx = sx;
    707   1.1        ad 		sc->sc_shifty = sy;
    708   1.1        ad 		zx_cursor_set(sc);
    709   1.1        ad 	}
    710   1.1        ad 
    711  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_sxy,
    712  1.25   tsutsui 	    ((y & 0x7ff) << 11) | (x & 0x7ff));
    713  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    714  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) | 0x30);
    715   1.1        ad 
    716   1.1        ad 	/* XXX Necessary? */
    717  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    718  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) | 0x80);
    719   1.1        ad }
    720   1.1        ad 
    721  1.27  macallan static void
    722   1.1        ad zx_cursor_set(struct zx_softc *sc)
    723   1.1        ad {
    724   1.1        ad 	int i, j, data;
    725   1.1        ad 
    726   1.2        ad 	if ((sc->sc_flags & ZX_CURSOR) != 0)
    727  1.25   tsutsui 		bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    728  1.25   tsutsui 		    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) &
    729  1.25   tsutsui 		    ~0x80);
    730   1.1        ad 
    731   1.1        ad 	for (j = 0; j < 2; j++) {
    732  1.25   tsutsui 		bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_type, 0x20 << j);
    733   1.2        ad 
    734   1.1        ad 		for (i = sc->sc_shifty; i < 32; i++) {
    735   1.1        ad 			data = sc->sc_curbits[j][i];
    736  1.25   tsutsui 			bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_data,
    737  1.25   tsutsui 			    data >> sc->sc_shiftx);
    738   1.1        ad 		}
    739   1.1        ad 		for (i = sc->sc_shifty; i != 0; i--)
    740  1.25   tsutsui 			bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_data, 0);
    741   1.1        ad 	}
    742   1.2        ad 
    743   1.2        ad 	if ((sc->sc_flags & ZX_CURSOR) != 0)
    744  1.25   tsutsui 		bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    745  1.25   tsutsui 		    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) | 0x80);
    746   1.1        ad }
    747   1.1        ad 
    748  1.27  macallan static void
    749   1.1        ad zx_cursor_blank(struct zx_softc *sc)
    750   1.1        ad {
    751   1.1        ad 
    752   1.1        ad 	sc->sc_flags &= ~ZX_CURSOR;
    753  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    754  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) & ~0x80);
    755   1.1        ad }
    756   1.1        ad 
    757  1.27  macallan static void
    758   1.1        ad zx_cursor_unblank(struct zx_softc *sc)
    759   1.1        ad {
    760   1.1        ad 
    761   1.1        ad 	sc->sc_flags |= ZX_CURSOR;
    762  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    763  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) | 0x80);
    764   1.1        ad }
    765   1.1        ad 
    766  1.27  macallan static void
    767   1.1        ad zx_cursor_color(struct zx_softc *sc)
    768   1.1        ad {
    769  1.33   tsutsui 	uint8_t tmp;
    770   1.1        ad 
    771  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_type, 0x50);
    772   1.1        ad 
    773   1.1        ad 	tmp = sc->sc_curcmap[0] | (sc->sc_curcmap[2] << 8) |
    774   1.1        ad 	    (sc->sc_curcmap[4] << 16);
    775  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_data, tmp);
    776   1.1        ad 
    777   1.1        ad 	tmp = sc->sc_curcmap[1] | (sc->sc_curcmap[3] << 8) |
    778   1.1        ad 	    (sc->sc_curcmap[5] << 16);
    779  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_data, sc->sc_curcmap[1]);
    780   1.1        ad 
    781  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc,
    782  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzcu, zcu_misc) | 0x03);
    783   1.1        ad }
    784   1.1        ad 
    785  1.27  macallan static void
    786  1.27  macallan zx_blank(device_t dv)
    787   1.1        ad {
    788   1.1        ad 	struct zx_softc *sc;
    789   1.1        ad 
    790  1.24  drochner 	sc = device_private(dv);
    791   1.1        ad 
    792   1.1        ad 	if ((sc->sc_flags & ZX_BLANKED) != 0)
    793   1.1        ad 		return;
    794   1.1        ad 	sc->sc_flags |= ZX_BLANKED;
    795   1.1        ad 
    796  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_VIDEO);
    797  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_csr,
    798  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzx, zx_csr) &
    799  1.25   tsutsui 	    ~ZX_CROSS_CSR_ENABLE);
    800   1.1        ad }
    801   1.1        ad 
    802  1.27  macallan static void
    803  1.27  macallan zx_unblank(device_t dv)
    804   1.1        ad {
    805   1.1        ad 	struct zx_softc *sc;
    806   1.1        ad 
    807  1.24  drochner 	sc = device_private(dv);
    808   1.1        ad 
    809   1.1        ad 	if ((sc->sc_flags & ZX_BLANKED) == 0)
    810   1.1        ad 		return;
    811   1.1        ad 	sc->sc_flags &= ~ZX_BLANKED;
    812   1.1        ad 
    813  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_type, ZX_CROSS_TYPE_VIDEO);
    814  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzx, zx_csr,
    815  1.25   tsutsui 	    bus_space_read_4(sc->sc_bt, sc->sc_bhzx, zx_csr) |
    816  1.25   tsutsui 	    ZX_CROSS_CSR_ENABLE);
    817   1.1        ad }
    818   1.1        ad 
    819  1.27  macallan static paddr_t
    820   1.1        ad zxmmap(dev_t dev, off_t off, int prot)
    821   1.1        ad {
    822   1.1        ad 	struct zx_softc *sc;
    823  1.15   tsutsui 	const struct zx_mmo *mm, *mmmax;
    824   1.2        ad 
    825  1.23    cegger 	sc = device_lookup_private(&zx_cd, minor(dev));
    826   1.2        ad 	off = trunc_page(off);
    827   1.1        ad 	mm = zx_mmo;
    828  1.15   tsutsui 	mmmax = mm + sizeof(zx_mmo) / sizeof(zx_mmo[0]);
    829   1.1        ad 
    830  1.15   tsutsui 	for (; mm < mmmax; mm++)
    831   1.1        ad 		if (off >= mm->mo_va && off < mm->mo_va + mm->mo_size) {
    832   1.1        ad 			off = off - mm->mo_va + mm->mo_pa;
    833   1.1        ad 			return (bus_space_mmap(sc->sc_bt, sc->sc_paddr,
    834   1.1        ad 			    off, prot, BUS_SPACE_MAP_LINEAR));
    835   1.1        ad 		}
    836   1.1        ad 
    837   1.1        ad 	return (-1);
    838   1.1        ad }
    839   1.1        ad 
    840  1.27  macallan static void
    841  1.27  macallan zx_fillrect(struct zx_softc *sc, int x, int y, int w, int h, uint32_t bg,
    842   1.1        ad 	    int rop)
    843   1.1        ad {
    844   1.1        ad 
    845   1.1        ad 
    846  1.25   tsutsui 	while ((bus_space_read_4(sc->sc_bt, sc->sc_bhzc, zc_csr) &
    847  1.25   tsutsui 	    ZX_CSR_BLT_BUSY) != 0)
    848   1.1        ad 		;
    849   1.1        ad 
    850  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_rop, rop);
    851  1.27  macallan 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_fg, bg);
    852  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_extent, w | (h << 11));
    853  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_fill,
    854  1.25   tsutsui 	    x | (y << 11) | 0x80000000);
    855   1.1        ad }
    856   1.1        ad 
    857  1.27  macallan static void
    858  1.27  macallan zx_copyrect(struct zx_softc *sc, int sx, int sy, int dx, int dy, int w,
    859   1.1        ad 	    int h)
    860   1.1        ad {
    861  1.27  macallan 	uint32_t dir;
    862   1.1        ad 
    863   1.1        ad 	if (sy < dy || sx < dx) {
    864   1.1        ad 		dir = 0x80000000;
    865   1.1        ad 		sx += w;
    866   1.1        ad 		sy += h;
    867   1.1        ad 		dx += w;
    868   1.1        ad 		dy += h;
    869   1.1        ad 	} else
    870   1.1        ad 		dir = 0;
    871   1.1        ad 
    872  1.25   tsutsui 	while ((bus_space_read_4(sc->sc_bt, sc->sc_bhzc, zc_csr) &
    873  1.25   tsutsui 	    ZX_CSR_BLT_BUSY) != 0)
    874   1.1        ad 		;
    875   1.1        ad 
    876  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_rop, ZX_STD_ROP);
    877  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_extent,
    878  1.25   tsutsui 	    w | (h << 11) | dir);
    879  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_src, sx | (sy << 11));
    880  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_copy, dx | (dy << 11));
    881   1.1        ad }
    882   1.1        ad 
    883  1.27  macallan static void
    884  1.27  macallan zx_do_cursor(void *cookie, int on, int row, int col)
    885   1.1        ad {
    886  1.27  macallan 	struct rasops_info *ri = cookie;
    887  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    888  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    889  1.27  macallan 	int x, y, wi, he;
    890  1.27  macallan 
    891  1.27  macallan 	wi = ri->ri_font->fontwidth;
    892  1.27  macallan 	he = ri->ri_font->fontheight;
    893  1.27  macallan 
    894  1.27  macallan 	if (ri->ri_flg & RI_CURSOR) {
    895  1.27  macallan 		x = ri->ri_ccol * wi + ri->ri_xorigin;
    896  1.27  macallan 		y = ri->ri_crow * he + ri->ri_yorigin;
    897  1.27  macallan 		zx_fillrect(sc, x, y, wi, he, 0xff000000,
    898  1.27  macallan 		  ZX_ROP_NEW_XOR_OLD | ZX_ATTR_WE_ENABLE | ZX_ATTR_OE_ENABLE |
    899  1.27  macallan 		  ZX_ATTR_FORCE_WID);
    900  1.27  macallan 		ri->ri_flg &= ~RI_CURSOR;
    901  1.27  macallan 	}
    902   1.1        ad 
    903  1.27  macallan 	ri->ri_crow = row;
    904  1.27  macallan 	ri->ri_ccol = col;
    905   1.1        ad 
    906  1.27  macallan 	if (on)
    907  1.27  macallan 	{
    908  1.27  macallan 		x = ri->ri_ccol * wi + ri->ri_xorigin;
    909  1.27  macallan 		y = ri->ri_crow * he + ri->ri_yorigin;
    910  1.27  macallan 		zx_fillrect(sc, x, y, wi, he, 0xff000000,
    911  1.27  macallan 		  ZX_ROP_NEW_XOR_OLD | ZX_ATTR_WE_ENABLE | ZX_ATTR_OE_ENABLE |
    912  1.27  macallan 		  ZX_ATTR_FORCE_WID);
    913  1.27  macallan 		ri->ri_flg |= RI_CURSOR;
    914  1.27  macallan 	}
    915   1.1        ad }
    916   1.1        ad 
    917  1.27  macallan static void
    918  1.27  macallan zx_erasecols(void *cookie, int row, int startcol, int ncols, long attr)
    919   1.1        ad {
    920  1.27  macallan 	struct rasops_info *ri = cookie;
    921  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    922  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    923  1.27  macallan 	int32_t x, y, width, height, bg;
    924  1.27  macallan 
    925  1.27  macallan 	x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
    926  1.27  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    927  1.27  macallan 	width = ri->ri_font->fontwidth * ncols;
    928  1.27  macallan 	height = ri->ri_font->fontheight;
    929  1.27  macallan 	bg = ((uint32_t)ri->ri_devcmap[(attr >> 16) & 0xff]) << 24;
    930  1.27  macallan 	zx_fillrect(sc, x, y, width, height, bg, ZX_STD_ROP);
    931  1.27  macallan }
    932  1.27  macallan 
    933  1.27  macallan static void
    934  1.27  macallan zx_eraserows(void *cookie, int row, int nrows, long attr)
    935  1.27  macallan {
    936  1.27  macallan 	struct rasops_info *ri = cookie;
    937  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    938  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    939  1.27  macallan 	int32_t x, y, width, height, bg;
    940  1.27  macallan 
    941  1.27  macallan 	if ((row == 0) && (nrows == ri->ri_rows)) {
    942  1.27  macallan 		x = y = 0;
    943  1.27  macallan 		width = ri->ri_width;
    944  1.27  macallan 		height = ri->ri_height;
    945  1.27  macallan 	} else {
    946  1.27  macallan 		x = ri->ri_xorigin;
    947  1.27  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    948  1.27  macallan 		width = ri->ri_emuwidth;
    949  1.27  macallan 		height = ri->ri_font->fontheight * nrows;
    950  1.27  macallan 	}
    951  1.27  macallan 	bg = ((uint32_t)ri->ri_devcmap[(attr >> 16) & 0xff]) << 24;
    952  1.27  macallan 	zx_fillrect(sc, x, y, width, height, bg, ZX_STD_ROP);
    953   1.1        ad }
    954   1.1        ad 
    955  1.27  macallan static void
    956  1.27  macallan zx_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
    957   1.1        ad {
    958  1.27  macallan 	struct rasops_info *ri = cookie;
    959  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    960  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    961  1.27  macallan 	int32_t x, ys, yd, width, height;
    962   1.1        ad 
    963  1.27  macallan 	x = ri->ri_xorigin;
    964  1.27  macallan 	ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
    965  1.27  macallan 	yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
    966  1.27  macallan 	width = ri->ri_emuwidth;
    967  1.27  macallan 	height = ri->ri_font->fontheight * nrows;
    968  1.27  macallan 	zx_copyrect(sc, x, ys, x, yd, width, height);
    969   1.1        ad }
    970   1.1        ad 
    971  1.27  macallan static void
    972  1.27  macallan zx_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
    973   1.1        ad {
    974  1.27  macallan 	struct rasops_info *ri = cookie;
    975  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    976  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    977  1.27  macallan 	int32_t xs, xd, y, width, height;
    978   1.1        ad 
    979  1.27  macallan 	xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
    980  1.27  macallan 	xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
    981  1.27  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    982  1.27  macallan 	width = ri->ri_font->fontwidth * ncols;
    983  1.27  macallan 	height = ri->ri_font->fontheight;
    984  1.27  macallan 	zx_copyrect(sc, xs, y, xd, y, width, height);
    985   1.1        ad }
    986   1.1        ad 
    987  1.27  macallan static void
    988   1.1        ad zx_putchar(void *cookie, int row, int col, u_int uc, long attr)
    989   1.1        ad {
    990  1.27  macallan 	struct rasops_info *ri = cookie;
    991  1.27  macallan 	struct vcons_screen *scr = ri->ri_hw;
    992  1.27  macallan 	struct zx_softc *sc = scr->scr_cookie;
    993   1.1        ad 	struct wsdisplay_font *font;
    994  1.33   tsutsui 	volatile uint32_t *dp;
    995  1.33   tsutsui 	uint8_t *fb;
    996  1.27  macallan 	int fs, i, ul;
    997  1.27  macallan 	uint32_t fg, bg;
    998  1.27  macallan 
    999  1.27  macallan 	rasops_unpack_attr(attr, &fg, &bg, &ul);
   1000  1.27  macallan 	bg = ((uint32_t)ri->ri_devcmap[bg]) << 24;
   1001  1.27  macallan 	fg = ((uint32_t)ri->ri_devcmap[fg]) << 24;
   1002  1.27  macallan 	if (uc == ' ') {
   1003  1.27  macallan 		int x, y;
   1004   1.1        ad 
   1005  1.27  macallan 		x = ri->ri_xorigin + ri->ri_font->fontwidth * col;
   1006  1.27  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
   1007  1.27  macallan 		zx_fillrect(sc, x, y, ri->ri_font->fontwidth,
   1008  1.27  macallan 			    ri->ri_font->fontheight, bg, ZX_STD_ROP);
   1009   1.1        ad 		return;
   1010   1.1        ad 	}
   1011   1.1        ad 
   1012   1.1        ad 	font = ri->ri_font;
   1013   1.1        ad 
   1014  1.33   tsutsui 	dp = (volatile uint32_t *)sc->sc_pixels +
   1015  1.27  macallan 	    ((row * font->fontheight + ri->ri_yorigin) << 11) +
   1016  1.27  macallan 	    (col * font->fontwidth + ri->ri_xorigin);
   1017  1.33   tsutsui 	fb = (uint8_t *)font->data + (uc - font->firstchar) *
   1018   1.1        ad 	    ri->ri_fontscale;
   1019   1.1        ad 	fs = font->stride;
   1020   1.1        ad 
   1021  1.25   tsutsui 	while ((bus_space_read_4(sc->sc_bt, sc->sc_bhzc, zc_csr) &
   1022  1.25   tsutsui 	    ZX_CSR_BLT_BUSY) != 0)
   1023   1.1        ad 		;
   1024   1.1        ad 
   1025  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_rop, ZX_STD_ROP);
   1026  1.27  macallan 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_fg, fg);
   1027  1.27  macallan 	bus_space_write_4(sc->sc_bt, sc->sc_bhzdss0, zd_bg, bg);
   1028  1.25   tsutsui 	bus_space_write_4(sc->sc_bt, sc->sc_bhzc, zc_fontmsk,
   1029  1.27  macallan 	    0xffffffff << (32 - font->fontwidth));
   1030   1.1        ad 
   1031  1.27  macallan 	if (font->fontwidth <= 8) {
   1032  1.27  macallan 		for (i = font->fontheight; i != 0; i--, dp += 2048) {
   1033   1.1        ad 			*dp = *fb << 24;
   1034   1.1        ad 			fb += fs;
   1035   1.1        ad 		}
   1036   1.1        ad 	} else {
   1037  1.27  macallan 		for (i = font->fontheight; i != 0; i--, dp += 2048) {
   1038  1.33   tsutsui 			*dp = *((uint16_t *)fb) << 16;
   1039   1.1        ad 			fb += fs;
   1040   1.1        ad 		}
   1041   1.1        ad 	}
   1042   1.1        ad 
   1043   1.1        ad 	if (ul) {
   1044   1.1        ad 		dp -= 4096;
   1045   1.1        ad 		*dp = 0xffffffff;
   1046   1.1        ad 	}
   1047   1.1        ad }
   1048  1.27  macallan 
   1049  1.27  macallan #if NWSDISPLAY > 0
   1050  1.27  macallan static int
   1051  1.27  macallan zx_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
   1052  1.27  macallan 	struct lwp *l)
   1053  1.27  macallan {
   1054  1.27  macallan 	/* we'll probably need to add more stuff here */
   1055  1.27  macallan 	struct vcons_data *vd = v;
   1056  1.27  macallan 	struct zx_softc *sc = vd->cookie;
   1057  1.27  macallan 	struct wsdisplay_fbinfo *wdf;
   1058  1.27  macallan 	struct rasops_info *ri = &sc->sc_fb.fb_rinfo;
   1059  1.27  macallan 	struct vcons_screen *ms = sc->vd.active;
   1060  1.27  macallan 	switch (cmd) {
   1061  1.27  macallan 		case WSDISPLAYIO_GTYPE:
   1062  1.27  macallan 			*(u_int *)data = WSDISPLAY_TYPE_SUNTCX;
   1063  1.27  macallan 			return 0;
   1064  1.27  macallan 		case WSDISPLAYIO_GINFO:
   1065  1.27  macallan 			wdf = (void *)data;
   1066  1.27  macallan 			wdf->height = ri->ri_height;
   1067  1.27  macallan 			wdf->width = ri->ri_width;
   1068  1.27  macallan 			wdf->depth = ri->ri_depth;
   1069  1.27  macallan 			wdf->cmsize = 256;
   1070  1.27  macallan 			return 0;
   1071  1.27  macallan 
   1072  1.27  macallan 		case WSDISPLAYIO_GETCMAP:
   1073  1.27  macallan 			return zx_getcmap(sc,
   1074  1.27  macallan 			    (struct wsdisplay_cmap *)data);
   1075  1.27  macallan 		case WSDISPLAYIO_PUTCMAP:
   1076  1.27  macallan 			return zx_putcmap(sc,
   1077  1.27  macallan 			    (struct wsdisplay_cmap *)data);
   1078  1.27  macallan 
   1079  1.27  macallan 		case WSDISPLAYIO_SMODE:
   1080  1.27  macallan 			{
   1081  1.27  macallan 				int new_mode = *(int*)data;
   1082  1.27  macallan 				if (new_mode != sc->sc_mode)
   1083  1.27  macallan 				{
   1084  1.27  macallan 					sc->sc_mode = new_mode;
   1085  1.27  macallan 					if(new_mode == WSDISPLAYIO_MODE_EMUL)
   1086  1.27  macallan 					{
   1087  1.27  macallan 						vcons_redraw_screen(ms);
   1088  1.27  macallan 					}
   1089  1.27  macallan 				}
   1090  1.27  macallan 			}
   1091  1.27  macallan 	}
   1092  1.27  macallan 	return EPASSTHROUGH;
   1093  1.27  macallan }
   1094  1.27  macallan 
   1095  1.27  macallan static paddr_t
   1096  1.27  macallan zx_mmap(void *v, void *vs, off_t offset, int prot)
   1097  1.27  macallan {
   1098  1.27  macallan 	/* I'm not at all sure this is the right thing to do */
   1099  1.27  macallan 	return zxmmap(0, offset, prot); /* assume minor dev 0 for now */
   1100  1.27  macallan }
   1101  1.27  macallan 
   1102  1.27  macallan static int
   1103  1.27  macallan zx_putcmap(struct zx_softc *sc, struct wsdisplay_cmap *cm)
   1104  1.27  macallan {
   1105  1.27  macallan 	u_int index = cm->index;
   1106  1.27  macallan 	u_int count = cm->count;
   1107  1.27  macallan 	int error,i;
   1108  1.27  macallan 	if (index >= 256 || count > 256 || index + count > 256)
   1109  1.27  macallan 		return EINVAL;
   1110  1.27  macallan 
   1111  1.27  macallan 	for (i = 0; i < count; i++)
   1112  1.27  macallan 	{
   1113  1.27  macallan 		error = copyin(&cm->red[i],
   1114  1.27  macallan 		    &sc->sc_cmap[index + i], 1);
   1115  1.27  macallan 		if (error)
   1116  1.27  macallan 			return error;
   1117  1.27  macallan 		error = copyin(&cm->green[i],
   1118  1.27  macallan 		    &sc->sc_cmap[index + i + 256], 1);
   1119  1.27  macallan 		if (error)
   1120  1.27  macallan 			return error;
   1121  1.27  macallan 		error = copyin(&cm->blue[i],
   1122  1.27  macallan 		    &sc->sc_cmap[index + i + 512], 1);
   1123  1.27  macallan 		if (error)
   1124  1.27  macallan 			return error;
   1125  1.27  macallan 	}
   1126  1.27  macallan 	zx_cmap_put(sc);
   1127  1.27  macallan 
   1128  1.27  macallan 	return 0;
   1129  1.27  macallan }
   1130  1.27  macallan 
   1131  1.27  macallan static int
   1132  1.27  macallan zx_getcmap(struct zx_softc *sc, struct wsdisplay_cmap *cm)
   1133  1.27  macallan {
   1134  1.27  macallan 	u_int index = cm->index;
   1135  1.27  macallan 	u_int count = cm->count;
   1136  1.27  macallan 	int error,i;
   1137  1.27  macallan 
   1138  1.27  macallan 	if (index >= 256 || count > 256 || index + count > 256)
   1139  1.27  macallan 		return EINVAL;
   1140  1.27  macallan 
   1141  1.27  macallan 	for (i = 0; i < count; i++)
   1142  1.27  macallan 	{
   1143  1.27  macallan 		error = copyout(&sc->sc_cmap[index + i],
   1144  1.27  macallan 		    &cm->red[i], 1);
   1145  1.27  macallan 		if (error)
   1146  1.27  macallan 			return error;
   1147  1.27  macallan 		error = copyout(&sc->sc_cmap[index + i + 256],
   1148  1.27  macallan 		    &cm->green[i], 1);
   1149  1.27  macallan 		if (error)
   1150  1.27  macallan 			return error;
   1151  1.27  macallan 		error = copyout(&sc->sc_cmap[index + i + 256],
   1152  1.27  macallan 		    &cm->blue[i], 1);
   1153  1.27  macallan 		if (error)
   1154  1.27  macallan 			return error;
   1155  1.27  macallan 	}
   1156  1.27  macallan 
   1157  1.27  macallan 	return 0;
   1158  1.27  macallan }
   1159  1.27  macallan 
   1160  1.27  macallan static void
   1161  1.27  macallan zx_init_screen(void *cookie, struct vcons_screen *scr,
   1162  1.27  macallan     int existing, long *defattr)
   1163  1.27  macallan {
   1164  1.27  macallan 	struct zx_softc *sc = cookie;
   1165  1.27  macallan 	struct rasops_info *ri = &scr->scr_ri;
   1166  1.27  macallan 
   1167  1.27  macallan 	ri->ri_depth = 8; /*sc->sc_fb.fb_type.fb_depth = 32;*/
   1168  1.27  macallan 	ri->ri_width = sc->sc_width;
   1169  1.27  macallan 	ri->ri_height = sc->sc_height;
   1170  1.27  macallan 	ri->ri_stride = sc->sc_stride;
   1171  1.27  macallan 	ri->ri_flg = RI_CENTER;
   1172  1.27  macallan 
   1173  1.27  macallan 	ri->ri_bits = (void *)sc->sc_pixels;
   1174  1.27  macallan 
   1175  1.27  macallan 	rasops_init(ri, sc->sc_height/8, sc->sc_width/8);
   1176  1.27  macallan 	ri->ri_caps = WSSCREEN_WSCOLORS | WSSCREEN_REVERSE;
   1177  1.27  macallan 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
   1178  1.27  macallan 		    sc->sc_width / ri->ri_font->fontwidth);
   1179  1.27  macallan 
   1180  1.27  macallan 	ri->ri_hw = scr;
   1181  1.27  macallan 
   1182  1.27  macallan 	ri->ri_ops.cursor = zx_do_cursor;
   1183  1.27  macallan 	ri->ri_ops.copycols = zx_copycols;
   1184  1.27  macallan 	ri->ri_ops.copyrows = zx_copyrows;
   1185  1.27  macallan 	ri->ri_ops.erasecols = zx_erasecols;
   1186  1.27  macallan 	ri->ri_ops.eraserows = zx_eraserows;
   1187  1.27  macallan 	ri->ri_ops.putchar = zx_putchar;
   1188  1.27  macallan }
   1189  1.27  macallan 
   1190  1.27  macallan #endif /* NWSDISPLAY > 0 */
   1191