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