xref: /freebsd/sys/net/bpf.c (revision 560a54e10cbf5d595fe5fcc5b79efee7ffee6ba9)
1c398230bSWarner Losh /*-
2df8bae1dSRodney W. Grimes  * Copyright (c) 1990, 1991, 1993
3df8bae1dSRodney W. Grimes  *	The Regents of the University of California.  All rights reserved.
4df8bae1dSRodney W. Grimes  *
5df8bae1dSRodney W. Grimes  * This code is derived from the Stanford/CMU enet packet filter,
6df8bae1dSRodney W. Grimes  * (net/enet.c) distributed as part of 4.3BSD, and code contributed
7df8bae1dSRodney W. Grimes  * to Berkeley by Steven McCanne and Van Jacobson both of Lawrence
8df8bae1dSRodney W. Grimes  * Berkeley Laboratory.
9df8bae1dSRodney W. Grimes  *
10df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
11df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
12df8bae1dSRodney W. Grimes  * are met:
13df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
14df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
15df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
16df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
17df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
18df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
19df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
20df8bae1dSRodney W. Grimes  *    without specific prior written permission.
21df8bae1dSRodney W. Grimes  *
22df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
33df8bae1dSRodney W. Grimes  *
344f252c4dSRuslan Ermilov  *      @(#)bpf.c	8.4 (Berkeley) 1/9/95
35df8bae1dSRodney W. Grimes  *
36c3aac50fSPeter Wemm  * $FreeBSD$
37df8bae1dSRodney W. Grimes  */
38df8bae1dSRodney W. Grimes 
395bb5f2c9SPeter Wemm #include "opt_bpf.h"
4082f4445dSRobert Watson #include "opt_mac.h"
415bb5f2c9SPeter Wemm #include "opt_netgraph.h"
42df8bae1dSRodney W. Grimes 
4395aab9ccSJohn-Mark Gurney #include <sys/types.h>
44df8bae1dSRodney W. Grimes #include <sys/param.h>
45df8bae1dSRodney W. Grimes #include <sys/systm.h>
46ce7609a4SBruce Evans #include <sys/conf.h>
47e76eee55SPoul-Henning Kamp #include <sys/fcntl.h>
484d1d4912SBruce Evans #include <sys/malloc.h>
49df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
50df8bae1dSRodney W. Grimes #include <sys/time.h>
51acd3428bSRobert Watson #include <sys/priv.h>
52df8bae1dSRodney W. Grimes #include <sys/proc.h>
530310c19fSBruce Evans #include <sys/signalvar.h>
54528f627fSBruce Evans #include <sys/filio.h>
55528f627fSBruce Evans #include <sys/sockio.h>
56528f627fSBruce Evans #include <sys/ttycom.h>
57e76eee55SPoul-Henning Kamp #include <sys/uio.h>
58df8bae1dSRodney W. Grimes 
5995aab9ccSJohn-Mark Gurney #include <sys/event.h>
6095aab9ccSJohn-Mark Gurney #include <sys/file.h>
61243ac7d8SPeter Wemm #include <sys/poll.h>
6295aab9ccSJohn-Mark Gurney #include <sys/proc.h>
63df8bae1dSRodney W. Grimes 
64df8bae1dSRodney W. Grimes #include <sys/socket.h>
65df8bae1dSRodney W. Grimes 
66fba9235dSBruce Evans #include <net/if.h>
67df8bae1dSRodney W. Grimes #include <net/bpf.h>
68ae275efcSJung-uk Kim #ifdef BPF_JITTER
69ae275efcSJung-uk Kim #include <net/bpf_jitter.h>
70ae275efcSJung-uk Kim #endif
71df8bae1dSRodney W. Grimes #include <net/bpfdesc.h>
72df8bae1dSRodney W. Grimes 
73df8bae1dSRodney W. Grimes #include <netinet/in.h>
74df8bae1dSRodney W. Grimes #include <netinet/if_ether.h>
75df8bae1dSRodney W. Grimes #include <sys/kernel.h>
76f708ef1bSPoul-Henning Kamp #include <sys/sysctl.h>
777b778b5eSEivind Eklund 
78246b5467SSam Leffler #include <net80211/ieee80211_freebsd.h>
79246b5467SSam Leffler 
80aed55708SRobert Watson #include <security/mac/mac_framework.h>
81aed55708SRobert Watson 
82959b7375SPoul-Henning Kamp static MALLOC_DEFINE(M_BPF, "BPF", "BPF data");
8387f6c662SJulian Elischer 
845bb5f2c9SPeter Wemm #if defined(DEV_BPF) || defined(NETGRAPH_BPF)
8553ac6efbSJulian Elischer 
86df8bae1dSRodney W. Grimes #define PRINET  26			/* interruptible */
87df8bae1dSRodney W. Grimes 
88560a54e1SJung-uk Kim #define	M_SKIP_BPF	M_SKIP_FIREWALL
89560a54e1SJung-uk Kim 
90df8bae1dSRodney W. Grimes /*
91d1a67300SRobert Watson  * bpf_iflist is a list of BPF interface structures, each corresponding to a
92d1a67300SRobert Watson  * specific DLT.  The same network interface might have several BPF interface
93d1a67300SRobert Watson  * structures registered by different layers in the stack (i.e., 802.11
94d1a67300SRobert Watson  * frames, ethernet frames, etc).
95df8bae1dSRodney W. Grimes  */
964a3feeaaSRobert Watson static LIST_HEAD(, bpf_if)	bpf_iflist;
97e7bb21b3SJonathan Lemon static struct mtx	bpf_mtx;		/* bpf global lock */
9869f7644bSChristian S.J. Peron static int		bpf_bpfd_cnt;
99df8bae1dSRodney W. Grimes 
100a3594432SRobert Watson static void	bpf_allocbufs(struct bpf_d *);
10119ba8395SChristian S.J. Peron static void	bpf_attachd(struct bpf_d *, struct bpf_if *);
10219ba8395SChristian S.J. Peron static void	bpf_detachd(struct bpf_d *);
103929ddbbbSAlfred Perlstein static void	bpf_freed(struct bpf_d *);
104929ddbbbSAlfred Perlstein static void	bpf_mcopy(const void *, void *, size_t);
105560a54e1SJung-uk Kim static int	bpf_movein(struct uio *, int, int, struct mbuf **,
106560a54e1SJung-uk Kim 		    struct sockaddr *, int *, struct bpf_insn *);
107929ddbbbSAlfred Perlstein static int	bpf_setif(struct bpf_d *, struct ifreq *);
108929ddbbbSAlfred Perlstein static void	bpf_timed_out(void *);
109e7bb21b3SJonathan Lemon static __inline void
110929ddbbbSAlfred Perlstein 		bpf_wakeup(struct bpf_d *);
111929ddbbbSAlfred Perlstein static void	catchpacket(struct bpf_d *, u_char *, u_int,
11291433904SDavid Malone 		    u_int, void (*)(const void *, void *, size_t),
11391433904SDavid Malone 		    struct timeval *);
114929ddbbbSAlfred Perlstein static void	reset_d(struct bpf_d *);
11593e39f0bSChristian S.J. Peron static int	 bpf_setf(struct bpf_d *, struct bpf_program *, u_long cmd);
1168eab61f3SSam Leffler static int	bpf_getdltlist(struct bpf_d *, struct bpf_dltlist *);
1178eab61f3SSam Leffler static int	bpf_setdlt(struct bpf_d *, u_int);
11895aab9ccSJohn-Mark Gurney static void	filt_bpfdetach(struct knote *);
11995aab9ccSJohn-Mark Gurney static int	filt_bpfread(struct knote *, long);
120a3272e3cSChristian S.J. Peron static void	bpf_drvinit(void *);
1216a113b3dSRobert Watson static void	bpf_clone(void *, struct ucred *, char *, int, struct cdev **);
12269f7644bSChristian S.J. Peron static int	bpf_stats_sysctl(SYSCTL_HANDLER_ARGS);
12369f7644bSChristian S.J. Peron 
12469f7644bSChristian S.J. Peron SYSCTL_NODE(_net, OID_AUTO, bpf, CTLFLAG_RW, 0, "bpf sysctl");
12569f7644bSChristian S.J. Peron static int bpf_bufsize = 4096;
12669f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, bufsize, CTLFLAG_RW,
1275d1f8283SRobert Watson     &bpf_bufsize, 0, "Default bpf buffer size");
12869f7644bSChristian S.J. Peron static int bpf_maxbufsize = BPF_MAXBUFSIZE;
12969f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, maxbufsize, CTLFLAG_RW,
1305d1f8283SRobert Watson     &bpf_maxbufsize, 0, "Maximum bpf buffer size");
13169f7644bSChristian S.J. Peron static int bpf_maxinsns = BPF_MAXINSNS;
13269f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, maxinsns, CTLFLAG_RW,
13369f7644bSChristian S.J. Peron     &bpf_maxinsns, 0, "Maximum bpf program instructions");
13469f7644bSChristian S.J. Peron SYSCTL_NODE(_net_bpf, OID_AUTO, stats, CTLFLAG_RW,
13569f7644bSChristian S.J. Peron     bpf_stats_sysctl, "bpf statistics portal");
136df8bae1dSRodney W. Grimes 
13787f6c662SJulian Elischer static	d_open_t	bpfopen;
13887f6c662SJulian Elischer static	d_close_t	bpfclose;
13987f6c662SJulian Elischer static	d_read_t	bpfread;
14087f6c662SJulian Elischer static	d_write_t	bpfwrite;
14187f6c662SJulian Elischer static	d_ioctl_t	bpfioctl;
142243ac7d8SPeter Wemm static	d_poll_t	bpfpoll;
14395aab9ccSJohn-Mark Gurney static	d_kqfilter_t	bpfkqfilter;
14487f6c662SJulian Elischer 
1454e2f199eSPoul-Henning Kamp static struct cdevsw bpf_cdevsw = {
146dc08ffecSPoul-Henning Kamp 	.d_version =	D_VERSION,
147dc08ffecSPoul-Henning Kamp 	.d_flags =	D_NEEDGIANT,
1487ac40f5fSPoul-Henning Kamp 	.d_open =	bpfopen,
1497ac40f5fSPoul-Henning Kamp 	.d_close =	bpfclose,
1507ac40f5fSPoul-Henning Kamp 	.d_read =	bpfread,
1517ac40f5fSPoul-Henning Kamp 	.d_write =	bpfwrite,
1527ac40f5fSPoul-Henning Kamp 	.d_ioctl =	bpfioctl,
1537ac40f5fSPoul-Henning Kamp 	.d_poll =	bpfpoll,
1547ac40f5fSPoul-Henning Kamp 	.d_name =	"bpf",
15595aab9ccSJohn-Mark Gurney 	.d_kqfilter =	bpfkqfilter,
1564e2f199eSPoul-Henning Kamp };
15787f6c662SJulian Elischer 
15895aab9ccSJohn-Mark Gurney static struct filterops bpfread_filtops =
15995aab9ccSJohn-Mark Gurney 	{ 1, NULL, filt_bpfdetach, filt_bpfread };
16087f6c662SJulian Elischer 
161df8bae1dSRodney W. Grimes static int
16219ba8395SChristian S.J. Peron bpf_movein(struct uio *uio, int linktype, int mtu, struct mbuf **mp,
163560a54e1SJung-uk Kim     struct sockaddr *sockp, int *hdrlen, struct bpf_insn *wfilter)
164df8bae1dSRodney W. Grimes {
165246b5467SSam Leffler 	const struct ieee80211_bpf_params *p;
166df8bae1dSRodney W. Grimes 	struct mbuf *m;
167df8bae1dSRodney W. Grimes 	int error;
168df8bae1dSRodney W. Grimes 	int len;
169df8bae1dSRodney W. Grimes 	int hlen;
17093e39f0bSChristian S.J. Peron 	int slen;
171df8bae1dSRodney W. Grimes 
172df8bae1dSRodney W. Grimes 	/*
173df8bae1dSRodney W. Grimes 	 * Build a sockaddr based on the data link layer type.
174df8bae1dSRodney W. Grimes 	 * We do this at this level because the ethernet header
175df8bae1dSRodney W. Grimes 	 * is copied directly into the data field of the sockaddr.
176df8bae1dSRodney W. Grimes 	 * In the case of SLIP, there is no header and the packet
177df8bae1dSRodney W. Grimes 	 * is forwarded as is.
178df8bae1dSRodney W. Grimes 	 * Also, we are careful to leave room at the front of the mbuf
179df8bae1dSRodney W. Grimes 	 * for the link level header.
180df8bae1dSRodney W. Grimes 	 */
181df8bae1dSRodney W. Grimes 	switch (linktype) {
182df8bae1dSRodney W. Grimes 
183df8bae1dSRodney W. Grimes 	case DLT_SLIP:
184df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_INET;
185df8bae1dSRodney W. Grimes 		hlen = 0;
186df8bae1dSRodney W. Grimes 		break;
187df8bae1dSRodney W. Grimes 
188df8bae1dSRodney W. Grimes 	case DLT_EN10MB:
189df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_UNSPEC;
190df8bae1dSRodney W. Grimes 		/* XXX Would MAXLINKHDR be better? */
191797f247bSMatthew N. Dodd 		hlen = ETHER_HDR_LEN;
192df8bae1dSRodney W. Grimes 		break;
193df8bae1dSRodney W. Grimes 
194df8bae1dSRodney W. Grimes 	case DLT_FDDI:
195d41f24e7SDavid Greenman 		sockp->sa_family = AF_IMPLINK;
196d41f24e7SDavid Greenman 		hlen = 0;
197df8bae1dSRodney W. Grimes 		break;
198df8bae1dSRodney W. Grimes 
19922f05c43SAndrey A. Chernov 	case DLT_RAW:
200df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_UNSPEC;
201df8bae1dSRodney W. Grimes 		hlen = 0;
202df8bae1dSRodney W. Grimes 		break;
203df8bae1dSRodney W. Grimes 
20401399f34SDavid Malone 	case DLT_NULL:
20501399f34SDavid Malone 		/*
20601399f34SDavid Malone 		 * null interface types require a 4 byte pseudo header which
20701399f34SDavid Malone 		 * corresponds to the address family of the packet.
20801399f34SDavid Malone 		 */
20901399f34SDavid Malone 		sockp->sa_family = AF_UNSPEC;
21001399f34SDavid Malone 		hlen = 4;
21101399f34SDavid Malone 		break;
21201399f34SDavid Malone 
2134f53e3ccSKenjiro Cho 	case DLT_ATM_RFC1483:
2144f53e3ccSKenjiro Cho 		/*
2154f53e3ccSKenjiro Cho 		 * en atm driver requires 4-byte atm pseudo header.
2164f53e3ccSKenjiro Cho 		 * though it isn't standard, vpi:vci needs to be
2174f53e3ccSKenjiro Cho 		 * specified anyway.
2184f53e3ccSKenjiro Cho 		 */
2194f53e3ccSKenjiro Cho 		sockp->sa_family = AF_UNSPEC;
2204f53e3ccSKenjiro Cho 		hlen = 12;	/* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */
2214f53e3ccSKenjiro Cho 		break;
2224f53e3ccSKenjiro Cho 
22330fa52a6SBrian Somers 	case DLT_PPP:
22430fa52a6SBrian Somers 		sockp->sa_family = AF_UNSPEC;
22530fa52a6SBrian Somers 		hlen = 4;	/* This should match PPP_HDRLEN */
22630fa52a6SBrian Somers 		break;
22730fa52a6SBrian Somers 
228246b5467SSam Leffler 	case DLT_IEEE802_11:		/* IEEE 802.11 wireless */
229246b5467SSam Leffler 		sockp->sa_family = AF_IEEE80211;
230246b5467SSam Leffler 		hlen = 0;
231246b5467SSam Leffler 		break;
232246b5467SSam Leffler 
233246b5467SSam Leffler 	case DLT_IEEE802_11_RADIO:	/* IEEE 802.11 wireless w/ phy params */
234246b5467SSam Leffler 		sockp->sa_family = AF_IEEE80211;
235246b5467SSam Leffler 		sockp->sa_len = 12;	/* XXX != 0 */
236246b5467SSam Leffler 		hlen = sizeof(struct ieee80211_bpf_params);
237246b5467SSam Leffler 		break;
238246b5467SSam Leffler 
239df8bae1dSRodney W. Grimes 	default:
240df8bae1dSRodney W. Grimes 		return (EIO);
241df8bae1dSRodney W. Grimes 	}
242df8bae1dSRodney W. Grimes 
243df8bae1dSRodney W. Grimes 	len = uio->uio_resid;
24401399f34SDavid Malone 
24501399f34SDavid Malone 	if (len - hlen > mtu)
24601399f34SDavid Malone 		return (EMSGSIZE);
24701399f34SDavid Malone 
248df8bae1dSRodney W. Grimes 	if ((unsigned)len > MCLBYTES)
249df8bae1dSRodney W. Grimes 		return (EIO);
250df8bae1dSRodney W. Grimes 
251963e4c2aSGarrett Wollman 	if (len > MHLEN) {
252a163d034SWarner Losh 		m = m_getcl(M_TRYWAIT, MT_DATA, M_PKTHDR);
25324a229f4SSam Leffler 	} else {
254a163d034SWarner Losh 		MGETHDR(m, M_TRYWAIT, MT_DATA);
255df8bae1dSRodney W. Grimes 	}
25624a229f4SSam Leffler 	if (m == NULL)
25724a229f4SSam Leffler 		return (ENOBUFS);
258963e4c2aSGarrett Wollman 	m->m_pkthdr.len = m->m_len = len;
259963e4c2aSGarrett Wollman 	m->m_pkthdr.rcvif = NULL;
260df8bae1dSRodney W. Grimes 	*mp = m;
26124a229f4SSam Leffler 
26293e39f0bSChristian S.J. Peron 	if (m->m_len < hlen) {
26393e39f0bSChristian S.J. Peron 		error = EPERM;
26493e39f0bSChristian S.J. Peron 		goto bad;
26593e39f0bSChristian S.J. Peron 	}
26693e39f0bSChristian S.J. Peron 
26793e39f0bSChristian S.J. Peron 	error = uiomove(mtod(m, u_char *), len, uio);
26893e39f0bSChristian S.J. Peron 	if (error)
26993e39f0bSChristian S.J. Peron 		goto bad;
27093e39f0bSChristian S.J. Peron 
27193e39f0bSChristian S.J. Peron 	slen = bpf_filter(wfilter, mtod(m, u_char *), len, len);
27293e39f0bSChristian S.J. Peron 	if (slen == 0) {
27393e39f0bSChristian S.J. Peron 		error = EPERM;
27493e39f0bSChristian S.J. Peron 		goto bad;
27593e39f0bSChristian S.J. Peron 	}
27693e39f0bSChristian S.J. Peron 
277df8bae1dSRodney W. Grimes 	/*
27893e39f0bSChristian S.J. Peron 	 * Make room for link header, and copy it to sockaddr
279df8bae1dSRodney W. Grimes 	 */
280df8bae1dSRodney W. Grimes 	if (hlen != 0) {
281246b5467SSam Leffler 		if (sockp->sa_family == AF_IEEE80211) {
282246b5467SSam Leffler 			/*
283246b5467SSam Leffler 			 * Collect true length from the parameter header
284246b5467SSam Leffler 			 * NB: sockp is known to be zero'd so if we do a
285246b5467SSam Leffler 			 *     short copy unspecified parameters will be
286246b5467SSam Leffler 			 *     zero.
287246b5467SSam Leffler 			 * NB: packet may not be aligned after stripping
288246b5467SSam Leffler 			 *     bpf params
289246b5467SSam Leffler 			 * XXX check ibp_vers
290246b5467SSam Leffler 			 */
291246b5467SSam Leffler 			p = mtod(m, const struct ieee80211_bpf_params *);
292246b5467SSam Leffler 			hlen = p->ibp_len;
293246b5467SSam Leffler 			if (hlen > sizeof(sockp->sa_data)) {
294246b5467SSam Leffler 				error = EINVAL;
295246b5467SSam Leffler 				goto bad;
296246b5467SSam Leffler 			}
297246b5467SSam Leffler 		}
29893e39f0bSChristian S.J. Peron 		bcopy(m->m_data, sockp->sa_data, hlen);
299df8bae1dSRodney W. Grimes 	}
300560a54e1SJung-uk Kim 	*hdrlen = hlen;
30193e39f0bSChristian S.J. Peron 
302df8bae1dSRodney W. Grimes 	return (0);
303df8bae1dSRodney W. Grimes bad:
304df8bae1dSRodney W. Grimes 	m_freem(m);
305df8bae1dSRodney W. Grimes 	return (error);
306df8bae1dSRodney W. Grimes }
307df8bae1dSRodney W. Grimes 
308df8bae1dSRodney W. Grimes /*
309df8bae1dSRodney W. Grimes  * Attach file to the bpf interface, i.e. make d listen on bp.
310df8bae1dSRodney W. Grimes  */
311df8bae1dSRodney W. Grimes static void
31219ba8395SChristian S.J. Peron bpf_attachd(struct bpf_d *d, struct bpf_if *bp)
313df8bae1dSRodney W. Grimes {
314df8bae1dSRodney W. Grimes 	/*
315df8bae1dSRodney W. Grimes 	 * Point d at bp, and add d to the interface's list of listeners.
316df8bae1dSRodney W. Grimes 	 * Finally, point the driver's bpf cookie at the interface so
317df8bae1dSRodney W. Grimes 	 * it will divert packets to bpf.
318df8bae1dSRodney W. Grimes 	 */
319e7bb21b3SJonathan Lemon 	BPFIF_LOCK(bp);
320df8bae1dSRodney W. Grimes 	d->bd_bif = bp;
3214a3feeaaSRobert Watson 	LIST_INSERT_HEAD(&bp->bif_dlist, d, bd_next);
322df8bae1dSRodney W. Grimes 
32369f7644bSChristian S.J. Peron 	bpf_bpfd_cnt++;
324e7bb21b3SJonathan Lemon 	BPFIF_UNLOCK(bp);
325df8bae1dSRodney W. Grimes }
326df8bae1dSRodney W. Grimes 
327df8bae1dSRodney W. Grimes /*
328df8bae1dSRodney W. Grimes  * Detach a file from its interface.
329df8bae1dSRodney W. Grimes  */
330df8bae1dSRodney W. Grimes static void
33119ba8395SChristian S.J. Peron bpf_detachd(struct bpf_d *d)
332df8bae1dSRodney W. Grimes {
3336e891d64SPoul-Henning Kamp 	int error;
334df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
33546448b5aSRobert Watson 	struct ifnet *ifp;
336df8bae1dSRodney W. Grimes 
337df8bae1dSRodney W. Grimes 	bp = d->bd_bif;
33846448b5aSRobert Watson 	BPFIF_LOCK(bp);
33946448b5aSRobert Watson 	BPFD_LOCK(d);
34046448b5aSRobert Watson 	ifp = d->bd_bif->bif_ifp;
34146448b5aSRobert Watson 
34246448b5aSRobert Watson 	/*
34346448b5aSRobert Watson 	 * Remove d from the interface's descriptor list.
34446448b5aSRobert Watson 	 */
34546448b5aSRobert Watson 	LIST_REMOVE(d, bd_next);
34646448b5aSRobert Watson 
34769f7644bSChristian S.J. Peron 	bpf_bpfd_cnt--;
348572bde2aSRobert Watson 	d->bd_bif = NULL;
34946448b5aSRobert Watson 	BPFD_UNLOCK(d);
35046448b5aSRobert Watson 	BPFIF_UNLOCK(bp);
35146448b5aSRobert Watson 
352df8bae1dSRodney W. Grimes 	/*
353df8bae1dSRodney W. Grimes 	 * Check if this descriptor had requested promiscuous mode.
354df8bae1dSRodney W. Grimes 	 * If so, turn it off.
355df8bae1dSRodney W. Grimes 	 */
356df8bae1dSRodney W. Grimes 	if (d->bd_promisc) {
357df8bae1dSRodney W. Grimes 		d->bd_promisc = 0;
35846448b5aSRobert Watson 		error = ifpromisc(ifp, 0);
3596e891d64SPoul-Henning Kamp 		if (error != 0 && error != ENXIO) {
360df8bae1dSRodney W. Grimes 			/*
3616e891d64SPoul-Henning Kamp 			 * ENXIO can happen if a pccard is unplugged
362df8bae1dSRodney W. Grimes 			 * Something is really wrong if we were able to put
363df8bae1dSRodney W. Grimes 			 * the driver into promiscuous mode, but can't
364df8bae1dSRodney W. Grimes 			 * take it out.
365df8bae1dSRodney W. Grimes 			 */
3668eab61f3SSam Leffler 			if_printf(bp->bif_ifp,
3678eab61f3SSam Leffler 				"bpf_detach: ifpromisc failed (%d)\n", error);
3686e891d64SPoul-Henning Kamp 		}
369df8bae1dSRodney W. Grimes 	}
370df8bae1dSRodney W. Grimes }
371df8bae1dSRodney W. Grimes 
372df8bae1dSRodney W. Grimes /*
373df8bae1dSRodney W. Grimes  * Open ethernet device.  Returns ENXIO for illegal minor device number,
374df8bae1dSRodney W. Grimes  * EBUSY if file is open by another process.
375df8bae1dSRodney W. Grimes  */
376df8bae1dSRodney W. Grimes /* ARGSUSED */
37787f6c662SJulian Elischer static	int
37819ba8395SChristian S.J. Peron bpfopen(struct cdev *dev, int flags, int fmt, struct thread *td)
379df8bae1dSRodney W. Grimes {
380e7bb21b3SJonathan Lemon 	struct bpf_d *d;
381df8bae1dSRodney W. Grimes 
382e7bb21b3SJonathan Lemon 	mtx_lock(&bpf_mtx);
383bd3a5320SPoul-Henning Kamp 	d = dev->si_drv1;
384df8bae1dSRodney W. Grimes 	/*
385df8bae1dSRodney W. Grimes 	 * Each minor can be opened by only one process.  If the requested
386df8bae1dSRodney W. Grimes 	 * minor is in use, return EBUSY.
387df8bae1dSRodney W. Grimes 	 */
388d17d8184SRobert Watson 	if (d != NULL) {
389e7bb21b3SJonathan Lemon 		mtx_unlock(&bpf_mtx);
390df8bae1dSRodney W. Grimes 		return (EBUSY);
391e7bb21b3SJonathan Lemon 	}
392e7bb21b3SJonathan Lemon 	dev->si_drv1 = (struct bpf_d *)~0;	/* mark device in use */
393e7bb21b3SJonathan Lemon 	mtx_unlock(&bpf_mtx);
394e7bb21b3SJonathan Lemon 
395d1d74c28SJohn Baldwin 	if ((dev->si_flags & SI_NAMED) == 0)
396b0d17ba6SPoul-Henning Kamp 		make_dev(&bpf_cdevsw, minor(dev), UID_ROOT, GID_WHEEL, 0600,
397b0d17ba6SPoul-Henning Kamp 		    "bpf%d", dev2unit(dev));
398a163d034SWarner Losh 	MALLOC(d, struct bpf_d *, sizeof(*d), M_BPF, M_WAITOK | M_ZERO);
399bd3a5320SPoul-Henning Kamp 	dev->si_drv1 = d;
400df8bae1dSRodney W. Grimes 	d->bd_bufsize = bpf_bufsize;
40100a83887SPaul Traina 	d->bd_sig = SIGIO;
402560a54e1SJung-uk Kim 	d->bd_direction = BPF_D_INOUT;
40369f7644bSChristian S.J. Peron 	d->bd_pid = td->td_proc->p_pid;
40482f4445dSRobert Watson #ifdef MAC
40582f4445dSRobert Watson 	mac_init_bpfdesc(d);
40682f4445dSRobert Watson 	mac_create_bpfdesc(td->td_ucred, d);
40782f4445dSRobert Watson #endif
4086008862bSJohn Baldwin 	mtx_init(&d->bd_mtx, devtoname(dev), "bpf cdev lock", MTX_DEF);
40931199c84SGleb Smirnoff 	callout_init(&d->bd_callout, NET_CALLOUT_MPSAFE);
410571dcd15SSuleiman Souhlal 	knlist_init(&d->bd_sel.si_note, &d->bd_mtx, NULL, NULL, NULL);
411df8bae1dSRodney W. Grimes 
412df8bae1dSRodney W. Grimes 	return (0);
413df8bae1dSRodney W. Grimes }
414df8bae1dSRodney W. Grimes 
415df8bae1dSRodney W. Grimes /*
416df8bae1dSRodney W. Grimes  * Close the descriptor by detaching it from its interface,
417df8bae1dSRodney W. Grimes  * deallocating its buffers, and marking it free.
418df8bae1dSRodney W. Grimes  */
419df8bae1dSRodney W. Grimes /* ARGSUSED */
42087f6c662SJulian Elischer static	int
42119ba8395SChristian S.J. Peron bpfclose(struct cdev *dev, int flags, int fmt, struct thread *td)
422df8bae1dSRodney W. Grimes {
423e7bb21b3SJonathan Lemon 	struct bpf_d *d = dev->si_drv1;
424df8bae1dSRodney W. Grimes 
42581bda851SJohn Polstra 	BPFD_LOCK(d);
42681bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING)
42781bda851SJohn Polstra 		callout_stop(&d->bd_callout);
42881bda851SJohn Polstra 	d->bd_state = BPF_IDLE;
42981bda851SJohn Polstra 	BPFD_UNLOCK(d);
430e649887bSAlfred Perlstein 	funsetown(&d->bd_sigio);
431e7bb21b3SJonathan Lemon 	mtx_lock(&bpf_mtx);
432df8bae1dSRodney W. Grimes 	if (d->bd_bif)
433df8bae1dSRodney W. Grimes 		bpf_detachd(d);
434e7bb21b3SJonathan Lemon 	mtx_unlock(&bpf_mtx);
4354549709fSBrian Feldman 	selwakeuppri(&d->bd_sel, PRINET);
43682f4445dSRobert Watson #ifdef MAC
43782f4445dSRobert Watson 	mac_destroy_bpfdesc(d);
43882f4445dSRobert Watson #endif /* MAC */
439ad3b9257SJohn-Mark Gurney 	knlist_destroy(&d->bd_sel.si_note);
440df8bae1dSRodney W. Grimes 	bpf_freed(d);
441d17d8184SRobert Watson 	dev->si_drv1 = NULL;
442d722be54SLuigi Rizzo 	free(d, M_BPF);
443df8bae1dSRodney W. Grimes 
444df8bae1dSRodney W. Grimes 	return (0);
445df8bae1dSRodney W. Grimes }
446df8bae1dSRodney W. Grimes 
447df8bae1dSRodney W. Grimes 
448df8bae1dSRodney W. Grimes /*
449df8bae1dSRodney W. Grimes  * Rotate the packet buffers in descriptor d.  Move the store buffer
450df8bae1dSRodney W. Grimes  * into the hold slot, and the free buffer into the store slot.
451df8bae1dSRodney W. Grimes  * Zero the length of the new store buffer.
452df8bae1dSRodney W. Grimes  */
453df8bae1dSRodney W. Grimes #define ROTATE_BUFFERS(d) \
454df8bae1dSRodney W. Grimes 	(d)->bd_hbuf = (d)->bd_sbuf; \
455df8bae1dSRodney W. Grimes 	(d)->bd_hlen = (d)->bd_slen; \
456df8bae1dSRodney W. Grimes 	(d)->bd_sbuf = (d)->bd_fbuf; \
457df8bae1dSRodney W. Grimes 	(d)->bd_slen = 0; \
458d17d8184SRobert Watson 	(d)->bd_fbuf = NULL;
459df8bae1dSRodney W. Grimes /*
460df8bae1dSRodney W. Grimes  *  bpfread - read next chunk of packets from buffers
461df8bae1dSRodney W. Grimes  */
46287f6c662SJulian Elischer static	int
46319ba8395SChristian S.J. Peron bpfread(struct cdev *dev, struct uio *uio, int ioflag)
464df8bae1dSRodney W. Grimes {
465e7bb21b3SJonathan Lemon 	struct bpf_d *d = dev->si_drv1;
46681bda851SJohn Polstra 	int timed_out;
467df8bae1dSRodney W. Grimes 	int error;
468df8bae1dSRodney W. Grimes 
469df8bae1dSRodney W. Grimes 	/*
470df8bae1dSRodney W. Grimes 	 * Restrict application to use a buffer the same size as
471df8bae1dSRodney W. Grimes 	 * as kernel buffers.
472df8bae1dSRodney W. Grimes 	 */
473df8bae1dSRodney W. Grimes 	if (uio->uio_resid != d->bd_bufsize)
474df8bae1dSRodney W. Grimes 		return (EINVAL);
475df8bae1dSRodney W. Grimes 
476e7bb21b3SJonathan Lemon 	BPFD_LOCK(d);
47781bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING)
47881bda851SJohn Polstra 		callout_stop(&d->bd_callout);
47981bda851SJohn Polstra 	timed_out = (d->bd_state == BPF_TIMED_OUT);
48081bda851SJohn Polstra 	d->bd_state = BPF_IDLE;
481df8bae1dSRodney W. Grimes 	/*
482df8bae1dSRodney W. Grimes 	 * If the hold buffer is empty, then do a timed sleep, which
483df8bae1dSRodney W. Grimes 	 * ends when the timeout expires or when enough packets
484df8bae1dSRodney W. Grimes 	 * have arrived to fill the store buffer.
485df8bae1dSRodney W. Grimes 	 */
486572bde2aSRobert Watson 	while (d->bd_hbuf == NULL) {
48781bda851SJohn Polstra 		if ((d->bd_immediate || timed_out) && d->bd_slen != 0) {
488df8bae1dSRodney W. Grimes 			/*
489df8bae1dSRodney W. Grimes 			 * A packet(s) either arrived since the previous
490df8bae1dSRodney W. Grimes 			 * read or arrived while we were asleep.
491df8bae1dSRodney W. Grimes 			 * Rotate the buffers and return what's here.
492df8bae1dSRodney W. Grimes 			 */
493df8bae1dSRodney W. Grimes 			ROTATE_BUFFERS(d);
494df8bae1dSRodney W. Grimes 			break;
495df8bae1dSRodney W. Grimes 		}
496de5d9935SRobert Watson 
497de5d9935SRobert Watson 		/*
498de5d9935SRobert Watson 		 * No data is available, check to see if the bpf device
499de5d9935SRobert Watson 		 * is still pointed at a real interface.  If not, return
500de5d9935SRobert Watson 		 * ENXIO so that the userland process knows to rebind
501de5d9935SRobert Watson 		 * it before using it again.
502de5d9935SRobert Watson 		 */
503de5d9935SRobert Watson 		if (d->bd_bif == NULL) {
504e7bb21b3SJonathan Lemon 			BPFD_UNLOCK(d);
505de5d9935SRobert Watson 			return (ENXIO);
506de5d9935SRobert Watson 		}
507de5d9935SRobert Watson 
508e76eee55SPoul-Henning Kamp 		if (ioflag & O_NONBLOCK) {
509e7bb21b3SJonathan Lemon 			BPFD_UNLOCK(d);
510fba3cfdeSJohn Polstra 			return (EWOULDBLOCK);
511fba3cfdeSJohn Polstra 		}
512521f364bSDag-Erling Smørgrav 		error = msleep(d, &d->bd_mtx, PRINET|PCATCH,
513e7bb21b3SJonathan Lemon 		     "bpf", d->bd_rtout);
514df8bae1dSRodney W. Grimes 		if (error == EINTR || error == ERESTART) {
515e7bb21b3SJonathan Lemon 			BPFD_UNLOCK(d);
516df8bae1dSRodney W. Grimes 			return (error);
517df8bae1dSRodney W. Grimes 		}
518df8bae1dSRodney W. Grimes 		if (error == EWOULDBLOCK) {
519df8bae1dSRodney W. Grimes 			/*
520df8bae1dSRodney W. Grimes 			 * On a timeout, return what's in the buffer,
521df8bae1dSRodney W. Grimes 			 * which may be nothing.  If there is something
522df8bae1dSRodney W. Grimes 			 * in the store buffer, we can rotate the buffers.
523df8bae1dSRodney W. Grimes 			 */
524df8bae1dSRodney W. Grimes 			if (d->bd_hbuf)
525df8bae1dSRodney W. Grimes 				/*
526df8bae1dSRodney W. Grimes 				 * We filled up the buffer in between
527df8bae1dSRodney W. Grimes 				 * getting the timeout and arriving
528df8bae1dSRodney W. Grimes 				 * here, so we don't need to rotate.
529df8bae1dSRodney W. Grimes 				 */
530df8bae1dSRodney W. Grimes 				break;
531df8bae1dSRodney W. Grimes 
532df8bae1dSRodney W. Grimes 			if (d->bd_slen == 0) {
533e7bb21b3SJonathan Lemon 				BPFD_UNLOCK(d);
534df8bae1dSRodney W. Grimes 				return (0);
535df8bae1dSRodney W. Grimes 			}
536df8bae1dSRodney W. Grimes 			ROTATE_BUFFERS(d);
537df8bae1dSRodney W. Grimes 			break;
538df8bae1dSRodney W. Grimes 		}
539df8bae1dSRodney W. Grimes 	}
540df8bae1dSRodney W. Grimes 	/*
541df8bae1dSRodney W. Grimes 	 * At this point, we know we have something in the hold slot.
542df8bae1dSRodney W. Grimes 	 */
543e7bb21b3SJonathan Lemon 	BPFD_UNLOCK(d);
544df8bae1dSRodney W. Grimes 
545df8bae1dSRodney W. Grimes 	/*
546df8bae1dSRodney W. Grimes 	 * Move data from hold buffer into user space.
547df8bae1dSRodney W. Grimes 	 * We know the entire buffer is transferred since
548df8bae1dSRodney W. Grimes 	 * we checked above that the read buffer is bpf_bufsize bytes.
549df8bae1dSRodney W. Grimes 	 */
550e7bb21b3SJonathan Lemon 	error = uiomove(d->bd_hbuf, d->bd_hlen, uio);
551df8bae1dSRodney W. Grimes 
552e7bb21b3SJonathan Lemon 	BPFD_LOCK(d);
553df8bae1dSRodney W. Grimes 	d->bd_fbuf = d->bd_hbuf;
554572bde2aSRobert Watson 	d->bd_hbuf = NULL;
555df8bae1dSRodney W. Grimes 	d->bd_hlen = 0;
556e7bb21b3SJonathan Lemon 	BPFD_UNLOCK(d);
557df8bae1dSRodney W. Grimes 
558df8bae1dSRodney W. Grimes 	return (error);
559df8bae1dSRodney W. Grimes }
560df8bae1dSRodney W. Grimes 
561df8bae1dSRodney W. Grimes 
562df8bae1dSRodney W. Grimes /*
563df8bae1dSRodney W. Grimes  * If there are processes sleeping on this descriptor, wake them up.
564df8bae1dSRodney W. Grimes  */
565e7bb21b3SJonathan Lemon static __inline void
56619ba8395SChristian S.J. Peron bpf_wakeup(struct bpf_d *d)
567df8bae1dSRodney W. Grimes {
568a3272e3cSChristian S.J. Peron 
569a3272e3cSChristian S.J. Peron 	BPFD_LOCK_ASSERT(d);
57081bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING) {
57181bda851SJohn Polstra 		callout_stop(&d->bd_callout);
57281bda851SJohn Polstra 		d->bd_state = BPF_IDLE;
57381bda851SJohn Polstra 	}
574521f364bSDag-Erling Smørgrav 	wakeup(d);
575831d27a9SDon Lewis 	if (d->bd_async && d->bd_sig && d->bd_sigio)
576f1320723SAlfred Perlstein 		pgsigio(&d->bd_sigio, d->bd_sig, 0);
57700a83887SPaul Traina 
578512824f8SSeigo Tanimura 	selwakeuppri(&d->bd_sel, PRINET);
579ad3b9257SJohn-Mark Gurney 	KNOTE_LOCKED(&d->bd_sel.si_note, 0);
580df8bae1dSRodney W. Grimes }
581df8bae1dSRodney W. Grimes 
58281bda851SJohn Polstra static void
58319ba8395SChristian S.J. Peron bpf_timed_out(void *arg)
58481bda851SJohn Polstra {
58581bda851SJohn Polstra 	struct bpf_d *d = (struct bpf_d *)arg;
58681bda851SJohn Polstra 
58781bda851SJohn Polstra 	BPFD_LOCK(d);
58881bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING) {
58981bda851SJohn Polstra 		d->bd_state = BPF_TIMED_OUT;
59081bda851SJohn Polstra 		if (d->bd_slen != 0)
59181bda851SJohn Polstra 			bpf_wakeup(d);
59281bda851SJohn Polstra 	}
59381bda851SJohn Polstra 	BPFD_UNLOCK(d);
59481bda851SJohn Polstra }
59581bda851SJohn Polstra 
59687f6c662SJulian Elischer static int
59719ba8395SChristian S.J. Peron bpfwrite(struct cdev *dev, struct uio *uio, int ioflag)
598df8bae1dSRodney W. Grimes {
599e7bb21b3SJonathan Lemon 	struct bpf_d *d = dev->si_drv1;
600df8bae1dSRodney W. Grimes 	struct ifnet *ifp;
601560a54e1SJung-uk Kim 	struct mbuf *m, *mc;
6028240bf1eSRobert Watson 	struct sockaddr dst;
603560a54e1SJung-uk Kim 	int error, hlen;
604df8bae1dSRodney W. Grimes 
605572bde2aSRobert Watson 	if (d->bd_bif == NULL)
606df8bae1dSRodney W. Grimes 		return (ENXIO);
607df8bae1dSRodney W. Grimes 
608df8bae1dSRodney W. Grimes 	ifp = d->bd_bif->bif_ifp;
609df8bae1dSRodney W. Grimes 
6103518d220SSam Leffler 	if ((ifp->if_flags & IFF_UP) == 0)
6113518d220SSam Leffler 		return (ENETDOWN);
6123518d220SSam Leffler 
613df8bae1dSRodney W. Grimes 	if (uio->uio_resid == 0)
614df8bae1dSRodney W. Grimes 		return (0);
615df8bae1dSRodney W. Grimes 
6168240bf1eSRobert Watson 	bzero(&dst, sizeof(dst));
61793e39f0bSChristian S.J. Peron 	error = bpf_movein(uio, (int)d->bd_bif->bif_dlt, ifp->if_mtu,
618560a54e1SJung-uk Kim 	    &m, &dst, &hlen, d->bd_wfilter);
619df8bae1dSRodney W. Grimes 	if (error)
620df8bae1dSRodney W. Grimes 		return (error);
621df8bae1dSRodney W. Grimes 
622114ae644SMike Smith 	if (d->bd_hdrcmplt)
623114ae644SMike Smith 		dst.sa_family = pseudo_AF_HDRCMPLT;
624114ae644SMike Smith 
625560a54e1SJung-uk Kim 	if (d->bd_feedback) {
626560a54e1SJung-uk Kim 		mc = m_dup(m, M_DONTWAIT);
627560a54e1SJung-uk Kim 		if (mc != NULL)
628560a54e1SJung-uk Kim 			mc->m_pkthdr.rcvif = ifp;
629560a54e1SJung-uk Kim 		/* XXX Do not return the same packet twice. */
630560a54e1SJung-uk Kim 		if (d->bd_direction == BPF_D_INOUT)
631560a54e1SJung-uk Kim 			m->m_flags |= M_SKIP_BPF;
632560a54e1SJung-uk Kim 	} else
633560a54e1SJung-uk Kim 		mc = NULL;
634560a54e1SJung-uk Kim 
635560a54e1SJung-uk Kim 	m->m_pkthdr.len -= hlen;
636560a54e1SJung-uk Kim 	m->m_len -= hlen;
637560a54e1SJung-uk Kim 	m->m_data += hlen;	/* XXX */
638560a54e1SJung-uk Kim 
63982f4445dSRobert Watson #ifdef MAC
640f747d2ddSRobert Watson 	BPFD_LOCK(d);
64182f4445dSRobert Watson 	mac_create_mbuf_from_bpfdesc(d, m);
642560a54e1SJung-uk Kim 	if (mc != NULL)
643560a54e1SJung-uk Kim 		mac_create_mbuf_from_bpfdesc(d, mc);
644f747d2ddSRobert Watson 	BPFD_UNLOCK(d);
64582f4445dSRobert Watson #endif
646560a54e1SJung-uk Kim 
647b8f9429dSRobert Watson 	NET_LOCK_GIANT();
648572bde2aSRobert Watson 	error = (*ifp->if_output)(ifp, m, &dst, NULL);
649b8f9429dSRobert Watson 	NET_UNLOCK_GIANT();
650560a54e1SJung-uk Kim 
651560a54e1SJung-uk Kim 	if (mc != NULL) {
652560a54e1SJung-uk Kim 		if (error == 0) {
653560a54e1SJung-uk Kim 			NET_LOCK_GIANT();
654560a54e1SJung-uk Kim 			(*ifp->if_input)(ifp, mc);
655560a54e1SJung-uk Kim 			NET_UNLOCK_GIANT();
656560a54e1SJung-uk Kim 		} else
657560a54e1SJung-uk Kim 			m_freem(mc);
658560a54e1SJung-uk Kim 	}
659560a54e1SJung-uk Kim 
660df8bae1dSRodney W. Grimes 	return (error);
661df8bae1dSRodney W. Grimes }
662df8bae1dSRodney W. Grimes 
663df8bae1dSRodney W. Grimes /*
664df8bae1dSRodney W. Grimes  * Reset a descriptor by flushing its packet buffer and clearing the
665e7bb21b3SJonathan Lemon  * receive and drop counts.
666df8bae1dSRodney W. Grimes  */
667df8bae1dSRodney W. Grimes static void
66819ba8395SChristian S.J. Peron reset_d(struct bpf_d *d)
669df8bae1dSRodney W. Grimes {
670e7bb21b3SJonathan Lemon 
671e7bb21b3SJonathan Lemon 	mtx_assert(&d->bd_mtx, MA_OWNED);
672df8bae1dSRodney W. Grimes 	if (d->bd_hbuf) {
673df8bae1dSRodney W. Grimes 		/* Free the hold buffer. */
674df8bae1dSRodney W. Grimes 		d->bd_fbuf = d->bd_hbuf;
675572bde2aSRobert Watson 		d->bd_hbuf = NULL;
676df8bae1dSRodney W. Grimes 	}
677df8bae1dSRodney W. Grimes 	d->bd_slen = 0;
678df8bae1dSRodney W. Grimes 	d->bd_hlen = 0;
679df8bae1dSRodney W. Grimes 	d->bd_rcount = 0;
680df8bae1dSRodney W. Grimes 	d->bd_dcount = 0;
68169f7644bSChristian S.J. Peron 	d->bd_fcount = 0;
682df8bae1dSRodney W. Grimes }
683df8bae1dSRodney W. Grimes 
684df8bae1dSRodney W. Grimes /*
685df8bae1dSRodney W. Grimes  *  FIONREAD		Check for read packet available.
686df8bae1dSRodney W. Grimes  *  SIOCGIFADDR		Get interface address - convenient hook to driver.
687df8bae1dSRodney W. Grimes  *  BIOCGBLEN		Get buffer len [for read()].
688df8bae1dSRodney W. Grimes  *  BIOCSETF		Set ethernet read filter.
68993e39f0bSChristian S.J. Peron  *  BIOCSETWF		Set ethernet write filter.
690df8bae1dSRodney W. Grimes  *  BIOCFLUSH		Flush read packet buffer.
691df8bae1dSRodney W. Grimes  *  BIOCPROMISC		Put interface into promiscuous mode.
692df8bae1dSRodney W. Grimes  *  BIOCGDLT		Get link layer type.
693df8bae1dSRodney W. Grimes  *  BIOCGETIF		Get interface name.
694df8bae1dSRodney W. Grimes  *  BIOCSETIF		Set interface.
695df8bae1dSRodney W. Grimes  *  BIOCSRTIMEOUT	Set read timeout.
696df8bae1dSRodney W. Grimes  *  BIOCGRTIMEOUT	Get read timeout.
697df8bae1dSRodney W. Grimes  *  BIOCGSTATS		Get packet stats.
698df8bae1dSRodney W. Grimes  *  BIOCIMMEDIATE	Set immediate mode.
699df8bae1dSRodney W. Grimes  *  BIOCVERSION		Get filter language version.
700114ae644SMike Smith  *  BIOCGHDRCMPLT	Get "header already complete" flag
701114ae644SMike Smith  *  BIOCSHDRCMPLT	Set "header already complete" flag
702560a54e1SJung-uk Kim  *  BIOCGDIRECTION	Get packet direction flag
703560a54e1SJung-uk Kim  *  BIOCSDIRECTION	Set packet direction flag
70493e39f0bSChristian S.J. Peron  *  BIOCLOCK		Set "locked" flag
705560a54e1SJung-uk Kim  *  BIOCFEEDBACK	Set packet feedback mode.
706df8bae1dSRodney W. Grimes  */
707df8bae1dSRodney W. Grimes /* ARGSUSED */
70887f6c662SJulian Elischer static	int
70919ba8395SChristian S.J. Peron bpfioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags,
71019ba8395SChristian S.J. Peron     struct thread *td)
711df8bae1dSRodney W. Grimes {
712e7bb21b3SJonathan Lemon 	struct bpf_d *d = dev->si_drv1;
713e7bb21b3SJonathan Lemon 	int error = 0;
714df8bae1dSRodney W. Grimes 
715b75a24a0SChristian S.J. Peron 	/*
716b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
717b75a24a0SChristian S.J. Peron 	 */
71881bda851SJohn Polstra 	BPFD_LOCK(d);
719cb1d4f92SChristian S.J. Peron 	d->bd_pid = td->td_proc->p_pid;
72081bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING)
72181bda851SJohn Polstra 		callout_stop(&d->bd_callout);
72281bda851SJohn Polstra 	d->bd_state = BPF_IDLE;
72381bda851SJohn Polstra 	BPFD_UNLOCK(d);
72481bda851SJohn Polstra 
72593e39f0bSChristian S.J. Peron 	if (d->bd_locked == 1) {
72693e39f0bSChristian S.J. Peron 		switch (cmd) {
72793e39f0bSChristian S.J. Peron 		case BIOCGBLEN:
72893e39f0bSChristian S.J. Peron 		case BIOCFLUSH:
72993e39f0bSChristian S.J. Peron 		case BIOCGDLT:
73093e39f0bSChristian S.J. Peron 		case BIOCGDLTLIST:
73193e39f0bSChristian S.J. Peron 		case BIOCGETIF:
73293e39f0bSChristian S.J. Peron 		case BIOCGRTIMEOUT:
73393e39f0bSChristian S.J. Peron 		case BIOCGSTATS:
73493e39f0bSChristian S.J. Peron 		case BIOCVERSION:
73593e39f0bSChristian S.J. Peron 		case BIOCGRSIG:
73693e39f0bSChristian S.J. Peron 		case BIOCGHDRCMPLT:
737560a54e1SJung-uk Kim 		case BIOCFEEDBACK:
73893e39f0bSChristian S.J. Peron 		case FIONREAD:
73993e39f0bSChristian S.J. Peron 		case BIOCLOCK:
74093e39f0bSChristian S.J. Peron 		case BIOCSRTIMEOUT:
74193e39f0bSChristian S.J. Peron 		case BIOCIMMEDIATE:
74293e39f0bSChristian S.J. Peron 		case TIOCGPGRP:
74393e39f0bSChristian S.J. Peron 			break;
74493e39f0bSChristian S.J. Peron 		default:
74593e39f0bSChristian S.J. Peron 			return (EPERM);
74693e39f0bSChristian S.J. Peron 		}
74793e39f0bSChristian S.J. Peron 	}
748df8bae1dSRodney W. Grimes 	switch (cmd) {
749df8bae1dSRodney W. Grimes 
750df8bae1dSRodney W. Grimes 	default:
751df8bae1dSRodney W. Grimes 		error = EINVAL;
752df8bae1dSRodney W. Grimes 		break;
753df8bae1dSRodney W. Grimes 
754df8bae1dSRodney W. Grimes 	/*
755df8bae1dSRodney W. Grimes 	 * Check for read packet available.
756df8bae1dSRodney W. Grimes 	 */
757df8bae1dSRodney W. Grimes 	case FIONREAD:
758df8bae1dSRodney W. Grimes 		{
759df8bae1dSRodney W. Grimes 			int n;
760df8bae1dSRodney W. Grimes 
761e7bb21b3SJonathan Lemon 			BPFD_LOCK(d);
762df8bae1dSRodney W. Grimes 			n = d->bd_slen;
763df8bae1dSRodney W. Grimes 			if (d->bd_hbuf)
764df8bae1dSRodney W. Grimes 				n += d->bd_hlen;
765e7bb21b3SJonathan Lemon 			BPFD_UNLOCK(d);
766df8bae1dSRodney W. Grimes 
767df8bae1dSRodney W. Grimes 			*(int *)addr = n;
768df8bae1dSRodney W. Grimes 			break;
769df8bae1dSRodney W. Grimes 		}
770df8bae1dSRodney W. Grimes 
771df8bae1dSRodney W. Grimes 	case SIOCGIFADDR:
772df8bae1dSRodney W. Grimes 		{
773df8bae1dSRodney W. Grimes 			struct ifnet *ifp;
774df8bae1dSRodney W. Grimes 
775572bde2aSRobert Watson 			if (d->bd_bif == NULL)
776df8bae1dSRodney W. Grimes 				error = EINVAL;
777df8bae1dSRodney W. Grimes 			else {
778df8bae1dSRodney W. Grimes 				ifp = d->bd_bif->bif_ifp;
779df8bae1dSRodney W. Grimes 				error = (*ifp->if_ioctl)(ifp, cmd, addr);
780df8bae1dSRodney W. Grimes 			}
781df8bae1dSRodney W. Grimes 			break;
782df8bae1dSRodney W. Grimes 		}
783df8bae1dSRodney W. Grimes 
784df8bae1dSRodney W. Grimes 	/*
785df8bae1dSRodney W. Grimes 	 * Get buffer len [for read()].
786df8bae1dSRodney W. Grimes 	 */
787df8bae1dSRodney W. Grimes 	case BIOCGBLEN:
788df8bae1dSRodney W. Grimes 		*(u_int *)addr = d->bd_bufsize;
789df8bae1dSRodney W. Grimes 		break;
790df8bae1dSRodney W. Grimes 
791df8bae1dSRodney W. Grimes 	/*
792df8bae1dSRodney W. Grimes 	 * Set buffer length.
793df8bae1dSRodney W. Grimes 	 */
794df8bae1dSRodney W. Grimes 	case BIOCSBLEN:
795572bde2aSRobert Watson 		if (d->bd_bif != NULL)
796df8bae1dSRodney W. Grimes 			error = EINVAL;
797df8bae1dSRodney W. Grimes 		else {
7988994a245SDag-Erling Smørgrav 			u_int size = *(u_int *)addr;
799df8bae1dSRodney W. Grimes 
800eba2a1aeSPoul-Henning Kamp 			if (size > bpf_maxbufsize)
801eba2a1aeSPoul-Henning Kamp 				*(u_int *)addr = size = bpf_maxbufsize;
802df8bae1dSRodney W. Grimes 			else if (size < BPF_MINBUFSIZE)
803df8bae1dSRodney W. Grimes 				*(u_int *)addr = size = BPF_MINBUFSIZE;
804df8bae1dSRodney W. Grimes 			d->bd_bufsize = size;
805df8bae1dSRodney W. Grimes 		}
806df8bae1dSRodney W. Grimes 		break;
807df8bae1dSRodney W. Grimes 
808df8bae1dSRodney W. Grimes 	/*
809df8bae1dSRodney W. Grimes 	 * Set link layer read filter.
810df8bae1dSRodney W. Grimes 	 */
811df8bae1dSRodney W. Grimes 	case BIOCSETF:
81293e39f0bSChristian S.J. Peron 	case BIOCSETWF:
81393e39f0bSChristian S.J. Peron 		error = bpf_setf(d, (struct bpf_program *)addr, cmd);
814df8bae1dSRodney W. Grimes 		break;
815df8bae1dSRodney W. Grimes 
816df8bae1dSRodney W. Grimes 	/*
817df8bae1dSRodney W. Grimes 	 * Flush read packet buffer.
818df8bae1dSRodney W. Grimes 	 */
819df8bae1dSRodney W. Grimes 	case BIOCFLUSH:
820e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
821df8bae1dSRodney W. Grimes 		reset_d(d);
822e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
823df8bae1dSRodney W. Grimes 		break;
824df8bae1dSRodney W. Grimes 
825df8bae1dSRodney W. Grimes 	/*
826df8bae1dSRodney W. Grimes 	 * Put interface into promiscuous mode.
827df8bae1dSRodney W. Grimes 	 */
828df8bae1dSRodney W. Grimes 	case BIOCPROMISC:
829572bde2aSRobert Watson 		if (d->bd_bif == NULL) {
830df8bae1dSRodney W. Grimes 			/*
831df8bae1dSRodney W. Grimes 			 * No interface attached yet.
832df8bae1dSRodney W. Grimes 			 */
833df8bae1dSRodney W. Grimes 			error = EINVAL;
834df8bae1dSRodney W. Grimes 			break;
835df8bae1dSRodney W. Grimes 		}
836df8bae1dSRodney W. Grimes 		if (d->bd_promisc == 0) {
837e7bb21b3SJonathan Lemon 			mtx_lock(&Giant);
838df8bae1dSRodney W. Grimes 			error = ifpromisc(d->bd_bif->bif_ifp, 1);
839e7bb21b3SJonathan Lemon 			mtx_unlock(&Giant);
840df8bae1dSRodney W. Grimes 			if (error == 0)
841df8bae1dSRodney W. Grimes 				d->bd_promisc = 1;
842df8bae1dSRodney W. Grimes 		}
843df8bae1dSRodney W. Grimes 		break;
844df8bae1dSRodney W. Grimes 
845df8bae1dSRodney W. Grimes 	/*
8468eab61f3SSam Leffler 	 * Get current data link type.
847df8bae1dSRodney W. Grimes 	 */
848df8bae1dSRodney W. Grimes 	case BIOCGDLT:
849572bde2aSRobert Watson 		if (d->bd_bif == NULL)
850df8bae1dSRodney W. Grimes 			error = EINVAL;
851df8bae1dSRodney W. Grimes 		else
852df8bae1dSRodney W. Grimes 			*(u_int *)addr = d->bd_bif->bif_dlt;
853df8bae1dSRodney W. Grimes 		break;
854df8bae1dSRodney W. Grimes 
855df8bae1dSRodney W. Grimes 	/*
8568eab61f3SSam Leffler 	 * Get a list of supported data link types.
8578eab61f3SSam Leffler 	 */
8588eab61f3SSam Leffler 	case BIOCGDLTLIST:
859572bde2aSRobert Watson 		if (d->bd_bif == NULL)
8608eab61f3SSam Leffler 			error = EINVAL;
8618eab61f3SSam Leffler 		else
8628eab61f3SSam Leffler 			error = bpf_getdltlist(d, (struct bpf_dltlist *)addr);
8638eab61f3SSam Leffler 		break;
8648eab61f3SSam Leffler 
8658eab61f3SSam Leffler 	/*
8668eab61f3SSam Leffler 	 * Set data link type.
8678eab61f3SSam Leffler 	 */
8688eab61f3SSam Leffler 	case BIOCSDLT:
869572bde2aSRobert Watson 		if (d->bd_bif == NULL)
8708eab61f3SSam Leffler 			error = EINVAL;
8718eab61f3SSam Leffler 		else
8728eab61f3SSam Leffler 			error = bpf_setdlt(d, *(u_int *)addr);
8738eab61f3SSam Leffler 		break;
8748eab61f3SSam Leffler 
8758eab61f3SSam Leffler 	/*
8761dd0feaaSArchie Cobbs 	 * Get interface name.
877df8bae1dSRodney W. Grimes 	 */
878df8bae1dSRodney W. Grimes 	case BIOCGETIF:
879572bde2aSRobert Watson 		if (d->bd_bif == NULL)
880df8bae1dSRodney W. Grimes 			error = EINVAL;
8811dd0feaaSArchie Cobbs 		else {
8821dd0feaaSArchie Cobbs 			struct ifnet *const ifp = d->bd_bif->bif_ifp;
8831dd0feaaSArchie Cobbs 			struct ifreq *const ifr = (struct ifreq *)addr;
8841dd0feaaSArchie Cobbs 
8859bf40edeSBrooks Davis 			strlcpy(ifr->ifr_name, ifp->if_xname,
8869bf40edeSBrooks Davis 			    sizeof(ifr->ifr_name));
8871dd0feaaSArchie Cobbs 		}
888df8bae1dSRodney W. Grimes 		break;
889df8bae1dSRodney W. Grimes 
890df8bae1dSRodney W. Grimes 	/*
891df8bae1dSRodney W. Grimes 	 * Set interface.
892df8bae1dSRodney W. Grimes 	 */
893df8bae1dSRodney W. Grimes 	case BIOCSETIF:
894df8bae1dSRodney W. Grimes 		error = bpf_setif(d, (struct ifreq *)addr);
895df8bae1dSRodney W. Grimes 		break;
896df8bae1dSRodney W. Grimes 
897df8bae1dSRodney W. Grimes 	/*
898df8bae1dSRodney W. Grimes 	 * Set read timeout.
899df8bae1dSRodney W. Grimes 	 */
900df8bae1dSRodney W. Grimes 	case BIOCSRTIMEOUT:
901df8bae1dSRodney W. Grimes 		{
902df8bae1dSRodney W. Grimes 			struct timeval *tv = (struct timeval *)addr;
903df8bae1dSRodney W. Grimes 
904bdc2cdc5SAlexander Langer 			/*
905bdc2cdc5SAlexander Langer 			 * Subtract 1 tick from tvtohz() since this isn't
906bdc2cdc5SAlexander Langer 			 * a one-shot timer.
907bdc2cdc5SAlexander Langer 			 */
908bdc2cdc5SAlexander Langer 			if ((error = itimerfix(tv)) == 0)
909bdc2cdc5SAlexander Langer 				d->bd_rtout = tvtohz(tv) - 1;
910df8bae1dSRodney W. Grimes 			break;
911df8bae1dSRodney W. Grimes 		}
912df8bae1dSRodney W. Grimes 
913df8bae1dSRodney W. Grimes 	/*
914df8bae1dSRodney W. Grimes 	 * Get read timeout.
915df8bae1dSRodney W. Grimes 	 */
916df8bae1dSRodney W. Grimes 	case BIOCGRTIMEOUT:
917df8bae1dSRodney W. Grimes 		{
918df8bae1dSRodney W. Grimes 			struct timeval *tv = (struct timeval *)addr;
919df8bae1dSRodney W. Grimes 
920bdc2cdc5SAlexander Langer 			tv->tv_sec = d->bd_rtout / hz;
921bdc2cdc5SAlexander Langer 			tv->tv_usec = (d->bd_rtout % hz) * tick;
922df8bae1dSRodney W. Grimes 			break;
923df8bae1dSRodney W. Grimes 		}
924df8bae1dSRodney W. Grimes 
925df8bae1dSRodney W. Grimes 	/*
926df8bae1dSRodney W. Grimes 	 * Get packet stats.
927df8bae1dSRodney W. Grimes 	 */
928df8bae1dSRodney W. Grimes 	case BIOCGSTATS:
929df8bae1dSRodney W. Grimes 		{
930df8bae1dSRodney W. Grimes 			struct bpf_stat *bs = (struct bpf_stat *)addr;
931df8bae1dSRodney W. Grimes 
932df8bae1dSRodney W. Grimes 			bs->bs_recv = d->bd_rcount;
933df8bae1dSRodney W. Grimes 			bs->bs_drop = d->bd_dcount;
934df8bae1dSRodney W. Grimes 			break;
935df8bae1dSRodney W. Grimes 		}
936df8bae1dSRodney W. Grimes 
937df8bae1dSRodney W. Grimes 	/*
938df8bae1dSRodney W. Grimes 	 * Set immediate mode.
939df8bae1dSRodney W. Grimes 	 */
940df8bae1dSRodney W. Grimes 	case BIOCIMMEDIATE:
941df8bae1dSRodney W. Grimes 		d->bd_immediate = *(u_int *)addr;
942df8bae1dSRodney W. Grimes 		break;
943df8bae1dSRodney W. Grimes 
944df8bae1dSRodney W. Grimes 	case BIOCVERSION:
945df8bae1dSRodney W. Grimes 		{
946df8bae1dSRodney W. Grimes 			struct bpf_version *bv = (struct bpf_version *)addr;
947df8bae1dSRodney W. Grimes 
948df8bae1dSRodney W. Grimes 			bv->bv_major = BPF_MAJOR_VERSION;
949df8bae1dSRodney W. Grimes 			bv->bv_minor = BPF_MINOR_VERSION;
950df8bae1dSRodney W. Grimes 			break;
951df8bae1dSRodney W. Grimes 		}
95200a83887SPaul Traina 
953114ae644SMike Smith 	/*
954114ae644SMike Smith 	 * Get "header already complete" flag
955114ae644SMike Smith 	 */
956114ae644SMike Smith 	case BIOCGHDRCMPLT:
957114ae644SMike Smith 		*(u_int *)addr = d->bd_hdrcmplt;
958114ae644SMike Smith 		break;
959114ae644SMike Smith 
960114ae644SMike Smith 	/*
961114ae644SMike Smith 	 * Set "header already complete" flag
962114ae644SMike Smith 	 */
963114ae644SMike Smith 	case BIOCSHDRCMPLT:
964114ae644SMike Smith 		d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0;
965114ae644SMike Smith 		break;
966114ae644SMike Smith 
9678ed3828cSRobert Watson 	/*
968560a54e1SJung-uk Kim 	 * Get packet direction flag
9698ed3828cSRobert Watson 	 */
970560a54e1SJung-uk Kim 	case BIOCGDIRECTION:
971560a54e1SJung-uk Kim 		*(u_int *)addr = d->bd_direction;
9728ed3828cSRobert Watson 		break;
9738ed3828cSRobert Watson 
9748ed3828cSRobert Watson 	/*
975560a54e1SJung-uk Kim 	 * Set packet direction flag
9768ed3828cSRobert Watson 	 */
977560a54e1SJung-uk Kim 	case BIOCSDIRECTION:
978560a54e1SJung-uk Kim 		{
979560a54e1SJung-uk Kim 			u_int	direction;
980560a54e1SJung-uk Kim 
981560a54e1SJung-uk Kim 			direction = *(u_int *)addr;
982560a54e1SJung-uk Kim 			switch (direction) {
983560a54e1SJung-uk Kim 			case BPF_D_IN:
984560a54e1SJung-uk Kim 			case BPF_D_INOUT:
985560a54e1SJung-uk Kim 			case BPF_D_OUT:
986560a54e1SJung-uk Kim 				d->bd_direction = direction;
987560a54e1SJung-uk Kim 				break;
988560a54e1SJung-uk Kim 			default:
989560a54e1SJung-uk Kim 				error = EINVAL;
990560a54e1SJung-uk Kim 			}
991560a54e1SJung-uk Kim 		}
992560a54e1SJung-uk Kim 		break;
993560a54e1SJung-uk Kim 
994560a54e1SJung-uk Kim 	case BIOCFEEDBACK:
995560a54e1SJung-uk Kim 		d->bd_feedback = *(u_int *)addr;
996560a54e1SJung-uk Kim 		break;
997560a54e1SJung-uk Kim 
998560a54e1SJung-uk Kim 	case BIOCLOCK:
999560a54e1SJung-uk Kim 		d->bd_locked = 1;
10008ed3828cSRobert Watson 		break;
10018ed3828cSRobert Watson 
100200a83887SPaul Traina 	case FIONBIO:		/* Non-blocking I/O */
100300a83887SPaul Traina 		break;
100400a83887SPaul Traina 
100500a83887SPaul Traina 	case FIOASYNC:		/* Send signal on receive packets */
100600a83887SPaul Traina 		d->bd_async = *(int *)addr;
100700a83887SPaul Traina 		break;
100800a83887SPaul Traina 
1009831d27a9SDon Lewis 	case FIOSETOWN:
1010831d27a9SDon Lewis 		error = fsetown(*(int *)addr, &d->bd_sigio);
101100a83887SPaul Traina 		break;
101200a83887SPaul Traina 
1013831d27a9SDon Lewis 	case FIOGETOWN:
101491e97a82SDon Lewis 		*(int *)addr = fgetown(&d->bd_sigio);
1015831d27a9SDon Lewis 		break;
1016831d27a9SDon Lewis 
1017831d27a9SDon Lewis 	/* This is deprecated, FIOSETOWN should be used instead. */
1018831d27a9SDon Lewis 	case TIOCSPGRP:
1019831d27a9SDon Lewis 		error = fsetown(-(*(int *)addr), &d->bd_sigio);
1020831d27a9SDon Lewis 		break;
1021831d27a9SDon Lewis 
1022831d27a9SDon Lewis 	/* This is deprecated, FIOGETOWN should be used instead. */
102300a83887SPaul Traina 	case TIOCGPGRP:
102491e97a82SDon Lewis 		*(int *)addr = -fgetown(&d->bd_sigio);
102500a83887SPaul Traina 		break;
102600a83887SPaul Traina 
102700a83887SPaul Traina 	case BIOCSRSIG:		/* Set receive signal */
102800a83887SPaul Traina 		{
102900a83887SPaul Traina 			u_int sig;
103000a83887SPaul Traina 
103100a83887SPaul Traina 			sig = *(u_int *)addr;
103200a83887SPaul Traina 
103300a83887SPaul Traina 			if (sig >= NSIG)
103400a83887SPaul Traina 				error = EINVAL;
103500a83887SPaul Traina 			else
103600a83887SPaul Traina 				d->bd_sig = sig;
103700a83887SPaul Traina 			break;
103800a83887SPaul Traina 		}
103900a83887SPaul Traina 	case BIOCGRSIG:
104000a83887SPaul Traina 		*(u_int *)addr = d->bd_sig;
104100a83887SPaul Traina 		break;
1042df8bae1dSRodney W. Grimes 	}
1043df8bae1dSRodney W. Grimes 	return (error);
1044df8bae1dSRodney W. Grimes }
1045df8bae1dSRodney W. Grimes 
1046df8bae1dSRodney W. Grimes /*
1047df8bae1dSRodney W. Grimes  * Set d's packet filter program to fp.  If this file already has a filter,
1048df8bae1dSRodney W. Grimes  * free it and replace it.  Returns EINVAL for bogus requests.
1049df8bae1dSRodney W. Grimes  */
1050f708ef1bSPoul-Henning Kamp static int
105119ba8395SChristian S.J. Peron bpf_setf(struct bpf_d *d, struct bpf_program *fp, u_long cmd)
1052df8bae1dSRodney W. Grimes {
1053df8bae1dSRodney W. Grimes 	struct bpf_insn *fcode, *old;
105493e39f0bSChristian S.J. Peron 	u_int wfilter, flen, size;
1055293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1056ae275efcSJung-uk Kim 	bpf_jit_filter *ofunc;
1057ae275efcSJung-uk Kim #endif
1058df8bae1dSRodney W. Grimes 
105993e39f0bSChristian S.J. Peron 	if (cmd == BIOCSETWF) {
106093e39f0bSChristian S.J. Peron 		old = d->bd_wfilter;
106193e39f0bSChristian S.J. Peron 		wfilter = 1;
1062293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1063ae275efcSJung-uk Kim 		ofunc = NULL;
1064ae275efcSJung-uk Kim #endif
106593e39f0bSChristian S.J. Peron 	} else {
106693e39f0bSChristian S.J. Peron 		wfilter = 0;
106793e39f0bSChristian S.J. Peron 		old = d->bd_rfilter;
1068293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1069ae275efcSJung-uk Kim 		ofunc = d->bd_bfilter;
1070ae275efcSJung-uk Kim #endif
107193e39f0bSChristian S.J. Peron 	}
1072572bde2aSRobert Watson 	if (fp->bf_insns == NULL) {
1073df8bae1dSRodney W. Grimes 		if (fp->bf_len != 0)
1074df8bae1dSRodney W. Grimes 			return (EINVAL);
1075e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
107693e39f0bSChristian S.J. Peron 		if (wfilter)
107793e39f0bSChristian S.J. Peron 			d->bd_wfilter = NULL;
1078ae275efcSJung-uk Kim 		else {
107993e39f0bSChristian S.J. Peron 			d->bd_rfilter = NULL;
1080293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1081ae275efcSJung-uk Kim 			d->bd_bfilter = NULL;
1082ae275efcSJung-uk Kim #endif
1083ae275efcSJung-uk Kim 		}
1084df8bae1dSRodney W. Grimes 		reset_d(d);
1085e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
1086572bde2aSRobert Watson 		if (old != NULL)
1087bd3a5320SPoul-Henning Kamp 			free((caddr_t)old, M_BPF);
1088293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1089ae275efcSJung-uk Kim 		if (ofunc != NULL)
1090ae275efcSJung-uk Kim 			bpf_destroy_jit_filter(ofunc);
1091ae275efcSJung-uk Kim #endif
1092df8bae1dSRodney W. Grimes 		return (0);
1093df8bae1dSRodney W. Grimes 	}
1094df8bae1dSRodney W. Grimes 	flen = fp->bf_len;
10950eb20604SChristian S.J. Peron 	if (flen > bpf_maxinsns)
1096df8bae1dSRodney W. Grimes 		return (EINVAL);
1097df8bae1dSRodney W. Grimes 
1098df8bae1dSRodney W. Grimes 	size = flen * sizeof(*fp->bf_insns);
1099a163d034SWarner Losh 	fcode = (struct bpf_insn *)malloc(size, M_BPF, M_WAITOK);
1100df8bae1dSRodney W. Grimes 	if (copyin((caddr_t)fp->bf_insns, (caddr_t)fcode, size) == 0 &&
1101df8bae1dSRodney W. Grimes 	    bpf_validate(fcode, (int)flen)) {
1102e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
110393e39f0bSChristian S.J. Peron 		if (wfilter)
110493e39f0bSChristian S.J. Peron 			d->bd_wfilter = fcode;
1105ae275efcSJung-uk Kim 		else {
110693e39f0bSChristian S.J. Peron 			d->bd_rfilter = fcode;
1107293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1108ae275efcSJung-uk Kim 			d->bd_bfilter = bpf_jitter(fcode, flen);
1109ae275efcSJung-uk Kim #endif
1110ae275efcSJung-uk Kim 		}
1111df8bae1dSRodney W. Grimes 		reset_d(d);
1112e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
1113572bde2aSRobert Watson 		if (old != NULL)
1114bd3a5320SPoul-Henning Kamp 			free((caddr_t)old, M_BPF);
1115293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1116ae275efcSJung-uk Kim 		if (ofunc != NULL)
1117ae275efcSJung-uk Kim 			bpf_destroy_jit_filter(ofunc);
1118ae275efcSJung-uk Kim #endif
1119df8bae1dSRodney W. Grimes 
1120df8bae1dSRodney W. Grimes 		return (0);
1121df8bae1dSRodney W. Grimes 	}
1122bd3a5320SPoul-Henning Kamp 	free((caddr_t)fcode, M_BPF);
1123df8bae1dSRodney W. Grimes 	return (EINVAL);
1124df8bae1dSRodney W. Grimes }
1125df8bae1dSRodney W. Grimes 
1126df8bae1dSRodney W. Grimes /*
1127df8bae1dSRodney W. Grimes  * Detach a file from its current interface (if attached at all) and attach
1128df8bae1dSRodney W. Grimes  * to the interface indicated by the name stored in ifr.
1129df8bae1dSRodney W. Grimes  * Return an errno or 0.
1130df8bae1dSRodney W. Grimes  */
1131df8bae1dSRodney W. Grimes static int
113219ba8395SChristian S.J. Peron bpf_setif(struct bpf_d *d, struct ifreq *ifr)
1133df8bae1dSRodney W. Grimes {
1134df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
11359b44ff22SGarrett Wollman 	struct ifnet *theywant;
1136df8bae1dSRodney W. Grimes 
11379b44ff22SGarrett Wollman 	theywant = ifunit(ifr->ifr_name);
113816d878ccSChristian S.J. Peron 	if (theywant == NULL || theywant->if_bpf == NULL)
113916d878ccSChristian S.J. Peron 		return (ENXIO);
11409b44ff22SGarrett Wollman 
114116d878ccSChristian S.J. Peron 	bp = theywant->if_bpf;
1142df8bae1dSRodney W. Grimes 	/*
1143df8bae1dSRodney W. Grimes 	 * Allocate the packet buffers if we need to.
1144df8bae1dSRodney W. Grimes 	 * If we're already attached to requested interface,
1145df8bae1dSRodney W. Grimes 	 * just flush the buffer.
1146df8bae1dSRodney W. Grimes 	 */
1147a3594432SRobert Watson 	if (d->bd_sbuf == NULL)
1148a3594432SRobert Watson 		bpf_allocbufs(d);
1149df8bae1dSRodney W. Grimes 	if (bp != d->bd_bif) {
1150df8bae1dSRodney W. Grimes 		if (d->bd_bif)
1151df8bae1dSRodney W. Grimes 			/*
1152df8bae1dSRodney W. Grimes 			 * Detach if attached to something else.
1153df8bae1dSRodney W. Grimes 			 */
1154df8bae1dSRodney W. Grimes 			bpf_detachd(d);
1155df8bae1dSRodney W. Grimes 
1156df8bae1dSRodney W. Grimes 		bpf_attachd(d, bp);
1157df8bae1dSRodney W. Grimes 	}
1158e7bb21b3SJonathan Lemon 	BPFD_LOCK(d);
1159df8bae1dSRodney W. Grimes 	reset_d(d);
1160e7bb21b3SJonathan Lemon 	BPFD_UNLOCK(d);
1161df8bae1dSRodney W. Grimes 	return (0);
1162df8bae1dSRodney W. Grimes }
1163df8bae1dSRodney W. Grimes 
1164df8bae1dSRodney W. Grimes /*
1165243ac7d8SPeter Wemm  * Support for select() and poll() system calls
1166df8bae1dSRodney W. Grimes  *
1167df8bae1dSRodney W. Grimes  * Return true iff the specific operation will not block indefinitely.
1168df8bae1dSRodney W. Grimes  * Otherwise, return false but make a note that a selwakeup() must be done.
1169df8bae1dSRodney W. Grimes  */
117037c84183SPoul-Henning Kamp static int
117119ba8395SChristian S.J. Peron bpfpoll(struct cdev *dev, int events, struct thread *td)
1172df8bae1dSRodney W. Grimes {
1173e7bb21b3SJonathan Lemon 	struct bpf_d *d;
11740832fc64SGarance A Drosehn 	int revents;
1175df8bae1dSRodney W. Grimes 
1176bd3a5320SPoul-Henning Kamp 	d = dev->si_drv1;
1177de5d9935SRobert Watson 	if (d->bd_bif == NULL)
1178de5d9935SRobert Watson 		return (ENXIO);
1179de5d9935SRobert Watson 
1180b75a24a0SChristian S.J. Peron 	/*
1181b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
1182b75a24a0SChristian S.J. Peron 	 */
11830832fc64SGarance A Drosehn 	revents = events & (POLLOUT | POLLWRNORM);
1184e7bb21b3SJonathan Lemon 	BPFD_LOCK(d);
1185cb1d4f92SChristian S.J. Peron 	d->bd_pid = td->td_proc->p_pid;
118675c13541SPoul-Henning Kamp 	if (events & (POLLIN | POLLRDNORM)) {
118795aab9ccSJohn-Mark Gurney 		if (bpf_ready(d))
1188243ac7d8SPeter Wemm 			revents |= events & (POLLIN | POLLRDNORM);
118981bda851SJohn Polstra 		else {
1190ed01445dSJohn Baldwin 			selrecord(td, &d->bd_sel);
119181bda851SJohn Polstra 			/* Start the read timeout if necessary. */
119281bda851SJohn Polstra 			if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) {
119381bda851SJohn Polstra 				callout_reset(&d->bd_callout, d->bd_rtout,
119481bda851SJohn Polstra 				    bpf_timed_out, d);
119581bda851SJohn Polstra 				d->bd_state = BPF_WAITING;
119681bda851SJohn Polstra 			}
119781bda851SJohn Polstra 		}
119875c13541SPoul-Henning Kamp 	}
1199e7bb21b3SJonathan Lemon 	BPFD_UNLOCK(d);
1200243ac7d8SPeter Wemm 	return (revents);
1201df8bae1dSRodney W. Grimes }
1202df8bae1dSRodney W. Grimes 
1203df8bae1dSRodney W. Grimes /*
120495aab9ccSJohn-Mark Gurney  * Support for kevent() system call.  Register EVFILT_READ filters and
120595aab9ccSJohn-Mark Gurney  * reject all others.
120695aab9ccSJohn-Mark Gurney  */
120795aab9ccSJohn-Mark Gurney int
120819ba8395SChristian S.J. Peron bpfkqfilter(struct cdev *dev, struct knote *kn)
120995aab9ccSJohn-Mark Gurney {
121095aab9ccSJohn-Mark Gurney 	struct bpf_d *d = (struct bpf_d *)dev->si_drv1;
121195aab9ccSJohn-Mark Gurney 
121295aab9ccSJohn-Mark Gurney 	if (kn->kn_filter != EVFILT_READ)
121395aab9ccSJohn-Mark Gurney 		return (1);
121495aab9ccSJohn-Mark Gurney 
1215b75a24a0SChristian S.J. Peron 	/*
1216b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
1217b75a24a0SChristian S.J. Peron 	 */
1218cb1d4f92SChristian S.J. Peron 	BPFD_LOCK(d);
1219b75a24a0SChristian S.J. Peron 	d->bd_pid = curthread->td_proc->p_pid;
122095aab9ccSJohn-Mark Gurney 	kn->kn_fop = &bpfread_filtops;
122195aab9ccSJohn-Mark Gurney 	kn->kn_hook = d;
12224b19419eSChristian S.J. Peron 	knlist_add(&d->bd_sel.si_note, kn, 1);
1223cb1d4f92SChristian S.J. Peron 	BPFD_UNLOCK(d);
122495aab9ccSJohn-Mark Gurney 
122595aab9ccSJohn-Mark Gurney 	return (0);
122695aab9ccSJohn-Mark Gurney }
122795aab9ccSJohn-Mark Gurney 
122895aab9ccSJohn-Mark Gurney static void
122919ba8395SChristian S.J. Peron filt_bpfdetach(struct knote *kn)
123095aab9ccSJohn-Mark Gurney {
123195aab9ccSJohn-Mark Gurney 	struct bpf_d *d = (struct bpf_d *)kn->kn_hook;
123295aab9ccSJohn-Mark Gurney 
1233ad3b9257SJohn-Mark Gurney 	knlist_remove(&d->bd_sel.si_note, kn, 0);
123495aab9ccSJohn-Mark Gurney }
123595aab9ccSJohn-Mark Gurney 
123695aab9ccSJohn-Mark Gurney static int
123719ba8395SChristian S.J. Peron filt_bpfread(struct knote *kn, long hint)
123895aab9ccSJohn-Mark Gurney {
123995aab9ccSJohn-Mark Gurney 	struct bpf_d *d = (struct bpf_d *)kn->kn_hook;
124095aab9ccSJohn-Mark Gurney 	int ready;
124195aab9ccSJohn-Mark Gurney 
124286c9a453SJohn-Mark Gurney 	BPFD_LOCK_ASSERT(d);
124395aab9ccSJohn-Mark Gurney 	ready = bpf_ready(d);
124495aab9ccSJohn-Mark Gurney 	if (ready) {
124595aab9ccSJohn-Mark Gurney 		kn->kn_data = d->bd_slen;
124695aab9ccSJohn-Mark Gurney 		if (d->bd_hbuf)
124795aab9ccSJohn-Mark Gurney 			kn->kn_data += d->bd_hlen;
124895aab9ccSJohn-Mark Gurney 	}
124995aab9ccSJohn-Mark Gurney 	else if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) {
125095aab9ccSJohn-Mark Gurney 		callout_reset(&d->bd_callout, d->bd_rtout,
125195aab9ccSJohn-Mark Gurney 		    bpf_timed_out, d);
125295aab9ccSJohn-Mark Gurney 		d->bd_state = BPF_WAITING;
125395aab9ccSJohn-Mark Gurney 	}
125495aab9ccSJohn-Mark Gurney 
125595aab9ccSJohn-Mark Gurney 	return (ready);
125695aab9ccSJohn-Mark Gurney }
125795aab9ccSJohn-Mark Gurney 
125895aab9ccSJohn-Mark Gurney /*
1259df8bae1dSRodney W. Grimes  * Incoming linkage from device drivers.  Process the packet pkt, of length
1260df8bae1dSRodney W. Grimes  * pktlen, which is stored in a contiguous buffer.  The packet is parsed
1261df8bae1dSRodney W. Grimes  * by each process' filter, and if accepted, stashed into the corresponding
1262df8bae1dSRodney W. Grimes  * buffer.
1263df8bae1dSRodney W. Grimes  */
1264df8bae1dSRodney W. Grimes void
126519ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen)
1266df8bae1dSRodney W. Grimes {
12678994a245SDag-Erling Smørgrav 	struct bpf_d *d;
12688994a245SDag-Erling Smørgrav 	u_int slen;
126991433904SDavid Malone 	int gottime;
127091433904SDavid Malone 	struct timeval tv;
1271e7bb21b3SJonathan Lemon 
127291433904SDavid Malone 	gottime = 0;
1273e7bb21b3SJonathan Lemon 	BPFIF_LOCK(bp);
12744a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
1275e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
1276df8bae1dSRodney W. Grimes 		++d->bd_rcount;
1277ae275efcSJung-uk Kim #ifdef BPF_JITTER
1278ae275efcSJung-uk Kim 		if (bpf_jitter_enable != 0 && d->bd_bfilter != NULL)
1279ae275efcSJung-uk Kim 			slen = (*(d->bd_bfilter->func))(pkt, pktlen, pktlen);
1280ae275efcSJung-uk Kim 		else
1281ae275efcSJung-uk Kim #endif
128293e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, pkt, pktlen, pktlen);
1283ec272d87SRobert Watson 		if (slen != 0) {
128469f7644bSChristian S.J. Peron 			d->bd_fcount++;
128591433904SDavid Malone 			if (!gottime) {
128691433904SDavid Malone 				microtime(&tv);
128791433904SDavid Malone 				gottime = 1;
128891433904SDavid Malone 			}
1289ec272d87SRobert Watson #ifdef MAC
129024a229f4SSam Leffler 			if (mac_check_bpfdesc_receive(d, bp->bif_ifp) == 0)
1291ec272d87SRobert Watson #endif
129291433904SDavid Malone 				catchpacket(d, pkt, pktlen, slen, bcopy, &tv);
1293ec272d87SRobert Watson 		}
1294e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
1295df8bae1dSRodney W. Grimes 	}
1296e7bb21b3SJonathan Lemon 	BPFIF_UNLOCK(bp);
1297df8bae1dSRodney W. Grimes }
1298df8bae1dSRodney W. Grimes 
1299df8bae1dSRodney W. Grimes /*
1300df8bae1dSRodney W. Grimes  * Copy data from an mbuf chain into a buffer.  This code is derived
1301df8bae1dSRodney W. Grimes  * from m_copydata in sys/uipc_mbuf.c.
1302df8bae1dSRodney W. Grimes  */
1303df8bae1dSRodney W. Grimes static void
130419ba8395SChristian S.J. Peron bpf_mcopy(const void *src_arg, void *dst_arg, size_t len)
1305df8bae1dSRodney W. Grimes {
13068994a245SDag-Erling Smørgrav 	const struct mbuf *m;
13078994a245SDag-Erling Smørgrav 	u_int count;
1308df8bae1dSRodney W. Grimes 	u_char *dst;
1309df8bae1dSRodney W. Grimes 
1310df8bae1dSRodney W. Grimes 	m = src_arg;
1311df8bae1dSRodney W. Grimes 	dst = dst_arg;
1312df8bae1dSRodney W. Grimes 	while (len > 0) {
1313572bde2aSRobert Watson 		if (m == NULL)
1314df8bae1dSRodney W. Grimes 			panic("bpf_mcopy");
1315df8bae1dSRodney W. Grimes 		count = min(m->m_len, len);
13160453d3cbSBruce Evans 		bcopy(mtod(m, void *), dst, count);
1317df8bae1dSRodney W. Grimes 		m = m->m_next;
1318df8bae1dSRodney W. Grimes 		dst += count;
1319df8bae1dSRodney W. Grimes 		len -= count;
1320df8bae1dSRodney W. Grimes 	}
1321df8bae1dSRodney W. Grimes }
1322df8bae1dSRodney W. Grimes 
1323560a54e1SJung-uk Kim #define	BPF_CHECK_DIRECTION(d, m) \
1324560a54e1SJung-uk Kim 	if (((d)->bd_direction == BPF_D_IN && (m)->m_pkthdr.rcvif == NULL) || \
1325560a54e1SJung-uk Kim 	    ((d)->bd_direction == BPF_D_OUT && (m)->m_pkthdr.rcvif != NULL))
1326560a54e1SJung-uk Kim 
1327df8bae1dSRodney W. Grimes /*
1328df8bae1dSRodney W. Grimes  * Incoming linkage from device drivers, when packet is in an mbuf chain.
1329df8bae1dSRodney W. Grimes  */
1330df8bae1dSRodney W. Grimes void
133119ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m)
1332df8bae1dSRodney W. Grimes {
1333df8bae1dSRodney W. Grimes 	struct bpf_d *d;
1334df8bae1dSRodney W. Grimes 	u_int pktlen, slen;
133591433904SDavid Malone 	int gottime;
133691433904SDavid Malone 	struct timeval tv;
133791433904SDavid Malone 
1338560a54e1SJung-uk Kim 	if (m->m_flags & M_SKIP_BPF) {
1339560a54e1SJung-uk Kim 		m->m_flags &= ~M_SKIP_BPF;
1340560a54e1SJung-uk Kim 		return;
1341560a54e1SJung-uk Kim 	}
1342560a54e1SJung-uk Kim 
134391433904SDavid Malone 	gottime = 0;
1344df8bae1dSRodney W. Grimes 
1345f0e2422bSPoul-Henning Kamp 	pktlen = m_length(m, NULL);
1346df8bae1dSRodney W. Grimes 
1347e7bb21b3SJonathan Lemon 	BPFIF_LOCK(bp);
13484a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
1349560a54e1SJung-uk Kim 		BPF_CHECK_DIRECTION(d, m)
13508ed3828cSRobert Watson 			continue;
1351e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
1352df8bae1dSRodney W. Grimes 		++d->bd_rcount;
1353ae275efcSJung-uk Kim #ifdef BPF_JITTER
1354ae275efcSJung-uk Kim 		/* XXX We cannot handle multiple mbufs. */
1355ae275efcSJung-uk Kim 		if (bpf_jitter_enable != 0 && d->bd_bfilter != NULL &&
1356ae275efcSJung-uk Kim 		    m->m_next == NULL)
1357ae275efcSJung-uk Kim 			slen = (*(d->bd_bfilter->func))(mtod(m, u_char *),
1358ae275efcSJung-uk Kim 			    pktlen, pktlen);
1359ae275efcSJung-uk Kim 		else
1360ae275efcSJung-uk Kim #endif
136193e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, (u_char *)m, pktlen, 0);
13624ddfb531SChristian S.J. Peron 		if (slen != 0) {
136369f7644bSChristian S.J. Peron 			d->bd_fcount++;
136491433904SDavid Malone 			if (!gottime) {
136591433904SDavid Malone 				microtime(&tv);
136691433904SDavid Malone 				gottime = 1;
136791433904SDavid Malone 			}
13680c7fb534SRobert Watson #ifdef MAC
136924a229f4SSam Leffler 			if (mac_check_bpfdesc_receive(d, bp->bif_ifp) == 0)
13700c7fb534SRobert Watson #endif
13710c7fb534SRobert Watson 				catchpacket(d, (u_char *)m, pktlen, slen,
137291433904SDavid Malone 				    bpf_mcopy, &tv);
13734ddfb531SChristian S.J. Peron 		}
1374e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
1375df8bae1dSRodney W. Grimes 	}
1376e7bb21b3SJonathan Lemon 	BPFIF_UNLOCK(bp);
1377df8bae1dSRodney W. Grimes }
1378df8bae1dSRodney W. Grimes 
1379df8bae1dSRodney W. Grimes /*
1380437ffe18SSam Leffler  * Incoming linkage from device drivers, when packet is in
1381437ffe18SSam Leffler  * an mbuf chain and to be prepended by a contiguous header.
1382437ffe18SSam Leffler  */
1383437ffe18SSam Leffler void
138419ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m)
1385437ffe18SSam Leffler {
1386437ffe18SSam Leffler 	struct mbuf mb;
1387437ffe18SSam Leffler 	struct bpf_d *d;
1388437ffe18SSam Leffler 	u_int pktlen, slen;
138991433904SDavid Malone 	int gottime;
139091433904SDavid Malone 	struct timeval tv;
139191433904SDavid Malone 
1392560a54e1SJung-uk Kim 	if (m->m_flags & M_SKIP_BPF) {
1393560a54e1SJung-uk Kim 		m->m_flags &= ~M_SKIP_BPF;
1394560a54e1SJung-uk Kim 		return;
1395560a54e1SJung-uk Kim 	}
1396560a54e1SJung-uk Kim 
139791433904SDavid Malone 	gottime = 0;
1398437ffe18SSam Leffler 
1399437ffe18SSam Leffler 	pktlen = m_length(m, NULL);
1400437ffe18SSam Leffler 	/*
1401437ffe18SSam Leffler 	 * Craft on-stack mbuf suitable for passing to bpf_filter.
1402437ffe18SSam Leffler 	 * Note that we cut corners here; we only setup what's
1403437ffe18SSam Leffler 	 * absolutely needed--this mbuf should never go anywhere else.
1404437ffe18SSam Leffler 	 */
1405437ffe18SSam Leffler 	mb.m_next = m;
1406437ffe18SSam Leffler 	mb.m_data = data;
1407437ffe18SSam Leffler 	mb.m_len = dlen;
1408437ffe18SSam Leffler 	pktlen += dlen;
1409437ffe18SSam Leffler 
1410437ffe18SSam Leffler 	BPFIF_LOCK(bp);
14114a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
1412560a54e1SJung-uk Kim 		BPF_CHECK_DIRECTION(d, m)
1413437ffe18SSam Leffler 			continue;
1414437ffe18SSam Leffler 		BPFD_LOCK(d);
1415437ffe18SSam Leffler 		++d->bd_rcount;
141693e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, (u_char *)&mb, pktlen, 0);
14174ddfb531SChristian S.J. Peron 		if (slen != 0) {
141869f7644bSChristian S.J. Peron 			d->bd_fcount++;
141991433904SDavid Malone 			if (!gottime) {
142091433904SDavid Malone 				microtime(&tv);
142191433904SDavid Malone 				gottime = 1;
142291433904SDavid Malone 			}
1423437ffe18SSam Leffler #ifdef MAC
1424437ffe18SSam Leffler 			if (mac_check_bpfdesc_receive(d, bp->bif_ifp) == 0)
1425437ffe18SSam Leffler #endif
1426437ffe18SSam Leffler 				catchpacket(d, (u_char *)&mb, pktlen, slen,
142791433904SDavid Malone 				    bpf_mcopy, &tv);
14284ddfb531SChristian S.J. Peron 		}
1429437ffe18SSam Leffler 		BPFD_UNLOCK(d);
1430437ffe18SSam Leffler 	}
1431437ffe18SSam Leffler 	BPFIF_UNLOCK(bp);
1432437ffe18SSam Leffler }
1433437ffe18SSam Leffler 
1434560a54e1SJung-uk Kim #undef	BPF_CHECK_DIRECTION
1435560a54e1SJung-uk Kim 
1436437ffe18SSam Leffler /*
1437df8bae1dSRodney W. Grimes  * Move the packet data from interface memory (pkt) into the
14389e610888SDag-Erling Smørgrav  * store buffer.  "cpfn" is the routine called to do the actual data
1439df8bae1dSRodney W. Grimes  * transfer.  bcopy is passed in to copy contiguous chunks, while
1440df8bae1dSRodney W. Grimes  * bpf_mcopy is passed in to copy mbuf chains.  In the latter case,
1441df8bae1dSRodney W. Grimes  * pkt is really an mbuf.
1442df8bae1dSRodney W. Grimes  */
1443df8bae1dSRodney W. Grimes static void
144419ba8395SChristian S.J. Peron catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen,
144591433904SDavid Malone     void (*cpfn)(const void *, void *, size_t), struct timeval *tv)
1446df8bae1dSRodney W. Grimes {
14478994a245SDag-Erling Smørgrav 	struct bpf_hdr *hp;
14488994a245SDag-Erling Smørgrav 	int totlen, curlen;
14498994a245SDag-Erling Smørgrav 	int hdrlen = d->bd_bif->bif_hdrlen;
14507819da79SJohn-Mark Gurney 	int do_wakeup = 0;
14519e610888SDag-Erling Smørgrav 
1452a3272e3cSChristian S.J. Peron 	BPFD_LOCK_ASSERT(d);
1453df8bae1dSRodney W. Grimes 	/*
1454df8bae1dSRodney W. Grimes 	 * Figure out how many bytes to move.  If the packet is
1455df8bae1dSRodney W. Grimes 	 * greater or equal to the snapshot length, transfer that
1456df8bae1dSRodney W. Grimes 	 * much.  Otherwise, transfer the whole packet (unless
1457df8bae1dSRodney W. Grimes 	 * we hit the buffer size limit).
1458df8bae1dSRodney W. Grimes 	 */
1459df8bae1dSRodney W. Grimes 	totlen = hdrlen + min(snaplen, pktlen);
1460df8bae1dSRodney W. Grimes 	if (totlen > d->bd_bufsize)
1461df8bae1dSRodney W. Grimes 		totlen = d->bd_bufsize;
1462df8bae1dSRodney W. Grimes 
1463df8bae1dSRodney W. Grimes 	/*
1464df8bae1dSRodney W. Grimes 	 * Round up the end of the previous packet to the next longword.
1465df8bae1dSRodney W. Grimes 	 */
1466df8bae1dSRodney W. Grimes 	curlen = BPF_WORDALIGN(d->bd_slen);
1467df8bae1dSRodney W. Grimes 	if (curlen + totlen > d->bd_bufsize) {
1468df8bae1dSRodney W. Grimes 		/*
1469df8bae1dSRodney W. Grimes 		 * This packet will overflow the storage buffer.
1470df8bae1dSRodney W. Grimes 		 * Rotate the buffers if we can, then wakeup any
1471df8bae1dSRodney W. Grimes 		 * pending reads.
1472df8bae1dSRodney W. Grimes 		 */
1473572bde2aSRobert Watson 		if (d->bd_fbuf == NULL) {
1474df8bae1dSRodney W. Grimes 			/*
1475df8bae1dSRodney W. Grimes 			 * We haven't completed the previous read yet,
1476df8bae1dSRodney W. Grimes 			 * so drop the packet.
1477df8bae1dSRodney W. Grimes 			 */
1478df8bae1dSRodney W. Grimes 			++d->bd_dcount;
1479df8bae1dSRodney W. Grimes 			return;
1480df8bae1dSRodney W. Grimes 		}
1481df8bae1dSRodney W. Grimes 		ROTATE_BUFFERS(d);
14827819da79SJohn-Mark Gurney 		do_wakeup = 1;
1483df8bae1dSRodney W. Grimes 		curlen = 0;
1484df8bae1dSRodney W. Grimes 	}
148581bda851SJohn Polstra 	else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT)
1486df8bae1dSRodney W. Grimes 		/*
148781bda851SJohn Polstra 		 * Immediate mode is set, or the read timeout has
148881bda851SJohn Polstra 		 * already expired during a select call.  A packet
148981bda851SJohn Polstra 		 * arrived, so the reader should be woken up.
1490df8bae1dSRodney W. Grimes 		 */
14917819da79SJohn-Mark Gurney 		do_wakeup = 1;
1492df8bae1dSRodney W. Grimes 
1493df8bae1dSRodney W. Grimes 	/*
1494df8bae1dSRodney W. Grimes 	 * Append the bpf header.
1495df8bae1dSRodney W. Grimes 	 */
1496df8bae1dSRodney W. Grimes 	hp = (struct bpf_hdr *)(d->bd_sbuf + curlen);
149791433904SDavid Malone 	hp->bh_tstamp = *tv;
1498df8bae1dSRodney W. Grimes 	hp->bh_datalen = pktlen;
1499df8bae1dSRodney W. Grimes 	hp->bh_hdrlen = hdrlen;
1500df8bae1dSRodney W. Grimes 	/*
1501df8bae1dSRodney W. Grimes 	 * Copy the packet data into the store buffer and update its length.
1502df8bae1dSRodney W. Grimes 	 */
1503df8bae1dSRodney W. Grimes 	(*cpfn)(pkt, (u_char *)hp + hdrlen, (hp->bh_caplen = totlen - hdrlen));
1504df8bae1dSRodney W. Grimes 	d->bd_slen = curlen + totlen;
15057819da79SJohn-Mark Gurney 
15067819da79SJohn-Mark Gurney 	if (do_wakeup)
15077819da79SJohn-Mark Gurney 		bpf_wakeup(d);
1508df8bae1dSRodney W. Grimes }
1509df8bae1dSRodney W. Grimes 
1510df8bae1dSRodney W. Grimes /*
1511df8bae1dSRodney W. Grimes  * Initialize all nonzero fields of a descriptor.
1512df8bae1dSRodney W. Grimes  */
1513a3594432SRobert Watson static void
151419ba8395SChristian S.J. Peron bpf_allocbufs(struct bpf_d *d)
1515df8bae1dSRodney W. Grimes {
1516df8bae1dSRodney W. Grimes 
1517a3594432SRobert Watson 	KASSERT(d->bd_fbuf == NULL, ("bpf_allocbufs: bd_fbuf != NULL"));
1518a3594432SRobert Watson 	KASSERT(d->bd_sbuf == NULL, ("bpf_allocbufs: bd_sbuf != NULL"));
1519a3594432SRobert Watson 	KASSERT(d->bd_hbuf == NULL, ("bpf_allocbufs: bd_hbuf != NULL"));
1520a3594432SRobert Watson 
1521a3594432SRobert Watson 	d->bd_fbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK);
1522a163d034SWarner Losh 	d->bd_sbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK);
1523df8bae1dSRodney W. Grimes 	d->bd_slen = 0;
1524df8bae1dSRodney W. Grimes 	d->bd_hlen = 0;
1525df8bae1dSRodney W. Grimes }
1526df8bae1dSRodney W. Grimes 
1527df8bae1dSRodney W. Grimes /*
1528df8bae1dSRodney W. Grimes  * Free buffers currently in use by a descriptor.
1529df8bae1dSRodney W. Grimes  * Called on close.
1530df8bae1dSRodney W. Grimes  */
1531df8bae1dSRodney W. Grimes static void
153219ba8395SChristian S.J. Peron bpf_freed(struct bpf_d *d)
1533df8bae1dSRodney W. Grimes {
1534df8bae1dSRodney W. Grimes 	/*
1535df8bae1dSRodney W. Grimes 	 * We don't need to lock out interrupts since this descriptor has
1536df8bae1dSRodney W. Grimes 	 * been detached from its interface and it yet hasn't been marked
1537df8bae1dSRodney W. Grimes 	 * free.
1538df8bae1dSRodney W. Grimes 	 */
1539572bde2aSRobert Watson 	if (d->bd_sbuf != NULL) {
1540bd3a5320SPoul-Henning Kamp 		free(d->bd_sbuf, M_BPF);
1541572bde2aSRobert Watson 		if (d->bd_hbuf != NULL)
1542bd3a5320SPoul-Henning Kamp 			free(d->bd_hbuf, M_BPF);
1543572bde2aSRobert Watson 		if (d->bd_fbuf != NULL)
1544bd3a5320SPoul-Henning Kamp 			free(d->bd_fbuf, M_BPF);
1545df8bae1dSRodney W. Grimes 	}
1546ae275efcSJung-uk Kim 	if (d->bd_rfilter) {
154793e39f0bSChristian S.J. Peron 		free((caddr_t)d->bd_rfilter, M_BPF);
1548ae275efcSJung-uk Kim #ifdef BPF_JITTER
1549ae275efcSJung-uk Kim 		bpf_destroy_jit_filter(d->bd_bfilter);
1550ae275efcSJung-uk Kim #endif
1551ae275efcSJung-uk Kim 	}
155293e39f0bSChristian S.J. Peron 	if (d->bd_wfilter)
155393e39f0bSChristian S.J. Peron 		free((caddr_t)d->bd_wfilter, M_BPF);
1554e7bb21b3SJonathan Lemon 	mtx_destroy(&d->bd_mtx);
1555df8bae1dSRodney W. Grimes }
1556df8bae1dSRodney W. Grimes 
1557df8bae1dSRodney W. Grimes /*
155824a229f4SSam Leffler  * Attach an interface to bpf.  dlt is the link layer type; hdrlen is the
155924a229f4SSam Leffler  * fixed size of the link header (variable length headers not yet supported).
1560df8bae1dSRodney W. Grimes  */
1561df8bae1dSRodney W. Grimes void
156219ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen)
1563df8bae1dSRodney W. Grimes {
156424a229f4SSam Leffler 
156524a229f4SSam Leffler 	bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf);
156624a229f4SSam Leffler }
156724a229f4SSam Leffler 
156824a229f4SSam Leffler /*
156924a229f4SSam Leffler  * Attach an interface to bpf.  ifp is a pointer to the structure
157024a229f4SSam Leffler  * defining the interface to be attached, dlt is the link layer type,
157124a229f4SSam Leffler  * and hdrlen is the fixed size of the link header (variable length
157224a229f4SSam Leffler  * headers are not yet supporrted).
157324a229f4SSam Leffler  */
157424a229f4SSam Leffler void
157519ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp)
157624a229f4SSam Leffler {
1577df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
157819ba8395SChristian S.J. Peron 
157919ba8395SChristian S.J. Peron 	bp = malloc(sizeof(*bp), M_BPF, M_NOWAIT | M_ZERO);
1580572bde2aSRobert Watson 	if (bp == NULL)
1581df8bae1dSRodney W. Grimes 		panic("bpfattach");
1582df8bae1dSRodney W. Grimes 
15834a3feeaaSRobert Watson 	LIST_INIT(&bp->bif_dlist);
1584df8bae1dSRodney W. Grimes 	bp->bif_ifp = ifp;
1585df8bae1dSRodney W. Grimes 	bp->bif_dlt = dlt;
15866008862bSJohn Baldwin 	mtx_init(&bp->bif_mtx, "bpf interface lock", NULL, MTX_DEF);
158716d878ccSChristian S.J. Peron 	KASSERT(*driverp == NULL, ("bpfattach2: driverp already initialized"));
158816d878ccSChristian S.J. Peron 	*driverp = bp;
1589df8bae1dSRodney W. Grimes 
1590e7bb21b3SJonathan Lemon 	mtx_lock(&bpf_mtx);
15914a3feeaaSRobert Watson 	LIST_INSERT_HEAD(&bpf_iflist, bp, bif_next);
1592e7bb21b3SJonathan Lemon 	mtx_unlock(&bpf_mtx);
1593df8bae1dSRodney W. Grimes 
1594df8bae1dSRodney W. Grimes 	/*
1595df8bae1dSRodney W. Grimes 	 * Compute the length of the bpf header.  This is not necessarily
1596df8bae1dSRodney W. Grimes 	 * equal to SIZEOF_BPF_HDR because we want to insert spacing such
1597df8bae1dSRodney W. Grimes 	 * that the network layer header begins on a longword boundary (for
1598df8bae1dSRodney W. Grimes 	 * performance reasons and to alleviate alignment restrictions).
1599df8bae1dSRodney W. Grimes 	 */
1600df8bae1dSRodney W. Grimes 	bp->bif_hdrlen = BPF_WORDALIGN(hdrlen + SIZEOF_BPF_HDR) - hdrlen;
1601df8bae1dSRodney W. Grimes 
16022eeab939SGarrett Wollman 	if (bootverbose)
160324a229f4SSam Leffler 		if_printf(ifp, "bpf attached\n");
1604df8bae1dSRodney W. Grimes }
160553ac6efbSJulian Elischer 
1606de5d9935SRobert Watson /*
1607de5d9935SRobert Watson  * Detach bpf from an interface.  This involves detaching each descriptor
1608de5d9935SRobert Watson  * associated with the interface, and leaving bd_bif NULL.  Notify each
1609de5d9935SRobert Watson  * descriptor as it's detached so that any sleepers wake up and get
1610de5d9935SRobert Watson  * ENXIO.
1611de5d9935SRobert Watson  */
1612de5d9935SRobert Watson void
161319ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp)
1614de5d9935SRobert Watson {
16154a3feeaaSRobert Watson 	struct bpf_if	*bp;
1616de5d9935SRobert Watson 	struct bpf_d	*d;
1617de5d9935SRobert Watson 
1618de5d9935SRobert Watson 	/* Locate BPF interface information */
16198eab61f3SSam Leffler 	mtx_lock(&bpf_mtx);
16204a3feeaaSRobert Watson 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
1621de5d9935SRobert Watson 		if (ifp == bp->bif_ifp)
1622de5d9935SRobert Watson 			break;
1623de5d9935SRobert Watson 	}
1624de5d9935SRobert Watson 
1625de5d9935SRobert Watson 	/* Interface wasn't attached */
1626d79bf337SMatthew N. Dodd 	if ((bp == NULL) || (bp->bif_ifp == NULL)) {
1627e7bb21b3SJonathan Lemon 		mtx_unlock(&bpf_mtx);
16289bf40edeSBrooks Davis 		printf("bpfdetach: %s was not attached\n", ifp->if_xname);
1629de5d9935SRobert Watson 		return;
1630de5d9935SRobert Watson 	}
1631de5d9935SRobert Watson 
16324a3feeaaSRobert Watson 	LIST_REMOVE(bp, bif_next);
16338eab61f3SSam Leffler 	mtx_unlock(&bpf_mtx);
1634de5d9935SRobert Watson 
16354a3feeaaSRobert Watson 	while ((d = LIST_FIRST(&bp->bif_dlist)) != NULL) {
1636e7bb21b3SJonathan Lemon 		bpf_detachd(d);
1637e7bb21b3SJonathan Lemon 		BPFD_LOCK(d);
1638e7bb21b3SJonathan Lemon 		bpf_wakeup(d);
1639e7bb21b3SJonathan Lemon 		BPFD_UNLOCK(d);
1640e7bb21b3SJonathan Lemon 	}
1641e7bb21b3SJonathan Lemon 
1642e7bb21b3SJonathan Lemon 	mtx_destroy(&bp->bif_mtx);
1643de5d9935SRobert Watson 	free(bp, M_BPF);
16448eab61f3SSam Leffler }
1645de5d9935SRobert Watson 
16468eab61f3SSam Leffler /*
16478eab61f3SSam Leffler  * Get a list of available data link type of the interface.
16488eab61f3SSam Leffler  */
16498eab61f3SSam Leffler static int
165019ba8395SChristian S.J. Peron bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl)
16518eab61f3SSam Leffler {
16528eab61f3SSam Leffler 	int n, error;
16538eab61f3SSam Leffler 	struct ifnet *ifp;
16548eab61f3SSam Leffler 	struct bpf_if *bp;
16558eab61f3SSam Leffler 
16568eab61f3SSam Leffler 	ifp = d->bd_bif->bif_ifp;
16578eab61f3SSam Leffler 	n = 0;
16588eab61f3SSam Leffler 	error = 0;
16598eab61f3SSam Leffler 	mtx_lock(&bpf_mtx);
16604a3feeaaSRobert Watson 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
16618eab61f3SSam Leffler 		if (bp->bif_ifp != ifp)
16628eab61f3SSam Leffler 			continue;
16638eab61f3SSam Leffler 		if (bfl->bfl_list != NULL) {
16648eab61f3SSam Leffler 			if (n >= bfl->bfl_len) {
1665e7bb21b3SJonathan Lemon 				mtx_unlock(&bpf_mtx);
16668eab61f3SSam Leffler 				return (ENOMEM);
16678eab61f3SSam Leffler 			}
16688eab61f3SSam Leffler 			error = copyout(&bp->bif_dlt,
16698eab61f3SSam Leffler 			    bfl->bfl_list + n, sizeof(u_int));
16708eab61f3SSam Leffler 		}
16718eab61f3SSam Leffler 		n++;
16728eab61f3SSam Leffler 	}
16738eab61f3SSam Leffler 	mtx_unlock(&bpf_mtx);
16748eab61f3SSam Leffler 	bfl->bfl_len = n;
16758eab61f3SSam Leffler 	return (error);
16768eab61f3SSam Leffler }
16778eab61f3SSam Leffler 
16788eab61f3SSam Leffler /*
16798eab61f3SSam Leffler  * Set the data link type of a BPF instance.
16808eab61f3SSam Leffler  */
16818eab61f3SSam Leffler static int
168219ba8395SChristian S.J. Peron bpf_setdlt(struct bpf_d *d, u_int dlt)
16838eab61f3SSam Leffler {
16848eab61f3SSam Leffler 	int error, opromisc;
16858eab61f3SSam Leffler 	struct ifnet *ifp;
16868eab61f3SSam Leffler 	struct bpf_if *bp;
16878eab61f3SSam Leffler 
16888eab61f3SSam Leffler 	if (d->bd_bif->bif_dlt == dlt)
16898eab61f3SSam Leffler 		return (0);
16908eab61f3SSam Leffler 	ifp = d->bd_bif->bif_ifp;
16918eab61f3SSam Leffler 	mtx_lock(&bpf_mtx);
16924a3feeaaSRobert Watson 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
16938eab61f3SSam Leffler 		if (bp->bif_ifp == ifp && bp->bif_dlt == dlt)
16948eab61f3SSam Leffler 			break;
16958eab61f3SSam Leffler 	}
16968eab61f3SSam Leffler 	mtx_unlock(&bpf_mtx);
16978eab61f3SSam Leffler 	if (bp != NULL) {
16988eab61f3SSam Leffler 		opromisc = d->bd_promisc;
16998eab61f3SSam Leffler 		bpf_detachd(d);
17008eab61f3SSam Leffler 		bpf_attachd(d, bp);
170193daabddSBrian Feldman 		BPFD_LOCK(d);
17028eab61f3SSam Leffler 		reset_d(d);
17038eab61f3SSam Leffler 		BPFD_UNLOCK(d);
17048eab61f3SSam Leffler 		if (opromisc) {
17058eab61f3SSam Leffler 			error = ifpromisc(bp->bif_ifp, 1);
17068eab61f3SSam Leffler 			if (error)
17078eab61f3SSam Leffler 				if_printf(bp->bif_ifp,
17088eab61f3SSam Leffler 					"bpf_setdlt: ifpromisc failed (%d)\n",
17098eab61f3SSam Leffler 					error);
17108eab61f3SSam Leffler 			else
17118eab61f3SSam Leffler 				d->bd_promisc = 1;
17128eab61f3SSam Leffler 		}
17138eab61f3SSam Leffler 	}
17148eab61f3SSam Leffler 	return (bp == NULL ? EINVAL : 0);
1715de5d9935SRobert Watson }
1716de5d9935SRobert Watson 
17173f54a085SPoul-Henning Kamp static void
171819ba8395SChristian S.J. Peron bpf_clone(void *arg, struct ucred *cred, char *name, int namelen,
171919ba8395SChristian S.J. Peron     struct cdev **dev)
17203f54a085SPoul-Henning Kamp {
17213f54a085SPoul-Henning Kamp 	int u;
17223f54a085SPoul-Henning Kamp 
1723f3732fd1SPoul-Henning Kamp 	if (*dev != NULL)
17243f54a085SPoul-Henning Kamp 		return;
1725db901281SPoul-Henning Kamp 	if (dev_stdclone(name, NULL, "bpf", &u) != 1)
17263f54a085SPoul-Henning Kamp 		return;
1727b0d17ba6SPoul-Henning Kamp 	*dev = make_dev(&bpf_cdevsw, unit2minor(u), UID_ROOT, GID_WHEEL, 0600,
1728b0d17ba6SPoul-Henning Kamp 	    "bpf%d", u);
1729f4f6abcbSPoul-Henning Kamp 	dev_ref(*dev);
1730b0d17ba6SPoul-Henning Kamp 	(*dev)->si_flags |= SI_CHEAPCLONE;
17313f54a085SPoul-Henning Kamp 	return;
17323f54a085SPoul-Henning Kamp }
17333f54a085SPoul-Henning Kamp 
1734514ede09SBruce Evans static void
173519ba8395SChristian S.J. Peron bpf_drvinit(void *unused)
173653ac6efbSJulian Elischer {
173753ac6efbSJulian Elischer 
17386008862bSJohn Baldwin 	mtx_init(&bpf_mtx, "bpf global lock", NULL, MTX_DEF);
17394a3feeaaSRobert Watson 	LIST_INIT(&bpf_iflist);
1740db901281SPoul-Henning Kamp 	EVENTHANDLER_REGISTER(dev_clone, bpf_clone, 0, 1000);
17417198bf47SJulian Elischer }
174253ac6efbSJulian Elischer 
174369f7644bSChristian S.J. Peron static void
174469f7644bSChristian S.J. Peron bpfstats_fill_xbpf(struct xbpf_d *d, struct bpf_d *bd)
174569f7644bSChristian S.J. Peron {
174669f7644bSChristian S.J. Peron 
174769f7644bSChristian S.J. Peron 	bzero(d, sizeof(*d));
174869f7644bSChristian S.J. Peron 	BPFD_LOCK_ASSERT(bd);
174969f7644bSChristian S.J. Peron 	d->bd_immediate = bd->bd_immediate;
175069f7644bSChristian S.J. Peron 	d->bd_promisc = bd->bd_promisc;
175169f7644bSChristian S.J. Peron 	d->bd_hdrcmplt = bd->bd_hdrcmplt;
1752560a54e1SJung-uk Kim 	d->bd_direction = bd->bd_direction;
1753560a54e1SJung-uk Kim 	d->bd_feedback = bd->bd_feedback;
175469f7644bSChristian S.J. Peron 	d->bd_async = bd->bd_async;
175569f7644bSChristian S.J. Peron 	d->bd_rcount = bd->bd_rcount;
175669f7644bSChristian S.J. Peron 	d->bd_dcount = bd->bd_dcount;
175769f7644bSChristian S.J. Peron 	d->bd_fcount = bd->bd_fcount;
175869f7644bSChristian S.J. Peron 	d->bd_sig = bd->bd_sig;
175969f7644bSChristian S.J. Peron 	d->bd_slen = bd->bd_slen;
176069f7644bSChristian S.J. Peron 	d->bd_hlen = bd->bd_hlen;
176169f7644bSChristian S.J. Peron 	d->bd_bufsize = bd->bd_bufsize;
176269f7644bSChristian S.J. Peron 	d->bd_pid = bd->bd_pid;
176369f7644bSChristian S.J. Peron 	strlcpy(d->bd_ifname,
176469f7644bSChristian S.J. Peron 	    bd->bd_bif->bif_ifp->if_xname, IFNAMSIZ);
176593e39f0bSChristian S.J. Peron 	d->bd_locked = bd->bd_locked;
176669f7644bSChristian S.J. Peron }
176769f7644bSChristian S.J. Peron 
176869f7644bSChristian S.J. Peron static int
176969f7644bSChristian S.J. Peron bpf_stats_sysctl(SYSCTL_HANDLER_ARGS)
177069f7644bSChristian S.J. Peron {
1771422a63daSChristian S.J. Peron 	struct xbpf_d *xbdbuf, *xbd;
1772422a63daSChristian S.J. Peron 	int index, error;
177369f7644bSChristian S.J. Peron 	struct bpf_if *bp;
177469f7644bSChristian S.J. Peron 	struct bpf_d *bd;
177569f7644bSChristian S.J. Peron 
177669f7644bSChristian S.J. Peron 	/*
177769f7644bSChristian S.J. Peron 	 * XXX This is not technically correct. It is possible for non
177869f7644bSChristian S.J. Peron 	 * privileged users to open bpf devices. It would make sense
177969f7644bSChristian S.J. Peron 	 * if the users who opened the devices were able to retrieve
178069f7644bSChristian S.J. Peron 	 * the statistics for them, too.
178169f7644bSChristian S.J. Peron 	 */
1782acd3428bSRobert Watson 	error = priv_check(req->td, PRIV_NET_BPF);
178369f7644bSChristian S.J. Peron 	if (error)
178469f7644bSChristian S.J. Peron 		return (error);
178569f7644bSChristian S.J. Peron 	if (req->oldptr == NULL)
1786422a63daSChristian S.J. Peron 		return (SYSCTL_OUT(req, 0, bpf_bpfd_cnt * sizeof(*xbd)));
178769f7644bSChristian S.J. Peron 	if (bpf_bpfd_cnt == 0)
178869f7644bSChristian S.J. Peron 		return (SYSCTL_OUT(req, 0, 0));
1789422a63daSChristian S.J. Peron 	xbdbuf = malloc(req->oldlen, M_BPF, M_WAITOK);
179069f7644bSChristian S.J. Peron 	mtx_lock(&bpf_mtx);
1791422a63daSChristian S.J. Peron 	if (req->oldlen < (bpf_bpfd_cnt * sizeof(*xbd))) {
1792422a63daSChristian S.J. Peron 		mtx_unlock(&bpf_mtx);
1793422a63daSChristian S.J. Peron 		free(xbdbuf, M_BPF);
1794422a63daSChristian S.J. Peron 		return (ENOMEM);
1795422a63daSChristian S.J. Peron 	}
1796422a63daSChristian S.J. Peron 	index = 0;
179769f7644bSChristian S.J. Peron 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
17981fc9e387SChristian S.J. Peron 		BPFIF_LOCK(bp);
179969f7644bSChristian S.J. Peron 		LIST_FOREACH(bd, &bp->bif_dlist, bd_next) {
1800422a63daSChristian S.J. Peron 			xbd = &xbdbuf[index++];
180169f7644bSChristian S.J. Peron 			BPFD_LOCK(bd);
1802422a63daSChristian S.J. Peron 			bpfstats_fill_xbpf(xbd, bd);
180369f7644bSChristian S.J. Peron 			BPFD_UNLOCK(bd);
180469f7644bSChristian S.J. Peron 		}
18051fc9e387SChristian S.J. Peron 		BPFIF_UNLOCK(bp);
180669f7644bSChristian S.J. Peron 	}
180769f7644bSChristian S.J. Peron 	mtx_unlock(&bpf_mtx);
1808422a63daSChristian S.J. Peron 	error = SYSCTL_OUT(req, xbdbuf, index * sizeof(*xbd));
1809422a63daSChristian S.J. Peron 	free(xbdbuf, M_BPF);
181069f7644bSChristian S.J. Peron 	return (error);
181169f7644bSChristian S.J. Peron }
181269f7644bSChristian S.J. Peron 
1813c9c7976fSPoul-Henning Kamp SYSINIT(bpfdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE,bpf_drvinit,NULL)
181453ac6efbSJulian Elischer 
18155bb5f2c9SPeter Wemm #else /* !DEV_BPF && !NETGRAPH_BPF */
1816f8dc4716SMike Smith /*
1817f8dc4716SMike Smith  * NOP stubs to allow bpf-using drivers to load and function.
1818f8dc4716SMike Smith  *
1819f8dc4716SMike Smith  * A 'better' implementation would allow the core bpf functionality
1820f8dc4716SMike Smith  * to be loaded at runtime.
1821f8dc4716SMike Smith  */
18227eae78a4SChristian S.J. Peron static struct bpf_if bp_null;
1823f8dc4716SMike Smith 
1824f8dc4716SMike Smith void
182519ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen)
1826f8dc4716SMike Smith {
1827f8dc4716SMike Smith }
1828f8dc4716SMike Smith 
1829f8dc4716SMike Smith void
183019ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m)
1831f8dc4716SMike Smith {
1832f8dc4716SMike Smith }
1833f8dc4716SMike Smith 
1834f8dc4716SMike Smith void
183519ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *d, u_int l, struct mbuf *m)
1836437ffe18SSam Leffler {
1837437ffe18SSam Leffler }
1838437ffe18SSam Leffler 
1839437ffe18SSam Leffler void
184019ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen)
1841f8dc4716SMike Smith {
18427eae78a4SChristian S.J. Peron 
18437eae78a4SChristian S.J. Peron 	bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf);
1844f8dc4716SMike Smith }
1845f8dc4716SMike Smith 
1846da626c17SBill Paul void
184719ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp)
18485f7a7923SSam Leffler {
18497eae78a4SChristian S.J. Peron 
18507eae78a4SChristian S.J. Peron 	*driverp = &bp_null;
18515f7a7923SSam Leffler }
18525f7a7923SSam Leffler 
18535f7a7923SSam Leffler void
185419ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp)
1855da626c17SBill Paul {
1856da626c17SBill Paul }
1857da626c17SBill Paul 
1858f8dc4716SMike Smith u_int
185919ba8395SChristian S.J. Peron bpf_filter(const struct bpf_insn *pc, u_char *p, u_int wirelen, u_int buflen)
1860f8dc4716SMike Smith {
1861f8dc4716SMike Smith 	return -1;	/* "no filter" behaviour */
1862f8dc4716SMike Smith }
1863f8dc4716SMike Smith 
18645bb5f2c9SPeter Wemm int
186519ba8395SChristian S.J. Peron bpf_validate(const struct bpf_insn *f, int len)
18665bb5f2c9SPeter Wemm {
18675bb5f2c9SPeter Wemm 	return 0;		/* false */
18685bb5f2c9SPeter Wemm }
18695bb5f2c9SPeter Wemm 
18705bb5f2c9SPeter Wemm #endif /* !DEV_BPF && !NETGRAPH_BPF */
1871