1 /* $NetBSD: grf_compat.c,v 1.15 2005/12/11 12:18:02 christos 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.15 2005/12/11 12:18:02 christos 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 lwp *l) 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 lwp *l) 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 lwp *l) 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, l->l_proc); 256 break; 257 258 case GRFIOCUNMAP: 259 rv = grfunmap(dev, sc->mfb_sc, *(caddr_t *)data, l->l_proc); 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