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