xref: /netbsd-src/sys/dev/sbus/tcx.c (revision b7b7574d3bf8eeb51a1fa3977b59142ec6434a55)
1 /*	$NetBSD: tcx.c,v 1.52 2014/06/24 05:04:14 macallan Exp $ */
2 
3 /*
4  *  Copyright (c) 1996, 1998, 2009 The NetBSD Foundation, Inc.
5  *  All rights reserved.
6  *
7  *  This code is derived from software contributed to The NetBSD Foundation
8  *  by Paul Kranenburg and Michael Lorenz.
9  *
10  *  Redistribution and use in source and binary forms, with or without
11  *  modification, are permitted provided that the following conditions
12  *  are met:
13  *  1. Redistributions of source code must retain the above copyright
14  *     notice, this list of conditions and the following disclaimer.
15  *  2. Redistributions in binary form must reproduce the above copyright
16  *     notice, this list of conditions and the following disclaimer in the
17  *     documentation and/or other materials provided with the distribution.
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 /*
33  * color display (TCX) driver.
34  *
35  * Does not handle interrupts, even though they can occur.
36  *
37  * XXX should defer colormap updates to vertical retrace interrupts
38  */
39 
40 #include <sys/cdefs.h>
41 __KERNEL_RCSID(0, "$NetBSD: tcx.c,v 1.52 2014/06/24 05:04:14 macallan Exp $");
42 
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/buf.h>
46 #include <sys/device.h>
47 #include <sys/ioctl.h>
48 #include <sys/malloc.h>
49 #include <sys/mman.h>
50 #include <sys/tty.h>
51 #include <sys/conf.h>
52 
53 #ifdef DEBUG
54 #include <sys/proc.h>
55 #include <sys/syslog.h>
56 #endif
57 
58 #include <sys/bus.h>
59 #include <machine/autoconf.h>
60 
61 #include <dev/sun/fbio.h>
62 #include <dev/sun/fbvar.h>
63 #include <dev/sun/btreg.h>
64 #include <dev/sun/btvar.h>
65 
66 #include <dev/sbus/sbusvar.h>
67 #include <dev/sbus/tcxreg.h>
68 
69 #include <dev/wscons/wsdisplayvar.h>
70 #include <dev/wscons/wsconsio.h>
71 #include <dev/wsfont/wsfont.h>
72 #include <dev/rasops/rasops.h>
73 
74 #include <dev/wscons/wsdisplay_vconsvar.h>
75 
76 #include "opt_wsemul.h"
77 
78 #include "ioconf.h"
79 
80 /* per-display variables */
81 struct tcx_softc {
82 	device_t	sc_dev;		/* base device */
83 	struct fbdevice	sc_fb;		/* frame buffer device */
84 	bus_space_tag_t	sc_bustag;
85 	struct openprom_addr sc_physaddr[TCX_NREG];/* phys addr of h/w */
86 
87 	bus_space_handle_t sc_bt;	/* Brooktree registers */
88 	bus_space_handle_t sc_thc;	/* THC registers */
89 	uint8_t 	*sc_fbaddr;	/* framebuffer */
90 	uint64_t 	*sc_rblit;	/* blitspace */
91 	uint64_t 	*sc_rstip;	/* stipple space */
92 
93 	short		sc_8bit;	/* true if 8-bit hardware */
94 	short		sc_blanked;	/* true if blanked */
95 	uint32_t	sc_fbsize;	/* size of the 8bit fb */
96 	u_char		sc_cmap_red[256];
97 	u_char		sc_cmap_green[256];
98 	u_char		sc_cmap_blue[256];
99 	int 		sc_mode, sc_bg;
100 	int		sc_cursor_x, sc_cursor_y;
101 	int		sc_hotspot_x, sc_hotspot_y;
102 	struct vcons_data vd;
103 };
104 
105 static struct vcons_screen tcx_console_screen;
106 
107 extern const u_char rasops_cmap[768];
108 
109 struct wsscreen_descr tcx_defscreendesc = {
110 	"default",
111 	0, 0,
112 	NULL,
113 	8, 16,
114 	WSSCREEN_WSCOLORS,
115 };
116 
117 const struct wsscreen_descr *_tcx_scrlist[] = {
118 	&tcx_defscreendesc,
119 	/* XXX other formats, graphics screen? */
120 };
121 
122 struct wsscreen_list tcx_screenlist = {
123 	sizeof(_tcx_scrlist) / sizeof(struct wsscreen_descr *),
124 	_tcx_scrlist
125 };
126 
127 /*
128  * The S24 provides the framebuffer RAM mapped in three ways:
129  * 26 bits per pixel, in 32-bit words; the low-order 24 bits are
130  * blue, green, and red values, and the other two bits select the
131  * display modes, per pixel);
132  * 24 bits per pixel, in 32-bit words; the high-order byte reads as
133  * zero, and is ignored on writes (so the mode bits cannot be altered);
134  * 8 bits per pixel, unpadded; writes to this space do not modify the
135  * other 18 bits.
136  */
137 #define TCX_CTL_8_MAPPED	0x00000000	/* 8 bits, uses color map */
138 #define TCX_CTL_24_MAPPED	0x01000000	/* 24 bits, uses color map */
139 #define TCX_CTL_24_LEVEL	0x03000000	/* 24 bits, ignores color map */
140 #define TCX_CTL_PIXELMASK	0x00FFFFFF	/* mask for index/level */
141 
142 /*
143  * differences between S24 and tcx, as far as this driver is concerned:
144  * - S24 has 4MB VRAM, 24bit + 2bit control planes, no expansion possible
145  * - tcx has 1MB VRAM, 8bit, no control planes, may have a VSIMM toat bumps
146  *   VRAM to 2MB
147  * - tcx can apply ROPs to STIP operations, unlike S24
148  * - tcx has a Bt458 DAC, just like CG6. S24 has an AT&T 20C567
149  */
150 
151 /* autoconfiguration driver */
152 static void	tcxattach(device_t, device_t, void *);
153 static int	tcxmatch(device_t, cfdata_t, void *);
154 static void	tcx_unblank(device_t);
155 
156 CFATTACH_DECL_NEW(tcx, sizeof(struct tcx_softc),
157     tcxmatch, tcxattach, NULL, NULL);
158 
159 dev_type_open(tcxopen);
160 dev_type_close(tcxclose);
161 dev_type_ioctl(tcxioctl);
162 dev_type_mmap(tcxmmap);
163 
164 const struct cdevsw tcx_cdevsw = {
165 	.d_open = tcxopen,
166 	.d_close = tcxclose,
167 	.d_read = noread,
168 	.d_write = nowrite,
169 	.d_ioctl = tcxioctl,
170 	.d_stop = nostop,
171 	.d_tty = notty,
172 	.d_poll = nopoll,
173 	.d_mmap = tcxmmap,
174 	.d_kqfilter = nokqfilter,
175 	.d_flag = 0
176 };
177 
178 /* frame buffer generic driver */
179 static struct fbdriver tcx_fbdriver = {
180 	tcx_unblank, tcxopen, tcxclose, tcxioctl, nopoll, tcxmmap,
181 	nokqfilter
182 };
183 
184 static void tcx_reset(struct tcx_softc *);
185 static void tcx_loadcmap(struct tcx_softc *, int, int);
186 
187 static int	tcx_ioctl(void *, void *, u_long, void *, int, struct lwp *);
188 static paddr_t	tcx_mmap(void *, void *, off_t, int);
189 
190 static void	tcx_init_screen(void *, struct vcons_screen *, int, long *);
191 static void	tcx_clearscreen(struct tcx_softc *, int);
192 static void	tcx_copyrows(void *, int, int, int);
193 static void	tcx_eraserows(void *, int, int, long);
194 static void	tcx_putchar(void *, int, int, u_int, long);
195 static void	tcx_set_video(struct tcx_softc *, int);
196 static int	tcx_do_cursor(struct tcx_softc *, struct wsdisplay_cursor *);
197 static void	tcx_set_cursor(struct tcx_softc *);
198 
199 struct wsdisplay_accessops tcx_accessops = {
200 	tcx_ioctl,
201 	tcx_mmap,
202 	NULL,	/* vcons_alloc_screen */
203 	NULL,	/* vcons_free_screen */
204 	NULL,	/* vcons_show_screen */
205 	NULL,	/* load_font */
206 	NULL,	/* polls */
207 	NULL,	/* scroll */
208 };
209 
210 #define OBPNAME	"SUNW,tcx"
211 
212 /*
213  * Match a tcx.
214  */
215 int
216 tcxmatch(device_t parent, cfdata_t cf, void *aux)
217 {
218 	struct sbus_attach_args *sa = aux;
219 
220 	if (strcmp(sa->sa_name, OBPNAME) == 0)
221 		return 100;	/* beat genfb */
222 	return 0;
223 }
224 
225 /*
226  * Attach a display.
227  */
228 void
229 tcxattach(device_t parent, device_t self, void *args)
230 {
231 	struct tcx_softc *sc = device_private(self);
232 	struct sbus_attach_args *sa = args;
233 	struct wsemuldisplaydev_attach_args aa;
234 	struct rasops_info *ri;
235 	unsigned long defattr;
236 	int node;
237 	struct fbdevice *fb = &sc->sc_fb;
238 	bus_space_handle_t bh;
239 	int isconsole, i, j;
240 	uint32_t confreg;
241 
242 	sc->sc_dev = self;
243 	sc->sc_bustag = sa->sa_bustag;
244 	node = sa->sa_node;
245 
246 	sc->sc_cursor_x = 0x7fff;
247 	sc->sc_cursor_y = 0x7fff;
248 	sc->sc_hotspot_x = 0;
249 	sc->sc_hotspot_y = 0;
250 
251 	fb->fb_driver = &tcx_fbdriver;
252 	fb->fb_device = sc->sc_dev;
253 	/* Mask out invalid flags from the user. */
254 	fb->fb_flags = device_cfdata(sc->sc_dev)->cf_flags & FB_USERMASK;
255 	/*
256 	 * The onboard framebuffer on the SS4 supports only 8-bit mode;
257 	 * it can be distinguished from the S24 card for the SS5 by the
258 	 * presence of the "tcx-8-bit" attribute on the SS4 version.
259 	 */
260 	sc->sc_8bit = node_has_property(node, "tcx-8-bit");
261 	fb->fb_type.fb_depth = 8;
262 	fb_setsize_obp(fb, fb->fb_type.fb_depth, 1152, 900, node);
263 
264 	/*
265 	 * actual FB size ( of the 8bit region )
266 	 * no need to restrict userland mappings to the visible VRAM
267 	 */
268 	if (sc->sc_8bit) {
269 		aprint_normal(" (8-bit only TCX)\n");
270 		/* at least the SS4 can have 2MB with a VSIMM */
271 		sc->sc_fbsize = 0x100000 * prom_getpropint(node, "vram", 1);
272 	} else {
273 		aprint_normal(" (S24)\n");
274 		/* all S24 I know of have 4MB, non-expandable */
275 		sc->sc_fbsize = 0x100000;
276 	}
277 
278 	fb->fb_type.fb_cmsize = 256;
279 	fb->fb_type.fb_size = sc->sc_fbsize;	/* later code assumes 8bit */
280 	aprint_normal_dev(self, "%s, %d x %d\n", OBPNAME,
281 		fb->fb_type.fb_width,
282 		fb->fb_type.fb_height);
283 
284 	fb->fb_type.fb_type = FBTYPE_TCXCOLOR;
285 
286 	if (sa->sa_nreg != TCX_NREG) {
287 		aprint_error("\n");
288 		aprint_error_dev(self, "only %d register sets\n",
289 			sa->sa_nreg);
290 		return;
291 	}
292 	if (sa->sa_reg[TCX_REG_STIP].oa_size < 0x1000) {
293 		aprint_error("\n");
294 		aprint_error_dev(self, "STIP register too small (0x%x)\n",
295 		    sa->sa_reg[TCX_REG_STIP].oa_size);
296 		return;
297 	}
298 
299 	memcpy(sc->sc_physaddr, sa->sa_reg,
300 	      sa->sa_nreg * sizeof(struct openprom_addr));
301 
302 	/* Map the register banks we care about */
303 	if (sbus_bus_map(sa->sa_bustag,
304 			 sc->sc_physaddr[TCX_REG_THC].oa_space,
305 			 sc->sc_physaddr[TCX_REG_THC].oa_base,
306 			 0x1000,
307 			 BUS_SPACE_MAP_LINEAR, &sc->sc_thc) != 0) {
308 		aprint_error_dev(self,
309 		    "tcxattach: cannot map thc registers\n");
310 		return;
311 	}
312 
313 	if (sbus_bus_map(sa->sa_bustag,
314 			 sc->sc_physaddr[TCX_REG_CMAP].oa_space,
315 			 sc->sc_physaddr[TCX_REG_CMAP].oa_base,
316 			 0x1000,
317 			 BUS_SPACE_MAP_LINEAR, &sc->sc_bt) != 0) {
318 		aprint_error_dev(self, "tcxattach: cannot map DAC registers\n");
319 		return;
320 	}
321 
322 	/* map the 8bit dumb FB for the console */
323 	if (sbus_bus_map(sa->sa_bustag,
324 		 sc->sc_physaddr[TCX_REG_DFB8].oa_space,
325 		 sc->sc_physaddr[TCX_REG_DFB8].oa_base,
326 			 sc->sc_fbsize,
327 			 BUS_SPACE_MAP_LINEAR,
328 			 &bh) != 0) {
329 		aprint_error_dev(self, "tcxattach: cannot map framebuffer\n");
330 		return;
331 	}
332 	sc->sc_fbaddr = bus_space_vaddr(sa->sa_bustag, bh);
333 
334 	/*
335 	 * 8bit tcx has the RSTIP and RBLIT ranges set to size 0.
336 	 * On Real Hardware they work anyway ( on my SS4 at least ) but
337 	 * emulators may not be so forgiving.
338 	 */
339 	if (sc->sc_8bit) {
340 		/* BLIT space */
341 		if (sbus_bus_map(sa->sa_bustag,
342 			 sc->sc_physaddr[TCX_REG_BLIT].oa_space,
343 			 sc->sc_physaddr[TCX_REG_BLIT].oa_base,
344 				 sc->sc_fbsize << 3,
345 				 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
346 				 &bh) != 0) {
347 			aprint_error_dev(self,
348 			    "tcxattach: cannot map BLIT space\n");
349 			return;
350 		}
351 		sc->sc_rblit = bus_space_vaddr(sa->sa_bustag, bh);
352 
353 		/* STIP space */
354 		if (sbus_bus_map(sa->sa_bustag,
355 			 sc->sc_physaddr[TCX_REG_STIP].oa_space,
356 			 sc->sc_physaddr[TCX_REG_STIP].oa_base,
357 				 sc->sc_fbsize << 3,
358 				 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
359 				 &bh) != 0) {
360 			aprint_error_dev(self,
361 			    "tcxattach: cannot map STIP space\n");
362 			return;
363 		}
364 		sc->sc_rstip = bus_space_vaddr(sa->sa_bustag, bh);
365 	} else {
366 		/* RBLIT space */
367 		if (sbus_bus_map(sa->sa_bustag,
368 			 sc->sc_physaddr[TCX_REG_RBLIT].oa_space,
369 			 sc->sc_physaddr[TCX_REG_RBLIT].oa_base,
370 				 sc->sc_fbsize << 3,
371 				 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
372 				 &bh) != 0) {
373 			aprint_error_dev(self,
374 			    "tcxattach: cannot map RBLIT space\n");
375 			return;
376 		}
377 		sc->sc_rblit = bus_space_vaddr(sa->sa_bustag, bh);
378 
379 		/* RSTIP space */
380 		if (sbus_bus_map(sa->sa_bustag,
381 			 sc->sc_physaddr[TCX_REG_RSTIP].oa_space,
382 			 sc->sc_physaddr[TCX_REG_RSTIP].oa_base,
383 				 sc->sc_fbsize << 3,
384 				 BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
385 				 &bh) != 0) {
386 			aprint_error_dev(self,
387 			    "tcxattach: cannot map RSTIP space\n");
388 			return;
389 		}
390 		sc->sc_rstip = bus_space_vaddr(sa->sa_bustag, bh);
391 	}
392 	isconsole = fb_is_console(node);
393 
394 	confreg = bus_space_read_4(sa->sa_bustag, sc->sc_thc, THC_CONFIG);
395 	aprint_normal_dev(self, "id %d, rev %d, sense %d\n",
396 		(confreg & THC_CFG_FBID) >> THC_CFG_FBID_SHIFT,
397 		(confreg & THC_CFG_REV) >> THC_CFG_REV_SHIFT,
398 		(confreg & THC_CFG_SENSE) >> THC_CFG_SENSE_SHIFT
399 	);
400 
401 	/* reset cursor & frame buffer controls */
402 	tcx_reset(sc);
403 
404 	/* Initialize the default color map. */
405 	j = 0;
406 	for (i = 0; i < 256; i++) {
407 
408 		sc->sc_cmap_red[i] = rasops_cmap[j];
409 		sc->sc_cmap_green[i] = rasops_cmap[j + 1];
410 		sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
411 		j += 3;
412 	}
413 	tcx_loadcmap(sc, 0, 256);
414 
415 	if (!sc->sc_8bit)
416 	    tcx_set_cursor(sc);
417 
418 	/* enable video */
419 	confreg = bus_space_read_4(sa->sa_bustag, sc->sc_thc, THC_MISC);
420 	confreg |= THC_MISC_VIDEN;
421 	bus_space_write_4(sa->sa_bustag, sc->sc_thc, THC_MISC, confreg);
422 
423 	if (isconsole) {
424 		aprint_error_dev(self, "(console)\n");
425 	}
426 
427 	fb_attach(&sc->sc_fb, isconsole);
428 
429 	sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
430 	wsfont_init();
431 
432 	vcons_init(&sc->vd, sc, &tcx_defscreendesc, &tcx_accessops);
433 	sc->vd.init_screen = tcx_init_screen;
434 
435 	vcons_init_screen(&sc->vd, &tcx_console_screen, 1, &defattr);
436 	tcx_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
437 
438 	ri = &tcx_console_screen.scr_ri;
439 
440 	sc->sc_bg = ri->ri_devcmap[(defattr >> 16) & 0xff];
441 	tcx_clearscreen(sc, 0);
442 
443 	tcx_defscreendesc.nrows = ri->ri_rows;
444 	tcx_defscreendesc.ncols = ri->ri_cols;
445 	tcx_defscreendesc.textops = &ri->ri_ops;
446 	tcx_defscreendesc.capabilities = ri->ri_caps;
447 
448 	if(isconsole) {
449 		wsdisplay_cnattach(&tcx_defscreendesc, ri, 0, 0, defattr);
450 		vcons_replay_msgbuf(&tcx_console_screen);
451 	}
452 
453 	aa.console = isconsole;
454 	aa.scrdata = &tcx_screenlist;
455 	aa.accessops = &tcx_accessops;
456 	aa.accesscookie = &sc->vd;
457 
458 	config_found(self, &aa, wsemuldisplaydevprint);
459 	/*
460 	 * we need to do this again - something overwrites a handful
461 	 * palette registers and we end up with white in reg. 0
462 	 */
463 	tcx_loadcmap(sc, 0, 256);
464 }
465 
466 int
467 tcxopen(dev_t dev, int flags, int mode, struct lwp *l)
468 {
469 	return (0);
470 }
471 
472 int
473 tcxclose(dev_t dev, int flags, int mode, struct lwp *l)
474 {
475 	struct tcx_softc *sc = device_lookup_private(&tcx_cd, minor(dev));
476 
477 	tcx_reset(sc);
478 	/* we may want to clear and redraw the console here */
479 	return (0);
480 }
481 
482 int
483 tcxioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
484 {
485 	struct tcx_softc *sc = device_lookup_private(&tcx_cd, minor(dev));
486 
487 	switch (cmd) {
488 
489 	case FBIOGTYPE:
490 		*(struct fbtype *)data = sc->sc_fb.fb_type;
491 		break;
492 
493 	case FBIOGATTR:
494 #define fba ((struct fbgattr *)data)
495 		fba->real_type = sc->sc_fb.fb_type.fb_type;
496 		fba->owner = 0;		/* XXX ??? */
497 		fba->fbtype = sc->sc_fb.fb_type;
498 		fba->sattr.flags = 0;
499 		fba->sattr.emu_type = sc->sc_fb.fb_type.fb_type;
500 		fba->sattr.dev_specific[0] = -1;
501 		fba->emu_types[0] = sc->sc_fb.fb_type.fb_type;
502 		fba->emu_types[1] = FBTYPE_SUN3COLOR;
503 		fba->emu_types[2] = -1;
504 #undef fba
505 		break;
506 
507 	case FBIOGETCMAP:
508 #define	p ((struct fbcmap *)data)
509 		if (copyout(&sc->sc_cmap_red[p->index], p->red, p->count) != 0)
510 			return EINVAL;
511 		if (copyout(&sc->sc_cmap_green[p->index], p->green, p->count)
512 		    != 0)
513 			return EINVAL;
514 		if (copyout(&sc->sc_cmap_blue[p->index], p->blue, p->count)
515 		    != 0)
516 			return EINVAL;
517 		return 0;
518 
519 	case FBIOPUTCMAP:
520 		/* copy to software map */
521 		if (copyin(p->red, &sc->sc_cmap_red[p->index], p->count) != 0)
522 			return EINVAL;
523 		if (copyin(p->green, &sc->sc_cmap_green[p->index], p->count)
524 		    != 0)
525 			return EINVAL;
526 		if (copyin(p->blue, &sc->sc_cmap_blue[p->index], p->count) != 0)
527 			return EINVAL;
528 		tcx_loadcmap(sc, p->index, p->count);
529 #undef p
530 		break;
531 	case FBIOGVIDEO:
532 		*(int *)data = sc->sc_blanked;
533 		break;
534 
535 	case FBIOSVIDEO:
536 		tcx_set_video(sc, *(int *)data);
537 		break;
538 
539 	default:
540 #ifdef DEBUG
541 		log(LOG_NOTICE, "tcxioctl(0x%lx) (%s[%d])\n", cmd,
542 		    l->l_proc->p_comm, l->l_proc->p_pid);
543 #endif
544 		return (ENOTTY);
545 	}
546 	return (0);
547 }
548 
549 /*
550  * Clean up hardware state (e.g., after bootup or after X crashes).
551  */
552 static void
553 tcx_reset(struct tcx_softc *sc)
554 {
555 	uint32_t reg;
556 
557 	reg = bus_space_read_4(sc->sc_bustag, sc->sc_thc, THC_MISC);
558 	reg |= THC_MISC_CURSRES;
559 	bus_space_write_4(sc->sc_bustag, sc->sc_thc, THC_MISC, reg);
560 }
561 
562 static void
563 tcx_loadcmap(struct tcx_softc *sc, int start, int ncolors)
564 {
565 	int i;
566 
567 	for (i = 0; i < ncolors; i++) {
568 		bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_ADDRESS,
569 		    (start + i) << 24);
570 		bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_FB_LUT,
571 		    sc->sc_cmap_red[i + start] << 24);
572 		bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_FB_LUT,
573 		    sc->sc_cmap_green[i + start] << 24);
574 		bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_FB_LUT,
575 		    sc->sc_cmap_blue[i + start] << 24);
576 	}
577 	bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_ADDRESS, 0);
578 }
579 
580 static void
581 tcx_unblank(device_t dev)
582 {
583 	struct tcx_softc *sc = device_private(dev);
584 
585 	if (sc->sc_blanked) {
586 		uint32_t reg;
587 		sc->sc_blanked = 0;
588 		reg = bus_space_read_4(sc->sc_bustag, sc->sc_thc, THC_MISC);
589 		reg &= ~THC_MISC_VSYNC_DISABLE;
590 		reg &= ~THC_MISC_HSYNC_DISABLE;
591 		reg |= THC_MISC_VIDEN;
592 		bus_space_write_4(sc->sc_bustag, sc->sc_thc, THC_MISC, reg);
593 	}
594 }
595 
596 static void
597 tcx_set_video(struct tcx_softc *sc, int unblank)
598 {
599 	uint32_t reg;
600 	if (unblank) {
601 		sc->sc_blanked = 0;
602 		reg = bus_space_read_4(sc->sc_bustag, sc->sc_thc, THC_MISC);
603 		reg &= ~THC_MISC_VSYNC_DISABLE;
604 		reg &= ~THC_MISC_HSYNC_DISABLE;
605 		reg |= THC_MISC_VIDEN;
606 		bus_space_write_4(sc->sc_bustag, sc->sc_thc, THC_MISC, reg);
607 	} else {
608 		sc->sc_blanked = 1;
609 		reg = bus_space_read_4(sc->sc_bustag, sc->sc_thc, THC_MISC);
610 		reg |= THC_MISC_VSYNC_DISABLE;
611 		reg |= THC_MISC_HSYNC_DISABLE;
612 		reg &= ~THC_MISC_VIDEN;
613 		bus_space_write_4(sc->sc_bustag, sc->sc_thc, THC_MISC, reg);
614 	}
615 }
616 
617 /*
618  * Base addresses at which users can mmap() the various pieces of a tcx.
619  */
620 #define	TCX_USER_RAM	0x00000000
621 #define	TCX_USER_RAM24	0x01000000
622 #define	TCX_USER_RAM_COMPAT	0x04000000	/* cg3 emulation */
623 #define	TCX_USER_STIP	0x10000000
624 #define	TCX_USER_BLIT	0x20000000
625 #define	TCX_USER_RDFB32	0x28000000
626 #define	TCX_USER_RSTIP	0x30000000
627 #define	TCX_USER_RBLIT	0x38000000
628 #define	TCX_USER_TEC	0x70001000
629 #define	TCX_USER_BTREGS	0x70002000
630 #define	TCX_USER_THC	0x70004000
631 #define	TCX_USER_DHC	0x70008000
632 #define	TCX_USER_ALT	0x7000a000
633 #define	TCX_USER_UART	0x7000c000
634 #define	TCX_USER_VRT	0x7000e000
635 #define	TCX_USER_ROM	0x70010000
636 
637 struct mmo {
638 	u_int	mo_uaddr;	/* user (virtual) address */
639 	u_int	mo_size;	/* size, or 0 for video ram size */
640 	u_int	mo_bank;	/* register bank number */
641 };
642 
643 /*
644  * Return the address that would map the given device at the given
645  * offset, allowing for the given protection, or return -1 for error.
646  *
647  * XXX	needs testing against `demanding' applications (e.g., aviator)
648  */
649 paddr_t
650 tcxmmap(dev_t dev, off_t off, int prot)
651 {
652 	struct tcx_softc *sc = device_lookup_private(&tcx_cd, minor(dev));
653 	struct openprom_addr *rr = sc->sc_physaddr;
654 	struct mmo *mo, *mo_end;
655 	u_int u, sz;
656 	static struct mmo mmo[] = {
657 		{ TCX_USER_RAM, 0, TCX_REG_DFB8 },
658 		{ TCX_USER_RAM24, 0, TCX_REG_DFB24 },
659 		{ TCX_USER_RAM_COMPAT, 0, TCX_REG_DFB8 },
660 
661 		{ TCX_USER_STIP, 1, TCX_REG_STIP },
662 		{ TCX_USER_BLIT, 1, TCX_REG_BLIT },
663 		{ TCX_USER_RDFB32, 0, TCX_REG_RDFB32 },
664 		{ TCX_USER_RSTIP, 1, TCX_REG_RSTIP },
665 		{ TCX_USER_RBLIT, 1, TCX_REG_RBLIT },
666 		{ TCX_USER_TEC, 1, TCX_REG_TEC },
667 		{ TCX_USER_BTREGS, 8192 /* XXX */, TCX_REG_CMAP },
668 		{ TCX_USER_THC, 0x2000, TCX_REG_THC },
669 		{ TCX_USER_DHC, 1, TCX_REG_DHC },
670 		{ TCX_USER_ALT, 1, TCX_REG_ALT },
671 		{ TCX_USER_ROM, 65536, TCX_REG_ROM },
672 	};
673 #define NMMO (sizeof mmo / sizeof *mmo)
674 
675 	if (off & PGOFSET)
676 		panic("tcxmmap");
677 
678 	/*
679 	 * Entries with size 0 map video RAM (i.e., the size in fb data).
680 	 * Entries that map 32-bit deep regions are adjusted for their
681 	 * depth (fb_size gives the size of the 8-bit-deep region).
682 	 *
683 	 * Since we work in pages, the fact that the map offset table's
684 	 * sizes are sometimes bizarre (e.g., 1) is effectively ignored:
685 	 * one byte is as good as one page.
686 	 */
687 
688 	mo = mmo;
689 	mo_end = &mmo[NMMO];
690 
691 	for (; mo < mo_end; mo++) {
692 		if ((u_int)off < mo->mo_uaddr)
693 			continue;
694 
695 		u = off - mo->mo_uaddr;
696 		sz = mo->mo_size;
697 
698 		if (sz == 0) {
699 			sz = sc->sc_fb.fb_type.fb_size;
700 			/*
701 			 * check for the 32-bit-deep regions and adjust
702 			 * accordingly
703 			 */
704 			if (mo->mo_uaddr == TCX_USER_RAM24 ||
705 			    mo->mo_uaddr == TCX_USER_RDFB32) {
706 				if (sc->sc_8bit) {
707 					/*
708 					 * not present on 8-bit hardware
709 					 */
710 					continue;
711 				}
712 				sz *= 4;
713 			}
714 		}
715 		if (sz == 1)
716 			sz = rr[mo->mo_bank].oa_size;
717 
718 		if (u < sz) {
719 			return (bus_space_mmap(sc->sc_bustag,
720 				BUS_ADDR(rr[mo->mo_bank].oa_space,
721 					 rr[mo->mo_bank].oa_base),
722 				u,
723 				prot,
724 				BUS_SPACE_MAP_LINEAR));
725 		}
726 	}
727 	return (-1);
728 }
729 
730 int
731 tcx_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
732 	struct lwp *l)
733 {
734 	struct vcons_data *vd = v;
735 	struct tcx_softc *sc = vd->cookie;
736 	struct wsdisplay_fbinfo *wdf;
737 	struct vcons_screen *ms = vd->active;
738 
739 	switch (cmd) {
740 		case WSDISPLAYIO_GTYPE:
741 			*(u_int *)data = WSDISPLAY_TYPE_SUNTCX;
742 			return 0;
743 
744 		case FBIOGVIDEO:
745 		case WSDISPLAYIO_GVIDEO:
746 			*(int *)data = !sc->sc_blanked;
747 			return 0;
748 
749 		case WSDISPLAYIO_SVIDEO:
750 		case FBIOSVIDEO:
751 			tcx_set_video(sc, *(int *)data);
752 			return 0;
753 
754 		case WSDISPLAYIO_GINFO:
755 			wdf = (void *)data;
756 			wdf->height = ms->scr_ri.ri_height;
757 			wdf->width = ms->scr_ri.ri_width;
758 			if (sc->sc_8bit) {
759 				wdf->depth = 8;
760 			} else {
761 				wdf->depth = 32;
762 			}
763 			wdf->cmsize = 256;
764 			return 0;
765 		case WSDISPLAYIO_LINEBYTES:
766 			{
767 				int *ret = (int *)data;
768 				*ret = sc->sc_8bit ? ms->scr_ri.ri_width :
769 				    ms->scr_ri.ri_width << 2;
770 			}
771 			return 0;
772 #if 0
773 		case WSDISPLAYIO_GETCMAP:
774 			return tcx_getcmap(sc, (struct wsdisplay_cmap *)data);
775 
776 		case WSDISPLAYIO_PUTCMAP:
777 			return tcx_putcmap(sc, (struct wsdisplay_cmap *)data);
778 #endif
779 		case WSDISPLAYIO_SMODE:
780 			{
781 				int new_mode = *(int*)data;
782 				if (new_mode != sc->sc_mode)
783 				{
784 					sc->sc_mode = new_mode;
785 					if (new_mode == WSDISPLAYIO_MODE_EMUL)
786 					{
787 						tcx_loadcmap(sc, 0, 256);
788 						tcx_clearscreen(sc, 0);
789 						vcons_redraw_screen(ms);
790 					} else if (!sc->sc_8bit)
791 						tcx_clearscreen(sc, 3);
792 				}
793 			}
794 			return 0;
795 
796 		case WSDISPLAYIO_GCURPOS:
797 			if (sc->sc_8bit) {
798 				return EOPNOTSUPP;
799 			} else {
800 				struct wsdisplay_curpos *cp = (void *)data;
801 
802 				cp->x = sc->sc_cursor_x;
803 				cp->y = sc->sc_cursor_y;
804 			}
805 			return 0;
806 
807 		case WSDISPLAYIO_SCURPOS:
808 			if (sc->sc_8bit) {
809 				return EOPNOTSUPP;
810 			} else {
811 				struct wsdisplay_curpos *cp = (void *)data;
812 
813 				sc->sc_cursor_x = cp->x;
814 				sc->sc_cursor_y = cp->y;
815 				tcx_set_cursor(sc);
816 			}
817 			return 0;
818 
819 		case WSDISPLAYIO_GCURMAX:
820 			if (sc->sc_8bit) {
821 				return EOPNOTSUPP;
822 			} else {
823 				struct wsdisplay_curpos *cp = (void *)data;
824 
825 				cp->x = 32;
826 				cp->y = 32;
827 			}
828 			return 0;
829 
830 		case WSDISPLAYIO_SCURSOR:
831 			if (sc->sc_8bit) {
832 				return EOPNOTSUPP;
833 			} else {
834 				struct wsdisplay_cursor *cursor = (void *)data;
835 
836 				return tcx_do_cursor(sc, cursor);
837 			}
838 	}
839 	return EPASSTHROUGH;
840 }
841 
842 static paddr_t
843 tcx_mmap(void *v, void *vs, off_t offset, int prot)
844 {
845 	struct vcons_data *vd = v;
846 	struct tcx_softc *sc = vd->cookie;
847 
848 	/* 'regular' framebuffer mmap()ing */
849 	if (sc->sc_8bit) {
850 		/* on 8Bit boards hand over the 8 bit aperture */
851 		if (offset > sc->sc_fbsize)
852 			return -1;
853 		return bus_space_mmap(sc->sc_bustag,
854 		    sc->sc_physaddr[TCX_REG_DFB8].oa_base + offset, 0, prot,
855 		    BUS_SPACE_MAP_LINEAR);
856 	} else {
857 		/* ... but if we have a 24bit aperture we use it */
858 		if (offset > sc->sc_fbsize * 4)
859 			return -1;
860 		return bus_space_mmap(sc->sc_bustag,
861 		    sc->sc_physaddr[TCX_REG_DFB24].oa_base + offset, 0, prot,
862 		    BUS_SPACE_MAP_LINEAR);
863 	}
864 	return -1;
865 }
866 
867 static void
868 tcx_init_screen(void *cookie, struct vcons_screen *scr,
869     int existing, long *defattr)
870 {
871 	struct tcx_softc *sc = cookie;
872 	struct rasops_info *ri = &scr->scr_ri;
873 
874 	ri->ri_depth = 8;
875 	ri->ri_width = sc->sc_fb.fb_type.fb_width;
876 	ri->ri_height = sc->sc_fb.fb_type.fb_height;
877 	ri->ri_stride = sc->sc_fb.fb_linebytes;
878 	ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
879 
880 	ri->ri_bits = sc->sc_fbaddr;
881 
882 	rasops_init(ri, 0, 0);
883 	ri->ri_caps = WSSCREEN_WSCOLORS;
884 	rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight,
885 		    ri->ri_width / ri->ri_font->fontwidth);
886 
887 	/* enable acceleration */
888 	ri->ri_ops.copyrows  = tcx_copyrows;
889 	ri->ri_ops.eraserows = tcx_eraserows;
890 	ri->ri_ops.putchar   = tcx_putchar;
891 #if 0
892 	ri->ri_ops.cursor    = tcx_cursor;
893 	ri->ri_ops.copycols  = tcx_copycols;
894 	ri->ri_ops.erasecols = tcx_erasecols;
895 #endif
896 }
897 
898 static void
899 tcx_clearscreen(struct tcx_softc *sc, int spc)
900 {
901 	/* ROP in the upper 4bit is necessary, tcx actually uses it */
902 	uint64_t bg = 0x30000000ffffffffLL;
903 	uint64_t spc64;
904 	int i, len;
905 
906 	bg |=  ((uint64_t)sc->sc_bg << 32);
907 	spc64 = (spc & 3) << 24;
908 	bg |= spc64;
909 
910 	len = sc->sc_fb.fb_type.fb_width * sc->sc_fb.fb_type.fb_height;
911 	for (i = 0; i < len; i += 32)
912 		sc->sc_rstip[i] = bg;
913 }
914 
915 static void
916 tcx_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
917 {
918 	struct rasops_info *ri = cookie;
919 	struct vcons_screen *scr = ri->ri_hw;
920 	struct tcx_softc *sc = scr->scr_cookie;
921 	int i, last, first, len, dest, leftover;
922 
923 	i = ri->ri_width * ri->ri_font->fontheight * nrows;
924 	len = i & 0xffffe0;
925 	leftover = i & 0x1f;
926 	if (srcrow < dstrow) {
927 		/* we must go bottom to top */
928 		first = ri->ri_width *
929 		    (ri->ri_font->fontheight * srcrow + ri->ri_yorigin);
930 		last = first + len;
931 		dest = ri->ri_width *
932 		    (ri->ri_font->fontheight * dstrow + ri->ri_yorigin) + len;
933 		if (leftover > 0) {
934 			sc->sc_rblit[dest + 32] =
935 			    (uint64_t)((leftover - 1) << 24) |
936 			    (uint64_t)(i + 32);
937 		}
938 		for (i = last; i >= first; i -= 32) {
939 			sc->sc_rblit[dest] = 0x300000001f000000LL | (uint64_t)i;
940 			dest -= 32;
941 		}
942 	} else {
943 		/* top to bottom */
944 		first = ri->ri_width *
945 		    (ri->ri_font->fontheight * srcrow + ri->ri_yorigin);
946 		dest = ri->ri_width *
947 		    (ri->ri_font->fontheight * dstrow + ri->ri_yorigin);
948 		last = first + len;
949 		for (i = first; i <= last; i+= 32) {
950 			sc->sc_rblit[dest] = 0x300000001f000000LL | (uint64_t)i;
951 			dest += 32;
952 		}
953 		if (leftover > 0) {
954 			sc->sc_rblit[dest] =
955 			    (uint64_t)((leftover - 1) << 24) | (uint64_t)i;
956 		}
957 	}
958 }
959 
960 static void
961 tcx_eraserows(void *cookie, int start, int nrows, long attr)
962 {
963 	struct rasops_info *ri = cookie;
964 	struct vcons_screen *scr = ri->ri_hw;
965 	struct tcx_softc *sc = scr->scr_cookie;
966 	uint64_t temp;
967 	int i, last, first, len, leftover;
968 
969 	i = ri->ri_width * ri->ri_font->fontheight * nrows;
970 	len = i & 0xffffe0;
971 	leftover = i & 0x1f;
972 	first = ri->ri_width *
973 	    (ri->ri_font->fontheight * start + ri->ri_yorigin);
974 	last = first + len;
975 	temp = 0x30000000ffffffffLL |
976 	    ((uint64_t)ri->ri_devcmap[(attr >> 16) & 0xff] << 32);
977 
978 	for (i = first; i <= last; i+= 32)
979 		sc->sc_rblit[i] = temp;
980 
981 	if (leftover > 0) {
982 		temp &= 0xffffffffffffffffLL << (32 - leftover);
983 		sc->sc_rblit[i] = temp;
984 	}
985 }
986 /*
987  * The stipple engine is 100% retarded. All drawing operations have to start
988  * at 32 pixel boundaries so we'll have to deal with characters being split.
989  */
990 
991 static void
992 tcx_putchar(void *cookie, int row, int col, u_int c, long attr)
993 {
994 	struct rasops_info *ri = cookie;
995 	struct wsdisplay_font *font = PICK_FONT(ri, c);
996 	struct vcons_screen *scr = ri->ri_hw;
997 	struct tcx_softc *sc = scr->scr_cookie;
998 	uint64_t bg, fg, temp, mask;
999 	int addr, i, uc, shift;
1000 	uint32_t fmask;
1001 	uint8_t *cdata;
1002 	uint16_t *wdata;
1003 
1004 	addr = ri->ri_xorigin + col * font->fontwidth +
1005 	    (ri->ri_yorigin + row * font->fontheight) * ri->ri_width;
1006 
1007 	/* check if the character is crossing a 32 pixel boundary */
1008 	if ((addr & 0xffffe0) ==
1009 	    ((addr + font->fontwidth - 1) & 0xffffe0)) {
1010 		/* phew, not split */
1011 		shift = addr & 0x1f;
1012 		addr &= 0xffffe0;
1013 		fmask = 0xffffffff >> (32 - font->fontwidth);
1014 		fmask = fmask << (32 - font->fontwidth - shift);
1015 		mask = fmask;
1016 		bg = 0x3000000000000000LL |
1017 		    ((uint64_t)ri->ri_devcmap[(attr >> 16) & 0xff] &
1018 		      0xff) << 32;
1019 		bg |= mask;
1020 		temp = 0x3000000000000000LL |
1021 		    ((uint64_t)ri->ri_devcmap[(attr >> 24) & 0xff] & 0xff) <<
1022 		    	32;
1023 		uc = c - font->firstchar;
1024 		cdata = (uint8_t *)font->data + uc * ri->ri_fontscale;
1025 
1026 		if (font->fontwidth < 9) {
1027 			/* byte by byte */
1028 			for (i = 0; i < font->fontheight; i++) {
1029 				sc->sc_rstip[addr] = bg;
1030 				if (*cdata != 0) {
1031 					if (shift > 24) {
1032 						fg = (uint64_t)*cdata >>
1033 					  	  (shift - 24);
1034 					} else {
1035 						fg = (uint64_t)*cdata <<
1036 					  	  (24 - shift);
1037 					}
1038 					sc->sc_rstip[addr] = fg | temp;
1039 				}
1040 				cdata++;
1041 				addr += ri->ri_width;
1042 			}
1043 		} else if (font->fontwidth < 17) {
1044 			/* short by short */
1045 			wdata = (uint16_t *)cdata;
1046 			for (i = 0; i < font->fontheight; i++) {
1047 				sc->sc_rstip[addr] = bg;
1048 				if (*wdata != 0) {
1049 					if (shift > 16) {
1050 						fg = temp | (uint64_t)*wdata >>
1051 					  	  (shift - 16);
1052 					} else {
1053 						fg = temp | (uint64_t)*wdata <<
1054 					  	  (16 - shift);
1055 					}
1056 					sc->sc_rstip[addr] = fg;
1057 				}
1058 				wdata++;
1059 				addr += ri->ri_width;
1060 			}
1061 		}
1062 	} else {
1063 		/* and now the split case ( man this hardware is dumb ) */
1064 		uint64_t bgr, maskr, fgr;
1065 		uint32_t bork;
1066 
1067 		shift = addr & 0x1f;
1068 		addr &= 0xffffe0;
1069 		mask = 0xffffffff >> shift;
1070 		maskr = (uint64_t)(0xffffffffUL <<
1071 		    (32 - (font->fontwidth + shift - 32)));
1072 		bg = 0x3000000000000000LL |
1073 		    ((uint64_t)ri->ri_devcmap[(attr >> 16) & 0xff] &
1074 		      0xff) << 32;
1075 		bgr = bg | maskr;
1076 		bg |= mask;
1077 		temp = 0x3000000000000000LL |
1078 		    ((uint64_t)ri->ri_devcmap[(attr >> 24) & 0xff] & 0xff) <<
1079 		      32;
1080 
1081 		uc = c - font->firstchar;
1082 		cdata = (uint8_t *)font->data + uc * ri->ri_fontscale;
1083 
1084 		if (font->fontwidth < 9) {
1085 			/* byte by byte */
1086 			for (i = 0; i < font->fontheight; i++) {
1087 				sc->sc_rstip[addr] = bg;
1088 				sc->sc_rstip[addr + 32] = bgr;
1089 				bork = *cdata;
1090 				if (bork != 0) {
1091 					fg = (uint64_t)bork >> (shift - 24);
1092 					sc->sc_rstip[addr] = fg | temp;
1093 					fgr = (uint64_t)(bork << (52 - shift));
1094 					sc->sc_rstip[addr] = fgr | temp;
1095 				}
1096 				cdata++;
1097 				addr += ri->ri_width;
1098 			}
1099 		} else if (font->fontwidth < 17) {
1100 			/* short by short */
1101 			wdata = (uint16_t *)cdata;
1102 			for (i = 0; i < font->fontheight; i++) {
1103 				sc->sc_rstip[addr] = bg;
1104 				sc->sc_rstip[addr + 32] = bgr;
1105 				bork = *wdata;
1106 				if (bork != 0) {
1107 					fg = (uint64_t)bork >> (shift - 16);
1108 					sc->sc_rstip[addr] = fg | temp;
1109 					fgr = (uint64_t)(bork << (48 - shift));
1110 					sc->sc_rstip[addr + 32] = fgr | temp;
1111 				}
1112 				wdata++;
1113 				addr += ri->ri_width;
1114 			}
1115 		}
1116 
1117 	}
1118 }
1119 
1120 static int
1121 tcx_do_cursor(struct tcx_softc *sc, struct wsdisplay_cursor *cur)
1122 {
1123 	if (sc->sc_8bit) {
1124 		/* hw cursor is not implemented on tcx */
1125 		return -1;
1126 	}
1127 	if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
1128 
1129 		if (cur->enable) {
1130 			tcx_set_cursor(sc);
1131 		} else {
1132 			/* move the cursor out of sight */
1133 			bus_space_write_4(sc->sc_bustag, sc->sc_thc,
1134 			    THC_CURSOR_POS, 0x7fff7fff);
1135 		}
1136 	}
1137 	if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
1138 
1139 		sc->sc_hotspot_x = cur->hot.x;
1140 		sc->sc_hotspot_y = cur->hot.y;
1141 		tcx_set_cursor(sc);
1142 	}
1143 	if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
1144 
1145 		sc->sc_cursor_x = cur->pos.x;
1146 		sc->sc_cursor_y = cur->pos.y;
1147 		tcx_set_cursor(sc);
1148 	}
1149 	if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
1150 #if 0
1151 	/*
1152 	 * apparently we're not writing in the right register here - if we do
1153 	 * this the screen goes all funky
1154 	 */
1155 		int i;
1156 
1157 		for (i = 0; i < cur->cmap.count; i++) {
1158 			bus_space_write_4(sc->sc_bustag, sc->sc_bt, DAC_ADDRESS,
1159 			    (cur->cmap.index + i + 2) << 24);
1160 			bus_space_write_4(sc->sc_bustag, sc->sc_bt,
1161 			    DAC_CURSOR_LUT, cur->cmap.red[i] << 24);
1162 			bus_space_write_4(sc->sc_bustag, sc->sc_bt,
1163 			    DAC_CURSOR_LUT, cur->cmap.green[i] << 24);
1164 			bus_space_write_4(sc->sc_bustag, sc->sc_bt,
1165 			    DAC_CURSOR_LUT, cur->cmap.blue[i] << 24);
1166 		}
1167 #endif
1168 	}
1169 	if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {
1170 		int i;
1171 		uint32_t temp, poof;
1172 
1173 		for (i = 0; i < 128; i += 4) {
1174 			memcpy(&temp, &cur->mask[i], 4);
1175 			printf("%08x -> ", temp);
1176 			poof = ((temp & 0x80808080) >> 7) |
1177 			       ((temp & 0x40404040) >> 5) |
1178 			       ((temp & 0x20202020) >> 3) |
1179 			       ((temp & 0x10101010) >> 1) |
1180 			       ((temp & 0x08080808) << 1) |
1181 			       ((temp & 0x04040404) << 3) |
1182 			       ((temp & 0x02020202) << 5) |
1183 			       ((temp & 0x01010101) << 7);
1184 			printf("%08x\n", poof);
1185 			bus_space_write_4(sc->sc_bustag, sc->sc_thc,
1186 			    THC_CURSOR_1 + i, poof);
1187 			memcpy(&temp, &cur->image[i], 4);
1188 			poof = ((temp & 0x80808080) >> 7) |
1189 			       ((temp & 0x40404040) >> 5) |
1190 			       ((temp & 0x20202020) >> 3) |
1191 			       ((temp & 0x10101010) >> 1) |
1192 			       ((temp & 0x08080808) << 1) |
1193 			       ((temp & 0x04040404) << 3) |
1194 			       ((temp & 0x02020202) << 5) |
1195 			       ((temp & 0x01010101) << 7);
1196 			bus_space_write_4(sc->sc_bustag, sc->sc_thc,
1197 			    THC_CURSOR_0 + i, poof);
1198 		}
1199 	}
1200 	return 0;
1201 }
1202 
1203 static void
1204 tcx_set_cursor(struct tcx_softc *sc)
1205 {
1206 	uint32_t reg;
1207 
1208 	reg = (sc->sc_cursor_x - sc->sc_hotspot_x) << 16 |
1209 	     ((sc->sc_cursor_y - sc->sc_hotspot_y) & 0xffff);
1210 	bus_space_write_4(sc->sc_bustag, sc->sc_thc, THC_CURSOR_POS, reg);
1211 }
1212 
1213