Home | History | Annotate | Line # | Download | only in sbus
agten.c revision 1.11
      1 /*	$NetBSD: agten.c,v 1.11 2008/05/16 15:57:21 macallan Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2007 Michael Lorenz
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  * POSSIBILITY OF SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: agten.c,v 1.11 2008/05/16 15:57:21 macallan Exp $");
     31 
     32 /*
     33  * a driver for the Fujitsu AG-10e SBus framebuffer
     34  *
     35  * this thing is Frankenstein's Monster among graphics boards.
     36  * it contains three graphics chips:
     37  * a GLint - 24bit stuff, double-buffered
     38  * an Imagine 128 which provides an 8bit overlay
     39  * a Weitek P9100 which provides WIDs
     40  * so here we need to mess only with the P9100 and the I128 - for X we just
     41  * hide the overlay and let the Xserver mess with the GLint
     42  */
     43 
     44 #include <sys/param.h>
     45 #include <sys/systm.h>
     46 #include <sys/kernel.h>
     47 #include <sys/device.h>
     48 #include <sys/proc.h>
     49 #include <sys/mutex.h>
     50 #include <sys/ioctl.h>
     51 #include <sys/kernel.h>
     52 #include <sys/systm.h>
     53 #include <sys/conf.h>
     54 
     55 #include <dev/sun/fbio.h>
     56 #include <dev/sun/fbvar.h>
     57 #include <dev/sun/btreg.h>
     58 #include <dev/sun/btvar.h>
     59 
     60 #include <sys/bus.h>
     61 #include <machine/autoconf.h>
     62 
     63 #include <dev/sbus/sbusvar.h>
     64 
     65 #include <dev/wscons/wsconsio.h>
     66 #include <dev/wscons/wsdisplayvar.h>
     67 #include <dev/rasops/rasops.h>
     68 #include <dev/wsfont/wsfont.h>
     69 
     70 #include <dev/wscons/wsdisplay_vconsvar.h>
     71 
     72 #include <dev/sbus/p9100reg.h>
     73 #include <dev/ic/ibm561reg.h>
     74 #include <dev/ic/i128reg.h>
     75 #include <dev/ic/i128var.h>
     76 
     77 #include "opt_agten.h"
     78 
     79 static int	agten_match(device_t, struct cfdata *, void *);
     80 static void	agten_attach(device_t, device_t, void *);
     81 
     82 static int	agten_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     83 static paddr_t	agten_mmap(void *, void *, off_t, int);
     84 static void	agten_init_screen(void *, struct vcons_screen *, int, long *);
     85 
     86 struct agten_softc {
     87 	device_t	sc_dev;		/* base device */
     88 	struct sbusdev	sc_sd;		/* sbus device */
     89 	struct fbdevice	sc_fb;		/* frame buffer device */
     90 
     91 	struct vcons_screen sc_console_screen;
     92 	struct wsscreen_descr sc_defaultscreen_descr;
     93 	const struct wsscreen_descr *sc_screens[1];
     94 	struct wsscreen_list sc_screenlist;
     95 
     96 	bus_space_tag_t	sc_bustag;
     97 
     98 	bus_space_handle_t 	sc_i128_fbh;
     99 	bus_size_t		sc_i128_fbsz;
    100 	bus_space_handle_t 	sc_i128_regh;
    101 	bus_space_handle_t 	sc_p9100_regh;
    102 	bus_addr_t		sc_glint_fb;
    103 	bus_addr_t		sc_glint_regs;
    104 	uint32_t		sc_glint_fbsz;
    105 
    106 	uint32_t	sc_width;
    107 	uint32_t	sc_height;	/* panel width / height */
    108 	uint32_t	sc_stride;
    109 	uint32_t	sc_depth;
    110 
    111 	int sc_cursor_x;
    112 	int sc_cursor_y;
    113 	int sc_video;			/* video output enabled */
    114 
    115 	/* some /dev/fb* stuff */
    116 	int sc_fb_is_open;
    117 
    118 	union	bt_cmap sc_cmap;	/* Brooktree color map */
    119 
    120 	int sc_mode;
    121 	uint32_t sc_bg;
    122 	struct vcons_data vd;
    123 };
    124 
    125 CFATTACH_DECL(agten, sizeof(struct agten_softc),
    126     agten_match, agten_attach, NULL, NULL);
    127 
    128 
    129 static int	agten_putcmap(struct agten_softc *, struct wsdisplay_cmap *);
    130 static int 	agten_getcmap(struct agten_softc *, struct wsdisplay_cmap *);
    131 static int 	agten_putpalreg(struct agten_softc *, uint8_t, uint8_t,
    132 			    uint8_t, uint8_t);
    133 static void	agten_init(struct agten_softc *);
    134 static void	agten_gfx(struct agten_softc *);
    135 static void	agten_set_video(struct agten_softc *, int);
    136 static int	agten_get_video(struct agten_softc *);
    137 
    138 static void	agten_copycols(void *, int, int, int, int);
    139 static void	agten_erasecols(void *, int, int, int, long);
    140 static void	agten_copyrows(void *, int, int, int);
    141 static void	agten_eraserows(void *, int, int, long);
    142 
    143 static void	agten_move_cursor(struct agten_softc *, int, int);
    144 static int	agten_do_cursor(struct agten_softc *sc,
    145 				struct wsdisplay_cursor *);
    146 static int	agten_do_sun_cursor(struct agten_softc *sc,
    147 				struct fbcursor *);
    148 
    149 static uint16_t util_interleave(uint8_t, uint8_t);
    150 static uint16_t util_interleave_lin(uint8_t, uint8_t);
    151 
    152 extern const u_char rasops_cmap[768];
    153 
    154 struct wsdisplay_accessops agten_accessops = {
    155 	agten_ioctl,
    156 	agten_mmap,
    157 	NULL,	/* alloc_screen */
    158 	NULL,	/* free_screen */
    159 	NULL,	/* show_screen */
    160 	NULL, 	/* load_font */
    161 	NULL,	/* pollc */
    162 	NULL	/* scroll */
    163 };
    164 
    165 /* /dev/fb* stuff */
    166 extern struct cfdriver agten_cd;
    167 
    168 static int agten_fb_open(dev_t, int, int, struct lwp *);
    169 static int agten_fb_close(dev_t, int, int, struct lwp *);
    170 static int agten_fb_ioctl(dev_t, u_long, void *, int, struct lwp *);
    171 static paddr_t agten_fb_mmap(dev_t, off_t, int);
    172 static void agten_fb_unblank(device_t);
    173 
    174 static struct fbdriver agtenfbdriver = {
    175 	agten_fb_unblank, agten_fb_open, agten_fb_close, agten_fb_ioctl,
    176 	nopoll, agten_fb_mmap, nokqfilter
    177 };
    178 
    179 static inline void
    180 agten_write_dac(struct agten_softc *sc, int reg, uint8_t val)
    181 {
    182 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    183 	    0x200 + (reg << 2), (uint32_t)val << 16);
    184 }
    185 
    186 static inline void
    187 agten_write_idx(struct agten_softc *sc, int offset)
    188 {
    189 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    190 	    0x200 + (IBM561_ADDR_LOW << 2), (offset & 0xff) << 16);
    191 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
    192 	    0x200 + (IBM561_ADDR_HIGH << 2), ((offset >> 8) & 0xff) << 16);
    193 }
    194 
    195 static inline void
    196 agten_write_dac_10(struct agten_softc *sc, int reg, uint16_t val)
    197 {
    198 	agten_write_dac(sc, reg, (val >> 2) & 0xff);
    199 	agten_write_dac(sc, reg, (val & 0x3) << 6);
    200 }
    201 
    202 static int
    203 agten_match(device_t dev, struct cfdata *cf, void *aux)
    204 {
    205 	struct sbus_attach_args *sa = aux;
    206 
    207 	if (strcmp("PFU,aga", sa->sa_name) == 0)
    208 		return 100;
    209 	return 0;
    210 }
    211 
    212 static void
    213 agten_attach(device_t parent, device_t dev, void *aux)
    214 {
    215 	struct agten_softc *sc = device_private(dev);
    216 	struct sbus_attach_args *sa = aux;
    217 	struct fbdevice *fb = &sc->sc_fb;
    218 	struct wsemuldisplaydev_attach_args aa;
    219 	struct rasops_info *ri;
    220 	long defattr;
    221 	uint32_t reg;
    222 	int node = sa->sa_node;
    223 	int console;
    224 
    225  	sc->sc_dev = dev;
    226 	sc->sc_defaultscreen_descr = (struct wsscreen_descr){
    227 		"default",
    228 		0, 0,
    229 		NULL,
    230 		8, 16,
    231 		WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
    232 		NULL
    233 	};
    234 	sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
    235 	sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
    236 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
    237 	sc->sc_fb_is_open = 0;
    238 	sc->sc_video = -1;
    239 	sc->sc_bustag = sa->sa_bustag;
    240 
    241 	reg = prom_getpropint(node, "i128_fb_physaddr", -1);
    242 	sc->sc_i128_fbsz = prom_getpropint(node, "i128_fb_size", -1);
    243 	if (sbus_bus_map(sc->sc_bustag,
    244 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    245 	    sc->sc_i128_fbsz, BUS_SPACE_MAP_LINEAR, &sc->sc_i128_fbh) != 0) {
    246 
    247 		aprint_error_dev(dev, "unable to map the framebuffer\n");
    248 		return;
    249 	}
    250 	fb->fb_pixels = bus_space_vaddr(sc->sc_bustag, sc->sc_i128_fbh);
    251 
    252 	reg = prom_getpropint(node, "i128_reg_physaddr", -1);
    253 	if (sbus_bus_map(sc->sc_bustag,
    254 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    255 	    0x10000, 0, &sc->sc_i128_regh) != 0) {
    256 
    257 		aprint_error_dev(dev, "unable to map I128 registers\n");
    258 		return;
    259 	}
    260 
    261 	reg = prom_getpropint(node, "p9100_reg_physaddr", -1);
    262 	if (sbus_bus_map(sc->sc_bustag,
    263 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
    264 	    0x8000, 0, &sc->sc_p9100_regh) != 0) {
    265 
    266 		aprint_error_dev(dev, "unable to map P9100 registers\n");
    267 		return;
    268 	}
    269 
    270 	reg = prom_getpropint(node, "glint_fb0_physaddr", -1);
    271 	sc->sc_glint_fb = sbus_bus_addr(sc->sc_bustag,
    272 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg);
    273 	sc->sc_glint_fbsz = prom_getpropint(node, "glint_lb_size", -1);
    274 	reg = prom_getpropint(node, "glint_reg_physaddr", -1);
    275 	sc->sc_glint_regs = sbus_bus_addr(sc->sc_bustag,
    276 	    sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg);
    277 
    278 	sbus_establish(&sc->sc_sd, sc->sc_dev);
    279 
    280 #if 0
    281 	bus_intr_establish(sc->sc_bustag, sa->sa_pri, IPL_BIO,
    282 	    agten_intr, sc);
    283 #endif
    284 
    285 	sc->sc_width = prom_getpropint(node, "ffb_width", 1152);
    286 	sc->sc_height = prom_getpropint(node, "ffb_height", 900);
    287 	sc->sc_depth = prom_getpropint(node, "ffb_depth", 8);
    288 	sc->sc_stride = sc->sc_width * (sc->sc_depth >> 3);
    289 
    290 	printf(": %dx%d\n", sc->sc_width, sc->sc_height);
    291 	agten_init(sc);
    292 
    293 	console = fb_is_console(node);
    294 
    295 	vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
    296 	    &agten_accessops);
    297 	sc->vd.init_screen = agten_init_screen;
    298 
    299 	ri = &sc->sc_console_screen.scr_ri;
    300 
    301 	if (console) {
    302 		vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
    303 		    &defattr);
    304 		sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
    305 
    306 		sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
    307 		sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
    308 		sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
    309 		sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
    310 		wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
    311 		    defattr);
    312 		i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, 0, 0,
    313 		    sc->sc_width, sc->sc_height,
    314 		    ri->ri_devcmap[(defattr >> 16) & 0xff]);
    315 	} else {
    316 		/*
    317 		 * since we're not the console we can postpone the rest
    318 		 * until someone actually allocates a screen for us
    319 		 */
    320 	}
    321 
    322 	/* Initialize the default color map. */
    323 
    324 	aa.console = console;
    325 	aa.scrdata = &sc->sc_screenlist;
    326 	aa.accessops = &agten_accessops;
    327 	aa.accesscookie = &sc->vd;
    328 
    329 	config_found(sc->sc_dev, &aa, wsemuldisplaydevprint);
    330 
    331 	fb->fb_driver = &agtenfbdriver;
    332 	fb->fb_device = sc->sc_dev;
    333 	fb->fb_flags = device_cfdata(sc->sc_dev)->cf_flags & FB_USERMASK;
    334 	fb->fb_type.fb_type = FBTYPE_AG10E;
    335 	fb->fb_type.fb_cmsize = 256;	/* doesn't matter, we're always 24bit */
    336 	fb->fb_type.fb_size = sc->sc_glint_fbsz;
    337 	fb->fb_type.fb_width = sc->sc_width;
    338 	fb->fb_type.fb_height = sc->sc_height;
    339 	fb->fb_type.fb_depth = 32;
    340 	fb->fb_linebytes = sc->sc_stride;
    341 	fb_attach(fb, console);
    342 	agten_set_video(sc, 1);	/* make sure video's on */
    343 }
    344 
    345 static int
    346 agten_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
    347 	struct lwp *l)
    348 {
    349 	struct vcons_data *vd = v;
    350 	struct agten_softc *sc = vd->cookie;
    351 	struct wsdisplay_fbinfo *wdf;
    352 	struct vcons_screen *ms = vd->active;
    353 
    354 	switch (cmd) {
    355 
    356 		case WSDISPLAYIO_GTYPE:
    357 			*(u_int *)data = WSDISPLAY_TYPE_AG10;
    358 			return 0;
    359 
    360 		case WSDISPLAYIO_GINFO:
    361 			if (ms == NULL)
    362 				return ENODEV;
    363 			wdf = (void *)data;
    364 			wdf->height = ms->scr_ri.ri_height;
    365 			wdf->width = ms->scr_ri.ri_width;
    366 			wdf->depth = 32;
    367 			wdf->cmsize = 256;
    368 			return 0;
    369 
    370 		case WSDISPLAYIO_GVIDEO:
    371 			*(int *)data = sc->sc_video;
    372 			return 0;
    373 
    374 		case WSDISPLAYIO_SVIDEO:
    375 			agten_set_video(sc, *(int *)data);
    376 			return 0;
    377 
    378 		case WSDISPLAYIO_GETCMAP:
    379 			return agten_getcmap(sc,
    380 			    (struct wsdisplay_cmap *)data);
    381 
    382 		case WSDISPLAYIO_PUTCMAP:
    383 			return agten_putcmap(sc,
    384 			    (struct wsdisplay_cmap *)data);
    385 
    386 		case WSDISPLAYIO_LINEBYTES:
    387 			*(u_int *)data = sc->sc_stride << 2;
    388 			return 0;
    389 
    390 		case WSDISPLAYIO_SMODE:
    391 			{
    392 				int new_mode = *(int*)data;
    393 				if (new_mode != sc->sc_mode) {
    394 					sc->sc_mode = new_mode;
    395 					if(new_mode == WSDISPLAYIO_MODE_EMUL) {
    396 						agten_init(sc);
    397 						vcons_redraw_screen(ms);
    398 					} else {
    399 						agten_gfx(sc);
    400 					}
    401 				}
    402 			}
    403 			return 0;
    404 
    405 		case WSDISPLAYIO_GCURPOS:
    406 			{
    407 				struct wsdisplay_curpos *cp = (void *)data;
    408 
    409 				cp->x = sc->sc_cursor_x;
    410 				cp->y = sc->sc_cursor_y;
    411 			}
    412 			return 0;
    413 
    414 		case WSDISPLAYIO_SCURPOS:
    415 			{
    416 				struct wsdisplay_curpos *cp = (void *)data;
    417 
    418 				agten_move_cursor(sc, cp->x, cp->y);
    419 			}
    420 			return 0;
    421 
    422 		case WSDISPLAYIO_GCURMAX:
    423 			{
    424 				struct wsdisplay_curpos *cp = (void *)data;
    425 
    426 				cp->x = 64;
    427 				cp->y = 64;
    428 			}
    429 			return 0;
    430 
    431 		case WSDISPLAYIO_SCURSOR:
    432 			{
    433 				struct wsdisplay_cursor *cursor = (void *)data;
    434 
    435 				return agten_do_cursor(sc, cursor);
    436 			}
    437 	}
    438 	return EPASSTHROUGH;
    439 }
    440 
    441 static paddr_t
    442 agten_mmap(void *v, void *vs, off_t offset, int prot)
    443 {
    444 	struct vcons_data *vd = v;
    445 	struct agten_softc *sc = vd->cookie;
    446 
    447 	if (offset < sc->sc_glint_fbsz)
    448 		return bus_space_mmap(sc->sc_bustag, sc->sc_glint_fb, offset,
    449 		    prot, BUS_SPACE_MAP_LINEAR);
    450 	return -1;
    451 }
    452 
    453 static void
    454 agten_init_screen(void *cookie, struct vcons_screen *scr,
    455     int existing, long *defattr)
    456 {
    457 	struct agten_softc *sc = cookie;
    458 	struct rasops_info *ri = &scr->scr_ri;
    459 
    460 	ri->ri_depth = sc->sc_depth;
    461 	ri->ri_width = sc->sc_width;
    462 	ri->ri_height = sc->sc_height;
    463 	ri->ri_stride = sc->sc_stride;
    464 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
    465 
    466 	ri->ri_bits = (char *)sc->sc_fb.fb_pixels;
    467 
    468 	if (existing) {
    469 		ri->ri_flg |= RI_CLEAR;
    470 	}
    471 
    472 	rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
    473 	ri->ri_caps = WSSCREEN_WSCOLORS;
    474 
    475 	rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
    476 		    sc->sc_width / ri->ri_font->fontwidth);
    477 
    478 	ri->ri_hw = scr;
    479 	ri->ri_ops.copyrows  = agten_copyrows;
    480 	ri->ri_ops.eraserows = agten_eraserows;
    481 	ri->ri_ops.copycols  = agten_copycols;
    482 	ri->ri_ops.erasecols = agten_erasecols;
    483 
    484 }
    485 
    486 static int
    487 agten_putcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
    488 {
    489 	u_int index = cm->index;
    490 	u_int count = cm->count;
    491 	int i, error;
    492 	u_char rbuf[256], gbuf[256], bbuf[256];
    493 	u_char *r, *g, *b;
    494 
    495 	if (cm->index >= 256 || cm->count > 256 ||
    496 	    (cm->index + cm->count) > 256)
    497 		return EINVAL;
    498 	error = copyin(cm->red, &rbuf[index], count);
    499 	if (error)
    500 		return error;
    501 	error = copyin(cm->green, &gbuf[index], count);
    502 	if (error)
    503 		return error;
    504 	error = copyin(cm->blue, &bbuf[index], count);
    505 	if (error)
    506 		return error;
    507 
    508 	r = &rbuf[index];
    509 	g = &gbuf[index];
    510 	b = &bbuf[index];
    511 
    512 	for (i = 0; i < count; i++) {
    513 		agten_putpalreg(sc, index, *r, *g, *b);
    514 		index++;
    515 		r++, g++, b++;
    516 	}
    517 	return 0;
    518 }
    519 
    520 static int
    521 agten_getcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
    522 {
    523 	u_int index = cm->index;
    524 	u_int count = cm->count;
    525 	int error, i;
    526 	uint8_t red[256], green[256], blue[256];
    527 
    528 	if (index >= 255 || count > 256 || index + count > 256)
    529 		return EINVAL;
    530 
    531 	i = index;
    532 	while (i < (index + count)) {
    533 		red[i] = sc->sc_cmap.cm_map[i][0];
    534 		green[i] = sc->sc_cmap.cm_map[i][1];
    535 		blue[i] = sc->sc_cmap.cm_map[i][2];
    536 		i++;
    537 	}
    538 	error = copyout(&red[index],   cm->red,   count);
    539 	if (error)
    540 		return error;
    541 	error = copyout(&green[index], cm->green, count);
    542 	if (error)
    543 		return error;
    544 	error = copyout(&blue[index],  cm->blue,  count);
    545 	if (error)
    546 		return error;
    547 
    548 	return 0;
    549 }
    550 
    551 static int
    552 agten_putpalreg(struct agten_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
    553     uint8_t b)
    554 {
    555 
    556 	sc->sc_cmap.cm_map[idx][0] = r;
    557 	sc->sc_cmap.cm_map[idx][1] = g;
    558 	sc->sc_cmap.cm_map[idx][2] = b;
    559 	agten_write_idx(sc, IBM561_CMAP_TABLE + idx);
    560 	agten_write_dac(sc, IBM561_CMD_CMAP, r);
    561 	agten_write_dac(sc, IBM561_CMD_CMAP, g);
    562 	agten_write_dac(sc, IBM561_CMD_CMAP, b);
    563 	return 0;
    564 }
    565 
    566 static void
    567 agten_init(struct agten_softc *sc)
    568 {
    569 	int i, j;
    570 	uint32_t src, srcw;
    571 	volatile uint32_t junk;
    572 
    573 	/* first we set up the colour map */
    574 	j = 0;
    575 	for (i = 0; i < 256; i++) {
    576 
    577 		agten_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
    578 		    rasops_cmap[j + 2]);
    579 		j += 3;
    580 	}
    581 
    582 	/* then we set up a linear LUT for 24bit colour */
    583 	agten_write_idx(sc, IBM561_CMAP_TABLE + 256);
    584 	for (i = 0; i < 256; i++) {
    585 		agten_write_dac(sc, IBM561_CMD_CMAP, i);
    586 		agten_write_dac(sc, IBM561_CMD_CMAP, i);
    587 		agten_write_dac(sc, IBM561_CMD_CMAP, i);
    588 	}
    589 
    590 	/* and the linear gamma maps */
    591 	agten_write_idx(sc, IBM561_RED_GAMMA_TABLE);
    592 	for (i = 0; i < 0x3ff; i+= 4)
    593 		agten_write_dac_10(sc, IBM561_CMD_GAMMA, i);
    594 	agten_write_idx(sc, IBM561_GREEN_GAMMA_TABLE);
    595 	for (i = 0; i < 0x3ff; i+= 4)
    596 		agten_write_dac_10(sc, IBM561_CMD_GAMMA, i);
    597 	agten_write_idx(sc, IBM561_BLUE_GAMMA_TABLE);
    598 	for (i = 0; i < 0x3ff; i+= 4)
    599 		agten_write_dac_10(sc, IBM561_CMD_GAMMA, i);
    600 
    601 	/* enable outputs, RGB mode */
    602 	agten_write_idx(sc, IBM561_CONFIG_REG3);
    603 	agten_write_dac(sc, IBM561_CMD, 0x41);
    604 
    605 	/* MUX 4:1 basic, 8bit overlay, 8bit WIDs */
    606 	agten_write_idx(sc, IBM561_CONFIG_REG1);
    607 	agten_write_dac(sc, IBM561_CMD, 0x2c);
    608 
    609 	/* use internal PLL, enable video output */
    610 	agten_write_idx(sc, IBM561_CONFIG_REG2);
    611 	agten_write_dac(sc, IBM561_CMD, CR2_ENABLE_CLC | CR2_PLL_REF_SELECT |
    612 	    CR2_PIXEL_CLOCK_SELECT | CR2_ENABLE_RGB_OUTPUT);
    613 
    614 	/* now set up some window attributes */
    615 
    616 	/*
    617 	 * direct colour, 24 bit, transparency off, LUT from 0x100
    618 	 * we need to use direct colour and a linear LUT because for some
    619 	 * reason true color mode gives messed up colours
    620 	 */
    621 	agten_write_idx(sc, IBM561_FB_WINTYPE);
    622 	agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x134);
    623 
    624 	/* use gamma LUTs, no crosshair, 0 is transparent */
    625 	agten_write_idx(sc, IBM561_AUXFB_WINTYPE);
    626 	agten_write_dac(sc, IBM561_CMD_FB_WAT, 0x0);
    627 
    628 	/* overlay is 8 bit, opaque */
    629 	agten_write_idx(sc, IBM561_OL_WINTYPE);
    630 	agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x00);
    631 
    632 	/* now we fill the WID fb with zeroes */
    633 	src = 0;
    634 	srcw = sc->sc_width << 16 | sc->sc_height;
    635 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, FOREGROUND_COLOR,
    636 	    0x0);
    637 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, BACKGROUND_COLOR,
    638 	    0x0);
    639 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RASTER_OP, ROP_PAT);
    640 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, COORD_INDEX, 0);
    641 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, src);
    642 	bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, srcw);
    643 	junk = bus_space_read_4(sc->sc_bustag, sc->sc_p9100_regh, COMMAND_QUAD);
    644 
    645 	/* initialize the cursor registers */
    646 
    647 	/* initialize the Imagine 128 */
    648 	i128_init(sc->sc_bustag, sc->sc_i128_regh, sc->sc_stride, 8);
    649 }
    650 
    651 static void
    652 agten_gfx(struct agten_softc *sc)
    653 {
    654 	/* enable overlay transparency on colour 0x00 */
    655 	agten_write_idx(sc, IBM561_OL_WINTYPE);
    656 	agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x01);
    657 
    658 	/* then blit the overlay full of 0x00 */
    659 	i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, 0, 0, sc->sc_width,
    660 	    sc->sc_height, 0);
    661 
    662 	/* ... so we can see the 24bit framebuffer */
    663 }
    664 
    665 static void
    666 agten_set_video(struct agten_softc *sc, int flag)
    667 {
    668 	uint8_t reg =
    669 	    CR2_ENABLE_CLC | CR2_PLL_REF_SELECT | CR2_PIXEL_CLOCK_SELECT;
    670 
    671 	if (flag == sc->sc_video)
    672 		return;
    673 
    674 	agten_write_idx(sc, IBM561_CONFIG_REG2);
    675 	agten_write_dac(sc, IBM561_CMD, flag ? reg | CR2_ENABLE_RGB_OUTPUT :
    676 	    reg);
    677 
    678 	sc->sc_video = flag;
    679 }
    680 
    681 static int
    682 agten_get_video(struct agten_softc *sc)
    683 {
    684 
    685 	return sc->sc_video;
    686 }
    687 
    688 static void
    689 agten_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
    690 {
    691 	struct rasops_info *ri = cookie;
    692 	struct vcons_screen *scr = ri->ri_hw;
    693 	struct agten_softc *sc = scr->scr_cookie;
    694 	int32_t xs, xd, y, width, height;
    695 
    696 	xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
    697 	xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
    698 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    699 	width = ri->ri_font->fontwidth * ncols;
    700 	height = ri->ri_font->fontheight;
    701 	i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, xs, y, xd, y, width,
    702 	    height, CR_COPY);
    703 }
    704 
    705 static void
    706 agten_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
    707 {
    708 	struct rasops_info *ri = cookie;
    709 	struct vcons_screen *scr = ri->ri_hw;
    710 	struct agten_softc *sc = scr->scr_cookie;
    711 	int32_t x, y, width, height, bg;
    712 
    713 	x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
    714 	y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    715 	width = ri->ri_font->fontwidth * ncols;
    716 	height = ri->ri_font->fontheight;
    717 	bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
    718 	i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
    719 }
    720 
    721 static void
    722 agten_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
    723 {
    724 	struct rasops_info *ri = cookie;
    725 	struct vcons_screen *scr = ri->ri_hw;
    726 	struct agten_softc *sc = scr->scr_cookie;
    727 	int32_t x, ys, yd, width, height;
    728 
    729 	x = ri->ri_xorigin;
    730 	ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
    731 	yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
    732 	width = ri->ri_emuwidth;
    733 	height = ri->ri_font->fontheight * nrows;
    734 	i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, x, ys, x, yd, width,
    735 	    height, CR_COPY);
    736 }
    737 
    738 static void
    739 agten_eraserows(void *cookie, int row, int nrows, long fillattr)
    740 {
    741 	struct rasops_info *ri = cookie;
    742 	struct vcons_screen *scr = ri->ri_hw;
    743 	struct agten_softc *sc = scr->scr_cookie;
    744 	int32_t x, y, width, height, bg;
    745 
    746 	if ((row == 0) && (nrows == ri->ri_rows)) {
    747 		x = y = 0;
    748 		width = ri->ri_width;
    749 		height = ri->ri_height;
    750 	} else {
    751 		x = ri->ri_xorigin;
    752 		y = ri->ri_yorigin + ri->ri_font->fontheight * row;
    753 		width = ri->ri_emuwidth;
    754 		height = ri->ri_font->fontheight * nrows;
    755 	}
    756 	bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
    757 	i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
    758 }
    759 
    760 static void
    761 agten_move_cursor(struct agten_softc *sc, int x, int y)
    762 {
    763 
    764 	sc->sc_cursor_x = x;
    765 	sc->sc_cursor_y = y;
    766 	agten_write_idx(sc, IBM561_CURSOR_X_REG);
    767 	agten_write_dac(sc, IBM561_CMD, x & 0xff);
    768 	agten_write_dac(sc, IBM561_CMD, (x >> 8) & 0xff);
    769 	agten_write_dac(sc, IBM561_CMD, y & 0xff);
    770 	agten_write_dac(sc, IBM561_CMD, (y >> 8) & 0xff);
    771 }
    772 
    773 static int
    774 agten_do_cursor(struct agten_softc *sc, struct wsdisplay_cursor *cur)
    775 {
    776 	if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
    777 
    778 		agten_write_idx(sc, IBM561_CURS_CNTL_REG);
    779 		agten_write_dac(sc, IBM561_CMD, cur->enable ?
    780 		    CURS_ENABLE : 0);
    781 	}
    782 	if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
    783 
    784 		agten_write_idx(sc, IBM561_HOTSPOT_X_REG);
    785 		agten_write_dac(sc, IBM561_CMD, cur->hot.x);
    786 		agten_write_dac(sc, IBM561_CMD, cur->hot.y);
    787 	}
    788 	if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
    789 
    790 		agten_move_cursor(sc, cur->pos.x, cur->pos.y);
    791 	}
    792 	if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
    793 		int i;
    794 
    795 		agten_write_idx(sc, IBM561_CURSOR_LUT + cur->cmap.index + 2);
    796 		for (i = 0; i < cur->cmap.count; i++) {
    797 			agten_write_dac(sc, IBM561_CMD_CMAP, cur->cmap.red[i]);
    798 			agten_write_dac(sc, IBM561_CMD_CMAP, cur->cmap.green[i]);
    799 			agten_write_dac(sc, IBM561_CMD_CMAP, cur->cmap.blue[i]);
    800 		}
    801 	}
    802 	if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {
    803 		int i;
    804 		uint16_t tmp;
    805 
    806 		agten_write_idx(sc, IBM561_CURSOR_BITMAP);
    807 		for (i = 0; i < 512; i++) {
    808 			tmp = util_interleave(cur->mask[i], cur->image[i]);
    809 			agten_write_dac(sc, IBM561_CMD, (tmp >> 8) & 0xff);
    810 			agten_write_dac(sc, IBM561_CMD, tmp & 0xff);
    811 		}
    812 	}
    813 	return 0;
    814 }
    815 
    816 static int
    817 agten_do_sun_cursor(struct agten_softc *sc, struct fbcursor *cur)
    818 {
    819 	if (cur->set & FB_CUR_SETCUR) {
    820 
    821 		agten_write_idx(sc, IBM561_CURS_CNTL_REG);
    822 		agten_write_dac(sc, IBM561_CMD, cur->enable ?
    823 		    CURS_ENABLE : 0);
    824 	}
    825 	if (cur->set & FB_CUR_SETHOT) {
    826 
    827 		agten_write_idx(sc, IBM561_HOTSPOT_X_REG);
    828 		agten_write_dac(sc, IBM561_CMD, cur->hot.x);
    829 		agten_write_dac(sc, IBM561_CMD, cur->hot.y);
    830 	}
    831 	if (cur->set & FB_CUR_SETPOS) {
    832 
    833 		agten_move_cursor(sc, cur->pos.x, cur->pos.y);
    834 	}
    835 	if (cur->set & FB_CUR_SETCMAP) {
    836 		int i;
    837 
    838 		agten_write_idx(sc, IBM561_CURSOR_LUT + cur->cmap.index + 2);
    839 		for (i = 0; i < cur->cmap.count; i++) {
    840 			agten_write_dac(sc, IBM561_CMD_CMAP, cur->cmap.red[i]);
    841 			agten_write_dac(sc, IBM561_CMD_CMAP,
    842 			    cur->cmap.green[i]);
    843 			agten_write_dac(sc, IBM561_CMD_CMAP, cur->cmap.blue[i]);
    844 		}
    845 	}
    846 	if (cur->set & FB_CUR_SETSHAPE) {
    847 		int i;
    848 		uint16_t tmp;
    849 
    850 		agten_write_idx(sc, IBM561_CURSOR_BITMAP);
    851 		for (i = 0; i < 512; i++) {
    852 			tmp = util_interleave_lin(cur->mask[i], cur->image[i]);
    853 			agten_write_dac(sc, IBM561_CMD, (tmp >> 8) & 0xff);
    854 			agten_write_dac(sc, IBM561_CMD, tmp & 0xff);
    855 		}
    856 	}
    857 	return 0;
    858 }
    859 
    860 uint16_t
    861 util_interleave(uint8_t b1, uint8_t b2)
    862 {
    863 	int i;
    864 	uint16_t ret = 0;
    865 	uint16_t mask = 0x8000;
    866 	uint8_t mask8 = 0x01;
    867 
    868 	for (i = 0; i < 8; i++) {
    869 		if (b1 & mask8)
    870 			ret |= mask;
    871 		mask = mask >> 1;
    872 		if (b2 & mask8)
    873 			ret |= mask;
    874 		mask = mask >> 1;
    875 		mask8 = mask8 << 1;
    876 	}
    877 	return ret;
    878 }
    879 
    880 uint16_t
    881 util_interleave_lin(uint8_t b1, uint8_t b2)
    882 {
    883 	int i;
    884 	uint16_t ret = 0;
    885 	uint16_t mask = 0x8000;
    886 	uint8_t mask8 = 0x80;
    887 
    888 	for (i = 0; i < 8; i++) {
    889 		if (b1 & mask8)
    890 			ret |= mask;
    891 		mask = mask >> 1;
    892 		if (b2 & mask8)
    893 			ret |= mask;
    894 		mask = mask >> 1;
    895 		mask8 = mask8 >> 1;
    896 	}
    897 	return ret;
    898 }
    899 
    900 /* and now the /dev/fb* stuff */
    901 static void
    902 agten_fb_unblank(device_t dev)
    903 {
    904 	struct agten_softc *sc = device_private(dev);
    905 
    906 	agten_init(sc);
    907 	agten_set_video(sc, 1);
    908 }
    909 
    910 static int
    911 agten_fb_open(dev_t dev, int flags, int mode, struct lwp *l)
    912 {
    913 	struct agten_softc *sc = device_private(agten_cd.cd_devs[minor(dev)]);
    914 	int unit = minor(dev);
    915 
    916 	if (unit >= agten_cd.cd_ndevs || agten_cd.cd_devs[unit] == NULL)
    917 		return (ENXIO);
    918 	if (sc->sc_fb_is_open)
    919 		return 0;
    920 
    921 	sc->sc_fb_is_open++;
    922 	agten_gfx(sc);
    923 
    924 	return (0);
    925 }
    926 
    927 static int
    928 agten_fb_close(dev_t dev, int flags, int mode, struct lwp *l)
    929 {
    930 	struct agten_softc *sc = device_private(agten_cd.cd_devs[minor(dev)]);
    931 
    932 	sc->sc_fb_is_open--;
    933 	if (sc->sc_fb_is_open < 0)
    934 		sc->sc_fb_is_open = 0;
    935 
    936 	if (sc->sc_fb_is_open == 0) {
    937 		agten_init(sc);
    938 		vcons_redraw_screen(sc->vd.active);
    939 	}
    940 
    941 	return (0);
    942 }
    943 
    944 static int
    945 agten_fb_ioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
    946 {
    947 	struct agten_softc *sc = device_private(agten_cd.cd_devs[minor(dev)]);
    948 	struct fbgattr *fba;
    949 	int error;
    950 
    951 	switch (cmd) {
    952 
    953 	case FBIOGTYPE:
    954 		*(struct fbtype *)data = sc->sc_fb.fb_type;
    955 		break;
    956 
    957 	case FBIOGATTR:
    958 		fba = (struct fbgattr *)data;
    959 		fba->real_type = sc->sc_fb.fb_type.fb_type;
    960 		fba->owner = 0;		/* XXX ??? */
    961 		fba->fbtype = sc->sc_fb.fb_type;
    962 		fba->sattr.flags = 0;
    963 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
    964 		fba->sattr.dev_specific[0] = -1;
    965 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
    966 		fba->emu_types[1] = -1;
    967 		break;
    968 
    969 	case FBIOGETCMAP:
    970 #define p ((struct fbcmap *)data)
    971 		return (bt_getcmap(p, &sc->sc_cmap, 256, 1));
    972 
    973 	case FBIOPUTCMAP:
    974 		/* copy to software map */
    975 		error = bt_putcmap(p, &sc->sc_cmap, 256, 1);
    976 		if (error)
    977 			return (error);
    978 		/* now blast them into the chip */
    979 		/* don't bother - we're 24bit */
    980 #undef p
    981 		break;
    982 
    983 	case FBIOGVIDEO:
    984 		*(int *)data = agten_get_video(sc);
    985 		break;
    986 
    987 	case FBIOSVIDEO:
    988 		agten_set_video(sc, *(int *)data);
    989 		break;
    990 
    991 /* these are for both FBIOSCURSOR and FBIOGCURSOR */
    992 #define p ((struct fbcursor *)data)
    993 #define pc (&sc->sc_cursor)
    994 
    995 	case FBIOGCURSOR:
    996 		/* does anyone use this ioctl?! */
    997 		p->set = FB_CUR_SETALL;	/* close enough, anyway */
    998 		p->enable = 1;
    999 		p->pos.x = sc->sc_cursor_x;
   1000 		p->pos.y = sc->sc_cursor_y;
   1001 		p->size.x = 64;
   1002 		p->size.y = 64;
   1003 		break;
   1004 
   1005 	case FBIOSCURSOR:
   1006 		agten_do_sun_cursor(sc, p);
   1007 	break;
   1008 
   1009 #undef p
   1010 #undef cc
   1011 
   1012 	case FBIOGCURPOS:
   1013 	{
   1014 		struct fbcurpos *cp = (struct fbcurpos *)data;
   1015 		cp->x = sc->sc_cursor_x;
   1016 		cp->y = sc->sc_cursor_y;
   1017 	}
   1018 	break;
   1019 
   1020 	case FBIOSCURPOS:
   1021 	{
   1022 		struct fbcurpos *cp = (struct fbcurpos *)data;
   1023 		agten_move_cursor(sc, cp->x, cp->y);
   1024 	}
   1025 	break;
   1026 
   1027 	case FBIOGCURMAX:
   1028 		/* max cursor size is 64x64 */
   1029 		((struct fbcurpos *)data)->x = 64;
   1030 		((struct fbcurpos *)data)->y = 64;
   1031 		break;
   1032 
   1033 	default:
   1034 		return (ENOTTY);
   1035 	}
   1036 	return (0);
   1037 }
   1038 
   1039 static paddr_t
   1040 agten_fb_mmap(dev_t dev, off_t off, int prot)
   1041 {
   1042 	struct agten_softc *sc = device_private(agten_cd.cd_devs[minor(dev)]);
   1043 
   1044 	/*
   1045 	 * mappings are subject to change
   1046 	 * for now we put the framebuffer at offset 0 and the GLint registers
   1047 	 * right after that. We may want to expose more register ranges and
   1048 	 * probably will want to map the 2nd framebuffer as well
   1049 	 */
   1050 
   1051 	if (off < 0)
   1052 		return EINVAL;
   1053 
   1054 	if (off >= sc->sc_glint_fbsz + 0x10000)
   1055 		return EINVAL;
   1056 
   1057 	if (off < sc->sc_glint_fbsz) {
   1058 		return (bus_space_mmap(sc->sc_bustag,
   1059 			sc->sc_glint_fb,
   1060 			off,
   1061 			prot,
   1062 			BUS_SPACE_MAP_LINEAR));
   1063 	}
   1064 
   1065 	off -= sc->sc_glint_fbsz;
   1066 	if (off < 0x10000) {
   1067 		return (bus_space_mmap(sc->sc_bustag,
   1068 			sc->sc_glint_regs,
   1069 			off,
   1070 			prot,
   1071 			BUS_SPACE_MAP_LINEAR));
   1072 	}
   1073 	return EINVAL;
   1074 }
   1075