Annotation of sys/dev/wscons/wsmux.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: wsmux.c,v 1.20 2007/05/14 09:03:34 tedu Exp $ */
! 2: /* $NetBSD: wsmux.c,v 1.37 2005/04/30 03:47:12 augustss Exp $ */
! 3:
! 4: /*
! 5: * Copyright (c) 1998, 2005 The NetBSD Foundation, Inc.
! 6: * All rights reserved.
! 7: *
! 8: * Author: Lennart Augustsson <augustss@carlstedt.se>
! 9: * Carlstedt Research & Technology
! 10: *
! 11: * Redistribution and use in source and binary forms, with or without
! 12: * modification, are permitted provided that the following conditions
! 13: * are met:
! 14: * 1. Redistributions of source code must retain the above copyright
! 15: * notice, this list of conditions and the following disclaimer.
! 16: * 2. Redistributions in binary form must reproduce the above copyright
! 17: * notice, this list of conditions and the following disclaimer in the
! 18: * documentation and/or other materials provided with the distribution.
! 19: * 3. All advertising materials mentioning features or use of this software
! 20: * must display the following acknowledgement:
! 21: * This product includes software developed by the NetBSD
! 22: * Foundation, Inc. and its contributors.
! 23: * 4. Neither the name of The NetBSD Foundation nor the names of its
! 24: * contributors may be used to endorse or promote products derived
! 25: * from this software without specific prior written permission.
! 26: *
! 27: * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
! 28: * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
! 29: * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
! 30: * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
! 31: * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
! 32: * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
! 33: * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
! 34: * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
! 35: * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
! 36: * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
! 37: * POSSIBILITY OF SUCH DAMAGE.
! 38: */
! 39:
! 40: #include "wsmux.h"
! 41: #include "wsdisplay.h"
! 42: #include "wskbd.h"
! 43: #include "wsmouse.h"
! 44:
! 45: /*
! 46: * wscons mux device.
! 47: *
! 48: * The mux device is a collection of real mice and keyboards and acts as
! 49: * a merge point for all the events from the different real devices.
! 50: */
! 51:
! 52: #include <sys/param.h>
! 53: #include <sys/conf.h>
! 54: #include <sys/ioctl.h>
! 55: #include <sys/fcntl.h>
! 56: #include <sys/kernel.h>
! 57: #include <sys/malloc.h>
! 58: #include <sys/proc.h>
! 59: #include <sys/queue.h>
! 60: #include <sys/syslog.h>
! 61: #include <sys/systm.h>
! 62: #include <sys/tty.h>
! 63: #include <sys/signalvar.h>
! 64: #include <sys/device.h>
! 65: #include <sys/poll.h>
! 66:
! 67: #include <dev/wscons/wsconsio.h>
! 68: #include <dev/wscons/wsksymdef.h>
! 69: #include <dev/wscons/wseventvar.h>
! 70: #include <dev/wscons/wscons_callbacks.h>
! 71: #include <dev/wscons/wsmuxvar.h>
! 72:
! 73: #ifdef WSMUX_DEBUG
! 74: #define DPRINTF(x) if (wsmuxdebug) printf x
! 75: #define DPRINTFN(n,x) if (wsmuxdebug > (n)) printf x
! 76: int wsmuxdebug = 0;
! 77: #else
! 78: #define DPRINTF(x)
! 79: #define DPRINTFN(n,x)
! 80: #endif
! 81:
! 82: /*
! 83: * The wsmux pseudo device is used to multiplex events from several wsmouse,
! 84: * wskbd, and/or wsmux devices together.
! 85: * The devices connected together form a tree with muxes in the interior
! 86: * and real devices (mouse and kbd) at the leaves. The special case of
! 87: * a tree with one node (mux or other) is supported as well.
! 88: * Only the device at the root of the tree can be opened (if a non-root
! 89: * device is opened the subtree rooted at that point is severed from the
! 90: * containing tree). When the root is opened it allocates a wseventvar
! 91: * struct which all the nodes in the tree will send their events too.
! 92: * An ioctl() performed on the root is propagated to all the nodes.
! 93: * There are also ioctl() operations to add and remove nodes from a tree.
! 94: */
! 95:
! 96: int wsmux_mux_open(struct wsevsrc *, struct wseventvar *);
! 97: int wsmux_mux_close(struct wsevsrc *);
! 98:
! 99: void wsmux_do_open(struct wsmux_softc *, struct wseventvar *);
! 100:
! 101: void wsmux_do_close(struct wsmux_softc *);
! 102: #if NWSDISPLAY > 0
! 103: int wsmux_evsrc_set_display(struct device *, struct device *);
! 104: #else
! 105: #define wsmux_evsrc_set_display NULL
! 106: #endif
! 107:
! 108: int wsmux_do_displayioctl(struct device *dev, u_long cmd, caddr_t data,
! 109: int flag, struct proc *p);
! 110: int wsmux_do_ioctl(struct device *, u_long, caddr_t,int,struct proc *);
! 111:
! 112: int wsmux_add_mux(int, struct wsmux_softc *);
! 113:
! 114: void wsmuxattach(int);
! 115:
! 116: struct wssrcops wsmux_srcops = {
! 117: WSMUX_MUX,
! 118: wsmux_mux_open, wsmux_mux_close, wsmux_do_ioctl, wsmux_do_displayioctl,
! 119: wsmux_evsrc_set_display
! 120: };
! 121:
! 122: /* From upper level */
! 123: void
! 124: wsmuxattach(int n)
! 125: {
! 126: }
! 127:
! 128: /* Keep track of all muxes that have been allocated */
! 129: int nwsmux = 0;
! 130: struct wsmux_softc **wsmuxdevs = NULL;
! 131:
! 132: /* Return mux n, create if necessary */
! 133: struct wsmux_softc *
! 134: wsmux_getmux(int n)
! 135: {
! 136: struct wsmux_softc *sc;
! 137: struct wsmux_softc **new, **old;
! 138: int i;
! 139:
! 140: /* Make sure there is room for mux n in the table */
! 141: if (n >= nwsmux) {
! 142: old = wsmuxdevs;
! 143: new = (struct wsmux_softc **)
! 144: malloc((n + 1) * sizeof (*wsmuxdevs), M_DEVBUF, M_NOWAIT);
! 145: if (new == NULL) {
! 146: printf("wsmux_getmux: no memory for mux %d\n", n);
! 147: return (NULL);
! 148: }
! 149: if (old != NULL)
! 150: bcopy(old, new, nwsmux * sizeof(*wsmuxdevs));
! 151: for (i = nwsmux; i < (n + 1); i++)
! 152: new[i] = NULL;
! 153: wsmuxdevs = new;
! 154: nwsmux = n + 1;
! 155: if (old != NULL)
! 156: free(old, M_DEVBUF);
! 157: }
! 158:
! 159: sc = wsmuxdevs[n];
! 160: if (sc == NULL) {
! 161: sc = wsmux_create("wsmux", n);
! 162: if (sc == NULL)
! 163: printf("wsmux: attach out of memory\n");
! 164: wsmuxdevs[n] = sc;
! 165: }
! 166: return (sc);
! 167: }
! 168:
! 169: /*
! 170: * open() of the pseudo device from device table.
! 171: */
! 172: int
! 173: wsmuxopen(dev_t dev, int flags, int mode, struct proc *p)
! 174: {
! 175: struct wsmux_softc *sc;
! 176: struct wseventvar *evar;
! 177: int unit;
! 178:
! 179: unit = minor(dev);
! 180: sc = wsmux_getmux(unit);
! 181: if (sc == NULL)
! 182: return (ENXIO);
! 183:
! 184: DPRINTF(("wsmuxopen: %s: sc=%p p=%p\n", sc->sc_base.me_dv.dv_xname, sc, p));
! 185:
! 186: if ((flags & (FREAD | FWRITE)) == FWRITE) {
! 187: /* Not opening for read, only ioctl is available. */
! 188: return (0);
! 189: }
! 190:
! 191: if (sc->sc_base.me_parent != NULL) {
! 192: /* Grab the mux out of the greedy hands of the parent mux. */
! 193: DPRINTF(("wsmuxopen: detach\n"));
! 194: wsmux_detach_sc(&sc->sc_base);
! 195: }
! 196:
! 197: if (sc->sc_base.me_evp != NULL)
! 198: /* Already open. */
! 199: return (EBUSY);
! 200:
! 201: evar = &sc->sc_base.me_evar;
! 202: wsevent_init(evar);
! 203: evar->io = p;
! 204: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 205: sc->sc_rawkbd = 0;
! 206: #endif
! 207:
! 208: wsmux_do_open(sc, evar);
! 209:
! 210: return (0);
! 211: }
! 212:
! 213: /*
! 214: * Open of a mux via the parent mux.
! 215: */
! 216: int
! 217: wsmux_mux_open(struct wsevsrc *me, struct wseventvar *evar)
! 218: {
! 219: struct wsmux_softc *sc = (struct wsmux_softc *)me;
! 220:
! 221: #ifdef DIAGNOSTIC
! 222: if (sc->sc_base.me_evp != NULL) {
! 223: printf("wsmux_mux_open: busy\n");
! 224: return (EBUSY);
! 225: }
! 226: if (sc->sc_base.me_parent == NULL) {
! 227: printf("wsmux_mux_open: no parent\n");
! 228: return (EINVAL);
! 229: }
! 230: #endif
! 231:
! 232: wsmux_do_open(sc, evar);
! 233:
! 234: return (0);
! 235: }
! 236:
! 237: /* Common part of opening a mux. */
! 238: void
! 239: wsmux_do_open(struct wsmux_softc *sc, struct wseventvar *evar)
! 240: {
! 241: struct wsevsrc *me;
! 242: #ifdef DIAGNOSTIC
! 243: int error;
! 244: #endif
! 245:
! 246: sc->sc_base.me_evp = evar; /* remember event variable, mark as open */
! 247:
! 248: /* Open all children. */
! 249: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 250: DPRINTF(("wsmuxopen: %s: m=%p dev=%s\n",
! 251: sc->sc_base.me_dv.dv_xname, me, me->me_dv.dv_xname));
! 252: #ifdef DIAGNOSTIC
! 253: if (me->me_evp != NULL) {
! 254: printf("wsmuxopen: dev already in use\n");
! 255: continue;
! 256: }
! 257: if (me->me_parent != sc) {
! 258: printf("wsmux_do_open: bad child=%p\n", me);
! 259: continue;
! 260: }
! 261: error = wsevsrc_open(me, evar);
! 262: if (error) {
! 263: DPRINTF(("wsmuxopen: open failed %d\n", error));
! 264: }
! 265: #else
! 266: /* ignore errors, failing children will not be marked open */
! 267: (void)wsevsrc_open(me, evar);
! 268: #endif
! 269: }
! 270: }
! 271:
! 272: /*
! 273: * close() of the pseudo device from device table.
! 274: */
! 275: int
! 276: wsmuxclose(dev_t dev, int flags, int mode, struct proc *p)
! 277: {
! 278: struct wsmux_softc *sc =
! 279: (struct wsmux_softc *)wsmuxdevs[minor(dev)];
! 280: struct wseventvar *evar = sc->sc_base.me_evp;
! 281:
! 282: if (evar == NULL)
! 283: /* Not open for read */
! 284: return (0);
! 285:
! 286: wsmux_do_close(sc);
! 287: sc->sc_base.me_evp = NULL;
! 288: wsevent_fini(evar);
! 289: return (0);
! 290: }
! 291:
! 292: /*
! 293: * Close of a mux via the parent mux.
! 294: */
! 295: int
! 296: wsmux_mux_close(struct wsevsrc *me)
! 297: {
! 298: me->me_evp = NULL;
! 299: wsmux_do_close((struct wsmux_softc *)me);
! 300: return (0);
! 301: }
! 302:
! 303: /* Common part of closing a mux. */
! 304: void
! 305: wsmux_do_close(struct wsmux_softc *sc)
! 306: {
! 307: struct wsevsrc *me;
! 308:
! 309: DPRINTF(("wsmuxclose: %s: sc=%p\n", sc->sc_base.me_dv.dv_xname, sc));
! 310:
! 311: /* Close all the children. */
! 312: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 313: DPRINTF(("wsmuxclose %s: m=%p dev=%s\n",
! 314: sc->sc_base.me_dv.dv_xname, me, me->me_dv.dv_xname));
! 315: #ifdef DIAGNOSTIC
! 316: if (me->me_parent != sc) {
! 317: printf("wsmuxclose: bad child=%p\n", me);
! 318: continue;
! 319: }
! 320: #endif
! 321: (void)wsevsrc_close(me);
! 322: me->me_evp = NULL;
! 323: }
! 324: }
! 325:
! 326: /*
! 327: * read() of the pseudo device from device table.
! 328: */
! 329: int
! 330: wsmuxread(dev_t dev, struct uio *uio, int flags)
! 331: {
! 332: struct wsmux_softc *sc = wsmuxdevs[minor(dev)];
! 333: struct wseventvar *evar;
! 334: int error;
! 335:
! 336: evar = sc->sc_base.me_evp;
! 337: if (evar == NULL) {
! 338: #ifdef DIAGNOSTIC
! 339: /* XXX can we get here? */
! 340: printf("wsmuxread: not open\n");
! 341: #endif
! 342: return (EINVAL);
! 343: }
! 344:
! 345: DPRINTFN(5,("wsmuxread: %s event read evar=%p\n",
! 346: sc->sc_base.me_dv.dv_xname, evar));
! 347: error = wsevent_read(evar, uio, flags);
! 348: DPRINTFN(5,("wsmuxread: %s event read ==> error=%d\n",
! 349: sc->sc_base.me_dv.dv_xname, error));
! 350: return (error);
! 351: }
! 352:
! 353: /*
! 354: * ioctl of the pseudo device from device table.
! 355: */
! 356: int
! 357: wsmuxioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
! 358: {
! 359: return wsmux_do_ioctl(&wsmuxdevs[minor(dev)]->sc_base.me_dv, cmd, data, flag, p);
! 360: }
! 361:
! 362: /*
! 363: * ioctl of a mux via the parent mux, continuation of wsmuxioctl().
! 364: */
! 365: int
! 366: wsmux_do_ioctl(struct device *dv, u_long cmd, caddr_t data, int flag,
! 367: struct proc *p)
! 368: {
! 369: struct wsmux_softc *sc = (struct wsmux_softc *)dv;
! 370: struct wsevsrc *me;
! 371: int error, ok;
! 372: int s, put, get, n;
! 373: struct wseventvar *evar;
! 374: struct wscons_event *ev;
! 375: struct wsmux_device_list *l;
! 376:
! 377: DPRINTF(("wsmux_do_ioctl: %s: enter sc=%p, cmd=%08lx\n",
! 378: sc->sc_base.me_dv.dv_xname, sc, cmd));
! 379:
! 380: switch (cmd) {
! 381: case WSMUXIO_INJECTEVENT:
! 382: case WSMUXIO_ADD_DEVICE:
! 383: case WSMUXIO_REMOVE_DEVICE:
! 384: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 385: case WSKBDIO_SETMODE:
! 386: #endif
! 387: if ((flag & FWRITE) == 0)
! 388: return (EACCES);
! 389: }
! 390:
! 391: switch (cmd) {
! 392: case WSMUXIO_INJECTEVENT:
! 393: /* Inject an event, e.g., from moused. */
! 394: DPRINTF(("%s: inject\n", sc->sc_base.me_dv.dv_xname));
! 395: evar = sc->sc_base.me_evp;
! 396: if (evar == NULL) {
! 397: /* No event sink, so ignore it. */
! 398: DPRINTF(("wsmux_do_ioctl: event ignored\n"));
! 399: return (0);
! 400: }
! 401:
! 402: s = spltty();
! 403: get = evar->get;
! 404: put = evar->put;
! 405: ev = &evar->q[put];
! 406: if (++put % WSEVENT_QSIZE == get) {
! 407: put--;
! 408: splx(s);
! 409: return (ENOSPC);
! 410: }
! 411: if (put >= WSEVENT_QSIZE)
! 412: put = 0;
! 413: *ev = *(struct wscons_event *)data;
! 414: nanotime(&ev->time);
! 415: evar->put = put;
! 416: WSEVENT_WAKEUP(evar);
! 417: splx(s);
! 418: return (0);
! 419: case WSMUXIO_ADD_DEVICE:
! 420: #define d ((struct wsmux_device *)data)
! 421: DPRINTF(("%s: add type=%d, no=%d\n", sc->sc_base.me_dv.dv_xname,
! 422: d->type, d->idx));
! 423: switch (d->type) {
! 424: #if NWSMOUSE > 0
! 425: case WSMUX_MOUSE:
! 426: return (wsmouse_add_mux(d->idx, sc));
! 427: #endif
! 428: #if NWSKBD > 0
! 429: case WSMUX_KBD:
! 430: return (wskbd_add_mux(d->idx, sc));
! 431: #endif
! 432: case WSMUX_MUX:
! 433: return (wsmux_add_mux(d->idx, sc));
! 434: default:
! 435: return (EINVAL);
! 436: }
! 437: case WSMUXIO_REMOVE_DEVICE:
! 438: DPRINTF(("%s: rem type=%d, no=%d\n", sc->sc_base.me_dv.dv_xname,
! 439: d->type, d->idx));
! 440: /* Locate the device */
! 441: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 442: if (me->me_ops->type == d->type &&
! 443: me->me_dv.dv_unit == d->idx) {
! 444: DPRINTF(("wsmux_do_ioctl: detach\n"));
! 445: wsmux_detach_sc(me);
! 446: return (0);
! 447: }
! 448: }
! 449: return (EINVAL);
! 450: #undef d
! 451:
! 452: case WSMUXIO_LIST_DEVICES:
! 453: DPRINTF(("%s: list\n", sc->sc_base.me_dv.dv_xname));
! 454: l = (struct wsmux_device_list *)data;
! 455: n = 0;
! 456: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 457: if (n >= WSMUX_MAXDEV)
! 458: break;
! 459: l->devices[n].type = me->me_ops->type;
! 460: l->devices[n].idx = me->me_dv.dv_unit;
! 461: n++;
! 462: }
! 463: l->ndevices = n;
! 464: return (0);
! 465: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 466: case WSKBDIO_SETMODE:
! 467: sc->sc_rawkbd = *(int *)data;
! 468: DPRINTF(("wsmux_do_ioctl: save rawkbd = %d\n", sc->sc_rawkbd));
! 469: break;
! 470: #endif
! 471: case FIONBIO:
! 472: DPRINTF(("%s: FIONBIO\n", sc->sc_base.me_dv.dv_xname));
! 473: return (0);
! 474:
! 475: case FIOASYNC:
! 476: DPRINTF(("%s: FIOASYNC\n", sc->sc_base.me_dv.dv_xname));
! 477: evar = sc->sc_base.me_evp;
! 478: if (evar == NULL)
! 479: return (EINVAL);
! 480: evar->async = *(int *)data != 0;
! 481: return (0);
! 482: case FIOSETOWN:
! 483: DPRINTF(("%s: FIOSETOWN\n", sc->sc_base.me_dv.dv_xname));
! 484: evar = sc->sc_base.me_evp;
! 485: if (evar == NULL)
! 486: return (EINVAL);
! 487: if (-*(int *)data != evar->io->p_pgid
! 488: && *(int *)data != evar->io->p_pid)
! 489: return (EPERM);
! 490: return (0);
! 491: case TIOCSPGRP:
! 492: DPRINTF(("%s: TIOCSPGRP\n", sc->sc_base.me_dv.dv_xname));
! 493: evar = sc->sc_base.me_evp;
! 494: if (evar == NULL)
! 495: return (EINVAL);
! 496: if (*(int *)data != evar->io->p_pgid)
! 497: return (EPERM);
! 498: return (0);
! 499: default:
! 500: DPRINTF(("%s: unknown\n", sc->sc_base.me_dv.dv_xname));
! 501: break;
! 502: }
! 503:
! 504: if (sc->sc_base.me_evp == NULL
! 505: #if NWSDISPLAY > 0
! 506: && sc->sc_displaydv == NULL
! 507: #endif
! 508: )
! 509: return (EACCES);
! 510:
! 511: /* Return 0 if any of the ioctl() succeeds, otherwise the last error */
! 512: error = 0;
! 513: ok = 0;
! 514: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 515: #ifdef DIAGNOSTIC
! 516: /* XXX check evp? */
! 517: if (me->me_parent != sc) {
! 518: printf("wsmux_do_ioctl: bad child %p\n", me);
! 519: continue;
! 520: }
! 521: #endif
! 522: error = wsevsrc_ioctl(me, cmd, data, flag, p);
! 523: DPRINTF(("wsmux_do_ioctl: %s: me=%p dev=%s ==> %d\n",
! 524: sc->sc_base.me_dv.dv_xname, me, me->me_dv.dv_xname,
! 525: error));
! 526: if (!error)
! 527: ok = 1;
! 528: }
! 529: if (ok) {
! 530: error = 0;
! 531: if (cmd == WSKBDIO_SETENCODING) {
! 532: sc->sc_kbd_layout = *((kbd_t *)data);
! 533: }
! 534:
! 535: }
! 536:
! 537: return (error);
! 538: }
! 539:
! 540: /*
! 541: * poll() of the pseudo device from device table.
! 542: */
! 543: int
! 544: wsmuxpoll(dev_t dev, int events, struct proc *p)
! 545: {
! 546: struct wsmux_softc *sc = wsmuxdevs[minor(dev)];
! 547:
! 548: if (sc->sc_base.me_evp == NULL) {
! 549: #ifdef DIAGNOSTIC
! 550: printf("wsmuxpoll: not open\n");
! 551: #endif
! 552: return (POLLERR);
! 553: }
! 554:
! 555: return (wsevent_poll(sc->sc_base.me_evp, events, p));
! 556: }
! 557:
! 558: /*
! 559: * Add mux unit as a child to muxsc.
! 560: */
! 561: int
! 562: wsmux_add_mux(int unit, struct wsmux_softc *muxsc)
! 563: {
! 564: struct wsmux_softc *sc, *m;
! 565:
! 566: sc = wsmux_getmux(unit);
! 567: if (sc == NULL)
! 568: return (ENXIO);
! 569:
! 570: DPRINTF(("wsmux_add_mux: %s(%p) to %s(%p)\n",
! 571: sc->sc_base.me_dv.dv_xname, sc, muxsc->sc_base.me_dv.dv_xname,
! 572: muxsc));
! 573:
! 574: if (sc->sc_base.me_parent != NULL || sc->sc_base.me_evp != NULL)
! 575: return (EBUSY);
! 576:
! 577: /* The mux we are adding must not be an ancestor of itself. */
! 578: for (m = muxsc; m != NULL ; m = m->sc_base.me_parent)
! 579: if (m == sc)
! 580: return (EINVAL);
! 581:
! 582: return (wsmux_attach_sc(muxsc, &sc->sc_base));
! 583: }
! 584:
! 585: /* Create a new mux softc. */
! 586: struct wsmux_softc *
! 587: wsmux_create(const char *name, int unit)
! 588: {
! 589: struct wsmux_softc *sc;
! 590:
! 591: DPRINTF(("wsmux_create: allocating\n"));
! 592: sc = malloc(sizeof *sc, M_DEVBUF, M_NOWAIT);
! 593: if (sc == NULL)
! 594: return (NULL);
! 595: bzero(sc, sizeof *sc);
! 596: CIRCLEQ_INIT(&sc->sc_cld);
! 597: snprintf(sc->sc_base.me_dv.dv_xname, sizeof sc->sc_base.me_dv.dv_xname,
! 598: "%s%d", name, unit);
! 599: sc->sc_base.me_dv.dv_unit = unit;
! 600: sc->sc_base.me_ops = &wsmux_srcops;
! 601: sc->sc_kbd_layout = KB_NONE;
! 602: return (sc);
! 603: }
! 604:
! 605: /* Attach me as a child to sc. */
! 606: int
! 607: wsmux_attach_sc(struct wsmux_softc *sc, struct wsevsrc *me)
! 608: {
! 609: int error;
! 610:
! 611: if (sc == NULL)
! 612: return (EINVAL);
! 613:
! 614: DPRINTF(("wsmux_attach_sc: %s(%p): type=%d\n",
! 615: sc->sc_base.me_dv.dv_xname, sc, me->me_ops->type));
! 616:
! 617: #ifdef DIAGNOSTIC
! 618: if (me->me_parent != NULL) {
! 619: printf("wsmux_attach_sc: busy\n");
! 620: return (EBUSY);
! 621: }
! 622: #endif
! 623: me->me_parent = sc;
! 624: CIRCLEQ_INSERT_TAIL(&sc->sc_cld, me, me_next);
! 625:
! 626: error = 0;
! 627: #if NWSDISPLAY > 0
! 628: if (sc->sc_displaydv != NULL) {
! 629: /* This is a display mux, so attach the new device to it. */
! 630: DPRINTF(("wsmux_attach_sc: %s: set display %p\n",
! 631: sc->sc_base.me_dv.dv_xname, sc->sc_displaydv));
! 632: if (me->me_ops->dsetdisplay != NULL) {
! 633: error = wsevsrc_set_display(me, sc->sc_displaydv);
! 634: /* Ignore that the console already has a display. */
! 635: if (error == EBUSY)
! 636: error = 0;
! 637: if (!error) {
! 638: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 639: DPRINTF(("wsmux_attach_sc: %s set rawkbd=%d\n",
! 640: me->me_dv.dv_xname, sc->sc_rawkbd));
! 641: (void)wsevsrc_ioctl(me, WSKBDIO_SETMODE,
! 642: &sc->sc_rawkbd, FWRITE, 0);
! 643: #endif
! 644: if (sc->sc_kbd_layout != KB_NONE)
! 645: (void)wsevsrc_ioctl(me,
! 646: WSKBDIO_SETENCODING,
! 647: &sc->sc_kbd_layout, FWRITE, 0);
! 648: }
! 649: }
! 650: }
! 651: #endif
! 652: if (sc->sc_base.me_evp != NULL) {
! 653: /* Mux is open, so open the new subdevice */
! 654: DPRINTF(("wsmux_attach_sc: %s: calling open of %s\n",
! 655: sc->sc_base.me_dv.dv_xname, me->me_dv.dv_xname));
! 656: error = wsevsrc_open(me, sc->sc_base.me_evp);
! 657: } else {
! 658: DPRINTF(("wsmux_attach_sc: %s not open\n",
! 659: sc->sc_base.me_dv.dv_xname));
! 660: }
! 661:
! 662: if (error) {
! 663: me->me_parent = NULL;
! 664: CIRCLEQ_REMOVE(&sc->sc_cld, me, me_next);
! 665: }
! 666:
! 667: DPRINTF(("wsmux_attach_sc: %s(%p) done, error=%d\n",
! 668: sc->sc_base.me_dv.dv_xname, sc, error));
! 669: return (error);
! 670: }
! 671:
! 672: /* Remove me from the parent. */
! 673: void
! 674: wsmux_detach_sc(struct wsevsrc *me)
! 675: {
! 676: struct wsmux_softc *sc = me->me_parent;
! 677:
! 678: DPRINTF(("wsmux_detach_sc: %s(%p) parent=%p\n",
! 679: me->me_dv.dv_xname, me, sc));
! 680:
! 681: #ifdef DIAGNOSTIC
! 682: if (sc == NULL) {
! 683: printf("wsmux_detach_sc: %s has no parent\n",
! 684: me->me_dv.dv_xname);
! 685: return;
! 686: }
! 687: #endif
! 688:
! 689: #if NWSDISPLAY > 0
! 690: if (sc->sc_displaydv != NULL) {
! 691: if (me->me_ops->dsetdisplay != NULL)
! 692: /* ignore error, there's nothing we can do */
! 693: (void)wsevsrc_set_display(me, NULL);
! 694: } else
! 695: #endif
! 696: if (me->me_evp != NULL) {
! 697: DPRINTF(("wsmux_detach_sc: close\n"));
! 698: /* mux device is open, so close multiplexee */
! 699: (void)wsevsrc_close(me);
! 700: }
! 701:
! 702: CIRCLEQ_REMOVE(&sc->sc_cld, me, me_next);
! 703: me->me_parent = NULL;
! 704:
! 705: DPRINTF(("wsmux_detach_sc: done sc=%p\n", sc));
! 706: }
! 707:
! 708: /*
! 709: * Display ioctl() of a mux via the parent mux.
! 710: */
! 711: int
! 712: wsmux_do_displayioctl(struct device *dv, u_long cmd, caddr_t data, int flag,
! 713: struct proc *p)
! 714: {
! 715: struct wsmux_softc *sc = (struct wsmux_softc *)dv;
! 716: struct wsevsrc *me;
! 717: int error, ok;
! 718:
! 719: DPRINTF(("wsmux_displayioctl: %s: sc=%p, cmd=%08lx\n",
! 720: sc->sc_base.me_dv.dv_xname, sc, cmd));
! 721:
! 722: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 723: if (cmd == WSKBDIO_SETMODE) {
! 724: sc->sc_rawkbd = *(int *)data;
! 725: DPRINTF(("wsmux_displayioctl: rawkbd = %d\n", sc->sc_rawkbd));
! 726: }
! 727: #endif
! 728:
! 729: /*
! 730: * Return 0 if any of the ioctl() succeeds, otherwise the last error.
! 731: * Return -1 if no mux component accepts the ioctl.
! 732: */
! 733: error = -1;
! 734: ok = 0;
! 735: CIRCLEQ_FOREACH(me, &sc->sc_cld, me_next) {
! 736: DPRINTF(("wsmux_displayioctl: me=%p\n", me));
! 737: #ifdef DIAGNOSTIC
! 738: if (me->me_parent != sc) {
! 739: printf("wsmux_displayioctl: bad child %p\n", me);
! 740: continue;
! 741: }
! 742: #endif
! 743: if (me->me_ops->ddispioctl != NULL) {
! 744: error = wsevsrc_display_ioctl(me, cmd, data, flag, p);
! 745: DPRINTF(("wsmux_displayioctl: me=%p dev=%s ==> %d\n",
! 746: me, me->me_dv.dv_xname, error));
! 747: if (!error)
! 748: ok = 1;
! 749: }
! 750: }
! 751: if (ok)
! 752: error = 0;
! 753:
! 754: return (error);
! 755: }
! 756:
! 757: #if NWSDISPLAY > 0
! 758: /*
! 759: * Set display of a mux via the parent mux.
! 760: */
! 761: int
! 762: wsmux_evsrc_set_display(struct device *dv, struct device *displaydv)
! 763: {
! 764: struct wsmux_softc *sc = (struct wsmux_softc *)dv;
! 765:
! 766: DPRINTF(("wsmux_set_display: %s: displaydv=%p\n",
! 767: sc->sc_base.me_dv.dv_xname, displaydv));
! 768:
! 769: if (displaydv != NULL) {
! 770: if (sc->sc_displaydv != NULL)
! 771: return (EBUSY);
! 772: } else {
! 773: if (sc->sc_displaydv == NULL)
! 774: return (ENXIO);
! 775: }
! 776:
! 777: return wsmux_set_display(sc, displaydv);
! 778: }
! 779:
! 780: int
! 781: wsmux_set_display(struct wsmux_softc *sc, struct device *displaydv)
! 782: {
! 783: struct device *odisplaydv;
! 784: struct wsevsrc *me;
! 785: struct wsmux_softc *nsc = displaydv ? sc : NULL;
! 786: int error, ok;
! 787:
! 788: odisplaydv = sc->sc_displaydv;
! 789: sc->sc_displaydv = displaydv;
! 790:
! 791: if (displaydv) {
! 792: DPRINTF(("%s: connecting to %s\n",
! 793: sc->sc_base.me_dv.dv_xname, displaydv->dv_xname));
! 794: }
! 795: ok = 0;
! 796: error = 0;
! 797: CIRCLEQ_FOREACH(me, &sc->sc_cld,me_next) {
! 798: #ifdef DIAGNOSTIC
! 799: if (me->me_parent != sc) {
! 800: printf("wsmux_set_display: bad child parent %p\n", me);
! 801: continue;
! 802: }
! 803: #endif
! 804: if (me->me_ops->dsetdisplay != NULL) {
! 805: error = wsevsrc_set_display(me, nsc->sc_displaydv);
! 806: DPRINTF(("wsmux_set_display: m=%p dev=%s error=%d\n",
! 807: me, me->me_dv.dv_xname, error));
! 808: if (!error) {
! 809: ok = 1;
! 810: #ifdef WSDISPLAY_COMPAT_RAWKBD
! 811: DPRINTF(("wsmux_set_display: %s set rawkbd=%d\n"
! 812: ,
! 813: me->me_dv.dv_xname, sc->sc_rawkbd));
! 814: (void)wsevsrc_ioctl(me, WSKBDIO_SETMODE,
! 815: &sc->sc_rawkbd, FWRITE, 0);
! 816: #endif
! 817: }
! 818: }
! 819: }
! 820: if (ok)
! 821: error = 0;
! 822:
! 823: if (displaydv == NULL) {
! 824: DPRINTF(("%s: disconnecting from %s\n",
! 825: sc->sc_base.me_dv.dv_xname, odisplaydv->dv_xname));
! 826: }
! 827:
! 828: return (error);
! 829: }
! 830: #endif /* NWSDISPLAY > 0 */
CVSweb