Home | History | Annotate | Line # | Download | only in wscons
wsmux.c revision 1.13
      1  1.13       jmc /*	$NetBSD: wsmux.c,v 1.13 2001/10/21 23:04:57 jmc Exp $	*/
      2   1.1  augustss 
      3   1.1  augustss /*
      4   1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1  augustss  * All rights reserved.
      6   1.1  augustss  *
      7   1.1  augustss  * Author: Lennart Augustsson <augustss (at) carlstedt.se>
      8   1.1  augustss  *         Carlstedt Research & Technology
      9   1.1  augustss  *
     10   1.1  augustss  * Redistribution and use in source and binary forms, with or without
     11   1.1  augustss  * modification, are permitted provided that the following conditions
     12   1.1  augustss  * are met:
     13   1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     14   1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     15   1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     17   1.1  augustss  *    documentation and/or other materials provided with the distribution.
     18   1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     19   1.1  augustss  *    must display the following acknowledgement:
     20   1.1  augustss  *        This product includes software developed by the NetBSD
     21   1.1  augustss  *        Foundation, Inc. and its contributors.
     22   1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1  augustss  *    contributors may be used to endorse or promote products derived
     24   1.1  augustss  *    from this software without specific prior written permission.
     25   1.1  augustss  *
     26   1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     37   1.1  augustss  */
     38   1.1  augustss 
     39   1.1  augustss #include "wsmux.h"
     40   1.1  augustss #include "wsdisplay.h"
     41   1.1  augustss #include "wskbd.h"
     42  1.12  augustss #include "wsmouse.h"
     43   1.1  augustss 
     44   1.1  augustss #if NWSMUX > 0 || (NWSDISPLAY > 0 && NWSKBD > 0)
     45   1.1  augustss 
     46   1.1  augustss /*
     47   1.1  augustss  * wscons mux device.
     48   1.1  augustss  *
     49   1.1  augustss  * The mux device is a collection of real mice and keyboards and acts as
     50   1.1  augustss  * a merge point for all the events from the different real devices.
     51   1.1  augustss  */
     52   1.1  augustss 
     53   1.1  augustss #include <sys/param.h>
     54   1.1  augustss #include <sys/conf.h>
     55   1.1  augustss #include <sys/ioctl.h>
     56   1.1  augustss #include <sys/fcntl.h>
     57   1.1  augustss #include <sys/kernel.h>
     58   1.1  augustss #include <sys/malloc.h>
     59   1.1  augustss #include <sys/proc.h>
     60   1.1  augustss #include <sys/queue.h>
     61   1.1  augustss #include <sys/syslog.h>
     62   1.1  augustss #include <sys/systm.h>
     63   1.1  augustss #include <sys/tty.h>
     64   1.1  augustss #include <sys/signalvar.h>
     65   1.1  augustss #include <sys/device.h>
     66   1.1  augustss 
     67   1.1  augustss #include "opt_wsdisplay_compat.h"
     68   1.1  augustss 
     69   1.1  augustss #include <dev/wscons/wsconsio.h>
     70   1.1  augustss #include <dev/wscons/wseventvar.h>
     71   1.1  augustss #include <dev/wscons/wscons_callbacks.h>
     72   1.1  augustss #include <dev/wscons/wsmuxvar.h>
     73   1.1  augustss 
     74   1.1  augustss #ifdef WSMUX_DEBUG
     75   1.1  augustss #define DPRINTF(x)	if (wsmuxdebug) printf x
     76   1.1  augustss int	wsmuxdebug = 0;
     77   1.1  augustss #else
     78   1.1  augustss #define DPRINTF(x)
     79   1.1  augustss #endif
     80   1.1  augustss 
     81   1.1  augustss struct wsplink {
     82   1.1  augustss 	LIST_ENTRY(wsplink) next;
     83   1.1  augustss 	int type;
     84   1.1  augustss 	struct wsmux_softc *mux; /* our mux device */
     85   1.1  augustss 	/* The rest of the fields reflect a value in the multiplexee. */
     86   1.1  augustss 	struct device *sc;	/* softc */
     87   1.1  augustss 	struct wseventvar *sc_mevents; /* event var */
     88   1.1  augustss 	struct wsmux_softc **sc_muxp; /* pointer to us */
     89   1.1  augustss 	struct wsmuxops *sc_ops;
     90   1.1  augustss };
     91   1.1  augustss 
     92  1.11  augustss int wsmuxdoclose(struct device *, int, int, struct proc *);
     93  1.11  augustss int wsmux_set_display(struct device *, struct wsmux_softc *);
     94   1.1  augustss 
     95   1.2  augustss #if NWSMUX > 0
     96  1.12  augustss 
     97  1.12  augustss #define WSMUXDEV(n) ((n) & 0x7f)
     98  1.12  augustss #define WSMUXCTL(n) ((n) & 0x80)
     99  1.12  augustss 
    100   1.2  augustss cdev_decl(wsmux);
    101   1.1  augustss 
    102  1.11  augustss void wsmuxattach(int);
    103   1.1  augustss 
    104   1.1  augustss struct wsmuxops wsmux_muxops = {
    105   1.1  augustss 	wsmuxopen, wsmuxdoclose, wsmuxdoioctl, wsmux_displayioctl,
    106   1.1  augustss 	wsmux_set_display
    107   1.1  augustss };
    108   1.1  augustss 
    109  1.11  augustss void wsmux_setmax(int n);
    110   1.2  augustss 
    111   1.2  augustss int nwsmux = 0;
    112   1.2  augustss struct wsmux_softc **wsmuxdevs;
    113   1.2  augustss 
    114   1.2  augustss void
    115  1.11  augustss wsmux_setmax(int n)
    116   1.2  augustss {
    117   1.2  augustss 	int i;
    118   1.2  augustss 
    119   1.2  augustss 	if (n >= nwsmux) {
    120   1.2  augustss 		i = nwsmux;
    121   1.2  augustss 		nwsmux = n + 1;
    122  1.10  augustss 		if (i != 0)
    123   1.2  augustss 			wsmuxdevs = realloc(wsmuxdevs,
    124   1.2  augustss 					    nwsmux * sizeof (*wsmuxdevs),
    125   1.2  augustss 					    M_DEVBUF, M_NOWAIT);
    126   1.2  augustss 		else
    127   1.2  augustss 			wsmuxdevs = malloc(nwsmux * sizeof (*wsmuxdevs),
    128   1.2  augustss 					   M_DEVBUF, M_NOWAIT);
    129  1.11  augustss 		if (wsmuxdevs == NULL)
    130   1.2  augustss 			panic("wsmux_setmax: no memory\n");
    131   1.2  augustss 		for (; i < nwsmux; i++)
    132   1.2  augustss 			wsmuxdevs[i] = 0;
    133   1.2  augustss 	}
    134   1.2  augustss }
    135   1.2  augustss 
    136   1.1  augustss /* From upper level */
    137   1.1  augustss void
    138  1.11  augustss wsmuxattach(int n)
    139   1.1  augustss {
    140  1.10  augustss }
    141   1.1  augustss 
    142  1.10  augustss /* Return mux n, create if necessary */
    143  1.10  augustss struct wsmux_softc *
    144  1.11  augustss wsmux_getmux(int n)
    145  1.10  augustss {
    146  1.10  augustss 	struct wsmux_softc *sc;
    147   1.1  augustss 
    148  1.10  augustss 	wsmux_setmax(n);
    149  1.10  augustss 	sc = wsmuxdevs[n];
    150  1.10  augustss 	if (sc == 0) {
    151  1.10  augustss 		sc = wsmux_create("wsmux", n);
    152  1.10  augustss 		if (sc == 0) {
    153  1.10  augustss 			printf("wsmux: attach out of memory\n");
    154  1.10  augustss 			return (NULL);
    155  1.10  augustss 		}
    156  1.10  augustss 		wsmuxdevs[n] = sc;
    157  1.10  augustss 	}
    158  1.10  augustss 	return (sc);
    159   1.1  augustss }
    160   1.1  augustss 
    161   1.1  augustss /* From mouse or keyboard. */
    162   1.1  augustss void
    163  1.11  augustss wsmux_attach(int n, int type, struct device *dsc, struct wseventvar *ev,
    164  1.11  augustss 	struct wsmux_softc **psp, struct wsmuxops *ops)
    165   1.1  augustss {
    166   1.1  augustss 	struct wsmux_softc *sc;
    167   1.1  augustss 	int error;
    168   1.1  augustss 
    169   1.2  augustss 	DPRINTF(("wsmux_attach: n=%d\n", n));
    170  1.10  augustss 	sc = wsmux_getmux(n);
    171   1.1  augustss 	error = wsmux_attach_sc(sc, type, dsc, ev, psp, ops);
    172   1.1  augustss 	if (error)
    173   1.1  augustss 		printf("wsmux_attach: error=%d\n", error);
    174   1.1  augustss }
    175   1.1  augustss 
    176   1.2  augustss /* From mouse or keyboard. */
    177   1.2  augustss void
    178  1.11  augustss wsmux_detach(int n, struct device *dsc)
    179   1.2  augustss {
    180   1.2  augustss #ifdef DIAGNOSTIC
    181   1.2  augustss 	int error;
    182   1.2  augustss 
    183   1.2  augustss 	if (n >= nwsmux || n < 0) {
    184   1.2  augustss 		printf("wsmux_detach: detach is out of range\n");
    185   1.2  augustss 		return;
    186   1.2  augustss 	}
    187   1.2  augustss 	if ((error = wsmux_detach_sc(wsmuxdevs[n], dsc)))
    188   1.2  augustss 		printf("wsmux_detach: error=%d\n", error);
    189   1.2  augustss #else
    190   1.2  augustss 	(void)wsmux_detach_sc(wsmuxdevs[n], dsc);
    191   1.2  augustss #endif
    192   1.2  augustss }
    193   1.2  augustss 
    194   1.2  augustss int
    195  1.11  augustss wsmuxopen(dev_t dev, int flags, int mode, struct proc *p)
    196   1.2  augustss {
    197   1.2  augustss 	struct wsmux_softc *sc;
    198   1.2  augustss 	struct wsplink *m;
    199  1.12  augustss 	int munit, unit, error, nopen, lasterror;
    200   1.2  augustss 
    201  1.12  augustss 	munit = minor(dev);
    202  1.12  augustss 	unit = WSMUXDEV(munit);
    203  1.12  augustss 	sc = wsmux_getmux(unit);
    204  1.12  augustss 	if (sc == NULL)
    205   1.2  augustss 		return (ENXIO);
    206   1.2  augustss 
    207   1.2  augustss 	DPRINTF(("wsmuxopen: %s: sc=%p\n", sc->sc_dv.dv_xname, sc));
    208  1.12  augustss 	if (WSMUXCTL(munit)) {
    209  1.12  augustss 		/* This is the control device which does not allow reads. */
    210  1.12  augustss 		if (flags & FREAD)
    211  1.12  augustss 			return (EINVAL);
    212   1.2  augustss 		return (0);
    213   1.2  augustss 	}
    214   1.2  augustss 
    215  1.12  augustss 	if (sc->sc_mux) {
    216  1.12  augustss 		/* Grab the mux out of the greedy hands of the parent mux. */
    217  1.12  augustss 		int error = wsmux_rem_mux(unit, sc->sc_mux);
    218  1.12  augustss 		if (error)
    219  1.12  augustss 			return (error);
    220  1.12  augustss 	}
    221  1.12  augustss 
    222   1.2  augustss 	if (sc->sc_events.io)
    223   1.2  augustss 		return (EBUSY);
    224   1.2  augustss 
    225   1.2  augustss 	sc->sc_events.io = p;
    226   1.2  augustss 	sc->sc_flags = flags;
    227   1.2  augustss 	sc->sc_mode = mode;
    228   1.2  augustss 	sc->sc_p = p;
    229   1.2  augustss 	wsevent_init(&sc->sc_events);		/* may cause sleep */
    230   1.2  augustss 
    231   1.2  augustss 	nopen = 0;
    232   1.2  augustss 	lasterror = 0;
    233   1.2  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    234   1.2  augustss 		if (!m->sc_mevents->io && !*m->sc_muxp) {
    235   1.2  augustss 			DPRINTF(("wsmuxopen: %s: m=%p dev=%s\n",
    236   1.2  augustss 				 sc->sc_dv.dv_xname, m, m->sc->dv_xname));
    237   1.2  augustss 			error = m->sc_ops->dopen(makedev(0, m->sc->dv_unit),
    238   1.2  augustss 						 flags, mode, p);
    239   1.2  augustss 			if (error) {
    240   1.2  augustss 				/* Ignore opens that fail */
    241   1.2  augustss 				lasterror = error;
    242   1.2  augustss 				DPRINTF(("wsmuxopen: open failed %d\n",
    243   1.2  augustss 					 error));
    244   1.2  augustss 			} else {
    245   1.2  augustss 				nopen++;
    246   1.2  augustss 				*m->sc_muxp = sc;
    247   1.2  augustss 			}
    248   1.2  augustss 		}
    249   1.2  augustss 	}
    250   1.2  augustss 
    251   1.2  augustss 	if (nopen == 0 && lasterror != 0) {
    252   1.2  augustss 		wsevent_fini(&sc->sc_events);
    253   1.2  augustss 		sc->sc_events.io = NULL;
    254   1.2  augustss 		return (lasterror);
    255   1.2  augustss 	}
    256   1.2  augustss 
    257   1.2  augustss 	return (0);
    258   1.2  augustss }
    259   1.2  augustss 
    260   1.2  augustss int
    261  1.11  augustss wsmuxclose(dev_t dev, int flags, int mode, struct proc *p)
    262   1.2  augustss {
    263  1.12  augustss 	int munit = minor(dev);
    264  1.12  augustss 
    265  1.12  augustss 	if (WSMUXCTL(munit)) {
    266  1.12  augustss 		/* control device */
    267  1.12  augustss 		return (0);
    268  1.12  augustss 	}
    269  1.12  augustss 	return wsmuxdoclose(&wsmuxdevs[WSMUXDEV(munit)]->sc_dv, flags, mode, p);
    270   1.2  augustss }
    271   1.2  augustss 
    272   1.2  augustss int
    273  1.11  augustss wsmuxread(dev_t dev, struct uio *uio, int flags)
    274   1.2  augustss {
    275  1.12  augustss 	int munit = minor(dev);
    276  1.12  augustss 	struct wsmux_softc *sc = wsmuxdevs[WSMUXDEV(munit)];
    277  1.12  augustss 
    278  1.12  augustss 	if (WSMUXCTL(munit)) {
    279  1.12  augustss 		/* control device */
    280  1.12  augustss 		return (EINVAL);
    281  1.12  augustss 	}
    282   1.2  augustss 
    283   1.2  augustss 	if (!sc->sc_events.io)
    284   1.2  augustss 		return (EACCES);
    285   1.2  augustss 
    286   1.2  augustss 	return (wsevent_read(&sc->sc_events, uio, flags));
    287   1.2  augustss }
    288   1.2  augustss 
    289   1.2  augustss int
    290  1.11  augustss wsmuxioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
    291   1.2  augustss {
    292  1.12  augustss 	int unit = WSMUXDEV(minor(dev));
    293  1.12  augustss 
    294  1.12  augustss 	return wsmuxdoioctl(&wsmuxdevs[unit]->sc_dv, cmd, data, flag, p);
    295   1.2  augustss }
    296   1.2  augustss 
    297   1.2  augustss int
    298  1.11  augustss wsmuxpoll(dev_t dev, int events, struct proc *p)
    299   1.2  augustss {
    300  1.12  augustss 	int munit = minor(dev);
    301  1.12  augustss 	struct wsmux_softc *sc = wsmuxdevs[WSMUXDEV(munit)];
    302  1.12  augustss 
    303  1.12  augustss 	if (WSMUXCTL(munit)) {
    304  1.12  augustss 		/* control device */
    305  1.12  augustss 		return (EINVAL);
    306  1.12  augustss 	}
    307   1.2  augustss 
    308   1.2  augustss 	if (!sc->sc_events.io)
    309   1.2  augustss 		return (EACCES);
    310   1.2  augustss 
    311   1.2  augustss 	return (wsevent_poll(&sc->sc_events, events, p));
    312   1.2  augustss }
    313   1.2  augustss 
    314   1.2  augustss int
    315  1.11  augustss wsmux_add_mux(int unit, struct wsmux_softc *muxsc)
    316   1.2  augustss {
    317   1.2  augustss 	struct wsmux_softc *sc, *m;
    318   1.2  augustss 
    319  1.12  augustss 	sc = wsmux_getmux(unit);
    320  1.12  augustss 	if (sc == NULL)
    321   1.2  augustss 		return (ENXIO);
    322   1.2  augustss 
    323  1.10  augustss 	DPRINTF(("wsmux_add_mux: %s(%p) to %s(%p)\n", sc->sc_dv.dv_xname, sc,
    324  1.10  augustss 		 muxsc->sc_dv.dv_xname, muxsc));
    325   1.2  augustss 
    326   1.2  augustss 	if (sc->sc_mux || sc->sc_events.io)
    327   1.2  augustss 		return (EBUSY);
    328   1.2  augustss 
    329  1.10  augustss 	/* The mux we are adding must not be an ancestor of itself. */
    330  1.10  augustss 	for (m = muxsc; m; m = m->sc_mux)
    331   1.2  augustss 		if (m == sc)
    332   1.2  augustss 			return (EINVAL);
    333   1.2  augustss 
    334   1.2  augustss 	return (wsmux_attach_sc(muxsc, WSMUX_MUX, &sc->sc_dv, &sc->sc_events,
    335   1.2  augustss 				&sc->sc_mux, &wsmux_muxops));
    336   1.2  augustss }
    337   1.2  augustss 
    338   1.2  augustss int
    339  1.11  augustss wsmux_rem_mux(int unit, struct wsmux_softc *muxsc)
    340   1.2  augustss {
    341   1.2  augustss 	struct wsmux_softc *sc;
    342   1.2  augustss 
    343   1.2  augustss 	if (unit < 0 || unit >= nwsmux || (sc = wsmuxdevs[unit]) == NULL)
    344   1.2  augustss 		return (ENXIO);
    345   1.2  augustss 
    346   1.2  augustss 	DPRINTF(("wsmux_rem_mux: %s from %s\n", sc->sc_dv.dv_xname,
    347   1.2  augustss 		 muxsc->sc_dv.dv_xname));
    348   1.2  augustss 
    349   1.2  augustss 	return (wsmux_detach_sc(muxsc, &sc->sc_dv));
    350   1.2  augustss }
    351   1.2  augustss 
    352   1.2  augustss #endif /* NWSMUX > 0 */
    353   1.2  augustss 
    354   1.2  augustss struct wsmux_softc *
    355  1.11  augustss wsmux_create(const char *name, int unit)
    356   1.2  augustss {
    357   1.2  augustss 	struct wsmux_softc *sc;
    358   1.2  augustss 
    359   1.2  augustss 	DPRINTF(("wsmux_create: allocating\n"));
    360   1.2  augustss 	sc = malloc(sizeof *sc, M_DEVBUF, M_NOWAIT);
    361  1.10  augustss 	if (sc == NULL)
    362  1.10  augustss 		return (NULL);
    363   1.2  augustss 	memset(sc, 0, sizeof *sc);
    364   1.2  augustss 	LIST_INIT(&sc->sc_reals);
    365   1.2  augustss 	snprintf(sc->sc_dv.dv_xname, sizeof sc->sc_dv.dv_xname,
    366   1.2  augustss 		 "%s%d", name, unit);
    367   1.2  augustss 	sc->sc_dv.dv_unit = unit;
    368   1.2  augustss 	return (sc);
    369   1.2  augustss }
    370   1.2  augustss 
    371   1.1  augustss int
    372  1.11  augustss wsmux_attach_sc(struct wsmux_softc *sc, int type, struct device *dsc,
    373  1.11  augustss 	struct wseventvar *ev, struct wsmux_softc **psp, struct wsmuxops *ops)
    374   1.1  augustss {
    375   1.1  augustss 	struct wsplink *m;
    376   1.1  augustss 	int error;
    377   1.1  augustss 
    378   1.1  augustss 	DPRINTF(("wsmux_attach_sc: %s: type=%d dsc=%p, *psp=%p\n",
    379   1.1  augustss 		 sc->sc_dv.dv_xname, type, dsc, *psp));
    380   1.1  augustss 	m = malloc(sizeof *m, M_DEVBUF, M_NOWAIT);
    381  1.10  augustss 	if (m == NULL)
    382   1.1  augustss 		return (ENOMEM);
    383   1.1  augustss 	m->type = type;
    384   1.1  augustss 	m->mux = sc;
    385   1.1  augustss 	m->sc = dsc;
    386   1.1  augustss 	m->sc_mevents = ev;
    387   1.1  augustss 	m->sc_muxp = psp;
    388   1.1  augustss 	m->sc_ops = ops;
    389   1.1  augustss 	LIST_INSERT_HEAD(&sc->sc_reals, m, next);
    390   1.1  augustss 
    391   1.1  augustss 	if (sc->sc_displaydv) {
    392   1.1  augustss 		/* This is a display mux, so attach the new device to it. */
    393   1.1  augustss 		DPRINTF(("wsmux_attach_sc: %s: set display %p\n",
    394   1.1  augustss 			 sc->sc_dv.dv_xname, sc->sc_displaydv));
    395   1.1  augustss 		error = 0;
    396   1.1  augustss 		if (m->sc_ops->dsetdisplay) {
    397   1.1  augustss 			error = m->sc_ops->dsetdisplay(m->sc, sc);
    398   1.1  augustss 			/* Ignore that the console already has a display. */
    399   1.1  augustss 			if (error == EBUSY)
    400   1.1  augustss 				error = 0;
    401   1.1  augustss 			if (!error) {
    402   1.1  augustss 				*m->sc_muxp = sc;
    403   1.1  augustss #ifdef WSDISPLAY_COMPAT_RAWKBD
    404   1.1  augustss 				DPRINTF(("wsmux_attach_sc: on %s set rawkbd=%d\n",
    405   1.1  augustss 					 m->sc->dv_xname, sc->sc_rawkbd));
    406   1.1  augustss 				(void)m->sc_ops->dioctl(m->sc,
    407   1.1  augustss 					     WSKBDIO_SETMODE,
    408   1.1  augustss 					     (caddr_t)&sc->sc_rawkbd,
    409   1.1  augustss 					     0, 0);
    410   1.1  augustss #endif
    411   1.1  augustss 			}
    412   1.1  augustss 		}
    413   1.1  augustss 	} else if (sc->sc_events.io) {
    414   1.1  augustss 		/* Mux is open, so open the new subdevice */
    415   1.1  augustss 		DPRINTF(("wsmux_attach_sc: %s: calling open of %s\n",
    416   1.1  augustss 			 sc->sc_dv.dv_xname, m->sc->dv_xname));
    417   1.1  augustss 		/* mux already open, join in */
    418   1.1  augustss 		error = m->sc_ops->dopen(makedev(0, m->sc->dv_unit),
    419   1.1  augustss 					 sc->sc_flags, sc->sc_mode, sc->sc_p);
    420   1.1  augustss 		if (!error)
    421   1.1  augustss 			*m->sc_muxp = sc;
    422   1.1  augustss 	} else {
    423   1.1  augustss 		DPRINTF(("wsmux_attach_sc: %s not open\n",
    424   1.1  augustss 			 sc->sc_dv.dv_xname));
    425   1.1  augustss 		error = 0;
    426   1.1  augustss 	}
    427   1.1  augustss 	DPRINTF(("wsmux_attach_sc: done sc=%p psp=%p *psp=%p\n",
    428   1.1  augustss 		 sc, psp, *psp));
    429   1.1  augustss 
    430   1.1  augustss 	return (error);
    431   1.1  augustss }
    432   1.1  augustss 
    433   1.1  augustss int
    434  1.11  augustss wsmux_detach_sc(struct wsmux_softc *sc, struct device *dsc)
    435   1.1  augustss {
    436   1.1  augustss 	struct wsplink *m;
    437   1.4    simonb 	int error = 0;
    438   1.1  augustss 
    439   1.1  augustss 	DPRINTF(("wsmux_detach_sc: %s: dsc=%p\n", sc->sc_dv.dv_xname, dsc));
    440   1.1  augustss #ifdef DIAGNOSTIC
    441   1.1  augustss 	if (sc == 0) {
    442   1.1  augustss 		printf("wsmux_detach_sc: not allocated\n");
    443   1.1  augustss 		return (ENXIO);
    444   1.1  augustss 	}
    445   1.1  augustss #endif
    446   1.1  augustss 
    447   1.1  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    448   1.1  augustss 		if (m->sc == dsc)
    449   1.1  augustss 			break;
    450   1.1  augustss 	}
    451   1.1  augustss #ifdef DIAGNOSTIC
    452   1.1  augustss 	if (!m) {
    453   1.1  augustss 		printf("wsmux_detach_sc: not found\n");
    454   1.1  augustss 		return (ENXIO);
    455   1.1  augustss 	}
    456   1.1  augustss #endif
    457   1.1  augustss 	if (sc->sc_displaydv) {
    458   1.1  augustss 		if (m->sc_ops->dsetdisplay)
    459   1.1  augustss 			error = m->sc_ops->dsetdisplay(m->sc, 0);
    460   1.1  augustss 		if (error)
    461   1.1  augustss 			return (error);
    462   1.1  augustss 		*m->sc_muxp = 0;
    463   1.1  augustss 	} else if (*m->sc_muxp) {
    464   1.1  augustss 		DPRINTF(("wsmux_detach_sc: close\n"));
    465   1.1  augustss 		/* mux device is open, so close multiplexee */
    466   1.1  augustss 		m->sc_ops->dclose(m->sc, FREAD, 0, 0);
    467   1.1  augustss 		*m->sc_muxp = 0;
    468   1.1  augustss 	}
    469   1.1  augustss 
    470   1.1  augustss 	LIST_REMOVE(m, next);
    471   1.1  augustss 
    472   1.1  augustss 	free(m, M_DEVBUF);
    473   1.1  augustss 	DPRINTF(("wsmux_detach_sc: done sc=%p\n", sc));
    474   1.1  augustss 	return (0);
    475   1.1  augustss }
    476   1.1  augustss 
    477  1.10  augustss int
    478  1.11  augustss wsmuxdoclose(struct device *dv, int flags, int mode, struct proc *p)
    479   1.1  augustss {
    480   1.1  augustss 	struct wsmux_softc *sc = (struct wsmux_softc *)dv;
    481   1.1  augustss 	struct wsplink *m;
    482   1.1  augustss 
    483   1.1  augustss 	DPRINTF(("wsmuxclose: %s: sc=%p\n", sc->sc_dv.dv_xname, sc));
    484   1.1  augustss 
    485   1.1  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    486   1.1  augustss 		if (*m->sc_muxp == sc) {
    487   1.1  augustss 			DPRINTF(("wsmuxclose %s: m=%p dev=%s\n",
    488   1.1  augustss 				 sc->sc_dv.dv_xname, m, m->sc->dv_xname));
    489   1.1  augustss 			m->sc_ops->dclose(m->sc, flags, mode, p);
    490   1.1  augustss 			*m->sc_muxp = 0;
    491   1.1  augustss 		}
    492   1.1  augustss 	}
    493   1.1  augustss 
    494   1.1  augustss 	wsevent_fini(&sc->sc_events);
    495   1.1  augustss 	sc->sc_events.io = NULL;
    496   1.1  augustss 
    497   1.1  augustss 	return (0);
    498   1.1  augustss }
    499   1.1  augustss 
    500   1.1  augustss int
    501  1.11  augustss wsmuxdoioctl(struct device *dv, u_long cmd, caddr_t data, int flag,
    502  1.11  augustss 	     struct proc *p)
    503   1.1  augustss {
    504   1.1  augustss 	struct wsmux_softc *sc = (struct wsmux_softc *)dv;
    505   1.1  augustss 	struct wsplink *m;
    506   1.1  augustss 	int error, ok;
    507   1.1  augustss 	int s, put, get, n;
    508   1.1  augustss 	struct wseventvar *evar;
    509   1.1  augustss 	struct wscons_event *ev;
    510   1.1  augustss 	struct timeval xxxtime;
    511   1.1  augustss 	struct wsmux_device_list *l;
    512   1.1  augustss 
    513   1.1  augustss 	DPRINTF(("wsmuxdoioctl: %s: sc=%p, cmd=%08lx\n",
    514   1.1  augustss 		 sc->sc_dv.dv_xname, sc, cmd));
    515   1.1  augustss 
    516   1.1  augustss 	switch (cmd) {
    517   1.1  augustss 	case WSMUX_INJECTEVENT:
    518   1.1  augustss 		/* Inject an event, e.g., from moused. */
    519   1.1  augustss 		if (!sc->sc_events.io)
    520   1.1  augustss 			return (EACCES);
    521   1.1  augustss 
    522   1.1  augustss 		evar = &sc->sc_events;
    523   1.1  augustss 		s = spltty();
    524   1.1  augustss 		get = evar->get;
    525   1.1  augustss 		put = evar->put;
    526   1.1  augustss 		if (++put % WSEVENT_QSIZE == get) {
    527   1.1  augustss 			put--;
    528   1.1  augustss 			splx(s);
    529   1.1  augustss 			return (ENOSPC);
    530   1.1  augustss 		}
    531   1.1  augustss 		if (put >= WSEVENT_QSIZE)
    532   1.1  augustss 			put = 0;
    533   1.1  augustss 		ev = &evar->q[put];
    534   1.1  augustss 		*ev = *(struct wscons_event *)data;
    535   1.1  augustss 		microtime(&xxxtime);
    536   1.1  augustss 		TIMEVAL_TO_TIMESPEC(&xxxtime, &ev->time);
    537   1.1  augustss 		evar->put = put;
    538   1.1  augustss 		WSEVENT_WAKEUP(evar);
    539   1.1  augustss 		splx(s);
    540   1.1  augustss 		return (0);
    541   1.1  augustss 	case WSMUX_ADD_DEVICE:
    542   1.1  augustss #define d ((struct wsmux_device *)data)
    543   1.1  augustss 		switch (d->type) {
    544  1.13       jmc #if NWSMUX > 0
    545   1.1  augustss #if NWSMOUSE > 0
    546   1.1  augustss 		case WSMUX_MOUSE:
    547   1.1  augustss 			return (wsmouse_add_mux(d->idx, sc));
    548   1.1  augustss #endif
    549   1.1  augustss #if NWSKBD > 0
    550   1.1  augustss 		case WSMUX_KBD:
    551   1.1  augustss 			return (wskbd_add_mux(d->idx, sc));
    552   1.1  augustss #endif
    553   1.1  augustss 		case WSMUX_MUX:
    554   1.1  augustss 			return (wsmux_add_mux(d->idx, sc));
    555   1.2  augustss #endif
    556   1.1  augustss 		default:
    557   1.1  augustss 			return (EINVAL);
    558   1.1  augustss 		}
    559   1.1  augustss 	case WSMUX_REMOVE_DEVICE:
    560   1.1  augustss 		switch (d->type) {
    561  1.13       jmc #if NWSMUX > 0
    562   1.1  augustss #if NWSMOUSE > 0
    563   1.1  augustss 		case WSMUX_MOUSE:
    564   1.1  augustss 			return (wsmouse_rem_mux(d->idx, sc));
    565   1.1  augustss #endif
    566   1.1  augustss #if NWSKBD > 0
    567   1.1  augustss 		case WSMUX_KBD:
    568   1.1  augustss 			return (wskbd_rem_mux(d->idx, sc));
    569   1.1  augustss #endif
    570   1.1  augustss 		case WSMUX_MUX:
    571   1.1  augustss 			return (wsmux_rem_mux(d->idx, sc));
    572   1.2  augustss #endif
    573   1.1  augustss 		default:
    574   1.1  augustss 			return (EINVAL);
    575   1.1  augustss 		}
    576   1.1  augustss #undef d
    577   1.1  augustss 	case WSMUX_LIST_DEVICES:
    578   1.1  augustss 		l = (struct wsmux_device_list *)data;
    579   1.1  augustss 		for (n = 0, m = LIST_FIRST(&sc->sc_reals);
    580   1.1  augustss 		     n < WSMUX_MAXDEV && m != NULL;
    581   1.1  augustss 		     m = LIST_NEXT(m, next)) {
    582   1.1  augustss 			l->devices[n].type = m->type;
    583   1.1  augustss 			l->devices[n].idx = m->sc->dv_unit;
    584   1.1  augustss 			n++;
    585   1.1  augustss 		}
    586   1.1  augustss 		l->ndevices = n;
    587   1.1  augustss 		return (0);
    588   1.1  augustss #ifdef WSDISPLAY_COMPAT_RAWKBD
    589   1.1  augustss 	case WSKBDIO_SETMODE:
    590   1.1  augustss 		sc->sc_rawkbd = *(int *)data;
    591   1.1  augustss 		DPRINTF(("wsmuxdoioctl: save rawkbd = %d\n", sc->sc_rawkbd));
    592   1.1  augustss 		break;
    593   1.1  augustss #endif
    594   1.9  takemura 	case FIOASYNC:
    595   1.9  takemura 		sc->sc_events.async = *(int *)data != 0;
    596   1.9  takemura 		return (0);
    597   1.9  takemura 	case TIOCSPGRP:
    598   1.9  takemura 		if (*(int *)data != sc->sc_events.io->p_pgid)
    599   1.9  takemura 			return (EPERM);
    600   1.9  takemura 		return (0);
    601   1.1  augustss 	default:
    602   1.1  augustss 		break;
    603   1.1  augustss 	}
    604   1.1  augustss 
    605   1.1  augustss 	if (sc->sc_events.io == NULL && sc->sc_displaydv == NULL)
    606   1.1  augustss 		return (EACCES);
    607   1.1  augustss 
    608   1.1  augustss 	/* Return 0 if any of the ioctl() succeeds, otherwise the last error */
    609   1.7  augustss 	error = 0;
    610   1.1  augustss 	ok = 0;
    611   1.1  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    612   1.1  augustss 		DPRINTF(("wsmuxdoioctl: m=%p *m->sc_muxp=%p sc=%p\n",
    613   1.1  augustss 			 m, *m->sc_muxp, sc));
    614   1.1  augustss 		if (*m->sc_muxp == sc) {
    615   1.1  augustss 			DPRINTF(("wsmuxdoioctl: %s: m=%p dev=%s\n",
    616   1.1  augustss 				 sc->sc_dv.dv_xname, m, m->sc->dv_xname));
    617   1.1  augustss 			error = m->sc_ops->dioctl(m->sc, cmd, data, flag, p);
    618   1.1  augustss 			if (!error)
    619   1.1  augustss 				ok = 1;
    620   1.1  augustss 		}
    621   1.1  augustss 	}
    622   1.1  augustss 	if (ok)
    623   1.1  augustss 		error = 0;
    624   1.1  augustss 
    625   1.1  augustss 	return (error);
    626   1.1  augustss }
    627   1.1  augustss 
    628   1.1  augustss int
    629  1.11  augustss wsmux_displayioctl(struct device *dv, u_long cmd, caddr_t data, int flag,
    630  1.11  augustss 		   struct proc *p)
    631   1.1  augustss {
    632   1.1  augustss 	struct wsmux_softc *sc = (struct wsmux_softc *)dv;
    633   1.1  augustss 	struct wsplink *m;
    634   1.1  augustss 	int error, ok;
    635   1.1  augustss 
    636   1.1  augustss 	DPRINTF(("wsmux_displayioctl: %s: sc=%p, cmd=%08lx\n",
    637   1.1  augustss 		 sc->sc_dv.dv_xname, sc, cmd));
    638   1.1  augustss 
    639   1.1  augustss #ifdef WSDISPLAY_COMPAT_RAWKBD
    640   1.1  augustss 	if (cmd == WSKBDIO_SETMODE) {
    641   1.1  augustss 		sc->sc_rawkbd = *(int *)data;
    642   1.1  augustss 		DPRINTF(("wsmux_displayioctl: rawkbd = %d\n", sc->sc_rawkbd));
    643   1.1  augustss 	}
    644   1.1  augustss #endif
    645   1.1  augustss 
    646   1.8  augustss 	/*
    647   1.8  augustss 	 * Return 0 if any of the ioctl() succeeds, otherwise the last error.
    648   1.8  augustss 	 * Return -1 if no mux component accepts the ioctl.
    649   1.8  augustss 	 */
    650   1.8  augustss 	error = -1;
    651   1.1  augustss 	ok = 0;
    652   1.1  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    653   1.1  augustss 		DPRINTF(("wsmux_displayioctl: m=%p sc=%p sc_muxp=%p\n",
    654   1.1  augustss 			 m, sc, *m->sc_muxp));
    655   1.1  augustss 		if (m->sc_ops->ddispioctl && *m->sc_muxp == sc) {
    656   1.1  augustss 			error = m->sc_ops->ddispioctl(m->sc, cmd, data,
    657   1.1  augustss 						      flag, p);
    658   1.1  augustss 			DPRINTF(("wsmux_displayioctl: m=%p dev=%s ==> %d\n",
    659   1.1  augustss 				 m, m->sc->dv_xname, error));
    660   1.1  augustss 			if (!error)
    661   1.1  augustss 				ok = 1;
    662   1.1  augustss 		}
    663   1.1  augustss 	}
    664   1.1  augustss 	if (ok)
    665   1.1  augustss 		error = 0;
    666   1.1  augustss 
    667   1.1  augustss 	return (error);
    668   1.1  augustss }
    669   1.1  augustss 
    670   1.1  augustss int
    671  1.11  augustss wsmux_set_display(struct device *dv, struct wsmux_softc *muxsc)
    672   1.1  augustss {
    673   1.1  augustss 	struct wsmux_softc *sc = (struct wsmux_softc *)dv;
    674   1.1  augustss 	struct wsmux_softc *nsc = muxsc ? sc : 0;
    675   1.1  augustss 	struct device *displaydv = muxsc ? muxsc->sc_displaydv : 0;
    676   1.1  augustss 	struct device *odisplaydv;
    677   1.1  augustss 	struct wsplink *m;
    678   1.1  augustss 	int error, ok;
    679   1.1  augustss 
    680   1.1  augustss 	DPRINTF(("wsmux_set_display: %s: displaydv=%p\n",
    681   1.1  augustss 		 sc->sc_dv.dv_xname, displaydv));
    682   1.1  augustss 
    683   1.1  augustss 	if (displaydv) {
    684   1.1  augustss 		if (sc->sc_displaydv)
    685   1.1  augustss 			return (EBUSY);
    686   1.1  augustss 	} else {
    687   1.1  augustss 		if (sc->sc_displaydv == NULL)
    688   1.1  augustss 			return (ENXIO);
    689   1.1  augustss 	}
    690   1.1  augustss 
    691   1.1  augustss 	odisplaydv = sc->sc_displaydv;
    692   1.1  augustss 	sc->sc_displaydv = displaydv;
    693   1.1  augustss 
    694   1.1  augustss 	if (displaydv)
    695   1.1  augustss 		printf("%s: connecting to %s\n",
    696   1.1  augustss 		       sc->sc_dv.dv_xname, displaydv->dv_xname);
    697   1.1  augustss 	ok = 0;
    698   1.1  augustss 	error = 0;
    699   1.1  augustss 	for (m = LIST_FIRST(&sc->sc_reals); m; m = LIST_NEXT(m, next)) {
    700   1.1  augustss 		if (m->sc_ops->dsetdisplay &&
    701   1.1  augustss 		    (nsc ? m->sc_mevents->io == 0 && *m->sc_muxp == 0 :
    702   1.1  augustss 		           *m->sc_muxp == sc)) {
    703   1.1  augustss 			error = m->sc_ops->dsetdisplay(m->sc, nsc);
    704   1.1  augustss 			DPRINTF(("wsmux_set_display: m=%p dev=%s error=%d\n",
    705   1.1  augustss 				 m, m->sc->dv_xname, error));
    706   1.1  augustss 			if (!error) {
    707   1.1  augustss 				ok = 1;
    708   1.1  augustss 				*m->sc_muxp = nsc;
    709   1.1  augustss #ifdef WSDISPLAY_COMPAT_RAWKBD
    710   1.1  augustss 				DPRINTF(("wsmux_set_display: on %s set rawkbd=%d\n",
    711   1.1  augustss 					 m->sc->dv_xname, sc->sc_rawkbd));
    712   1.1  augustss 				(void)m->sc_ops->dioctl(m->sc,
    713   1.1  augustss 					     WSKBDIO_SETMODE,
    714   1.1  augustss 					     (caddr_t)&sc->sc_rawkbd,
    715   1.1  augustss 					     0, 0);
    716   1.1  augustss #endif
    717   1.1  augustss 			}
    718   1.1  augustss 		}
    719   1.1  augustss 	}
    720   1.1  augustss 	if (ok)
    721   1.1  augustss 		error = 0;
    722   1.1  augustss 
    723   1.1  augustss 	if (displaydv == NULL)
    724   1.1  augustss 		printf("%s: disconnecting from %s\n",
    725   1.1  augustss 		       sc->sc_dv.dv_xname, odisplaydv->dv_xname);
    726   1.1  augustss 
    727   1.1  augustss 	return (error);
    728   1.1  augustss }
    729   1.1  augustss 
    730   1.1  augustss #endif /* NWSMUX > 0 || (NWSDISPLAY > 0 && NWSKBD > 0) */
    731