Home | History | Annotate | Line # | Download | only in tc
cfb.c revision 1.1
      1  1.1  nisimura /* $NetBSD: cfb.c,v 1.1 1998/10/29 12:24:24 nisimura Exp $ */
      2  1.1  nisimura 
      3  1.1  nisimura #include <sys/cdefs.h>			/* RCS ID & Copyright macro defns */
      4  1.1  nisimura 
      5  1.1  nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.1 1998/10/29 12:24:24 nisimura Exp $");
      6  1.1  nisimura 
      7  1.1  nisimura #include <sys/param.h>
      8  1.1  nisimura #include <sys/systm.h>
      9  1.1  nisimura #include <sys/kernel.h>
     10  1.1  nisimura #include <sys/device.h>
     11  1.1  nisimura #include <sys/malloc.h>
     12  1.1  nisimura #include <sys/buf.h>
     13  1.1  nisimura #include <sys/ioctl.h>
     14  1.1  nisimura #include <vm/vm.h>
     15  1.1  nisimura 
     16  1.1  nisimura #include <machine/bus.h>
     17  1.1  nisimura #include <machine/intr.h>
     18  1.1  nisimura 
     19  1.1  nisimura #include <dev/rcons/raster.h>
     20  1.1  nisimura #include <dev/wscons/wsconsio.h>
     21  1.1  nisimura #include <dev/wscons/wscons_raster.h>
     22  1.1  nisimura #include <dev/wscons/wsdisplayvar.h>
     23  1.1  nisimura #include <machine/autoconf.h>
     24  1.1  nisimura 
     25  1.1  nisimura #include <dev/tc/tcvar.h>
     26  1.1  nisimura #include <dev/ic/bt459reg.h>
     27  1.1  nisimura 
     28  1.1  nisimura #include "opt_uvm.h"
     29  1.1  nisimura #if defined(UVM)
     30  1.1  nisimura #include <uvm/uvm_extern.h>
     31  1.1  nisimura #define useracc uvm_useracc
     32  1.1  nisimura #endif
     33  1.1  nisimura 
     34  1.1  nisimura /* XXX BUS'IFYING XXX */
     35  1.1  nisimura 
     36  1.1  nisimura #if defined(__pmax__)
     37  1.1  nisimura #define	machine_btop(x) mips_btop(x)
     38  1.1  nisimura #define	MACHINE_KSEG0_TO_PHYS(x) MIPS_KSEG1_TO_PHYS(x)
     39  1.1  nisimura #endif
     40  1.1  nisimura 
     41  1.1  nisimura #if defined(__alpha__) || defined(alpha)
     42  1.1  nisimura /*
     43  1.1  nisimura  * Digital UNIX never supports PMAG-BA
     44  1.1  nisimura  */
     45  1.1  nisimura #define machine_btop(x) alpha_btop(x)
     46  1.1  nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
     47  1.1  nisimura #endif
     48  1.1  nisimura 
     49  1.1  nisimura /* XXX XXX XXX */
     50  1.1  nisimura 
     51  1.1  nisimura /*
     52  1.1  nisimura  * N.B., Bt459 registers are 8bit width.  Some of TC framebuffers have
     53  1.1  nisimura  * weird register layout such as each of 2nd and 3rd Bt459 registers
     54  1.1  nisimura  * is adjacent each other in a word, i.e.,
     55  1.1  nisimura  *
     56  1.1  nisimura  *	struct bt459triplet {
     57  1.1  nisimura  * 		struct {
     58  1.1  nisimura  *			u_int8_t u0;
     59  1.1  nisimura  *			u_int8_t u1;
     60  1.1  nisimura  *			u_int8_t u2;
     61  1.1  nisimura  *			unsigned :8;
     62  1.1  nisimura  *		} bt_lo;
     63  1.1  nisimura  *		...
     64  1.1  nisimura  *
     65  1.1  nisimura  * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
     66  1.1  nisimura  */
     67  1.1  nisimura struct bt459reg {
     68  1.1  nisimura         u_int32_t       bt_lo;
     69  1.1  nisimura         u_int32_t       bt_hi;
     70  1.1  nisimura         u_int32_t       bt_reg;
     71  1.1  nisimura         u_int32_t       bt_cmap;
     72  1.1  nisimura };
     73  1.1  nisimura 
     74  1.1  nisimura struct fb_devconfig {
     75  1.1  nisimura 	vaddr_t dc_vaddr;		/* memory space virtual base address */
     76  1.1  nisimura 	paddr_t dc_paddr;		/* memory space physical base address */
     77  1.1  nisimura 	vsize_t	dc_size;		/* size of slot memory */
     78  1.1  nisimura 	int	dc_wid;			/* width of frame buffer */
     79  1.1  nisimura 	int	dc_ht;			/* height of frame buffer */
     80  1.1  nisimura 	int	dc_depth;		/* depth, bits per pixel */
     81  1.1  nisimura 	int	dc_rowbytes;		/* bytes in a FB scan line */
     82  1.1  nisimura 	vaddr_t dc_videobase;		/* base of flat frame buffer */
     83  1.1  nisimura 	struct raster	dc_raster;	/* raster description */
     84  1.1  nisimura 	struct rcons	dc_rcons;	/* raster blitter control info */
     85  1.1  nisimura 	int	    dc_blanked;		/* currently has video disabled */
     86  1.1  nisimura };
     87  1.1  nisimura 
     88  1.1  nisimura struct hwcmap {
     89  1.1  nisimura #define	CMAP_SIZE	256	/* 256 R/G/B entries */
     90  1.1  nisimura 	u_int8_t r[CMAP_SIZE];
     91  1.1  nisimura 	u_int8_t g[CMAP_SIZE];
     92  1.1  nisimura 	u_int8_t b[CMAP_SIZE];
     93  1.1  nisimura };
     94  1.1  nisimura 
     95  1.1  nisimura struct hwcursor {
     96  1.1  nisimura 	struct wsdisplay_curpos cc_pos;
     97  1.1  nisimura 	struct wsdisplay_curpos cc_hot;
     98  1.1  nisimura 	struct wsdisplay_curpos cc_size;
     99  1.1  nisimura #define	CURSOR_MAX_SIZE	64
    100  1.1  nisimura 	u_int8_t cc_color[6];
    101  1.1  nisimura 	u_int64_t cc_image[64 + 64];
    102  1.1  nisimura };
    103  1.1  nisimura 
    104  1.1  nisimura struct cfb_softc {
    105  1.1  nisimura 	struct device sc_dev;
    106  1.1  nisimura 	struct fb_devconfig *sc_dc;	/* device configuration */
    107  1.1  nisimura 	struct hwcmap sc_cmap;		/* software copy of colormap */
    108  1.1  nisimura 	struct hwcursor sc_cursor;	/* software copy of cursor */
    109  1.1  nisimura 	int sc_curenb;			/* cursor sprite enabled */
    110  1.1  nisimura 	int sc_changed;			/* need update of colormap */
    111  1.1  nisimura #define	DATA_ENB_CHANGED	0x01	/* cursor enable changed */
    112  1.1  nisimura #define	DATA_CURCMAP_CHANGED	0x02	/* cursor colormap changed */
    113  1.1  nisimura #define	DATA_CURSHAPE_CHANGED	0x04	/* cursor size, image, mask changed */
    114  1.1  nisimura #define	DATA_CMAP_CHANGED	0x08	/* colormap changed */
    115  1.1  nisimura #define	DATA_ALL_CHANGED	0x0f
    116  1.1  nisimura 	int nscreens;
    117  1.1  nisimura };
    118  1.1  nisimura 
    119  1.1  nisimura int  cfbmatch __P((struct device *, struct cfdata *, void *));
    120  1.1  nisimura void cfbattach __P((struct device *, struct device *, void *));
    121  1.1  nisimura 
    122  1.1  nisimura struct cfattach cfb_ca = {
    123  1.1  nisimura 	sizeof(struct cfb_softc), cfbmatch, cfbattach,
    124  1.1  nisimura };
    125  1.1  nisimura 
    126  1.1  nisimura void cfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
    127  1.1  nisimura struct fb_devconfig cfb_console_dc;
    128  1.1  nisimura tc_addr_t cfb_consaddr;
    129  1.1  nisimura 
    130  1.1  nisimura struct wsdisplay_emulops cfb_emulops = {
    131  1.1  nisimura 	rcons_cursor,			/* could use hardware cursor; punt */
    132  1.1  nisimura 	rcons_mapchar,
    133  1.1  nisimura 	rcons_putchar,
    134  1.1  nisimura 	rcons_copycols,
    135  1.1  nisimura 	rcons_erasecols,
    136  1.1  nisimura 	rcons_copyrows,
    137  1.1  nisimura 	rcons_eraserows,
    138  1.1  nisimura 	rcons_alloc_attr
    139  1.1  nisimura };
    140  1.1  nisimura 
    141  1.1  nisimura struct wsscreen_descr cfb_stdscreen = {
    142  1.1  nisimura 	"std", 0, 0,
    143  1.1  nisimura 	&cfb_emulops,
    144  1.1  nisimura 	0, 0,
    145  1.1  nisimura 	0
    146  1.1  nisimura };
    147  1.1  nisimura 
    148  1.1  nisimura const struct wsscreen_descr *_cfb_scrlist[] = {
    149  1.1  nisimura 	&cfb_stdscreen,
    150  1.1  nisimura };
    151  1.1  nisimura 
    152  1.1  nisimura struct wsscreen_list cfb_screenlist = {
    153  1.1  nisimura 	sizeof(_cfb_scrlist) / sizeof(struct wsscreen_descr *), _cfb_scrlist
    154  1.1  nisimura };
    155  1.1  nisimura 
    156  1.1  nisimura int	cfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
    157  1.1  nisimura int	cfbmmap __P((void *, off_t, int));
    158  1.1  nisimura 
    159  1.1  nisimura int	cfb_alloc_screen __P((void *, const struct wsscreen_descr *,
    160  1.1  nisimura 				      void **, int *, int *, long *));
    161  1.1  nisimura void	cfb_free_screen __P((void *, void *));
    162  1.1  nisimura void	cfb_show_screen __P((void *, void *));
    163  1.1  nisimura int	cfb_load_font __P((void *, void *, int, int, int, void *));
    164  1.1  nisimura 
    165  1.1  nisimura struct wsdisplay_accessops cfb_accessops = {
    166  1.1  nisimura 	cfbioctl,
    167  1.1  nisimura 	cfbmmap,
    168  1.1  nisimura 	cfb_alloc_screen,
    169  1.1  nisimura 	cfb_free_screen,
    170  1.1  nisimura 	cfb_show_screen,
    171  1.1  nisimura 	cfb_load_font
    172  1.1  nisimura };
    173  1.1  nisimura 
    174  1.1  nisimura int  cfb_cnattach __P((tc_addr_t));
    175  1.1  nisimura int  cfbintr __P((void *));
    176  1.1  nisimura void cfbinit __P((struct fb_devconfig *));
    177  1.1  nisimura 
    178  1.1  nisimura static int  get_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
    179  1.1  nisimura static int  set_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
    180  1.1  nisimura static int  set_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
    181  1.1  nisimura static int  get_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
    182  1.1  nisimura static void set_curpos __P((struct cfb_softc *, struct wsdisplay_curpos *));
    183  1.1  nisimura static void bt459_set_curpos __P((struct cfb_softc *));
    184  1.1  nisimura 
    185  1.1  nisimura /* XXX XXX XXX */
    186  1.1  nisimura #define	BT459_SELECT(vdac, regno) do {		\
    187  1.1  nisimura 	vdac->bt_lo = (regno) & 0x00ff;		\
    188  1.1  nisimura 	vdac->bt_hi = ((regno)& 0xff00) >> 8;	\
    189  1.1  nisimura 	tc_wmb();				\
    190  1.1  nisimura    } while (0)
    191  1.1  nisimura /* XXX XXX XXX */
    192  1.1  nisimura 
    193  1.1  nisimura #define	CFB_FB_OFFSET		0x000000
    194  1.1  nisimura #define	CFB_FB_SIZE		0x100000
    195  1.1  nisimura #define	CFB_BT459_OFFSET	0x200000
    196  1.1  nisimura #define	CFB_OFFSET_IREQ		0x300000	/* Interrupt req. control */
    197  1.1  nisimura 
    198  1.1  nisimura int
    199  1.1  nisimura cfbmatch(parent, match, aux)
    200  1.1  nisimura 	struct device *parent;
    201  1.1  nisimura 	struct cfdata *match;
    202  1.1  nisimura 	void *aux;
    203  1.1  nisimura {
    204  1.1  nisimura 	struct tc_attach_args *ta = aux;
    205  1.1  nisimura 
    206  1.1  nisimura 	if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
    207  1.1  nisimura 		return (0);
    208  1.1  nisimura 
    209  1.1  nisimura 	return (1);
    210  1.1  nisimura }
    211  1.1  nisimura 
    212  1.1  nisimura void
    213  1.1  nisimura cfb_getdevconfig(dense_addr, dc)
    214  1.1  nisimura 	tc_addr_t dense_addr;
    215  1.1  nisimura 	struct fb_devconfig *dc;
    216  1.1  nisimura {
    217  1.1  nisimura 	struct raster *rap;
    218  1.1  nisimura 	struct rcons *rcp;
    219  1.1  nisimura 	int i;
    220  1.1  nisimura 
    221  1.1  nisimura 	dc->dc_vaddr = dense_addr;
    222  1.1  nisimura 	dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr + CFB_FB_OFFSET);
    223  1.1  nisimura 
    224  1.1  nisimura 	dc->dc_wid = 1024;
    225  1.1  nisimura 	dc->dc_ht = 864;
    226  1.1  nisimura 	dc->dc_depth = 8;
    227  1.1  nisimura 	dc->dc_rowbytes = 1024;
    228  1.1  nisimura 	dc->dc_videobase = dc->dc_vaddr + CFB_FB_OFFSET;
    229  1.1  nisimura 	dc->dc_blanked = 0;
    230  1.1  nisimura 
    231  1.1  nisimura 	/* initialize colormap and cursor resource */
    232  1.1  nisimura 	cfbinit(dc);
    233  1.1  nisimura 
    234  1.1  nisimura 	/* clear the screen */
    235  1.1  nisimura 	for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
    236  1.1  nisimura 		*(u_int32_t *)(dc->dc_videobase + i) = 0x0;
    237  1.1  nisimura 
    238  1.1  nisimura 	/* initialize the raster */
    239  1.1  nisimura 	rap = &dc->dc_raster;
    240  1.1  nisimura 	rap->width = dc->dc_wid;
    241  1.1  nisimura 	rap->height = dc->dc_ht;
    242  1.1  nisimura 	rap->depth = dc->dc_depth;
    243  1.1  nisimura 	rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
    244  1.1  nisimura 	rap->pixels = (u_int32_t *)dc->dc_videobase;
    245  1.1  nisimura 
    246  1.1  nisimura 	/* initialize the raster console blitter */
    247  1.1  nisimura 	rcp = &dc->dc_rcons;
    248  1.1  nisimura 	rcp->rc_sp = rap;
    249  1.1  nisimura 	rcp->rc_crow = rcp->rc_ccol = -1;
    250  1.1  nisimura 	rcp->rc_crowp = &rcp->rc_crow;
    251  1.1  nisimura 	rcp->rc_ccolp = &rcp->rc_ccol;
    252  1.1  nisimura 	rcons_init(rcp, 34, 80);
    253  1.1  nisimura 
    254  1.1  nisimura 	cfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
    255  1.1  nisimura 	cfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
    256  1.1  nisimura }
    257  1.1  nisimura 
    258  1.1  nisimura void
    259  1.1  nisimura cfbattach(parent, self, aux)
    260  1.1  nisimura 	struct device *parent, *self;
    261  1.1  nisimura 	void *aux;
    262  1.1  nisimura {
    263  1.1  nisimura 	struct cfb_softc *sc = (struct cfb_softc *)self;
    264  1.1  nisimura 	struct tc_attach_args *ta = aux;
    265  1.1  nisimura 	struct wsemuldisplaydev_attach_args waa;
    266  1.1  nisimura 	struct hwcmap *cm;
    267  1.1  nisimura 	int console, i;
    268  1.1  nisimura 
    269  1.1  nisimura 	console = (ta->ta_addr == cfb_consaddr);
    270  1.1  nisimura 	if (console) {
    271  1.1  nisimura 		sc->sc_dc = &cfb_console_dc;
    272  1.1  nisimura 		sc->nscreens = 1;
    273  1.1  nisimura 	}
    274  1.1  nisimura 	else {
    275  1.1  nisimura 		sc->sc_dc = (struct fb_devconfig *)
    276  1.1  nisimura 		    malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
    277  1.1  nisimura 		cfb_getdevconfig(ta->ta_addr, sc->sc_dc);
    278  1.1  nisimura 	}
    279  1.1  nisimura 	printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
    280  1.1  nisimura 	    sc->sc_dc->dc_depth);
    281  1.1  nisimura 
    282  1.1  nisimura 	cm = &sc->sc_cmap;
    283  1.1  nisimura 	cm->r[0] = cm->g[0] = cm->b[0] = 0;
    284  1.1  nisimura 	for (i = 1; i < CMAP_SIZE; i++) {
    285  1.1  nisimura 		cm->r[i] = cm->g[i] = cm->b[i] = 0xff;
    286  1.1  nisimura 	}
    287  1.1  nisimura 
    288  1.1  nisimura 	/* Establish an interrupt handler, and clear any pending interrupts */
    289  1.1  nisimura         tc_intr_establish(parent, ta->ta_cookie, TC_IPL_TTY, cfbintr, sc);
    290  1.1  nisimura 	*(u_int8_t *)(sc->sc_dc->dc_vaddr + CFB_OFFSET_IREQ) = 0;
    291  1.1  nisimura 
    292  1.1  nisimura 	waa.console = console;
    293  1.1  nisimura 	waa.scrdata = &cfb_screenlist;
    294  1.1  nisimura 	waa.accessops = &cfb_accessops;
    295  1.1  nisimura 	waa.accesscookie = sc;
    296  1.1  nisimura 
    297  1.1  nisimura 	config_found(self, &waa, wsemuldisplaydevprint);
    298  1.1  nisimura }
    299  1.1  nisimura 
    300  1.1  nisimura int
    301  1.1  nisimura cfbioctl(v, cmd, data, flag, p)
    302  1.1  nisimura 	void *v;
    303  1.1  nisimura 	u_long cmd;
    304  1.1  nisimura 	caddr_t data;
    305  1.1  nisimura 	int flag;
    306  1.1  nisimura 	struct proc *p;
    307  1.1  nisimura {
    308  1.1  nisimura 	struct cfb_softc *sc = v;
    309  1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    310  1.1  nisimura 	int turnoff;
    311  1.1  nisimura 
    312  1.1  nisimura 	switch (cmd) {
    313  1.1  nisimura 	case WSDISPLAYIO_GTYPE:
    314  1.1  nisimura 		*(u_int *)data = WSDISPLAY_TYPE_CFB;
    315  1.1  nisimura 		return (0);
    316  1.1  nisimura 
    317  1.1  nisimura 	case WSDISPLAYIO_GINFO:
    318  1.1  nisimura #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    319  1.1  nisimura 		wsd_fbip->height = sc->sc_dc->dc_ht;
    320  1.1  nisimura 		wsd_fbip->width = sc->sc_dc->dc_wid;
    321  1.1  nisimura 		wsd_fbip->depth = sc->sc_dc->dc_depth;
    322  1.1  nisimura 		wsd_fbip->cmsize = CMAP_SIZE;
    323  1.1  nisimura #undef fbt
    324  1.1  nisimura 		return (0);
    325  1.1  nisimura 
    326  1.1  nisimura 	case WSDISPLAYIO_GETCMAP:
    327  1.1  nisimura 		return get_cmap(sc, (struct wsdisplay_cmap *)data);
    328  1.1  nisimura 
    329  1.1  nisimura 	case WSDISPLAYIO_PUTCMAP:
    330  1.1  nisimura 		return set_cmap(sc, (struct wsdisplay_cmap *)data);
    331  1.1  nisimura 
    332  1.1  nisimura 	case WSDISPLAYIO_SVIDEO:
    333  1.1  nisimura 		turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
    334  1.1  nisimura 		if ((dc->dc_blanked == 0) ^ turnoff) {
    335  1.1  nisimura 			/* sc->sc_changed |= DATA_ALL_CHANGED; */
    336  1.1  nisimura 			dc->dc_blanked = turnoff;
    337  1.1  nisimura 		}
    338  1.1  nisimura 		return (0);
    339  1.1  nisimura 
    340  1.1  nisimura 	case WSDISPLAYIO_GVIDEO:
    341  1.1  nisimura 		*(u_int *)data = dc->dc_blanked ?
    342  1.1  nisimura 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
    343  1.1  nisimura 		return (0);
    344  1.1  nisimura 
    345  1.1  nisimura 	case WSDISPLAYIO_GCURPOS:
    346  1.1  nisimura 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    347  1.1  nisimura 		return (0);
    348  1.1  nisimura 
    349  1.1  nisimura 	case WSDISPLAYIO_SCURPOS:
    350  1.1  nisimura 		set_curpos(sc, (struct wsdisplay_curpos *)data);
    351  1.1  nisimura 		bt459_set_curpos(sc);
    352  1.1  nisimura 		return (0);
    353  1.1  nisimura 
    354  1.1  nisimura 	case WSDISPLAYIO_GCURMAX:
    355  1.1  nisimura 		((struct wsdisplay_curpos *)data)->x =
    356  1.1  nisimura 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    357  1.1  nisimura 		return (0);
    358  1.1  nisimura 
    359  1.1  nisimura 	case WSDISPLAYIO_GCURSOR:
    360  1.1  nisimura 		return get_cursor(sc, (struct wsdisplay_cursor *)data);
    361  1.1  nisimura 
    362  1.1  nisimura 	case WSDISPLAYIO_SCURSOR:
    363  1.1  nisimura 		return set_cursor(sc, (struct wsdisplay_cursor *)data);
    364  1.1  nisimura 	}
    365  1.1  nisimura 	return ENOTTY;
    366  1.1  nisimura }
    367  1.1  nisimura 
    368  1.1  nisimura int
    369  1.1  nisimura cfbmmap(v, offset, prot)
    370  1.1  nisimura 	void *v;
    371  1.1  nisimura 	off_t offset;
    372  1.1  nisimura 	int prot;
    373  1.1  nisimura {
    374  1.1  nisimura 	struct cfb_softc *sc = v;
    375  1.1  nisimura 
    376  1.1  nisimura 	if (offset > CFB_FB_SIZE)
    377  1.1  nisimura 		return (-1);
    378  1.1  nisimura 	return machine_btop(sc->sc_dc->dc_paddr + offset);
    379  1.1  nisimura }
    380  1.1  nisimura 
    381  1.1  nisimura int
    382  1.1  nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
    383  1.1  nisimura 	void *v;
    384  1.1  nisimura 	const struct wsscreen_descr *type;
    385  1.1  nisimura 	void **cookiep;
    386  1.1  nisimura 	int *curxp, *curyp;
    387  1.1  nisimura 	long *attrp;
    388  1.1  nisimura {
    389  1.1  nisimura 	struct cfb_softc *sc = v;
    390  1.1  nisimura 	long defattr;
    391  1.1  nisimura 
    392  1.1  nisimura 	if (sc->nscreens > 0)
    393  1.1  nisimura 		return (ENOMEM);
    394  1.1  nisimura 
    395  1.1  nisimura 	*cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
    396  1.1  nisimura 	*curxp = 0;
    397  1.1  nisimura 	*curyp = 0;
    398  1.1  nisimura 	rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
    399  1.1  nisimura 	*attrp = defattr;
    400  1.1  nisimura 	sc->nscreens++;
    401  1.1  nisimura 	return (0);
    402  1.1  nisimura }
    403  1.1  nisimura 
    404  1.1  nisimura void
    405  1.1  nisimura cfb_free_screen(v, cookie)
    406  1.1  nisimura 	void *v;
    407  1.1  nisimura 	void *cookie;
    408  1.1  nisimura {
    409  1.1  nisimura 	struct cfb_softc *sc = v;
    410  1.1  nisimura 
    411  1.1  nisimura 	if (sc->sc_dc == &cfb_console_dc)
    412  1.1  nisimura 		panic("cfb_free_screen: console");
    413  1.1  nisimura 
    414  1.1  nisimura 	sc->nscreens--;
    415  1.1  nisimura }
    416  1.1  nisimura 
    417  1.1  nisimura void
    418  1.1  nisimura cfb_show_screen(v, cookie)
    419  1.1  nisimura 	void *v;
    420  1.1  nisimura 	void *cookie;
    421  1.1  nisimura {
    422  1.1  nisimura }
    423  1.1  nisimura 
    424  1.1  nisimura int
    425  1.1  nisimura cfb_load_font(v, cookie, first, num, stride, data)
    426  1.1  nisimura 	void *v;
    427  1.1  nisimura 	void *cookie;
    428  1.1  nisimura 	int first, num, stride;
    429  1.1  nisimura 	void *data;
    430  1.1  nisimura {
    431  1.1  nisimura 	return (EINVAL);
    432  1.1  nisimura }
    433  1.1  nisimura 
    434  1.1  nisimura int
    435  1.1  nisimura cfb_cnattach(addr)
    436  1.1  nisimura         tc_addr_t addr;
    437  1.1  nisimura {
    438  1.1  nisimura         struct fb_devconfig *dcp = &cfb_console_dc;
    439  1.1  nisimura         long defattr;
    440  1.1  nisimura 
    441  1.1  nisimura         cfb_getdevconfig(addr, dcp);
    442  1.1  nisimura 
    443  1.1  nisimura         rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
    444  1.1  nisimura 
    445  1.1  nisimura         wsdisplay_cnattach(&cfb_stdscreen, &dcp->dc_rcons,
    446  1.1  nisimura                            0, 0, defattr);
    447  1.1  nisimura         cfb_consaddr = addr;
    448  1.1  nisimura         return(0);
    449  1.1  nisimura }
    450  1.1  nisimura 
    451  1.1  nisimura 
    452  1.1  nisimura int
    453  1.1  nisimura cfbintr(arg)
    454  1.1  nisimura 	void *arg;
    455  1.1  nisimura {
    456  1.1  nisimura 	struct cfb_softc *sc = arg;
    457  1.1  nisimura 	caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    458  1.1  nisimura 	struct bt459reg *vdac;
    459  1.1  nisimura 	int v;
    460  1.1  nisimura 
    461  1.1  nisimura 	*(u_int8_t *)(cfbbase + CFB_OFFSET_IREQ) = 0;
    462  1.1  nisimura 	if (sc->sc_changed == 0)
    463  1.1  nisimura 		return (1);
    464  1.1  nisimura 
    465  1.1  nisimura 	vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
    466  1.1  nisimura 	v = sc->sc_changed;
    467  1.1  nisimura 	sc->sc_changed = 0;
    468  1.1  nisimura 	if (v & DATA_ENB_CHANGED) {
    469  1.1  nisimura 		BT459_SELECT(vdac, BT459_REG_CCR);
    470  1.1  nisimura 		vdac->bt_reg = (sc->sc_curenb) ? 0xc0 : 0x00;
    471  1.1  nisimura 	}
    472  1.1  nisimura 	if (v & DATA_CURCMAP_CHANGED) {
    473  1.1  nisimura 		u_int8_t *cp = sc->sc_cursor.cc_color;
    474  1.1  nisimura 
    475  1.1  nisimura 		BT459_SELECT(vdac, BT459_REG_CCOLOR_2);
    476  1.1  nisimura 		vdac->bt_cmap = cp[1];	tc_wmb();
    477  1.1  nisimura 		vdac->bt_cmap = cp[3];	tc_wmb();
    478  1.1  nisimura 		vdac->bt_cmap = cp[5];	tc_wmb();
    479  1.1  nisimura 
    480  1.1  nisimura 		BT459_SELECT(vdac, BT459_REG_CCOLOR_3);
    481  1.1  nisimura 		vdac->bt_cmap = cp[0];	tc_wmb();
    482  1.1  nisimura 		vdac->bt_cmap = cp[2];	tc_wmb();
    483  1.1  nisimura 		vdac->bt_cmap = cp[4];	tc_wmb();
    484  1.1  nisimura 	}
    485  1.1  nisimura 	if (v & DATA_CURSHAPE_CHANGED) {
    486  1.1  nisimura 		u_int8_t *bp;
    487  1.1  nisimura 		int i;
    488  1.1  nisimura 
    489  1.1  nisimura 		bp = (u_int8_t *)&sc->sc_cursor.cc_image;
    490  1.1  nisimura 		BT459_SELECT(vdac, BT459_REG_CRAM_BASE);
    491  1.1  nisimura 		for (i = 0; i < sizeof(sc->sc_cursor.cc_image); i++) {
    492  1.1  nisimura 			vdac->bt_reg = *bp++;
    493  1.1  nisimura 			tc_wmb();
    494  1.1  nisimura 		}
    495  1.1  nisimura 	}
    496  1.1  nisimura 	if (v & DATA_CMAP_CHANGED) {
    497  1.1  nisimura 		struct hwcmap *cm = &sc->sc_cmap;
    498  1.1  nisimura 		int index;
    499  1.1  nisimura 
    500  1.1  nisimura 		BT459_SELECT(vdac, 0);
    501  1.1  nisimura 		for (index = 0; index < CMAP_SIZE; index++) {
    502  1.1  nisimura 			vdac->bt_cmap = cm->r[index];
    503  1.1  nisimura 			vdac->bt_cmap = cm->g[index];
    504  1.1  nisimura 			vdac->bt_cmap = cm->b[index];
    505  1.1  nisimura 		}
    506  1.1  nisimura 	}
    507  1.1  nisimura 	return (1);
    508  1.1  nisimura }
    509  1.1  nisimura 
    510  1.1  nisimura void
    511  1.1  nisimura cfbinit(dc)
    512  1.1  nisimura 	struct fb_devconfig *dc;
    513  1.1  nisimura {
    514  1.1  nisimura 	caddr_t cfbbase = (caddr_t)dc->dc_vaddr;
    515  1.1  nisimura 	struct bt459reg *vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
    516  1.1  nisimura 	int i;
    517  1.1  nisimura 
    518  1.1  nisimura 	BT459_SELECT(vdac, 0);
    519  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    520  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    521  1.1  nisimura 	vdac->bt_cmap = 0;	tc_wmb();
    522  1.1  nisimura 	for (i = 1; i < CMAP_SIZE; i++) {
    523  1.1  nisimura 		vdac->bt_cmap = 0xff;	tc_wmb();
    524  1.1  nisimura 		vdac->bt_cmap = 0xff;	tc_wmb();
    525  1.1  nisimura 		vdac->bt_cmap = 0xff;	tc_wmb();
    526  1.1  nisimura 	}
    527  1.1  nisimura 
    528  1.1  nisimura 	BT459_SELECT(vdac, BT459_REG_COMMAND_0);
    529  1.1  nisimura 	vdac->bt_reg = 0x40; /* CMD0 */	tc_wmb();
    530  1.1  nisimura 	vdac->bt_reg = 0x0;  /* CMD1 */	tc_wmb();
    531  1.1  nisimura 	vdac->bt_reg = 0xc0; /* CMD2 */	tc_wmb();
    532  1.1  nisimura 	vdac->bt_reg = 0xff; /* PRM */	tc_wmb();
    533  1.1  nisimura 	vdac->bt_reg = 0;    /* 205 */	tc_wmb();
    534  1.1  nisimura 	vdac->bt_reg = 0x0;  /* PBM */	tc_wmb();
    535  1.1  nisimura 	vdac->bt_reg = 0;    /* 207 */	tc_wmb();
    536  1.1  nisimura 	vdac->bt_reg = 0x0;  /* ORM */	tc_wmb();
    537  1.1  nisimura 	vdac->bt_reg = 0x0;  /* OBM */	tc_wmb();
    538  1.1  nisimura 	vdac->bt_reg = 0x0;  /* ILV */	tc_wmb();
    539  1.1  nisimura 	vdac->bt_reg = 0x0;  /* TEST */	tc_wmb();
    540  1.1  nisimura 
    541  1.1  nisimura 	BT459_SELECT(vdac, BT459_REG_CCR);
    542  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    543  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    544  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    545  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    546  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    547  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    548  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    549  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    550  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    551  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    552  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    553  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    554  1.1  nisimura 	vdac->bt_reg = 0x0;	tc_wmb();
    555  1.1  nisimura }
    556  1.1  nisimura 
    557  1.1  nisimura static int
    558  1.1  nisimura get_cmap(sc, p)
    559  1.1  nisimura 	struct cfb_softc *sc;
    560  1.1  nisimura 	struct wsdisplay_cmap *p;
    561  1.1  nisimura {
    562  1.1  nisimura 	u_int index = p->index, count = p->count;
    563  1.1  nisimura 
    564  1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    565  1.1  nisimura 		return (EINVAL);
    566  1.1  nisimura 
    567  1.1  nisimura 	if (!useracc(p->red, count, B_WRITE) ||
    568  1.1  nisimura 	    !useracc(p->green, count, B_WRITE) ||
    569  1.1  nisimura 	    !useracc(p->blue, count, B_WRITE))
    570  1.1  nisimura 		return (EFAULT);
    571  1.1  nisimura 
    572  1.1  nisimura 	copyout(&sc->sc_cmap.r[index], p->red, count);
    573  1.1  nisimura 	copyout(&sc->sc_cmap.g[index], p->green, count);
    574  1.1  nisimura 	copyout(&sc->sc_cmap.b[index], p->blue, count);
    575  1.1  nisimura 
    576  1.1  nisimura 	return (0);
    577  1.1  nisimura }
    578  1.1  nisimura 
    579  1.1  nisimura static int
    580  1.1  nisimura set_cmap(sc, p)
    581  1.1  nisimura 	struct cfb_softc *sc;
    582  1.1  nisimura 	struct wsdisplay_cmap *p;
    583  1.1  nisimura {
    584  1.1  nisimura 	u_int index = p->index, count = p->count;
    585  1.1  nisimura 
    586  1.1  nisimura 	if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
    587  1.1  nisimura 		return (EINVAL);
    588  1.1  nisimura 
    589  1.1  nisimura 	if (!useracc(p->red, count, B_READ) ||
    590  1.1  nisimura 	    !useracc(p->green, count, B_READ) ||
    591  1.1  nisimura 	    !useracc(p->blue, count, B_READ))
    592  1.1  nisimura 		return (EFAULT);
    593  1.1  nisimura 
    594  1.1  nisimura 	copyin(p->red, &sc->sc_cmap.r[index], count);
    595  1.1  nisimura 	copyin(p->green, &sc->sc_cmap.g[index], count);
    596  1.1  nisimura 	copyin(p->blue, &sc->sc_cmap.b[index], count);
    597  1.1  nisimura 
    598  1.1  nisimura 	sc->sc_changed |= DATA_CMAP_CHANGED;
    599  1.1  nisimura 
    600  1.1  nisimura 	return (0);
    601  1.1  nisimura }
    602  1.1  nisimura 
    603  1.1  nisimura static int
    604  1.1  nisimura set_cursor(sc, p)
    605  1.1  nisimura 	struct cfb_softc *sc;
    606  1.1  nisimura 	struct wsdisplay_cursor *p;
    607  1.1  nisimura {
    608  1.1  nisimura #define	cc (&sc->sc_cursor)
    609  1.1  nisimura 	int v, index, count;
    610  1.1  nisimura 
    611  1.1  nisimura 	v = p->which;
    612  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    613  1.1  nisimura 		index = p->cmap.index;
    614  1.1  nisimura 		count = p->cmap.count;
    615  1.1  nisimura 		if (index >= 2 || (index + count) > 2)
    616  1.1  nisimura 			return (EINVAL);
    617  1.1  nisimura 		if (!useracc(p->cmap.red, count, B_READ) ||
    618  1.1  nisimura 		    !useracc(p->cmap.green, count, B_READ) ||
    619  1.1  nisimura 		    !useracc(p->cmap.blue, count, B_READ))
    620  1.1  nisimura 			return (EFAULT);
    621  1.1  nisimura 	}
    622  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    623  1.1  nisimura 		if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
    624  1.1  nisimura 			return (EINVAL);
    625  1.1  nisimura 		count = (CURSOR_MAX_SIZE / NBBY) * p->size.y;
    626  1.1  nisimura 		if (!useracc(p->image, count, B_READ) ||
    627  1.1  nisimura 		    !useracc(p->mask, count, B_READ))
    628  1.1  nisimura 			return (EFAULT);
    629  1.1  nisimura 	}
    630  1.1  nisimura 	if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) {
    631  1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOCUR)
    632  1.1  nisimura 			cc->cc_hot = p->hot;
    633  1.1  nisimura 		if (v & WSDISPLAY_CURSOR_DOPOS)
    634  1.1  nisimura 			set_curpos(sc, &p->pos);
    635  1.1  nisimura 		bt459_set_curpos(sc);
    636  1.1  nisimura 	}
    637  1.1  nisimura 
    638  1.1  nisimura 	sc->sc_changed = 0;
    639  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCUR) {
    640  1.1  nisimura 		sc->sc_curenb = p->enable;
    641  1.1  nisimura 		sc->sc_changed |= DATA_ENB_CHANGED;
    642  1.1  nisimura 	}
    643  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOCMAP) {
    644  1.1  nisimura 		count = p->cmap.count;
    645  1.1  nisimura 		copyin(p->cmap.red, &cc->cc_color[index], count);
    646  1.1  nisimura 		copyin(p->cmap.green, &cc->cc_color[index + 2], count);
    647  1.1  nisimura 		copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
    648  1.1  nisimura 		sc->sc_changed |= DATA_CURCMAP_CHANGED;
    649  1.1  nisimura 	}
    650  1.1  nisimura 	if (v & WSDISPLAY_CURSOR_DOSHAPE) {
    651  1.1  nisimura 		cc->cc_size = p->size;
    652  1.1  nisimura 		memset(cc->cc_image, 0, sizeof cc->cc_image);
    653  1.1  nisimura 		copyin(p->image, (caddr_t)cc->cc_image, count);
    654  1.1  nisimura 		copyin(p->mask, (caddr_t)(cc->cc_image+CURSOR_MAX_SIZE), count);
    655  1.1  nisimura 		sc->sc_changed |= DATA_CURSHAPE_CHANGED;
    656  1.1  nisimura 	}
    657  1.1  nisimura 
    658  1.1  nisimura 	return (0);
    659  1.1  nisimura #undef cc
    660  1.1  nisimura }
    661  1.1  nisimura 
    662  1.1  nisimura static int
    663  1.1  nisimura get_cursor(sc, p)
    664  1.1  nisimura 	struct cfb_softc *sc;
    665  1.1  nisimura 	struct wsdisplay_cursor *p;
    666  1.1  nisimura {
    667  1.1  nisimura 	return (ENOTTY); /* XXX */
    668  1.1  nisimura }
    669  1.1  nisimura 
    670  1.1  nisimura static void
    671  1.1  nisimura set_curpos(sc, curpos)
    672  1.1  nisimura 	struct cfb_softc *sc;
    673  1.1  nisimura 	struct wsdisplay_curpos *curpos;
    674  1.1  nisimura {
    675  1.1  nisimura 	struct fb_devconfig *dc = sc->sc_dc;
    676  1.1  nisimura 	int x = curpos->x, y = curpos->y;
    677  1.1  nisimura 
    678  1.1  nisimura 	if (y < 0)
    679  1.1  nisimura 		y = 0;
    680  1.1  nisimura 	else if (y > dc->dc_ht - sc->sc_cursor.cc_size.y - 1)
    681  1.1  nisimura 		y = dc->dc_ht - sc->sc_cursor.cc_size.y - 1;
    682  1.1  nisimura 	if (x < 0)
    683  1.1  nisimura 		x = 0;
    684  1.1  nisimura 	else if (x > dc->dc_wid - sc->sc_cursor.cc_size.x - 1)
    685  1.1  nisimura 		x = dc->dc_wid - sc->sc_cursor.cc_size.x - 1;
    686  1.1  nisimura 	sc->sc_cursor.cc_pos.x = x;
    687  1.1  nisimura 	sc->sc_cursor.cc_pos.y = y;
    688  1.1  nisimura }
    689  1.1  nisimura 
    690  1.1  nisimura void
    691  1.1  nisimura bt459_set_curpos(sc)
    692  1.1  nisimura 	struct cfb_softc *sc;
    693  1.1  nisimura {
    694  1.1  nisimura 	caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
    695  1.1  nisimura 	struct bt459reg *vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
    696  1.1  nisimura 	int x = 220, y = 35; /* magic offset of CX coordinate */
    697  1.1  nisimura 	int s;
    698  1.1  nisimura 
    699  1.1  nisimura 	x += sc->sc_cursor.cc_pos.x;
    700  1.1  nisimura 	y += sc->sc_cursor.cc_pos.y;
    701  1.1  nisimura 
    702  1.1  nisimura 	s = spltty();
    703  1.1  nisimura 
    704  1.1  nisimura 	BT459_SELECT(vdac, BT459_REG_CURSOR_X_LOW);
    705  1.1  nisimura 	vdac->bt_reg = x;	tc_wmb();
    706  1.1  nisimura 	vdac->bt_reg = x >> 8;	tc_wmb();
    707  1.1  nisimura 	vdac->bt_reg = y;	tc_wmb();
    708  1.1  nisimura 	vdac->bt_reg = y >> 8;	tc_wmb();
    709  1.1  nisimura 
    710  1.1  nisimura 	splx(s);
    711  1.1  nisimura }
    712