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