Home | History | Annotate | Line # | Download | only in sbus
agten.c revision 1.2
      1  1.2  macallan /*	$NetBSD: agten.c,v 1.2 2007/08/26 07:24:28 macallan Exp $ */
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2007 Michael Lorenz
      5  1.1  macallan  * All rights reserved.
      6  1.1  macallan  *
      7  1.1  macallan  * Redistribution and use in source and binary forms, with or without
      8  1.1  macallan  * modification, are permitted provided that the following conditions
      9  1.1  macallan  * are met:
     10  1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     11  1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     12  1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  macallan  *    documentation and/or other materials provided with the distribution.
     15  1.1  macallan  * 3. Neither the name of The NetBSD Foundation nor the names of its
     16  1.1  macallan  *    contributors may be used to endorse or promote products derived
     17  1.1  macallan  *    from this software without specific prior written permission.
     18  1.1  macallan  *
     19  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  macallan  */
     31  1.1  macallan 
     32  1.1  macallan #include <sys/cdefs.h>
     33  1.2  macallan __KERNEL_RCSID(0, "$NetBSD: agten.c,v 1.2 2007/08/26 07:24:28 macallan Exp $");
     34  1.1  macallan 
     35  1.1  macallan /*
     36  1.1  macallan  * a driver for the Fujitsu AG-10e SBus framebuffer
     37  1.1  macallan  *
     38  1.1  macallan  * this thing is Frankenstein's Monster among graphics boards.
     39  1.1  macallan  * it contains three graphics chips:
     40  1.1  macallan  * a GLint - 24bit stuff, double-buffered
     41  1.1  macallan  * an Imagine 128 which provides an 8bit overlay
     42  1.1  macallan  * a Weitek P9100 which provides WIDs
     43  1.1  macallan  * so here we need to mess only with the P9100 and the I128 - for X we just
     44  1.1  macallan  * hide the overlay and let the Xserver mess with the GLint
     45  1.1  macallan  */
     46  1.1  macallan 
     47  1.1  macallan #include <sys/param.h>
     48  1.1  macallan #include <sys/systm.h>
     49  1.1  macallan #include <sys/kernel.h>
     50  1.1  macallan #include <sys/device.h>
     51  1.1  macallan #include <sys/proc.h>
     52  1.1  macallan #include <sys/mutex.h>
     53  1.1  macallan #include <sys/ioctl.h>
     54  1.1  macallan #include <sys/kernel.h>
     55  1.1  macallan #include <sys/systm.h>
     56  1.1  macallan #include <sys/malloc.h>
     57  1.1  macallan 
     58  1.1  macallan #include <dev/sun/fbio.h>
     59  1.1  macallan #include <dev/sun/fbvar.h>
     60  1.1  macallan #include <dev/sun/btreg.h>
     61  1.1  macallan #include <dev/sun/btvar.h>
     62  1.1  macallan 
     63  1.1  macallan #include <machine/bus.h>
     64  1.1  macallan #include <machine/autoconf.h>
     65  1.1  macallan 
     66  1.1  macallan #include <dev/sbus/sbusvar.h>
     67  1.1  macallan 
     68  1.1  macallan #include <dev/wscons/wsconsio.h>
     69  1.1  macallan #include <dev/wscons/wsdisplayvar.h>
     70  1.1  macallan #include <dev/rasops/rasops.h>
     71  1.1  macallan #include <dev/wsfont/wsfont.h>
     72  1.1  macallan 
     73  1.1  macallan #include <dev/wscons/wsdisplay_vconsvar.h>
     74  1.1  macallan 
     75  1.1  macallan #include <dev/sbus/p9100reg.h>
     76  1.1  macallan #include <dev/ic/ibm561reg.h>
     77  1.1  macallan #include <dev/ic/i128reg.h>
     78  1.1  macallan #include <dev/ic/i128var.h>
     79  1.1  macallan 
     80  1.1  macallan #include "opt_agten.h"
     81  1.1  macallan 
     82  1.1  macallan static int	agten_match(struct device *, struct cfdata *, void *);
     83  1.1  macallan static void	agten_attach(struct device *, struct device *, void *);
     84  1.1  macallan 
     85  1.1  macallan #if 0
     86  1.1  macallan static void	agten_unblank(struct device *);
     87  1.1  macallan #endif
     88  1.1  macallan 
     89  1.1  macallan static int	agten_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     90  1.1  macallan static paddr_t	agten_mmap(void *, void *, off_t, int);
     91  1.1  macallan static void	agten_init_screen(void *, struct vcons_screen *, int, long *);
     92  1.1  macallan 
     93  1.1  macallan struct agten_softc {
     94  1.1  macallan 	struct device	sc_dev;		/* base device */
     95  1.1  macallan 	struct sbusdev	sc_sd;		/* sbus device */
     96  1.1  macallan 	struct fbdevice	sc_fb;		/* frame buffer device */
     97  1.1  macallan 
     98  1.1  macallan 	struct vcons_screen sc_console_screen;
     99  1.1  macallan 	struct wsscreen_descr sc_defaultscreen_descr;
    100  1.1  macallan 	const struct wsscreen_descr *sc_screens[1];
    101  1.1  macallan 	struct wsscreen_list sc_screenlist;
    102  1.1  macallan 
    103  1.1  macallan 	bus_space_tag_t	sc_bustag;
    104  1.1  macallan 
    105  1.1  macallan 	bus_space_handle_t 	sc_i128_fbh;
    106  1.1  macallan 	bus_size_t		sc_i128_fbsz;
    107  1.1  macallan 	bus_space_handle_t 	sc_i128_regh;
    108  1.1  macallan 	bus_space_handle_t 	sc_p9100_regh;
    109  1.1  macallan 
    110  1.1  macallan 	uint32_t	sc_width;
    111  1.1  macallan 	uint32_t	sc_height;	/* panel width / height */
    112  1.1  macallan 	uint32_t	sc_stride;
    113  1.1  macallan 	uint32_t	sc_depth;
    114  1.1  macallan 
    115  1.1  macallan 	union	bt_cmap sc_cmap;	/* Brooktree color map */
    116  1.1  macallan 
    117  1.1  macallan 	int sc_mode;
    118  1.1  macallan 	int sc_video, sc_powerstate;
    119  1.1  macallan 	uint32_t sc_bg;
    120  1.1  macallan 	struct vcons_data vd;
    121  1.1  macallan };
    122  1.1  macallan 
    123  1.1  macallan CFATTACH_DECL(agten, sizeof(struct agten_softc),
    124  1.1  macallan     agten_match, agten_attach, NULL, NULL);
    125  1.1  macallan 
    126  1.1  macallan 
    127  1.1  macallan static int	agten_putcmap(struct agten_softc *, struct wsdisplay_cmap *);
    128  1.1  macallan static int 	agten_getcmap(struct agten_softc *, struct wsdisplay_cmap *);
    129  1.1  macallan static int 	agten_putpalreg(struct agten_softc *, uint8_t, uint8_t,
    130  1.1  macallan 			    uint8_t, uint8_t);
    131  1.1  macallan static void	agten_init(struct agten_softc *);
    132  1.1  macallan 
    133  1.1  macallan static void	agten_copycols(void *, int, int, int, int);
    134  1.1  macallan static void	agten_erasecols(void *, int, int, int, long);
    135  1.1  macallan static void	agten_copyrows(void *, int, int, int);
    136  1.1  macallan static void	agten_eraserows(void *, int, int, long);
    137  1.1  macallan 
    138  1.1  macallan extern const u_char rasops_cmap[768];
    139  1.1  macallan 
    140  1.1  macallan struct wsdisplay_accessops agten_accessops = {
    141  1.1  macallan 	agten_ioctl,
    142  1.1  macallan 	agten_mmap,
    143  1.1  macallan 	NULL,	/* alloc_screen */
    144  1.1  macallan 	NULL,	/* free_screen */
    145  1.1  macallan 	NULL,	/* show_screen */
    146  1.1  macallan 	NULL, 	/* load_font */
    147  1.1  macallan 	NULL,	/* pollc */
    148  1.1  macallan 	NULL	/* scroll */
    149  1.1  macallan };
    150  1.1  macallan 
    151  1.1  macallan static inline void
    152  1.1  macallan agten_write_dac(struct agten_softc *sc, int reg, uint8_t val)
    153  1.1  macallan {
    154  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    155  1.1  macallan 	    0x200 + (reg << 2), (uint32_t)val << 16);
    156  1.1  macallan }
    157  1.1  macallan 
    158  1.1  macallan static inline void
    159  1.1  macallan agten_write_idx(struct agten_softc *sc, int offset)
    160  1.1  macallan {
    161  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    162  1.1  macallan 	    0x200 + (IBM561_ADDR_LOW << 2), (offset & 0xff) << 16);
    163  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    164  1.1  macallan 	    0x200 + (IBM561_ADDR_HIGH << 2), ((offset >> 8) & 0xff) << 16);
    165  1.1  macallan }
    166  1.1  macallan 
    167  1.1  macallan static inline void
    168  1.1  macallan agten_write_dac_10(struct agten_softc *sc, int reg, uint16_t val)
    169  1.1  macallan {
    170  1.1  macallan 	agten_write_dac(sc, reg, (val >> 2) & 0xff);
    171  1.1  macallan 	agten_write_dac(sc, reg, (val & 0x3) << 6);
    172  1.1  macallan }
    173  1.1  macallan 
    174  1.1  macallan static int
    175  1.1  macallan agten_match(struct device *dev, struct cfdata *cf, void *aux)
    176  1.1  macallan {
    177  1.1  macallan 	struct sbus_attach_args *sa = aux;
    178  1.1  macallan 
    179  1.1  macallan 	if (strcmp("PFU,aga", sa->sa_name) == 0)
    180  1.1  macallan 		return 100;
    181  1.1  macallan 	return 0;
    182  1.1  macallan }
    183  1.1  macallan 
    184  1.1  macallan static void
    185  1.1  macallan agten_attach(struct device *parent, struct device *dev, void *aux)
    186  1.1  macallan {
    187  1.1  macallan 	struct agten_softc *sc = (struct agten_softc *)dev;
    188  1.1  macallan 	struct sbus_attach_args *sa = aux;
    189  1.1  macallan 	struct fbdevice *fb = &sc->sc_fb;
    190  1.1  macallan 	struct wsemuldisplaydev_attach_args aa;
    191  1.1  macallan 	struct rasops_info *ri;
    192  1.1  macallan 	long defattr;
    193  1.1  macallan 	uint32_t reg;
    194  1.1  macallan 	int node = sa->sa_node;
    195  1.1  macallan 	int console;
    196  1.1  macallan 
    197  1.1  macallan 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    198  1.1  macallan 		"default",
    199  1.1  macallan 		0, 0,
    200  1.1  macallan 		NULL,
    201  1.1  macallan 		8, 16,
    202  1.1  macallan 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    203  1.1  macallan 		NULL
    204  1.1  macallan 	};
    205  1.1  macallan 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    206  1.1  macallan 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    207  1.1  macallan 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    208  1.1  macallan 	sc->sc_bustag = sa->sa_bustag;
    209  1.1  macallan #if 0
    210  1.1  macallan 	sc->sc_shadowfb = malloc(sc->sc_fbsize, M_DEVBUF, M_WAITOK);
    211  1.1  macallan 
    212  1.1  macallan 	dict = device_properties(&sc->sc_dev);
    213  1.1  macallan 
    214  1.1  macallan 	prop_dictionary_get_bool(dict, "is_console", &console);
    215  1.1  macallan #endif
    216  1.1  macallan 
    217  1.1  macallan 	reg = prom_getpropint(node, "i128_fb_physaddr", -1);
    218  1.1  macallan 	sc->sc_i128_fbsz = prom_getpropint(node, "i128_fb_size", -1);
    219  1.1  macallan 	if (sbus_bus_map(sc->sc_bustag,
    220  1.1  macallan 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    221  1.1  macallan 	    sc->sc_i128_fbsz, BUS_SPACE_MAP_LINEAR, &sc->sc_i128_fbh) != 0) {
    222  1.1  macallan 
    223  1.1  macallan 		aprint_error("%s: unable to map the framebuffer\n",
    224  1.1  macallan 		    dev->dv_xname);
    225  1.1  macallan 		return;
    226  1.1  macallan 	}
    227  1.1  macallan 	fb->fb_pixels = bus_space_vaddr(sc->sc_bustag, sc->sc_i128_fbh);
    228  1.1  macallan 
    229  1.1  macallan 	reg = prom_getpropint(node, "p9100_reg_physaddr", -1);
    230  1.1  macallan 	if (sbus_bus_map(sc->sc_bustag,
    231  1.1  macallan 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    232  1.1  macallan 	    0x8000, 0, &sc->sc_p9100_regh) != 0) {
    233  1.1  macallan 
    234  1.1  macallan 		aprint_error("%s: unable to map P9100 registers\n",
    235  1.1  macallan 		    dev->dv_xname);
    236  1.1  macallan 		return;
    237  1.1  macallan 	}
    238  1.1  macallan 
    239  1.1  macallan 	reg = prom_getpropint(node, "i128_reg_physaddr", -1);
    240  1.1  macallan 	if (sbus_bus_map(sc->sc_bustag,
    241  1.1  macallan 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    242  1.1  macallan 	    0x10000, 0, &sc->sc_i128_regh) != 0) {
    243  1.1  macallan 
    244  1.1  macallan 		aprint_error("%s: unable to map I128 registers\n",
    245  1.1  macallan 		    dev->dv_xname);
    246  1.1  macallan 		return;
    247  1.1  macallan 	}
    248  1.2  macallan 
    249  1.1  macallan 	sbus_establish(&sc->sc_sd, &sc->sc_dev);
    250  1.1  macallan #if 0
    251  1.1  macallan 	bus_intr_establish(sc->sc_bustag, sa->sa_pri, IPL_BIO,
    252  1.1  macallan 	    agten_intr, sc);
    253  1.1  macallan #endif
    254  1.1  macallan 
    255  1.1  macallan 	sc->sc_width = prom_getpropint(node, "ffb_width", 800);
    256  1.1  macallan 	sc->sc_height = prom_getpropint(node, "ffb_height", 600);
    257  1.1  macallan 	sc->sc_depth = prom_getpropint(node, "ffb_depth", 8);
    258  1.1  macallan 	sc->sc_stride = sc->sc_width * (sc->sc_depth >> 3);
    259  1.1  macallan 
    260  1.1  macallan 	agten_init(sc);
    261  1.1  macallan 
    262  1.1  macallan 	console = fb_is_console(node);
    263  1.1  macallan 
    264  1.1  macallan 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    265  1.1  macallan 	    &agten_accessops);
    266  1.1  macallan 	sc->vd.init_screen = agten_init_screen;
    267  1.1  macallan 
    268  1.1  macallan 	ri = &sc->sc_console_screen.scr_ri;
    269  1.1  macallan 
    270  1.1  macallan 	if (console) {
    271  1.1  macallan 		vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    272  1.1  macallan 		    &defattr);
    273  1.1  macallan 		sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    274  1.1  macallan 
    275  1.1  macallan 		sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    276  1.1  macallan 		sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    277  1.1  macallan 		sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    278  1.1  macallan 		sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    279  1.1  macallan 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    280  1.1  macallan 		    defattr);
    281  1.2  macallan 		i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, 0, 0,
    282  1.2  macallan 		    sc->sc_width, sc->sc_height,
    283  1.2  macallan 		    ri->ri_devcmap[(defattr >> 16) & 0xff]);
    284  1.1  macallan 	} else {
    285  1.1  macallan 		/*
    286  1.1  macallan 		 * since we're not the console we can postpone the rest
    287  1.1  macallan 		 * until someone actually allocates a screen for us
    288  1.1  macallan 		 */
    289  1.1  macallan 	}
    290  1.1  macallan 
    291  1.1  macallan 	/* Initialize the default color map. */
    292  1.1  macallan 
    293  1.1  macallan 	aa.console = console;
    294  1.1  macallan 	aa.scrdata = &sc->sc_screenlist;
    295  1.1  macallan 	aa.accessops = &agten_accessops;
    296  1.1  macallan 	aa.accesscookie = &sc->vd;
    297  1.1  macallan 
    298  1.1  macallan 	config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
    299  1.1  macallan }
    300  1.1  macallan 
    301  1.1  macallan static int
    302  1.1  macallan agten_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    303  1.1  macallan 	struct lwp *l)
    304  1.1  macallan {
    305  1.1  macallan 	struct vcons_data *vd = v;
    306  1.1  macallan 	struct agten_softc *sc = vd->cookie;
    307  1.1  macallan 	struct wsdisplay_fbinfo *wdf;
    308  1.1  macallan 	struct vcons_screen *ms = vd->active;
    309  1.1  macallan 
    310  1.1  macallan 	switch (cmd) {
    311  1.1  macallan 
    312  1.1  macallan 		case WSDISPLAYIO_GINFO:
    313  1.1  macallan 			if (ms == NULL)
    314  1.1  macallan 				return ENODEV;
    315  1.1  macallan 			wdf = (void *)data;
    316  1.1  macallan 			wdf->height = ms->scr_ri.ri_height;
    317  1.1  macallan 			wdf->width = ms->scr_ri.ri_width;
    318  1.1  macallan 			wdf->depth = ms->scr_ri.ri_depth;
    319  1.1  macallan 			wdf->cmsize = 256;
    320  1.1  macallan 			return 0;
    321  1.1  macallan 
    322  1.1  macallan 		case WSDISPLAYIO_GETCMAP:
    323  1.1  macallan 			return agten_getcmap(sc,
    324  1.1  macallan 			    (struct wsdisplay_cmap *)data);
    325  1.1  macallan 
    326  1.1  macallan 		case WSDISPLAYIO_PUTCMAP:
    327  1.1  macallan 			return agten_putcmap(sc,
    328  1.1  macallan 			    (struct wsdisplay_cmap *)data);
    329  1.1  macallan 
    330  1.1  macallan 		case WSDISPLAYIO_LINEBYTES:
    331  1.1  macallan 			*(u_int *)data = sc->sc_stride;
    332  1.1  macallan 			return 0;
    333  1.1  macallan 
    334  1.1  macallan 		case WSDISPLAYIO_SMODE:
    335  1.1  macallan 			{
    336  1.1  macallan 				int new_mode = *(int*)data;
    337  1.1  macallan 				if (new_mode != sc->sc_mode) {
    338  1.1  macallan 					sc->sc_mode = new_mode;
    339  1.1  macallan 					if(new_mode == WSDISPLAYIO_MODE_EMUL) {
    340  1.2  macallan 						agten_init(sc);
    341  1.1  macallan 						vcons_redraw_screen(ms);
    342  1.1  macallan 					}
    343  1.1  macallan 				}
    344  1.1  macallan 			}
    345  1.1  macallan 			return 0;
    346  1.1  macallan 	}
    347  1.1  macallan 	return EPASSTHROUGH;
    348  1.1  macallan }
    349  1.1  macallan 
    350  1.1  macallan static paddr_t
    351  1.1  macallan agten_mmap(void *v, void *vs, off_t offset, int prot)
    352  1.1  macallan {
    353  1.1  macallan 	struct vcons_data *vd = v;
    354  1.1  macallan 	struct agten_softc *sc = vd->cookie;
    355  1.1  macallan 
    356  1.1  macallan 	if (offset < sc->sc_i128_fbsz)
    357  1.1  macallan 		return bus_space_mmap(sc->sc_bustag, sc->sc_i128_fbh, offset,
    358  1.1  macallan 		    prot, BUS_SPACE_MAP_LINEAR);
    359  1.1  macallan 	return -1;
    360  1.1  macallan }
    361  1.1  macallan 
    362  1.1  macallan static void
    363  1.1  macallan agten_init_screen(void *cookie, struct vcons_screen *scr,
    364  1.1  macallan     int existing, long *defattr)
    365  1.1  macallan {
    366  1.1  macallan 	struct agten_softc *sc = cookie;
    367  1.1  macallan 	struct rasops_info *ri = &scr->scr_ri;
    368  1.1  macallan 
    369  1.1  macallan 	ri->ri_depth = sc->sc_depth;
    370  1.1  macallan 	ri->ri_width = sc->sc_width;
    371  1.1  macallan 	ri->ri_height = sc->sc_height;
    372  1.1  macallan 	ri->ri_stride = sc->sc_stride;
    373  1.1  macallan 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    374  1.1  macallan 
    375  1.1  macallan 	ri->ri_bits = (char *)sc->sc_fb.fb_pixels;
    376  1.1  macallan 
    377  1.1  macallan 	if (existing) {
    378  1.1  macallan 		ri->ri_flg |= RI_CLEAR;
    379  1.1  macallan 	}
    380  1.1  macallan 
    381  1.1  macallan 	rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
    382  1.1  macallan 	ri->ri_caps = WSSCREEN_WSCOLORS;
    383  1.1  macallan 
    384  1.1  macallan 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    385  1.1  macallan 		    sc->sc_width / ri->ri_font->fontwidth);
    386  1.1  macallan 
    387  1.1  macallan 	ri->ri_hw = scr;
    388  1.1  macallan 	ri->ri_ops.copyrows  = agten_copyrows;
    389  1.1  macallan 	ri->ri_ops.eraserows = agten_eraserows;
    390  1.1  macallan 	ri->ri_ops.copycols  = agten_copycols;
    391  1.1  macallan 	ri->ri_ops.erasecols = agten_erasecols;
    392  1.1  macallan 
    393  1.1  macallan }
    394  1.1  macallan 
    395  1.1  macallan static int
    396  1.1  macallan agten_putcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
    397  1.1  macallan {
    398  1.1  macallan 	u_int index = cm->index;
    399  1.1  macallan 	u_int count = cm->count;
    400  1.1  macallan 	int i, error;
    401  1.1  macallan 	u_char rbuf[256], gbuf[256], bbuf[256];
    402  1.1  macallan 	u_char *r, *g, *b;
    403  1.1  macallan 
    404  1.1  macallan 	if (cm->index >= 256 || cm->count > 256 ||
    405  1.1  macallan 	    (cm->index + cm->count) > 256)
    406  1.1  macallan 		return EINVAL;
    407  1.1  macallan 	error = copyin(cm->red, &rbuf[index], count);
    408  1.1  macallan 	if (error)
    409  1.1  macallan 		return error;
    410  1.1  macallan 	error = copyin(cm->green, &gbuf[index], count);
    411  1.1  macallan 	if (error)
    412  1.1  macallan 		return error;
    413  1.1  macallan 	error = copyin(cm->blue, &bbuf[index], count);
    414  1.1  macallan 	if (error)
    415  1.1  macallan 		return error;
    416  1.1  macallan 
    417  1.1  macallan 	r = &rbuf[index];
    418  1.1  macallan 	g = &gbuf[index];
    419  1.1  macallan 	b = &bbuf[index];
    420  1.1  macallan 
    421  1.1  macallan 	for (i = 0; i < count; i++) {
    422  1.1  macallan 		agten_putpalreg(sc, index, *r, *g, *b);
    423  1.1  macallan 		index++;
    424  1.1  macallan 		r++, g++, b++;
    425  1.1  macallan 	}
    426  1.1  macallan 	return 0;
    427  1.1  macallan }
    428  1.1  macallan 
    429  1.1  macallan static int
    430  1.1  macallan agten_getcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
    431  1.1  macallan {
    432  1.1  macallan 	u_int index = cm->index;
    433  1.1  macallan 	u_int count = cm->count;
    434  1.1  macallan 	int error, i;
    435  1.1  macallan 	uint8_t red[256], green[256], blue[256];
    436  1.1  macallan 
    437  1.1  macallan 	if (index >= 255 || count > 256 || index + count > 256)
    438  1.1  macallan 		return EINVAL;
    439  1.1  macallan 
    440  1.1  macallan 	i = index;
    441  1.1  macallan 	while (i < (index + count)) {
    442  1.1  macallan 		red[i] = sc->sc_cmap.cm_map[i][0];
    443  1.1  macallan 		green[i] = sc->sc_cmap.cm_map[i][1];
    444  1.1  macallan 		blue[i] = sc->sc_cmap.cm_map[i][2];
    445  1.1  macallan 		i++;
    446  1.1  macallan 	}
    447  1.1  macallan 	error = copyout(&red[index],   cm->red,   count);
    448  1.1  macallan 	if (error)
    449  1.1  macallan 		return error;
    450  1.1  macallan 	error = copyout(&green[index], cm->green, count);
    451  1.1  macallan 	if (error)
    452  1.1  macallan 		return error;
    453  1.1  macallan 	error = copyout(&blue[index],  cm->blue,  count);
    454  1.1  macallan 	if (error)
    455  1.1  macallan 		return error;
    456  1.1  macallan 
    457  1.1  macallan 	return 0;
    458  1.1  macallan }
    459  1.1  macallan 
    460  1.1  macallan static int
    461  1.1  macallan agten_putpalreg(struct agten_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
    462  1.1  macallan     uint8_t b)
    463  1.1  macallan {
    464  1.1  macallan 
    465  1.1  macallan 	sc->sc_cmap.cm_map[idx][0] = r;
    466  1.1  macallan 	sc->sc_cmap.cm_map[idx][1] = g;
    467  1.1  macallan 	sc->sc_cmap.cm_map[idx][2] = b;
    468  1.1  macallan 	agten_write_idx(sc, IBM561_CMAP_TABLE + idx);
    469  1.1  macallan 	agten_write_dac(sc, IBM561_CMD_CMAP, r);
    470  1.1  macallan 	agten_write_dac(sc, IBM561_CMD_CMAP, g);
    471  1.1  macallan 	agten_write_dac(sc, IBM561_CMD_CMAP, b);
    472  1.1  macallan 	return 0;
    473  1.1  macallan }
    474  1.1  macallan 
    475  1.1  macallan static void
    476  1.1  macallan agten_init(struct agten_softc *sc)
    477  1.1  macallan {
    478  1.1  macallan 	int i, j;
    479  1.1  macallan 	uint32_t src, srcw;
    480  1.1  macallan 	volatile uint32_t junk;
    481  1.1  macallan 
    482  1.1  macallan 	/* first we set up the colour map */
    483  1.1  macallan 	j = 0;
    484  1.1  macallan 	for (i = 0; i < 256; i++) {
    485  1.1  macallan 
    486  1.1  macallan 		agten_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
    487  1.1  macallan 		    rasops_cmap[j + 2]);
    488  1.1  macallan 		j += 3;
    489  1.1  macallan 	}
    490  1.1  macallan 
    491  1.1  macallan 	/* now set up some window attributes */
    492  1.2  macallan 	agten_write_idx(sc, IBM561_OL_WINTYPE);
    493  1.1  macallan 	agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x00);
    494  1.1  macallan 	for (i = 1; i < 256; i++)
    495  1.1  macallan 		agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x01);
    496  1.1  macallan 
    497  1.1  macallan 	src = 0;
    498  1.1  macallan 	srcw = sc->sc_width << 16 | sc->sc_height;
    499  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, FOREGROUND_COLOR,
    500  1.1  macallan 	    0x0);
    501  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, BACKGROUND_COLOR,
    502  1.1  macallan 	    0x0);
    503  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RASTER_OP, ROP_PAT);
    504  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, COORD_INDEX, 0);
    505  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, src);
    506  1.1  macallan 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, srcw);
    507  1.1  macallan 	junk = bus_space_read_4(sc->sc_bustag, sc->sc_p9100_regh, COMMAND_QUAD);
    508  1.1  macallan 
    509  1.2  macallan 	i128_init(sc->sc_bustag, sc->sc_i128_regh, sc->sc_stride, 8);
    510  1.1  macallan }
    511  1.1  macallan 
    512  1.1  macallan static void
    513  1.1  macallan agten_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
    514  1.1  macallan {
    515  1.1  macallan 	struct rasops_info *ri = cookie;
    516  1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
    517  1.1  macallan 	struct agten_softc *sc = scr->scr_cookie;
    518  1.1  macallan 	int32_t xs, xd, y, width, height;
    519  1.1  macallan 
    520  1.1  macallan 	xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
    521  1.1  macallan 	xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
    522  1.1  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    523  1.1  macallan 	width = ri->ri_font->fontwidth * ncols;
    524  1.1  macallan 	height = ri->ri_font->fontheight;
    525  1.1  macallan 	i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, xs, y, xd, y, width,
    526  1.2  macallan 	    height, CR_COPY);
    527  1.1  macallan }
    528  1.1  macallan 
    529  1.1  macallan static void
    530  1.1  macallan agten_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
    531  1.1  macallan {
    532  1.1  macallan 	struct rasops_info *ri = cookie;
    533  1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
    534  1.1  macallan 	struct agten_softc *sc = scr->scr_cookie;
    535  1.1  macallan 	int32_t x, y, width, height, bg;
    536  1.1  macallan 
    537  1.1  macallan 	x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
    538  1.1  macallan 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    539  1.1  macallan 	width = ri->ri_font->fontwidth * ncols;
    540  1.1  macallan 	height = ri->ri_font->fontheight;
    541  1.1  macallan 	bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
    542  1.1  macallan 	i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
    543  1.1  macallan }
    544  1.1  macallan 
    545  1.1  macallan static void
    546  1.1  macallan agten_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
    547  1.1  macallan {
    548  1.1  macallan 	struct rasops_info *ri = cookie;
    549  1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
    550  1.1  macallan 	struct agten_softc *sc = scr->scr_cookie;
    551  1.1  macallan 	int32_t x, ys, yd, width, height;
    552  1.1  macallan 
    553  1.1  macallan 	x = ri->ri_xorigin;
    554  1.1  macallan 	ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
    555  1.1  macallan 	yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
    556  1.1  macallan 	width = ri->ri_emuwidth;
    557  1.1  macallan 	height = ri->ri_font->fontheight * nrows;
    558  1.1  macallan 	i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, x, ys, x, yd, width,
    559  1.2  macallan 	    height, CR_COPY);
    560  1.1  macallan }
    561  1.1  macallan 
    562  1.1  macallan static void
    563  1.1  macallan agten_eraserows(void *cookie, int row, int nrows, long fillattr)
    564  1.1  macallan {
    565  1.1  macallan 	struct rasops_info *ri = cookie;
    566  1.1  macallan 	struct vcons_screen *scr = ri->ri_hw;
    567  1.1  macallan 	struct agten_softc *sc = scr->scr_cookie;
    568  1.1  macallan 	int32_t x, y, width, height, bg;
    569  1.1  macallan 
    570  1.1  macallan 	if ((row == 0) && (nrows == ri->ri_rows)) {
    571  1.1  macallan 		x = y = 0;
    572  1.1  macallan 		width = ri->ri_width;
    573  1.1  macallan 		height = ri->ri_height;
    574  1.1  macallan 	} else {
    575  1.1  macallan 		x = ri->ri_xorigin;
    576  1.1  macallan 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    577  1.1  macallan 		width = ri->ri_emuwidth;
    578  1.1  macallan 		height = ri->ri_font->fontheight * nrows;
    579  1.1  macallan 	}
    580  1.1  macallan 	bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
    581  1.1  macallan 	i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
    582  1.1  macallan }
    583