Home | History | Annotate | Line # | Download | only in ibus
pm.c revision 1.6.2.1
      1  1.6.2.1  wrstuden /*	$NetBSD: pm.c,v 1.6.2.1 2008/06/23 04:30:37 wrstuden Exp $	*/
      2      1.2        ad 
      3      1.2        ad /*-
      4      1.2        ad  * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc.
      5      1.2        ad  * All rights reserved.
      6      1.2        ad  *
      7      1.2        ad  * This code is derived from software contributed to The NetBSD Foundation
      8      1.2        ad  * by Andrew Doran.
      9      1.2        ad  *
     10      1.2        ad  * Redistribution and use in source and binary forms, with or without
     11      1.2        ad  * modification, are permitted provided that the following conditions
     12      1.2        ad  * are met:
     13      1.2        ad  * 1. Redistributions of source code must retain the above copyright
     14      1.2        ad  *    notice, this list of conditions and the following disclaimer.
     15      1.2        ad  * 2. Redistributions in binary form must reproduce the above copyright
     16      1.2        ad  *    notice, this list of conditions and the following disclaimer in the
     17      1.2        ad  *    documentation and/or other materials provided with the distribution.
     18      1.2        ad  *
     19      1.2        ad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20      1.2        ad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21      1.2        ad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22      1.2        ad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23      1.2        ad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24      1.2        ad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25      1.2        ad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26      1.2        ad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27      1.2        ad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28      1.2        ad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29      1.2        ad  * POSSIBILITY OF SUCH DAMAGE.
     30      1.2        ad  */
     31      1.2        ad 
     32      1.2        ad #include <sys/cdefs.h>
     33  1.6.2.1  wrstuden __KERNEL_RCSID(0, "$NetBSD: pm.c,v 1.6.2.1 2008/06/23 04:30:37 wrstuden Exp $");
     34      1.2        ad 
     35      1.2        ad #include <sys/param.h>
     36      1.2        ad #include <sys/systm.h>
     37      1.2        ad #include <sys/kernel.h>
     38      1.2        ad #include <sys/device.h>
     39      1.2        ad #include <sys/buf.h>
     40      1.2        ad #include <sys/ioctl.h>
     41      1.2        ad 
     42      1.2        ad #include <machine/bus.h>
     43      1.2        ad #include <machine/intr.h>
     44      1.2        ad 
     45      1.2        ad #include <dev/wscons/wsconsio.h>
     46      1.2        ad #include <dev/wscons/wsdisplayvar.h>
     47      1.2        ad #include <dev/rasops/rasops.h>
     48      1.2        ad #include <dev/wsfont/wsfont.h>
     49      1.2        ad 
     50      1.2        ad #include <pmax/pmax/kn01.h>
     51      1.2        ad 
     52      1.2        ad #include <pmax/ibus/ibusvar.h>
     53      1.2        ad #include <pmax/ibus/pmreg.h>
     54      1.2        ad 
     55      1.2        ad #include <uvm/uvm_extern.h>
     56      1.2        ad 
     57      1.2        ad #define	CURSOR_MAX_SIZE	16
     58      1.2        ad 
     59      1.2        ad struct hwcmap256 {
     60      1.2        ad 	uint8_t r[256];
     61      1.2        ad 	uint8_t g[256];
     62      1.2        ad 	uint8_t b[256];
     63      1.2        ad };
     64      1.2        ad 
     65      1.2        ad struct hwcursor64 {
     66      1.2        ad 	struct wsdisplay_curpos cc_pos;
     67      1.2        ad 	struct wsdisplay_curpos cc_hot;
     68      1.2        ad 	struct wsdisplay_curpos cc_size;
     69      1.2        ad 	uint8_t cc_color[6];
     70      1.2        ad 
     71      1.2        ad 	/*
     72      1.2        ad 	 * Max cursor size is 16x16.  The X server pads bitmap scanlines to
     73      1.2        ad 	 * a word boundary.  We take the easy route and waste some space.
     74      1.2        ad 	 */
     75      1.2        ad 	u_short cc_image[32 + 32];
     76      1.2        ad };
     77      1.2        ad 
     78      1.2        ad struct pm_softc {
     79      1.2        ad 	struct device		sc_dev;
     80      1.2        ad 	size_t			sc_cmap_size;
     81      1.2        ad 	size_t			sc_fb_size;
     82      1.2        ad 	int			sc_type;
     83      1.2        ad 	int			sc_blanked;
     84      1.2        ad 	int			sc_curenb;
     85      1.2        ad 	int			sc_changed;
     86      1.2        ad 	int			sc_nscreens;
     87      1.2        ad 	struct hwcursor64	sc_cursor;
     88      1.2        ad 	struct hwcmap256	sc_cmap;
     89      1.2        ad };
     90      1.2        ad #define	WSDISPLAY_CMAP_DOLUT	0x20
     91      1.2        ad 
     92      1.2        ad int	pm_match(struct device *, struct cfdata *, void *);
     93      1.2        ad void	pm_attach(struct device *, struct device *, void *);
     94      1.5  christos int	pm_ioctl(void *, void *, u_long, void *, int, struct lwp *);
     95      1.4      jmmv paddr_t	pm_mmap(void *, void *, off_t, int);
     96      1.2        ad int	pm_alloc_screen(void *, const struct wsscreen_descr *,
     97      1.2        ad 				void **, int *, int *, long *);
     98      1.2        ad void	pm_free_screen(void *, void *);
     99      1.2        ad int	pm_show_screen(void *, void *, int,
    100      1.2        ad 			       void (*) (void *, int, int), void *);
    101      1.2        ad void	pm_cursor_off(void);
    102      1.2        ad void	pm_cursor_on(struct pm_softc *);
    103      1.2        ad int	pm_cnattach(void);
    104      1.2        ad void	pm_common_init(void);
    105      1.2        ad int	pm_flush(struct pm_softc *);
    106      1.2        ad int	pm_get_cmap(struct pm_softc *, struct wsdisplay_cmap *);
    107      1.2        ad int	pm_set_cmap(struct pm_softc *, struct wsdisplay_cmap *);
    108      1.2        ad int	pm_set_cursor(struct pm_softc *, struct wsdisplay_cursor *);
    109      1.2        ad int	pm_get_cursor(struct pm_softc *, struct wsdisplay_cursor *);
    110      1.2        ad void	pm_set_curpos(struct pm_softc *, struct wsdisplay_curpos *);
    111      1.2        ad void	pm_init_cmap(struct pm_softc *);
    112      1.2        ad 
    113      1.2        ad CFATTACH_DECL(pm, sizeof(struct pm_softc),
    114      1.2        ad    pm_match, pm_attach, NULL, NULL);
    115      1.2        ad 
    116      1.2        ad struct rasops_info pm_ri;
    117      1.2        ad 
    118      1.2        ad struct wsscreen_descr pm_stdscreen = {
    119      1.2        ad 	"std", 0, 0,
    120      1.2        ad 	0, /* textops */
    121      1.2        ad 	0, 0,
    122      1.2        ad 	WSSCREEN_REVERSE
    123      1.2        ad };
    124      1.2        ad 
    125      1.2        ad const struct wsscreen_descr *_pm_scrlist[] = {
    126      1.2        ad 	&pm_stdscreen,
    127      1.2        ad };
    128      1.2        ad 
    129      1.2        ad const struct wsscreen_list pm_screenlist = {
    130      1.2        ad 	sizeof(_pm_scrlist) / sizeof(struct wsscreen_descr *), _pm_scrlist
    131      1.2        ad };
    132      1.2        ad 
    133      1.2        ad const struct wsdisplay_accessops pm_accessops = {
    134      1.2        ad 	pm_ioctl,
    135      1.2        ad 	pm_mmap,
    136      1.2        ad 	pm_alloc_screen,
    137      1.2        ad 	pm_free_screen,
    138      1.2        ad 	pm_show_screen,
    139      1.2        ad 	0 /* load_font */
    140      1.2        ad };
    141      1.2        ad 
    142      1.2        ad u_int	pm_creg;
    143      1.2        ad 
    144      1.2        ad int
    145      1.2        ad pm_match(struct device *parent, struct cfdata *match, void *aux)
    146      1.2        ad {
    147      1.2        ad 	struct ibus_attach_args *ia;
    148      1.5  christos 	void *pmaddr;
    149      1.2        ad 
    150      1.2        ad 	ia = aux;
    151      1.5  christos 	pmaddr = (void *)ia->ia_addr;
    152      1.2        ad 
    153      1.2        ad 	if (strcmp(ia->ia_name, "pm") != 0)
    154      1.2        ad 		return (0);
    155      1.2        ad 
    156      1.2        ad 	if (badaddr(pmaddr, 4))
    157      1.2        ad 		return (0);
    158      1.2        ad 
    159      1.2        ad 	return (1);
    160      1.2        ad }
    161      1.2        ad 
    162      1.2        ad void
    163      1.2        ad pm_attach(struct device *parent, struct device *self, void *aux)
    164      1.2        ad {
    165      1.2        ad 	struct pm_softc *sc;
    166      1.2        ad 	struct rasops_info *ri;
    167      1.2        ad 	struct wsemuldisplaydev_attach_args waa;
    168      1.2        ad 	int console;
    169      1.2        ad 
    170      1.2        ad 	sc = (struct pm_softc *)self;
    171      1.2        ad 	ri = &pm_ri;
    172      1.2        ad 	console = (ri->ri_bits != NULL);
    173      1.2        ad 
    174      1.2        ad 	if (console)
    175      1.2        ad 		sc->sc_nscreens = 1;
    176      1.2        ad 	else
    177      1.2        ad 		pm_common_init();
    178      1.2        ad 
    179      1.2        ad 	printf(": %dx%d, %dbpp\n", ri->ri_width, ri->ri_height, ri->ri_depth);
    180      1.2        ad 
    181      1.2        ad 	pm_init_cmap(sc);
    182      1.2        ad 
    183      1.2        ad 	sc->sc_blanked = 0;
    184      1.2        ad 	sc->sc_curenb = 0;
    185      1.2        ad 
    186      1.2        ad 	waa.console = console;
    187      1.2        ad 	waa.scrdata = &pm_screenlist;
    188      1.2        ad 	waa.accessops = &pm_accessops;
    189      1.2        ad 	waa.accesscookie = sc;
    190      1.2        ad 
    191      1.2        ad 	config_found(self, &waa, wsemuldisplaydevprint);
    192      1.2        ad }
    193      1.2        ad 
    194      1.2        ad void
    195      1.2        ad pm_init_cmap(struct pm_softc *sc)
    196      1.2        ad {
    197      1.2        ad 	struct hwcmap256 *cm;
    198      1.2        ad 	struct rasops_info *ri;
    199      1.2        ad 	const uint8_t *p;
    200      1.2        ad 	int index;
    201      1.2        ad 
    202      1.2        ad 	cm = &sc->sc_cmap;
    203      1.2        ad 	ri = &pm_ri;
    204      1.2        ad 
    205      1.2        ad 	if (ri->ri_depth == 8) {
    206      1.2        ad 		p = rasops_cmap;
    207      1.2        ad 		for (index = 0; index < 256; index++, p += 3) {
    208      1.2        ad 			cm->r[index] = p[0];
    209      1.2        ad 			cm->g[index] = p[1];
    210      1.2        ad 			cm->b[index] = p[2];
    211      1.2        ad 		}
    212      1.2        ad 
    213      1.2        ad 		sc->sc_type = WSDISPLAY_TYPE_PM_COLOR;
    214      1.2        ad 		sc->sc_cmap_size = 256;
    215      1.2        ad 		sc->sc_fb_size = 0x100000;
    216      1.2        ad 	} else {
    217      1.2        ad 		cm->r[0] = 0x00;
    218      1.2        ad 		cm->g[0] = 0x00;
    219      1.2        ad 		cm->b[0] = 0x00;
    220      1.2        ad 
    221      1.2        ad 		cm->r[1] = 0x00;
    222      1.2        ad 		cm->g[1] = 0xff;
    223      1.2        ad 		cm->b[1] = 0x00;
    224      1.2        ad 
    225      1.2        ad 		sc->sc_type = WSDISPLAY_TYPE_PM_MONO;
    226      1.2        ad 		sc->sc_cmap_size = 2;
    227      1.2        ad 		sc->sc_fb_size = 0x40000;
    228      1.2        ad 	}
    229      1.2        ad }
    230      1.2        ad 
    231      1.2        ad void
    232      1.2        ad pm_common_init(void)
    233      1.2        ad {
    234      1.2        ad 	struct rasops_info *ri;
    235      1.2        ad 	int cookie, bior, i;
    236      1.2        ad 	PCCRegs *pcc;
    237      1.2        ad 	VDACRegs *vdac;
    238      1.2        ad 	uint16_t kn01csr;
    239      1.2        ad 
    240      1.2        ad 	kn01csr = *(volatile uint16_t *)MIPS_PHYS_TO_KSEG1(KN01_SYS_CSR);
    241      1.2        ad 	pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
    242      1.2        ad 	vdac = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_VDAC);
    243      1.2        ad 	ri = &pm_ri;
    244      1.2        ad 
    245      1.2        ad 	ri->ri_flg = RI_CENTER;
    246      1.2        ad 	ri->ri_depth = ((kn01csr & KN01_CSR_MONO) != 0 ? 1 : 8);
    247      1.2        ad 	ri->ri_width = 1024;
    248      1.2        ad 	ri->ri_height = 864;
    249      1.2        ad 	ri->ri_stride = (ri->ri_depth == 8 ? 1024 : 2048 / 8);
    250      1.2        ad 	ri->ri_bits = (void *)MIPS_PHYS_TO_KSEG1(KN01_PHYS_FBUF_START);
    251      1.2        ad 
    252      1.2        ad 	/*
    253      1.2        ad 	 * Clear the screen.
    254      1.2        ad 	 */
    255      1.2        ad 	memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    256      1.2        ad 
    257      1.2        ad 	/*
    258      1.2        ad 	 * Get a font to use.
    259      1.2        ad 	 */
    260      1.2        ad 	bior = (ri->ri_depth == 8 ? WSDISPLAY_FONTORDER_L2R :
    261      1.2        ad 	    WSDISPLAY_FONTORDER_R2L);
    262      1.2        ad 
    263      1.2        ad 	wsfont_init();
    264      1.2        ad 	if (ri->ri_depth == 8)
    265      1.2        ad 		cookie = wsfont_find(NULL, 12, 0, 0, bior,
    266      1.2        ad 		    WSDISPLAY_FONTORDER_L2R);
    267      1.2        ad 	else
    268      1.2        ad 		cookie = wsfont_find(NULL, 8, 0, 0, bior,
    269      1.2        ad 		    WSDISPLAY_FONTORDER_L2R);
    270      1.2        ad 	if (cookie <= 0)
    271      1.2        ad 		cookie = wsfont_find(NULL, 0, 0, 0, bior,
    272      1.2        ad 		    WSDISPLAY_FONTORDER_L2R);
    273      1.2        ad 	if (cookie <= 0) {
    274      1.2        ad 		printf("pm: font table is empty\n");
    275      1.2        ad 		return;
    276      1.2        ad 	}
    277      1.2        ad 
    278      1.2        ad 	if (wsfont_lock(cookie, &ri->ri_font)) {
    279      1.2        ad 		printf("pm: couldn't lock font\n");
    280      1.2        ad 		return;
    281      1.2        ad 	}
    282      1.2        ad 	ri->ri_wsfcookie = cookie;
    283      1.2        ad 
    284      1.2        ad 	/*
    285      1.2        ad 	 * Set up the raster operations set.
    286      1.2        ad 	 */
    287      1.2        ad 	rasops_init(ri, 1000, 1000);
    288      1.2        ad 
    289      1.2        ad 	pm_stdscreen.nrows = ri->ri_rows;
    290      1.2        ad 	pm_stdscreen.ncols = ri->ri_cols;
    291      1.2        ad 	pm_stdscreen.textops = &ri->ri_ops;
    292      1.2        ad 	pm_stdscreen.capabilities = ri->ri_caps;
    293      1.2        ad 
    294      1.2        ad 	/*
    295      1.2        ad 	 * Initalize the VDAC.
    296      1.2        ad 	 */
    297      1.2        ad 	*(uint8_t *)MIPS_PHYS_TO_KSEG1(KN01_PHYS_COLMASK_START) = 0xff;
    298      1.2        ad 	wbflush();
    299      1.2        ad 
    300      1.2        ad 	vdac->overWA = 0x04; wbflush();
    301      1.2        ad 	vdac->over = 0x00; wbflush();
    302      1.2        ad 	vdac->over = 0x00; wbflush();
    303      1.2        ad 	vdac->over = 0x00; wbflush();
    304      1.2        ad 	vdac->overWA = 0x08; wbflush();
    305      1.2        ad 	vdac->over = 0x00; wbflush();
    306      1.2        ad 	vdac->over = 0x00; wbflush();
    307      1.2        ad 	vdac->over = 0x7f; wbflush();
    308      1.2        ad 	vdac->overWA = 0x0c; wbflush();
    309      1.2        ad 	vdac->over = 0xff; wbflush();
    310      1.2        ad 	vdac->over = 0xff; wbflush();
    311      1.2        ad 	vdac->over = 0xff; wbflush();
    312      1.2        ad 
    313      1.2        ad 	/*
    314      1.2        ad 	 * Set in the initial colormap.
    315      1.2        ad 	 */
    316      1.2        ad 	if (ri->ri_depth == 8) {
    317      1.2        ad 		vdac->mapWA = 0;
    318      1.2        ad 		wbflush();
    319      1.2        ad 
    320      1.2        ad 		for (i = 0; i < 256 * 3; i += 3) {
    321      1.2        ad 			vdac->map = rasops_cmap[i];
    322      1.2        ad 			wbflush();
    323      1.2        ad 			vdac->map = rasops_cmap[i + 1];
    324      1.2        ad 			wbflush();
    325      1.2        ad 			vdac->map = rasops_cmap[i + 2];
    326      1.2        ad 			wbflush();
    327      1.2        ad 		}
    328      1.2        ad 	} else {
    329      1.2        ad 		vdac->mapWA = 0;
    330      1.2        ad 		wbflush();
    331      1.2        ad 
    332      1.2        ad 		for (i = 0; i < 256; i++) {
    333      1.2        ad 			vdac->map = 0x00;
    334      1.2        ad 			wbflush();
    335      1.2        ad 			vdac->map = (i < 128 ? 0x00 : 0xff);
    336      1.2        ad 			wbflush();
    337      1.2        ad 			vdac->map = 0x00;
    338      1.2        ad 			wbflush();
    339      1.2        ad 		}
    340      1.2        ad 	}
    341      1.2        ad 
    342      1.2        ad 	/*
    343      1.2        ad 	 * Turn off the hardware cursor sprite for text mode.
    344      1.2        ad 	 */
    345      1.2        ad 	pcc->cmdr = PCC_FOPB | PCC_VBHI;
    346      1.2        ad 	wbflush();
    347      1.2        ad 	pm_creg = 0;
    348      1.2        ad 	pm_cursor_off();
    349      1.2        ad }
    350      1.2        ad 
    351      1.2        ad void
    352      1.2        ad pm_cursor_off(void)
    353      1.2        ad {
    354      1.2        ad 	PCCRegs *pcc;
    355      1.2        ad 
    356      1.2        ad 	pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
    357      1.2        ad 	pcc->cmdr = (pm_creg &= ~(PCC_ENPA | PCC_ENPB));
    358      1.2        ad 	wbflush();
    359      1.2        ad }
    360      1.2        ad 
    361      1.2        ad void
    362      1.2        ad pm_cursor_on(struct pm_softc *sc)
    363      1.2        ad {
    364      1.2        ad 	PCCRegs *pcc;
    365      1.2        ad 
    366      1.2        ad 	if (sc->sc_curenb) {
    367      1.2        ad 		pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
    368      1.2        ad 		pcc->cmdr = (pm_creg |= (PCC_ENPA | PCC_ENPB));
    369      1.2        ad 		wbflush();
    370      1.2        ad 	}
    371      1.2        ad }
    372      1.2        ad 
    373      1.2        ad int
    374      1.5  christos pm_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
    375      1.2        ad {
    376      1.2        ad 	struct pm_softc *sc;
    377      1.2        ad 	struct rasops_info *ri;
    378      1.2        ad 	int turnoff, rv, i;
    379      1.2        ad 	PCCRegs *pcc;
    380      1.2        ad 	VDACRegs *vdac;
    381      1.2        ad 
    382      1.2        ad 	sc = v;
    383      1.2        ad 	ri = &pm_ri;
    384      1.2        ad 	rv = 0;
    385      1.2        ad 	pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
    386      1.2        ad 	vdac = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_VDAC);
    387      1.2        ad 
    388      1.2        ad 	switch (cmd) {
    389      1.2        ad 	case WSDISPLAYIO_GTYPE:
    390      1.2        ad 		*(u_int *)data = sc->sc_type;
    391      1.2        ad 		break;
    392      1.2        ad 
    393      1.2        ad 	case WSDISPLAYIO_SMODE:
    394      1.2        ad 		if (*(u_int *)data == WSDISPLAYIO_MODE_EMUL) {
    395      1.2        ad 			pm_cursor_off();
    396      1.2        ad 			pm_init_cmap(sc);
    397      1.2        ad 			memset(ri->ri_bits, 0, ri->ri_stride * ri->ri_height);
    398      1.2        ad 			sc->sc_curenb = 0;
    399      1.2        ad 			sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
    400      1.2        ad 		}
    401      1.2        ad 		break;
    402      1.2        ad 
    403      1.2        ad 	case WSDISPLAYIO_GINFO:
    404      1.2        ad #define	wsd_fbip ((struct wsdisplay_fbinfo *)data)
    405      1.2        ad 		wsd_fbip->height = ri->ri_height;
    406      1.2        ad 		wsd_fbip->width = ri->ri_width;
    407      1.2        ad 		wsd_fbip->depth = ri->ri_depth;
    408      1.2        ad 		wsd_fbip->cmsize = sc->sc_cmap_size;
    409      1.2        ad #undef fbt
    410      1.2        ad 		break;
    411      1.2        ad 
    412      1.2        ad 	case WSDISPLAYIO_GETCMAP:
    413      1.2        ad 		rv = pm_get_cmap(sc, (struct wsdisplay_cmap *)data);
    414      1.2        ad 		break;
    415      1.2        ad 
    416      1.2        ad 	case WSDISPLAYIO_PUTCMAP:
    417      1.2        ad 		rv = pm_set_cmap(sc, (struct wsdisplay_cmap *)data);
    418      1.2        ad 		break;
    419      1.2        ad 
    420      1.2        ad 	case WSDISPLAYIO_SVIDEO:
    421      1.2        ad 		turnoff = (*(int *)data == WSDISPLAYIO_VIDEO_OFF);
    422      1.2        ad 		if ((sc->sc_blanked == 0) ^ turnoff) {
    423      1.2        ad 			sc->sc_blanked = turnoff;
    424      1.2        ad 			if (turnoff == 0) {
    425      1.2        ad 				pcc->cmdr =
    426      1.2        ad 				    (pm_creg &= ~(PCC_FOPA | PCC_FOPB));
    427      1.2        ad 				wbflush();
    428      1.2        ad 				pm_cursor_on(sc);
    429      1.2        ad 				sc->sc_changed |= WSDISPLAY_CURSOR_DOCMAP;
    430      1.2        ad 			} else {
    431      1.2        ad 				pm_cursor_off();
    432      1.2        ad 				pcc->cmdr =
    433      1.2        ad 				    (pm_creg |= (PCC_FOPA | PCC_FOPB));
    434      1.2        ad 				wbflush();
    435      1.2        ad 				vdac->overWA = 0x0c;
    436      1.2        ad 				wbflush();
    437      1.2        ad 				for (i = 0; i < 3; i++) {
    438      1.2        ad 					vdac->over = 0;
    439      1.2        ad 					wbflush();
    440      1.2        ad 				}
    441      1.2        ad 			}
    442      1.2        ad 		}
    443      1.2        ad 		break;
    444      1.2        ad 
    445      1.2        ad 	case WSDISPLAYIO_GVIDEO:
    446      1.2        ad 		*(u_int *)data = (sc->sc_blanked ?
    447      1.2        ad 		    WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON);
    448      1.2        ad 		break;
    449      1.2        ad 
    450      1.2        ad 	case WSDISPLAYIO_GCURPOS:
    451      1.2        ad 		*(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
    452      1.2        ad 		break;
    453      1.2        ad 
    454      1.2        ad 	case WSDISPLAYIO_SCURPOS:
    455      1.2        ad 		pm_set_curpos(sc, (struct wsdisplay_curpos *)data);
    456      1.2        ad 		sc->sc_changed |= WSDISPLAY_CURSOR_DOPOS;
    457      1.2        ad 		break;
    458      1.2        ad 
    459      1.2        ad 	case WSDISPLAYIO_GCURMAX:
    460      1.2        ad 		((struct wsdisplay_curpos *)data)->x =
    461      1.2        ad 		((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
    462      1.2        ad 		break;
    463      1.2        ad 
    464      1.2        ad 	case WSDISPLAYIO_GCURSOR:
    465      1.2        ad 		rv = pm_get_cursor(sc, (struct wsdisplay_cursor *)data);
    466      1.2        ad 		break;
    467      1.2        ad 
    468      1.2        ad 	case WSDISPLAYIO_SCURSOR:
    469      1.2        ad 		rv = pm_set_cursor(sc, (struct wsdisplay_cursor *)data);
    470      1.2        ad 		break;
    471      1.2        ad 
    472      1.2        ad 	default:
    473      1.2        ad 		rv = ENOTTY;
    474      1.2        ad 		break;
    475      1.2        ad 	}
    476      1.2        ad 
    477      1.2        ad 	pm_flush(sc);
    478      1.2        ad 	return (rv);
    479      1.2        ad }
    480      1.2        ad 
    481      1.2        ad paddr_t
    482      1.4      jmmv pm_mmap(void *v, void *vs, off_t offset, int prot)
    483      1.2        ad {
    484      1.2        ad 	struct pm_softc *sc;
    485      1.2        ad 
    486      1.2        ad 	sc = v;
    487      1.2        ad 
    488      1.2        ad 	if (offset >= sc->sc_fb_size || offset < 0)
    489      1.2        ad 		return (-1);
    490      1.2        ad 
    491      1.2        ad 	return (mips_btop(KN01_PHYS_FBUF_START + offset));
    492      1.2        ad }
    493      1.2        ad 
    494      1.2        ad int
    495      1.2        ad pm_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
    496      1.2        ad 		int *curxp, int *curyp, long *attrp)
    497      1.2        ad {
    498      1.2        ad 	struct pm_softc *sc;
    499      1.2        ad 	struct rasops_info *ri;
    500      1.2        ad 	long defattr;
    501      1.2        ad 
    502      1.2        ad 	sc = v;
    503      1.2        ad 	ri = &pm_ri;
    504      1.2        ad 
    505      1.2        ad 	if (sc->sc_nscreens > 0)
    506      1.2        ad 		return (ENOMEM);
    507      1.2        ad 
    508      1.2        ad 	*cookiep = ri;	 /* one and only for now */
    509      1.2        ad 	*curxp = 0;
    510      1.2        ad 	*curyp = 0;
    511      1.2        ad 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    512      1.2        ad 	*attrp = defattr;
    513      1.2        ad 	sc->sc_nscreens++;
    514      1.2        ad 	return (0);
    515      1.2        ad }
    516      1.2        ad 
    517      1.2        ad void
    518      1.2        ad pm_free_screen(void *v, void *cookie)
    519      1.2        ad {
    520      1.2        ad 
    521      1.2        ad 	panic("pm_free_screen: console");
    522      1.2        ad }
    523      1.2        ad 
    524      1.2        ad int
    525      1.2        ad pm_show_screen(void *v, void *cookie, int waitok,
    526      1.2        ad 	       void (*cb)(void *, int, int), void *cbarg)
    527      1.2        ad {
    528      1.2        ad 
    529      1.2        ad 	return (0);
    530      1.2        ad }
    531      1.2        ad 
    532      1.2        ad /* EXPORT */ int
    533      1.2        ad pm_cnattach(void)
    534      1.2        ad {
    535      1.2        ad 	struct rasops_info *ri;
    536      1.2        ad 	long defattr;
    537      1.2        ad 
    538      1.2        ad 	ri = &pm_ri;
    539      1.2        ad 
    540      1.2        ad 	pm_common_init();
    541      1.2        ad 	(*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
    542      1.2        ad 	wsdisplay_cnattach(&pm_stdscreen, ri, 0, 0, defattr);
    543      1.2        ad 	return (1);
    544      1.2        ad }
    545      1.2        ad 
    546      1.2        ad int
    547      1.2        ad pm_flush(struct pm_softc *sc)
    548      1.2        ad {
    549      1.2        ad 	VDACRegs *vdac;
    550      1.2        ad 	PCCRegs *pcc;
    551      1.2        ad 	uint8_t *cp;
    552      1.2        ad 	int v, i, x, y;
    553      1.2        ad 	u_short *p, *pe;
    554      1.2        ad 	struct hwcmap256 *cm;
    555      1.2        ad 	struct rasops_info *ri;
    556      1.2        ad 
    557      1.2        ad 	if (sc->sc_changed == 0)
    558      1.2        ad 		return (1);
    559      1.2        ad 
    560      1.2        ad 	vdac = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_VDAC);
    561      1.2        ad 	pcc = (void *)MIPS_PHYS_TO_KSEG1(KN01_SYS_PCC);
    562      1.2        ad 	ri = &pm_ri;
    563      1.2        ad 	v = sc->sc_changed;
    564      1.2        ad 
    565      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOCUR) != 0) {
    566      1.2        ad 		if (sc->sc_curenb)
    567      1.2        ad 			pm_cursor_on(sc);
    568      1.2        ad 		else
    569      1.2        ad 			pm_cursor_off();
    570      1.2        ad 	}
    571      1.2        ad 
    572      1.2        ad 	if ((v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) != 0) {
    573      1.2        ad 		x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
    574      1.2        ad 		y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
    575      1.2        ad 		pcc->xpos = x + PCC_X_OFFSET;
    576      1.2        ad 		pcc->ypos = y + PCC_Y_OFFSET;
    577      1.2        ad 		wbflush();
    578      1.2        ad 	}
    579      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOCMAP) != 0) {
    580      1.2        ad 		cp = sc->sc_cursor.cc_color;
    581      1.2        ad 
    582      1.2        ad 		vdac->overWA = 0x04;
    583      1.2        ad 		wbflush();
    584      1.2        ad 		for (i = 1; i < 6; i += 2) {
    585      1.2        ad 			vdac->over = cp[i];
    586      1.2        ad 			wbflush();
    587      1.2        ad 		}
    588      1.2        ad 
    589      1.2        ad 		vdac->overWA = 0x08;
    590      1.2        ad 		wbflush();
    591      1.2        ad 		vdac->over = 0x00;
    592      1.2        ad 		wbflush();
    593      1.2        ad 		vdac->over = 0x00;
    594      1.2        ad 		wbflush();
    595      1.2        ad 		vdac->over = 0x7f;
    596      1.2        ad 		wbflush();
    597      1.2        ad 
    598      1.2        ad 		vdac->overWA = 0x0c;
    599      1.2        ad 		wbflush();
    600      1.2        ad 		for (i = 0; i < 6; i += 2) {
    601      1.2        ad 			vdac->over = cp[i];
    602      1.2        ad 			wbflush();
    603      1.2        ad 		}
    604      1.2        ad 	}
    605      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOSHAPE) != 0) {
    606      1.2        ad 		pcc->cmdr = (pm_creg | PCC_LODSA);
    607      1.2        ad 		wbflush();
    608      1.2        ad 
    609      1.2        ad 		p = sc->sc_cursor.cc_image;
    610      1.2        ad 		x = 0xffff >> (16 - sc->sc_cursor.cc_size.x);
    611      1.2        ad 		for (pe = p + 64; p < pe; p += 2) {
    612      1.2        ad 			pcc->memory = *p & x;
    613      1.2        ad 			wbflush();
    614      1.2        ad 		}
    615      1.2        ad 
    616      1.2        ad 		pcc->cmdr = (pm_creg &= ~PCC_LODSA);
    617      1.2        ad 		wbflush();
    618      1.2        ad 	}
    619      1.2        ad 
    620      1.2        ad 	if ((v & WSDISPLAY_CMAP_DOLUT) != 0) {
    621      1.2        ad 		cm = &sc->sc_cmap;
    622      1.2        ad 
    623      1.2        ad 		vdac->mapWA = 0;
    624      1.2        ad 		wbflush();
    625      1.2        ad 
    626      1.2        ad 		if (sc->sc_cmap_size == 2) {
    627      1.2        ad 			for (i = 0; i < 128; i++) {
    628      1.2        ad 				vdac->map = 0;
    629      1.2        ad 				wbflush();
    630      1.2        ad 				vdac->map = cm->g[0];
    631      1.2        ad 				wbflush();
    632      1.2        ad 				vdac->map = 0;
    633      1.2        ad 				wbflush();
    634      1.2        ad 			}
    635      1.2        ad 			for (; i < 256; i++) {
    636      1.2        ad 				vdac->map = 0;
    637      1.2        ad 				wbflush();
    638      1.2        ad 				vdac->map = cm->g[1];
    639      1.2        ad 				wbflush();
    640      1.2        ad 				vdac->map = 0;
    641      1.2        ad 				wbflush();
    642      1.2        ad 			}
    643      1.2        ad 		} else {
    644      1.2        ad 			for (i = 0; i < sc->sc_cmap_size; i++) {
    645      1.2        ad 				vdac->map = cm->r[i];
    646      1.2        ad 				wbflush();
    647      1.2        ad 				vdac->map = cm->g[i];
    648      1.2        ad 				wbflush();
    649      1.2        ad 				vdac->map = cm->b[i];
    650      1.2        ad 				wbflush();
    651      1.2        ad 			}
    652      1.2        ad 		}
    653      1.2        ad 	}
    654      1.2        ad 
    655      1.2        ad 	sc->sc_changed = 0;
    656      1.2        ad 	return (1);
    657      1.2        ad }
    658      1.2        ad 
    659      1.2        ad int
    660      1.2        ad pm_get_cmap(struct pm_softc *sc, struct wsdisplay_cmap *p)
    661      1.2        ad {
    662      1.2        ad 	u_int index, count;
    663      1.2        ad 	int rv;
    664      1.2        ad 
    665      1.2        ad 	index = p->index;
    666      1.2        ad 	count = p->count;
    667      1.2        ad 
    668      1.2        ad 	if (index >= sc->sc_cmap_size || (index + count) > sc->sc_cmap_size)
    669      1.2        ad 		return (EINVAL);
    670      1.2        ad 
    671      1.2        ad 	if ((rv = copyout(&sc->sc_cmap.r[index], p->red, count)) != 0)
    672      1.2        ad 		return (rv);
    673      1.2        ad 	if ((rv = copyout(&sc->sc_cmap.g[index], p->green, count)) != 0)
    674      1.2        ad 		return (rv);
    675      1.2        ad 	return (copyout(&sc->sc_cmap.b[index], p->blue, count));
    676      1.2        ad }
    677      1.2        ad 
    678      1.2        ad int
    679      1.2        ad pm_set_cmap(struct pm_softc *sc, struct wsdisplay_cmap *p)
    680      1.2        ad {
    681      1.2        ad 	u_int index, count;
    682      1.2        ad 	int rv;
    683      1.2        ad 
    684      1.2        ad 	index = p->index;
    685      1.2        ad 	count = p->count;
    686      1.2        ad 
    687      1.2        ad 	if (index >= sc->sc_cmap_size || (index + count) > sc->sc_cmap_size)
    688      1.2        ad 		return (EINVAL);
    689      1.2        ad 
    690      1.2        ad 	if ((rv = copyin(p->red, &sc->sc_cmap.r[index], count)) != 0)
    691      1.2        ad 		return (rv);
    692      1.2        ad 	if ((rv = copyin(p->green, &sc->sc_cmap.g[index], count)) != 0)
    693      1.2        ad 		return (rv);
    694      1.2        ad 	if ((rv = copyin(p->blue, &sc->sc_cmap.b[index], count)) != 0)
    695      1.2        ad 		return (rv);
    696      1.2        ad 	sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
    697      1.2        ad 	return (0);
    698      1.2        ad }
    699      1.2        ad 
    700      1.2        ad int
    701      1.2        ad pm_set_cursor(struct pm_softc *sc, struct wsdisplay_cursor *p)
    702      1.2        ad {
    703      1.2        ad 	u_int v, index, count;
    704      1.2        ad 	struct hwcursor64 *cc;
    705      1.2        ad 	int rv;
    706      1.2        ad 
    707      1.2        ad 	v = p->which;
    708      1.2        ad 	cc = &sc->sc_cursor;
    709      1.2        ad 
    710      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOCUR) != 0)
    711      1.2        ad 		sc->sc_curenb = p->enable;
    712      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOPOS) != 0)
    713      1.2        ad 		pm_set_curpos(sc, &p->pos);
    714      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOHOT) != 0)
    715      1.2        ad 		cc->cc_hot = p->hot;
    716      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOCMAP) != 0) {
    717      1.2        ad 		index = p->cmap.index;
    718      1.2        ad 		count = p->cmap.count;
    719      1.2        ad 		if (index >= 2 || (index + count) > 2)
    720      1.2        ad 			return (EINVAL);
    721      1.2        ad 
    722      1.2        ad 		rv = copyin(p->cmap.red, &cc->cc_color[index], count);
    723      1.2        ad 		if (rv != 0)
    724      1.2        ad 			return (rv);
    725      1.2        ad 		rv = copyin(p->cmap.green, &cc->cc_color[index + 2], count);
    726      1.2        ad 		if (rv != 0)
    727      1.2        ad 			return (rv);
    728      1.2        ad 		rv = copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
    729      1.2        ad 		if (rv != 0)
    730      1.2        ad 			return (rv);
    731      1.2        ad 	}
    732      1.2        ad 	if ((v & WSDISPLAY_CURSOR_DOSHAPE) != 0) {
    733      1.2        ad 		if (p->size.x > CURSOR_MAX_SIZE ||
    734      1.2        ad 		    p->size.y > CURSOR_MAX_SIZE)
    735      1.2        ad 			return (EINVAL);
    736      1.2        ad 
    737      1.2        ad 		cc->cc_size = p->size;
    738      1.2        ad 		memset(cc->cc_image, 0, sizeof(cc->cc_image));
    739      1.2        ad 		rv = copyin(p->image, cc->cc_image, p->size.y * 4);
    740      1.2        ad 		if (rv != 0)
    741      1.2        ad 			return (rv);
    742      1.2        ad 		rv = copyin(p->mask, cc->cc_image+32, p->size.y * 4);
    743      1.2        ad 		if (rv != 0)
    744      1.2        ad 			return (rv);
    745      1.2        ad 	}
    746      1.2        ad 
    747      1.2        ad 	sc->sc_changed |= v;
    748      1.2        ad 	return (0);
    749      1.2        ad }
    750      1.2        ad 
    751      1.2        ad int
    752      1.2        ad pm_get_cursor(struct pm_softc *sc, struct wsdisplay_cursor *p)
    753      1.2        ad {
    754      1.2        ad 
    755      1.2        ad 	return (ENOTTY); /* XXX */
    756      1.2        ad }
    757      1.2        ad 
    758      1.2        ad void
    759      1.2        ad pm_set_curpos(struct pm_softc *sc, struct wsdisplay_curpos *curpos)
    760      1.2        ad {
    761      1.2        ad 	struct rasops_info *ri;
    762      1.2        ad 	int x, y;
    763      1.2        ad 
    764      1.2        ad 	ri = &pm_ri;
    765      1.2        ad 	x = curpos->x;
    766      1.2        ad 	y = curpos->y;
    767      1.2        ad 
    768      1.2        ad 	if (y < 0)
    769      1.2        ad 		y = 0;
    770      1.2        ad 	else if (y > ri->ri_height)
    771      1.2        ad 		y = ri->ri_height;
    772      1.2        ad 	if (x < 0)
    773      1.2        ad 		x = 0;
    774      1.2        ad 	else if (x > ri->ri_width)
    775      1.2        ad 		x = ri->ri_width;
    776      1.2        ad 	sc->sc_cursor.cc_pos.x = x;
    777      1.2        ad 	sc->sc_cursor.cc_pos.y = y;
    778      1.2        ad }
    779