Home | History | Annotate | Line # | Download | only in dev
grf.c revision 1.8
      1  1.1      mw /*
      2  1.1      mw  * Copyright (c) 1988 University of Utah.
      3  1.1      mw  * Copyright (c) 1990 The Regents of the University of California.
      4  1.1      mw  * All rights reserved.
      5  1.1      mw  *
      6  1.1      mw  * This code is derived from software contributed to Berkeley by
      7  1.1      mw  * the Systems Programming Group of the University of Utah Computer
      8  1.1      mw  * Science Department.
      9  1.1      mw  *
     10  1.1      mw  * Redistribution and use in source and binary forms, with or without
     11  1.1      mw  * modification, are permitted provided that the following conditions
     12  1.1      mw  * are met:
     13  1.1      mw  * 1. Redistributions of source code must retain the above copyright
     14  1.1      mw  *    notice, this list of conditions and the following disclaimer.
     15  1.1      mw  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1      mw  *    notice, this list of conditions and the following disclaimer in the
     17  1.1      mw  *    documentation and/or other materials provided with the distribution.
     18  1.1      mw  * 3. All advertising materials mentioning features or use of this software
     19  1.1      mw  *    must display the following acknowledgement:
     20  1.1      mw  *	This product includes software developed by the University of
     21  1.1      mw  *	California, Berkeley and its contributors.
     22  1.1      mw  * 4. Neither the name of the University nor the names of its contributors
     23  1.1      mw  *    may be used to endorse or promote products derived from this software
     24  1.1      mw  *    without specific prior written permission.
     25  1.1      mw  *
     26  1.1      mw  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     27  1.1      mw  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     28  1.1      mw  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     29  1.1      mw  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     30  1.1      mw  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     31  1.1      mw  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     32  1.1      mw  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     33  1.1      mw  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     34  1.1      mw  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     35  1.1      mw  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     36  1.1      mw  * SUCH DAMAGE.
     37  1.1      mw  *
     38  1.4      mw  * from: Utah $Hdr: grf.c 1.31 91/01/21$
     39  1.4      mw  *
     40  1.4      mw  *	@(#)grf.c	7.8 (Berkeley) 5/7/91
     41  1.8  chopps  *	$Id: grf.c,v 1.8 1994/02/13 21:10:24 chopps Exp $
     42  1.1      mw  */
     43  1.1      mw 
     44  1.1      mw /*
     45  1.1      mw  * Graphics display driver for the AMIGA
     46  1.1      mw  * This is the hardware-independent portion of the driver.
     47  1.1      mw  * Hardware access is through the grfdev routines below.
     48  1.1      mw  */
     49  1.1      mw 
     50  1.1      mw #include "grf.h"
     51  1.1      mw #if NGRF > 0
     52  1.1      mw 
     53  1.8  chopps #include <sys/param.h>
     54  1.8  chopps #include <sys/proc.h>
     55  1.8  chopps #include <sys/ioctl.h>
     56  1.8  chopps #include <sys/file.h>
     57  1.8  chopps #include <sys/malloc.h>
     58  1.8  chopps 
     59  1.8  chopps #include <amiga/dev/device.h>
     60  1.8  chopps #include <amiga/dev/grfioctl.h>
     61  1.8  chopps #include <amiga/dev/grfvar.h>
     62  1.8  chopps 
     63  1.8  chopps #include <machine/cpu.h>
     64  1.8  chopps 
     65  1.8  chopps #include <vm/vm.h>
     66  1.8  chopps #include <vm/vm_kern.h>
     67  1.8  chopps #include <vm/vm_page.h>
     68  1.8  chopps #include <vm/vm_pager.h>
     69  1.8  chopps 
     70  1.8  chopps #include <miscfs/specfs/specdev.h>
     71  1.8  chopps #include <sys/vnode.h>
     72  1.8  chopps #include <sys/mman.h>
     73  1.1      mw 
     74  1.1      mw #include "ite.h"
     75  1.1      mw #if NITE == 0
     76  1.1      mw #define	iteon(u,f)
     77  1.1      mw #define	iteoff(u,f)
     78  1.1      mw #endif
     79  1.1      mw 
     80  1.1      mw int	grfprobe();
     81  1.1      mw int	cc_init(), cc_mode();
     82  1.1      mw int	tg_init(), tg_mode();
     83  1.3      mw int	rt_init(), rt_mode();
     84  1.1      mw 
     85  1.1      mw struct grfdev grfdev[] = {
     86  1.1      mw 	MANUF_BUILTIN,		PROD_BUILTIN_DISPLAY,
     87  1.1      mw 		cc_init,  cc_mode,  "custom chips",
     88  1.1      mw 	MANUF_UNILOWELL,	PROD_UNILOWELL_A2410,
     89  1.3      mw 		tg_init,  tg_mode,    "A2410 TIGA",
     90  1.3      mw 	MANUF_MACROSYSTEM,	PROD_MACROSYSTEM_RETINA,
     91  1.3      mw 		rt_init,  rt_mode,    "Retina",
     92  1.1      mw };
     93  1.1      mw int	ngrfdev = sizeof(grfdev) / sizeof(grfdev[0]);
     94  1.1      mw 
     95  1.1      mw struct	driver grfdriver = { grfprobe, "grf" };
     96  1.1      mw struct	grf_softc grf_softc[NGRF];
     97  1.1      mw 
     98  1.1      mw #ifdef DEBUG
     99  1.1      mw int grfdebug = 0;
    100  1.1      mw #define GDB_DEVNO	0x01
    101  1.1      mw #define GDB_MMAP	0x02
    102  1.1      mw #define GDB_IOMAP	0x04
    103  1.1      mw #define GDB_LOCK	0x08
    104  1.1      mw #endif
    105  1.1      mw 
    106  1.1      mw /*
    107  1.1      mw  * XXX: called from ite console init routine.
    108  1.1      mw  * Does just what configure will do later but without printing anything.
    109  1.1      mw  */
    110  1.1      mw grfconfig()
    111  1.1      mw {
    112  1.1      mw 	register caddr_t addr;
    113  1.1      mw 	register struct amiga_hw *hw;
    114  1.1      mw 	register struct amiga_device *ad, *nad;
    115  1.1      mw 
    116  1.1      mw 	for (hw = sc_table; hw->hw_type; hw++) {
    117  1.1      mw 	        if (!HW_ISDEV(hw, D_BITMAP))
    118  1.1      mw 			continue;
    119  1.1      mw 		/*
    120  1.1      mw 		 * Found one, now match up with a logical unit number
    121  1.1      mw 		 */
    122  1.1      mw 		nad = NULL;
    123  1.1      mw 		addr = hw->hw_kva;
    124  1.1      mw 		for (ad = amiga_dinit; ad->amiga_driver; ad++) {
    125  1.1      mw 			if (ad->amiga_driver != &grfdriver || ad->amiga_alive)
    126  1.1      mw 				continue;
    127  1.1      mw 			/*
    128  1.1      mw 			 * Wildcarded.  If first, remember as possible match.
    129  1.1      mw 			 */
    130  1.1      mw 			if (ad->amiga_addr == NULL) {
    131  1.1      mw 				if (nad == NULL)
    132  1.1      mw 					nad = ad;
    133  1.1      mw 				continue;
    134  1.1      mw 			}
    135  1.1      mw 			/*
    136  1.1      mw 			 * Not wildcarded.
    137  1.1      mw 			 * If exact match done searching, else keep looking.
    138  1.1      mw 			 */
    139  1.1      mw 			if (((hw->hw_manufacturer << 16) | hw->hw_product)
    140  1.6  chopps 			    == (u_int) ad->amiga_addr) {
    141  1.1      mw 				nad = ad;
    142  1.1      mw 				break;
    143  1.1      mw 			}
    144  1.1      mw 		}
    145  1.1      mw 		/*
    146  1.1      mw 		 * Found a match, initialize
    147  1.1      mw 		 */
    148  1.3      mw 		if (nad && grfinit (nad, hw))
    149  1.3      mw 		  nad->amiga_addr = addr;
    150  1.1      mw 	}
    151  1.1      mw }
    152  1.1      mw 
    153  1.1      mw /*
    154  1.1      mw  * Normal init routine called by configure() code
    155  1.1      mw  */
    156  1.1      mw grfprobe(ad)
    157  1.1      mw 	struct amiga_device *ad;
    158  1.1      mw {
    159  1.1      mw 	struct grf_softc *gp = &grf_softc[ad->amiga_unit];
    160  1.1      mw 
    161  1.3      mw 	/* can't reinit, as ad->amiga_addr no longer contains
    162  1.3      mw 	   manuf/prod information */
    163  1.3      mw 	if ((gp->g_flags & GF_ALIVE) == 0 /* &&
    164  1.3      mw 	    !grfinit (ad) */)
    165  1.1      mw 		return(0);
    166  1.1      mw 	printf("grf%d: %d x %d ", ad->amiga_unit,
    167  1.1      mw 	       gp->g_display.gd_dwidth, gp->g_display.gd_dheight);
    168  1.1      mw 	if (gp->g_display.gd_colors == 2)
    169  1.1      mw 		printf("monochrome");
    170  1.1      mw 	else
    171  1.1      mw 		printf("%d color", gp->g_display.gd_colors);
    172  1.1      mw 	printf(" %s display\n", grfdev[gp->g_type].gd_desc);
    173  1.1      mw 	return(1);
    174  1.1      mw }
    175  1.1      mw 
    176  1.3      mw grfinit(ad, ahw)
    177  1.1      mw 	struct amiga_device *ad;
    178  1.3      mw 	struct amiga_hw *ahw;
    179  1.1      mw {
    180  1.1      mw 	struct grf_softc *gp = &grf_softc[ad->amiga_unit];
    181  1.1      mw 	register struct grfdev *gd;
    182  1.1      mw 
    183  1.1      mw 	for (gd = grfdev; gd < &grfdev[ngrfdev]; gd++)
    184  1.6  chopps 	  if (((gd->gd_manuf << 16) | gd->gd_prod) == (u_int)ad->amiga_addr)
    185  1.1      mw 	    break;
    186  1.1      mw 
    187  1.3      mw 	if (gd < &grfdev[ngrfdev] && (*gd->gd_init)(gp, ad, ahw)) {
    188  1.1      mw 		gp->g_type = gd - grfdev;
    189  1.1      mw 		gp->g_flags = GF_ALIVE;
    190  1.1      mw 		return(1);
    191  1.1      mw 	}
    192  1.1      mw 	return(0);
    193  1.1      mw }
    194  1.1      mw 
    195  1.1      mw /*ARGSUSED*/
    196  1.1      mw grfopen(dev, flags)
    197  1.1      mw 	dev_t dev;
    198  1.1      mw {
    199  1.1      mw 	int unit = GRFUNIT(dev);
    200  1.1      mw 	register struct grf_softc *gp = &grf_softc[unit];
    201  1.1      mw 	int error = 0;
    202  1.1      mw 
    203  1.1      mw 	if (unit >= NGRF || (gp->g_flags & GF_ALIVE) == 0)
    204  1.1      mw 		return(ENXIO);
    205  1.1      mw 	if ((gp->g_flags & (GF_OPEN|GF_EXCLUDE)) == (GF_OPEN|GF_EXCLUDE))
    206  1.1      mw 		return(EBUSY);
    207  1.3      mw #if 0
    208  1.1      mw 	/*
    209  1.1      mw 	 * First open.
    210  1.1      mw 	 * XXX: always put in graphics mode.
    211  1.1      mw 	 */
    212  1.1      mw 	error = 0;
    213  1.1      mw 	if ((gp->g_flags & GF_OPEN) == 0) {
    214  1.1      mw 		gp->g_flags |= GF_OPEN;
    215  1.1      mw 		error = grfon(dev);
    216  1.1      mw 	}
    217  1.3      mw #endif
    218  1.1      mw 	return(error);
    219  1.1      mw }
    220  1.1      mw 
    221  1.1      mw /*ARGSUSED*/
    222  1.1      mw grfclose(dev, flags)
    223  1.1      mw 	dev_t dev;
    224  1.1      mw {
    225  1.1      mw 	register struct grf_softc *gp = &grf_softc[GRFUNIT(dev)];
    226  1.1      mw 
    227  1.1      mw 	(void) grfoff(dev);
    228  1.1      mw 	(void) grfunlock(gp);
    229  1.1      mw 	gp->g_flags &= GF_ALIVE;
    230  1.1      mw 	return(0);
    231  1.1      mw }
    232  1.1      mw 
    233  1.1      mw /*ARGSUSED*/
    234  1.1      mw grfioctl(dev, cmd, data, flag, p)
    235  1.1      mw 	dev_t dev;
    236  1.1      mw 	caddr_t data;
    237  1.1      mw 	struct proc *p;
    238  1.1      mw {
    239  1.1      mw 	register struct grf_softc *gp = &grf_softc[GRFUNIT(dev)];
    240  1.1      mw 	int error;
    241  1.1      mw 
    242  1.1      mw 	error = 0;
    243  1.1      mw 	switch (cmd) {
    244  1.1      mw 
    245  1.5      mw 	case OGRFIOCGINFO:
    246  1.5      mw 	        /* argl.. no bank-member.. */
    247  1.5      mw 	  	bcopy((caddr_t)&gp->g_display, data, sizeof(struct grfinfo)-4);
    248  1.5      mw 		break;
    249  1.5      mw 
    250  1.1      mw 	case GRFIOCGINFO:
    251  1.1      mw 		bcopy((caddr_t)&gp->g_display, data, sizeof(struct grfinfo));
    252  1.1      mw 		break;
    253  1.1      mw 
    254  1.1      mw 	case GRFIOCON:
    255  1.1      mw 		error = grfon(dev);
    256  1.1      mw 		break;
    257  1.1      mw 
    258  1.1      mw 	case GRFIOCOFF:
    259  1.1      mw 		error = grfoff(dev);
    260  1.1      mw 		break;
    261  1.1      mw 
    262  1.1      mw 	case GRFIOCMAP:
    263  1.1      mw 		error = grfmmap(dev, (caddr_t *)data, p);
    264  1.1      mw 		break;
    265  1.1      mw 
    266  1.1      mw 	case GRFIOCUNMAP:
    267  1.1      mw 		error = grfunmmap(dev, *(caddr_t *)data, p);
    268  1.1      mw 		break;
    269  1.1      mw 
    270  1.1      mw 	case GRFIOCSINFO:
    271  1.1      mw 		error = grfsinfo (dev, (struct grfdyninfo *) data);
    272  1.1      mw 		break;
    273  1.3      mw 
    274  1.3      mw 	case GRFGETVMODE:
    275  1.3      mw 		return grfdev[gp->g_type].gd_mode (gp, GM_GRFGETVMODE, data);
    276  1.3      mw 
    277  1.3      mw 	case GRFSETVMODE:
    278  1.3      mw 		error = grfdev[gp->g_type].gd_mode (gp, GM_GRFSETVMODE, data);
    279  1.3      mw 		if (! error)
    280  1.3      mw 		  {
    281  1.3      mw 		    /* XXX */
    282  1.3      mw 		    itereinit (GRFUNIT (dev));
    283  1.3      mw 		  }
    284  1.3      mw 		break;
    285  1.3      mw 
    286  1.3      mw 	case GRFGETNUMVM:
    287  1.3      mw 		return grfdev[gp->g_type].gd_mode (gp, GM_GRFGETNUMVM, data);
    288  1.3      mw 
    289  1.5      mw 		/* these are all hardware dependant, and have to be resolved
    290  1.5      mw 		   in the respective driver. */
    291  1.5      mw 	case GRFIOCPUTCMAP:
    292  1.5      mw 	case GRFIOCGETCMAP:
    293  1.5      mw 	case GRFIOCSSPRITEPOS:
    294  1.5      mw 	case GRFIOCGSPRITEPOS:
    295  1.5      mw 	case GRFIOCSSPRITEINF:
    296  1.5      mw 	case GRFIOCGSPRITEINF:
    297  1.5      mw 	case GRFIOCGSPRITEMAX:
    298  1.5      mw 		return grfdev[gp->g_type].gd_mode (gp, GM_GRFIOCTL, cmd, data);
    299  1.5      mw 
    300  1.1      mw 	default:
    301  1.5      mw 		/* check to see whether it's a command recognized by the
    302  1.5      mw 		   view code if the unit is 0 XXX */
    303  1.5      mw 		if (GRFUNIT(dev) == 0)
    304  1.5      mw 		  return viewioctl (dev, cmd, data, flag, p);
    305  1.1      mw 		error = EINVAL;
    306  1.1      mw 		break;
    307  1.1      mw 
    308  1.1      mw 	}
    309  1.1      mw 	return(error);
    310  1.1      mw }
    311  1.1      mw 
    312  1.1      mw /*ARGSUSED*/
    313  1.1      mw grfselect(dev, rw)
    314  1.1      mw 	dev_t dev;
    315  1.1      mw {
    316  1.1      mw 	if (rw == FREAD)
    317  1.1      mw 		return(0);
    318  1.1      mw 	return(1);
    319  1.1      mw }
    320  1.1      mw 
    321  1.1      mw grflock(gp, block)
    322  1.1      mw 	register struct grf_softc *gp;
    323  1.1      mw 	int block;
    324  1.1      mw {
    325  1.1      mw 	struct proc *p = curproc;		/* XXX */
    326  1.1      mw 	int error;
    327  1.1      mw 	extern char devioc[];
    328  1.1      mw 
    329  1.1      mw #ifdef DEBUG
    330  1.1      mw 	if (grfdebug & GDB_LOCK)
    331  1.1      mw 		printf("grflock(%d): dev %x flags %x lockpid %x\n",
    332  1.1      mw 		       p->p_pid, gp-grf_softc, gp->g_flags,
    333  1.1      mw 		       gp->g_lockp ? gp->g_lockp->p_pid : -1);
    334  1.1      mw #endif
    335  1.1      mw 	if (gp->g_lockp) {
    336  1.1      mw 		if (gp->g_lockp == p)
    337  1.1      mw 			return(EBUSY);
    338  1.1      mw 		if (!block)
    339  1.1      mw 			return(EAGAIN);
    340  1.1      mw 		do {
    341  1.1      mw 			gp->g_flags |= GF_WANTED;
    342  1.1      mw 			if (error = tsleep((caddr_t)&gp->g_flags,
    343  1.1      mw 					   (PZERO+1) | PCATCH, devioc, 0))
    344  1.1      mw 				return (error);
    345  1.1      mw 		} while (gp->g_lockp);
    346  1.1      mw 	}
    347  1.1      mw 	gp->g_lockp = p;
    348  1.1      mw 	return(0);
    349  1.1      mw }
    350  1.1      mw 
    351  1.1      mw grfunlock(gp)
    352  1.1      mw 	register struct grf_softc *gp;
    353  1.1      mw {
    354  1.1      mw #ifdef DEBUG
    355  1.1      mw 	if (grfdebug & GDB_LOCK)
    356  1.1      mw 		printf("grfunlock(%d): dev %x flags %x lockpid %d\n",
    357  1.1      mw 		       curproc->p_pid, gp-grf_softc, gp->g_flags,
    358  1.1      mw 		       gp->g_lockp ? gp->g_lockp->p_pid : -1);
    359  1.1      mw #endif
    360  1.1      mw 	if (gp->g_lockp != curproc)
    361  1.1      mw 		return(EBUSY);
    362  1.1      mw 	if (gp->g_flags & GF_WANTED) {
    363  1.1      mw 		wakeup((caddr_t)&gp->g_flags);
    364  1.1      mw 		gp->g_flags &= ~GF_WANTED;
    365  1.1      mw 	}
    366  1.1      mw 	gp->g_lockp = NULL;
    367  1.1      mw 	return(0);
    368  1.1      mw }
    369  1.1      mw 
    370  1.1      mw /*ARGSUSED*/
    371  1.1      mw grfmap(dev, off, prot)
    372  1.1      mw 	dev_t dev;
    373  1.1      mw {
    374  1.1      mw 	return(grfaddr(&grf_softc[GRFUNIT(dev)], off));
    375  1.1      mw }
    376  1.1      mw 
    377  1.1      mw 
    378  1.1      mw grfon(dev)
    379  1.1      mw 	dev_t dev;
    380  1.1      mw {
    381  1.1      mw 	int unit = GRFUNIT(dev);
    382  1.1      mw 	struct grf_softc *gp = &grf_softc[unit];
    383  1.1      mw 
    384  1.3      mw 	if (gp->g_flags & GF_GRFON)
    385  1.3      mw 	  return 0;
    386  1.3      mw 	gp->g_flags |= GF_GRFON;
    387  1.3      mw 
    388  1.1      mw 	/*
    389  1.1      mw 	 * XXX: iteoff call relies on devices being in same order
    390  1.1      mw 	 * as ITEs and the fact that iteoff only uses the minor part
    391  1.1      mw 	 * of the dev arg.
    392  1.1      mw 	 */
    393  1.1      mw 	iteoff(unit, 3);
    394  1.1      mw 	return((*grfdev[gp->g_type].gd_mode)
    395  1.1      mw 			(gp, (dev&GRFOVDEV) ? GM_GRFOVON : GM_GRFON));
    396  1.1      mw }
    397  1.1      mw 
    398  1.1      mw grfoff(dev)
    399  1.1      mw 	dev_t dev;
    400  1.1      mw {
    401  1.1      mw 	int unit = GRFUNIT(dev);
    402  1.1      mw 	struct grf_softc *gp = &grf_softc[unit];
    403  1.1      mw 	int error;
    404  1.3      mw 
    405  1.3      mw 	if (!(gp->g_flags & GF_GRFON))
    406  1.3      mw 	  return 0;
    407  1.3      mw 	gp->g_flags &= ~GF_GRFON;
    408  1.1      mw 
    409  1.1      mw 	(void) grfunmmap(dev, (caddr_t)0, curproc);
    410  1.1      mw 	error = (*grfdev[gp->g_type].gd_mode)
    411  1.1      mw 			(gp, (dev&GRFOVDEV) ? GM_GRFOVOFF : GM_GRFOFF);
    412  1.1      mw 	/* XXX: see comment for iteoff above */
    413  1.1      mw 	iteon(unit, 2);
    414  1.1      mw 	return(error);
    415  1.1      mw }
    416  1.1      mw 
    417  1.1      mw grfsinfo(dev, dyninfo)
    418  1.1      mw 	dev_t dev;
    419  1.1      mw 	struct grfdyninfo *dyninfo;
    420  1.1      mw {
    421  1.1      mw 	int unit = GRFUNIT(dev);
    422  1.1      mw 	struct grf_softc *gp = &grf_softc[unit];
    423  1.1      mw 	int error;
    424  1.1      mw 
    425  1.1      mw 	error = grfdev[gp->g_type].gd_mode (gp, GM_GRFCONFIG, dyninfo);
    426  1.1      mw 	/* XXX: see comment for iteoff above */
    427  1.1      mw 	itereinit (unit);
    428  1.1      mw 	return(error);
    429  1.1      mw }
    430  1.1      mw 
    431  1.1      mw grfaddr(gp, off)
    432  1.1      mw 	struct grf_softc *gp;
    433  1.1      mw 	register int off;
    434  1.1      mw {
    435  1.1      mw 	register struct grfinfo *gi = &gp->g_display;
    436  1.1      mw 
    437  1.1      mw 	/* control registers */
    438  1.1      mw 	if (off >= 0 && off < gi->gd_regsize)
    439  1.1      mw 		return(((u_int)gi->gd_regaddr + off) >> PGSHIFT);
    440  1.1      mw 
    441  1.1      mw 	/* frame buffer */
    442  1.1      mw 	if (off >= gi->gd_regsize && off < gi->gd_regsize+gi->gd_fbsize) {
    443  1.1      mw 		off -= gi->gd_regsize;
    444  1.5      mw #ifdef BANKEDDEVPAGER
    445  1.5      mw 		if (gi->gd_bank_size)
    446  1.5      mw 		  off %= gi->gd_bank_size;
    447  1.5      mw #endif
    448  1.1      mw 		return(((u_int)gi->gd_fbaddr + off) >> PGSHIFT);
    449  1.1      mw 	}
    450  1.1      mw 	/* bogus */
    451  1.1      mw 	return(-1);
    452  1.1      mw }
    453  1.1      mw 
    454  1.1      mw grfmmap(dev, addrp, p)
    455  1.1      mw 	dev_t dev;
    456  1.1      mw 	caddr_t *addrp;
    457  1.1      mw 	struct proc *p;
    458  1.1      mw {
    459  1.1      mw 	struct grf_softc *gp = &grf_softc[GRFUNIT(dev)];
    460  1.1      mw 	int len, error;
    461  1.1      mw 	struct vnode vn;
    462  1.1      mw 	struct specinfo si;
    463  1.1      mw 	int flags;
    464  1.1      mw 
    465  1.1      mw #ifdef DEBUG
    466  1.1      mw 	if (grfdebug & GDB_MMAP)
    467  1.1      mw 		printf("grfmmap(%d): addr %x\n", p->p_pid, *addrp);
    468  1.1      mw #endif
    469  1.1      mw 	len = gp->g_display.gd_regsize + gp->g_display.gd_fbsize;
    470  1.1      mw 	flags = MAP_FILE|MAP_SHARED;
    471  1.1      mw 	if (*addrp)
    472  1.1      mw 		flags |= MAP_FIXED;
    473  1.5      mw 	else {
    474  1.5      mw 		/*
    475  1.5      mw 		 * XXX if no hint provided for a non-fixed mapping place it after
    476  1.5      mw 		 * the end of the largest possible heap.
    477  1.5      mw 		 *
    478  1.5      mw 		 * There should really be a pmap call to determine a reasonable
    479  1.5      mw 		 * location.
    480  1.5      mw 		 */
    481  1.6  chopps 		*addrp = (caddr_t) round_page(p->p_vmspace->vm_daddr + MAXDSIZ);
    482  1.5      mw 	}
    483  1.5      mw 	bzero (&vn, sizeof (vn));
    484  1.5      mw 	bzero (&si, sizeof (si));
    485  1.1      mw 	vn.v_type = VCHR;			/* XXX */
    486  1.1      mw 	vn.v_specinfo = &si;			/* XXX */
    487  1.1      mw 	vn.v_rdev = dev;			/* XXX */
    488  1.4      mw   	error = vm_mmap(&p->p_vmspace->vm_map, (vm_offset_t *)addrp,
    489  1.4      mw 			(vm_size_t)len, VM_PROT_ALL, VM_PROT_ALL, flags,
    490  1.4      mw 			(caddr_t)&vn, 0);
    491  1.1      mw 	return(error);
    492  1.1      mw }
    493  1.1      mw 
    494  1.1      mw grfunmmap(dev, addr, p)
    495  1.1      mw 	dev_t dev;
    496  1.1      mw 	caddr_t addr;
    497  1.1      mw 	struct proc *p;
    498  1.1      mw {
    499  1.1      mw 	struct grf_softc *gp = &grf_softc[GRFUNIT(dev)];
    500  1.1      mw 	vm_size_t size;
    501  1.1      mw 	int rv;
    502  1.1      mw 
    503  1.1      mw #ifdef DEBUG
    504  1.1      mw 	if (grfdebug & GDB_MMAP)
    505  1.1      mw 		printf("grfunmmap(%d): dev %x addr %x\n", p->p_pid, dev, addr);
    506  1.1      mw #endif
    507  1.1      mw 	if (addr == 0)
    508  1.1      mw 		return(EINVAL);		/* XXX: how do we deal with this? */
    509  1.1      mw 	size = round_page(gp->g_display.gd_regsize + gp->g_display.gd_fbsize);
    510  1.1      mw 	rv = vm_deallocate(p->p_vmspace->vm_map, (vm_offset_t)addr, size);
    511  1.1      mw 	return(rv == KERN_SUCCESS ? 0 : EINVAL);
    512  1.1      mw }
    513  1.1      mw 
    514  1.5      mw #ifdef BANKEDDEVPAGER
    515  1.5      mw 
    516  1.5      mw int
    517  1.5      mw grfbanked_get (dev, off, prot)
    518  1.5      mw      dev_t dev;
    519  1.5      mw      off_t off;
    520  1.5      mw      int   prot;
    521  1.5      mw {
    522  1.5      mw   int unit = GRFUNIT(dev);
    523  1.5      mw   struct grf_softc *gp = &grf_softc[unit];
    524  1.5      mw   int error, bank;
    525  1.5      mw   struct grfinfo *gi = &gp->g_display;
    526  1.5      mw 
    527  1.5      mw   off -= gi->gd_regsize;
    528  1.5      mw   if (off < 0 || off >= gi->gd_fbsize)
    529  1.5      mw     return -1;
    530  1.5      mw 
    531  1.5      mw   error = grfdev[gp->g_type].gd_mode (gp, GM_GRFGETBANK, &bank, off, prot);
    532  1.5      mw   return error ? -1 : bank;
    533  1.5      mw }
    534  1.5      mw 
    535  1.5      mw int
    536  1.5      mw grfbanked_cur (dev)
    537  1.5      mw      dev_t dev;
    538  1.5      mw {
    539  1.5      mw   int unit = GRFUNIT(dev);
    540  1.5      mw   struct grf_softc *gp = &grf_softc[unit];
    541  1.5      mw   int error, bank;
    542  1.5      mw 
    543  1.5      mw   error = grfdev[gp->g_type].gd_mode (gp, GM_GRFGETCURBANK, &bank);
    544  1.5      mw   return error ? -1 : bank;
    545  1.5      mw }
    546  1.5      mw 
    547  1.5      mw int
    548  1.5      mw grfbanked_set (dev, bank)
    549  1.5      mw      dev_t dev;
    550  1.5      mw      int bank;
    551  1.5      mw {
    552  1.5      mw   int unit = GRFUNIT(dev);
    553  1.5      mw   struct grf_softc *gp = &grf_softc[unit];
    554  1.5      mw 
    555  1.5      mw   return grfdev[gp->g_type].gd_mode (gp, GM_GRFSETBANK, bank) ? -1 : 0;
    556  1.5      mw }
    557  1.5      mw 
    558  1.5      mw #endif /* BANKEDDEVPAGER */
    559  1.1      mw 
    560  1.1      mw #endif	/* NGRF > 0 */
    561