Home | History | Annotate | Line # | Download | only in net
if_tap.c revision 1.18
      1  1.18    kardel /*	$NetBSD: if_tap.c,v 1.18 2006/06/07 22:33:43 kardel Exp $	*/
      2   1.1      cube 
      3   1.1      cube /*
      4   1.1      cube  *  Copyright (c) 2003, 2004 The NetBSD Foundation.
      5   1.1      cube  *  All rights reserved.
      6   1.1      cube  *
      7   1.1      cube  *  This code is derived from software contributed to the NetBSD Foundation
      8   1.1      cube  *   by Quentin Garnier.
      9   1.6     perry  *
     10   1.1      cube  *  Redistribution and use in source and binary forms, with or without
     11   1.1      cube  *  modification, are permitted provided that the following conditions
     12   1.1      cube  *  are met:
     13   1.1      cube  *  1. Redistributions of source code must retain the above copyright
     14   1.1      cube  *     notice, this list of conditions and the following disclaimer.
     15   1.1      cube  *  2. Redistributions in binary form must reproduce the above copyright
     16   1.1      cube  *     notice, this list of conditions and the following disclaimer in the
     17   1.1      cube  *     documentation and/or other materials provided with the distribution.
     18   1.1      cube  *  3. All advertising materials mentioning features or use of this software
     19   1.1      cube  *     must display the following acknowledgement:
     20   1.1      cube  *         This product includes software developed by the NetBSD
     21   1.1      cube  *         Foundation, Inc. and its contributors.
     22   1.1      cube  *  4. Neither the name of The NetBSD Foundation nor the names of its
     23   1.1      cube  *     contributors may be used to endorse or promote products derived
     24   1.1      cube  *     from this software without specific prior written permission.
     25   1.6     perry  *
     26   1.1      cube  *  THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27   1.1      cube  *  ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28   1.1      cube  *  TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29   1.1      cube  *  PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30   1.1      cube  *  BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31   1.1      cube  *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32   1.1      cube  *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33   1.1      cube  *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34   1.1      cube  *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35   1.1      cube  *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36   1.1      cube  *  POSSIBILITY OF SUCH DAMAGE.
     37   1.1      cube  */
     38   1.1      cube 
     39   1.1      cube /*
     40   1.1      cube  * tap(4) is a virtual Ethernet interface.  It appears as a real Ethernet
     41   1.1      cube  * device to the system, but can also be accessed by userland through a
     42   1.1      cube  * character device interface, which allows reading and injecting frames.
     43   1.1      cube  */
     44   1.1      cube 
     45   1.1      cube #include <sys/cdefs.h>
     46  1.18    kardel __KERNEL_RCSID(0, "$NetBSD: if_tap.c,v 1.18 2006/06/07 22:33:43 kardel Exp $");
     47   1.1      cube 
     48   1.2      cube #if defined(_KERNEL_OPT)
     49   1.1      cube #include "bpfilter.h"
     50   1.2      cube #endif
     51   1.1      cube 
     52   1.1      cube #include <sys/param.h>
     53   1.1      cube #include <sys/systm.h>
     54   1.1      cube #include <sys/kernel.h>
     55   1.1      cube #include <sys/malloc.h>
     56   1.1      cube #include <sys/conf.h>
     57   1.1      cube #include <sys/device.h>
     58   1.1      cube #include <sys/file.h>
     59   1.1      cube #include <sys/filedesc.h>
     60   1.1      cube #include <sys/ksyms.h>
     61   1.1      cube #include <sys/poll.h>
     62   1.1      cube #include <sys/select.h>
     63   1.1      cube #include <sys/sockio.h>
     64   1.1      cube #include <sys/sysctl.h>
     65  1.17      elad #include <sys/kauth.h>
     66   1.1      cube 
     67   1.1      cube #include <net/if.h>
     68   1.1      cube #include <net/if_dl.h>
     69   1.1      cube #include <net/if_ether.h>
     70   1.1      cube #include <net/if_media.h>
     71   1.1      cube #include <net/if_tap.h>
     72   1.1      cube #if NBPFILTER > 0
     73   1.1      cube #include <net/bpf.h>
     74   1.1      cube #endif
     75   1.1      cube 
     76   1.1      cube /*
     77   1.1      cube  * sysctl node management
     78   1.1      cube  *
     79   1.1      cube  * It's not really possible to use a SYSCTL_SETUP block with
     80   1.1      cube  * current LKM implementation, so it is easier to just define
     81   1.1      cube  * our own function.
     82   1.1      cube  *
     83   1.1      cube  * The handler function is a "helper" in Andrew Brown's sysctl
     84   1.1      cube  * framework terminology.  It is used as a gateway for sysctl
     85   1.1      cube  * requests over the nodes.
     86   1.1      cube  *
     87   1.1      cube  * tap_log allows the module to log creations of nodes and
     88   1.1      cube  * destroy them all at once using sysctl_teardown.
     89   1.1      cube  */
     90   1.1      cube static int tap_node;
     91   1.1      cube static int	tap_sysctl_handler(SYSCTLFN_PROTO);
     92   1.2      cube SYSCTL_SETUP_PROTO(sysctl_tap_setup);
     93   1.1      cube 
     94   1.1      cube /*
     95   1.1      cube  * Since we're an Ethernet device, we need the 3 following
     96   1.1      cube  * components: a leading struct device, a struct ethercom,
     97   1.1      cube  * and also a struct ifmedia since we don't attach a PHY to
     98   1.1      cube  * ourselves. We could emulate one, but there's no real
     99   1.1      cube  * point.
    100   1.1      cube  */
    101   1.1      cube 
    102   1.1      cube struct tap_softc {
    103   1.1      cube 	struct device	sc_dev;
    104   1.1      cube 	struct ifmedia	sc_im;
    105   1.1      cube 	struct ethercom	sc_ec;
    106   1.1      cube 	int		sc_flags;
    107   1.1      cube #define	TAP_INUSE	0x00000001	/* tap device can only be opened once */
    108   1.1      cube #define TAP_ASYNCIO	0x00000002	/* user is using async I/O (SIGIO) on the device */
    109   1.1      cube #define TAP_NBIO	0x00000004	/* user wants calls to avoid blocking */
    110   1.1      cube #define TAP_GOING	0x00000008	/* interface is being destroyed */
    111   1.1      cube 	struct selinfo	sc_rsel;
    112   1.1      cube 	pid_t		sc_pgid; /* For async. IO */
    113   1.1      cube 	struct lock	sc_rdlock;
    114   1.1      cube 	struct simplelock	sc_kqlock;
    115   1.1      cube };
    116   1.1      cube 
    117   1.1      cube /* autoconf(9) glue */
    118   1.1      cube 
    119   1.1      cube void	tapattach(int);
    120   1.1      cube 
    121   1.1      cube static int	tap_match(struct device *, struct cfdata *, void *);
    122   1.1      cube static void	tap_attach(struct device *, struct device *, void *);
    123   1.1      cube static int	tap_detach(struct device*, int);
    124   1.1      cube 
    125   1.1      cube /* Ethernet address helper functions */
    126   1.1      cube 
    127   1.1      cube static int	tap_ether_aton(u_char *, char *);
    128   1.1      cube 
    129   1.1      cube CFATTACH_DECL(tap, sizeof(struct tap_softc),
    130   1.1      cube     tap_match, tap_attach, tap_detach, NULL);
    131   1.1      cube extern struct cfdriver tap_cd;
    132   1.1      cube 
    133   1.1      cube /* Real device access routines */
    134   1.1      cube static int	tap_dev_close(struct tap_softc *);
    135   1.1      cube static int	tap_dev_read(int, struct uio *, int);
    136   1.1      cube static int	tap_dev_write(int, struct uio *, int);
    137  1.11  christos static int	tap_dev_ioctl(int, u_long, caddr_t, struct lwp *);
    138  1.11  christos static int	tap_dev_poll(int, int, struct lwp *);
    139   1.1      cube static int	tap_dev_kqfilter(int, struct knote *);
    140   1.1      cube 
    141   1.1      cube /* Fileops access routines */
    142  1.11  christos static int	tap_fops_close(struct file *, struct lwp *);
    143   1.1      cube static int	tap_fops_read(struct file *, off_t *, struct uio *,
    144  1.17      elad     kauth_cred_t, int);
    145   1.1      cube static int	tap_fops_write(struct file *, off_t *, struct uio *,
    146  1.17      elad     kauth_cred_t, int);
    147   1.1      cube static int	tap_fops_ioctl(struct file *, u_long, void *,
    148  1.11  christos     struct lwp *);
    149  1.11  christos static int	tap_fops_poll(struct file *, int, struct lwp *);
    150   1.1      cube static int	tap_fops_kqfilter(struct file *, struct knote *);
    151   1.1      cube 
    152   1.1      cube static const struct fileops tap_fileops = {
    153   1.1      cube 	tap_fops_read,
    154   1.1      cube 	tap_fops_write,
    155   1.1      cube 	tap_fops_ioctl,
    156   1.1      cube 	fnullop_fcntl,
    157   1.1      cube 	tap_fops_poll,
    158   1.1      cube 	fbadop_stat,
    159   1.1      cube 	tap_fops_close,
    160   1.1      cube 	tap_fops_kqfilter,
    161   1.1      cube };
    162   1.1      cube 
    163   1.1      cube /* Helper for cloning open() */
    164  1.11  christos static int	tap_dev_cloner(struct lwp *);
    165   1.1      cube 
    166   1.1      cube /* Character device routines */
    167  1.11  christos static int	tap_cdev_open(dev_t, int, int, struct lwp *);
    168  1.11  christos static int	tap_cdev_close(dev_t, int, int, struct lwp *);
    169   1.1      cube static int	tap_cdev_read(dev_t, struct uio *, int);
    170   1.1      cube static int	tap_cdev_write(dev_t, struct uio *, int);
    171  1.11  christos static int	tap_cdev_ioctl(dev_t, u_long, caddr_t, int, struct lwp *);
    172  1.11  christos static int	tap_cdev_poll(dev_t, int, struct lwp *);
    173   1.1      cube static int	tap_cdev_kqfilter(dev_t, struct knote *);
    174   1.1      cube 
    175   1.1      cube const struct cdevsw tap_cdevsw = {
    176   1.1      cube 	tap_cdev_open, tap_cdev_close,
    177   1.1      cube 	tap_cdev_read, tap_cdev_write,
    178   1.1      cube 	tap_cdev_ioctl, nostop, notty,
    179   1.1      cube 	tap_cdev_poll, nommap,
    180   1.1      cube 	tap_cdev_kqfilter,
    181   1.1      cube };
    182   1.1      cube 
    183   1.1      cube #define TAP_CLONER	0xfffff		/* Maximal minor value */
    184   1.1      cube 
    185   1.1      cube /* kqueue-related routines */
    186   1.1      cube static void	tap_kqdetach(struct knote *);
    187   1.1      cube static int	tap_kqread(struct knote *, long);
    188   1.1      cube 
    189   1.1      cube /*
    190   1.1      cube  * Those are needed by the if_media interface.
    191   1.1      cube  */
    192   1.1      cube 
    193   1.1      cube static int	tap_mediachange(struct ifnet *);
    194   1.1      cube static void	tap_mediastatus(struct ifnet *, struct ifmediareq *);
    195   1.1      cube 
    196   1.1      cube /*
    197   1.1      cube  * Those are needed by the ifnet interface, and would typically be
    198   1.1      cube  * there for any network interface driver.
    199   1.1      cube  * Some other routines are optional: watchdog and drain.
    200   1.1      cube  */
    201   1.1      cube 
    202   1.1      cube static void	tap_start(struct ifnet *);
    203   1.1      cube static void	tap_stop(struct ifnet *, int);
    204   1.1      cube static int	tap_init(struct ifnet *);
    205   1.1      cube static int	tap_ioctl(struct ifnet *, u_long, caddr_t);
    206   1.1      cube 
    207   1.1      cube /* This is an internal function to keep tap_ioctl readable */
    208   1.1      cube static int	tap_lifaddr(struct ifnet *, u_long, struct ifaliasreq *);
    209   1.1      cube 
    210   1.1      cube /*
    211   1.1      cube  * tap is a clonable interface, although it is highly unrealistic for
    212   1.1      cube  * an Ethernet device.
    213   1.1      cube  *
    214   1.1      cube  * Here are the bits needed for a clonable interface.
    215   1.1      cube  */
    216   1.1      cube static int	tap_clone_create(struct if_clone *, int);
    217   1.1      cube static int	tap_clone_destroy(struct ifnet *);
    218   1.1      cube 
    219   1.1      cube struct if_clone tap_cloners = IF_CLONE_INITIALIZER("tap",
    220   1.1      cube 					tap_clone_create,
    221   1.1      cube 					tap_clone_destroy);
    222   1.1      cube 
    223   1.1      cube /* Helper functionis shared by the two cloning code paths */
    224   1.1      cube static struct tap_softc *	tap_clone_creator(int);
    225  1.12      cube int	tap_clone_destroyer(struct device *);
    226   1.1      cube 
    227   1.1      cube void
    228   1.1      cube tapattach(int n)
    229   1.1      cube {
    230   1.1      cube 	int error;
    231   1.1      cube 
    232   1.1      cube 	error = config_cfattach_attach(tap_cd.cd_name, &tap_ca);
    233   1.1      cube 	if (error) {
    234   1.1      cube 		aprint_error("%s: unable to register cfattach\n",
    235   1.1      cube 		    tap_cd.cd_name);
    236   1.1      cube 		(void)config_cfdriver_detach(&tap_cd);
    237   1.1      cube 		return;
    238   1.1      cube 	}
    239   1.1      cube 
    240   1.1      cube 	if_clone_attach(&tap_cloners);
    241   1.1      cube }
    242   1.1      cube 
    243   1.1      cube /* Pretty much useless for a pseudo-device */
    244   1.1      cube static int
    245   1.1      cube tap_match(struct device *self, struct cfdata *cfdata, void *arg)
    246   1.1      cube {
    247   1.1      cube 	return (1);
    248   1.1      cube }
    249   1.1      cube 
    250   1.1      cube void
    251   1.1      cube tap_attach(struct device *parent, struct device *self, void *aux)
    252   1.1      cube {
    253   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)self;
    254   1.1      cube 	struct ifnet *ifp;
    255  1.18    kardel 	const struct sysctlnode *node;
    256   1.1      cube 	u_int8_t enaddr[ETHER_ADDR_LEN] =
    257   1.7      cube 	    { 0xf2, 0x0b, 0xa4, 0xff, 0xff, 0xff };
    258  1.14  christos 	char enaddrstr[3 * ETHER_ADDR_LEN];
    259  1.18    kardel 	struct timeval tv;
    260   1.1      cube 	uint32_t ui;
    261   1.1      cube 	int error;
    262   1.1      cube 
    263   1.1      cube 	aprint_normal("%s: faking Ethernet device\n",
    264   1.1      cube 	    self->dv_xname);
    265   1.1      cube 
    266   1.1      cube 	/*
    267   1.1      cube 	 * In order to obtain unique initial Ethernet address on a host,
    268  1.18    kardel 	 * do some randomisation using the current uptime.  It's not meant
    269  1.18    kardel 	 * for anything but avoiding hard-coding an address.
    270   1.1      cube 	 */
    271  1.18    kardel 	getmicrouptime(&tv);
    272  1.18    kardel 	ui = (tv.tv_sec ^ tv.tv_usec) & 0xffffff;
    273   1.1      cube 	memcpy(enaddr+3, (u_int8_t *)&ui, 3);
    274   1.1      cube 
    275   1.1      cube 	aprint_normal("%s: Ethernet address %s\n", sc->sc_dev.dv_xname,
    276  1.14  christos 	    ether_snprintf(enaddrstr, sizeof(enaddrstr), enaddr));
    277   1.1      cube 
    278   1.1      cube 	/*
    279   1.1      cube 	 * Why 1000baseT? Why not? You can add more.
    280   1.1      cube 	 *
    281   1.1      cube 	 * Note that there are 3 steps: init, one or several additions to
    282   1.1      cube 	 * list of supported media, and in the end, the selection of one
    283   1.1      cube 	 * of them.
    284   1.1      cube 	 */
    285   1.1      cube 	ifmedia_init(&sc->sc_im, 0, tap_mediachange, tap_mediastatus);
    286   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_1000_T, 0, NULL);
    287   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_1000_T|IFM_FDX, 0, NULL);
    288   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_100_TX, 0, NULL);
    289   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_100_TX|IFM_FDX, 0, NULL);
    290   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_10_T, 0, NULL);
    291   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_10_T|IFM_FDX, 0, NULL);
    292   1.1      cube 	ifmedia_add(&sc->sc_im, IFM_ETHER|IFM_AUTO, 0, NULL);
    293   1.1      cube 	ifmedia_set(&sc->sc_im, IFM_ETHER|IFM_AUTO);
    294   1.1      cube 
    295   1.1      cube 	/*
    296   1.1      cube 	 * One should note that an interface must do multicast in order
    297   1.1      cube 	 * to support IPv6.
    298   1.1      cube 	 */
    299   1.1      cube 	ifp = &sc->sc_ec.ec_if;
    300   1.1      cube 	strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
    301   1.1      cube 	ifp->if_softc	= sc;
    302   1.1      cube 	ifp->if_flags	= IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    303   1.1      cube 	ifp->if_ioctl	= tap_ioctl;
    304   1.1      cube 	ifp->if_start	= tap_start;
    305   1.1      cube 	ifp->if_stop	= tap_stop;
    306   1.1      cube 	ifp->if_init	= tap_init;
    307   1.1      cube 	IFQ_SET_READY(&ifp->if_snd);
    308   1.1      cube 
    309   1.1      cube 	sc->sc_ec.ec_capabilities = ETHERCAP_VLAN_MTU | ETHERCAP_JUMBO_MTU;
    310   1.1      cube 
    311   1.1      cube 	/* Those steps are mandatory for an Ethernet driver, the fisrt call
    312   1.1      cube 	 * being common to all network interface drivers. */
    313   1.1      cube 	if_attach(ifp);
    314   1.1      cube 	ether_ifattach(ifp, enaddr);
    315   1.1      cube 
    316   1.1      cube 	sc->sc_flags = 0;
    317   1.1      cube 
    318   1.1      cube 	/*
    319   1.1      cube 	 * Add a sysctl node for that interface.
    320   1.1      cube 	 *
    321   1.1      cube 	 * The pointer transmitted is not a string, but instead a pointer to
    322   1.1      cube 	 * the softc structure, which we can use to build the string value on
    323   1.1      cube 	 * the fly in the helper function of the node.  See the comments for
    324   1.1      cube 	 * tap_sysctl_handler for details.
    325   1.1      cube 	 */
    326   1.1      cube 	if ((error = sysctl_createv(NULL, 0, NULL,
    327   1.1      cube 	    &node, CTLFLAG_READWRITE,
    328   1.1      cube 	    CTLTYPE_STRING, sc->sc_dev.dv_xname, NULL,
    329   1.1      cube 	    tap_sysctl_handler, 0, sc, 18,
    330  1.15   thorpej 	    CTL_NET, AF_LINK, tap_node, device_unit(&sc->sc_dev),
    331  1.15   thorpej 	    CTL_EOL)) != 0)
    332   1.1      cube 		aprint_error("%s: sysctl_createv returned %d, ignoring\n",
    333   1.1      cube 		    sc->sc_dev.dv_xname, error);
    334   1.1      cube 
    335   1.1      cube 	/*
    336   1.1      cube 	 * Initialize the two locks for the device.
    337   1.1      cube 	 *
    338   1.1      cube 	 * We need a lock here because even though the tap device can be
    339   1.1      cube 	 * opened only once, the file descriptor might be passed to another
    340   1.1      cube 	 * process, say a fork(2)ed child.
    341   1.1      cube 	 *
    342   1.1      cube 	 * The Giant saves us from most of the hassle, but since the read
    343   1.1      cube 	 * operation can sleep, we don't want two processes to wake up at
    344   1.1      cube 	 * the same moment and both try and dequeue a single packet.
    345   1.1      cube 	 *
    346   1.1      cube 	 * The queue for event listeners (used by kqueue(9), see below) has
    347   1.1      cube 	 * to be protected, too, but we don't need the same level of
    348   1.1      cube 	 * complexity for that lock, so a simple spinning lock is fine.
    349   1.1      cube 	 */
    350   1.1      cube 	lockinit(&sc->sc_rdlock, PSOCK|PCATCH, "tapl", 0, LK_SLEEPFAIL);
    351   1.1      cube 	simple_lock_init(&sc->sc_kqlock);
    352   1.1      cube }
    353   1.1      cube 
    354   1.1      cube /*
    355   1.1      cube  * When detaching, we do the inverse of what is done in the attach
    356   1.1      cube  * routine, in reversed order.
    357   1.1      cube  */
    358   1.1      cube static int
    359   1.1      cube tap_detach(struct device* self, int flags)
    360   1.1      cube {
    361   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)self;
    362   1.1      cube 	struct ifnet *ifp = &sc->sc_ec.ec_if;
    363   1.1      cube 	int error, s;
    364   1.1      cube 
    365   1.1      cube 	/*
    366   1.1      cube 	 * Some processes might be sleeping on "tap", so we have to make
    367   1.1      cube 	 * them release their hold on the device.
    368   1.1      cube 	 *
    369   1.1      cube 	 * The LK_DRAIN operation will wait for every locked process to
    370   1.1      cube 	 * release their hold.
    371   1.1      cube 	 */
    372   1.1      cube 	sc->sc_flags |= TAP_GOING;
    373   1.1      cube 	s = splnet();
    374   1.1      cube 	tap_stop(ifp, 1);
    375   1.1      cube 	if_down(ifp);
    376   1.1      cube 	splx(s);
    377   1.1      cube 	lockmgr(&sc->sc_rdlock, LK_DRAIN, NULL);
    378   1.1      cube 
    379   1.1      cube 	/*
    380   1.1      cube 	 * Destroying a single leaf is a very straightforward operation using
    381   1.1      cube 	 * sysctl_destroyv.  One should be sure to always end the path with
    382   1.1      cube 	 * CTL_EOL.
    383   1.1      cube 	 */
    384   1.3      cube 	if ((error = sysctl_destroyv(NULL, CTL_NET, AF_LINK, tap_node,
    385  1.15   thorpej 	    device_unit(&sc->sc_dev), CTL_EOL)) != 0)
    386   1.1      cube 		aprint_error("%s: sysctl_destroyv returned %d, ignoring\n",
    387   1.1      cube 		    sc->sc_dev.dv_xname, error);
    388   1.1      cube 	ether_ifdetach(ifp);
    389   1.1      cube 	if_detach(ifp);
    390   1.1      cube 	ifmedia_delete_instance(&sc->sc_im, IFM_INST_ANY);
    391   1.1      cube 
    392   1.1      cube 	return (0);
    393   1.1      cube }
    394   1.1      cube 
    395   1.1      cube /*
    396   1.1      cube  * This function is called by the ifmedia layer to notify the driver
    397   1.1      cube  * that the user requested a media change.  A real driver would
    398   1.1      cube  * reconfigure the hardware.
    399   1.1      cube  */
    400   1.1      cube static int
    401   1.1      cube tap_mediachange(struct ifnet *ifp)
    402   1.1      cube {
    403   1.1      cube 	return (0);
    404   1.1      cube }
    405   1.1      cube 
    406   1.1      cube /*
    407   1.1      cube  * Here the user asks for the currently used media.
    408   1.1      cube  */
    409   1.1      cube static void
    410   1.1      cube tap_mediastatus(struct ifnet *ifp, struct ifmediareq *imr)
    411   1.1      cube {
    412   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)ifp->if_softc;
    413   1.1      cube 	imr->ifm_active = sc->sc_im.ifm_cur->ifm_media;
    414   1.1      cube }
    415   1.1      cube 
    416   1.1      cube /*
    417   1.1      cube  * This is the function where we SEND packets.
    418   1.1      cube  *
    419   1.1      cube  * There is no 'receive' equivalent.  A typical driver will get
    420   1.1      cube  * interrupts from the hardware, and from there will inject new packets
    421   1.1      cube  * into the network stack.
    422   1.1      cube  *
    423   1.1      cube  * Once handled, a packet must be freed.  A real driver might not be able
    424   1.1      cube  * to fit all the pending packets into the hardware, and is allowed to
    425   1.1      cube  * return before having sent all the packets.  It should then use the
    426   1.1      cube  * if_flags flag IFF_OACTIVE to notify the upper layer.
    427   1.1      cube  *
    428   1.1      cube  * There are also other flags one should check, such as IFF_PAUSE.
    429   1.1      cube  *
    430   1.1      cube  * It is our duty to make packets available to BPF listeners.
    431   1.1      cube  *
    432   1.1      cube  * You should be aware that this function is called by the Ethernet layer
    433   1.1      cube  * at splnet().
    434   1.1      cube  *
    435   1.1      cube  * When the device is opened, we have to pass the packet(s) to the
    436   1.1      cube  * userland.  For that we stay in OACTIVE mode while the userland gets
    437   1.1      cube  * the packets, and we send a signal to the processes waiting to read.
    438   1.1      cube  *
    439   1.1      cube  * wakeup(sc) is the counterpart to the tsleep call in
    440   1.1      cube  * tap_dev_read, while selnotify() is used for kevent(2) and
    441   1.1      cube  * poll(2) (which includes select(2)) listeners.
    442   1.1      cube  */
    443   1.1      cube static void
    444   1.1      cube tap_start(struct ifnet *ifp)
    445   1.1      cube {
    446   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)ifp->if_softc;
    447   1.1      cube 	struct mbuf *m0;
    448   1.1      cube 
    449   1.1      cube 	if ((sc->sc_flags & TAP_INUSE) == 0) {
    450   1.1      cube 		/* Simply drop packets */
    451   1.1      cube 		for(;;) {
    452   1.1      cube 			IFQ_DEQUEUE(&ifp->if_snd, m0);
    453   1.1      cube 			if (m0 == NULL)
    454   1.1      cube 				return;
    455   1.1      cube 
    456   1.1      cube 			ifp->if_opackets++;
    457   1.1      cube #if NBPFILTER > 0
    458   1.1      cube 			if (ifp->if_bpf)
    459   1.1      cube 				bpf_mtap(ifp->if_bpf, m0);
    460   1.1      cube #endif
    461   1.1      cube 
    462   1.1      cube 			m_freem(m0);
    463   1.1      cube 		}
    464   1.1      cube 	} else if (!IFQ_IS_EMPTY(&ifp->if_snd)) {
    465   1.1      cube 		ifp->if_flags |= IFF_OACTIVE;
    466   1.1      cube 		wakeup(sc);
    467   1.1      cube 		selnotify(&sc->sc_rsel, 1);
    468   1.1      cube 		if (sc->sc_flags & TAP_ASYNCIO)
    469   1.1      cube 			fownsignal(sc->sc_pgid, SIGIO, POLL_IN,
    470   1.1      cube 			    POLLIN|POLLRDNORM, NULL);
    471   1.1      cube 	}
    472   1.1      cube }
    473   1.1      cube 
    474   1.1      cube /*
    475   1.1      cube  * A typical driver will only contain the following handlers for
    476   1.1      cube  * ioctl calls, except SIOCSIFPHYADDR.
    477   1.1      cube  * The latter is a hack I used to set the Ethernet address of the
    478   1.1      cube  * faked device.
    479   1.1      cube  *
    480   1.1      cube  * Note that both ifmedia_ioctl() and ether_ioctl() have to be
    481   1.1      cube  * called under splnet().
    482   1.1      cube  */
    483   1.1      cube static int
    484   1.1      cube tap_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
    485   1.1      cube {
    486   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)ifp->if_softc;
    487   1.1      cube 	struct ifreq *ifr = (struct ifreq *)data;
    488   1.1      cube 	int s, error;
    489   1.1      cube 
    490   1.1      cube 	s = splnet();
    491   1.1      cube 
    492   1.1      cube 	switch (cmd) {
    493   1.1      cube 	case SIOCSIFMEDIA:
    494   1.1      cube 	case SIOCGIFMEDIA:
    495   1.1      cube 		error = ifmedia_ioctl(ifp, ifr, &sc->sc_im, cmd);
    496   1.1      cube 		break;
    497   1.1      cube 	case SIOCSIFPHYADDR:
    498   1.1      cube 		error = tap_lifaddr(ifp, cmd, (struct ifaliasreq *)data);
    499   1.1      cube 		break;
    500   1.1      cube 	default:
    501   1.1      cube 		error = ether_ioctl(ifp, cmd, data);
    502   1.1      cube 		if (error == ENETRESET)
    503   1.1      cube 			error = 0;
    504   1.1      cube 		break;
    505   1.1      cube 	}
    506   1.1      cube 
    507   1.1      cube 	splx(s);
    508   1.1      cube 
    509   1.1      cube 	return (error);
    510   1.1      cube }
    511   1.1      cube 
    512   1.1      cube /*
    513   1.1      cube  * Helper function to set Ethernet address.  This shouldn't be done there,
    514   1.1      cube  * and should actually be available to all Ethernet drivers, real or not.
    515   1.1      cube  */
    516   1.1      cube static int
    517   1.1      cube tap_lifaddr(struct ifnet *ifp, u_long cmd, struct ifaliasreq *ifra)
    518   1.1      cube {
    519   1.1      cube 	struct sockaddr *sa = (struct sockaddr *)&ifra->ifra_addr;
    520   1.1      cube 
    521   1.1      cube 	if (sa->sa_family != AF_LINK)
    522   1.1      cube 		return (EINVAL);
    523   1.1      cube 
    524   1.1      cube 	memcpy(LLADDR(ifp->if_sadl), sa->sa_data, ETHER_ADDR_LEN);
    525   1.1      cube 
    526   1.1      cube 	return (0);
    527   1.1      cube }
    528   1.1      cube 
    529   1.1      cube /*
    530   1.1      cube  * _init() would typically be called when an interface goes up,
    531   1.1      cube  * meaning it should configure itself into the state in which it
    532   1.1      cube  * can send packets.
    533   1.1      cube  */
    534   1.1      cube static int
    535   1.1      cube tap_init(struct ifnet *ifp)
    536   1.1      cube {
    537   1.1      cube 	ifp->if_flags |= IFF_RUNNING;
    538   1.1      cube 
    539   1.1      cube 	tap_start(ifp);
    540   1.1      cube 
    541   1.1      cube 	return (0);
    542   1.1      cube }
    543   1.1      cube 
    544   1.1      cube /*
    545   1.1      cube  * _stop() is called when an interface goes down.  It is our
    546   1.1      cube  * responsability to validate that state by clearing the
    547   1.1      cube  * IFF_RUNNING flag.
    548   1.1      cube  *
    549   1.1      cube  * We have to wake up all the sleeping processes to have the pending
    550   1.1      cube  * read requests cancelled.
    551   1.1      cube  */
    552   1.1      cube static void
    553   1.1      cube tap_stop(struct ifnet *ifp, int disable)
    554   1.1      cube {
    555   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)ifp->if_softc;
    556   1.1      cube 
    557   1.1      cube 	ifp->if_flags &= ~IFF_RUNNING;
    558   1.1      cube 	wakeup(sc);
    559   1.1      cube 	selnotify(&sc->sc_rsel, 1);
    560   1.1      cube 	if (sc->sc_flags & TAP_ASYNCIO)
    561   1.1      cube 		fownsignal(sc->sc_pgid, SIGIO, POLL_HUP, 0, NULL);
    562   1.1      cube }
    563   1.1      cube 
    564   1.1      cube /*
    565   1.1      cube  * The 'create' command of ifconfig can be used to create
    566   1.1      cube  * any numbered instance of a given device.  Thus we have to
    567   1.1      cube  * make sure we have enough room in cd_devs to create the
    568   1.1      cube  * user-specified instance.  config_attach_pseudo will do this
    569   1.1      cube  * for us.
    570   1.1      cube  */
    571   1.1      cube static int
    572   1.1      cube tap_clone_create(struct if_clone *ifc, int unit)
    573   1.1      cube {
    574   1.1      cube 	if (tap_clone_creator(unit) == NULL) {
    575   1.1      cube 		aprint_error("%s%d: unable to attach an instance\n",
    576   1.1      cube                     tap_cd.cd_name, unit);
    577   1.1      cube 		return (ENXIO);
    578   1.1      cube 	}
    579   1.1      cube 
    580   1.1      cube 	return (0);
    581   1.1      cube }
    582   1.1      cube 
    583   1.1      cube /*
    584   1.1      cube  * tap(4) can be cloned by two ways:
    585   1.1      cube  *   using 'ifconfig tap0 create', which will use the network
    586   1.1      cube  *     interface cloning API, and call tap_clone_create above.
    587   1.1      cube  *   opening the cloning device node, whose minor number is TAP_CLONER.
    588   1.1      cube  *     See below for an explanation on how this part work.
    589   1.1      cube  *
    590   1.1      cube  * config_attach_pseudo can be called with unit = DVUNIT_ANY to have
    591   1.1      cube  * autoconf(9) choose a unit number for us.  This is what happens when
    592   1.1      cube  * the cloner is openend, while the ifcloner interface creates a device
    593   1.1      cube  * with a specific unit number.
    594   1.1      cube  */
    595   1.1      cube static struct tap_softc *
    596   1.1      cube tap_clone_creator(int unit)
    597   1.1      cube {
    598   1.1      cube 	struct cfdata *cf;
    599   1.1      cube 
    600   1.1      cube 	cf = malloc(sizeof(*cf), M_DEVBUF, M_WAITOK);
    601   1.1      cube 	cf->cf_name = tap_cd.cd_name;
    602   1.1      cube 	cf->cf_atname = tap_ca.ca_name;
    603   1.1      cube 	cf->cf_unit = unit;
    604   1.1      cube 	cf->cf_fstate = FSTATE_STAR;
    605   1.1      cube 
    606   1.1      cube 	return (struct tap_softc *)config_attach_pseudo(cf);
    607   1.1      cube }
    608   1.1      cube 
    609   1.1      cube /*
    610   1.1      cube  * The clean design of if_clone and autoconf(9) makes that part
    611   1.1      cube  * really straightforward.  The second argument of config_detach
    612   1.1      cube  * means neither QUIET nor FORCED.
    613   1.1      cube  */
    614   1.1      cube static int
    615   1.1      cube tap_clone_destroy(struct ifnet *ifp)
    616   1.1      cube {
    617   1.1      cube 	return tap_clone_destroyer((struct device *)ifp->if_softc);
    618   1.1      cube }
    619   1.1      cube 
    620  1.12      cube int
    621   1.1      cube tap_clone_destroyer(struct device *dev)
    622   1.1      cube {
    623  1.16   thorpej 	struct cfdata *cf = device_cfdata(dev);
    624   1.1      cube 	int error;
    625   1.1      cube 
    626   1.1      cube 	if ((error = config_detach(dev, 0)) != 0)
    627   1.1      cube 		aprint_error("%s: unable to detach instance\n",
    628   1.1      cube 		    dev->dv_xname);
    629   1.1      cube 	free(cf, M_DEVBUF);
    630   1.1      cube 
    631   1.1      cube 	return (error);
    632   1.1      cube }
    633   1.1      cube 
    634   1.1      cube /*
    635   1.1      cube  * tap(4) is a bit of an hybrid device.  It can be used in two different
    636   1.1      cube  * ways:
    637   1.1      cube  *  1. ifconfig tapN create, then use /dev/tapN to read/write off it.
    638   1.1      cube  *  2. open /dev/tap, get a new interface created and read/write off it.
    639   1.1      cube  *     That interface is destroyed when the process that had it created exits.
    640   1.1      cube  *
    641   1.1      cube  * The first way is managed by the cdevsw structure, and you access interfaces
    642   1.1      cube  * through a (major, minor) mapping:  tap4 is obtained by the minor number
    643   1.1      cube  * 4.  The entry points for the cdevsw interface are prefixed by tap_cdev_.
    644   1.1      cube  *
    645   1.1      cube  * The second way is the so-called "cloning" device.  It's a special minor
    646   1.1      cube  * number (chosen as the maximal number, to allow as much tap devices as
    647   1.1      cube  * possible).  The user first opens the cloner (e.g., /dev/tap), and that
    648   1.1      cube  * call ends in tap_cdev_open.  The actual place where it is handled is
    649   1.1      cube  * tap_dev_cloner.
    650   1.1      cube  *
    651   1.1      cube  * An tap device cannot be opened more than once at a time, so the cdevsw
    652   1.1      cube  * part of open() does nothing but noting that the interface is being used and
    653   1.1      cube  * hence ready to actually handle packets.
    654   1.1      cube  */
    655   1.1      cube 
    656   1.1      cube static int
    657  1.11  christos tap_cdev_open(dev_t dev, int flags, int fmt, struct lwp *l)
    658   1.1      cube {
    659   1.1      cube 	struct tap_softc *sc;
    660   1.1      cube 
    661   1.1      cube 	if (minor(dev) == TAP_CLONER)
    662  1.11  christos 		return tap_dev_cloner(l);
    663   1.1      cube 
    664   1.1      cube 	sc = (struct tap_softc *)device_lookup(&tap_cd, minor(dev));
    665   1.1      cube 	if (sc == NULL)
    666   1.1      cube 		return (ENXIO);
    667   1.1      cube 
    668   1.1      cube 	/* The device can only be opened once */
    669   1.1      cube 	if (sc->sc_flags & TAP_INUSE)
    670   1.1      cube 		return (EBUSY);
    671   1.1      cube 	sc->sc_flags |= TAP_INUSE;
    672   1.1      cube 	return (0);
    673   1.1      cube }
    674   1.1      cube 
    675   1.1      cube /*
    676   1.1      cube  * There are several kinds of cloning devices, and the most simple is the one
    677   1.1      cube  * tap(4) uses.  What it does is change the file descriptor with a new one,
    678   1.1      cube  * with its own fileops structure (which maps to the various read, write,
    679   1.1      cube  * ioctl functions).  It starts allocating a new file descriptor with falloc,
    680   1.1      cube  * then actually creates the new tap devices.
    681   1.1      cube  *
    682   1.1      cube  * Once those two steps are successful, we can re-wire the existing file
    683   1.1      cube  * descriptor to its new self.  This is done with fdclone():  it fills the fp
    684   1.1      cube  * structure as needed (notably f_data gets filled with the fifth parameter
    685   1.1      cube  * passed, the unit of the tap device which will allows us identifying the
    686   1.1      cube  * device later), and returns EMOVEFD.
    687   1.1      cube  *
    688   1.1      cube  * That magic value is interpreted by sys_open() which then replaces the
    689   1.1      cube  * current file descriptor by the new one (through a magic member of struct
    690  1.13     pooka  * lwp, l_dupfd).
    691   1.1      cube  *
    692   1.1      cube  * The tap device is flagged as being busy since it otherwise could be
    693   1.1      cube  * externally accessed through the corresponding device node with the cdevsw
    694   1.1      cube  * interface.
    695   1.1      cube  */
    696   1.1      cube 
    697   1.1      cube static int
    698  1.11  christos tap_dev_cloner(struct lwp *l)
    699   1.1      cube {
    700   1.1      cube 	struct tap_softc *sc;
    701   1.1      cube 	struct file *fp;
    702   1.1      cube 	int error, fd;
    703   1.1      cube 
    704  1.11  christos 	if ((error = falloc(l->l_proc, &fp, &fd)) != 0)
    705   1.1      cube 		return (error);
    706   1.1      cube 
    707   1.1      cube 	if ((sc = tap_clone_creator(DVUNIT_ANY)) == NULL) {
    708  1.11  christos 		FILE_UNUSE(fp, l);
    709   1.1      cube 		ffree(fp);
    710   1.1      cube 		return (ENXIO);
    711   1.1      cube 	}
    712   1.1      cube 
    713   1.1      cube 	sc->sc_flags |= TAP_INUSE;
    714   1.1      cube 
    715  1.11  christos 	return fdclone(l, fp, fd, FREAD|FWRITE, &tap_fileops,
    716  1.15   thorpej 	    (void *)(intptr_t)device_unit(&sc->sc_dev));
    717   1.1      cube }
    718   1.1      cube 
    719   1.1      cube /*
    720   1.1      cube  * While all other operations (read, write, ioctl, poll and kqfilter) are
    721   1.1      cube  * really the same whether we are in cdevsw or fileops mode, the close()
    722   1.1      cube  * function is slightly different in the two cases.
    723   1.1      cube  *
    724   1.1      cube  * As for the other, the core of it is shared in tap_dev_close.  What
    725   1.1      cube  * it does is sufficient for the cdevsw interface, but the cloning interface
    726   1.1      cube  * needs another thing:  the interface is destroyed when the processes that
    727   1.1      cube  * created it closes it.
    728   1.1      cube  */
    729   1.1      cube static int
    730  1.11  christos tap_cdev_close(dev_t dev, int flags, int fmt, struct lwp *l)
    731   1.1      cube {
    732   1.1      cube 	struct tap_softc *sc =
    733   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, minor(dev));
    734   1.1      cube 
    735   1.1      cube 	if (sc == NULL)
    736   1.1      cube 		return (ENXIO);
    737   1.1      cube 
    738   1.1      cube 	return tap_dev_close(sc);
    739   1.1      cube }
    740   1.1      cube 
    741   1.1      cube /*
    742   1.1      cube  * It might happen that the administrator used ifconfig to externally destroy
    743   1.1      cube  * the interface.  In that case, tap_fops_close will be called while
    744   1.1      cube  * tap_detach is already happening.  If we called it again from here, we
    745   1.1      cube  * would dead lock.  TAP_GOING ensures that this situation doesn't happen.
    746   1.1      cube  */
    747   1.1      cube static int
    748  1.11  christos tap_fops_close(struct file *fp, struct lwp *l)
    749   1.1      cube {
    750   1.1      cube 	int unit = (intptr_t)fp->f_data;
    751   1.1      cube 	struct tap_softc *sc;
    752   1.1      cube 	int error;
    753   1.1      cube 
    754   1.1      cube 	sc = (struct tap_softc *)device_lookup(&tap_cd, unit);
    755   1.1      cube 	if (sc == NULL)
    756   1.1      cube 		return (ENXIO);
    757   1.1      cube 
    758   1.1      cube 	/* tap_dev_close currently always succeeds, but it might not
    759   1.1      cube 	 * always be the case. */
    760   1.1      cube 	if ((error = tap_dev_close(sc)) != 0)
    761   1.1      cube 		return (error);
    762   1.1      cube 
    763   1.1      cube 	/* Destroy the device now that it is no longer useful,
    764   1.1      cube 	 * unless it's already being destroyed. */
    765   1.1      cube 	if ((sc->sc_flags & TAP_GOING) != 0)
    766   1.1      cube 		return (0);
    767   1.1      cube 
    768   1.1      cube 	return tap_clone_destroyer((struct device *)sc);
    769   1.1      cube }
    770   1.1      cube 
    771   1.1      cube static int
    772   1.1      cube tap_dev_close(struct tap_softc *sc)
    773   1.1      cube {
    774   1.1      cube 	struct ifnet *ifp;
    775   1.1      cube 	int s;
    776   1.1      cube 
    777   1.1      cube 	s = splnet();
    778   1.1      cube 	/* Let tap_start handle packets again */
    779   1.1      cube 	ifp = &sc->sc_ec.ec_if;
    780   1.1      cube 	ifp->if_flags &= ~IFF_OACTIVE;
    781   1.1      cube 
    782   1.1      cube 	/* Purge output queue */
    783   1.1      cube 	if (!(IFQ_IS_EMPTY(&ifp->if_snd))) {
    784   1.1      cube 		struct mbuf *m;
    785   1.1      cube 
    786   1.1      cube 		for (;;) {
    787   1.1      cube 			IFQ_DEQUEUE(&ifp->if_snd, m);
    788   1.1      cube 			if (m == NULL)
    789   1.1      cube 				break;
    790   1.1      cube 
    791   1.1      cube 			ifp->if_opackets++;
    792   1.1      cube #if NBPFILTER > 0
    793   1.1      cube 			if (ifp->if_bpf)
    794   1.1      cube 				bpf_mtap(ifp->if_bpf, m);
    795   1.1      cube #endif
    796   1.1      cube 		}
    797   1.1      cube 	}
    798   1.1      cube 	splx(s);
    799   1.1      cube 
    800   1.1      cube 	sc->sc_flags &= ~(TAP_INUSE | TAP_ASYNCIO);
    801   1.1      cube 
    802   1.1      cube 	return (0);
    803   1.1      cube }
    804   1.1      cube 
    805   1.1      cube static int
    806   1.1      cube tap_cdev_read(dev_t dev, struct uio *uio, int flags)
    807   1.1      cube {
    808   1.1      cube 	return tap_dev_read(minor(dev), uio, flags);
    809   1.1      cube }
    810   1.1      cube 
    811   1.1      cube static int
    812   1.1      cube tap_fops_read(struct file *fp, off_t *offp, struct uio *uio,
    813  1.17      elad     kauth_cred_t cred, int flags)
    814   1.1      cube {
    815   1.1      cube 	return tap_dev_read((intptr_t)fp->f_data, uio, flags);
    816   1.1      cube }
    817   1.1      cube 
    818   1.1      cube static int
    819   1.1      cube tap_dev_read(int unit, struct uio *uio, int flags)
    820   1.1      cube {
    821   1.1      cube 	struct tap_softc *sc =
    822   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, unit);
    823   1.1      cube 	struct ifnet *ifp;
    824   1.1      cube 	struct mbuf *m, *n;
    825   1.1      cube 	int error = 0, s;
    826   1.1      cube 
    827   1.1      cube 	if (sc == NULL)
    828   1.1      cube 		return (ENXIO);
    829   1.1      cube 
    830   1.1      cube 	ifp = &sc->sc_ec.ec_if;
    831   1.1      cube 	if ((ifp->if_flags & IFF_UP) == 0)
    832   1.1      cube 		return (EHOSTDOWN);
    833   1.1      cube 
    834   1.1      cube 	/*
    835   1.1      cube 	 * In the TAP_NBIO case, we have to make sure we won't be sleeping
    836   1.1      cube 	 */
    837   1.1      cube 	if ((sc->sc_flags & TAP_NBIO) &&
    838   1.1      cube 	    lockstatus(&sc->sc_rdlock) == LK_EXCLUSIVE)
    839   1.1      cube 		return (EWOULDBLOCK);
    840   1.1      cube 	error = lockmgr(&sc->sc_rdlock, LK_EXCLUSIVE, NULL);
    841   1.1      cube 	if (error != 0)
    842   1.1      cube 		return (error);
    843   1.1      cube 
    844   1.1      cube 	s = splnet();
    845   1.1      cube 	if (IFQ_IS_EMPTY(&ifp->if_snd)) {
    846   1.1      cube 		ifp->if_flags &= ~IFF_OACTIVE;
    847   1.1      cube 		splx(s);
    848   1.1      cube 		/*
    849   1.1      cube 		 * We must release the lock before sleeping, and re-acquire it
    850   1.1      cube 		 * after.
    851   1.1      cube 		 */
    852   1.1      cube 		(void)lockmgr(&sc->sc_rdlock, LK_RELEASE, NULL);
    853   1.1      cube 		if (sc->sc_flags & TAP_NBIO)
    854   1.1      cube 			error = EWOULDBLOCK;
    855   1.1      cube 		else
    856   1.1      cube 			error = tsleep(sc, PSOCK|PCATCH, "tap", 0);
    857   1.1      cube 
    858   1.1      cube 		if (error != 0)
    859   1.1      cube 			return (error);
    860   1.1      cube 		/* The device might have been downed */
    861   1.1      cube 		if ((ifp->if_flags & IFF_UP) == 0)
    862   1.1      cube 			return (EHOSTDOWN);
    863   1.1      cube 		if ((sc->sc_flags & TAP_NBIO) &&
    864   1.1      cube 		    lockstatus(&sc->sc_rdlock) == LK_EXCLUSIVE)
    865   1.1      cube 			return (EWOULDBLOCK);
    866   1.1      cube 		error = lockmgr(&sc->sc_rdlock, LK_EXCLUSIVE, NULL);
    867   1.1      cube 		if (error != 0)
    868   1.1      cube 			return (error);
    869   1.1      cube 		s = splnet();
    870   1.1      cube 	}
    871   1.1      cube 
    872   1.1      cube 	IFQ_DEQUEUE(&ifp->if_snd, m);
    873   1.1      cube 	ifp->if_flags &= ~IFF_OACTIVE;
    874   1.1      cube 	splx(s);
    875   1.1      cube 	if (m == NULL) {
    876   1.1      cube 		error = 0;
    877   1.1      cube 		goto out;
    878   1.1      cube 	}
    879   1.1      cube 
    880   1.1      cube 	ifp->if_opackets++;
    881   1.1      cube #if NBPFILTER > 0
    882   1.1      cube 	if (ifp->if_bpf)
    883   1.1      cube 		bpf_mtap(ifp->if_bpf, m);
    884   1.1      cube #endif
    885   1.1      cube 
    886   1.1      cube 	/*
    887   1.1      cube 	 * One read is one packet.
    888   1.1      cube 	 */
    889   1.1      cube 	do {
    890   1.1      cube 		error = uiomove(mtod(m, caddr_t),
    891   1.1      cube 		    min(m->m_len, uio->uio_resid), uio);
    892   1.1      cube 		MFREE(m, n);
    893   1.1      cube 		m = n;
    894   1.1      cube 	} while (m != NULL && uio->uio_resid > 0 && error == 0);
    895   1.1      cube 
    896   1.1      cube 	if (m != NULL)
    897   1.1      cube 		m_freem(m);
    898   1.1      cube 
    899   1.1      cube out:
    900   1.1      cube 	(void)lockmgr(&sc->sc_rdlock, LK_RELEASE, NULL);
    901   1.1      cube 	return (error);
    902   1.1      cube }
    903   1.1      cube 
    904   1.1      cube static int
    905   1.1      cube tap_cdev_write(dev_t dev, struct uio *uio, int flags)
    906   1.1      cube {
    907   1.1      cube 	return tap_dev_write(minor(dev), uio, flags);
    908   1.1      cube }
    909   1.1      cube 
    910   1.1      cube static int
    911   1.1      cube tap_fops_write(struct file *fp, off_t *offp, struct uio *uio,
    912  1.17      elad     kauth_cred_t cred, int flags)
    913   1.1      cube {
    914   1.1      cube 	return tap_dev_write((intptr_t)fp->f_data, uio, flags);
    915   1.1      cube }
    916   1.1      cube 
    917   1.1      cube static int
    918   1.1      cube tap_dev_write(int unit, struct uio *uio, int flags)
    919   1.1      cube {
    920   1.1      cube 	struct tap_softc *sc =
    921   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, unit);
    922   1.1      cube 	struct ifnet *ifp;
    923   1.1      cube 	struct mbuf *m, **mp;
    924   1.1      cube 	int error = 0;
    925   1.9    bouyer 	int s;
    926   1.1      cube 
    927   1.1      cube 	if (sc == NULL)
    928   1.1      cube 		return (ENXIO);
    929   1.1      cube 
    930   1.1      cube 	ifp = &sc->sc_ec.ec_if;
    931   1.1      cube 
    932   1.1      cube 	/* One write, one packet, that's the rule */
    933   1.1      cube 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    934   1.1      cube 	if (m == NULL) {
    935   1.1      cube 		ifp->if_ierrors++;
    936   1.1      cube 		return (ENOBUFS);
    937   1.1      cube 	}
    938   1.1      cube 	m->m_pkthdr.len = uio->uio_resid;
    939   1.1      cube 
    940   1.1      cube 	mp = &m;
    941   1.1      cube 	while (error == 0 && uio->uio_resid > 0) {
    942   1.1      cube 		if (*mp != m) {
    943   1.1      cube 			MGET(*mp, M_DONTWAIT, MT_DATA);
    944   1.1      cube 			if (*mp == NULL) {
    945   1.1      cube 				error = ENOBUFS;
    946   1.1      cube 				break;
    947   1.1      cube 			}
    948   1.1      cube 		}
    949   1.1      cube 		(*mp)->m_len = min(MHLEN, uio->uio_resid);
    950   1.1      cube 		error = uiomove(mtod(*mp, caddr_t), (*mp)->m_len, uio);
    951   1.1      cube 		mp = &(*mp)->m_next;
    952   1.1      cube 	}
    953   1.1      cube 	if (error) {
    954   1.1      cube 		ifp->if_ierrors++;
    955   1.1      cube 		m_freem(m);
    956   1.1      cube 		return (error);
    957   1.1      cube 	}
    958   1.1      cube 
    959   1.1      cube 	ifp->if_ipackets++;
    960   1.1      cube 	m->m_pkthdr.rcvif = ifp;
    961   1.1      cube 
    962   1.1      cube #if NBPFILTER > 0
    963   1.1      cube 	if (ifp->if_bpf)
    964   1.1      cube 		bpf_mtap(ifp->if_bpf, m);
    965   1.1      cube #endif
    966   1.9    bouyer 	s =splnet();
    967   1.1      cube 	(*ifp->if_input)(ifp, m);
    968   1.9    bouyer 	splx(s);
    969   1.1      cube 
    970   1.1      cube 	return (0);
    971   1.1      cube }
    972   1.1      cube 
    973   1.1      cube static int
    974   1.1      cube tap_cdev_ioctl(dev_t dev, u_long cmd, caddr_t data, int flags,
    975  1.11  christos     struct lwp *l)
    976   1.1      cube {
    977  1.11  christos 	return tap_dev_ioctl(minor(dev), cmd, data, l);
    978   1.1      cube }
    979   1.1      cube 
    980   1.1      cube static int
    981  1.11  christos tap_fops_ioctl(struct file *fp, u_long cmd, void *data, struct lwp *l)
    982   1.1      cube {
    983  1.11  christos 	return tap_dev_ioctl((intptr_t)fp->f_data, cmd, (caddr_t)data, l);
    984   1.1      cube }
    985   1.1      cube 
    986   1.1      cube static int
    987  1.11  christos tap_dev_ioctl(int unit, u_long cmd, caddr_t data, struct lwp *l)
    988   1.1      cube {
    989   1.1      cube 	struct tap_softc *sc =
    990   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, unit);
    991   1.1      cube 	int error = 0;
    992   1.1      cube 
    993   1.1      cube 	if (sc == NULL)
    994   1.1      cube 		return (ENXIO);
    995   1.1      cube 
    996   1.1      cube 	switch (cmd) {
    997   1.1      cube 	case FIONREAD:
    998   1.1      cube 		{
    999   1.1      cube 			struct ifnet *ifp = &sc->sc_ec.ec_if;
   1000   1.1      cube 			struct mbuf *m;
   1001   1.1      cube 			int s;
   1002   1.1      cube 
   1003   1.1      cube 			s = splnet();
   1004   1.1      cube 			IFQ_POLL(&ifp->if_snd, m);
   1005   1.1      cube 
   1006   1.1      cube 			if (m == NULL)
   1007   1.1      cube 				*(int *)data = 0;
   1008   1.1      cube 			else
   1009   1.1      cube 				*(int *)data = m->m_pkthdr.len;
   1010   1.1      cube 			splx(s);
   1011   1.1      cube 		} break;
   1012   1.1      cube 	case TIOCSPGRP:
   1013   1.1      cube 	case FIOSETOWN:
   1014  1.11  christos 		error = fsetown(l->l_proc, &sc->sc_pgid, cmd, data);
   1015   1.1      cube 		break;
   1016   1.1      cube 	case TIOCGPGRP:
   1017   1.1      cube 	case FIOGETOWN:
   1018  1.11  christos 		error = fgetown(l->l_proc, sc->sc_pgid, cmd, data);
   1019   1.1      cube 		break;
   1020   1.1      cube 	case FIOASYNC:
   1021   1.1      cube 		if (*(int *)data)
   1022   1.1      cube 			sc->sc_flags |= TAP_ASYNCIO;
   1023   1.1      cube 		else
   1024   1.1      cube 			sc->sc_flags &= ~TAP_ASYNCIO;
   1025   1.1      cube 		break;
   1026   1.1      cube 	case FIONBIO:
   1027   1.1      cube 		if (*(int *)data)
   1028   1.1      cube 			sc->sc_flags |= TAP_NBIO;
   1029   1.1      cube 		else
   1030   1.1      cube 			sc->sc_flags &= ~TAP_NBIO;
   1031   1.1      cube 		break;
   1032   1.1      cube 	case TAPGIFNAME:
   1033   1.1      cube 		{
   1034   1.1      cube 			struct ifreq *ifr = (struct ifreq *)data;
   1035   1.1      cube 			struct ifnet *ifp = &sc->sc_ec.ec_if;
   1036   1.1      cube 
   1037   1.1      cube 			strlcpy(ifr->ifr_name, ifp->if_xname, IFNAMSIZ);
   1038   1.1      cube 		} break;
   1039   1.1      cube 	default:
   1040   1.1      cube 		error = ENOTTY;
   1041   1.1      cube 		break;
   1042   1.1      cube 	}
   1043   1.1      cube 
   1044   1.1      cube 	return (0);
   1045   1.1      cube }
   1046   1.1      cube 
   1047   1.1      cube static int
   1048  1.11  christos tap_cdev_poll(dev_t dev, int events, struct lwp *l)
   1049   1.1      cube {
   1050  1.11  christos 	return tap_dev_poll(minor(dev), events, l);
   1051   1.1      cube }
   1052   1.1      cube 
   1053   1.1      cube static int
   1054  1.11  christos tap_fops_poll(struct file *fp, int events, struct lwp *l)
   1055   1.1      cube {
   1056  1.11  christos 	return tap_dev_poll((intptr_t)fp->f_data, events, l);
   1057   1.1      cube }
   1058   1.1      cube 
   1059   1.1      cube static int
   1060  1.11  christos tap_dev_poll(int unit, int events, struct lwp *l)
   1061   1.1      cube {
   1062   1.1      cube 	struct tap_softc *sc =
   1063   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, unit);
   1064   1.1      cube 	int revents = 0;
   1065   1.1      cube 
   1066   1.1      cube 	if (sc == NULL)
   1067   1.1      cube 		return (ENXIO);
   1068   1.1      cube 
   1069   1.1      cube 	if (events & (POLLIN|POLLRDNORM)) {
   1070   1.1      cube 		struct ifnet *ifp = &sc->sc_ec.ec_if;
   1071   1.1      cube 		struct mbuf *m;
   1072   1.1      cube 		int s;
   1073   1.1      cube 
   1074   1.1      cube 		s = splnet();
   1075   1.1      cube 		IFQ_POLL(&ifp->if_snd, m);
   1076   1.1      cube 		splx(s);
   1077   1.1      cube 
   1078   1.1      cube 		if (m != NULL)
   1079   1.1      cube 			revents |= events & (POLLIN|POLLRDNORM);
   1080   1.1      cube 		else {
   1081   1.4     ragge 			simple_lock(&sc->sc_kqlock);
   1082  1.11  christos 			selrecord(l, &sc->sc_rsel);
   1083   1.1      cube 			simple_unlock(&sc->sc_kqlock);
   1084   1.1      cube 		}
   1085   1.1      cube 	}
   1086   1.1      cube 	revents |= events & (POLLOUT|POLLWRNORM);
   1087   1.1      cube 
   1088   1.1      cube 	return (revents);
   1089   1.1      cube }
   1090   1.1      cube 
   1091   1.1      cube static struct filterops tap_read_filterops = { 1, NULL, tap_kqdetach,
   1092   1.1      cube 	tap_kqread };
   1093   1.1      cube static struct filterops tap_seltrue_filterops = { 1, NULL, tap_kqdetach,
   1094   1.1      cube 	filt_seltrue };
   1095   1.1      cube 
   1096   1.1      cube static int
   1097   1.1      cube tap_cdev_kqfilter(dev_t dev, struct knote *kn)
   1098   1.1      cube {
   1099   1.1      cube 	return tap_dev_kqfilter(minor(dev), kn);
   1100   1.1      cube }
   1101   1.1      cube 
   1102   1.1      cube static int
   1103   1.1      cube tap_fops_kqfilter(struct file *fp, struct knote *kn)
   1104   1.1      cube {
   1105   1.1      cube 	return tap_dev_kqfilter((intptr_t)fp->f_data, kn);
   1106   1.1      cube }
   1107   1.1      cube 
   1108   1.1      cube static int
   1109   1.1      cube tap_dev_kqfilter(int unit, struct knote *kn)
   1110   1.1      cube {
   1111   1.1      cube 	struct tap_softc *sc =
   1112   1.1      cube 	    (struct tap_softc *)device_lookup(&tap_cd, unit);
   1113   1.1      cube 
   1114   1.1      cube 	if (sc == NULL)
   1115   1.1      cube 		return (ENXIO);
   1116   1.1      cube 
   1117   1.1      cube 	switch(kn->kn_filter) {
   1118   1.1      cube 	case EVFILT_READ:
   1119   1.1      cube 		kn->kn_fop = &tap_read_filterops;
   1120   1.1      cube 		break;
   1121   1.1      cube 	case EVFILT_WRITE:
   1122   1.1      cube 		kn->kn_fop = &tap_seltrue_filterops;
   1123   1.1      cube 		break;
   1124   1.1      cube 	default:
   1125   1.1      cube 		return (1);
   1126   1.1      cube 	}
   1127   1.1      cube 
   1128   1.1      cube 	kn->kn_hook = sc;
   1129   1.4     ragge 	simple_lock(&sc->sc_kqlock);
   1130   1.1      cube 	SLIST_INSERT_HEAD(&sc->sc_rsel.sel_klist, kn, kn_selnext);
   1131   1.1      cube 	simple_unlock(&sc->sc_kqlock);
   1132   1.1      cube 	return (0);
   1133   1.1      cube }
   1134   1.1      cube 
   1135   1.1      cube static void
   1136   1.1      cube tap_kqdetach(struct knote *kn)
   1137   1.1      cube {
   1138   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)kn->kn_hook;
   1139   1.1      cube 
   1140   1.4     ragge 	simple_lock(&sc->sc_kqlock);
   1141   1.1      cube 	SLIST_REMOVE(&sc->sc_rsel.sel_klist, kn, knote, kn_selnext);
   1142   1.1      cube 	simple_unlock(&sc->sc_kqlock);
   1143   1.1      cube }
   1144   1.1      cube 
   1145   1.1      cube static int
   1146   1.1      cube tap_kqread(struct knote *kn, long hint)
   1147   1.1      cube {
   1148   1.1      cube 	struct tap_softc *sc = (struct tap_softc *)kn->kn_hook;
   1149   1.1      cube 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1150   1.1      cube 	struct mbuf *m;
   1151   1.1      cube 	int s;
   1152   1.1      cube 
   1153   1.1      cube 	s = splnet();
   1154   1.1      cube 	IFQ_POLL(&ifp->if_snd, m);
   1155   1.1      cube 
   1156   1.1      cube 	if (m == NULL)
   1157   1.1      cube 		kn->kn_data = 0;
   1158   1.1      cube 	else
   1159   1.1      cube 		kn->kn_data = m->m_pkthdr.len;
   1160   1.1      cube 	splx(s);
   1161   1.1      cube 	return (kn->kn_data != 0 ? 1 : 0);
   1162   1.1      cube }
   1163   1.1      cube 
   1164   1.1      cube /*
   1165   1.1      cube  * sysctl management routines
   1166   1.1      cube  * You can set the address of an interface through:
   1167   1.1      cube  * net.link.tap.tap<number>
   1168   1.1      cube  *
   1169   1.1      cube  * Note the consistent use of tap_log in order to use
   1170   1.1      cube  * sysctl_teardown at unload time.
   1171   1.1      cube  *
   1172   1.1      cube  * In the kernel you will find a lot of SYSCTL_SETUP blocks.  Those
   1173   1.1      cube  * blocks register a function in a special section of the kernel
   1174   1.1      cube  * (called a link set) which is used at init_sysctl() time to cycle
   1175   1.1      cube  * through all those functions to create the kernel's sysctl tree.
   1176   1.1      cube  *
   1177   1.1      cube  * It is not (currently) possible to use link sets in a LKM, so the
   1178   1.1      cube  * easiest is to simply call our own setup routine at load time.
   1179   1.1      cube  *
   1180   1.1      cube  * In the SYSCTL_SETUP blocks you find in the kernel, nodes have the
   1181   1.1      cube  * CTLFLAG_PERMANENT flag, meaning they cannot be removed.  Once the
   1182   1.1      cube  * whole kernel sysctl tree is built, it is not possible to add any
   1183   1.1      cube  * permanent node.
   1184   1.1      cube  *
   1185   1.1      cube  * It should be noted that we're not saving the sysctlnode pointer
   1186   1.1      cube  * we are returned when creating the "tap" node.  That structure
   1187   1.1      cube  * cannot be trusted once out of the calling function, as it might
   1188   1.1      cube  * get reused.  So we just save the MIB number, and always give the
   1189   1.1      cube  * full path starting from the root for later calls to sysctl_createv
   1190   1.1      cube  * and sysctl_destroyv.
   1191   1.1      cube  */
   1192   1.1      cube SYSCTL_SETUP(sysctl_tap_setup, "sysctl net.link.tap subtree setup")
   1193   1.1      cube {
   1194  1.10    atatat 	const struct sysctlnode *node;
   1195   1.1      cube 	int error = 0;
   1196   1.1      cube 
   1197   1.1      cube 	if ((error = sysctl_createv(clog, 0, NULL, NULL,
   1198   1.1      cube 	    CTLFLAG_PERMANENT,
   1199   1.1      cube 	    CTLTYPE_NODE, "net", NULL,
   1200   1.1      cube 	    NULL, 0, NULL, 0,
   1201   1.1      cube 	    CTL_NET, CTL_EOL)) != 0)
   1202   1.1      cube 		return;
   1203   1.1      cube 
   1204   1.1      cube 	if ((error = sysctl_createv(clog, 0, NULL, NULL,
   1205   1.1      cube 	    CTLFLAG_PERMANENT,
   1206   1.1      cube 	    CTLTYPE_NODE, "link", NULL,
   1207   1.1      cube 	    NULL, 0, NULL, 0,
   1208   1.3      cube 	    CTL_NET, AF_LINK, CTL_EOL)) != 0)
   1209   1.1      cube 		return;
   1210   1.1      cube 
   1211   1.1      cube 	/*
   1212   1.1      cube 	 * The first four parameters of sysctl_createv are for management.
   1213   1.1      cube 	 *
   1214   1.1      cube 	 * The four that follows, here starting with a '0' for the flags,
   1215   1.1      cube 	 * describe the node.
   1216   1.1      cube 	 *
   1217   1.1      cube 	 * The next series of four set its value, through various possible
   1218   1.1      cube 	 * means.
   1219   1.1      cube 	 *
   1220   1.1      cube 	 * Last but not least, the path to the node is described.  That path
   1221   1.1      cube 	 * is relative to the given root (third argument).  Here we're
   1222   1.1      cube 	 * starting from the root.
   1223   1.1      cube 	 */
   1224   1.1      cube 	if ((error = sysctl_createv(clog, 0, NULL, &node,
   1225   1.1      cube 	    CTLFLAG_PERMANENT,
   1226   1.1      cube 	    CTLTYPE_NODE, "tap", NULL,
   1227   1.1      cube 	    NULL, 0, NULL, 0,
   1228   1.3      cube 	    CTL_NET, AF_LINK, CTL_CREATE, CTL_EOL)) != 0)
   1229   1.1      cube 		return;
   1230   1.1      cube 	tap_node = node->sysctl_num;
   1231   1.1      cube }
   1232   1.1      cube 
   1233   1.1      cube /*
   1234   1.1      cube  * The helper functions make Andrew Brown's interface really
   1235   1.1      cube  * shine.  It makes possible to create value on the fly whether
   1236   1.1      cube  * the sysctl value is read or written.
   1237   1.1      cube  *
   1238   1.1      cube  * As shown as an example in the man page, the first step is to
   1239   1.1      cube  * create a copy of the node to have sysctl_lookup work on it.
   1240   1.1      cube  *
   1241   1.1      cube  * Here, we have more work to do than just a copy, since we have
   1242   1.1      cube  * to create the string.  The first step is to collect the actual
   1243   1.1      cube  * value of the node, which is a convenient pointer to the softc
   1244   1.1      cube  * of the interface.  From there we create the string and use it
   1245   1.1      cube  * as the value, but only for the *copy* of the node.
   1246   1.1      cube  *
   1247   1.1      cube  * Then we let sysctl_lookup do the magic, which consists in
   1248   1.1      cube  * setting oldp and newp as required by the operation.  When the
   1249   1.1      cube  * value is read, that means that the string will be copied to
   1250   1.1      cube  * the user, and when it is written, the new value will be copied
   1251   1.1      cube  * over in the addr array.
   1252   1.1      cube  *
   1253   1.1      cube  * If newp is NULL, the user was reading the value, so we don't
   1254   1.1      cube  * have anything else to do.  If a new value was written, we
   1255   1.1      cube  * have to check it.
   1256   1.1      cube  *
   1257   1.1      cube  * If it is incorrect, we can return an error and leave 'node' as
   1258   1.1      cube  * it is:  since it is a copy of the actual node, the change will
   1259   1.1      cube  * be forgotten.
   1260   1.1      cube  *
   1261   1.1      cube  * Upon a correct input, we commit the change to the ifnet
   1262   1.1      cube  * structure of our interface.
   1263   1.1      cube  */
   1264   1.1      cube static int
   1265   1.1      cube tap_sysctl_handler(SYSCTLFN_ARGS)
   1266   1.1      cube {
   1267   1.1      cube 	struct sysctlnode node;
   1268   1.1      cube 	struct tap_softc *sc;
   1269   1.1      cube 	struct ifnet *ifp;
   1270   1.1      cube 	int error;
   1271   1.1      cube 	size_t len;
   1272  1.14  christos 	char addr[3 * ETHER_ADDR_LEN];
   1273   1.1      cube 
   1274   1.1      cube 	node = *rnode;
   1275   1.1      cube 	sc = node.sysctl_data;
   1276   1.1      cube 	ifp = &sc->sc_ec.ec_if;
   1277  1.14  christos 	(void)ether_snprintf(addr, sizeof(addr), LLADDR(ifp->if_sadl));
   1278   1.1      cube 	node.sysctl_data = addr;
   1279   1.1      cube 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
   1280   1.1      cube 	if (error || newp == NULL)
   1281   1.1      cube 		return (error);
   1282   1.1      cube 
   1283   1.1      cube 	len = strlen(addr);
   1284   1.1      cube 	if (len < 11 || len > 17)
   1285   1.1      cube 		return (EINVAL);
   1286   1.1      cube 
   1287   1.1      cube 	/* Commit change */
   1288   1.1      cube 	if (tap_ether_aton(LLADDR(ifp->if_sadl), addr) != 0)
   1289   1.1      cube 		return (EINVAL);
   1290   1.1      cube 	return (error);
   1291   1.1      cube }
   1292   1.1      cube 
   1293   1.1      cube /*
   1294   1.1      cube  * ether_aton implementation, not using a static buffer.
   1295   1.1      cube  */
   1296   1.1      cube static int
   1297   1.1      cube tap_ether_aton(u_char *dest, char *str)
   1298   1.1      cube {
   1299   1.1      cube 	int i;
   1300   1.1      cube 	char *cp = str;
   1301   1.1      cube 	u_char val[6];
   1302   1.1      cube 
   1303   1.1      cube #define	set_value			\
   1304   1.1      cube 	if (*cp > '9' && *cp < 'a')	\
   1305   1.1      cube 		*cp -= 'A' - 10;	\
   1306   1.1      cube 	else if (*cp > '9')		\
   1307   1.1      cube 		*cp -= 'a' - 10;	\
   1308   1.1      cube 	else				\
   1309   1.1      cube 		*cp -= '0'
   1310   1.1      cube 
   1311   1.1      cube 	for (i = 0; i < 6; i++, cp++) {
   1312   1.1      cube 		if (!isxdigit(*cp))
   1313   1.1      cube 			return (1);
   1314   1.1      cube 		set_value;
   1315   1.1      cube 		val[i] = *cp++;
   1316   1.1      cube 		if (isxdigit(*cp)) {
   1317   1.1      cube 			set_value;
   1318   1.1      cube 			val[i] *= 16;
   1319   1.1      cube 			val[i] += *cp++;
   1320   1.1      cube 		}
   1321   1.1      cube 		if (*cp == ':' || i == 5)
   1322   1.1      cube 			continue;
   1323   1.1      cube 		else
   1324   1.1      cube 			return (1);
   1325   1.1      cube 	}
   1326   1.1      cube 	memcpy(dest, val, 6);
   1327   1.1      cube 	return (0);
   1328   1.1      cube }
   1329