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