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