Home | History | Annotate | Line # | Download | only in net
bpf.c revision 1.37
      1  1.37  christos /*	$NetBSD: bpf.c,v 1.37 1997/10/09 18:58:08 christos Exp $	*/
      2  1.13       cgd 
      3  1.12   mycroft /*
      4  1.12   mycroft  * Copyright (c) 1990, 1991, 1993
      5  1.12   mycroft  *	The Regents of the University of California.  All rights reserved.
      6   1.1       cgd  *
      7   1.1       cgd  * This code is derived from the Stanford/CMU enet packet filter,
      8   1.1       cgd  * (net/enet.c) distributed as part of 4.3BSD, and code contributed
      9  1.36  christos  * to Berkeley by Steven McCanne and Van Jacobson both of Lawrence
     10   1.2       cgd  * Berkeley Laboratory.
     11   1.1       cgd  *
     12   1.1       cgd  * Redistribution and use in source and binary forms, with or without
     13   1.1       cgd  * modification, are permitted provided that the following conditions
     14   1.1       cgd  * are met:
     15   1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     16   1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     17   1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     18   1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     19   1.1       cgd  *    documentation and/or other materials provided with the distribution.
     20   1.1       cgd  * 3. All advertising materials mentioning features or use of this software
     21   1.1       cgd  *    must display the following acknowledgement:
     22   1.1       cgd  *	This product includes software developed by the University of
     23   1.1       cgd  *	California, Berkeley and its contributors.
     24   1.1       cgd  * 4. Neither the name of the University nor the names of its contributors
     25   1.1       cgd  *    may be used to endorse or promote products derived from this software
     26   1.1       cgd  *    without specific prior written permission.
     27   1.1       cgd  *
     28   1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     29   1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     30   1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     31   1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     32   1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     33   1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     34   1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     35   1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     36   1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     37   1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     38   1.1       cgd  * SUCH DAMAGE.
     39   1.1       cgd  *
     40  1.13       cgd  *	@(#)bpf.c	8.2 (Berkeley) 3/28/94
     41  1.36  christos  * static char rcsid[] =
     42  1.36  christos  * "Header: bpf.c,v 1.67 96/09/26 22:00:52 leres Exp ";
     43   1.1       cgd  */
     44   1.1       cgd 
     45   1.1       cgd #include "bpfilter.h"
     46   1.1       cgd 
     47   1.1       cgd #include <sys/param.h>
     48   1.1       cgd #include <sys/systm.h>
     49   1.1       cgd #include <sys/mbuf.h>
     50   1.1       cgd #include <sys/buf.h>
     51  1.12   mycroft #include <sys/time.h>
     52   1.1       cgd #include <sys/proc.h>
     53   1.1       cgd #include <sys/user.h>
     54   1.1       cgd #include <sys/ioctl.h>
     55  1.11   deraadt #include <sys/map.h>
     56  1.25  christos #include <sys/conf.h>
     57  1.11   deraadt 
     58   1.1       cgd #include <sys/file.h>
     59  1.12   mycroft #if defined(sparc) && BSD < 199103
     60  1.12   mycroft #include <sys/stream.h>
     61  1.12   mycroft #endif
     62   1.1       cgd #include <sys/tty.h>
     63   1.1       cgd #include <sys/uio.h>
     64  1.11   deraadt 
     65   1.1       cgd #include <sys/protosw.h>
     66   1.1       cgd #include <sys/socket.h>
     67  1.30   mycroft #include <sys/errno.h>
     68  1.30   mycroft #include <sys/kernel.h>
     69  1.30   mycroft #include <sys/poll.h>
     70  1.30   mycroft 
     71  1.11   deraadt #include <net/if.h>
     72   1.8   mycroft 
     73   1.1       cgd #include <net/bpf.h>
     74   1.1       cgd #include <net/bpfdesc.h>
     75   1.1       cgd 
     76  1.35    scottr #include <net/if_arc.h>
     77  1.34        is #include <net/if_ether.h>
     78  1.34        is 
     79  1.12   mycroft #include <netinet/in.h>
     80  1.34        is #include <netinet/if_inarp.h>
     81  1.11   deraadt 
     82  1.12   mycroft /*
     83  1.12   mycroft  * Older BSDs don't have kernel malloc.
     84  1.12   mycroft  */
     85  1.12   mycroft #if BSD < 199103
     86  1.12   mycroft extern bcopy();
     87  1.12   mycroft static caddr_t bpf_alloc();
     88  1.12   mycroft #include <net/bpf_compat.h>
     89  1.12   mycroft #define BPF_BUFSIZE (MCLBYTES-8)
     90  1.12   mycroft #define UIOMOVE(cp, len, code, uio) uiomove(cp, len, code, uio)
     91  1.12   mycroft #else
     92  1.12   mycroft #define BPF_BUFSIZE 4096
     93  1.12   mycroft #define UIOMOVE(cp, len, code, uio) uiomove(cp, len, uio)
     94  1.12   mycroft #endif
     95   1.1       cgd 
     96  1.12   mycroft #define PRINET  26			/* interruptible */
     97   1.2       cgd 
     98   1.1       cgd /*
     99   1.1       cgd  * The default read buffer size is patchable.
    100   1.1       cgd  */
    101   1.2       cgd int bpf_bufsize = BPF_BUFSIZE;
    102   1.1       cgd 
    103   1.1       cgd /*
    104   1.1       cgd  *  bpf_iflist is the list of interfaces; each corresponds to an ifnet
    105   1.1       cgd  *  bpf_dtab holds the descriptors, indexed by minor device #
    106   1.1       cgd  */
    107  1.12   mycroft struct bpf_if	*bpf_iflist;
    108   1.2       cgd struct bpf_d	bpf_dtab[NBPFILTER];
    109   1.1       cgd 
    110  1.12   mycroft #if BSD >= 199207 || NetBSD0_9 >= 2
    111  1.12   mycroft /*
    112  1.12   mycroft  * bpfilterattach() is called at boot time in new systems.  We do
    113  1.12   mycroft  * nothing here since old systems will not call this.
    114  1.12   mycroft  */
    115  1.12   mycroft /* ARGSUSED */
    116   1.6   deraadt void
    117   1.6   deraadt bpfilterattach(n)
    118   1.6   deraadt 	int n;
    119   1.6   deraadt {
    120   1.6   deraadt }
    121  1.12   mycroft #endif
    122  1.12   mycroft 
    123  1.12   mycroft static int	bpf_allocbufs __P((struct bpf_d *));
    124  1.12   mycroft static int	bpf_allocbufs __P((struct bpf_d *));
    125  1.12   mycroft static void	bpf_freed __P((struct bpf_d *));
    126  1.12   mycroft static void	bpf_freed __P((struct bpf_d *));
    127  1.12   mycroft static void	bpf_ifname __P((struct ifnet *, struct ifreq *));
    128  1.12   mycroft static void	bpf_ifname __P((struct ifnet *, struct ifreq *));
    129  1.19       cgd static void	bpf_mcopy __P((const void *, void *, size_t));
    130  1.36  christos static int	bpf_movein __P((struct uio *, int, int,
    131  1.24  christos 			        struct mbuf **, struct sockaddr *));
    132  1.24  christos static void	bpf_attachd __P((struct bpf_d *, struct bpf_if *));
    133  1.24  christos static void	bpf_detachd __P((struct bpf_d *));
    134  1.12   mycroft static int	bpf_setif __P((struct bpf_d *, struct ifreq *));
    135  1.30   mycroft int		bpfpoll __P((dev_t, int, struct proc *));
    136  1.15       cgd static __inline void
    137  1.12   mycroft 		bpf_wakeup __P((struct bpf_d *));
    138  1.36  christos static void	catchpacket __P((struct bpf_d *, u_char *, u_int, u_int,
    139  1.24  christos 				 void (*)(const void *, void *, size_t)));
    140  1.12   mycroft static void	reset_d __P((struct bpf_d *));
    141  1.12   mycroft 
    142  1.12   mycroft static int
    143  1.36  christos bpf_movein(uio, linktype, mtu, mp, sockp)
    144  1.12   mycroft 	register struct uio *uio;
    145  1.20   mycroft 	int linktype;
    146  1.36  christos 	int mtu;
    147  1.12   mycroft 	register struct mbuf **mp;
    148  1.12   mycroft 	register struct sockaddr *sockp;
    149  1.12   mycroft {
    150  1.12   mycroft 	struct mbuf *m;
    151  1.12   mycroft 	int error;
    152  1.12   mycroft 	int len;
    153  1.12   mycroft 	int hlen;
    154  1.36  christos 	int align;
    155  1.12   mycroft 
    156  1.12   mycroft 	/*
    157  1.12   mycroft 	 * Build a sockaddr based on the data link layer type.
    158  1.12   mycroft 	 * We do this at this level because the ethernet header
    159  1.12   mycroft 	 * is copied directly into the data field of the sockaddr.
    160  1.12   mycroft 	 * In the case of SLIP, there is no header and the packet
    161  1.12   mycroft 	 * is forwarded as is.
    162  1.12   mycroft 	 * Also, we are careful to leave room at the front of the mbuf
    163  1.12   mycroft 	 * for the link level header.
    164  1.12   mycroft 	 */
    165  1.12   mycroft 	switch (linktype) {
    166  1.12   mycroft 
    167  1.12   mycroft 	case DLT_SLIP:
    168  1.12   mycroft 		sockp->sa_family = AF_INET;
    169  1.12   mycroft 		hlen = 0;
    170  1.36  christos 		align = 0;
    171  1.12   mycroft 		break;
    172  1.12   mycroft 
    173  1.12   mycroft 	case DLT_PPP:
    174  1.12   mycroft 		sockp->sa_family = AF_UNSPEC;
    175  1.12   mycroft 		hlen = 0;
    176  1.36  christos 		align = 0;
    177  1.12   mycroft 		break;
    178  1.12   mycroft 
    179  1.12   mycroft 	case DLT_EN10MB:
    180  1.12   mycroft 		sockp->sa_family = AF_UNSPEC;
    181  1.12   mycroft 		/* XXX Would MAXLINKHDR be better? */
    182  1.36  christos  		/* 6(dst)+6(src)+2(type) */
    183  1.12   mycroft 		hlen = sizeof(struct ether_header);
    184  1.36  christos 		align = 2;
    185  1.17     glass 		break;
    186  1.17     glass 
    187  1.17     glass 	case DLT_ARCNET:
    188  1.17     glass 		sockp->sa_family = AF_UNSPEC;
    189  1.17     glass 		hlen = ARC_HDRLEN;
    190  1.36  christos 		align = 5;
    191  1.12   mycroft 		break;
    192  1.12   mycroft 
    193  1.12   mycroft 	case DLT_FDDI:
    194  1.12   mycroft 		sockp->sa_family = AF_UNSPEC;
    195  1.12   mycroft 		/* XXX 4(FORMAC)+6(dst)+6(src)+3(LLC)+5(SNAP) */
    196  1.12   mycroft 		hlen = 24;
    197  1.36  christos 		align = 0;
    198  1.12   mycroft 		break;
    199  1.12   mycroft 
    200  1.12   mycroft 	case DLT_NULL:
    201  1.12   mycroft 		sockp->sa_family = AF_UNSPEC;
    202  1.12   mycroft 		hlen = 0;
    203  1.36  christos 		align = 0;
    204  1.12   mycroft 		break;
    205  1.12   mycroft 
    206  1.12   mycroft 	default:
    207  1.12   mycroft 		return (EIO);
    208  1.12   mycroft 	}
    209  1.12   mycroft 
    210  1.12   mycroft 	len = uio->uio_resid;
    211  1.36  christos 	/*
    212  1.36  christos 	 * If there aren't enough bytes for a link level header or the
    213  1.36  christos 	 * packet length exceeds the interface mtu, return an error.
    214  1.36  christos 	 */
    215  1.36  christos 	if (len < hlen || len - hlen > mtu)
    216  1.36  christos 		return (EMSGSIZE);
    217  1.36  christos 
    218  1.36  christos 	/*
    219  1.36  christos 	 * XXX Avoid complicated buffer chaining ---
    220  1.36  christos 	 * bail if it won't fit in a single mbuf.
    221  1.36  christos 	 * (Take into account possible alignment bytes)
    222  1.36  christos 	 */
    223  1.36  christos 	if ((unsigned)len > MCLBYTES - align)
    224  1.12   mycroft 		return (EIO);
    225  1.12   mycroft 
    226  1.20   mycroft 	MGETHDR(m, M_WAIT, MT_DATA);
    227  1.36  christos 	if (m == 0)
    228  1.36  christos 		return (ENOBUFS);
    229  1.20   mycroft 	m->m_pkthdr.rcvif = 0;
    230  1.20   mycroft 	m->m_pkthdr.len = len - hlen;
    231  1.36  christos 	if (len > MHLEN - align) {
    232  1.12   mycroft #if BSD >= 199103
    233  1.12   mycroft 		MCLGET(m, M_WAIT);
    234  1.12   mycroft 		if ((m->m_flags & M_EXT) == 0) {
    235  1.12   mycroft #else
    236  1.12   mycroft 		MCLGET(m);
    237  1.12   mycroft 		if (m->m_len != MCLBYTES) {
    238  1.12   mycroft #endif
    239  1.12   mycroft 			error = ENOBUFS;
    240  1.12   mycroft 			goto bad;
    241  1.12   mycroft 		}
    242  1.12   mycroft 	}
    243  1.36  christos 
    244  1.36  christos 	/* Insure the data is properly aligned */
    245  1.36  christos 	if (align > 0) {
    246  1.36  christos #if BSD >= 199103
    247  1.36  christos 		m->m_data += align;
    248  1.36  christos #else
    249  1.36  christos 		m->m_off += align;
    250  1.36  christos #endif
    251  1.36  christos 		m->m_len -= align;
    252  1.36  christos 	}
    253  1.36  christos 
    254  1.36  christos 	error = UIOMOVE(mtod(m, caddr_t), len, UIO_WRITE, uio);
    255  1.36  christos 	if (error)
    256  1.36  christos 		goto bad;
    257  1.12   mycroft 	if (hlen != 0) {
    258  1.36  christos 		bcopy(mtod(m, caddr_t), sockp->sa_data, hlen);
    259  1.12   mycroft #if BSD >= 199103
    260  1.12   mycroft 		m->m_data += hlen; /* XXX */
    261  1.12   mycroft #else
    262  1.12   mycroft 		m->m_off += hlen;
    263  1.12   mycroft #endif
    264  1.36  christos 		len -= hlen;
    265  1.12   mycroft 	}
    266  1.36  christos 	m->m_len = len;
    267  1.36  christos 	*mp = m;
    268  1.12   mycroft  bad:
    269  1.12   mycroft 	m_freem(m);
    270  1.12   mycroft 	return (error);
    271  1.12   mycroft }
    272   1.1       cgd 
    273   1.1       cgd /*
    274   1.2       cgd  * Attach file to the bpf interface, i.e. make d listen on bp.
    275   1.1       cgd  * Must be called at splimp.
    276   1.1       cgd  */
    277   1.1       cgd static void
    278   1.1       cgd bpf_attachd(d, bp)
    279   1.1       cgd 	struct bpf_d *d;
    280   1.1       cgd 	struct bpf_if *bp;
    281   1.1       cgd {
    282   1.2       cgd 	/*
    283   1.2       cgd 	 * Point d at bp, and add d to the interface's list of listeners.
    284   1.2       cgd 	 * Finally, point the driver's bpf cookie at the interface so
    285   1.2       cgd 	 * it will divert packets to bpf.
    286   1.2       cgd 	 */
    287   1.1       cgd 	d->bd_bif = bp;
    288   1.1       cgd 	d->bd_next = bp->bif_dlist;
    289   1.1       cgd 	bp->bif_dlist = d;
    290   1.1       cgd 
    291   1.1       cgd 	*bp->bif_driverp = bp;
    292   1.1       cgd }
    293   1.1       cgd 
    294   1.2       cgd /*
    295   1.2       cgd  * Detach a file from its interface.
    296   1.2       cgd  */
    297   1.1       cgd static void
    298   1.1       cgd bpf_detachd(d)
    299   1.1       cgd 	struct bpf_d *d;
    300   1.1       cgd {
    301   1.1       cgd 	struct bpf_d **p;
    302   1.1       cgd 	struct bpf_if *bp;
    303   1.1       cgd 
    304   1.1       cgd 	bp = d->bd_bif;
    305   1.1       cgd 	/*
    306   1.1       cgd 	 * Check if this descriptor had requested promiscuous mode.
    307   1.1       cgd 	 * If so, turn it off.
    308   1.1       cgd 	 */
    309   1.1       cgd 	if (d->bd_promisc) {
    310  1.18   mycroft 		int error;
    311  1.18   mycroft 
    312   1.1       cgd 		d->bd_promisc = 0;
    313  1.36  christos 		/*
    314  1.36  christos 		 * Take device out of promiscuous mode.  Since we were
    315  1.36  christos 		 * able to enter promiscuous mode, we should be able
    316  1.36  christos 		 * to turn it off.  But we can get an error if
    317  1.36  christos 		 * the interface was configured down, so only panic
    318  1.36  christos 		 * if we don't get an unexpected error.
    319  1.36  christos 		 */
    320  1.36  christos   		error = ifpromisc(bp->bif_ifp, 0);
    321  1.18   mycroft 		if (error && error != EINVAL)
    322   1.2       cgd 			panic("bpf: ifpromisc failed");
    323   1.1       cgd 	}
    324   1.2       cgd 	/* Remove d from the interface's descriptor list. */
    325   1.1       cgd 	p = &bp->bif_dlist;
    326   1.1       cgd 	while (*p != d) {
    327   1.1       cgd 		p = &(*p)->bd_next;
    328   1.1       cgd 		if (*p == 0)
    329   1.1       cgd 			panic("bpf_detachd: descriptor not in list");
    330   1.1       cgd 	}
    331   1.1       cgd 	*p = (*p)->bd_next;
    332   1.1       cgd 	if (bp->bif_dlist == 0)
    333   1.1       cgd 		/*
    334   1.1       cgd 		 * Let the driver know that there are no more listeners.
    335   1.1       cgd 		 */
    336   1.1       cgd 		*d->bd_bif->bif_driverp = 0;
    337   1.1       cgd 	d->bd_bif = 0;
    338   1.1       cgd }
    339   1.1       cgd 
    340   1.1       cgd 
    341   1.1       cgd /*
    342  1.12   mycroft  * Mark a descriptor free by making it point to itself.
    343   1.1       cgd  * This is probably cheaper than marking with a constant since
    344   1.1       cgd  * the address should be in a register anyway.
    345   1.1       cgd  */
    346   1.1       cgd #define D_ISFREE(d) ((d) == (d)->bd_next)
    347   1.1       cgd #define D_MARKFREE(d) ((d)->bd_next = (d))
    348   1.1       cgd #define D_MARKUSED(d) ((d)->bd_next = 0)
    349   1.1       cgd 
    350   1.1       cgd /*
    351   1.2       cgd  * Open ethernet device.  Returns ENXIO for illegal minor device number,
    352   1.2       cgd  * EBUSY if file is open by another process.
    353   1.1       cgd  */
    354   1.1       cgd /* ARGSUSED */
    355   1.1       cgd int
    356  1.24  christos bpfopen(dev, flag, mode, p)
    357   1.1       cgd 	dev_t dev;
    358   1.1       cgd 	int flag;
    359  1.24  christos 	int mode;
    360  1.24  christos 	struct proc *p;
    361   1.1       cgd {
    362   1.1       cgd 	register struct bpf_d *d;
    363  1.12   mycroft 
    364   1.1       cgd 	if (minor(dev) >= NBPFILTER)
    365   1.1       cgd 		return (ENXIO);
    366   1.1       cgd 	/*
    367   1.1       cgd 	 * Each minor can be opened by only one process.  If the requested
    368   1.1       cgd 	 * minor is in use, return EBUSY.
    369   1.1       cgd 	 */
    370   1.1       cgd 	d = &bpf_dtab[minor(dev)];
    371   1.2       cgd 	if (!D_ISFREE(d))
    372   1.1       cgd 		return (EBUSY);
    373   1.2       cgd 
    374   1.2       cgd 	/* Mark "free" and do most initialization. */
    375   1.2       cgd 	bzero((char *)d, sizeof(*d));
    376   1.2       cgd 	d->bd_bufsize = bpf_bufsize;
    377   1.1       cgd 
    378   1.1       cgd 	return (0);
    379   1.1       cgd }
    380   1.1       cgd 
    381   1.1       cgd /*
    382   1.1       cgd  * Close the descriptor by detaching it from its interface,
    383   1.1       cgd  * deallocating its buffers, and marking it free.
    384   1.1       cgd  */
    385   1.1       cgd /* ARGSUSED */
    386   1.2       cgd int
    387  1.24  christos bpfclose(dev, flag, mode, p)
    388   1.1       cgd 	dev_t dev;
    389   1.1       cgd 	int flag;
    390  1.24  christos 	int mode;
    391  1.24  christos 	struct proc *p;
    392   1.1       cgd {
    393   1.1       cgd 	register struct bpf_d *d = &bpf_dtab[minor(dev)];
    394   1.2       cgd 	register int s;
    395   1.1       cgd 
    396   1.1       cgd 	s = splimp();
    397   1.1       cgd 	if (d->bd_bif)
    398   1.1       cgd 		bpf_detachd(d);
    399   1.1       cgd 	splx(s);
    400   1.2       cgd 	bpf_freed(d);
    401   1.2       cgd 
    402   1.2       cgd 	return (0);
    403   1.2       cgd }
    404   1.2       cgd 
    405   1.2       cgd /*
    406  1.12   mycroft  * Support for SunOS, which does not have tsleep.
    407  1.12   mycroft  */
    408  1.12   mycroft #if BSD < 199103
    409  1.12   mycroft static
    410  1.12   mycroft bpf_timeout(arg)
    411  1.12   mycroft 	caddr_t arg;
    412  1.12   mycroft {
    413  1.12   mycroft 	struct bpf_d *d = (struct bpf_d *)arg;
    414  1.12   mycroft 	d->bd_timedout = 1;
    415  1.12   mycroft 	wakeup(arg);
    416  1.12   mycroft }
    417  1.12   mycroft 
    418  1.12   mycroft #define BPF_SLEEP(chan, pri, s, t) bpf_sleep((struct bpf_d *)chan)
    419  1.12   mycroft 
    420  1.12   mycroft int
    421  1.12   mycroft bpf_sleep(d)
    422  1.12   mycroft 	register struct bpf_d *d;
    423  1.12   mycroft {
    424  1.12   mycroft 	register int rto = d->bd_rtout;
    425  1.12   mycroft 	register int st;
    426  1.12   mycroft 
    427  1.12   mycroft 	if (rto != 0) {
    428  1.12   mycroft 		d->bd_timedout = 0;
    429  1.12   mycroft 		timeout(bpf_timeout, (caddr_t)d, rto);
    430  1.12   mycroft 	}
    431  1.12   mycroft 	st = sleep((caddr_t)d, PRINET|PCATCH);
    432  1.12   mycroft 	if (rto != 0) {
    433  1.12   mycroft 		if (d->bd_timedout == 0)
    434  1.12   mycroft 			untimeout(bpf_timeout, (caddr_t)d);
    435  1.12   mycroft 		else if (st == 0)
    436  1.12   mycroft 			return EWOULDBLOCK;
    437  1.12   mycroft 	}
    438  1.12   mycroft 	return (st != 0) ? EINTR : 0;
    439  1.12   mycroft }
    440  1.12   mycroft #else
    441  1.12   mycroft #define BPF_SLEEP tsleep
    442  1.12   mycroft #endif
    443  1.12   mycroft 
    444  1.12   mycroft /*
    445   1.1       cgd  * Rotate the packet buffers in descriptor d.  Move the store buffer
    446  1.12   mycroft  * into the hold slot, and the free buffer into the store slot.
    447   1.1       cgd  * Zero the length of the new store buffer.
    448   1.1       cgd  */
    449   1.1       cgd #define ROTATE_BUFFERS(d) \
    450   1.1       cgd 	(d)->bd_hbuf = (d)->bd_sbuf; \
    451   1.1       cgd 	(d)->bd_hlen = (d)->bd_slen; \
    452   1.1       cgd 	(d)->bd_sbuf = (d)->bd_fbuf; \
    453   1.1       cgd 	(d)->bd_slen = 0; \
    454  1.12   mycroft 	(d)->bd_fbuf = 0;
    455   1.1       cgd /*
    456   1.1       cgd  *  bpfread - read next chunk of packets from buffers
    457   1.1       cgd  */
    458   1.1       cgd int
    459  1.24  christos bpfread(dev, uio, ioflag)
    460   1.1       cgd 	dev_t dev;
    461   1.1       cgd 	register struct uio *uio;
    462  1.24  christos 	int ioflag;
    463   1.1       cgd {
    464   1.1       cgd 	register struct bpf_d *d = &bpf_dtab[minor(dev)];
    465   1.1       cgd 	int error;
    466   1.1       cgd 	int s;
    467   1.1       cgd 
    468   1.1       cgd 	/*
    469  1.12   mycroft 	 * Restrict application to use a buffer the same size as
    470   1.1       cgd 	 * as kernel buffers.
    471   1.1       cgd 	 */
    472   1.1       cgd 	if (uio->uio_resid != d->bd_bufsize)
    473   1.1       cgd 		return (EINVAL);
    474   1.1       cgd 
    475   1.1       cgd 	s = splimp();
    476   1.1       cgd 	/*
    477   1.2       cgd 	 * If the hold buffer is empty, then do a timed sleep, which
    478   1.2       cgd 	 * ends when the timeout expires or when enough packets
    479   1.2       cgd 	 * have arrived to fill the store buffer.
    480   1.1       cgd 	 */
    481   1.1       cgd 	while (d->bd_hbuf == 0) {
    482  1.36  christos 		if (d->bd_immediate) {
    483  1.36  christos 			if (d->bd_slen == 0) {
    484  1.36  christos 				splx(s);
    485  1.36  christos 				return (EWOULDBLOCK);
    486  1.36  christos 			}
    487   1.1       cgd 			/*
    488   1.1       cgd 			 * A packet(s) either arrived since the previous
    489   1.1       cgd 			 * read or arrived while we were asleep.
    490   1.1       cgd 			 * Rotate the buffers and return what's here.
    491   1.1       cgd 			 */
    492   1.1       cgd 			ROTATE_BUFFERS(d);
    493   1.1       cgd 			break;
    494   1.1       cgd 		}
    495  1.23   thorpej 		if (d->bd_rtout != -1)
    496  1.23   thorpej 			error = BPF_SLEEP((caddr_t)d, PRINET|PCATCH, "bpf",
    497  1.23   thorpej 					  d->bd_rtout);
    498  1.23   thorpej 		else
    499  1.23   thorpej 			error = EWOULDBLOCK; /* User requested non-blocking I/O */
    500  1.12   mycroft 		if (error == EINTR || error == ERESTART) {
    501  1.12   mycroft 			splx(s);
    502  1.12   mycroft 			return (error);
    503  1.12   mycroft 		}
    504  1.12   mycroft 		if (error == EWOULDBLOCK) {
    505  1.12   mycroft 			/*
    506  1.12   mycroft 			 * On a timeout, return what's in the buffer,
    507  1.12   mycroft 			 * which may be nothing.  If there is something
    508  1.12   mycroft 			 * in the store buffer, we can rotate the buffers.
    509  1.12   mycroft 			 */
    510  1.12   mycroft 			if (d->bd_hbuf)
    511   1.1       cgd 				/*
    512  1.12   mycroft 				 * We filled up the buffer in between
    513  1.12   mycroft 				 * getting the timeout and arriving
    514  1.12   mycroft 				 * here, so we don't need to rotate.
    515   1.1       cgd 				 */
    516   1.1       cgd 				break;
    517  1.12   mycroft 
    518  1.12   mycroft 			if (d->bd_slen == 0) {
    519  1.12   mycroft 				splx(s);
    520  1.12   mycroft 				return (0);
    521   1.1       cgd 			}
    522  1.12   mycroft 			ROTATE_BUFFERS(d);
    523  1.12   mycroft 			break;
    524   1.1       cgd 		}
    525  1.36  christos 		if (error != 0)
    526  1.36  christos 			goto done;
    527   1.1       cgd 	}
    528   1.1       cgd 	/*
    529   1.1       cgd 	 * At this point, we know we have something in the hold slot.
    530   1.1       cgd 	 */
    531   1.1       cgd 	splx(s);
    532  1.12   mycroft 
    533  1.12   mycroft 	/*
    534   1.1       cgd 	 * Move data from hold buffer into user space.
    535   1.1       cgd 	 * We know the entire buffer is transferred since
    536   1.1       cgd 	 * we checked above that the read buffer is bpf_bufsize bytes.
    537   1.1       cgd 	 */
    538  1.12   mycroft 	error = UIOMOVE(d->bd_hbuf, d->bd_hlen, UIO_READ, uio);
    539   1.1       cgd 
    540   1.1       cgd 	s = splimp();
    541   1.1       cgd 	d->bd_fbuf = d->bd_hbuf;
    542   1.1       cgd 	d->bd_hbuf = 0;
    543   1.2       cgd 	d->bd_hlen = 0;
    544  1.36  christos done:
    545   1.1       cgd 	splx(s);
    546   1.1       cgd 	return (error);
    547   1.1       cgd }
    548   1.1       cgd 
    549   1.1       cgd 
    550   1.1       cgd /*
    551  1.12   mycroft  * If there are processes sleeping on this descriptor, wake them up.
    552   1.1       cgd  */
    553  1.15       cgd static __inline void
    554   1.1       cgd bpf_wakeup(d)
    555   1.1       cgd 	register struct bpf_d *d;
    556   1.1       cgd {
    557  1.23   thorpej 	struct proc *p;
    558  1.23   thorpej 
    559   1.1       cgd 	wakeup((caddr_t)d);
    560  1.37  christos 	if (d->bd_async)
    561  1.23   thorpej 		if (d->bd_pgid > 0)
    562  1.37  christos 			gsignal (d->bd_pgid, SIGIO);
    563  1.24  christos 		else if ((p = pfind (-d->bd_pgid)) != NULL)
    564  1.37  christos 			psignal (p, SIGIO);
    565  1.23   thorpej 
    566  1.12   mycroft #if BSD >= 199103
    567   1.2       cgd 	selwakeup(&d->bd_sel);
    568   1.2       cgd 	/* XXX */
    569   1.2       cgd 	d->bd_sel.si_pid = 0;
    570   1.2       cgd #else
    571   1.1       cgd 	if (d->bd_selproc) {
    572   1.1       cgd 		selwakeup(d->bd_selproc, (int)d->bd_selcoll);
    573   1.1       cgd 		d->bd_selcoll = 0;
    574   1.1       cgd 		d->bd_selproc = 0;
    575   1.1       cgd 	}
    576   1.2       cgd #endif
    577   1.1       cgd }
    578   1.1       cgd 
    579   1.1       cgd int
    580  1.24  christos bpfwrite(dev, uio, ioflag)
    581   1.1       cgd 	dev_t dev;
    582   1.1       cgd 	struct uio *uio;
    583  1.24  christos 	int ioflag;
    584   1.1       cgd {
    585  1.12   mycroft 	register struct bpf_d *d = &bpf_dtab[minor(dev)];
    586  1.12   mycroft 	struct ifnet *ifp;
    587  1.12   mycroft 	struct mbuf *m;
    588  1.12   mycroft 	int error, s;
    589  1.12   mycroft 	static struct sockaddr dst;
    590   1.1       cgd 
    591  1.12   mycroft 	if (d->bd_bif == 0)
    592   1.1       cgd 		return (ENXIO);
    593   1.1       cgd 
    594  1.12   mycroft 	ifp = d->bd_bif->bif_ifp;
    595  1.11   deraadt 
    596  1.12   mycroft 	if (uio->uio_resid == 0)
    597  1.12   mycroft 		return (0);
    598  1.11   deraadt 
    599  1.36  christos 	error = bpf_movein(uio, (int)d->bd_bif->bif_dlt, ifp->if_mtu, &m, &dst);
    600  1.12   mycroft 	if (error)
    601  1.12   mycroft 		return (error);
    602  1.11   deraadt 
    603  1.20   mycroft 	if (m->m_pkthdr.len > ifp->if_mtu)
    604   1.1       cgd 		return (EMSGSIZE);
    605   1.1       cgd 
    606  1.21   mycroft 	s = splsoftnet();
    607  1.12   mycroft #if BSD >= 199103
    608   1.2       cgd 	error = (*ifp->if_output)(ifp, m, &dst, (struct rtentry *)0);
    609  1.12   mycroft #else
    610  1.12   mycroft 	error = (*ifp->if_output)(ifp, m, &dst);
    611  1.12   mycroft #endif
    612   1.1       cgd 	splx(s);
    613   1.1       cgd 	/*
    614  1.12   mycroft 	 * The driver frees the mbuf.
    615   1.1       cgd 	 */
    616   1.1       cgd 	return (error);
    617   1.1       cgd }
    618   1.1       cgd 
    619   1.1       cgd /*
    620   1.2       cgd  * Reset a descriptor by flushing its packet buffer and clearing the
    621   1.2       cgd  * receive and drop counts.  Should be called at splimp.
    622   1.1       cgd  */
    623   1.1       cgd static void
    624   1.1       cgd reset_d(d)
    625   1.1       cgd 	struct bpf_d *d;
    626   1.1       cgd {
    627   1.1       cgd 	if (d->bd_hbuf) {
    628   1.1       cgd 		/* Free the hold buffer. */
    629   1.1       cgd 		d->bd_fbuf = d->bd_hbuf;
    630   1.1       cgd 		d->bd_hbuf = 0;
    631   1.1       cgd 	}
    632   1.1       cgd 	d->bd_slen = 0;
    633   1.2       cgd 	d->bd_hlen = 0;
    634   1.1       cgd 	d->bd_rcount = 0;
    635   1.1       cgd 	d->bd_dcount = 0;
    636   1.1       cgd }
    637   1.1       cgd 
    638  1.36  christos #ifdef BPF_KERN_FILTER
    639  1.36  christos extern struct bpf_insn *bpf_tcp_filter;
    640  1.36  christos extern struct bpf_insn *bpf_udp_filter;
    641  1.36  christos #endif
    642  1.36  christos 
    643   1.1       cgd /*
    644   1.1       cgd  *  FIONREAD		Check for read packet available.
    645   1.1       cgd  *  BIOCGBLEN		Get buffer len [for read()].
    646   1.1       cgd  *  BIOCSETF		Set ethernet read filter.
    647   1.1       cgd  *  BIOCFLUSH		Flush read packet buffer.
    648   1.1       cgd  *  BIOCPROMISC		Put interface into promiscuous mode.
    649   1.1       cgd  *  BIOCGDLT		Get link layer type.
    650   1.1       cgd  *  BIOCGETIF		Get interface name.
    651   1.1       cgd  *  BIOCSETIF		Set interface.
    652   1.1       cgd  *  BIOCSRTIMEOUT	Set read timeout.
    653   1.1       cgd  *  BIOCGRTIMEOUT	Get read timeout.
    654   1.1       cgd  *  BIOCGSTATS		Get packet stats.
    655   1.1       cgd  *  BIOCIMMEDIATE	Set immediate mode.
    656   1.2       cgd  *  BIOCVERSION		Get filter language version.
    657   1.1       cgd  */
    658   1.1       cgd /* ARGSUSED */
    659   1.1       cgd int
    660  1.24  christos bpfioctl(dev, cmd, addr, flag, p)
    661   1.1       cgd 	dev_t dev;
    662  1.16       cgd 	u_long cmd;
    663   1.1       cgd 	caddr_t addr;
    664   1.1       cgd 	int flag;
    665  1.24  christos 	struct proc *p;
    666   1.1       cgd {
    667   1.1       cgd 	register struct bpf_d *d = &bpf_dtab[minor(dev)];
    668   1.1       cgd 	int s, error = 0;
    669  1.36  christos #ifdef BPF_KERN_FILTER
    670  1.36  christos 	register struct bpf_insn **p;
    671  1.36  christos #endif
    672   1.1       cgd 
    673   1.1       cgd 	switch (cmd) {
    674   1.1       cgd 
    675   1.1       cgd 	default:
    676   1.1       cgd 		error = EINVAL;
    677   1.1       cgd 		break;
    678   1.1       cgd 
    679   1.1       cgd 	/*
    680   1.1       cgd 	 * Check for read packet available.
    681   1.1       cgd 	 */
    682   1.1       cgd 	case FIONREAD:
    683   1.1       cgd 		{
    684   1.1       cgd 			int n;
    685  1.12   mycroft 
    686   1.1       cgd 			s = splimp();
    687   1.1       cgd 			n = d->bd_slen;
    688  1.12   mycroft 			if (d->bd_hbuf)
    689   1.1       cgd 				n += d->bd_hlen;
    690   1.1       cgd 			splx(s);
    691   1.1       cgd 
    692   1.1       cgd 			*(int *)addr = n;
    693   1.1       cgd 			break;
    694   1.1       cgd 		}
    695   1.1       cgd 
    696   1.1       cgd 	/*
    697   1.2       cgd 	 * Get buffer len [for read()].
    698   1.1       cgd 	 */
    699   1.2       cgd 	case BIOCGBLEN:
    700   1.2       cgd 		*(u_int *)addr = d->bd_bufsize;
    701   1.1       cgd 		break;
    702   1.2       cgd 
    703   1.1       cgd 	/*
    704   1.2       cgd 	 * Set buffer length.
    705   1.1       cgd 	 */
    706   1.2       cgd 	case BIOCSBLEN:
    707  1.12   mycroft #if BSD < 199103
    708  1.12   mycroft 		error = EINVAL;
    709  1.12   mycroft #else
    710   1.2       cgd 		if (d->bd_bif != 0)
    711   1.2       cgd 			error = EINVAL;
    712   1.2       cgd 		else {
    713   1.2       cgd 			register u_int size = *(u_int *)addr;
    714   1.2       cgd 
    715   1.2       cgd 			if (size > BPF_MAXBUFSIZE)
    716   1.2       cgd 				*(u_int *)addr = size = BPF_MAXBUFSIZE;
    717   1.2       cgd 			else if (size < BPF_MINBUFSIZE)
    718   1.2       cgd 				*(u_int *)addr = size = BPF_MINBUFSIZE;
    719   1.2       cgd 			d->bd_bufsize = size;
    720   1.2       cgd 		}
    721  1.12   mycroft #endif
    722   1.1       cgd 		break;
    723   1.1       cgd 
    724   1.1       cgd 	/*
    725   1.2       cgd 	 * Set link layer read filter.
    726   1.1       cgd 	 */
    727  1.12   mycroft 	case BIOCSETF:
    728   1.1       cgd 		error = bpf_setf(d, (struct bpf_program *)addr);
    729   1.1       cgd 		break;
    730   1.1       cgd 
    731  1.36  christos #ifdef BPF_KERN_FILTER
    732  1.36  christos 	/*
    733  1.36  christos 	 * Set TCP or UDP reject filter.
    734  1.36  christos 	 */
    735  1.36  christos 	case BIOCSTCPF:
    736  1.36  christos 	case BIOCSUDPF:
    737  1.36  christos 		if (!suser()) {
    738  1.36  christos 			error = EPERM;
    739  1.36  christos 			break;
    740  1.36  christos 		}
    741  1.36  christos 
    742  1.36  christos 		/* Validate and store filter */
    743  1.36  christos 		error = bpf_setf(d, (struct bpf_program *)addr);
    744  1.36  christos 
    745  1.36  christos 		/* Free possible old filter */
    746  1.36  christos 		if (cmd == BIOCSTCPF)
    747  1.36  christos 			p = &bpf_tcp_filter;
    748  1.36  christos 		else
    749  1.36  christos 			p = &bpf_udp_filter;
    750  1.36  christos 		if (*p != NULL)
    751  1.36  christos 			free((caddr_t)*p, M_DEVBUF);
    752  1.36  christos 
    753  1.36  christos 		/* Steal new filter (noop if error) */
    754  1.36  christos 		s = splimp();
    755  1.36  christos 		*p = d->bd_filter;
    756  1.36  christos 		d->bd_filter = NULL;
    757  1.36  christos 		splx(s);
    758  1.36  christos 		break;
    759  1.36  christos #endif
    760  1.36  christos 
    761   1.1       cgd 	/*
    762   1.1       cgd 	 * Flush read packet buffer.
    763   1.1       cgd 	 */
    764   1.1       cgd 	case BIOCFLUSH:
    765   1.1       cgd 		s = splimp();
    766   1.1       cgd 		reset_d(d);
    767   1.1       cgd 		splx(s);
    768   1.1       cgd 		break;
    769   1.1       cgd 
    770   1.1       cgd 	/*
    771   1.1       cgd 	 * Put interface into promiscuous mode.
    772   1.1       cgd 	 */
    773   1.1       cgd 	case BIOCPROMISC:
    774   1.1       cgd 		if (d->bd_bif == 0) {
    775   1.1       cgd 			/*
    776   1.1       cgd 			 * No interface attached yet.
    777   1.1       cgd 			 */
    778   1.1       cgd 			error = EINVAL;
    779   1.1       cgd 			break;
    780   1.1       cgd 		}
    781   1.1       cgd 		s = splimp();
    782   1.1       cgd 		if (d->bd_promisc == 0) {
    783   1.1       cgd 			error = ifpromisc(d->bd_bif->bif_ifp, 1);
    784   1.2       cgd 			if (error == 0)
    785   1.2       cgd 				d->bd_promisc = 1;
    786   1.1       cgd 		}
    787   1.1       cgd 		splx(s);
    788   1.1       cgd 		break;
    789   1.1       cgd 
    790   1.1       cgd 	/*
    791   1.1       cgd 	 * Get device parameters.
    792   1.1       cgd 	 */
    793   1.1       cgd 	case BIOCGDLT:
    794   1.1       cgd 		if (d->bd_bif == 0)
    795   1.1       cgd 			error = EINVAL;
    796   1.1       cgd 		else
    797   1.1       cgd 			*(u_int *)addr = d->bd_bif->bif_dlt;
    798   1.1       cgd 		break;
    799   1.1       cgd 
    800   1.1       cgd 	/*
    801   1.1       cgd 	 * Set interface name.
    802   1.1       cgd 	 */
    803   1.1       cgd 	case BIOCGETIF:
    804   1.1       cgd 		if (d->bd_bif == 0)
    805   1.1       cgd 			error = EINVAL;
    806   1.1       cgd 		else
    807   1.1       cgd 			bpf_ifname(d->bd_bif->bif_ifp, (struct ifreq *)addr);
    808   1.1       cgd 		break;
    809   1.1       cgd 
    810   1.1       cgd 	/*
    811   1.1       cgd 	 * Set interface.
    812   1.1       cgd 	 */
    813   1.1       cgd 	case BIOCSETIF:
    814   1.1       cgd 		error = bpf_setif(d, (struct ifreq *)addr);
    815   1.1       cgd 		break;
    816   1.1       cgd 
    817   1.1       cgd 	/*
    818   1.1       cgd 	 * Set read timeout.
    819   1.1       cgd 	 */
    820  1.12   mycroft 	case BIOCSRTIMEOUT:
    821   1.1       cgd 		{
    822   1.1       cgd 			struct timeval *tv = (struct timeval *)addr;
    823   1.1       cgd 
    824  1.19       cgd 			/* Compute number of ticks. */
    825  1.19       cgd 			d->bd_rtout = tv->tv_sec * hz + tv->tv_usec / tick;
    826  1.33   thorpej 			if ((d->bd_rtout == 0) && (tv->tv_usec != 0))
    827  1.33   thorpej 				d->bd_rtout = 1;
    828   1.1       cgd 			break;
    829   1.1       cgd 		}
    830   1.1       cgd 
    831   1.1       cgd 	/*
    832   1.1       cgd 	 * Get read timeout.
    833   1.1       cgd 	 */
    834  1.12   mycroft 	case BIOCGRTIMEOUT:
    835   1.1       cgd 		{
    836   1.1       cgd 			struct timeval *tv = (struct timeval *)addr;
    837   1.1       cgd 
    838  1.19       cgd 			tv->tv_sec = d->bd_rtout / hz;
    839  1.19       cgd 			tv->tv_usec = (d->bd_rtout % hz) * tick;
    840   1.1       cgd 			break;
    841   1.1       cgd 		}
    842   1.1       cgd 
    843   1.1       cgd 	/*
    844   1.1       cgd 	 * Get packet stats.
    845   1.1       cgd 	 */
    846   1.1       cgd 	case BIOCGSTATS:
    847   1.1       cgd 		{
    848   1.1       cgd 			struct bpf_stat *bs = (struct bpf_stat *)addr;
    849   1.1       cgd 
    850   1.1       cgd 			bs->bs_recv = d->bd_rcount;
    851   1.1       cgd 			bs->bs_drop = d->bd_dcount;
    852   1.1       cgd 			break;
    853   1.1       cgd 		}
    854   1.1       cgd 
    855   1.1       cgd 	/*
    856   1.1       cgd 	 * Set immediate mode.
    857   1.1       cgd 	 */
    858   1.1       cgd 	case BIOCIMMEDIATE:
    859   1.1       cgd 		d->bd_immediate = *(u_int *)addr;
    860   1.1       cgd 		break;
    861   1.2       cgd 
    862   1.2       cgd 	case BIOCVERSION:
    863   1.2       cgd 		{
    864   1.2       cgd 			struct bpf_version *bv = (struct bpf_version *)addr;
    865   1.2       cgd 
    866   1.2       cgd 			bv->bv_major = BPF_MAJOR_VERSION;
    867   1.2       cgd 			bv->bv_minor = BPF_MINOR_VERSION;
    868   1.2       cgd 			break;
    869  1.12   mycroft 		}
    870  1.23   thorpej 
    871  1.23   thorpej 
    872  1.23   thorpej 	case FIONBIO:		/* Non-blocking I/O */
    873  1.23   thorpej 		if (*(int *)addr)
    874  1.23   thorpej 			d->bd_rtout = -1;
    875  1.23   thorpej 		else
    876  1.23   thorpej 			d->bd_rtout = 0;
    877  1.23   thorpej 		break;
    878  1.23   thorpej 
    879  1.23   thorpej 	case FIOASYNC:		/* Send signal on receive packets */
    880  1.23   thorpej 		d->bd_async = *(int *)addr;
    881  1.23   thorpej 		break;
    882  1.23   thorpej 
    883  1.23   thorpej 	/*
    884  1.23   thorpej 	 * N.B.  ioctl (FIOSETOWN) and fcntl (F_SETOWN) both end up doing
    885  1.23   thorpej 	 * the equivalent of a TIOCSPGRP and hence end up here.  *However*
    886  1.23   thorpej 	 * TIOCSPGRP's arg is a process group if it's positive and a process
    887  1.23   thorpej 	 * id if it's negative.  This is exactly the opposite of what the
    888  1.23   thorpej 	 * other two functions want!  Therefore there is code in ioctl and
    889  1.23   thorpej 	 * fcntl to negate the arg before calling here.
    890  1.23   thorpej 	 */
    891  1.23   thorpej 	case TIOCSPGRP:		/* Process or group to send signals to */
    892  1.23   thorpej 		d->bd_pgid = *(int *)addr;
    893  1.23   thorpej 		break;
    894  1.23   thorpej 
    895  1.23   thorpej 	case TIOCGPGRP:
    896  1.23   thorpej 		*(int *)addr = d->bd_pgid;
    897  1.23   thorpej 		break;
    898   1.1       cgd 	}
    899   1.1       cgd 	return (error);
    900   1.1       cgd }
    901   1.1       cgd 
    902  1.12   mycroft /*
    903   1.2       cgd  * Set d's packet filter program to fp.  If this file already has a filter,
    904   1.1       cgd  * free it and replace it.  Returns EINVAL for bogus requests.
    905   1.1       cgd  */
    906   1.1       cgd int
    907   1.1       cgd bpf_setf(d, fp)
    908   1.1       cgd 	struct bpf_d *d;
    909   1.1       cgd 	struct bpf_program *fp;
    910   1.1       cgd {
    911   1.1       cgd 	struct bpf_insn *fcode, *old;
    912   1.1       cgd 	u_int flen, size;
    913   1.1       cgd 	int s;
    914   1.1       cgd 
    915   1.1       cgd 	old = d->bd_filter;
    916   1.1       cgd 	if (fp->bf_insns == 0) {
    917   1.1       cgd 		if (fp->bf_len != 0)
    918   1.1       cgd 			return (EINVAL);
    919   1.1       cgd 		s = splimp();
    920   1.1       cgd 		d->bd_filter = 0;
    921   1.1       cgd 		reset_d(d);
    922   1.1       cgd 		splx(s);
    923   1.1       cgd 		if (old != 0)
    924   1.1       cgd 			free((caddr_t)old, M_DEVBUF);
    925   1.1       cgd 		return (0);
    926   1.1       cgd 	}
    927   1.1       cgd 	flen = fp->bf_len;
    928   1.1       cgd 	if (flen > BPF_MAXINSNS)
    929   1.1       cgd 		return (EINVAL);
    930   1.1       cgd 
    931   1.1       cgd 	size = flen * sizeof(*fp->bf_insns);
    932   1.1       cgd 	fcode = (struct bpf_insn *)malloc(size, M_DEVBUF, M_WAITOK);
    933  1.36  christos 	if (fcode == 0)
    934  1.36  christos 		return (ENOMEM);
    935   1.2       cgd 	if (copyin((caddr_t)fp->bf_insns, (caddr_t)fcode, size) == 0 &&
    936   1.2       cgd 	    bpf_validate(fcode, (int)flen)) {
    937   1.1       cgd 		s = splimp();
    938   1.1       cgd 		d->bd_filter = fcode;
    939   1.1       cgd 		reset_d(d);
    940   1.1       cgd 		splx(s);
    941   1.1       cgd 		if (old != 0)
    942   1.1       cgd 			free((caddr_t)old, M_DEVBUF);
    943   1.1       cgd 
    944   1.1       cgd 		return (0);
    945   1.1       cgd 	}
    946   1.1       cgd 	free((caddr_t)fcode, M_DEVBUF);
    947   1.1       cgd 	return (EINVAL);
    948   1.1       cgd }
    949   1.1       cgd 
    950   1.1       cgd /*
    951   1.2       cgd  * Detach a file from its current interface (if attached at all) and attach
    952   1.2       cgd  * to the interface indicated by the name stored in ifr.
    953   1.2       cgd  * Return an errno or 0.
    954   1.1       cgd  */
    955   1.1       cgd static int
    956   1.1       cgd bpf_setif(d, ifr)
    957   1.1       cgd 	struct bpf_d *d;
    958   1.1       cgd 	struct ifreq *ifr;
    959   1.1       cgd {
    960   1.1       cgd 	struct bpf_if *bp;
    961   1.1       cgd 	char *cp;
    962  1.26   thorpej 	int unit_seen, i, s, error;
    963   1.1       cgd 
    964   1.1       cgd 	/*
    965  1.26   thorpej 	 * Make sure the provided name has a unit number, and default
    966  1.26   thorpej 	 * it to '0' if not specified.
    967  1.26   thorpej 	 * XXX This is ugly ... do this differently?
    968   1.1       cgd 	 */
    969  1.26   thorpej 	unit_seen = 0;
    970   1.1       cgd 	cp = ifr->ifr_name;
    971  1.26   thorpej 	cp[sizeof(ifr->ifr_name) - 1] = '\0';	/* sanity */
    972  1.26   thorpej 	while (*cp++)
    973  1.26   thorpej 		if (*cp >= '0' && *cp <= '9')
    974  1.26   thorpej 			unit_seen = 1;
    975  1.26   thorpej 	if (!unit_seen) {
    976  1.26   thorpej 		/* Make sure to leave room for the '\0'. */
    977  1.26   thorpej 		for (i = 0; i < (IFNAMSIZ - 1); ++i) {
    978  1.26   thorpej 			if ((ifr->ifr_name[i] >= 'a' &&
    979  1.26   thorpej 			     ifr->ifr_name[i] <= 'z') ||
    980  1.26   thorpej 			    (ifr->ifr_name[i] >= 'A' &&
    981  1.26   thorpej 			     ifr->ifr_name[i] <= 'Z'))
    982  1.26   thorpej 				continue;
    983  1.26   thorpej 			ifr->ifr_name[i] = '0';
    984   1.1       cgd 		}
    985   1.1       cgd 	}
    986  1.26   thorpej 
    987   1.1       cgd 	/*
    988   1.1       cgd 	 * Look through attached interfaces for the named one.
    989   1.1       cgd 	 */
    990   1.1       cgd 	for (bp = bpf_iflist; bp != 0; bp = bp->bif_next) {
    991   1.1       cgd 		struct ifnet *ifp = bp->bif_ifp;
    992   1.1       cgd 
    993  1.26   thorpej 		if (ifp == 0 ||
    994  1.26   thorpej 		    strcmp(ifp->if_xname, ifr->ifr_name) != 0)
    995   1.1       cgd 			continue;
    996   1.1       cgd 		/*
    997   1.2       cgd 		 * We found the requested interface.
    998   1.1       cgd 		 * If it's not up, return an error.
    999   1.2       cgd 		 * Allocate the packet buffers if we need to.
   1000   1.2       cgd 		 * If we're already attached to requested interface,
   1001   1.2       cgd 		 * just flush the buffer.
   1002   1.1       cgd 		 */
   1003   1.1       cgd 		if ((ifp->if_flags & IFF_UP) == 0)
   1004   1.1       cgd 			return (ENETDOWN);
   1005   1.2       cgd 
   1006   1.2       cgd 		if (d->bd_sbuf == 0) {
   1007   1.2       cgd 			error = bpf_allocbufs(d);
   1008   1.2       cgd 			if (error != 0)
   1009   1.2       cgd 				return (error);
   1010   1.2       cgd 		}
   1011   1.1       cgd 		s = splimp();
   1012   1.1       cgd 		if (bp != d->bd_bif) {
   1013   1.1       cgd 			if (d->bd_bif)
   1014  1.12   mycroft 				/*
   1015   1.1       cgd 				 * Detach if attached to something else.
   1016   1.1       cgd 				 */
   1017   1.1       cgd 				bpf_detachd(d);
   1018   1.1       cgd 
   1019   1.1       cgd 			bpf_attachd(d, bp);
   1020   1.1       cgd 		}
   1021   1.1       cgd 		reset_d(d);
   1022   1.1       cgd 		splx(s);
   1023   1.1       cgd 		return (0);
   1024   1.1       cgd 	}
   1025   1.1       cgd 	/* Not found. */
   1026   1.1       cgd 	return (ENXIO);
   1027   1.1       cgd }
   1028   1.1       cgd 
   1029   1.1       cgd /*
   1030  1.26   thorpej  * Copy the interface name to the ifreq.
   1031   1.1       cgd  */
   1032   1.1       cgd static void
   1033   1.1       cgd bpf_ifname(ifp, ifr)
   1034   1.1       cgd 	struct ifnet *ifp;
   1035   1.1       cgd 	struct ifreq *ifr;
   1036   1.1       cgd {
   1037   1.1       cgd 
   1038  1.26   thorpej 	bcopy(ifp->if_xname, ifr->ifr_name, IFNAMSIZ);
   1039   1.1       cgd }
   1040   1.1       cgd 
   1041   1.1       cgd /*
   1042  1.36  christos  * Support for poll() system call
   1043   1.1       cgd  *
   1044   1.2       cgd  * Return true iff the specific operation will not block indefinitely.
   1045   1.2       cgd  * Otherwise, return false but make a note that a selwakeup() must be done.
   1046   1.1       cgd  */
   1047   1.1       cgd int
   1048  1.30   mycroft bpfpoll(dev, events, p)
   1049   1.1       cgd 	register dev_t dev;
   1050  1.30   mycroft 	int events;
   1051   1.1       cgd 	struct proc *p;
   1052   1.1       cgd {
   1053  1.30   mycroft 	register struct bpf_d *d = &bpf_dtab[minor(dev)];
   1054  1.30   mycroft 	int revents = 0;
   1055  1.30   mycroft 	register int s = splimp();
   1056  1.12   mycroft 
   1057   1.1       cgd 	/*
   1058   1.1       cgd 	 * An imitation of the FIONREAD ioctl code.
   1059   1.1       cgd 	 */
   1060  1.30   mycroft 	if (events & (POLLIN | POLLRDNORM))
   1061  1.30   mycroft 		if (d->bd_hlen != 0 || (d->bd_immediate && d->bd_slen != 0))
   1062  1.30   mycroft 			revents |= events & (POLLIN | POLLRDNORM);
   1063  1.30   mycroft 		else
   1064  1.30   mycroft 			selrecord(p, &d->bd_sel);
   1065  1.12   mycroft 
   1066  1.12   mycroft 	splx(s);
   1067  1.30   mycroft 	return (revents);
   1068   1.1       cgd }
   1069   1.1       cgd 
   1070   1.1       cgd /*
   1071   1.2       cgd  * Incoming linkage from device drivers.  Process the packet pkt, of length
   1072   1.2       cgd  * pktlen, which is stored in a contiguous buffer.  The packet is parsed
   1073   1.2       cgd  * by each process' filter, and if accepted, stashed into the corresponding
   1074   1.2       cgd  * buffer.
   1075   1.1       cgd  */
   1076   1.1       cgd void
   1077   1.1       cgd bpf_tap(arg, pkt, pktlen)
   1078   1.1       cgd 	caddr_t arg;
   1079   1.1       cgd 	register u_char *pkt;
   1080   1.1       cgd 	register u_int pktlen;
   1081   1.1       cgd {
   1082   1.1       cgd 	struct bpf_if *bp;
   1083   1.1       cgd 	register struct bpf_d *d;
   1084  1.36  christos 	register u_int slen;
   1085   1.1       cgd 	/*
   1086   1.1       cgd 	 * Note that the ipl does not have to be raised at this point.
   1087   1.1       cgd 	 * The only problem that could arise here is that if two different
   1088   1.1       cgd 	 * interfaces shared any data.  This is not the case.
   1089   1.1       cgd 	 */
   1090   1.1       cgd 	bp = (struct bpf_if *)arg;
   1091   1.1       cgd 	for (d = bp->bif_dlist; d != 0; d = d->bd_next) {
   1092   1.1       cgd 		++d->bd_rcount;
   1093   1.1       cgd 		slen = bpf_filter(d->bd_filter, pkt, pktlen, pktlen);
   1094   1.1       cgd 		if (slen != 0)
   1095   1.1       cgd 			catchpacket(d, pkt, pktlen, slen, bcopy);
   1096   1.1       cgd 	}
   1097   1.1       cgd }
   1098   1.1       cgd 
   1099   1.1       cgd /*
   1100   1.1       cgd  * Copy data from an mbuf chain into a buffer.  This code is derived
   1101   1.1       cgd  * from m_copydata in sys/uipc_mbuf.c.
   1102   1.1       cgd  */
   1103   1.1       cgd static void
   1104  1.12   mycroft bpf_mcopy(src_arg, dst_arg, len)
   1105  1.12   mycroft 	const void *src_arg;
   1106  1.12   mycroft 	void *dst_arg;
   1107  1.19       cgd 	register size_t len;
   1108  1.12   mycroft {
   1109  1.12   mycroft 	register const struct mbuf *m;
   1110  1.12   mycroft 	register u_int count;
   1111   1.1       cgd 	u_char *dst;
   1112   1.1       cgd 
   1113  1.12   mycroft 	m = src_arg;
   1114  1.12   mycroft 	dst = dst_arg;
   1115   1.1       cgd 	while (len > 0) {
   1116   1.1       cgd 		if (m == 0)
   1117   1.1       cgd 			panic("bpf_mcopy");
   1118  1.12   mycroft 		count = min(m->m_len, len);
   1119   1.1       cgd 		bcopy(mtod(m, caddr_t), (caddr_t)dst, count);
   1120   1.1       cgd 		m = m->m_next;
   1121   1.1       cgd 		dst += count;
   1122   1.1       cgd 		len -= count;
   1123   1.1       cgd 	}
   1124   1.1       cgd }
   1125   1.1       cgd 
   1126   1.1       cgd /*
   1127   1.2       cgd  * Incoming linkage from device drivers, when packet is in an mbuf chain.
   1128   1.1       cgd  */
   1129   1.1       cgd void
   1130   1.1       cgd bpf_mtap(arg, m)
   1131   1.1       cgd 	caddr_t arg;
   1132   1.1       cgd 	struct mbuf *m;
   1133   1.1       cgd {
   1134   1.1       cgd 	struct bpf_if *bp = (struct bpf_if *)arg;
   1135   1.1       cgd 	struct bpf_d *d;
   1136  1.36  christos 	u_int pktlen, slen;
   1137   1.1       cgd 	struct mbuf *m0;
   1138   1.1       cgd 
   1139   1.1       cgd 	pktlen = 0;
   1140   1.2       cgd 	for (m0 = m; m0 != 0; m0 = m0->m_next)
   1141   1.1       cgd 		pktlen += m0->m_len;
   1142   1.1       cgd 
   1143   1.1       cgd 	for (d = bp->bif_dlist; d != 0; d = d->bd_next) {
   1144   1.1       cgd 		++d->bd_rcount;
   1145   1.1       cgd 		slen = bpf_filter(d->bd_filter, (u_char *)m, pktlen, 0);
   1146   1.1       cgd 		if (slen != 0)
   1147   1.1       cgd 			catchpacket(d, (u_char *)m, pktlen, slen, bpf_mcopy);
   1148   1.1       cgd 	}
   1149   1.1       cgd }
   1150   1.1       cgd 
   1151   1.1       cgd /*
   1152   1.1       cgd  * Move the packet data from interface memory (pkt) into the
   1153   1.1       cgd  * store buffer.  Return 1 if it's time to wakeup a listener (buffer full),
   1154   1.2       cgd  * otherwise 0.  "copy" is the routine called to do the actual data
   1155   1.2       cgd  * transfer.  bcopy is passed in to copy contiguous chunks, while
   1156   1.2       cgd  * bpf_mcopy is passed in to copy mbuf chains.  In the latter case,
   1157   1.2       cgd  * pkt is really an mbuf.
   1158   1.1       cgd  */
   1159   1.1       cgd static void
   1160   1.1       cgd catchpacket(d, pkt, pktlen, snaplen, cpfn)
   1161   1.1       cgd 	register struct bpf_d *d;
   1162   1.1       cgd 	register u_char *pkt;
   1163  1.36  christos 	register u_int pktlen, snaplen;
   1164  1.19       cgd 	register void (*cpfn) __P((const void *, void *, size_t));
   1165   1.1       cgd {
   1166   1.1       cgd 	register struct bpf_hdr *hp;
   1167   1.1       cgd 	register int totlen, curlen;
   1168   1.1       cgd 	register int hdrlen = d->bd_bif->bif_hdrlen;
   1169   1.1       cgd 	/*
   1170   1.1       cgd 	 * Figure out how many bytes to move.  If the packet is
   1171   1.1       cgd 	 * greater or equal to the snapshot length, transfer that
   1172   1.1       cgd 	 * much.  Otherwise, transfer the whole packet (unless
   1173   1.1       cgd 	 * we hit the buffer size limit).
   1174   1.1       cgd 	 */
   1175  1.12   mycroft 	totlen = hdrlen + min(snaplen, pktlen);
   1176   1.1       cgd 	if (totlen > d->bd_bufsize)
   1177   1.1       cgd 		totlen = d->bd_bufsize;
   1178   1.1       cgd 
   1179   1.1       cgd 	/*
   1180   1.1       cgd 	 * Round up the end of the previous packet to the next longword.
   1181   1.1       cgd 	 */
   1182   1.1       cgd 	curlen = BPF_WORDALIGN(d->bd_slen);
   1183   1.1       cgd 	if (curlen + totlen > d->bd_bufsize) {
   1184   1.1       cgd 		/*
   1185   1.1       cgd 		 * This packet will overflow the storage buffer.
   1186   1.1       cgd 		 * Rotate the buffers if we can, then wakeup any
   1187   1.1       cgd 		 * pending reads.
   1188   1.1       cgd 		 */
   1189   1.1       cgd 		if (d->bd_fbuf == 0) {
   1190  1.12   mycroft 			/*
   1191  1.12   mycroft 			 * We haven't completed the previous read yet,
   1192   1.1       cgd 			 * so drop the packet.
   1193   1.1       cgd 			 */
   1194   1.1       cgd 			++d->bd_dcount;
   1195   1.1       cgd 			return;
   1196   1.1       cgd 		}
   1197   1.1       cgd 		ROTATE_BUFFERS(d);
   1198   1.1       cgd 		bpf_wakeup(d);
   1199   1.1       cgd 		curlen = 0;
   1200   1.1       cgd 	}
   1201  1.12   mycroft 	else if (d->bd_immediate)
   1202   1.1       cgd 		/*
   1203   1.1       cgd 		 * Immediate mode is set.  A packet arrived so any
   1204   1.1       cgd 		 * reads should be woken up.
   1205   1.1       cgd 		 */
   1206   1.1       cgd 		bpf_wakeup(d);
   1207   1.1       cgd 
   1208   1.1       cgd 	/*
   1209   1.1       cgd 	 * Append the bpf header.
   1210   1.1       cgd 	 */
   1211   1.1       cgd 	hp = (struct bpf_hdr *)(d->bd_sbuf + curlen);
   1212  1.12   mycroft #if BSD >= 199103
   1213   1.2       cgd 	microtime(&hp->bh_tstamp);
   1214  1.12   mycroft #elif defined(sun)
   1215  1.12   mycroft 	uniqtime(&hp->bh_tstamp);
   1216  1.12   mycroft #else
   1217  1.12   mycroft 	hp->bh_tstamp = time;
   1218  1.12   mycroft #endif
   1219   1.1       cgd 	hp->bh_datalen = pktlen;
   1220   1.1       cgd 	hp->bh_hdrlen = hdrlen;
   1221   1.1       cgd 	/*
   1222   1.1       cgd 	 * Copy the packet data into the store buffer and update its length.
   1223   1.1       cgd 	 */
   1224   1.1       cgd 	(*cpfn)(pkt, (u_char *)hp + hdrlen, (hp->bh_caplen = totlen - hdrlen));
   1225   1.1       cgd 	d->bd_slen = curlen + totlen;
   1226   1.1       cgd }
   1227   1.1       cgd 
   1228  1.12   mycroft /*
   1229   1.1       cgd  * Initialize all nonzero fields of a descriptor.
   1230   1.1       cgd  */
   1231   1.1       cgd static int
   1232   1.2       cgd bpf_allocbufs(d)
   1233   1.1       cgd 	register struct bpf_d *d;
   1234   1.1       cgd {
   1235   1.1       cgd 	d->bd_fbuf = (caddr_t)malloc(d->bd_bufsize, M_DEVBUF, M_WAITOK);
   1236   1.1       cgd 	if (d->bd_fbuf == 0)
   1237   1.1       cgd 		return (ENOBUFS);
   1238   1.1       cgd 
   1239   1.1       cgd 	d->bd_sbuf = (caddr_t)malloc(d->bd_bufsize, M_DEVBUF, M_WAITOK);
   1240   1.1       cgd 	if (d->bd_sbuf == 0) {
   1241   1.1       cgd 		free(d->bd_fbuf, M_DEVBUF);
   1242   1.1       cgd 		return (ENOBUFS);
   1243   1.1       cgd 	}
   1244   1.1       cgd 	d->bd_slen = 0;
   1245   1.1       cgd 	d->bd_hlen = 0;
   1246   1.1       cgd 	return (0);
   1247   1.1       cgd }
   1248   1.1       cgd 
   1249   1.1       cgd /*
   1250   1.2       cgd  * Free buffers currently in use by a descriptor.
   1251   1.2       cgd  * Called on close.
   1252   1.2       cgd  */
   1253   1.2       cgd static void
   1254   1.2       cgd bpf_freed(d)
   1255   1.2       cgd 	register struct bpf_d *d;
   1256   1.2       cgd {
   1257   1.2       cgd 	/*
   1258   1.2       cgd 	 * We don't need to lock out interrupts since this descriptor has
   1259   1.2       cgd 	 * been detached from its interface and it yet hasn't been marked
   1260   1.2       cgd 	 * free.
   1261   1.2       cgd 	 */
   1262   1.2       cgd 	if (d->bd_sbuf != 0) {
   1263   1.2       cgd 		free(d->bd_sbuf, M_DEVBUF);
   1264   1.2       cgd 		if (d->bd_hbuf != 0)
   1265   1.2       cgd 			free(d->bd_hbuf, M_DEVBUF);
   1266   1.2       cgd 		if (d->bd_fbuf != 0)
   1267   1.2       cgd 			free(d->bd_fbuf, M_DEVBUF);
   1268   1.2       cgd 	}
   1269   1.2       cgd 	if (d->bd_filter)
   1270   1.2       cgd 		free((caddr_t)d->bd_filter, M_DEVBUF);
   1271   1.2       cgd 
   1272   1.2       cgd 	D_MARKFREE(d);
   1273   1.2       cgd }
   1274   1.2       cgd 
   1275   1.2       cgd /*
   1276   1.2       cgd  * Attach an interface to bpf.  driverp is a pointer to a (struct bpf_if *)
   1277   1.2       cgd  * in the driver's softc; dlt is the link layer type; hdrlen is the fixed
   1278   1.2       cgd  * size of the link header (variable length headers not yet supported).
   1279   1.1       cgd  */
   1280   1.1       cgd void
   1281   1.1       cgd bpfattach(driverp, ifp, dlt, hdrlen)
   1282   1.1       cgd 	caddr_t *driverp;
   1283   1.1       cgd 	struct ifnet *ifp;
   1284   1.1       cgd 	u_int dlt, hdrlen;
   1285   1.1       cgd {
   1286   1.1       cgd 	struct bpf_if *bp;
   1287   1.1       cgd 	int i;
   1288  1.12   mycroft #if BSD < 199103
   1289  1.12   mycroft 	static struct bpf_if bpf_ifs[NBPFILTER];
   1290  1.12   mycroft 	static int bpfifno;
   1291   1.1       cgd 
   1292  1.12   mycroft 	bp = (bpfifno < NBPFILTER) ? &bpf_ifs[bpfifno++] : 0;
   1293  1.12   mycroft #else
   1294   1.1       cgd 	bp = (struct bpf_if *)malloc(sizeof(*bp), M_DEVBUF, M_DONTWAIT);
   1295  1.12   mycroft #endif
   1296  1.12   mycroft 	if (bp == 0)
   1297  1.12   mycroft 		panic("bpfattach");
   1298  1.12   mycroft 
   1299   1.1       cgd 	bp->bif_dlist = 0;
   1300   1.1       cgd 	bp->bif_driverp = (struct bpf_if **)driverp;
   1301   1.1       cgd 	bp->bif_ifp = ifp;
   1302   1.1       cgd 	bp->bif_dlt = dlt;
   1303   1.1       cgd 
   1304   1.1       cgd 	bp->bif_next = bpf_iflist;
   1305   1.1       cgd 	bpf_iflist = bp;
   1306   1.1       cgd 
   1307   1.1       cgd 	*bp->bif_driverp = 0;
   1308   1.1       cgd 
   1309   1.1       cgd 	/*
   1310   1.1       cgd 	 * Compute the length of the bpf header.  This is not necessarily
   1311  1.12   mycroft 	 * equal to SIZEOF_BPF_HDR because we want to insert spacing such
   1312  1.12   mycroft 	 * that the network layer header begins on a longword boundary (for
   1313   1.1       cgd 	 * performance reasons and to alleviate alignment restrictions).
   1314   1.1       cgd 	 */
   1315   1.1       cgd 	bp->bif_hdrlen = BPF_WORDALIGN(hdrlen + SIZEOF_BPF_HDR) - hdrlen;
   1316   1.1       cgd 
   1317   1.1       cgd 	/*
   1318   1.1       cgd 	 * Mark all the descriptors free if this hasn't been done.
   1319   1.1       cgd 	 */
   1320   1.1       cgd 	if (!D_ISFREE(&bpf_dtab[0]))
   1321   1.1       cgd 		for (i = 0; i < NBPFILTER; ++i)
   1322   1.1       cgd 			D_MARKFREE(&bpf_dtab[i]);
   1323   1.1       cgd 
   1324  1.11   deraadt #if 0
   1325  1.32  christos 	printf("bpf: %s attached\n", ifp->if_xname);
   1326  1.11   deraadt #endif
   1327   1.1       cgd }
   1328   1.1       cgd 
   1329  1.12   mycroft #if BSD >= 199103
   1330   1.1       cgd /* XXX This routine belongs in net/if.c. */
   1331   1.1       cgd /*
   1332   1.2       cgd  * Set/clear promiscuous mode on interface ifp based on the truth value
   1333   1.1       cgd  * of pswitch.  The calls are reference counted so that only the first
   1334   1.2       cgd  * "on" request actually has an effect, as does the final "off" request.
   1335   1.2       cgd  * Results are undefined if the "off" and "on" requests are not matched.
   1336   1.1       cgd  */
   1337   1.1       cgd int
   1338   1.1       cgd ifpromisc(ifp, pswitch)
   1339  1.36  christos 	register struct ifnet *ifp;
   1340  1.36  christos 	register int pswitch;
   1341   1.1       cgd {
   1342  1.36  christos 	register int pcount, ret;
   1343  1.36  christos 	register short flags;
   1344   1.1       cgd 	struct ifreq ifr;
   1345   1.1       cgd 
   1346  1.36  christos 	pcount = ifp->if_pcount;
   1347  1.36  christos 	flags = ifp->if_flags;
   1348   1.1       cgd 	if (pswitch) {
   1349  1.18   mycroft 		/*
   1350  1.18   mycroft 		 * If the device is not configured up, we cannot put it in
   1351  1.18   mycroft 		 * promiscuous mode.
   1352  1.18   mycroft 		 */
   1353  1.18   mycroft 		if ((ifp->if_flags & IFF_UP) == 0)
   1354  1.18   mycroft 			return (ENETDOWN);
   1355   1.1       cgd 		if (ifp->if_pcount++ != 0)
   1356   1.1       cgd 			return (0);
   1357   1.1       cgd 		ifp->if_flags |= IFF_PROMISC;
   1358   1.1       cgd 	} else {
   1359   1.1       cgd 		if (--ifp->if_pcount > 0)
   1360   1.1       cgd 			return (0);
   1361   1.1       cgd 		ifp->if_flags &= ~IFF_PROMISC;
   1362  1.18   mycroft 		/*
   1363  1.18   mycroft 		 * If the device is not configured up, we should not need to
   1364  1.18   mycroft 		 * turn off promiscuous mode (device should have turned it
   1365  1.18   mycroft 		 * off when interface went down; and will look at IFF_PROMISC
   1366  1.18   mycroft 		 * again next time interface comes up).
   1367  1.18   mycroft 		 */
   1368  1.18   mycroft 		if ((ifp->if_flags & IFF_UP) == 0)
   1369  1.18   mycroft 			return (0);
   1370   1.1       cgd 	}
   1371  1.36  christos 	bzero((caddr_t)&ifr, sizeof(ifr));
   1372   1.1       cgd 	ifr.ifr_flags = ifp->if_flags;
   1373  1.36  christos 	ret = (*ifp->if_ioctl)(ifp, SIOCSIFFLAGS, (caddr_t)&ifr);
   1374  1.36  christos 	/* Restore interface state if not successful */
   1375  1.36  christos 	if (ret != 0) {
   1376  1.36  christos 		ifp->if_pcount = pcount;
   1377  1.36  christos 		ifp->if_flags = flags;
   1378  1.36  christos 	}
   1379  1.36  christos 	return (ret);
   1380   1.1       cgd }
   1381  1.12   mycroft #endif
   1382  1.12   mycroft 
   1383  1.12   mycroft #if BSD < 199103
   1384  1.12   mycroft /*
   1385  1.12   mycroft  * Allocate some memory for bpf.  This is temporary SunOS support, and
   1386  1.12   mycroft  * is admittedly a hack.
   1387  1.36  christos  * If resources unavailable, return 0.
   1388  1.12   mycroft  */
   1389  1.12   mycroft static caddr_t
   1390  1.12   mycroft bpf_alloc(size, canwait)
   1391  1.12   mycroft 	register int size;
   1392  1.12   mycroft 	register int canwait;
   1393  1.12   mycroft {
   1394  1.12   mycroft 	register struct mbuf *m;
   1395  1.12   mycroft 
   1396  1.12   mycroft 	if ((unsigned)size > (MCLBYTES-8))
   1397  1.12   mycroft 		return 0;
   1398   1.2       cgd 
   1399  1.12   mycroft 	MGET(m, canwait, MT_DATA);
   1400  1.12   mycroft 	if (m == 0)
   1401  1.12   mycroft 		return 0;
   1402  1.12   mycroft 	if ((unsigned)size > (MLEN-8)) {
   1403  1.12   mycroft 		MCLGET(m);
   1404  1.12   mycroft 		if (m->m_len != MCLBYTES) {
   1405  1.12   mycroft 			m_freem(m);
   1406  1.12   mycroft 			return 0;
   1407  1.12   mycroft 		}
   1408  1.12   mycroft 	}
   1409  1.12   mycroft 	*mtod(m, struct mbuf **) = m;
   1410  1.12   mycroft 	return mtod(m, caddr_t) + 8;
   1411  1.12   mycroft }
   1412  1.12   mycroft #endif
   1413