NetBSD/sys/arch/alpha/tc/sfb.c

/* $NetBSD: sfb.c,v 1.21 1998/11/19 15:38:20 mrg Exp $ */

/*
 * Copyright (c) 1995, 1996 Carnegie-Mellon University.
 * All rights reserved.
 *
 * Author: Chris G. Demetriou
 * 
 * Permission to use, copy, modify and distribute this software and
 * its documentation is hereby granted, provided that both the copyright
 * notice and this permission notice appear in all copies of the
 * software, derivative works or modified versions, and any portions
 * thereof, and that both notices appear in supporting documentation.
 * 
 * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS" 
 * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND 
 * FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
 * 
 * Carnegie Mellon requests users of this software to return to
 *
 *  Software Distribution Coordinator  or  Software.Distribution@CS.CMU.EDU
 *  School of Computer Science
 *  Carnegie Mellon University
 *  Pittsburgh PA 15213-3890
 *
 * any improvements or extensions that they make and grant Carnegie the
 * rights to redistribute these changes.
 */

#include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */

__KERNEL_RCSID(0, "$NetBSD: sfb.c,v 1.21 1998/11/19 15:38:20 mrg Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/malloc.h>
#include <sys/buf.h>
#include <sys/ioctl.h>

#include <machine/bus.h>
#include <machine/intr.h>
#include <machine/conf.h>

#include <dev/tc/tcvar.h>
#include <machine/sfbreg.h>
#include <alpha/tc/sfbvar.h>
#include <alpha/tc/bt459reg.h>

#include <dev/rcons/raster.h>
#include <dev/wscons/wscons_raster.h>
#include <dev/wscons/wsdisplayvar.h>
#include <machine/fbio.h>

#include <machine/autoconf.h>
#include <machine/pte.h>

int	sfbmatch __P((struct device *, struct cfdata *, void *));
void	sfbattach __P((struct device *, struct device *, void *));

struct cfattach sfb_ca = {
	sizeof(struct sfb_softc), sfbmatch, sfbattach,
};

void	sfb_getdevconfig __P((tc_addr_t dense_addr, struct sfb_devconfig *dc));
struct sfb_devconfig sfb_console_dc;
tc_addr_t sfb_consaddr;

struct wsdisplay_emulops sfb_emulfuncs = {
	rcons_cursor,			/* could use hardware cursor; punt */
	rcons_mapchar,
	rcons_putchar,
	rcons_copycols,
	rcons_erasecols,
	rcons_copyrows,
	rcons_eraserows,
	rcons_alloc_attr
};

struct wsscreen_descr sfb_stdscreen = {
	"std",
	0, 0,	/* will be filled in -- XXX shouldn't, it's global */
	&sfb_emulfuncs,
	0, 0
};

const struct wsscreen_descr *_sfb_scrlist[] = {
	&sfb_stdscreen,
	/* XXX other formats, graphics screen? */
};

struct wsscreen_list sfb_screenlist = {
	sizeof(_sfb_scrlist) / sizeof(struct wsscreen_descr *), _sfb_scrlist
};

int	sfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
int	sfbmmap __P((void *, off_t, int));

static int	sfb_alloc_screen __P((void *, const struct wsscreen_descr *,
				      void **, int *, int *, long *));
static void	sfb_free_screen __P((void *, void *));
static void	sfb_show_screen __P((void *, void *));
static int	sfb_load_font __P((void *, void *, int, int, int, void *));

void	sfb_blank __P((struct sfb_devconfig *));
void	sfb_unblank __P((struct sfb_devconfig *));

void	sfb_put_cmap __P((struct sfb_devconfig *, struct fbcmap *));
void	sfb_get_cmap __P((struct sfb_devconfig *, struct fbcmap *));
int     sfb_set_curpos __P((struct sfb_devconfig *, struct fbcurpos *));
int     sfb_get_curpos __P((struct sfb_devconfig *, struct fbcurpos *));
int     sfb_get_curmax __P((struct sfb_devconfig *, struct fbcurpos *));
int     sfb_set_cursor __P((struct sfb_devconfig *, struct fbcursor *));
int     sfb_get_cursor __P((struct sfb_devconfig *, struct fbcursor *));

struct wsdisplay_accessops sfb_accessops = {
	sfbioctl,
	sfbmmap,
	sfb_alloc_screen,
	sfb_free_screen,
	sfb_show_screen,
	sfb_load_font
};

int
sfbmatch(parent, match, aux)
	struct device *parent;
	struct cfdata *match;
	void *aux;
{
	struct tc_attach_args *ta = aux;

	if (strncmp("PMAGB-BA", ta->ta_modname, TC_ROM_LLEN) != 0)
		return (0);

	return (10);
}

void
sfb_getdevconfig(dense_addr, dc)
	tc_addr_t dense_addr;
	struct sfb_devconfig *dc;
{
	struct raster *rap;
	struct rcons *rcp;
	char *regp, *ramdacregp;
	int i;

	dc->dc_vaddr = dense_addr;
	dc->dc_paddr = ALPHA_K0SEG_TO_PHYS(dc->dc_vaddr);	/* XXX */
	dc->dc_size = SFB_SIZE;

	regp = (char *)dc->dc_vaddr + SFB_ASIC_OFFSET;
	ramdacregp = (char *)dc->dc_vaddr + SFB_RAMDAC_OFFSET;

	dc->dc_wid =
	    (*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_HSETUP) & 0x1ff) * 4;
	dc->dc_ht =
	    (*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_VSETUP) & 0x7ff);

	switch (*(volatile u_int32_t *)(regp + SFB_ASIC_DEEP)) {
	case 0:
	case 1:					/* XXX by the book; wrong? */
		dc->dc_depth = 8;		/* 8 plane */
		break;
	case 2:
		dc->dc_depth = 16;		/* 16 plane */
		break;
	case 4:
		dc->dc_depth = 32;		/* 32 plane */
		break;
	default:
		dc->dc_depth = 8;		/* XXX can't happen? */
		break;
	}

	dc->dc_rowbytes = dc->dc_wid * (dc->dc_depth / 8);

	dc->dc_videobase = dc->dc_vaddr + SFB_FB_OFFSET +
	    ((*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_BASE)) *
	     4096 * (dc->dc_depth / 8));
	
	(*(volatile u_int32_t *)(regp + SFB_ASIC_MODE)) = 0;
	tc_wmb();
	(*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_VALID)) = 1;
	tc_wmb();

	/*
	 * Set all bits in the pixel mask, to enable writes to all pixels.
	 * It seems that the console firmware clears some of them
	 * under some circumstances, which causes cute vertical stripes.
	 */
	(*(volatile u_int32_t *)(regp + SFB_ASIC_PIXELMASK)) = 0xffffffff;
	tc_wmb();
	(*(volatile u_int32_t *)(regp + SFB_ASIC_PLANEMASK)) = 0xffffffff;
	tc_wmb();

	/* Initialize the RAMDAC/colormap */
	/* start XXX XXX XXX */
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) = 0;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) = 0;
	tc_wmb();
	for (i = 0; i < 256; i++) {
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		  dc->dc_cmap_red[i] = i ? 0xff : 0;
		tc_wmb();
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		  dc->dc_cmap_green[i] = i ? 0xff : 0;
		tc_wmb();
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		  dc->dc_cmap_blue[i] = i ? 0xff : 0;
		tc_wmb();
	}
	/* end XXX XXX XXX */
	
	/* clear the screen */
	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
		*(u_int32_t *)(dc->dc_videobase + i) = 0x00000000;

	/* disable hardware cursor */
	dc->dc_cursor_enable = 0;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    BT459_REG_CCR;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CCR >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) = 0x00;
	tc_wmb();

	/* initialize the cursor position  */
	dc->dc_curpos_x = 368;
	dc->dc_curpos_y = 34;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) = 
	    BT459_REG_CXLO;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CXLO >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_x;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_x >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_y;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_y >> 8;
	tc_wmb();

	/* initialize the cursor color  */
	dc->dc_cursor_red[0] = 0xff;
	dc->dc_cursor_green[0] = 0xff;
	dc->dc_cursor_blue[0] = 0xff;
	dc->dc_cursor_red[1] = 0x00;
	dc->dc_cursor_green[1] = 0x00;
	dc->dc_cursor_blue[1] = 0x00;
	dc->dc_cursor_red[2] = 0xff;
	dc->dc_cursor_green[2] = 0xff;
	dc->dc_cursor_blue[2] = 0xff;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    BT459_REG_CCOLOR_1;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CCOLOR_1 >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_red[0];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_green[0];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_blue[0];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    BT459_REG_CCOLOR_2;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CCOLOR_2 >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_red[1];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_green[1];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_blue[1];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    BT459_REG_CCOLOR_3;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CCOLOR_3 >> 8;
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_red[2];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_green[2];
	tc_wmb();
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_cursor_blue[2];
	tc_wmb();

	/* initialize the raster */
	rap = &dc->dc_raster;
	rap->width = dc->dc_wid;
	rap->height = dc->dc_ht;
	rap->depth = 8;
	rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
	rap->pixels = (u_int32_t *)dc->dc_videobase;

	/* initialize the raster console blitter */
	rcp = &dc->dc_rcons;
	rcp->rc_sp = rap;
	rcp->rc_crow = rcp->rc_ccol = -1;
	rcp->rc_crowp = &rcp->rc_crow;
	rcp->rc_ccolp = &rcp->rc_ccol;
	rcons_init(rcp, 34, 80);

	sfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
	sfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
}

void
sfbattach(parent, self, aux)
	struct device *parent, *self;
	void *aux;
{
	struct sfb_softc *sc = (struct sfb_softc *)self;
	struct tc_attach_args *ta = aux;
	struct wsemuldisplaydev_attach_args waa;
	int console;

	console = (ta->ta_addr == sfb_consaddr);
	if (console) {
		sc->sc_dc = &sfb_console_dc;
		sc->nscreens = 1;
	} else {
		sc->sc_dc = (struct sfb_devconfig *)
		    malloc(sizeof(struct sfb_devconfig), M_DEVBUF, M_WAITOK);
		sfb_getdevconfig(ta->ta_addr, sc->sc_dc);
	}
	if (sc->sc_dc->dc_vaddr == NULL) {
		printf(": couldn't map memory space; punt!\n");
		return;
	}
	printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
	    sc->sc_dc->dc_depth);

#if 0
	x = (char *)ta->ta_addr + SFB_ASIC_OFFSET;
	printf("%s: Video Base Address = 0x%x\n", self->dv_xname,
	    *(u_int32_t *)(x + SFB_ASIC_VIDEO_BASE));
	printf("%s: Horizontal Setup = 0x%x\n", self->dv_xname,
	    *(u_int32_t *)(x + SFB_ASIC_VIDEO_HSETUP));
	printf("%s: Vertical Setup = 0x%x\n", self->dv_xname,
	    *(u_int32_t *)(x + SFB_ASIC_VIDEO_VSETUP));
#endif

	waa.console = console;
	waa.scrdata = &sfb_screenlist;
	waa.accessops = &sfb_accessops;
	waa.accesscookie = sc;

	config_found(self, &waa, wsemuldisplaydevprint);
}

int
sfbioctl(v, cmd, data, flag, p)
	void *v;
	u_long cmd;
	caddr_t data;
	int flag;
	struct proc *p;
{
	struct sfb_softc *sc = v;
	struct sfb_devconfig *dc = sc->sc_dc;

	switch (cmd) {
	case FBIOGTYPE:
#define fbt ((struct fbtype *)data)
		fbt->fb_type = FBTYPE_SFB;
		fbt->fb_height = sc->sc_dc->dc_ht;
		fbt->fb_width = sc->sc_dc->dc_wid;
		fbt->fb_depth = sc->sc_dc->dc_depth;
		fbt->fb_cmsize = 256;		/* XXX ??? */
		fbt->fb_size = sc->sc_dc->dc_size;
#undef fbt
		return (0);

	case FBIOPUTCMAP:
		sfb_put_cmap(dc, (struct fbcmap *)data);
		return (0);

	case FBIOGETCMAP:
		sfb_get_cmap(dc, (struct fbcmap *)data);
		return (0);

	case FBIOGATTR:
		return (ENOTTY);			/* XXX ? */

	case FBIOSVIDEO:
		if (*(int *)data == FBVIDEO_OFF)
			sfb_blank(sc->sc_dc);
		else
			sfb_unblank(sc->sc_dc);
		return (0);

	case FBIOGVIDEO:
		*(int *)data = dc->dc_blanked ? FBVIDEO_OFF : FBVIDEO_ON;
		return (0);

	case FBIOSCURSOR:
		return sfb_set_cursor(dc, (struct fbcursor *)data);

	case FBIOGCURSOR:
		return sfb_get_cursor(dc, (struct fbcursor *)data);

	case FBIOSCURPOS:
		return sfb_set_curpos(dc, (struct fbcurpos *)data);

	case FBIOGCURPOS:
		return sfb_get_curpos(dc, (struct fbcurpos *)data);

	case FBIOGCURMAX:
		return sfb_get_curmax(dc, (struct fbcurpos *)data);
	}
	return (-1);
}

int
sfbmmap(v, offset, prot)
	void *v;
	off_t offset;
	int prot;
{
	struct sfb_softc *sc = v;

	if (offset >= SFB_SIZE || offset < 0)
		return (-1);
	return alpha_btop(sc->sc_dc->dc_paddr + offset);
}

int
sfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
	void *v;
	const struct wsscreen_descr *type;
	void **cookiep;
	int *curxp, *curyp;
	long *attrp;
{
	struct sfb_softc *sc = v;
	long defattr;

	if (sc->nscreens > 0)
		return (ENOMEM);

	*cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
	*curxp = 0;
	*curyp = 0;
	rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
	*attrp = defattr;
	sc->nscreens++;
	return (0);
}

void
sfb_free_screen(v, cookie)
	void *v;
	void *cookie;
{
	struct sfb_softc *sc = v;

	if (sc->sc_dc == &sfb_console_dc)
		panic("sfb_free_screen: console");

	sc->nscreens--;
}

void
sfb_show_screen(v, cookie)
	void *v;
	void *cookie;
{
}

static int
sfb_load_font(v, cookie, first, num, stride, data)
	void *v;
	void *cookie;
	int first, num, stride;
	void *data;
{
	return (EINVAL);
}

int
sfb_cnattach(addr)
	tc_addr_t addr;
{
	struct sfb_devconfig *dcp = &sfb_console_dc;
	long defattr;

	sfb_getdevconfig(addr, dcp);

	rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);

	wsdisplay_cnattach(&sfb_stdscreen, &dcp->dc_rcons,
			   0, 0, defattr);
	sfb_consaddr = addr;
	return(0);
}

/*
 * Functions to blank and unblank the display.
 */
void
sfb_blank(dc)
	struct sfb_devconfig *dc;
{
	char *regp = (char *)dc->dc_vaddr + SFB_ASIC_OFFSET;

	if (!dc->dc_blanked) {
		dc->dc_blanked = 1;
	    	*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_VALID) = 0;
		tc_wmb();
	}
}

void
sfb_unblank(dc)
	struct sfb_devconfig *dc;
{
	char *regp = (char *)dc->dc_vaddr + SFB_ASIC_OFFSET;
	
	if (dc->dc_blanked) {
		dc->dc_blanked = 0;
	    	*(volatile u_int32_t *)(regp + SFB_ASIC_VIDEO_VALID) = 1;
		tc_wmb();
	}
}

void
sfb_put_cmap(dc, cmap)
     struct sfb_devconfig *dc;
     struct fbcmap *cmap;
{
	char *ramdacregp;
	int i;
	int max_i;
  
	ramdacregp = (char *)dc->dc_vaddr + SFB_RAMDAC_OFFSET;

	if (cmap->index > 255) {
		return;
	}
	max_i = cmap->index + cmap->count;
	if (max_i > 256) {
		max_i = 256;
	}

	for (i=cmap->index ; i<max_i ; i++) {
		dc->dc_cmap_red[i] = cmap->red[i];
		dc->dc_cmap_green[i] = cmap->green[i];
		dc->dc_cmap_blue[i] = cmap->blue[i];
	}
	/* Initialize the RAMDAC/colormap */
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    cmap->index;
	(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_ADDRHIGH)) = 0;
	tc_wmb();
	for (i=cmap->index ; i<max_i ; i++) {
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		    dc->dc_cmap_red[i];
		tc_wmb();
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		    dc->dc_cmap_green[i];
		tc_wmb();
		(*(volatile u_int32_t *)(ramdacregp + SFB_RAMDAC_CMAPDATA)) =
		    dc->dc_cmap_blue[i];
		tc_wmb();
	}
}

void 
sfb_get_cmap(dc, cmap)
	struct sfb_devconfig *dc;
	struct fbcmap  *cmap;
{
	int i;
	int max_i;

	if (cmap->index > 255) {
		return;
	}
	max_i = cmap->index + cmap->count;
	if (max_i > 256) {
		max_i = 256;
	}

	for (i = cmap->index; i < max_i; i++) {
		cmap->red[i] = dc->dc_cmap_red[i];
		cmap->green[i] = dc->dc_cmap_green[i];
		cmap->blue[i] = dc->dc_cmap_blue[i];
	}
}

int 
sfb_set_curpos(dc, curpos)
	struct sfb_devconfig *dc;
	struct fbcurpos *curpos;
{
	char *ramdacregp;

	dc->dc_curpos_x = curpos->x + 368;
	dc->dc_curpos_y = curpos->y + 34;

	ramdacregp = (char *) dc->dc_vaddr + SFB_RAMDAC_OFFSET;

	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
	    BT459_REG_CXLO;
	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
	    BT459_REG_CXLO >> 8;
	tc_wmb();

	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_x;
	tc_wmb();
	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_x >> 8;
	tc_wmb();
	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_y;
	tc_wmb();
	(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
	    dc->dc_curpos_y >> 8;
	tc_wmb();

	return 0;
}

int 
sfb_get_curpos(dc, curpos)
	struct sfb_devconfig *dc;
	struct fbcurpos *curpos;
{
	curpos->x = dc->dc_curpos_x - 368;
	curpos->y = dc->dc_curpos_y - 34;

	return 0;
}

int 
sfb_get_curmax(dc, curpos)
	struct sfb_devconfig *dc;
	struct fbcurpos *curpos;
{
	curpos->x = 1280;
	curpos->y = 1024;

	return 0;
}

int 
sfb_set_cursor(dc, cursor)
	struct sfb_devconfig *dc;
	struct fbcursor *cursor;
{
	unsigned char buf;
	char *ramdacregp;
	int result, i;

	result = 0;

	ramdacregp = (char *) dc->dc_vaddr + SFB_RAMDAC_OFFSET;

	if (cursor->set & FB_CUR_SETCUR) {
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
		    BT459_REG_CCR;
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
		    BT459_REG_CCR >> 8;
		tc_wmb();

		dc->dc_cursor_enable = cursor->enable;

		if (cursor->enable == 0) {
			(*(volatile u_int32_t *)
			    (ramdacregp + SFB_RAMDAC_REGDATA)) = 0x00;
		} else {
			(*(volatile u_int32_t *)
			    (ramdacregp + SFB_RAMDAC_REGDATA)) = 0xc0;
		}
		tc_wmb();

		result |= 0;
	}
	if (cursor->set & FB_CUR_SETPOS) {
		result |= sfb_set_curpos(dc, &cursor->pos);
	}
	if (cursor->set & FB_CUR_SETHOT) {
		result |= sfb_set_curpos(dc, &cursor->pos);
	}
	if (cursor->set & FB_CUR_SETCMAP) {
		for (i = 0; i < 3; i++) {
			dc->dc_cursor_red[i] = cursor->cmap.red[i];
			dc->dc_cursor_green[i] = cursor->cmap.green[i];
			dc->dc_cursor_blue[i] = cursor->cmap.blue[i];
		}

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
		    BT459_REG_CCOLOR_1;
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
		    BT459_REG_CCOLOR_1 >> 8;
		tc_wmb();

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.red[0];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.green[0];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.blue[0];
		tc_wmb();

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
		    BT459_REG_CCOLOR_2;
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
		    BT459_REG_CCOLOR_2 >> 8;
		tc_wmb();

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.red[1];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.green[1];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.blue[1];
		tc_wmb();

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
		    BT459_REG_CCOLOR_3;
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
		    BT459_REG_CCOLOR_3 >> 8;
		tc_wmb();

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.red[2];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.green[2];
		tc_wmb();
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_REGDATA)) =
		    cursor->cmap.blue[2];
		tc_wmb();

		result |= 0;
	}
	if (cursor->set & FB_CUR_SETSHAPE) {
		for (i = 0; i < 512; i++) {
			buf = (cursor->image[i] & 0x01) |
			    ((cursor->image[i] & 0x02) << 1) |
			    ((cursor->image[i] & 0x04) << 2) |
			    ((cursor->image[i] & 0x08) << 3);
			dc->dc_cursor_bitmap[i + i] = buf;
			buf = ((cursor->image[i] & 0x10) >> 4) |
			    ((cursor->image[i] & 0x20) >> 3) |
			    ((cursor->image[i] & 0x40) >> 2) |
			    ((cursor->image[i] & 0x80) >> 1);
			dc->dc_cursor_bitmap[i + i + 1] = buf;
		}

		for (i = 0; i < 512; i++) {
			buf = ((cursor->mask[i] & 0x01) << 1) |
			    ((cursor->mask[i] & 0x02) << 2) |
			    ((cursor->mask[i] & 0x04) << 3) |
			    ((cursor->mask[i] & 0x08) << 4);
			dc->dc_cursor_bitmap[i + i] |= buf;
			buf = ((cursor->mask[i] & 0x10) >> 3) |
			    ((cursor->mask[i] & 0x20) >> 2) |
			    ((cursor->mask[i] & 0x40) >> 1) |
			    (cursor->mask[i] & 0x80);
			dc->dc_cursor_bitmap[i + i + 1] |= buf;
		}

		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRLOW)) =
		    BT459_REG_CRAM_BASE;
		(*(volatile u_int32_t *) (ramdacregp + SFB_RAMDAC_ADDRHIGH)) =
		    BT459_REG_CRAM_BASE >> 8;
		tc_wmb();

		for (i = 0; i < 1024; i++) {
			(*(volatile u_int32_t *)
			    (ramdacregp + SFB_RAMDAC_REGDATA)) =
			    dc->dc_cursor_bitmap[i];
			tc_wmb();
		}
		result |= 0;
	}
	return result;
}

int 
sfb_get_cursor(dc, cursor)
	struct sfb_devconfig *dc;
	struct fbcursor *cursor;
{
	int result, i, j, k;

	result = 0;

	if (cursor->set & FB_CUR_SETCUR) {
		cursor->enable = dc->dc_cursor_enable;
	}
	if (cursor->set & FB_CUR_SETPOS) {
		result |= sfb_get_curpos(dc, &cursor->pos);
	}
	if (cursor->set & FB_CUR_SETHOT) {
		result |= sfb_get_curpos(dc, &cursor->pos);
	}
	if (cursor->set & FB_CUR_SETCMAP) {
		for (i = 0; i < 3; i++) {
			cursor->cmap.red[i] = dc->dc_cursor_red[i];
			cursor->cmap.green[i] = dc->dc_cursor_green[i];
			cursor->cmap.blue[i] = dc->dc_cursor_blue[i];
		}
	}
	if (cursor->set & FB_CUR_SETSHAPE) {
		cursor->size.x = 64;
		cursor->size.y = 64;
		for (i = 0; i < 512; i++) {
			j = i + i;
			k = j + 1;
			cursor->image[i] =
			    (dc->dc_cursor_bitmap[j] & 0x01) |
			    ((dc->dc_cursor_bitmap[j] & 0x04) >> 1) |
			    ((dc->dc_cursor_bitmap[j] & 0x10) >> 2) |
			    ((dc->dc_cursor_bitmap[j] & 0x40) >> 3) |
			    ((dc->dc_cursor_bitmap[k] & 0x01) << 4) |
			    ((dc->dc_cursor_bitmap[k] & 0x04) << 3) |
			    ((dc->dc_cursor_bitmap[k] & 0x10) << 2) |
			    ((dc->dc_cursor_bitmap[k] & 0x40) << 1);
			cursor->mask[i] =
			    ((dc->dc_cursor_bitmap[j] & 0x02) >> 1) |
			    ((dc->dc_cursor_bitmap[j] & 0x08) >> 2) |
			    ((dc->dc_cursor_bitmap[j] & 0x20) >> 3) |
			    ((dc->dc_cursor_bitmap[j] & 0x80) >> 4) |
			    ((dc->dc_cursor_bitmap[k] & 0x02) << 3) |
			    ((dc->dc_cursor_bitmap[k] & 0x08) << 2) |
			    ((dc->dc_cursor_bitmap[k] & 0x20) << 1) |
			    (dc->dc_cursor_bitmap[k] & 0x80);
		}
	}
	return result;
}