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