Home | History | Annotate | Line # | Download | only in dev
grf_compat.c revision 1.7.4.1
      1 /*	$NetBSD: grf_compat.c,v 1.7.4.1 2001/10/10 11:56:14 fvdl Exp $	*/
      2 
      3 /*
      4  * Copyright (C) 1999 Scott Reynolds
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. The name of the author may not be used to endorse or promote products
     16  *    derived from this software without specific prior written permission.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28  */
     29 
     30 /*
     31  * macfb compatibility with legacy grf devices
     32  */
     33 
     34 #include <sys/param.h>
     35 #include <sys/systm.h>
     36 #include <sys/cdefs.h>
     37 #include <sys/conf.h>
     38 #include <sys/device.h>
     39 #include <sys/errno.h>
     40 #include <sys/ioctl.h>
     41 #include <sys/malloc.h>
     42 #include <sys/mman.h>
     43 #include <sys/proc.h>
     44 #include <sys/resourcevar.h>
     45 #include <sys/vnode.h>
     46 
     47 #include <machine/autoconf.h>
     48 #include <machine/bus.h>
     49 #include <machine/grfioctl.h>
     50 
     51 #include <mac68k/nubus/nubus.h>
     52 #include <mac68k/dev/grfvar.h>
     53 #include <mac68k/dev/macfbvar.h>
     54 
     55 #include <miscfs/specfs/specdev.h>
     56 
     57 #include <uvm/uvm_extern.h>
     58 #include <uvm/uvm_map.h>
     59 
     60 cdev_decl(grf);
     61 
     62 void	grf_scinit __P((struct grf_softc *, const char *, int));
     63 void	grf_init __P((int));
     64 void	grfattach __P((int));
     65 int	grfmap __P((struct vnode *, struct macfb_softc *, caddr_t *, struct proc *));
     66 int	grfunmap __P((struct vnode *, struct macfb_softc *, caddr_t, struct proc *));
     67 
     68 /* Non-private for the benefit of libkvm. */
     69 struct	grf_softc *grf_softc;
     70 int	numgrf = 0;
     71 
     72 /*
     73  * Initialize a softc to sane defaults.
     74  */
     75 void
     76 grf_scinit(sc, name, unit)
     77 	struct grf_softc *sc;
     78 	const char *name;
     79 	int unit;
     80 {
     81 	memset(sc, 0, sizeof(struct grf_softc));
     82 	snprintf(sc->sc_xname, sizeof(sc->sc_xname), "%s%d", name, unit);
     83 	sc->mfb_sc = NULL;
     84 }
     85 
     86 /*
     87  * (Re-)initialize the grf_softc block so that at least the requested
     88  * number of elements has been allocated.  If this results in more
     89  * elements than we had prior to getting here, we initialize each of
     90  * them to avoid problems down the road.
     91  */
     92 void
     93 grf_init(n)
     94 	int n;
     95 {
     96 	struct grf_softc *sc;
     97 	int i;
     98 
     99 	if (n >= numgrf) {
    100 		i = numgrf;
    101 		numgrf = n + 1;
    102 
    103 		if (grf_softc == NULL)
    104 			sc = (struct grf_softc *)
    105 			    malloc(numgrf * sizeof(*sc),
    106 			    M_DEVBUF, M_NOWAIT);
    107 		else
    108 			sc = (struct grf_softc *)
    109 			    realloc(grf_softc, numgrf * sizeof(*sc),
    110 			    M_DEVBUF, M_NOWAIT);
    111 		if (sc == NULL) {
    112 			printf("WARNING: no memory for grf emulation\n");
    113 			if (grf_softc != NULL)
    114 				free(grf_softc, M_DEVBUF);
    115 			return;
    116 		}
    117 		grf_softc = sc;
    118 
    119 		/* Initialize per-softc structures. */
    120 		while (i < numgrf) {
    121 			grf_scinit(&grf_softc[i], "grf", i);
    122 			i++;
    123 		}
    124 	}
    125 }
    126 
    127 /*
    128  * Called by main() during pseudo-device attachment.  If we had a
    129  * way to configure additional grf devices later, this would actually
    130  * allocate enough space for them.  As it stands, it's nonsensical,
    131  * so other than a basic sanity check we do nothing.
    132  */
    133 void
    134 grfattach(n)
    135 	int n;
    136 {
    137 	if (n <= 0) {
    138 #ifdef DIAGNOSTIC
    139 		panic("grfattach: count <= 0");
    140 #endif
    141 		return;
    142 	}
    143 
    144 #if 0 /* XXX someday, if we implement a way to attach after autoconfig */
    145 	grf_init(n);
    146 #endif
    147 }
    148 
    149 /*
    150  * Called from macfb_attach() after setting up the frame buffer.  Since
    151  * there is a 1:1 correspondence between the macfb device and the grf
    152  * device, the only bit of information we really need is the macfb_softc.
    153  */
    154 void
    155 grf_attach(sc, unit)
    156 	struct macfb_softc *sc;
    157 	int unit;
    158 {
    159 	grf_init(unit);
    160 
    161 	if (unit < numgrf)
    162 		grf_softc[unit].mfb_sc = sc;
    163 }
    164 
    165 /*
    166  * Standard device ops
    167  */
    168 int
    169 grfopen(devvp, flag, mode, p)
    170 	struct vnode *devvp;
    171 	int flag;
    172 	int mode;
    173 	struct proc *p;
    174 {
    175 	dev_t dev;
    176 	struct grf_softc *sc;
    177 	int rv = 0;
    178 	int unit;
    179 
    180 	dev = vdev_rdev(devvp);
    181 	unit = GRFUNIT(dev);
    182 
    183 	if (grf_softc == NULL || unit >= numgrf)
    184 		return ENXIO;
    185 
    186 	sc = &grf_softc[unit];
    187 	if (sc->mfb_sc == NULL)
    188 		rv = ENXIO;
    189 
    190 	vdev_setprivdata(devvp, sc);
    191 
    192 	return rv;
    193 }
    194 
    195 int
    196 grfclose(devvp, flag, mode, p)
    197 	struct vnode *devvp;
    198 	int flag;
    199 	int mode;
    200 	struct proc *p;
    201 {
    202 	struct grf_softc *sc;
    203 	int rv = 0;
    204 
    205 	if (grf_softc == NULL)
    206 		return ENXIO;
    207 
    208 	sc = vdev_privdata(devvp);
    209 
    210 	if (sc->mfb_sc != NULL)
    211 		macfb_clear(sc->mfb_sc->sc_dc);	/* clear the display */
    212 	else
    213 		rv = ENXIO;
    214 
    215 	return rv;
    216 }
    217 
    218 int
    219 grfread(devvp, uio, ioflag)
    220 	struct vnode *devvp;
    221 	struct uio *uio;
    222 	int ioflag;
    223 {
    224 	return ENXIO;
    225 }
    226 
    227 int
    228 grfwrite(devvp, uio, ioflag)
    229 	struct vnode *devvp;
    230 	struct uio *uio;
    231 	int ioflag;
    232 {
    233 	return ENXIO;
    234 }
    235 
    236 int
    237 grfioctl(devvp, cmd, data, flag, p)
    238 	struct vnode *devvp;
    239 	u_long cmd;
    240 	caddr_t data;
    241 	int flag;
    242 	struct proc *p;
    243 {
    244 	struct grf_softc *sc;
    245 	struct macfb_devconfig *dc;
    246 #if defined(GRF_COMPAT) || (NGRF > 0)
    247 	struct grfinfo *gd;
    248 #endif /* GRF_COMPAT || (NGRF > 0) */
    249 	struct grfmode *gm;
    250 	int rv;
    251 
    252 	if (grf_softc == NULL)
    253 		return ENXIO;
    254 
    255 	sc = vdev_privdata(devvp);
    256 	if (sc->mfb_sc == NULL)
    257 		return ENXIO;
    258 
    259 	dc = sc->mfb_sc->sc_dc;
    260 
    261 	switch (cmd) {
    262 #if defined(GRF_COMPAT) || (NGRF > 0)
    263 	case GRFIOCGINFO:
    264 		gd = (struct grfinfo *)data;
    265 		memset(gd, 0, sizeof(struct grfinfo));
    266 		gd->gd_fbaddr     = (caddr_t)dc->dc_paddr;
    267 		gd->gd_fbsize     = dc->dc_size;
    268 		gd->gd_colors     = (short)(1 << dc->dc_depth);
    269 		gd->gd_planes     = (short)dc->dc_depth;
    270 		gd->gd_fbwidth    = dc->dc_wid;
    271 		gd->gd_fbheight   = dc->dc_ht;
    272 		gd->gd_fbrowbytes = dc->dc_rowbytes;
    273 		gd->gd_dwidth     = dc->dc_raster.width;
    274 		gd->gd_dheight    = dc->dc_raster.height;
    275 		rv = 0;
    276 		break;
    277 #endif /* GRF_COMPAT || (NGRF > 0) */
    278 
    279 	case GRFIOCON:
    280 	case GRFIOCOFF:
    281 		/* Nothing to do */
    282 		rv = 0;
    283 		break;
    284 
    285 #if defined(GRF_COMPAT) || (NGRF > 0)
    286 	case GRFIOCMAP:
    287 		rv = grfmap(devvp, sc->mfb_sc, (caddr_t *)data, p);
    288 		break;
    289 
    290 	case GRFIOCUNMAP:
    291 		rv = grfunmap(devvp, sc->mfb_sc, *(caddr_t *)data, p);
    292 		break;
    293 #endif /* GRF_COMPAT || (NGRF > 0) */
    294 
    295 	case GRFIOCGMODE:
    296 		gm = (struct grfmode *)data;
    297 		memset(gm, 0, sizeof(struct grfmode));
    298 		gm->fbbase   = (char *)dc->dc_vaddr;
    299 		gm->fbsize   = dc->dc_size;
    300 		gm->fboff    = dc->dc_offset;
    301 		gm->rowbytes = dc->dc_rowbytes;
    302 		gm->width    = dc->dc_wid;
    303 		gm->height   = dc->dc_ht;
    304 		gm->psize    = dc->dc_depth;
    305 		rv = 0;
    306 		break;
    307 
    308 	case GRFIOCLISTMODES:
    309 	case GRFIOCGETMODE:
    310 	case GRFIOCSETMODE:
    311 		/* NONE of these operations are (officially) supported. */
    312 	default:
    313 		rv = EINVAL;
    314 		break;
    315 	}
    316 	return rv;
    317 }
    318 
    319 int
    320 grfpoll(devvp, events, p)
    321 	struct vnode *devvp;
    322 	int events;
    323 	struct proc *p;
    324 {
    325 	return EINVAL;
    326 }
    327 
    328 paddr_t
    329 grfmmap(devvp, off, prot)
    330 	struct vnode *devvp;
    331 	off_t off;
    332 	int prot;
    333 {
    334 	struct grf_softc *sc;
    335 	struct macfb_devconfig *dc;
    336 	paddr_t addr;
    337 
    338 	if (grf_softc == NULL)
    339 		return ENXIO;
    340 
    341 	sc = vdev_privdata(devvp);
    342 	if (sc->mfb_sc == NULL)
    343 		return ENXIO;
    344 
    345 	dc = sc->mfb_sc->sc_dc;
    346 
    347 	if (off >= 0 &&
    348 	    off < m68k_round_page(dc->dc_offset + dc->dc_size))
    349 		addr = m68k_btop(dc->dc_paddr + off);
    350 	else
    351 		addr = (-1);	/* XXX bogus */
    352 
    353 	return addr;
    354 }
    355 
    356 int
    357 grfmap(devvp, sc, addrp, p)
    358 	struct vnode *devvp;
    359 	struct macfb_softc *sc;
    360 	caddr_t *addrp;
    361 	struct proc *p;
    362 {
    363 	u_long len;
    364 	int error, flags;
    365 
    366 	*addrp = (caddr_t)sc->sc_dc->dc_paddr;
    367 	len = m68k_round_page(sc->sc_dc->dc_offset + sc->sc_dc->dc_size);
    368 	flags = MAP_SHARED | MAP_FIXED;
    369 
    370 	error = uvm_mmap(&p->p_vmspace->vm_map, (vaddr_t *)addrp,
    371 	    (vsize_t)len, VM_PROT_ALL, VM_PROT_ALL,
    372 	    flags, devvp, 0, p->p_rlimit[RLIMIT_MEMLOCK].rlim_cur);
    373 
    374 	/* Offset into page: */
    375 	*addrp += sc->sc_dc->dc_offset;
    376 
    377 	return (error);
    378 }
    379 
    380 int
    381 grfunmap(devvp, sc, addr, p)
    382 	struct vnode *devvp;
    383 	struct macfb_softc *sc;
    384 	caddr_t addr;
    385 	struct proc *p;
    386 {
    387 	vm_size_t size;
    388 
    389 	addr -= sc->sc_dc->dc_offset;
    390 
    391 	if (addr <= 0)
    392 		return (-1);
    393 
    394 	size = m68k_round_page(sc->sc_dc->dc_offset + sc->sc_dc->dc_size);
    395 	uvm_unmap(&p->p_vmspace->vm_map, (vaddr_t)addr, (vaddr_t)addr + size);
    396 	return 0;
    397 }
    398