Home | History | Annotate | Line # | Download | only in dev
grf_compat.c revision 1.1.2.2
      1 /*	$NetBSD: grf_compat.c,v 1.1.2.2 1999/11/17 08:11:54 scottr 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 <vm/vm.h>
     58 #include <uvm/uvm_extern.h>
     59 #include <uvm/uvm_map.h>
     60 
     61 cdev_decl(grf);
     62 
     63 void	grf_scinit __P((struct grf_softc *, const char *, int));
     64 void	grf_init __P((int));
     65 void	grfattach __P((int));
     66 int	grfmap __P((dev_t, struct macfb_softc *, caddr_t *, struct proc *));
     67 int	grfunmap __P((dev_t, struct macfb_softc *, caddr_t, struct proc *));
     68 
     69 /* Non-private for the benefit of libkvm. */
     70 struct	grf_softc *grf_softc;
     71 int	numgrf = 0;
     72 
     73 /*
     74  * Initialize a softc to sane defaults.
     75  */
     76 void
     77 grf_scinit(sc, name, unit)
     78 	struct grf_softc *sc;
     79 	const char *name;
     80 	int unit;
     81 {
     82 	memset(sc, 0, sizeof(struct grf_softc));
     83 	snprintf(sc->sc_xname, sizeof(sc->sc_xname), "%s%d", name, unit);
     84 	sc->mfb_sc = NULL;
     85 }
     86 
     87 /*
     88  * (Re-)initialize the grf_softc block so that at least the requested
     89  * number of elements has been allocated.  If this results in more
     90  * elements than we had prior to getting here, we initialize each of
     91  * them to avoid problems down the road.
     92  */
     93 void
     94 grf_init(n)
     95 	int n;
     96 {
     97 	struct grf_softc *sc;
     98 	int i;
     99 
    100 	if (n >= numgrf) {
    101 		i = numgrf;
    102 		numgrf = n + 1;
    103 
    104 		if (grf_softc == NULL)
    105 			sc = (struct grf_softc *)
    106 			    malloc(numgrf * sizeof(*sc),
    107 			    M_DEVBUF, M_NOWAIT);
    108 		else
    109 			sc = (struct grf_softc *)
    110 			    realloc(grf_softc, numgrf * sizeof(*sc),
    111 			    M_DEVBUF, M_NOWAIT);
    112 		if (sc == NULL) {
    113 			printf("WARNING: no memory for grf emulation\n");
    114 			if (grf_softc != NULL)
    115 				free(grf_softc, M_DEVBUF);
    116 			return;
    117 		}
    118 		grf_softc = sc;
    119 
    120 		/* Initialize per-softc structures. */
    121 		while (i < numgrf) {
    122 			grf_scinit(&grf_softc[i], "grf", i);
    123 			i++;
    124 		}
    125 	}
    126 }
    127 
    128 /*
    129  * Called by main() during pseudo-device attachment.  If we had a
    130  * way to configure additional grf devices later, this would actually
    131  * allocate enough space for them.  As it stands, it's nonsensical,
    132  * so other than a basic sanity check we do nothing.
    133  */
    134 void
    135 grfattach(n)
    136 	int n;
    137 {
    138 	if (n <= 0) {
    139 #ifdef DIAGNOSTIC
    140 		panic("grfattach: count <= 0");
    141 #endif
    142 		return;
    143 	}
    144 
    145 #if 0 /* XXX someday, if we implement a way to attach after autoconfig */
    146 	grf_init(n);
    147 #endif
    148 }
    149 
    150 /*
    151  * Called from macfb_attach() after setting up the frame buffer.  Since
    152  * there is a 1:1 correspondence between the macfb device and the grf
    153  * device, the only bit of information we really need is the macfb_softc.
    154  */
    155 void
    156 grf_attach(sc, unit)
    157 	struct macfb_softc *sc;
    158 	int unit;
    159 {
    160 	grf_init(unit);
    161 
    162 	if (unit < numgrf)
    163 		grf_softc[unit].mfb_sc = sc;
    164 }
    165 
    166 /*
    167  * Standard device ops
    168  */
    169 int
    170 grfopen(dev, flag, mode, p)
    171 	dev_t dev;
    172 	int flag;
    173 	int mode;
    174 	struct proc *p;
    175 {
    176 	struct grf_softc *sc;
    177 	int unit = GRFUNIT(dev);
    178 	int rv = 0;
    179 
    180 	if (grf_softc == NULL || unit >= numgrf)
    181 		return ENXIO;
    182 
    183 	sc = &grf_softc[unit];
    184 	if (sc->mfb_sc != NULL)
    185 		sc->sc_isopen++;
    186 	else
    187 		rv = ENXIO;
    188 
    189 	return rv;
    190 }
    191 
    192 int
    193 grfclose(dev, flag, mode, p)
    194 	dev_t dev;
    195 	int flag;
    196 	int mode;
    197 	struct proc *p;
    198 {
    199 	struct grf_softc *sc;
    200 	int unit = GRFUNIT(dev);
    201 	int rv = 0;
    202 
    203 	if (grf_softc == NULL || unit >= numgrf)
    204 		return ENXIO;
    205 
    206 	sc = &grf_softc[unit];
    207 	if (sc->mfb_sc != NULL && sc->sc_isopen)
    208 		sc->sc_isopen = 0;
    209 	else
    210 		rv = ENXIO;
    211 
    212 	return rv;
    213 }
    214 
    215 int
    216 grfread(dev, uio, ioflag)
    217 	dev_t dev;
    218 	struct uio *uio;
    219 	int ioflag;
    220 {
    221 	return ENXIO;
    222 }
    223 
    224 int
    225 grfwrite(dev, uio, ioflag)
    226 	dev_t dev;
    227 	struct uio *uio;
    228 	int ioflag;
    229 {
    230 	return ENXIO;
    231 }
    232 
    233 int
    234 grfioctl(dev, cmd, data, flag, p)
    235 	dev_t dev;
    236 	u_long cmd;
    237 	caddr_t data;
    238 	int flag;
    239 	struct proc *p;
    240 {
    241 	struct grf_softc *sc;
    242 	struct macfb_devconfig *dc;
    243 	struct grfinfo *gd;
    244 	struct grfmode *gm;
    245 	int unit = GRFUNIT(dev);
    246 	int rv;
    247 
    248 	if (grf_softc == NULL || unit >= numgrf)
    249 		return ENXIO;
    250 
    251 	sc = &grf_softc[unit];
    252 	if (sc->mfb_sc == NULL)
    253 		return ENXIO;
    254 
    255 	dc = sc->mfb_sc->sc_dc;
    256 
    257 	switch (cmd) {
    258 	case GRFIOCGINFO:
    259 		gd = (struct grfinfo *)data;
    260 		memset(gd, 0, sizeof(struct grfinfo));
    261 		gd->gd_fbaddr     = (caddr_t)dc->dc_paddr;
    262 		gd->gd_fbsize     = dc->dc_size;
    263 		gd->gd_colors     = (short)(1 << dc->dc_depth);
    264 		gd->gd_planes     = (short)dc->dc_depth;
    265 		gd->gd_fbwidth    = dc->dc_wid;
    266 		gd->gd_fbheight   = dc->dc_ht;
    267 		gd->gd_fbrowbytes = dc->dc_rowbytes;
    268 		gd->gd_dwidth     = dc->dc_raster.width;
    269 		gd->gd_dheight    = dc->dc_raster.height;
    270 		rv = 0;
    271 		break;
    272 
    273 	case GRFIOCON:
    274 	case GRFIOCOFF:
    275 		/* Nothing to do */
    276 		rv = 0;
    277 		break;
    278 
    279 	case GRFIOCMAP:
    280 		rv = grfmap(dev, sc->mfb_sc, (caddr_t *)data, p);
    281 		break;
    282 
    283 	case GRFIOCUNMAP:
    284 		rv = grfunmap(dev, sc->mfb_sc, *(caddr_t *)data, p);
    285 		break;
    286 
    287 	case GRFIOCGMODE:
    288 		gm = (struct grfmode *)data;
    289 		memset(gm, 0, sizeof(struct grfmode));
    290 		gm->fbbase   = (char *)dc->dc_vaddr;
    291 		gm->fbsize   = dc->dc_size;
    292 		gm->fboff    = dc->dc_offset;
    293 		gm->rowbytes = dc->dc_rowbytes;
    294 		gm->width    = dc->dc_wid;
    295 		gm->height   = dc->dc_ht;
    296 		gm->psize    = dc->dc_depth;
    297 		rv = 0;
    298 		break;
    299 
    300 	case GRFIOCLISTMODES:
    301 	case GRFIOCGETMODE:
    302 	case GRFIOCSETMODE:
    303 		/* NONE of these operations are (or ever were) supported. */
    304 		rv = ENOTTY;
    305 		break;
    306 
    307 	default:
    308 		rv = (-1);
    309 		break;
    310 	}
    311 	return rv;
    312 }
    313 
    314 int
    315 grfpoll(dev, events, p)
    316 	dev_t dev;
    317 	int events;
    318 	struct proc *p;
    319 {
    320 	return EINVAL;
    321 }
    322 
    323 int
    324 grfmmap(dev, off, prot)
    325 	dev_t dev;
    326 	int off;
    327 	int prot;
    328 {
    329 	struct grf_softc *sc;
    330 	struct macfb_devconfig *dc;
    331 	u_long addr;
    332 	int unit = GRFUNIT(dev);
    333 
    334 	if (grf_softc == NULL || unit >= numgrf)
    335 		return ENXIO;
    336 
    337 	sc = &grf_softc[unit];
    338 	if (sc->mfb_sc == NULL || !sc->sc_isopen)
    339 		return ENXIO;
    340 
    341 	dc = sc->mfb_sc->sc_dc;
    342 
    343 	if (off >= 0 &&
    344 	    off < m68k_round_page(dc->dc_offset + dc->dc_size))
    345 		addr = m68k_btop(dc->dc_paddr + dc->dc_offset + off);
    346 	else
    347 		addr = (-1);	/* XXX bogus */
    348 
    349 	return (int)addr;
    350 }
    351 
    352 int
    353 grfmap(dev, sc, addrp, p)
    354 	dev_t dev;
    355 	struct macfb_softc *sc;
    356 	caddr_t *addrp;
    357 	struct proc *p;
    358 {
    359 	struct specinfo si;
    360 	struct vnode vn;
    361 	u_long len;
    362 	int error, flags;
    363 
    364 	*addrp = (caddr_t)sc->sc_dc->dc_paddr;
    365 	len = m68k_round_page(sc->sc_dc->dc_offset + sc->sc_dc->dc_size);
    366 	flags = MAP_SHARED;
    367 
    368 	vn.v_type = VCHR;		/* XXX */
    369 	vn.v_specinfo = &si;		/* XXX */
    370 	vn.v_rdev = dev;		/* XXX */
    371 
    372 	error = uvm_mmap(&p->p_vmspace->vm_map, (vaddr_t *)addrp,
    373 	    (vsize_t)len, VM_PROT_ALL, VM_PROT_ALL,
    374 	    flags, (caddr_t)&vn, 0, p->p_rlimit[RLIMIT_MEMLOCK].rlim_cur);
    375 
    376 	/* Offset into page: */
    377 	*addrp += sc->sc_dc->dc_offset;
    378 
    379 	return (error);
    380 }
    381 
    382 int
    383 grfunmap(dev, sc, addr, p)
    384 	dev_t dev;
    385 	struct macfb_softc *sc;
    386 	caddr_t addr;
    387 	struct proc *p;
    388 {
    389 	vm_size_t size;
    390 	int     rv;
    391 
    392 	addr -= sc->sc_dc->dc_offset;
    393 
    394 	if (addr <= 0)
    395 		return (-1);
    396 
    397 	size = m68k_round_page(sc->sc_dc->dc_offset + sc->sc_dc->dc_size);
    398 
    399 	rv = uvm_unmap(&p->p_vmspace->vm_map, (vaddr_t)addr,
    400 	    (vaddr_t)addr + size);
    401 
    402 	return (rv == KERN_SUCCESS ? 0 : EINVAL);
    403 }
    404