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