xref: /freebsd/sys/net/bpf.c (revision 97aacec6220c3e8c85bf1b7fc6bc8f83cefcb1e2)
1c398230bSWarner Losh /*-
2df8bae1dSRodney W. Grimes  * Copyright (c) 1990, 1991, 1993
3253a3814SLawrence Stewart  *	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  */
36df8bae1dSRodney W. Grimes 
37c7866007SRobert Watson #include <sys/cdefs.h>
38c7866007SRobert Watson __FBSDID("$FreeBSD$");
39c7866007SRobert Watson 
405bb5f2c9SPeter Wemm #include "opt_bpf.h"
41fc0a61a4SKonstantin Belousov #include "opt_compat.h"
425bb5f2c9SPeter Wemm #include "opt_netgraph.h"
43df8bae1dSRodney W. Grimes 
4495aab9ccSJohn-Mark Gurney #include <sys/types.h>
45df8bae1dSRodney W. Grimes #include <sys/param.h>
46e4b3229aSAlexander V. Chernikov #include <sys/lock.h>
47e4b3229aSAlexander V. Chernikov #include <sys/rwlock.h>
48df8bae1dSRodney W. Grimes #include <sys/systm.h>
49ce7609a4SBruce Evans #include <sys/conf.h>
50e76eee55SPoul-Henning Kamp #include <sys/fcntl.h>
51ebd8672cSBjoern A. Zeeb #include <sys/jail.h>
524d1d4912SBruce Evans #include <sys/malloc.h>
53df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
54df8bae1dSRodney W. Grimes #include <sys/time.h>
55acd3428bSRobert Watson #include <sys/priv.h>
56df8bae1dSRodney W. Grimes #include <sys/proc.h>
570310c19fSBruce Evans #include <sys/signalvar.h>
58528f627fSBruce Evans #include <sys/filio.h>
59528f627fSBruce Evans #include <sys/sockio.h>
60528f627fSBruce Evans #include <sys/ttycom.h>
61e76eee55SPoul-Henning Kamp #include <sys/uio.h>
62df8bae1dSRodney W. Grimes 
6395aab9ccSJohn-Mark Gurney #include <sys/event.h>
6495aab9ccSJohn-Mark Gurney #include <sys/file.h>
65243ac7d8SPeter Wemm #include <sys/poll.h>
6695aab9ccSJohn-Mark Gurney #include <sys/proc.h>
67df8bae1dSRodney W. Grimes 
68df8bae1dSRodney W. Grimes #include <sys/socket.h>
69df8bae1dSRodney W. Grimes 
70fba9235dSBruce Evans #include <net/if.h>
71e4b3229aSAlexander V. Chernikov #define	BPF_INTERNAL
72df8bae1dSRodney W. Grimes #include <net/bpf.h>
734d621040SChristian S.J. Peron #include <net/bpf_buffer.h>
74ae275efcSJung-uk Kim #ifdef BPF_JITTER
75ae275efcSJung-uk Kim #include <net/bpf_jitter.h>
76ae275efcSJung-uk Kim #endif
774d621040SChristian S.J. Peron #include <net/bpf_zerocopy.h>
78df8bae1dSRodney W. Grimes #include <net/bpfdesc.h>
79530c0060SRobert Watson #include <net/vnet.h>
80df8bae1dSRodney W. Grimes 
81df8bae1dSRodney W. Grimes #include <netinet/in.h>
82df8bae1dSRodney W. Grimes #include <netinet/if_ether.h>
83df8bae1dSRodney W. Grimes #include <sys/kernel.h>
84f708ef1bSPoul-Henning Kamp #include <sys/sysctl.h>
857b778b5eSEivind Eklund 
86246b5467SSam Leffler #include <net80211/ieee80211_freebsd.h>
87246b5467SSam Leffler 
88aed55708SRobert Watson #include <security/mac/mac_framework.h>
89aed55708SRobert Watson 
904d621040SChristian S.J. Peron MALLOC_DEFINE(M_BPF, "BPF", "BPF data");
9187f6c662SJulian Elischer 
925bb5f2c9SPeter Wemm #if defined(DEV_BPF) || defined(NETGRAPH_BPF)
9353ac6efbSJulian Elischer 
94df8bae1dSRodney W. Grimes #define PRINET  26			/* interruptible */
95df8bae1dSRodney W. Grimes 
96547d94bdSJung-uk Kim #define	SIZEOF_BPF_HDR(type)	\
97547d94bdSJung-uk Kim     (offsetof(type, bh_hdrlen) + sizeof(((type *)0)->bh_hdrlen))
98547d94bdSJung-uk Kim 
99fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
100fc0a61a4SKonstantin Belousov #include <sys/mount.h>
101fc0a61a4SKonstantin Belousov #include <compat/freebsd32/freebsd32.h>
102fc0a61a4SKonstantin Belousov #define BPF_ALIGNMENT32 sizeof(int32_t)
103fc0a61a4SKonstantin Belousov #define BPF_WORDALIGN32(x) (((x)+(BPF_ALIGNMENT32-1))&~(BPF_ALIGNMENT32-1))
104fc0a61a4SKonstantin Belousov 
105547d94bdSJung-uk Kim #ifndef BURN_BRIDGES
106fc0a61a4SKonstantin Belousov /*
107fc0a61a4SKonstantin Belousov  * 32-bit version of structure prepended to each packet.  We use this header
108fc0a61a4SKonstantin Belousov  * instead of the standard one for 32-bit streams.  We mark the a stream as
109fc0a61a4SKonstantin Belousov  * 32-bit the first time we see a 32-bit compat ioctl request.
110fc0a61a4SKonstantin Belousov  */
111fc0a61a4SKonstantin Belousov struct bpf_hdr32 {
112fc0a61a4SKonstantin Belousov 	struct timeval32 bh_tstamp;	/* time stamp */
113fc0a61a4SKonstantin Belousov 	uint32_t	bh_caplen;	/* length of captured portion */
114fc0a61a4SKonstantin Belousov 	uint32_t	bh_datalen;	/* original length of packet */
115fc0a61a4SKonstantin Belousov 	uint16_t	bh_hdrlen;	/* length of bpf header (this struct
116fc0a61a4SKonstantin Belousov 					   plus alignment padding) */
117fc0a61a4SKonstantin Belousov };
118253a3814SLawrence Stewart #endif
119fc0a61a4SKonstantin Belousov 
120fc0a61a4SKonstantin Belousov struct bpf_program32 {
121fc0a61a4SKonstantin Belousov 	u_int bf_len;
122fc0a61a4SKonstantin Belousov 	uint32_t bf_insns;
123fc0a61a4SKonstantin Belousov };
124fc0a61a4SKonstantin Belousov 
125fc0a61a4SKonstantin Belousov struct bpf_dltlist32 {
126fc0a61a4SKonstantin Belousov 	u_int	bfl_len;
127fc0a61a4SKonstantin Belousov 	u_int	bfl_list;
128fc0a61a4SKonstantin Belousov };
129fc0a61a4SKonstantin Belousov 
130fc0a61a4SKonstantin Belousov #define	BIOCSETF32	_IOW('B', 103, struct bpf_program32)
131fc0a61a4SKonstantin Belousov #define	BIOCSRTIMEOUT32	_IOW('B', 109, struct timeval32)
132fc0a61a4SKonstantin Belousov #define	BIOCGRTIMEOUT32	_IOR('B', 110, struct timeval32)
133fc0a61a4SKonstantin Belousov #define	BIOCGDLTLIST32	_IOWR('B', 121, struct bpf_dltlist32)
134fc0a61a4SKonstantin Belousov #define	BIOCSETWF32	_IOW('B', 123, struct bpf_program32)
135fc0a61a4SKonstantin Belousov #define	BIOCSETFNR32	_IOW('B', 130, struct bpf_program32)
136253a3814SLawrence Stewart #endif
137fc0a61a4SKonstantin Belousov 
138df8bae1dSRodney W. Grimes /*
139d1a67300SRobert Watson  * bpf_iflist is a list of BPF interface structures, each corresponding to a
140d1a67300SRobert Watson  * specific DLT.  The same network interface might have several BPF interface
141d1a67300SRobert Watson  * structures registered by different layers in the stack (i.e., 802.11
142d1a67300SRobert Watson  * frames, ethernet frames, etc).
143df8bae1dSRodney W. Grimes  */
1444a3feeaaSRobert Watson static LIST_HEAD(, bpf_if)	bpf_iflist;
145e7bb21b3SJonathan Lemon static struct mtx	bpf_mtx;		/* bpf global lock */
14669f7644bSChristian S.J. Peron static int		bpf_bpfd_cnt;
147df8bae1dSRodney W. Grimes 
14819ba8395SChristian S.J. Peron static void	bpf_attachd(struct bpf_d *, struct bpf_if *);
14919ba8395SChristian S.J. Peron static void	bpf_detachd(struct bpf_d *);
1506c74ff0eSAlexander V. Chernikov static void	bpf_detachd_locked(struct bpf_d *);
151929ddbbbSAlfred Perlstein static void	bpf_freed(struct bpf_d *);
152cb44b6dfSAndrew Thompson static int	bpf_movein(struct uio *, int, struct ifnet *, struct mbuf **,
153560a54e1SJung-uk Kim 		    struct sockaddr *, int *, struct bpf_insn *);
154929ddbbbSAlfred Perlstein static int	bpf_setif(struct bpf_d *, struct ifreq *);
155929ddbbbSAlfred Perlstein static void	bpf_timed_out(void *);
156e7bb21b3SJonathan Lemon static __inline void
157929ddbbbSAlfred Perlstein 		bpf_wakeup(struct bpf_d *);
1584d621040SChristian S.J. Peron static void	catchpacket(struct bpf_d *, u_char *, u_int, u_int,
1594d621040SChristian S.J. Peron 		    void (*)(struct bpf_d *, caddr_t, u_int, void *, u_int),
160547d94bdSJung-uk Kim 		    struct bintime *);
161929ddbbbSAlfred Perlstein static void	reset_d(struct bpf_d *);
16293e39f0bSChristian S.J. Peron static int	 bpf_setf(struct bpf_d *, struct bpf_program *, u_long cmd);
1638eab61f3SSam Leffler static int	bpf_getdltlist(struct bpf_d *, struct bpf_dltlist *);
1648eab61f3SSam Leffler static int	bpf_setdlt(struct bpf_d *, u_int);
16595aab9ccSJohn-Mark Gurney static void	filt_bpfdetach(struct knote *);
16695aab9ccSJohn-Mark Gurney static int	filt_bpfread(struct knote *, long);
167a3272e3cSChristian S.J. Peron static void	bpf_drvinit(void *);
16869f7644bSChristian S.J. Peron static int	bpf_stats_sysctl(SYSCTL_HANDLER_ARGS);
16969f7644bSChristian S.J. Peron 
17069f7644bSChristian S.J. Peron SYSCTL_NODE(_net, OID_AUTO, bpf, CTLFLAG_RW, 0, "bpf sysctl");
17112dc9582SJung-uk Kim int bpf_maxinsns = BPF_MAXINSNS;
17269f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, maxinsns, CTLFLAG_RW,
17369f7644bSChristian S.J. Peron     &bpf_maxinsns, 0, "Maximum bpf program instructions");
174ffeeb924SChristian S.J. Peron static int bpf_zerocopy_enable = 0;
1754d621040SChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, zerocopy_enable, CTLFLAG_RW,
1764d621040SChristian S.J. Peron     &bpf_zerocopy_enable, 0, "Enable new zero-copy BPF buffer sessions");
1776472ac3dSEd Schouten static SYSCTL_NODE(_net_bpf, OID_AUTO, stats, CTLFLAG_MPSAFE | CTLFLAG_RW,
17869f7644bSChristian S.J. Peron     bpf_stats_sysctl, "bpf statistics portal");
179df8bae1dSRodney W. Grimes 
18051ec1eb7SAlexander V. Chernikov static VNET_DEFINE(int, bpf_optimize_writers) = 0;
18151ec1eb7SAlexander V. Chernikov #define	V_bpf_optimize_writers VNET(bpf_optimize_writers)
18251ec1eb7SAlexander V. Chernikov SYSCTL_VNET_INT(_net_bpf, OID_AUTO, optimize_writers,
18351ec1eb7SAlexander V. Chernikov     CTLFLAG_RW, &VNET_NAME(bpf_optimize_writers), 0,
18451ec1eb7SAlexander V. Chernikov     "Do not send packets until BPF program is set");
18551ec1eb7SAlexander V. Chernikov 
18687f6c662SJulian Elischer static	d_open_t	bpfopen;
18787f6c662SJulian Elischer static	d_read_t	bpfread;
18887f6c662SJulian Elischer static	d_write_t	bpfwrite;
18987f6c662SJulian Elischer static	d_ioctl_t	bpfioctl;
190243ac7d8SPeter Wemm static	d_poll_t	bpfpoll;
19195aab9ccSJohn-Mark Gurney static	d_kqfilter_t	bpfkqfilter;
19287f6c662SJulian Elischer 
1934e2f199eSPoul-Henning Kamp static struct cdevsw bpf_cdevsw = {
194dc08ffecSPoul-Henning Kamp 	.d_version =	D_VERSION,
1957ac40f5fSPoul-Henning Kamp 	.d_open =	bpfopen,
1967ac40f5fSPoul-Henning Kamp 	.d_read =	bpfread,
1977ac40f5fSPoul-Henning Kamp 	.d_write =	bpfwrite,
1987ac40f5fSPoul-Henning Kamp 	.d_ioctl =	bpfioctl,
1997ac40f5fSPoul-Henning Kamp 	.d_poll =	bpfpoll,
2007ac40f5fSPoul-Henning Kamp 	.d_name =	"bpf",
20195aab9ccSJohn-Mark Gurney 	.d_kqfilter =	bpfkqfilter,
2024e2f199eSPoul-Henning Kamp };
20387f6c662SJulian Elischer 
204e76d823bSRobert Watson static struct filterops bpfread_filtops = {
205e76d823bSRobert Watson 	.f_isfd = 1,
206e76d823bSRobert Watson 	.f_detach = filt_bpfdetach,
207e76d823bSRobert Watson 	.f_event = filt_bpfread,
208e76d823bSRobert Watson };
20987f6c662SJulian Elischer 
210afa85850SAlexander V. Chernikov eventhandler_tag	bpf_ifdetach_cookie = NULL;
211afa85850SAlexander V. Chernikov 
2124d621040SChristian S.J. Peron /*
2136c74ff0eSAlexander V. Chernikov  * LOCKING MODEL USED BY BPF:
2146c74ff0eSAlexander V. Chernikov  * Locks:
2156c74ff0eSAlexander V. Chernikov  * 1) global lock (BPF_LOCK). Mutex, used to protect interface addition/removal,
2166c74ff0eSAlexander V. Chernikov  * some global counters and every bpf_if reference.
2176c74ff0eSAlexander V. Chernikov  * 2) Interface lock. Rwlock, used to protect list of BPF descriptors and their filters.
218afa85850SAlexander V. Chernikov  * 3) Descriptor lock. Mutex, used to protect BPF buffers and various structure fields
2196c74ff0eSAlexander V. Chernikov  *   used by bpf_mtap code.
2206c74ff0eSAlexander V. Chernikov  *
2216c74ff0eSAlexander V. Chernikov  * Lock order:
2226c74ff0eSAlexander V. Chernikov  *
2236c74ff0eSAlexander V. Chernikov  * Global lock, interface lock, descriptor lock
2246c74ff0eSAlexander V. Chernikov  *
2256c74ff0eSAlexander V. Chernikov  * We have to acquire interface lock before descriptor main lock due to BPF_MTAP[2]
2266c74ff0eSAlexander V. Chernikov  * working model. In many places (like bpf_detachd) we start with BPF descriptor
2276c74ff0eSAlexander V. Chernikov  * (and we need to at least rlock it to get reliable interface pointer). This
2286c74ff0eSAlexander V. Chernikov  * gives us potential LOR. As a result, we use global lock to protect from bpf_if
2296c74ff0eSAlexander V. Chernikov  * change in every such place.
2306c74ff0eSAlexander V. Chernikov  *
2316c74ff0eSAlexander V. Chernikov  * Changing d->bd_bif is protected by 1) global lock, 2) interface lock and
2326c74ff0eSAlexander V. Chernikov  * 3) descriptor main wlock.
2336c74ff0eSAlexander V. Chernikov  * Reading bd_bif can be protected by any of these locks, typically global lock.
2346c74ff0eSAlexander V. Chernikov  *
2356c74ff0eSAlexander V. Chernikov  * Changing read/write BPF filter is protected by the same three locks,
2366c74ff0eSAlexander V. Chernikov  * the same applies for reading.
2376c74ff0eSAlexander V. Chernikov  *
2386c74ff0eSAlexander V. Chernikov  * Sleeping in global lock is not allowed due to bpfdetach() using it.
2396c74ff0eSAlexander V. Chernikov  */
2406c74ff0eSAlexander V. Chernikov 
2416c74ff0eSAlexander V. Chernikov /*
2424d621040SChristian S.J. Peron  * Wrapper functions for various buffering methods.  If the set of buffer
2434d621040SChristian S.J. Peron  * modes expands, we will probably want to introduce a switch data structure
2444d621040SChristian S.J. Peron  * similar to protosw, et.
2454d621040SChristian S.J. Peron  */
2464d621040SChristian S.J. Peron static void
2474d621040SChristian S.J. Peron bpf_append_bytes(struct bpf_d *d, caddr_t buf, u_int offset, void *src,
2484d621040SChristian S.J. Peron     u_int len)
2494d621040SChristian S.J. Peron {
2504d621040SChristian S.J. Peron 
251afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
2524d621040SChristian S.J. Peron 
2534d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
2544d621040SChristian S.J. Peron 	case BPF_BUFMODE_BUFFER:
2554d621040SChristian S.J. Peron 		return (bpf_buffer_append_bytes(d, buf, offset, src, len));
2564d621040SChristian S.J. Peron 
2574d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
2584d621040SChristian S.J. Peron 		d->bd_zcopy++;
2594d621040SChristian S.J. Peron 		return (bpf_zerocopy_append_bytes(d, buf, offset, src, len));
2604d621040SChristian S.J. Peron 
2614d621040SChristian S.J. Peron 	default:
2624d621040SChristian S.J. Peron 		panic("bpf_buf_append_bytes");
2634d621040SChristian S.J. Peron 	}
2644d621040SChristian S.J. Peron }
2654d621040SChristian S.J. Peron 
2664d621040SChristian S.J. Peron static void
2674d621040SChristian S.J. Peron bpf_append_mbuf(struct bpf_d *d, caddr_t buf, u_int offset, void *src,
2684d621040SChristian S.J. Peron     u_int len)
2694d621040SChristian S.J. Peron {
2704d621040SChristian S.J. Peron 
271afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
2724d621040SChristian S.J. Peron 
2734d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
2744d621040SChristian S.J. Peron 	case BPF_BUFMODE_BUFFER:
2754d621040SChristian S.J. Peron 		return (bpf_buffer_append_mbuf(d, buf, offset, src, len));
2764d621040SChristian S.J. Peron 
2774d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
2784d621040SChristian S.J. Peron 		d->bd_zcopy++;
2794d621040SChristian S.J. Peron 		return (bpf_zerocopy_append_mbuf(d, buf, offset, src, len));
2804d621040SChristian S.J. Peron 
2814d621040SChristian S.J. Peron 	default:
2824d621040SChristian S.J. Peron 		panic("bpf_buf_append_mbuf");
2834d621040SChristian S.J. Peron 	}
2844d621040SChristian S.J. Peron }
2854d621040SChristian S.J. Peron 
2864d621040SChristian S.J. Peron /*
28729f612ecSChristian S.J. Peron  * This function gets called when the free buffer is re-assigned.
28829f612ecSChristian S.J. Peron  */
28929f612ecSChristian S.J. Peron static void
29029f612ecSChristian S.J. Peron bpf_buf_reclaimed(struct bpf_d *d)
29129f612ecSChristian S.J. Peron {
29229f612ecSChristian S.J. Peron 
293afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
29429f612ecSChristian S.J. Peron 
29529f612ecSChristian S.J. Peron 	switch (d->bd_bufmode) {
29629f612ecSChristian S.J. Peron 	case BPF_BUFMODE_BUFFER:
29729f612ecSChristian S.J. Peron 		return;
29829f612ecSChristian S.J. Peron 
29929f612ecSChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
30029f612ecSChristian S.J. Peron 		bpf_zerocopy_buf_reclaimed(d);
30129f612ecSChristian S.J. Peron 		return;
30229f612ecSChristian S.J. Peron 
30329f612ecSChristian S.J. Peron 	default:
30429f612ecSChristian S.J. Peron 		panic("bpf_buf_reclaimed");
30529f612ecSChristian S.J. Peron 	}
30629f612ecSChristian S.J. Peron }
30729f612ecSChristian S.J. Peron 
30829f612ecSChristian S.J. Peron /*
3094d621040SChristian S.J. Peron  * If the buffer mechanism has a way to decide that a held buffer can be made
3104d621040SChristian S.J. Peron  * free, then it is exposed via the bpf_canfreebuf() interface.  (1) is
3114d621040SChristian S.J. Peron  * returned if the buffer can be discarded, (0) is returned if it cannot.
3124d621040SChristian S.J. Peron  */
3134d621040SChristian S.J. Peron static int
3144d621040SChristian S.J. Peron bpf_canfreebuf(struct bpf_d *d)
3154d621040SChristian S.J. Peron {
3164d621040SChristian S.J. Peron 
3174d621040SChristian S.J. Peron 	BPFD_LOCK_ASSERT(d);
3184d621040SChristian S.J. Peron 
3194d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
3204d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
3214d621040SChristian S.J. Peron 		return (bpf_zerocopy_canfreebuf(d));
3224d621040SChristian S.J. Peron 	}
3234d621040SChristian S.J. Peron 	return (0);
3244d621040SChristian S.J. Peron }
3254d621040SChristian S.J. Peron 
326a7a91e65SRobert Watson /*
327a7a91e65SRobert Watson  * Allow the buffer model to indicate that the current store buffer is
328a7a91e65SRobert Watson  * immutable, regardless of the appearance of space.  Return (1) if the
329a7a91e65SRobert Watson  * buffer is writable, and (0) if not.
330a7a91e65SRobert Watson  */
331a7a91e65SRobert Watson static int
332a7a91e65SRobert Watson bpf_canwritebuf(struct bpf_d *d)
333a7a91e65SRobert Watson {
334a7a91e65SRobert Watson 	BPFD_LOCK_ASSERT(d);
335a7a91e65SRobert Watson 
336a7a91e65SRobert Watson 	switch (d->bd_bufmode) {
337a7a91e65SRobert Watson 	case BPF_BUFMODE_ZBUF:
338a7a91e65SRobert Watson 		return (bpf_zerocopy_canwritebuf(d));
339a7a91e65SRobert Watson 	}
340a7a91e65SRobert Watson 	return (1);
341a7a91e65SRobert Watson }
342a7a91e65SRobert Watson 
343a7a91e65SRobert Watson /*
344a7a91e65SRobert Watson  * Notify buffer model that an attempt to write to the store buffer has
345a7a91e65SRobert Watson  * resulted in a dropped packet, in which case the buffer may be considered
346a7a91e65SRobert Watson  * full.
347a7a91e65SRobert Watson  */
348a7a91e65SRobert Watson static void
349a7a91e65SRobert Watson bpf_buffull(struct bpf_d *d)
350a7a91e65SRobert Watson {
351a7a91e65SRobert Watson 
352afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
353a7a91e65SRobert Watson 
354a7a91e65SRobert Watson 	switch (d->bd_bufmode) {
355a7a91e65SRobert Watson 	case BPF_BUFMODE_ZBUF:
356a7a91e65SRobert Watson 		bpf_zerocopy_buffull(d);
357a7a91e65SRobert Watson 		break;
358a7a91e65SRobert Watson 	}
359a7a91e65SRobert Watson }
360a7a91e65SRobert Watson 
361a7a91e65SRobert Watson /*
362a7a91e65SRobert Watson  * Notify the buffer model that a buffer has moved into the hold position.
363a7a91e65SRobert Watson  */
3644d621040SChristian S.J. Peron void
3654d621040SChristian S.J. Peron bpf_bufheld(struct bpf_d *d)
3664d621040SChristian S.J. Peron {
3674d621040SChristian S.J. Peron 
368afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
3694d621040SChristian S.J. Peron 
3704d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
3714d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
3724d621040SChristian S.J. Peron 		bpf_zerocopy_bufheld(d);
3734d621040SChristian S.J. Peron 		break;
3744d621040SChristian S.J. Peron 	}
3754d621040SChristian S.J. Peron }
3764d621040SChristian S.J. Peron 
3774d621040SChristian S.J. Peron static void
3784d621040SChristian S.J. Peron bpf_free(struct bpf_d *d)
3794d621040SChristian S.J. Peron {
3804d621040SChristian S.J. Peron 
3814d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
3824d621040SChristian S.J. Peron 	case BPF_BUFMODE_BUFFER:
3834d621040SChristian S.J. Peron 		return (bpf_buffer_free(d));
3844d621040SChristian S.J. Peron 
3854d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
3864d621040SChristian S.J. Peron 		return (bpf_zerocopy_free(d));
3874d621040SChristian S.J. Peron 
3884d621040SChristian S.J. Peron 	default:
3894d621040SChristian S.J. Peron 		panic("bpf_buf_free");
3904d621040SChristian S.J. Peron 	}
3914d621040SChristian S.J. Peron }
3924d621040SChristian S.J. Peron 
3934d621040SChristian S.J. Peron static int
3944d621040SChristian S.J. Peron bpf_uiomove(struct bpf_d *d, caddr_t buf, u_int len, struct uio *uio)
3954d621040SChristian S.J. Peron {
3964d621040SChristian S.J. Peron 
3974d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_BUFFER)
3984d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
3994d621040SChristian S.J. Peron 	return (bpf_buffer_uiomove(d, buf, len, uio));
4004d621040SChristian S.J. Peron }
4014d621040SChristian S.J. Peron 
4024d621040SChristian S.J. Peron static int
4034d621040SChristian S.J. Peron bpf_ioctl_sblen(struct bpf_d *d, u_int *i)
4044d621040SChristian S.J. Peron {
4054d621040SChristian S.J. Peron 
4064d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_BUFFER)
4074d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
4084d621040SChristian S.J. Peron 	return (bpf_buffer_ioctl_sblen(d, i));
4094d621040SChristian S.J. Peron }
4104d621040SChristian S.J. Peron 
4114d621040SChristian S.J. Peron static int
4124d621040SChristian S.J. Peron bpf_ioctl_getzmax(struct thread *td, struct bpf_d *d, size_t *i)
4134d621040SChristian S.J. Peron {
4144d621040SChristian S.J. Peron 
4154d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_ZBUF)
4164d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
4174d621040SChristian S.J. Peron 	return (bpf_zerocopy_ioctl_getzmax(td, d, i));
4184d621040SChristian S.J. Peron }
4194d621040SChristian S.J. Peron 
4204d621040SChristian S.J. Peron static int
4214d621040SChristian S.J. Peron bpf_ioctl_rotzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz)
4224d621040SChristian S.J. Peron {
4234d621040SChristian S.J. Peron 
4244d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_ZBUF)
4254d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
4264d621040SChristian S.J. Peron 	return (bpf_zerocopy_ioctl_rotzbuf(td, d, bz));
4274d621040SChristian S.J. Peron }
4284d621040SChristian S.J. Peron 
4294d621040SChristian S.J. Peron static int
4304d621040SChristian S.J. Peron bpf_ioctl_setzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz)
4314d621040SChristian S.J. Peron {
4324d621040SChristian S.J. Peron 
4334d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_ZBUF)
4344d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
4354d621040SChristian S.J. Peron 	return (bpf_zerocopy_ioctl_setzbuf(td, d, bz));
4364d621040SChristian S.J. Peron }
4374d621040SChristian S.J. Peron 
4384d621040SChristian S.J. Peron /*
4394d621040SChristian S.J. Peron  * General BPF functions.
4404d621040SChristian S.J. Peron  */
441df8bae1dSRodney W. Grimes static int
442cb44b6dfSAndrew Thompson bpf_movein(struct uio *uio, int linktype, struct ifnet *ifp, struct mbuf **mp,
443560a54e1SJung-uk Kim     struct sockaddr *sockp, int *hdrlen, struct bpf_insn *wfilter)
444df8bae1dSRodney W. Grimes {
445246b5467SSam Leffler 	const struct ieee80211_bpf_params *p;
446cb44b6dfSAndrew Thompson 	struct ether_header *eh;
447df8bae1dSRodney W. Grimes 	struct mbuf *m;
448df8bae1dSRodney W. Grimes 	int error;
449df8bae1dSRodney W. Grimes 	int len;
450df8bae1dSRodney W. Grimes 	int hlen;
45193e39f0bSChristian S.J. Peron 	int slen;
452df8bae1dSRodney W. Grimes 
453df8bae1dSRodney W. Grimes 	/*
454df8bae1dSRodney W. Grimes 	 * Build a sockaddr based on the data link layer type.
455df8bae1dSRodney W. Grimes 	 * We do this at this level because the ethernet header
456df8bae1dSRodney W. Grimes 	 * is copied directly into the data field of the sockaddr.
457df8bae1dSRodney W. Grimes 	 * In the case of SLIP, there is no header and the packet
458df8bae1dSRodney W. Grimes 	 * is forwarded as is.
459df8bae1dSRodney W. Grimes 	 * Also, we are careful to leave room at the front of the mbuf
460df8bae1dSRodney W. Grimes 	 * for the link level header.
461df8bae1dSRodney W. Grimes 	 */
462df8bae1dSRodney W. Grimes 	switch (linktype) {
463df8bae1dSRodney W. Grimes 
464df8bae1dSRodney W. Grimes 	case DLT_SLIP:
465df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_INET;
466df8bae1dSRodney W. Grimes 		hlen = 0;
467df8bae1dSRodney W. Grimes 		break;
468df8bae1dSRodney W. Grimes 
469df8bae1dSRodney W. Grimes 	case DLT_EN10MB:
470df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_UNSPEC;
471df8bae1dSRodney W. Grimes 		/* XXX Would MAXLINKHDR be better? */
472797f247bSMatthew N. Dodd 		hlen = ETHER_HDR_LEN;
473df8bae1dSRodney W. Grimes 		break;
474df8bae1dSRodney W. Grimes 
475df8bae1dSRodney W. Grimes 	case DLT_FDDI:
476d41f24e7SDavid Greenman 		sockp->sa_family = AF_IMPLINK;
477d41f24e7SDavid Greenman 		hlen = 0;
478df8bae1dSRodney W. Grimes 		break;
479df8bae1dSRodney W. Grimes 
48022f05c43SAndrey A. Chernov 	case DLT_RAW:
481df8bae1dSRodney W. Grimes 		sockp->sa_family = AF_UNSPEC;
482df8bae1dSRodney W. Grimes 		hlen = 0;
483df8bae1dSRodney W. Grimes 		break;
484df8bae1dSRodney W. Grimes 
48501399f34SDavid Malone 	case DLT_NULL:
48601399f34SDavid Malone 		/*
48701399f34SDavid Malone 		 * null interface types require a 4 byte pseudo header which
48801399f34SDavid Malone 		 * corresponds to the address family of the packet.
48901399f34SDavid Malone 		 */
49001399f34SDavid Malone 		sockp->sa_family = AF_UNSPEC;
49101399f34SDavid Malone 		hlen = 4;
49201399f34SDavid Malone 		break;
49301399f34SDavid Malone 
4944f53e3ccSKenjiro Cho 	case DLT_ATM_RFC1483:
4954f53e3ccSKenjiro Cho 		/*
4964f53e3ccSKenjiro Cho 		 * en atm driver requires 4-byte atm pseudo header.
4974f53e3ccSKenjiro Cho 		 * though it isn't standard, vpi:vci needs to be
4984f53e3ccSKenjiro Cho 		 * specified anyway.
4994f53e3ccSKenjiro Cho 		 */
5004f53e3ccSKenjiro Cho 		sockp->sa_family = AF_UNSPEC;
5014f53e3ccSKenjiro Cho 		hlen = 12;	/* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */
5024f53e3ccSKenjiro Cho 		break;
5034f53e3ccSKenjiro Cho 
50430fa52a6SBrian Somers 	case DLT_PPP:
50530fa52a6SBrian Somers 		sockp->sa_family = AF_UNSPEC;
50630fa52a6SBrian Somers 		hlen = 4;	/* This should match PPP_HDRLEN */
50730fa52a6SBrian Somers 		break;
50830fa52a6SBrian Somers 
509246b5467SSam Leffler 	case DLT_IEEE802_11:		/* IEEE 802.11 wireless */
510246b5467SSam Leffler 		sockp->sa_family = AF_IEEE80211;
511246b5467SSam Leffler 		hlen = 0;
512246b5467SSam Leffler 		break;
513246b5467SSam Leffler 
514246b5467SSam Leffler 	case DLT_IEEE802_11_RADIO:	/* IEEE 802.11 wireless w/ phy params */
515246b5467SSam Leffler 		sockp->sa_family = AF_IEEE80211;
516246b5467SSam Leffler 		sockp->sa_len = 12;	/* XXX != 0 */
517246b5467SSam Leffler 		hlen = sizeof(struct ieee80211_bpf_params);
518246b5467SSam Leffler 		break;
519246b5467SSam Leffler 
520df8bae1dSRodney W. Grimes 	default:
521df8bae1dSRodney W. Grimes 		return (EIO);
522df8bae1dSRodney W. Grimes 	}
523df8bae1dSRodney W. Grimes 
524df8bae1dSRodney W. Grimes 	len = uio->uio_resid;
52501399f34SDavid Malone 
526cb44b6dfSAndrew Thompson 	if (len - hlen > ifp->if_mtu)
52701399f34SDavid Malone 		return (EMSGSIZE);
52801399f34SDavid Malone 
529968c88bcSJung-uk Kim 	if ((unsigned)len > MJUM16BYTES)
530df8bae1dSRodney W. Grimes 		return (EIO);
531df8bae1dSRodney W. Grimes 
532968c88bcSJung-uk Kim 	if (len <= MHLEN)
533968c88bcSJung-uk Kim 		MGETHDR(m, M_WAIT, MT_DATA);
534968c88bcSJung-uk Kim 	else if (len <= MCLBYTES)
535ea26d587SRuslan Ermilov 		m = m_getcl(M_WAIT, MT_DATA, M_PKTHDR);
536ea26d587SRuslan Ermilov 	else
537968c88bcSJung-uk Kim 		m = m_getjcl(M_WAIT, MT_DATA, M_PKTHDR,
538968c88bcSJung-uk Kim #if (MJUMPAGESIZE > MCLBYTES)
539968c88bcSJung-uk Kim 		    len <= MJUMPAGESIZE ? MJUMPAGESIZE :
540968c88bcSJung-uk Kim #endif
541968c88bcSJung-uk Kim 		    (len <= MJUM9BYTES ? MJUM9BYTES : MJUM16BYTES));
542963e4c2aSGarrett Wollman 	m->m_pkthdr.len = m->m_len = len;
543963e4c2aSGarrett Wollman 	m->m_pkthdr.rcvif = NULL;
544df8bae1dSRodney W. Grimes 	*mp = m;
54524a229f4SSam Leffler 
54693e39f0bSChristian S.J. Peron 	if (m->m_len < hlen) {
54793e39f0bSChristian S.J. Peron 		error = EPERM;
54893e39f0bSChristian S.J. Peron 		goto bad;
54993e39f0bSChristian S.J. Peron 	}
55093e39f0bSChristian S.J. Peron 
55193e39f0bSChristian S.J. Peron 	error = uiomove(mtod(m, u_char *), len, uio);
55293e39f0bSChristian S.J. Peron 	if (error)
55393e39f0bSChristian S.J. Peron 		goto bad;
55493e39f0bSChristian S.J. Peron 
55593e39f0bSChristian S.J. Peron 	slen = bpf_filter(wfilter, mtod(m, u_char *), len, len);
55693e39f0bSChristian S.J. Peron 	if (slen == 0) {
55793e39f0bSChristian S.J. Peron 		error = EPERM;
55893e39f0bSChristian S.J. Peron 		goto bad;
55993e39f0bSChristian S.J. Peron 	}
56093e39f0bSChristian S.J. Peron 
561cb44b6dfSAndrew Thompson 	/* Check for multicast destination */
562cb44b6dfSAndrew Thompson 	switch (linktype) {
563cb44b6dfSAndrew Thompson 	case DLT_EN10MB:
564cb44b6dfSAndrew Thompson 		eh = mtod(m, struct ether_header *);
565cb44b6dfSAndrew Thompson 		if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
566cb44b6dfSAndrew Thompson 			if (bcmp(ifp->if_broadcastaddr, eh->ether_dhost,
567cb44b6dfSAndrew Thompson 			    ETHER_ADDR_LEN) == 0)
568cb44b6dfSAndrew Thompson 				m->m_flags |= M_BCAST;
569cb44b6dfSAndrew Thompson 			else
570cb44b6dfSAndrew Thompson 				m->m_flags |= M_MCAST;
571cb44b6dfSAndrew Thompson 		}
572cb44b6dfSAndrew Thompson 		break;
573cb44b6dfSAndrew Thompson 	}
574cb44b6dfSAndrew Thompson 
575df8bae1dSRodney W. Grimes 	/*
57693e39f0bSChristian S.J. Peron 	 * Make room for link header, and copy it to sockaddr
577df8bae1dSRodney W. Grimes 	 */
578df8bae1dSRodney W. Grimes 	if (hlen != 0) {
579246b5467SSam Leffler 		if (sockp->sa_family == AF_IEEE80211) {
580246b5467SSam Leffler 			/*
581246b5467SSam Leffler 			 * Collect true length from the parameter header
582246b5467SSam Leffler 			 * NB: sockp is known to be zero'd so if we do a
583246b5467SSam Leffler 			 *     short copy unspecified parameters will be
584246b5467SSam Leffler 			 *     zero.
585246b5467SSam Leffler 			 * NB: packet may not be aligned after stripping
586246b5467SSam Leffler 			 *     bpf params
587246b5467SSam Leffler 			 * XXX check ibp_vers
588246b5467SSam Leffler 			 */
589246b5467SSam Leffler 			p = mtod(m, const struct ieee80211_bpf_params *);
590246b5467SSam Leffler 			hlen = p->ibp_len;
591246b5467SSam Leffler 			if (hlen > sizeof(sockp->sa_data)) {
592246b5467SSam Leffler 				error = EINVAL;
593246b5467SSam Leffler 				goto bad;
594246b5467SSam Leffler 			}
595246b5467SSam Leffler 		}
59693e39f0bSChristian S.J. Peron 		bcopy(m->m_data, sockp->sa_data, hlen);
597df8bae1dSRodney W. Grimes 	}
598560a54e1SJung-uk Kim 	*hdrlen = hlen;
59993e39f0bSChristian S.J. Peron 
600df8bae1dSRodney W. Grimes 	return (0);
601df8bae1dSRodney W. Grimes bad:
602df8bae1dSRodney W. Grimes 	m_freem(m);
603df8bae1dSRodney W. Grimes 	return (error);
604df8bae1dSRodney W. Grimes }
605df8bae1dSRodney W. Grimes 
606df8bae1dSRodney W. Grimes /*
607df8bae1dSRodney W. Grimes  * Attach file to the bpf interface, i.e. make d listen on bp.
608df8bae1dSRodney W. Grimes  */
609df8bae1dSRodney W. Grimes static void
61019ba8395SChristian S.J. Peron bpf_attachd(struct bpf_d *d, struct bpf_if *bp)
611df8bae1dSRodney W. Grimes {
6126c74ff0eSAlexander V. Chernikov 	int op_w;
6136c74ff0eSAlexander V. Chernikov 
6146c74ff0eSAlexander V. Chernikov 	BPF_LOCK_ASSERT();
6156c74ff0eSAlexander V. Chernikov 
6166c74ff0eSAlexander V. Chernikov 	/*
6176c74ff0eSAlexander V. Chernikov 	 * Save sysctl value to protect from sysctl change
6186c74ff0eSAlexander V. Chernikov 	 * between reads
6196c74ff0eSAlexander V. Chernikov 	 */
6206c74ff0eSAlexander V. Chernikov 	op_w = V_bpf_optimize_writers;
6216c74ff0eSAlexander V. Chernikov 
6226c74ff0eSAlexander V. Chernikov 	if (d->bd_bif != NULL)
6236c74ff0eSAlexander V. Chernikov 		bpf_detachd_locked(d);
624df8bae1dSRodney W. Grimes 	/*
62551ec1eb7SAlexander V. Chernikov 	 * Point d at bp, and add d to the interface's list.
62651ec1eb7SAlexander V. Chernikov 	 * Since there are many applicaiotns using BPF for
62751ec1eb7SAlexander V. Chernikov 	 * sending raw packets only (dhcpd, cdpd are good examples)
62851ec1eb7SAlexander V. Chernikov 	 * we can delay adding d to the list of active listeners until
62951ec1eb7SAlexander V. Chernikov 	 * some filter is configured.
630df8bae1dSRodney W. Grimes 	 */
63151ec1eb7SAlexander V. Chernikov 
63251ec1eb7SAlexander V. Chernikov 	BPFIF_WLOCK(bp);
633afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
63451ec1eb7SAlexander V. Chernikov 
6356c74ff0eSAlexander V. Chernikov 	d->bd_bif = bp;
6366c74ff0eSAlexander V. Chernikov 
6376c74ff0eSAlexander V. Chernikov 	if (op_w != 0) {
63851ec1eb7SAlexander V. Chernikov 		/* Add to writers-only list */
63951ec1eb7SAlexander V. Chernikov 		LIST_INSERT_HEAD(&bp->bif_wlist, d, bd_next);
64051ec1eb7SAlexander V. Chernikov 		/*
64151ec1eb7SAlexander V. Chernikov 		 * We decrement bd_writer on every filter set operation.
64251ec1eb7SAlexander V. Chernikov 		 * First BIOCSETF is done by pcap_open_live() to set up
64351ec1eb7SAlexander V. Chernikov 		 * snap length. After that appliation usually sets its own filter
64451ec1eb7SAlexander V. Chernikov 		 */
64551ec1eb7SAlexander V. Chernikov 		d->bd_writer = 2;
64651ec1eb7SAlexander V. Chernikov 	} else
6474a3feeaaSRobert Watson 		LIST_INSERT_HEAD(&bp->bif_dlist, d, bd_next);
648df8bae1dSRodney W. Grimes 
649afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
650e4b3229aSAlexander V. Chernikov 	BPFIF_WUNLOCK(bp);
651b743c310SSam Leffler 
65251ec1eb7SAlexander V. Chernikov 	bpf_bpfd_cnt++;
65351ec1eb7SAlexander V. Chernikov 
65451ec1eb7SAlexander V. Chernikov 	CTR3(KTR_NET, "%s: bpf_attach called by pid %d, adding to %s list",
65551ec1eb7SAlexander V. Chernikov 	    __func__, d->bd_pid, d->bd_writer ? "writer" : "active");
65651ec1eb7SAlexander V. Chernikov 
6576c74ff0eSAlexander V. Chernikov 	if (op_w == 0)
65851ec1eb7SAlexander V. Chernikov 		EVENTHANDLER_INVOKE(bpf_track, bp->bif_ifp, bp->bif_dlt, 1);
65951ec1eb7SAlexander V. Chernikov }
66051ec1eb7SAlexander V. Chernikov 
66151ec1eb7SAlexander V. Chernikov /*
66251ec1eb7SAlexander V. Chernikov  * Add d to the list of active bp filters.
66351ec1eb7SAlexander V. Chernikov  * Reuqires bpf_attachd() to be called before
66451ec1eb7SAlexander V. Chernikov  */
66551ec1eb7SAlexander V. Chernikov static void
66651ec1eb7SAlexander V. Chernikov bpf_upgraded(struct bpf_d *d)
66751ec1eb7SAlexander V. Chernikov {
66851ec1eb7SAlexander V. Chernikov 	struct bpf_if *bp;
66951ec1eb7SAlexander V. Chernikov 
6706c74ff0eSAlexander V. Chernikov 	BPF_LOCK_ASSERT();
6716c74ff0eSAlexander V. Chernikov 
67251ec1eb7SAlexander V. Chernikov 	bp = d->bd_bif;
67351ec1eb7SAlexander V. Chernikov 
6746c74ff0eSAlexander V. Chernikov 	/*
6756c74ff0eSAlexander V. Chernikov 	 * Filter can be set several times without specifying interface.
6766c74ff0eSAlexander V. Chernikov 	 * Mark d as reader and exit.
6776c74ff0eSAlexander V. Chernikov 	 */
6786c74ff0eSAlexander V. Chernikov 	if (bp == NULL) {
679afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
6806c74ff0eSAlexander V. Chernikov 		d->bd_writer = 0;
681afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
6826c74ff0eSAlexander V. Chernikov 		return;
6836c74ff0eSAlexander V. Chernikov 	}
6846c74ff0eSAlexander V. Chernikov 
68551ec1eb7SAlexander V. Chernikov 	BPFIF_WLOCK(bp);
686afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
68751ec1eb7SAlexander V. Chernikov 
68851ec1eb7SAlexander V. Chernikov 	/* Remove from writers-only list */
68951ec1eb7SAlexander V. Chernikov 	LIST_REMOVE(d, bd_next);
69051ec1eb7SAlexander V. Chernikov 	LIST_INSERT_HEAD(&bp->bif_dlist, d, bd_next);
69151ec1eb7SAlexander V. Chernikov 	/* Mark d as reader */
69251ec1eb7SAlexander V. Chernikov 	d->bd_writer = 0;
69351ec1eb7SAlexander V. Chernikov 
694afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
69551ec1eb7SAlexander V. Chernikov 	BPFIF_WUNLOCK(bp);
69651ec1eb7SAlexander V. Chernikov 
69751ec1eb7SAlexander V. Chernikov 	CTR2(KTR_NET, "%s: upgrade required by pid %d", __func__, d->bd_pid);
69851ec1eb7SAlexander V. Chernikov 
6995ce8d970SSam Leffler 	EVENTHANDLER_INVOKE(bpf_track, bp->bif_ifp, bp->bif_dlt, 1);
700df8bae1dSRodney W. Grimes }
701df8bae1dSRodney W. Grimes 
702df8bae1dSRodney W. Grimes /*
703df8bae1dSRodney W. Grimes  * Detach a file from its interface.
704df8bae1dSRodney W. Grimes  */
705df8bae1dSRodney W. Grimes static void
70619ba8395SChristian S.J. Peron bpf_detachd(struct bpf_d *d)
707df8bae1dSRodney W. Grimes {
7086c74ff0eSAlexander V. Chernikov 	BPF_LOCK();
7096c74ff0eSAlexander V. Chernikov 	bpf_detachd_locked(d);
7106c74ff0eSAlexander V. Chernikov 	BPF_UNLOCK();
7116c74ff0eSAlexander V. Chernikov }
7126c74ff0eSAlexander V. Chernikov 
7136c74ff0eSAlexander V. Chernikov static void
7146c74ff0eSAlexander V. Chernikov bpf_detachd_locked(struct bpf_d *d)
7156c74ff0eSAlexander V. Chernikov {
7166e891d64SPoul-Henning Kamp 	int error;
717df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
71846448b5aSRobert Watson 	struct ifnet *ifp;
719df8bae1dSRodney W. Grimes 
72051ec1eb7SAlexander V. Chernikov 	CTR2(KTR_NET, "%s: detach required by pid %d", __func__, d->bd_pid);
72151ec1eb7SAlexander V. Chernikov 
722e4b3229aSAlexander V. Chernikov 	BPF_LOCK_ASSERT();
723e4b3229aSAlexander V. Chernikov 
7246c74ff0eSAlexander V. Chernikov 	/* Check if descriptor is attached */
7256c74ff0eSAlexander V. Chernikov 	if ((bp = d->bd_bif) == NULL)
7266c74ff0eSAlexander V. Chernikov 		return;
7276c74ff0eSAlexander V. Chernikov 
728e4b3229aSAlexander V. Chernikov 	BPFIF_WLOCK(bp);
729afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
73046448b5aSRobert Watson 
73151ec1eb7SAlexander V. Chernikov 	/* Save bd_writer value */
73251ec1eb7SAlexander V. Chernikov 	error = d->bd_writer;
73351ec1eb7SAlexander V. Chernikov 
73446448b5aSRobert Watson 	/*
73546448b5aSRobert Watson 	 * Remove d from the interface's descriptor list.
73646448b5aSRobert Watson 	 */
73746448b5aSRobert Watson 	LIST_REMOVE(d, bd_next);
73846448b5aSRobert Watson 
739e4b3229aSAlexander V. Chernikov 	ifp = bp->bif_ifp;
740572bde2aSRobert Watson 	d->bd_bif = NULL;
741afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
742e4b3229aSAlexander V. Chernikov 	BPFIF_WUNLOCK(bp);
743e4b3229aSAlexander V. Chernikov 
744e4b3229aSAlexander V. Chernikov 	bpf_bpfd_cnt--;
74546448b5aSRobert Watson 
74651ec1eb7SAlexander V. Chernikov 	/* Call event handler iff d is attached */
74751ec1eb7SAlexander V. Chernikov 	if (error == 0)
7485ce8d970SSam Leffler 		EVENTHANDLER_INVOKE(bpf_track, ifp, bp->bif_dlt, 0);
749b743c310SSam Leffler 
750df8bae1dSRodney W. Grimes 	/*
751df8bae1dSRodney W. Grimes 	 * Check if this descriptor had requested promiscuous mode.
752df8bae1dSRodney W. Grimes 	 * If so, turn it off.
753df8bae1dSRodney W. Grimes 	 */
754df8bae1dSRodney W. Grimes 	if (d->bd_promisc) {
755df8bae1dSRodney W. Grimes 		d->bd_promisc = 0;
75697021c24SMarko Zec 		CURVNET_SET(ifp->if_vnet);
75746448b5aSRobert Watson 		error = ifpromisc(ifp, 0);
75897021c24SMarko Zec 		CURVNET_RESTORE();
7596e891d64SPoul-Henning Kamp 		if (error != 0 && error != ENXIO) {
760df8bae1dSRodney W. Grimes 			/*
7616e891d64SPoul-Henning Kamp 			 * ENXIO can happen if a pccard is unplugged
762df8bae1dSRodney W. Grimes 			 * Something is really wrong if we were able to put
763df8bae1dSRodney W. Grimes 			 * the driver into promiscuous mode, but can't
764df8bae1dSRodney W. Grimes 			 * take it out.
765df8bae1dSRodney W. Grimes 			 */
7668eab61f3SSam Leffler 			if_printf(bp->bif_ifp,
7678eab61f3SSam Leffler 				"bpf_detach: ifpromisc failed (%d)\n", error);
7686e891d64SPoul-Henning Kamp 		}
769df8bae1dSRodney W. Grimes 	}
770df8bae1dSRodney W. Grimes }
771df8bae1dSRodney W. Grimes 
772df8bae1dSRodney W. Grimes /*
773136600feSEd Schouten  * Close the descriptor by detaching it from its interface,
774136600feSEd Schouten  * deallocating its buffers, and marking it free.
775136600feSEd Schouten  */
776136600feSEd Schouten static void
777136600feSEd Schouten bpf_dtor(void *data)
778136600feSEd Schouten {
779136600feSEd Schouten 	struct bpf_d *d = data;
780136600feSEd Schouten 
781afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
782136600feSEd Schouten 	if (d->bd_state == BPF_WAITING)
783136600feSEd Schouten 		callout_stop(&d->bd_callout);
784136600feSEd Schouten 	d->bd_state = BPF_IDLE;
785afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
786136600feSEd Schouten 	funsetown(&d->bd_sigio);
787136600feSEd Schouten 	bpf_detachd(d);
788136600feSEd Schouten #ifdef MAC
789136600feSEd Schouten 	mac_bpfdesc_destroy(d);
790136600feSEd Schouten #endif /* MAC */
7916aba400aSAttilio Rao 	seldrain(&d->bd_sel);
792136600feSEd Schouten 	knlist_destroy(&d->bd_sel.si_note);
7939fee1bd1SJung-uk Kim 	callout_drain(&d->bd_callout);
794136600feSEd Schouten 	bpf_freed(d);
795136600feSEd Schouten 	free(d, M_BPF);
796136600feSEd Schouten }
797136600feSEd Schouten 
798136600feSEd Schouten /*
799df8bae1dSRodney W. Grimes  * Open ethernet device.  Returns ENXIO for illegal minor device number,
800df8bae1dSRodney W. Grimes  * EBUSY if file is open by another process.
801df8bae1dSRodney W. Grimes  */
802df8bae1dSRodney W. Grimes /* ARGSUSED */
80387f6c662SJulian Elischer static	int
80419ba8395SChristian S.J. Peron bpfopen(struct cdev *dev, int flags, int fmt, struct thread *td)
805df8bae1dSRodney W. Grimes {
806e7bb21b3SJonathan Lemon 	struct bpf_d *d;
807c7b0200eSAlexander V. Chernikov 	int error, size;
808df8bae1dSRodney W. Grimes 
8091ede983cSDag-Erling Smørgrav 	d = malloc(sizeof(*d), M_BPF, M_WAITOK | M_ZERO);
810136600feSEd Schouten 	error = devfs_set_cdevpriv(d, bpf_dtor);
811136600feSEd Schouten 	if (error != 0) {
812136600feSEd Schouten 		free(d, M_BPF);
813136600feSEd Schouten 		return (error);
814136600feSEd Schouten 	}
8154d621040SChristian S.J. Peron 
8164d621040SChristian S.J. Peron 	/*
8174d621040SChristian S.J. Peron 	 * For historical reasons, perform a one-time initialization call to
8184d621040SChristian S.J. Peron 	 * the buffer routines, even though we're not yet committed to a
8194d621040SChristian S.J. Peron 	 * particular buffer method.
8204d621040SChristian S.J. Peron 	 */
8214d621040SChristian S.J. Peron 	bpf_buffer_init(d);
8224d621040SChristian S.J. Peron 	d->bd_bufmode = BPF_BUFMODE_BUFFER;
82300a83887SPaul Traina 	d->bd_sig = SIGIO;
824560a54e1SJung-uk Kim 	d->bd_direction = BPF_D_INOUT;
825e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH(d, td);
82682f4445dSRobert Watson #ifdef MAC
82730d239bcSRobert Watson 	mac_bpfdesc_init(d);
82830d239bcSRobert Watson 	mac_bpfdesc_create(td->td_ucred, d);
82982f4445dSRobert Watson #endif
830afa85850SAlexander V. Chernikov 	mtx_init(&d->bd_lock, devtoname(dev), "bpf cdev lock", MTX_DEF);
831afa85850SAlexander V. Chernikov 	callout_init_mtx(&d->bd_callout, &d->bd_lock, 0);
832afa85850SAlexander V. Chernikov 	knlist_init_mtx(&d->bd_sel.si_note, &d->bd_lock);
833df8bae1dSRodney W. Grimes 
834c7b0200eSAlexander V. Chernikov 	/* Allocate default buffers */
835c7b0200eSAlexander V. Chernikov 	size = d->bd_bufsize;
836c7b0200eSAlexander V. Chernikov 	bpf_buffer_ioctl_sblen(d, &size);
837c7b0200eSAlexander V. Chernikov 
838df8bae1dSRodney W. Grimes 	return (0);
839df8bae1dSRodney W. Grimes }
840df8bae1dSRodney W. Grimes 
841df8bae1dSRodney W. Grimes /*
842df8bae1dSRodney W. Grimes  *  bpfread - read next chunk of packets from buffers
843df8bae1dSRodney W. Grimes  */
84487f6c662SJulian Elischer static	int
84519ba8395SChristian S.J. Peron bpfread(struct cdev *dev, struct uio *uio, int ioflag)
846df8bae1dSRodney W. Grimes {
847136600feSEd Schouten 	struct bpf_d *d;
848df8bae1dSRodney W. Grimes 	int error;
8498df67d77SJung-uk Kim 	int non_block;
8508df67d77SJung-uk Kim 	int timed_out;
851df8bae1dSRodney W. Grimes 
852136600feSEd Schouten 	error = devfs_get_cdevpriv((void **)&d);
853136600feSEd Schouten 	if (error != 0)
854136600feSEd Schouten 		return (error);
855136600feSEd Schouten 
856df8bae1dSRodney W. Grimes 	/*
857df8bae1dSRodney W. Grimes 	 * Restrict application to use a buffer the same size as
858df8bae1dSRodney W. Grimes 	 * as kernel buffers.
859df8bae1dSRodney W. Grimes 	 */
860df8bae1dSRodney W. Grimes 	if (uio->uio_resid != d->bd_bufsize)
861df8bae1dSRodney W. Grimes 		return (EINVAL);
862df8bae1dSRodney W. Grimes 
8638df67d77SJung-uk Kim 	non_block = ((ioflag & O_NONBLOCK) != 0);
8648df67d77SJung-uk Kim 
865afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
866e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH_CUR(d);
8674d621040SChristian S.J. Peron 	if (d->bd_bufmode != BPF_BUFMODE_BUFFER) {
868afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
8694d621040SChristian S.J. Peron 		return (EOPNOTSUPP);
8704d621040SChristian S.J. Peron 	}
87181bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING)
87281bda851SJohn Polstra 		callout_stop(&d->bd_callout);
87381bda851SJohn Polstra 	timed_out = (d->bd_state == BPF_TIMED_OUT);
87481bda851SJohn Polstra 	d->bd_state = BPF_IDLE;
875df8bae1dSRodney W. Grimes 	/*
876df8bae1dSRodney W. Grimes 	 * If the hold buffer is empty, then do a timed sleep, which
877df8bae1dSRodney W. Grimes 	 * ends when the timeout expires or when enough packets
878df8bae1dSRodney W. Grimes 	 * have arrived to fill the store buffer.
879df8bae1dSRodney W. Grimes 	 */
880572bde2aSRobert Watson 	while (d->bd_hbuf == NULL) {
8818df67d77SJung-uk Kim 		if (d->bd_slen != 0) {
882df8bae1dSRodney W. Grimes 			/*
883df8bae1dSRodney W. Grimes 			 * A packet(s) either arrived since the previous
884df8bae1dSRodney W. Grimes 			 * read or arrived while we were asleep.
8858df67d77SJung-uk Kim 			 */
8868df67d77SJung-uk Kim 			if (d->bd_immediate || non_block || timed_out) {
8878df67d77SJung-uk Kim 				/*
8888df67d77SJung-uk Kim 				 * Rotate the buffers and return what's here
8898df67d77SJung-uk Kim 				 * if we are in immediate mode, non-blocking
8908df67d77SJung-uk Kim 				 * flag is set, or this descriptor timed out.
891df8bae1dSRodney W. Grimes 				 */
892df8bae1dSRodney W. Grimes 				ROTATE_BUFFERS(d);
893df8bae1dSRodney W. Grimes 				break;
894df8bae1dSRodney W. Grimes 			}
8958df67d77SJung-uk Kim 		}
896de5d9935SRobert Watson 
897de5d9935SRobert Watson 		/*
898de5d9935SRobert Watson 		 * No data is available, check to see if the bpf device
899de5d9935SRobert Watson 		 * is still pointed at a real interface.  If not, return
900de5d9935SRobert Watson 		 * ENXIO so that the userland process knows to rebind
901de5d9935SRobert Watson 		 * it before using it again.
902de5d9935SRobert Watson 		 */
903de5d9935SRobert Watson 		if (d->bd_bif == NULL) {
904afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
905de5d9935SRobert Watson 			return (ENXIO);
906de5d9935SRobert Watson 		}
907de5d9935SRobert Watson 
9088df67d77SJung-uk Kim 		if (non_block) {
909afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
910fba3cfdeSJohn Polstra 			return (EWOULDBLOCK);
911fba3cfdeSJohn Polstra 		}
912afa85850SAlexander V. Chernikov 		error = msleep(d, &d->bd_lock, PRINET|PCATCH,
913e7bb21b3SJonathan Lemon 		     "bpf", d->bd_rtout);
914df8bae1dSRodney W. Grimes 		if (error == EINTR || error == ERESTART) {
915afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
916df8bae1dSRodney W. Grimes 			return (error);
917df8bae1dSRodney W. Grimes 		}
918df8bae1dSRodney W. Grimes 		if (error == EWOULDBLOCK) {
919df8bae1dSRodney W. Grimes 			/*
920df8bae1dSRodney W. Grimes 			 * On a timeout, return what's in the buffer,
921df8bae1dSRodney W. Grimes 			 * which may be nothing.  If there is something
922df8bae1dSRodney W. Grimes 			 * in the store buffer, we can rotate the buffers.
923df8bae1dSRodney W. Grimes 			 */
924df8bae1dSRodney W. Grimes 			if (d->bd_hbuf)
925df8bae1dSRodney W. Grimes 				/*
926df8bae1dSRodney W. Grimes 				 * We filled up the buffer in between
927df8bae1dSRodney W. Grimes 				 * getting the timeout and arriving
928df8bae1dSRodney W. Grimes 				 * here, so we don't need to rotate.
929df8bae1dSRodney W. Grimes 				 */
930df8bae1dSRodney W. Grimes 				break;
931df8bae1dSRodney W. Grimes 
932df8bae1dSRodney W. Grimes 			if (d->bd_slen == 0) {
933afa85850SAlexander V. Chernikov 				BPFD_UNLOCK(d);
934df8bae1dSRodney W. Grimes 				return (0);
935df8bae1dSRodney W. Grimes 			}
936df8bae1dSRodney W. Grimes 			ROTATE_BUFFERS(d);
937df8bae1dSRodney W. Grimes 			break;
938df8bae1dSRodney W. Grimes 		}
939df8bae1dSRodney W. Grimes 	}
940df8bae1dSRodney W. Grimes 	/*
941df8bae1dSRodney W. Grimes 	 * At this point, we know we have something in the hold slot.
942df8bae1dSRodney W. Grimes 	 */
943afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
944df8bae1dSRodney W. Grimes 
945df8bae1dSRodney W. Grimes 	/*
946df8bae1dSRodney W. Grimes 	 * Move data from hold buffer into user space.
947df8bae1dSRodney W. Grimes 	 * We know the entire buffer is transferred since
948df8bae1dSRodney W. Grimes 	 * we checked above that the read buffer is bpf_bufsize bytes.
94931b32e6dSRobert Watson 	 *
95031b32e6dSRobert Watson 	 * XXXRW: More synchronization needed here: what if a second thread
95131b32e6dSRobert Watson 	 * issues a read on the same fd at the same time?  Don't want this
95231b32e6dSRobert Watson 	 * getting invalidated.
953df8bae1dSRodney W. Grimes 	 */
9544d621040SChristian S.J. Peron 	error = bpf_uiomove(d, d->bd_hbuf, d->bd_hlen, uio);
955df8bae1dSRodney W. Grimes 
956afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
957df8bae1dSRodney W. Grimes 	d->bd_fbuf = d->bd_hbuf;
958572bde2aSRobert Watson 	d->bd_hbuf = NULL;
959df8bae1dSRodney W. Grimes 	d->bd_hlen = 0;
96029f612ecSChristian S.J. Peron 	bpf_buf_reclaimed(d);
961afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
962df8bae1dSRodney W. Grimes 
963df8bae1dSRodney W. Grimes 	return (error);
964df8bae1dSRodney W. Grimes }
965df8bae1dSRodney W. Grimes 
966df8bae1dSRodney W. Grimes /*
967df8bae1dSRodney W. Grimes  * If there are processes sleeping on this descriptor, wake them up.
968df8bae1dSRodney W. Grimes  */
969e7bb21b3SJonathan Lemon static __inline void
97019ba8395SChristian S.J. Peron bpf_wakeup(struct bpf_d *d)
971df8bae1dSRodney W. Grimes {
972a3272e3cSChristian S.J. Peron 
973afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
97481bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING) {
97581bda851SJohn Polstra 		callout_stop(&d->bd_callout);
97681bda851SJohn Polstra 		d->bd_state = BPF_IDLE;
97781bda851SJohn Polstra 	}
978521f364bSDag-Erling Smørgrav 	wakeup(d);
979831d27a9SDon Lewis 	if (d->bd_async && d->bd_sig && d->bd_sigio)
980f1320723SAlfred Perlstein 		pgsigio(&d->bd_sigio, d->bd_sig, 0);
98100a83887SPaul Traina 
982512824f8SSeigo Tanimura 	selwakeuppri(&d->bd_sel, PRINET);
983ad3b9257SJohn-Mark Gurney 	KNOTE_LOCKED(&d->bd_sel.si_note, 0);
984df8bae1dSRodney W. Grimes }
985df8bae1dSRodney W. Grimes 
98681bda851SJohn Polstra static void
98719ba8395SChristian S.J. Peron bpf_timed_out(void *arg)
98881bda851SJohn Polstra {
98981bda851SJohn Polstra 	struct bpf_d *d = (struct bpf_d *)arg;
99081bda851SJohn Polstra 
991afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
9929fee1bd1SJung-uk Kim 
9939fee1bd1SJung-uk Kim 	if (callout_pending(&d->bd_callout) || !callout_active(&d->bd_callout))
9949fee1bd1SJung-uk Kim 		return;
99581bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING) {
99681bda851SJohn Polstra 		d->bd_state = BPF_TIMED_OUT;
99781bda851SJohn Polstra 		if (d->bd_slen != 0)
99881bda851SJohn Polstra 			bpf_wakeup(d);
99981bda851SJohn Polstra 	}
100081bda851SJohn Polstra }
100181bda851SJohn Polstra 
100287f6c662SJulian Elischer static int
10034d621040SChristian S.J. Peron bpf_ready(struct bpf_d *d)
10044d621040SChristian S.J. Peron {
10054d621040SChristian S.J. Peron 
1006afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
10074d621040SChristian S.J. Peron 
10084d621040SChristian S.J. Peron 	if (!bpf_canfreebuf(d) && d->bd_hlen != 0)
10094d621040SChristian S.J. Peron 		return (1);
10104d621040SChristian S.J. Peron 	if ((d->bd_immediate || d->bd_state == BPF_TIMED_OUT) &&
10114d621040SChristian S.J. Peron 	    d->bd_slen != 0)
10124d621040SChristian S.J. Peron 		return (1);
10134d621040SChristian S.J. Peron 	return (0);
10144d621040SChristian S.J. Peron }
10154d621040SChristian S.J. Peron 
10164d621040SChristian S.J. Peron static int
101719ba8395SChristian S.J. Peron bpfwrite(struct cdev *dev, struct uio *uio, int ioflag)
1018df8bae1dSRodney W. Grimes {
1019136600feSEd Schouten 	struct bpf_d *d;
1020df8bae1dSRodney W. Grimes 	struct ifnet *ifp;
1021560a54e1SJung-uk Kim 	struct mbuf *m, *mc;
10228240bf1eSRobert Watson 	struct sockaddr dst;
1023560a54e1SJung-uk Kim 	int error, hlen;
1024df8bae1dSRodney W. Grimes 
1025136600feSEd Schouten 	error = devfs_get_cdevpriv((void **)&d);
1026136600feSEd Schouten 	if (error != 0)
1027136600feSEd Schouten 		return (error);
1028136600feSEd Schouten 
1029e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH_CUR(d);
10304d621040SChristian S.J. Peron 	d->bd_wcount++;
10316c74ff0eSAlexander V. Chernikov 	/* XXX: locking required */
10324d621040SChristian S.J. Peron 	if (d->bd_bif == NULL) {
10334d621040SChristian S.J. Peron 		d->bd_wdcount++;
1034df8bae1dSRodney W. Grimes 		return (ENXIO);
10354d621040SChristian S.J. Peron 	}
1036df8bae1dSRodney W. Grimes 
1037df8bae1dSRodney W. Grimes 	ifp = d->bd_bif->bif_ifp;
1038df8bae1dSRodney W. Grimes 
10394d621040SChristian S.J. Peron 	if ((ifp->if_flags & IFF_UP) == 0) {
10404d621040SChristian S.J. Peron 		d->bd_wdcount++;
10413518d220SSam Leffler 		return (ENETDOWN);
10424d621040SChristian S.J. Peron 	}
10433518d220SSam Leffler 
10444d621040SChristian S.J. Peron 	if (uio->uio_resid == 0) {
10454d621040SChristian S.J. Peron 		d->bd_wdcount++;
1046df8bae1dSRodney W. Grimes 		return (0);
10474d621040SChristian S.J. Peron 	}
1048df8bae1dSRodney W. Grimes 
10498240bf1eSRobert Watson 	bzero(&dst, sizeof(dst));
1050d83e603aSChristian S.J. Peron 	m = NULL;
1051d83e603aSChristian S.J. Peron 	hlen = 0;
10526c74ff0eSAlexander V. Chernikov 	/* XXX: bpf_movein() can sleep */
1053cb44b6dfSAndrew Thompson 	error = bpf_movein(uio, (int)d->bd_bif->bif_dlt, ifp,
1054560a54e1SJung-uk Kim 	    &m, &dst, &hlen, d->bd_wfilter);
10554d621040SChristian S.J. Peron 	if (error) {
10564d621040SChristian S.J. Peron 		d->bd_wdcount++;
1057df8bae1dSRodney W. Grimes 		return (error);
10584d621040SChristian S.J. Peron 	}
10594d621040SChristian S.J. Peron 	d->bd_wfcount++;
1060114ae644SMike Smith 	if (d->bd_hdrcmplt)
1061114ae644SMike Smith 		dst.sa_family = pseudo_AF_HDRCMPLT;
1062114ae644SMike Smith 
1063560a54e1SJung-uk Kim 	if (d->bd_feedback) {
1064560a54e1SJung-uk Kim 		mc = m_dup(m, M_DONTWAIT);
1065560a54e1SJung-uk Kim 		if (mc != NULL)
1066560a54e1SJung-uk Kim 			mc->m_pkthdr.rcvif = ifp;
10678cd892f7SJung-uk Kim 		/* Set M_PROMISC for outgoing packets to be discarded. */
10688cd892f7SJung-uk Kim 		if (d->bd_direction == BPF_D_INOUT)
10698cd892f7SJung-uk Kim 			m->m_flags |= M_PROMISC;
1070560a54e1SJung-uk Kim 	} else
1071560a54e1SJung-uk Kim 		mc = NULL;
1072560a54e1SJung-uk Kim 
1073560a54e1SJung-uk Kim 	m->m_pkthdr.len -= hlen;
1074560a54e1SJung-uk Kim 	m->m_len -= hlen;
1075560a54e1SJung-uk Kim 	m->m_data += hlen;	/* XXX */
1076560a54e1SJung-uk Kim 
107721ca7b57SMarko Zec 	CURVNET_SET(ifp->if_vnet);
107882f4445dSRobert Watson #ifdef MAC
1079afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
108030d239bcSRobert Watson 	mac_bpfdesc_create_mbuf(d, m);
1081560a54e1SJung-uk Kim 	if (mc != NULL)
108230d239bcSRobert Watson 		mac_bpfdesc_create_mbuf(d, mc);
1083afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
108482f4445dSRobert Watson #endif
1085560a54e1SJung-uk Kim 
1086572bde2aSRobert Watson 	error = (*ifp->if_output)(ifp, m, &dst, NULL);
10874d621040SChristian S.J. Peron 	if (error)
10884d621040SChristian S.J. Peron 		d->bd_wdcount++;
1089560a54e1SJung-uk Kim 
1090560a54e1SJung-uk Kim 	if (mc != NULL) {
10910bf686c1SRobert Watson 		if (error == 0)
1092560a54e1SJung-uk Kim 			(*ifp->if_input)(ifp, mc);
10930bf686c1SRobert Watson 		else
1094560a54e1SJung-uk Kim 			m_freem(mc);
1095560a54e1SJung-uk Kim 	}
109621ca7b57SMarko Zec 	CURVNET_RESTORE();
1097560a54e1SJung-uk Kim 
1098df8bae1dSRodney W. Grimes 	return (error);
1099df8bae1dSRodney W. Grimes }
1100df8bae1dSRodney W. Grimes 
1101df8bae1dSRodney W. Grimes /*
1102e82669d9SRobert Watson  * Reset a descriptor by flushing its packet buffer and clearing the receive
1103e82669d9SRobert Watson  * and drop counts.  This is doable for kernel-only buffers, but with
1104e82669d9SRobert Watson  * zero-copy buffers, we can't write to (or rotate) buffers that are
1105e82669d9SRobert Watson  * currently owned by userspace.  It would be nice if we could encapsulate
1106e82669d9SRobert Watson  * this logic in the buffer code rather than here.
1107df8bae1dSRodney W. Grimes  */
1108df8bae1dSRodney W. Grimes static void
110919ba8395SChristian S.J. Peron reset_d(struct bpf_d *d)
1110df8bae1dSRodney W. Grimes {
1111e7bb21b3SJonathan Lemon 
1112afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
1113e82669d9SRobert Watson 
1114e82669d9SRobert Watson 	if ((d->bd_hbuf != NULL) &&
1115e82669d9SRobert Watson 	    (d->bd_bufmode != BPF_BUFMODE_ZBUF || bpf_canfreebuf(d))) {
1116df8bae1dSRodney W. Grimes 		/* Free the hold buffer. */
1117df8bae1dSRodney W. Grimes 		d->bd_fbuf = d->bd_hbuf;
1118572bde2aSRobert Watson 		d->bd_hbuf = NULL;
1119e82669d9SRobert Watson 		d->bd_hlen = 0;
112029f612ecSChristian S.J. Peron 		bpf_buf_reclaimed(d);
1121df8bae1dSRodney W. Grimes 	}
1122e82669d9SRobert Watson 	if (bpf_canwritebuf(d))
1123df8bae1dSRodney W. Grimes 		d->bd_slen = 0;
1124df8bae1dSRodney W. Grimes 	d->bd_rcount = 0;
1125df8bae1dSRodney W. Grimes 	d->bd_dcount = 0;
112669f7644bSChristian S.J. Peron 	d->bd_fcount = 0;
11274d621040SChristian S.J. Peron 	d->bd_wcount = 0;
11284d621040SChristian S.J. Peron 	d->bd_wfcount = 0;
11294d621040SChristian S.J. Peron 	d->bd_wdcount = 0;
11304d621040SChristian S.J. Peron 	d->bd_zcopy = 0;
1131df8bae1dSRodney W. Grimes }
1132df8bae1dSRodney W. Grimes 
1133df8bae1dSRodney W. Grimes /*
1134df8bae1dSRodney W. Grimes  *  FIONREAD		Check for read packet available.
1135df8bae1dSRodney W. Grimes  *  SIOCGIFADDR		Get interface address - convenient hook to driver.
1136df8bae1dSRodney W. Grimes  *  BIOCGBLEN		Get buffer len [for read()].
1137f11c3508SDavid Malone  *  BIOCSETF		Set read filter.
1138f11c3508SDavid Malone  *  BIOCSETFNR		Set read filter without resetting descriptor.
1139f11c3508SDavid Malone  *  BIOCSETWF		Set write filter.
1140df8bae1dSRodney W. Grimes  *  BIOCFLUSH		Flush read packet buffer.
1141df8bae1dSRodney W. Grimes  *  BIOCPROMISC		Put interface into promiscuous mode.
1142df8bae1dSRodney W. Grimes  *  BIOCGDLT		Get link layer type.
1143df8bae1dSRodney W. Grimes  *  BIOCGETIF		Get interface name.
1144df8bae1dSRodney W. Grimes  *  BIOCSETIF		Set interface.
1145df8bae1dSRodney W. Grimes  *  BIOCSRTIMEOUT	Set read timeout.
1146df8bae1dSRodney W. Grimes  *  BIOCGRTIMEOUT	Get read timeout.
1147df8bae1dSRodney W. Grimes  *  BIOCGSTATS		Get packet stats.
1148df8bae1dSRodney W. Grimes  *  BIOCIMMEDIATE	Set immediate mode.
1149df8bae1dSRodney W. Grimes  *  BIOCVERSION		Get filter language version.
1150114ae644SMike Smith  *  BIOCGHDRCMPLT	Get "header already complete" flag
1151114ae644SMike Smith  *  BIOCSHDRCMPLT	Set "header already complete" flag
1152560a54e1SJung-uk Kim  *  BIOCGDIRECTION	Get packet direction flag
1153560a54e1SJung-uk Kim  *  BIOCSDIRECTION	Set packet direction flag
1154547d94bdSJung-uk Kim  *  BIOCGTSTAMP		Get time stamp format and resolution.
1155547d94bdSJung-uk Kim  *  BIOCSTSTAMP		Set time stamp format and resolution.
115693e39f0bSChristian S.J. Peron  *  BIOCLOCK		Set "locked" flag
1157560a54e1SJung-uk Kim  *  BIOCFEEDBACK	Set packet feedback mode.
11584d621040SChristian S.J. Peron  *  BIOCSETZBUF		Set current zero-copy buffer locations.
11594d621040SChristian S.J. Peron  *  BIOCGETZMAX		Get maximum zero-copy buffer size.
11604d621040SChristian S.J. Peron  *  BIOCROTZBUF		Force rotation of zero-copy buffer
11614d621040SChristian S.J. Peron  *  BIOCSETBUFMODE	Set buffer mode.
11624d621040SChristian S.J. Peron  *  BIOCGETBUFMODE	Get current buffer mode.
1163df8bae1dSRodney W. Grimes  */
1164df8bae1dSRodney W. Grimes /* ARGSUSED */
116587f6c662SJulian Elischer static	int
116619ba8395SChristian S.J. Peron bpfioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags,
116719ba8395SChristian S.J. Peron     struct thread *td)
1168df8bae1dSRodney W. Grimes {
1169136600feSEd Schouten 	struct bpf_d *d;
1170136600feSEd Schouten 	int error;
1171136600feSEd Schouten 
1172136600feSEd Schouten 	error = devfs_get_cdevpriv((void **)&d);
1173136600feSEd Schouten 	if (error != 0)
1174136600feSEd Schouten 		return (error);
1175df8bae1dSRodney W. Grimes 
1176b75a24a0SChristian S.J. Peron 	/*
1177b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
1178b75a24a0SChristian S.J. Peron 	 */
1179afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
1180e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH(d, td);
118181bda851SJohn Polstra 	if (d->bd_state == BPF_WAITING)
118281bda851SJohn Polstra 		callout_stop(&d->bd_callout);
118381bda851SJohn Polstra 	d->bd_state = BPF_IDLE;
1184afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
118581bda851SJohn Polstra 
118693e39f0bSChristian S.J. Peron 	if (d->bd_locked == 1) {
118793e39f0bSChristian S.J. Peron 		switch (cmd) {
118893e39f0bSChristian S.J. Peron 		case BIOCGBLEN:
118993e39f0bSChristian S.J. Peron 		case BIOCFLUSH:
119093e39f0bSChristian S.J. Peron 		case BIOCGDLT:
119193e39f0bSChristian S.J. Peron 		case BIOCGDLTLIST:
1192fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
1193fc0a61a4SKonstantin Belousov 		case BIOCGDLTLIST32:
1194fc0a61a4SKonstantin Belousov #endif
119593e39f0bSChristian S.J. Peron 		case BIOCGETIF:
119693e39f0bSChristian S.J. Peron 		case BIOCGRTIMEOUT:
11979624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1198fc0a61a4SKonstantin Belousov 		case BIOCGRTIMEOUT32:
1199fc0a61a4SKonstantin Belousov #endif
120093e39f0bSChristian S.J. Peron 		case BIOCGSTATS:
120193e39f0bSChristian S.J. Peron 		case BIOCVERSION:
120293e39f0bSChristian S.J. Peron 		case BIOCGRSIG:
120393e39f0bSChristian S.J. Peron 		case BIOCGHDRCMPLT:
1204547d94bdSJung-uk Kim 		case BIOCSTSTAMP:
1205560a54e1SJung-uk Kim 		case BIOCFEEDBACK:
120693e39f0bSChristian S.J. Peron 		case FIONREAD:
120793e39f0bSChristian S.J. Peron 		case BIOCLOCK:
120893e39f0bSChristian S.J. Peron 		case BIOCSRTIMEOUT:
12099624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1210fc0a61a4SKonstantin Belousov 		case BIOCSRTIMEOUT32:
1211fc0a61a4SKonstantin Belousov #endif
121293e39f0bSChristian S.J. Peron 		case BIOCIMMEDIATE:
121393e39f0bSChristian S.J. Peron 		case TIOCGPGRP:
12144d621040SChristian S.J. Peron 		case BIOCROTZBUF:
121593e39f0bSChristian S.J. Peron 			break;
121693e39f0bSChristian S.J. Peron 		default:
121793e39f0bSChristian S.J. Peron 			return (EPERM);
121893e39f0bSChristian S.J. Peron 		}
121993e39f0bSChristian S.J. Peron 	}
1220fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
1221fc0a61a4SKonstantin Belousov 	/*
1222fc0a61a4SKonstantin Belousov 	 * If we see a 32-bit compat ioctl, mark the stream as 32-bit so
1223fc0a61a4SKonstantin Belousov 	 * that it will get 32-bit packet headers.
1224fc0a61a4SKonstantin Belousov 	 */
1225fc0a61a4SKonstantin Belousov 	switch (cmd) {
1226fc0a61a4SKonstantin Belousov 	case BIOCSETF32:
1227fc0a61a4SKonstantin Belousov 	case BIOCSETFNR32:
1228fc0a61a4SKonstantin Belousov 	case BIOCSETWF32:
1229fc0a61a4SKonstantin Belousov 	case BIOCGDLTLIST32:
1230fc0a61a4SKonstantin Belousov 	case BIOCGRTIMEOUT32:
1231fc0a61a4SKonstantin Belousov 	case BIOCSRTIMEOUT32:
1232*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1233fc0a61a4SKonstantin Belousov 		d->bd_compat32 = 1;
1234*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1235fc0a61a4SKonstantin Belousov 	}
1236fc0a61a4SKonstantin Belousov #endif
1237fc0a61a4SKonstantin Belousov 
123897021c24SMarko Zec 	CURVNET_SET(TD_TO_VNET(td));
1239df8bae1dSRodney W. Grimes 	switch (cmd) {
1240df8bae1dSRodney W. Grimes 
1241df8bae1dSRodney W. Grimes 	default:
1242df8bae1dSRodney W. Grimes 		error = EINVAL;
1243df8bae1dSRodney W. Grimes 		break;
1244df8bae1dSRodney W. Grimes 
1245df8bae1dSRodney W. Grimes 	/*
1246df8bae1dSRodney W. Grimes 	 * Check for read packet available.
1247df8bae1dSRodney W. Grimes 	 */
1248df8bae1dSRodney W. Grimes 	case FIONREAD:
1249df8bae1dSRodney W. Grimes 		{
1250df8bae1dSRodney W. Grimes 			int n;
1251df8bae1dSRodney W. Grimes 
1252afa85850SAlexander V. Chernikov 			BPFD_LOCK(d);
1253df8bae1dSRodney W. Grimes 			n = d->bd_slen;
1254df8bae1dSRodney W. Grimes 			if (d->bd_hbuf)
1255df8bae1dSRodney W. Grimes 				n += d->bd_hlen;
1256afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
1257df8bae1dSRodney W. Grimes 
1258df8bae1dSRodney W. Grimes 			*(int *)addr = n;
1259df8bae1dSRodney W. Grimes 			break;
1260df8bae1dSRodney W. Grimes 		}
1261df8bae1dSRodney W. Grimes 
1262df8bae1dSRodney W. Grimes 	case SIOCGIFADDR:
1263df8bae1dSRodney W. Grimes 		{
1264df8bae1dSRodney W. Grimes 			struct ifnet *ifp;
1265df8bae1dSRodney W. Grimes 
1266572bde2aSRobert Watson 			if (d->bd_bif == NULL)
1267df8bae1dSRodney W. Grimes 				error = EINVAL;
1268df8bae1dSRodney W. Grimes 			else {
1269df8bae1dSRodney W. Grimes 				ifp = d->bd_bif->bif_ifp;
1270df8bae1dSRodney W. Grimes 				error = (*ifp->if_ioctl)(ifp, cmd, addr);
1271df8bae1dSRodney W. Grimes 			}
1272df8bae1dSRodney W. Grimes 			break;
1273df8bae1dSRodney W. Grimes 		}
1274df8bae1dSRodney W. Grimes 
1275df8bae1dSRodney W. Grimes 	/*
1276df8bae1dSRodney W. Grimes 	 * Get buffer len [for read()].
1277df8bae1dSRodney W. Grimes 	 */
1278df8bae1dSRodney W. Grimes 	case BIOCGBLEN:
1279*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1280df8bae1dSRodney W. Grimes 		*(u_int *)addr = d->bd_bufsize;
1281*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1282df8bae1dSRodney W. Grimes 		break;
1283df8bae1dSRodney W. Grimes 
1284df8bae1dSRodney W. Grimes 	/*
1285df8bae1dSRodney W. Grimes 	 * Set buffer length.
1286df8bae1dSRodney W. Grimes 	 */
1287df8bae1dSRodney W. Grimes 	case BIOCSBLEN:
12884d621040SChristian S.J. Peron 		error = bpf_ioctl_sblen(d, (u_int *)addr);
1289df8bae1dSRodney W. Grimes 		break;
1290df8bae1dSRodney W. Grimes 
1291df8bae1dSRodney W. Grimes 	/*
1292df8bae1dSRodney W. Grimes 	 * Set link layer read filter.
1293df8bae1dSRodney W. Grimes 	 */
1294df8bae1dSRodney W. Grimes 	case BIOCSETF:
1295f11c3508SDavid Malone 	case BIOCSETFNR:
129693e39f0bSChristian S.J. Peron 	case BIOCSETWF:
1297fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
1298fc0a61a4SKonstantin Belousov 	case BIOCSETF32:
1299fc0a61a4SKonstantin Belousov 	case BIOCSETFNR32:
1300fc0a61a4SKonstantin Belousov 	case BIOCSETWF32:
1301fc0a61a4SKonstantin Belousov #endif
130293e39f0bSChristian S.J. Peron 		error = bpf_setf(d, (struct bpf_program *)addr, cmd);
1303df8bae1dSRodney W. Grimes 		break;
1304df8bae1dSRodney W. Grimes 
1305df8bae1dSRodney W. Grimes 	/*
1306df8bae1dSRodney W. Grimes 	 * Flush read packet buffer.
1307df8bae1dSRodney W. Grimes 	 */
1308df8bae1dSRodney W. Grimes 	case BIOCFLUSH:
1309afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
1310df8bae1dSRodney W. Grimes 		reset_d(d);
1311afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1312df8bae1dSRodney W. Grimes 		break;
1313df8bae1dSRodney W. Grimes 
1314df8bae1dSRodney W. Grimes 	/*
1315df8bae1dSRodney W. Grimes 	 * Put interface into promiscuous mode.
1316df8bae1dSRodney W. Grimes 	 */
1317df8bae1dSRodney W. Grimes 	case BIOCPROMISC:
1318572bde2aSRobert Watson 		if (d->bd_bif == NULL) {
1319df8bae1dSRodney W. Grimes 			/*
1320df8bae1dSRodney W. Grimes 			 * No interface attached yet.
1321df8bae1dSRodney W. Grimes 			 */
1322df8bae1dSRodney W. Grimes 			error = EINVAL;
1323df8bae1dSRodney W. Grimes 			break;
1324df8bae1dSRodney W. Grimes 		}
1325df8bae1dSRodney W. Grimes 		if (d->bd_promisc == 0) {
1326df8bae1dSRodney W. Grimes 			error = ifpromisc(d->bd_bif->bif_ifp, 1);
1327df8bae1dSRodney W. Grimes 			if (error == 0)
1328df8bae1dSRodney W. Grimes 				d->bd_promisc = 1;
1329df8bae1dSRodney W. Grimes 		}
1330df8bae1dSRodney W. Grimes 		break;
1331df8bae1dSRodney W. Grimes 
1332df8bae1dSRodney W. Grimes 	/*
13338eab61f3SSam Leffler 	 * Get current data link type.
1334df8bae1dSRodney W. Grimes 	 */
1335df8bae1dSRodney W. Grimes 	case BIOCGDLT:
1336*97aacec6SAlexander V. Chernikov 		BPF_LOCK();
1337572bde2aSRobert Watson 		if (d->bd_bif == NULL)
1338df8bae1dSRodney W. Grimes 			error = EINVAL;
1339df8bae1dSRodney W. Grimes 		else
1340df8bae1dSRodney W. Grimes 			*(u_int *)addr = d->bd_bif->bif_dlt;
1341*97aacec6SAlexander V. Chernikov 		BPF_UNLOCK();
1342df8bae1dSRodney W. Grimes 		break;
1343df8bae1dSRodney W. Grimes 
1344df8bae1dSRodney W. Grimes 	/*
13458eab61f3SSam Leffler 	 * Get a list of supported data link types.
13468eab61f3SSam Leffler 	 */
1347fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
1348fc0a61a4SKonstantin Belousov 	case BIOCGDLTLIST32:
1349fc0a61a4SKonstantin Belousov 		{
1350fc0a61a4SKonstantin Belousov 			struct bpf_dltlist32 *list32;
1351fc0a61a4SKonstantin Belousov 			struct bpf_dltlist dltlist;
1352fc0a61a4SKonstantin Belousov 
1353fc0a61a4SKonstantin Belousov 			list32 = (struct bpf_dltlist32 *)addr;
1354fc0a61a4SKonstantin Belousov 			dltlist.bfl_len = list32->bfl_len;
1355fc0a61a4SKonstantin Belousov 			dltlist.bfl_list = PTRIN(list32->bfl_list);
1356*97aacec6SAlexander V. Chernikov 			BPF_LOCK();
1357fc0a61a4SKonstantin Belousov 			if (d->bd_bif == NULL)
1358fc0a61a4SKonstantin Belousov 				error = EINVAL;
1359fc0a61a4SKonstantin Belousov 			else {
1360fc0a61a4SKonstantin Belousov 				error = bpf_getdltlist(d, &dltlist);
1361fc0a61a4SKonstantin Belousov 				if (error == 0)
1362fc0a61a4SKonstantin Belousov 					list32->bfl_len = dltlist.bfl_len;
1363fc0a61a4SKonstantin Belousov 			}
1364*97aacec6SAlexander V. Chernikov 			BPF_UNLOCK();
1365fc0a61a4SKonstantin Belousov 			break;
1366fc0a61a4SKonstantin Belousov 		}
1367fc0a61a4SKonstantin Belousov #endif
1368fc0a61a4SKonstantin Belousov 
13698eab61f3SSam Leffler 	case BIOCGDLTLIST:
1370*97aacec6SAlexander V. Chernikov 		BPF_LOCK();
1371572bde2aSRobert Watson 		if (d->bd_bif == NULL)
13728eab61f3SSam Leffler 			error = EINVAL;
13738eab61f3SSam Leffler 		else
13748eab61f3SSam Leffler 			error = bpf_getdltlist(d, (struct bpf_dltlist *)addr);
1375*97aacec6SAlexander V. Chernikov 		BPF_UNLOCK();
13768eab61f3SSam Leffler 		break;
13778eab61f3SSam Leffler 
13788eab61f3SSam Leffler 	/*
13798eab61f3SSam Leffler 	 * Set data link type.
13808eab61f3SSam Leffler 	 */
13818eab61f3SSam Leffler 	case BIOCSDLT:
13826c74ff0eSAlexander V. Chernikov 		BPF_LOCK();
1383572bde2aSRobert Watson 		if (d->bd_bif == NULL)
13848eab61f3SSam Leffler 			error = EINVAL;
13858eab61f3SSam Leffler 		else
13868eab61f3SSam Leffler 			error = bpf_setdlt(d, *(u_int *)addr);
13876c74ff0eSAlexander V. Chernikov 		BPF_UNLOCK();
13888eab61f3SSam Leffler 		break;
13898eab61f3SSam Leffler 
13908eab61f3SSam Leffler 	/*
13911dd0feaaSArchie Cobbs 	 * Get interface name.
1392df8bae1dSRodney W. Grimes 	 */
1393df8bae1dSRodney W. Grimes 	case BIOCGETIF:
1394*97aacec6SAlexander V. Chernikov 		BPF_LOCK();
1395572bde2aSRobert Watson 		if (d->bd_bif == NULL)
1396df8bae1dSRodney W. Grimes 			error = EINVAL;
13971dd0feaaSArchie Cobbs 		else {
13981dd0feaaSArchie Cobbs 			struct ifnet *const ifp = d->bd_bif->bif_ifp;
13991dd0feaaSArchie Cobbs 			struct ifreq *const ifr = (struct ifreq *)addr;
14001dd0feaaSArchie Cobbs 
14019bf40edeSBrooks Davis 			strlcpy(ifr->ifr_name, ifp->if_xname,
14029bf40edeSBrooks Davis 			    sizeof(ifr->ifr_name));
14031dd0feaaSArchie Cobbs 		}
1404*97aacec6SAlexander V. Chernikov 		BPF_UNLOCK();
1405df8bae1dSRodney W. Grimes 		break;
1406df8bae1dSRodney W. Grimes 
1407df8bae1dSRodney W. Grimes 	/*
1408df8bae1dSRodney W. Grimes 	 * Set interface.
1409df8bae1dSRodney W. Grimes 	 */
1410df8bae1dSRodney W. Grimes 	case BIOCSETIF:
14116c74ff0eSAlexander V. Chernikov 		BPF_LOCK();
1412df8bae1dSRodney W. Grimes 		error = bpf_setif(d, (struct ifreq *)addr);
14136c74ff0eSAlexander V. Chernikov 		BPF_UNLOCK();
1414df8bae1dSRodney W. Grimes 		break;
1415df8bae1dSRodney W. Grimes 
1416df8bae1dSRodney W. Grimes 	/*
1417df8bae1dSRodney W. Grimes 	 * Set read timeout.
1418df8bae1dSRodney W. Grimes 	 */
1419df8bae1dSRodney W. Grimes 	case BIOCSRTIMEOUT:
14209624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1421fc0a61a4SKonstantin Belousov 	case BIOCSRTIMEOUT32:
1422fc0a61a4SKonstantin Belousov #endif
1423df8bae1dSRodney W. Grimes 		{
1424df8bae1dSRodney W. Grimes 			struct timeval *tv = (struct timeval *)addr;
14259624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1426fc0a61a4SKonstantin Belousov 			struct timeval32 *tv32;
1427fc0a61a4SKonstantin Belousov 			struct timeval tv64;
1428fc0a61a4SKonstantin Belousov 
1429fc0a61a4SKonstantin Belousov 			if (cmd == BIOCSRTIMEOUT32) {
1430fc0a61a4SKonstantin Belousov 				tv32 = (struct timeval32 *)addr;
1431fc0a61a4SKonstantin Belousov 				tv = &tv64;
1432fc0a61a4SKonstantin Belousov 				tv->tv_sec = tv32->tv_sec;
1433fc0a61a4SKonstantin Belousov 				tv->tv_usec = tv32->tv_usec;
1434fc0a61a4SKonstantin Belousov 			} else
1435fc0a61a4SKonstantin Belousov #endif
1436fc0a61a4SKonstantin Belousov 				tv = (struct timeval *)addr;
1437df8bae1dSRodney W. Grimes 
1438bdc2cdc5SAlexander Langer 			/*
1439bdc2cdc5SAlexander Langer 			 * Subtract 1 tick from tvtohz() since this isn't
1440bdc2cdc5SAlexander Langer 			 * a one-shot timer.
1441bdc2cdc5SAlexander Langer 			 */
1442bdc2cdc5SAlexander Langer 			if ((error = itimerfix(tv)) == 0)
1443bdc2cdc5SAlexander Langer 				d->bd_rtout = tvtohz(tv) - 1;
1444df8bae1dSRodney W. Grimes 			break;
1445df8bae1dSRodney W. Grimes 		}
1446df8bae1dSRodney W. Grimes 
1447df8bae1dSRodney W. Grimes 	/*
1448df8bae1dSRodney W. Grimes 	 * Get read timeout.
1449df8bae1dSRodney W. Grimes 	 */
1450df8bae1dSRodney W. Grimes 	case BIOCGRTIMEOUT:
14519624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1452fc0a61a4SKonstantin Belousov 	case BIOCGRTIMEOUT32:
1453fc0a61a4SKonstantin Belousov #endif
1454df8bae1dSRodney W. Grimes 		{
1455fc0a61a4SKonstantin Belousov 			struct timeval *tv;
14569624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1457fc0a61a4SKonstantin Belousov 			struct timeval32 *tv32;
1458fc0a61a4SKonstantin Belousov 			struct timeval tv64;
1459fc0a61a4SKonstantin Belousov 
1460fc0a61a4SKonstantin Belousov 			if (cmd == BIOCGRTIMEOUT32)
1461fc0a61a4SKonstantin Belousov 				tv = &tv64;
1462fc0a61a4SKonstantin Belousov 			else
1463fc0a61a4SKonstantin Belousov #endif
1464fc0a61a4SKonstantin Belousov 				tv = (struct timeval *)addr;
1465df8bae1dSRodney W. Grimes 
1466bdc2cdc5SAlexander Langer 			tv->tv_sec = d->bd_rtout / hz;
1467bdc2cdc5SAlexander Langer 			tv->tv_usec = (d->bd_rtout % hz) * tick;
14689624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__)
1469fc0a61a4SKonstantin Belousov 			if (cmd == BIOCGRTIMEOUT32) {
1470fc0a61a4SKonstantin Belousov 				tv32 = (struct timeval32 *)addr;
1471fc0a61a4SKonstantin Belousov 				tv32->tv_sec = tv->tv_sec;
1472fc0a61a4SKonstantin Belousov 				tv32->tv_usec = tv->tv_usec;
1473fc0a61a4SKonstantin Belousov 			}
1474fc0a61a4SKonstantin Belousov #endif
1475fc0a61a4SKonstantin Belousov 
1476df8bae1dSRodney W. Grimes 			break;
1477df8bae1dSRodney W. Grimes 		}
1478df8bae1dSRodney W. Grimes 
1479df8bae1dSRodney W. Grimes 	/*
1480df8bae1dSRodney W. Grimes 	 * Get packet stats.
1481df8bae1dSRodney W. Grimes 	 */
1482df8bae1dSRodney W. Grimes 	case BIOCGSTATS:
1483df8bae1dSRodney W. Grimes 		{
1484df8bae1dSRodney W. Grimes 			struct bpf_stat *bs = (struct bpf_stat *)addr;
1485df8bae1dSRodney W. Grimes 
14864d621040SChristian S.J. Peron 			/* XXXCSJP overflow */
1487df8bae1dSRodney W. Grimes 			bs->bs_recv = d->bd_rcount;
1488df8bae1dSRodney W. Grimes 			bs->bs_drop = d->bd_dcount;
1489df8bae1dSRodney W. Grimes 			break;
1490df8bae1dSRodney W. Grimes 		}
1491df8bae1dSRodney W. Grimes 
1492df8bae1dSRodney W. Grimes 	/*
1493df8bae1dSRodney W. Grimes 	 * Set immediate mode.
1494df8bae1dSRodney W. Grimes 	 */
1495df8bae1dSRodney W. Grimes 	case BIOCIMMEDIATE:
1496*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1497df8bae1dSRodney W. Grimes 		d->bd_immediate = *(u_int *)addr;
1498*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1499df8bae1dSRodney W. Grimes 		break;
1500df8bae1dSRodney W. Grimes 
1501df8bae1dSRodney W. Grimes 	case BIOCVERSION:
1502df8bae1dSRodney W. Grimes 		{
1503df8bae1dSRodney W. Grimes 			struct bpf_version *bv = (struct bpf_version *)addr;
1504df8bae1dSRodney W. Grimes 
1505df8bae1dSRodney W. Grimes 			bv->bv_major = BPF_MAJOR_VERSION;
1506df8bae1dSRodney W. Grimes 			bv->bv_minor = BPF_MINOR_VERSION;
1507df8bae1dSRodney W. Grimes 			break;
1508df8bae1dSRodney W. Grimes 		}
150900a83887SPaul Traina 
1510114ae644SMike Smith 	/*
1511114ae644SMike Smith 	 * Get "header already complete" flag
1512114ae644SMike Smith 	 */
1513114ae644SMike Smith 	case BIOCGHDRCMPLT:
1514*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1515114ae644SMike Smith 		*(u_int *)addr = d->bd_hdrcmplt;
1516*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1517114ae644SMike Smith 		break;
1518114ae644SMike Smith 
1519114ae644SMike Smith 	/*
1520114ae644SMike Smith 	 * Set "header already complete" flag
1521114ae644SMike Smith 	 */
1522114ae644SMike Smith 	case BIOCSHDRCMPLT:
1523*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1524114ae644SMike Smith 		d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0;
1525*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1526114ae644SMike Smith 		break;
1527114ae644SMike Smith 
15288ed3828cSRobert Watson 	/*
1529560a54e1SJung-uk Kim 	 * Get packet direction flag
15308ed3828cSRobert Watson 	 */
1531560a54e1SJung-uk Kim 	case BIOCGDIRECTION:
1532*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1533560a54e1SJung-uk Kim 		*(u_int *)addr = d->bd_direction;
1534*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
15358ed3828cSRobert Watson 		break;
15368ed3828cSRobert Watson 
15378ed3828cSRobert Watson 	/*
1538560a54e1SJung-uk Kim 	 * Set packet direction flag
15398ed3828cSRobert Watson 	 */
1540560a54e1SJung-uk Kim 	case BIOCSDIRECTION:
1541560a54e1SJung-uk Kim 		{
1542560a54e1SJung-uk Kim 			u_int	direction;
1543560a54e1SJung-uk Kim 
1544560a54e1SJung-uk Kim 			direction = *(u_int *)addr;
1545560a54e1SJung-uk Kim 			switch (direction) {
1546560a54e1SJung-uk Kim 			case BPF_D_IN:
1547560a54e1SJung-uk Kim 			case BPF_D_INOUT:
1548560a54e1SJung-uk Kim 			case BPF_D_OUT:
1549*97aacec6SAlexander V. Chernikov 				BPFD_LOCK(d);
1550560a54e1SJung-uk Kim 				d->bd_direction = direction;
1551*97aacec6SAlexander V. Chernikov 				BPFD_UNLOCK(d);
1552560a54e1SJung-uk Kim 				break;
1553560a54e1SJung-uk Kim 			default:
1554560a54e1SJung-uk Kim 				error = EINVAL;
1555560a54e1SJung-uk Kim 			}
1556560a54e1SJung-uk Kim 		}
1557560a54e1SJung-uk Kim 		break;
1558560a54e1SJung-uk Kim 
1559547d94bdSJung-uk Kim 	/*
1560d0d7bcdfSJung-uk Kim 	 * Get packet timestamp format and resolution.
1561547d94bdSJung-uk Kim 	 */
1562547d94bdSJung-uk Kim 	case BIOCGTSTAMP:
1563*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1564547d94bdSJung-uk Kim 		*(u_int *)addr = d->bd_tstamp;
1565*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1566547d94bdSJung-uk Kim 		break;
1567547d94bdSJung-uk Kim 
1568547d94bdSJung-uk Kim 	/*
1569547d94bdSJung-uk Kim 	 * Set packet timestamp format and resolution.
1570547d94bdSJung-uk Kim 	 */
1571547d94bdSJung-uk Kim 	case BIOCSTSTAMP:
1572547d94bdSJung-uk Kim 		{
1573547d94bdSJung-uk Kim 			u_int	func;
1574547d94bdSJung-uk Kim 
1575547d94bdSJung-uk Kim 			func = *(u_int *)addr;
1576547d94bdSJung-uk Kim 			if (BPF_T_VALID(func))
1577547d94bdSJung-uk Kim 				d->bd_tstamp = func;
1578547d94bdSJung-uk Kim 			else
1579547d94bdSJung-uk Kim 				error = EINVAL;
1580547d94bdSJung-uk Kim 		}
1581547d94bdSJung-uk Kim 		break;
1582547d94bdSJung-uk Kim 
1583560a54e1SJung-uk Kim 	case BIOCFEEDBACK:
1584*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1585560a54e1SJung-uk Kim 		d->bd_feedback = *(u_int *)addr;
1586*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1587560a54e1SJung-uk Kim 		break;
1588560a54e1SJung-uk Kim 
1589560a54e1SJung-uk Kim 	case BIOCLOCK:
1590*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
1591560a54e1SJung-uk Kim 		d->bd_locked = 1;
1592*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
15938ed3828cSRobert Watson 		break;
15948ed3828cSRobert Watson 
159500a83887SPaul Traina 	case FIONBIO:		/* Non-blocking I/O */
159600a83887SPaul Traina 		break;
159700a83887SPaul Traina 
159800a83887SPaul Traina 	case FIOASYNC:		/* Send signal on receive packets */
1599*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
160000a83887SPaul Traina 		d->bd_async = *(int *)addr;
1601*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
160200a83887SPaul Traina 		break;
160300a83887SPaul Traina 
1604831d27a9SDon Lewis 	case FIOSETOWN:
1605*97aacec6SAlexander V. Chernikov 		/*
1606*97aacec6SAlexander V. Chernikov 		 * XXX: Add some sort of locking here?
1607*97aacec6SAlexander V. Chernikov 		 * fsetown() can sleep.
1608*97aacec6SAlexander V. Chernikov 		 */
1609831d27a9SDon Lewis 		error = fsetown(*(int *)addr, &d->bd_sigio);
161000a83887SPaul Traina 		break;
161100a83887SPaul Traina 
1612831d27a9SDon Lewis 	case FIOGETOWN:
1613*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
161491e97a82SDon Lewis 		*(int *)addr = fgetown(&d->bd_sigio);
1615*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
1616831d27a9SDon Lewis 		break;
1617831d27a9SDon Lewis 
1618831d27a9SDon Lewis 	/* This is deprecated, FIOSETOWN should be used instead. */
1619831d27a9SDon Lewis 	case TIOCSPGRP:
1620831d27a9SDon Lewis 		error = fsetown(-(*(int *)addr), &d->bd_sigio);
1621831d27a9SDon Lewis 		break;
1622831d27a9SDon Lewis 
1623831d27a9SDon Lewis 	/* This is deprecated, FIOGETOWN should be used instead. */
162400a83887SPaul Traina 	case TIOCGPGRP:
162591e97a82SDon Lewis 		*(int *)addr = -fgetown(&d->bd_sigio);
162600a83887SPaul Traina 		break;
162700a83887SPaul Traina 
162800a83887SPaul Traina 	case BIOCSRSIG:		/* Set receive signal */
162900a83887SPaul Traina 		{
163000a83887SPaul Traina 			u_int sig;
163100a83887SPaul Traina 
163200a83887SPaul Traina 			sig = *(u_int *)addr;
163300a83887SPaul Traina 
163400a83887SPaul Traina 			if (sig >= NSIG)
163500a83887SPaul Traina 				error = EINVAL;
1636*97aacec6SAlexander V. Chernikov 			else {
1637*97aacec6SAlexander V. Chernikov 				BPFD_LOCK(d);
163800a83887SPaul Traina 				d->bd_sig = sig;
1639*97aacec6SAlexander V. Chernikov 				BPFD_UNLOCK(d);
1640*97aacec6SAlexander V. Chernikov 			}
164100a83887SPaul Traina 			break;
164200a83887SPaul Traina 		}
164300a83887SPaul Traina 	case BIOCGRSIG:
1644*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
164500a83887SPaul Traina 		*(u_int *)addr = d->bd_sig;
1646*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
164700a83887SPaul Traina 		break;
16484d621040SChristian S.J. Peron 
16494d621040SChristian S.J. Peron 	case BIOCGETBUFMODE:
1650*97aacec6SAlexander V. Chernikov 		BPFD_LOCK(d);
16514d621040SChristian S.J. Peron 		*(u_int *)addr = d->bd_bufmode;
1652*97aacec6SAlexander V. Chernikov 		BPFD_UNLOCK(d);
16534d621040SChristian S.J. Peron 		break;
16544d621040SChristian S.J. Peron 
16554d621040SChristian S.J. Peron 	case BIOCSETBUFMODE:
16564d621040SChristian S.J. Peron 		/*
16574d621040SChristian S.J. Peron 		 * Allow the buffering mode to be changed as long as we
16584d621040SChristian S.J. Peron 		 * haven't yet committed to a particular mode.  Our
16594d621040SChristian S.J. Peron 		 * definition of commitment, for now, is whether or not a
16604d621040SChristian S.J. Peron 		 * buffer has been allocated or an interface attached, since
16614d621040SChristian S.J. Peron 		 * that's the point where things get tricky.
16624d621040SChristian S.J. Peron 		 */
16634d621040SChristian S.J. Peron 		switch (*(u_int *)addr) {
16644d621040SChristian S.J. Peron 		case BPF_BUFMODE_BUFFER:
16654d621040SChristian S.J. Peron 			break;
16664d621040SChristian S.J. Peron 
16674d621040SChristian S.J. Peron 		case BPF_BUFMODE_ZBUF:
16684d621040SChristian S.J. Peron 			if (bpf_zerocopy_enable)
16694d621040SChristian S.J. Peron 				break;
16704d621040SChristian S.J. Peron 			/* FALLSTHROUGH */
16714d621040SChristian S.J. Peron 
16724d621040SChristian S.J. Peron 		default:
16731b610a74SBjoern A. Zeeb 			CURVNET_RESTORE();
16744d621040SChristian S.J. Peron 			return (EINVAL);
16754d621040SChristian S.J. Peron 		}
16764d621040SChristian S.J. Peron 
1677afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
16784d621040SChristian S.J. Peron 		if (d->bd_sbuf != NULL || d->bd_hbuf != NULL ||
16794d621040SChristian S.J. Peron 		    d->bd_fbuf != NULL || d->bd_bif != NULL) {
1680afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
16811b610a74SBjoern A. Zeeb 			CURVNET_RESTORE();
16824d621040SChristian S.J. Peron 			return (EBUSY);
16834d621040SChristian S.J. Peron 		}
16844d621040SChristian S.J. Peron 		d->bd_bufmode = *(u_int *)addr;
1685afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
16864d621040SChristian S.J. Peron 		break;
16874d621040SChristian S.J. Peron 
16884d621040SChristian S.J. Peron 	case BIOCGETZMAX:
16891b610a74SBjoern A. Zeeb 		error = bpf_ioctl_getzmax(td, d, (size_t *)addr);
16901b610a74SBjoern A. Zeeb 		break;
16914d621040SChristian S.J. Peron 
16924d621040SChristian S.J. Peron 	case BIOCSETZBUF:
16931b610a74SBjoern A. Zeeb 		error = bpf_ioctl_setzbuf(td, d, (struct bpf_zbuf *)addr);
16941b610a74SBjoern A. Zeeb 		break;
16954d621040SChristian S.J. Peron 
16964d621040SChristian S.J. Peron 	case BIOCROTZBUF:
16971b610a74SBjoern A. Zeeb 		error = bpf_ioctl_rotzbuf(td, d, (struct bpf_zbuf *)addr);
16981b610a74SBjoern A. Zeeb 		break;
1699df8bae1dSRodney W. Grimes 	}
170097021c24SMarko Zec 	CURVNET_RESTORE();
1701df8bae1dSRodney W. Grimes 	return (error);
1702df8bae1dSRodney W. Grimes }
1703df8bae1dSRodney W. Grimes 
1704df8bae1dSRodney W. Grimes /*
1705df8bae1dSRodney W. Grimes  * Set d's packet filter program to fp.  If this file already has a filter,
1706df8bae1dSRodney W. Grimes  * free it and replace it.  Returns EINVAL for bogus requests.
1707df8bae1dSRodney W. Grimes  */
1708f708ef1bSPoul-Henning Kamp static int
170919ba8395SChristian S.J. Peron bpf_setf(struct bpf_d *d, struct bpf_program *fp, u_long cmd)
1710df8bae1dSRodney W. Grimes {
1711df8bae1dSRodney W. Grimes 	struct bpf_insn *fcode, *old;
171293e39f0bSChristian S.J. Peron 	u_int wfilter, flen, size;
1713293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1714c7b0200eSAlexander V. Chernikov 	bpf_jit_filter *ofunc, *jfunc;
1715ae275efcSJung-uk Kim #endif
17169431cc16SAlexander V. Chernikov 	int need_upgrade;
1717fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
1718fc0a61a4SKonstantin Belousov 	struct bpf_program32 *fp32;
1719fc0a61a4SKonstantin Belousov 	struct bpf_program fp_swab;
1720df8bae1dSRodney W. Grimes 
1721fc0a61a4SKonstantin Belousov 	if (cmd == BIOCSETWF32 || cmd == BIOCSETF32 || cmd == BIOCSETFNR32) {
1722fc0a61a4SKonstantin Belousov 		fp32 = (struct bpf_program32 *)fp;
1723fc0a61a4SKonstantin Belousov 		fp_swab.bf_len = fp32->bf_len;
1724fc0a61a4SKonstantin Belousov 		fp_swab.bf_insns = (struct bpf_insn *)(uintptr_t)fp32->bf_insns;
1725fc0a61a4SKonstantin Belousov 		fp = &fp_swab;
1726fc0a61a4SKonstantin Belousov 		if (cmd == BIOCSETWF32)
1727fc0a61a4SKonstantin Belousov 			cmd = BIOCSETWF;
1728fc0a61a4SKonstantin Belousov 	}
1729fc0a61a4SKonstantin Belousov #endif
17306c74ff0eSAlexander V. Chernikov 	/*
17316c74ff0eSAlexander V. Chernikov 	 * Check new filter validness before acquiring any locks.
17326c74ff0eSAlexander V. Chernikov 	 * Allocate memory for new filter, if needed.
17336c74ff0eSAlexander V. Chernikov 	 */
17346c74ff0eSAlexander V. Chernikov 	flen = fp->bf_len;
17356c74ff0eSAlexander V. Chernikov 	if ((flen > bpf_maxinsns) || ((fp->bf_insns == NULL) && (flen != 0)))
17366c74ff0eSAlexander V. Chernikov 		return (EINVAL);
17376c74ff0eSAlexander V. Chernikov 
17386c74ff0eSAlexander V. Chernikov 	need_upgrade = 0;
17396c74ff0eSAlexander V. Chernikov 	size = flen * sizeof(*fp->bf_insns);
17406c74ff0eSAlexander V. Chernikov 	if (size > 0)
17416c74ff0eSAlexander V. Chernikov 		fcode = (struct bpf_insn *)malloc(size, M_BPF, M_WAITOK);
17426c74ff0eSAlexander V. Chernikov 	else
17436c74ff0eSAlexander V. Chernikov 		fcode = NULL; /* Make compiler happy */
17446c74ff0eSAlexander V. Chernikov 
1745c7b0200eSAlexander V. Chernikov #ifdef BPF_JITTER
1746c7b0200eSAlexander V. Chernikov 	if (fp->bf_insns != NULL)
1747c7b0200eSAlexander V. Chernikov 		jfunc = bpf_jitter(fcode, flen);
1748c7b0200eSAlexander V. Chernikov 	else
1749c7b0200eSAlexander V. Chernikov 		jfunc = NULL; /* Make compiler happy */
1750c7b0200eSAlexander V. Chernikov #endif
1751c7b0200eSAlexander V. Chernikov 
17526c74ff0eSAlexander V. Chernikov 	BPF_LOCK();
17536c74ff0eSAlexander V. Chernikov 
175493e39f0bSChristian S.J. Peron 	if (cmd == BIOCSETWF) {
175593e39f0bSChristian S.J. Peron 		old = d->bd_wfilter;
175693e39f0bSChristian S.J. Peron 		wfilter = 1;
1757293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1758ae275efcSJung-uk Kim 		ofunc = NULL;
1759ae275efcSJung-uk Kim #endif
176093e39f0bSChristian S.J. Peron 	} else {
176193e39f0bSChristian S.J. Peron 		wfilter = 0;
176293e39f0bSChristian S.J. Peron 		old = d->bd_rfilter;
1763293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1764ae275efcSJung-uk Kim 		ofunc = d->bd_bfilter;
1765ae275efcSJung-uk Kim #endif
176693e39f0bSChristian S.J. Peron 	}
1767572bde2aSRobert Watson 	if (fp->bf_insns == NULL) {
1768e4b3229aSAlexander V. Chernikov 		/*
17696c74ff0eSAlexander V. Chernikov 		 * Protect filter removal by interface lock.
17706c74ff0eSAlexander V. Chernikov 		 * Additionally, we are protected by global lock here.
1771e4b3229aSAlexander V. Chernikov 		 */
17726c74ff0eSAlexander V. Chernikov 		if (d->bd_bif != NULL)
1773e4b3229aSAlexander V. Chernikov 			BPFIF_WLOCK(d->bd_bif);
1774afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
177593e39f0bSChristian S.J. Peron 		if (wfilter)
177693e39f0bSChristian S.J. Peron 			d->bd_wfilter = NULL;
1777ae275efcSJung-uk Kim 		else {
177893e39f0bSChristian S.J. Peron 			d->bd_rfilter = NULL;
1779293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1780ae275efcSJung-uk Kim 			d->bd_bfilter = NULL;
1781ae275efcSJung-uk Kim #endif
1782f11c3508SDavid Malone 			if (cmd == BIOCSETF)
1783df8bae1dSRodney W. Grimes 				reset_d(d);
1784f11c3508SDavid Malone 		}
1785afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
17866c74ff0eSAlexander V. Chernikov 		if (d->bd_bif != NULL)
1787e4b3229aSAlexander V. Chernikov 			BPFIF_WUNLOCK(d->bd_bif);
1788572bde2aSRobert Watson 		if (old != NULL)
1789bd3a5320SPoul-Henning Kamp 			free((caddr_t)old, M_BPF);
1790293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1791ae275efcSJung-uk Kim 		if (ofunc != NULL)
1792ae275efcSJung-uk Kim 			bpf_destroy_jit_filter(ofunc);
1793ae275efcSJung-uk Kim #endif
17946c74ff0eSAlexander V. Chernikov 		BPF_UNLOCK();
1795df8bae1dSRodney W. Grimes 		return (0);
1796df8bae1dSRodney W. Grimes 	}
1797df8bae1dSRodney W. Grimes 
1798df8bae1dSRodney W. Grimes 	if (copyin((caddr_t)fp->bf_insns, (caddr_t)fcode, size) == 0 &&
1799df8bae1dSRodney W. Grimes 	    bpf_validate(fcode, (int)flen)) {
1800e4b3229aSAlexander V. Chernikov 		/*
18016c74ff0eSAlexander V. Chernikov 		 * Protect filter change by interface lock
18026c74ff0eSAlexander V. Chernikov 		 * Additionally, we are protected by global lock here.
1803e4b3229aSAlexander V. Chernikov 		 */
18046c74ff0eSAlexander V. Chernikov 		if (d->bd_bif != NULL)
1805e4b3229aSAlexander V. Chernikov 			BPFIF_WLOCK(d->bd_bif);
1806afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
180793e39f0bSChristian S.J. Peron 		if (wfilter)
180893e39f0bSChristian S.J. Peron 			d->bd_wfilter = fcode;
1809ae275efcSJung-uk Kim 		else {
181093e39f0bSChristian S.J. Peron 			d->bd_rfilter = fcode;
1811293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1812c7b0200eSAlexander V. Chernikov 			d->bd_bfilter = jfunc;
1813ae275efcSJung-uk Kim #endif
1814f11c3508SDavid Malone 			if (cmd == BIOCSETF)
1815df8bae1dSRodney W. Grimes 				reset_d(d);
181651ec1eb7SAlexander V. Chernikov 
181751ec1eb7SAlexander V. Chernikov 			/*
181851ec1eb7SAlexander V. Chernikov 			 * Do not require upgrade by first BIOCSETF
181951ec1eb7SAlexander V. Chernikov 			 * (used to set snaplen) by pcap_open_live()
182051ec1eb7SAlexander V. Chernikov 			 */
182151ec1eb7SAlexander V. Chernikov 			if ((d->bd_writer != 0) && (--d->bd_writer == 0))
182251ec1eb7SAlexander V. Chernikov 				need_upgrade = 1;
182351ec1eb7SAlexander V. Chernikov 			CTR4(KTR_NET, "%s: filter function set by pid %d, "
182451ec1eb7SAlexander V. Chernikov 			    "bd_writer counter %d, need_upgrade %d",
182551ec1eb7SAlexander V. Chernikov 			    __func__, d->bd_pid, d->bd_writer, need_upgrade);
1826f11c3508SDavid Malone 		}
1827afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
18286c74ff0eSAlexander V. Chernikov 		if (d->bd_bif != NULL)
1829e4b3229aSAlexander V. Chernikov 			BPFIF_WUNLOCK(d->bd_bif);
1830572bde2aSRobert Watson 		if (old != NULL)
1831bd3a5320SPoul-Henning Kamp 			free((caddr_t)old, M_BPF);
1832293c06a1SRuslan Ermilov #ifdef BPF_JITTER
1833ae275efcSJung-uk Kim 		if (ofunc != NULL)
1834ae275efcSJung-uk Kim 			bpf_destroy_jit_filter(ofunc);
1835ae275efcSJung-uk Kim #endif
1836df8bae1dSRodney W. Grimes 
183751ec1eb7SAlexander V. Chernikov 		/* Move d to active readers list */
183851ec1eb7SAlexander V. Chernikov 		if (need_upgrade != 0)
183951ec1eb7SAlexander V. Chernikov 			bpf_upgraded(d);
184051ec1eb7SAlexander V. Chernikov 
18416c74ff0eSAlexander V. Chernikov 		BPF_UNLOCK();
1842df8bae1dSRodney W. Grimes 		return (0);
1843df8bae1dSRodney W. Grimes 	}
1844bd3a5320SPoul-Henning Kamp 	free((caddr_t)fcode, M_BPF);
18456c74ff0eSAlexander V. Chernikov 	BPF_UNLOCK();
1846df8bae1dSRodney W. Grimes 	return (EINVAL);
1847df8bae1dSRodney W. Grimes }
1848df8bae1dSRodney W. Grimes 
1849df8bae1dSRodney W. Grimes /*
1850df8bae1dSRodney W. Grimes  * Detach a file from its current interface (if attached at all) and attach
1851df8bae1dSRodney W. Grimes  * to the interface indicated by the name stored in ifr.
1852df8bae1dSRodney W. Grimes  * Return an errno or 0.
1853df8bae1dSRodney W. Grimes  */
1854df8bae1dSRodney W. Grimes static int
185519ba8395SChristian S.J. Peron bpf_setif(struct bpf_d *d, struct ifreq *ifr)
1856df8bae1dSRodney W. Grimes {
1857df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
18589b44ff22SGarrett Wollman 	struct ifnet *theywant;
1859df8bae1dSRodney W. Grimes 
18606c74ff0eSAlexander V. Chernikov 	BPF_LOCK_ASSERT();
18616c74ff0eSAlexander V. Chernikov 
18629b44ff22SGarrett Wollman 	theywant = ifunit(ifr->ifr_name);
186316d878ccSChristian S.J. Peron 	if (theywant == NULL || theywant->if_bpf == NULL)
186416d878ccSChristian S.J. Peron 		return (ENXIO);
18659b44ff22SGarrett Wollman 
186616d878ccSChristian S.J. Peron 	bp = theywant->if_bpf;
18674d621040SChristian S.J. Peron 
1868afa85850SAlexander V. Chernikov 	/* Check if interface is not being detached from BPF */
1869afa85850SAlexander V. Chernikov 	BPFIF_RLOCK(bp);
1870afa85850SAlexander V. Chernikov 	if (bp->flags & BPFIF_FLAG_DYING) {
1871afa85850SAlexander V. Chernikov 		BPFIF_RUNLOCK(bp);
1872afa85850SAlexander V. Chernikov 		return (ENXIO);
1873afa85850SAlexander V. Chernikov 	}
1874afa85850SAlexander V. Chernikov 	BPFIF_RUNLOCK(bp);
1875afa85850SAlexander V. Chernikov 
1876df8bae1dSRodney W. Grimes 	/*
18774d621040SChristian S.J. Peron 	 * Behavior here depends on the buffering model.  If we're using
18784d621040SChristian S.J. Peron 	 * kernel memory buffers, then we can allocate them here.  If we're
18794d621040SChristian S.J. Peron 	 * using zero-copy, then the user process must have registered
18804d621040SChristian S.J. Peron 	 * buffers by the time we get here.  If not, return an error.
1881df8bae1dSRodney W. Grimes 	 */
18824d621040SChristian S.J. Peron 	switch (d->bd_bufmode) {
18834d621040SChristian S.J. Peron 	case BPF_BUFMODE_BUFFER:
18844d621040SChristian S.J. Peron 	case BPF_BUFMODE_ZBUF:
18854d621040SChristian S.J. Peron 		if (d->bd_sbuf == NULL)
18864d621040SChristian S.J. Peron 			return (EINVAL);
18874d621040SChristian S.J. Peron 		break;
18884d621040SChristian S.J. Peron 
18894d621040SChristian S.J. Peron 	default:
18904d621040SChristian S.J. Peron 		panic("bpf_setif: bufmode %d", d->bd_bufmode);
18914d621040SChristian S.J. Peron 	}
18926c74ff0eSAlexander V. Chernikov 	if (bp != d->bd_bif)
1893df8bae1dSRodney W. Grimes 		bpf_attachd(d, bp);
1894afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
1895df8bae1dSRodney W. Grimes 	reset_d(d);
1896afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
1897df8bae1dSRodney W. Grimes 	return (0);
1898df8bae1dSRodney W. Grimes }
1899df8bae1dSRodney W. Grimes 
1900df8bae1dSRodney W. Grimes /*
1901243ac7d8SPeter Wemm  * Support for select() and poll() system calls
1902df8bae1dSRodney W. Grimes  *
1903df8bae1dSRodney W. Grimes  * Return true iff the specific operation will not block indefinitely.
1904df8bae1dSRodney W. Grimes  * Otherwise, return false but make a note that a selwakeup() must be done.
1905df8bae1dSRodney W. Grimes  */
190637c84183SPoul-Henning Kamp static int
190719ba8395SChristian S.J. Peron bpfpoll(struct cdev *dev, int events, struct thread *td)
1908df8bae1dSRodney W. Grimes {
1909e7bb21b3SJonathan Lemon 	struct bpf_d *d;
19100832fc64SGarance A Drosehn 	int revents;
1911df8bae1dSRodney W. Grimes 
1912136600feSEd Schouten 	if (devfs_get_cdevpriv((void **)&d) != 0 || d->bd_bif == NULL)
1913136600feSEd Schouten 		return (events &
1914136600feSEd Schouten 		    (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM));
1915de5d9935SRobert Watson 
1916b75a24a0SChristian S.J. Peron 	/*
1917b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
1918b75a24a0SChristian S.J. Peron 	 */
19190832fc64SGarance A Drosehn 	revents = events & (POLLOUT | POLLWRNORM);
1920afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
1921e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH(d, td);
192275c13541SPoul-Henning Kamp 	if (events & (POLLIN | POLLRDNORM)) {
192395aab9ccSJohn-Mark Gurney 		if (bpf_ready(d))
1924243ac7d8SPeter Wemm 			revents |= events & (POLLIN | POLLRDNORM);
192581bda851SJohn Polstra 		else {
1926ed01445dSJohn Baldwin 			selrecord(td, &d->bd_sel);
192781bda851SJohn Polstra 			/* Start the read timeout if necessary. */
192881bda851SJohn Polstra 			if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) {
192981bda851SJohn Polstra 				callout_reset(&d->bd_callout, d->bd_rtout,
193081bda851SJohn Polstra 				    bpf_timed_out, d);
193181bda851SJohn Polstra 				d->bd_state = BPF_WAITING;
193281bda851SJohn Polstra 			}
193381bda851SJohn Polstra 		}
193475c13541SPoul-Henning Kamp 	}
1935afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
1936243ac7d8SPeter Wemm 	return (revents);
1937df8bae1dSRodney W. Grimes }
1938df8bae1dSRodney W. Grimes 
1939df8bae1dSRodney W. Grimes /*
194095aab9ccSJohn-Mark Gurney  * Support for kevent() system call.  Register EVFILT_READ filters and
194195aab9ccSJohn-Mark Gurney  * reject all others.
194295aab9ccSJohn-Mark Gurney  */
194395aab9ccSJohn-Mark Gurney int
194419ba8395SChristian S.J. Peron bpfkqfilter(struct cdev *dev, struct knote *kn)
194595aab9ccSJohn-Mark Gurney {
1946136600feSEd Schouten 	struct bpf_d *d;
194795aab9ccSJohn-Mark Gurney 
1948136600feSEd Schouten 	if (devfs_get_cdevpriv((void **)&d) != 0 ||
1949136600feSEd Schouten 	    kn->kn_filter != EVFILT_READ)
195095aab9ccSJohn-Mark Gurney 		return (1);
195195aab9ccSJohn-Mark Gurney 
1952b75a24a0SChristian S.J. Peron 	/*
1953b75a24a0SChristian S.J. Peron 	 * Refresh PID associated with this descriptor.
1954b75a24a0SChristian S.J. Peron 	 */
1955afa85850SAlexander V. Chernikov 	BPFD_LOCK(d);
1956e4b3229aSAlexander V. Chernikov 	BPF_PID_REFRESH_CUR(d);
195795aab9ccSJohn-Mark Gurney 	kn->kn_fop = &bpfread_filtops;
195895aab9ccSJohn-Mark Gurney 	kn->kn_hook = d;
19594b19419eSChristian S.J. Peron 	knlist_add(&d->bd_sel.si_note, kn, 1);
1960afa85850SAlexander V. Chernikov 	BPFD_UNLOCK(d);
196195aab9ccSJohn-Mark Gurney 
196295aab9ccSJohn-Mark Gurney 	return (0);
196395aab9ccSJohn-Mark Gurney }
196495aab9ccSJohn-Mark Gurney 
196595aab9ccSJohn-Mark Gurney static void
196619ba8395SChristian S.J. Peron filt_bpfdetach(struct knote *kn)
196795aab9ccSJohn-Mark Gurney {
196895aab9ccSJohn-Mark Gurney 	struct bpf_d *d = (struct bpf_d *)kn->kn_hook;
196995aab9ccSJohn-Mark Gurney 
1970ad3b9257SJohn-Mark Gurney 	knlist_remove(&d->bd_sel.si_note, kn, 0);
197195aab9ccSJohn-Mark Gurney }
197295aab9ccSJohn-Mark Gurney 
197395aab9ccSJohn-Mark Gurney static int
197419ba8395SChristian S.J. Peron filt_bpfread(struct knote *kn, long hint)
197595aab9ccSJohn-Mark Gurney {
197695aab9ccSJohn-Mark Gurney 	struct bpf_d *d = (struct bpf_d *)kn->kn_hook;
197795aab9ccSJohn-Mark Gurney 	int ready;
197895aab9ccSJohn-Mark Gurney 
1979afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
198095aab9ccSJohn-Mark Gurney 	ready = bpf_ready(d);
198195aab9ccSJohn-Mark Gurney 	if (ready) {
198295aab9ccSJohn-Mark Gurney 		kn->kn_data = d->bd_slen;
198395aab9ccSJohn-Mark Gurney 		if (d->bd_hbuf)
198495aab9ccSJohn-Mark Gurney 			kn->kn_data += d->bd_hlen;
19855d7af3a1SJung-uk Kim 	} else if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) {
198695aab9ccSJohn-Mark Gurney 		callout_reset(&d->bd_callout, d->bd_rtout,
198795aab9ccSJohn-Mark Gurney 		    bpf_timed_out, d);
198895aab9ccSJohn-Mark Gurney 		d->bd_state = BPF_WAITING;
198995aab9ccSJohn-Mark Gurney 	}
199095aab9ccSJohn-Mark Gurney 
199195aab9ccSJohn-Mark Gurney 	return (ready);
199295aab9ccSJohn-Mark Gurney }
199395aab9ccSJohn-Mark Gurney 
1994253a3814SLawrence Stewart #define	BPF_TSTAMP_NONE		0
1995253a3814SLawrence Stewart #define	BPF_TSTAMP_FAST		1
1996253a3814SLawrence Stewart #define	BPF_TSTAMP_NORMAL	2
1997253a3814SLawrence Stewart #define	BPF_TSTAMP_EXTERN	3
1998253a3814SLawrence Stewart 
1999253a3814SLawrence Stewart static int
2000253a3814SLawrence Stewart bpf_ts_quality(int tstype)
2001253a3814SLawrence Stewart {
2002253a3814SLawrence Stewart 
2003253a3814SLawrence Stewart 	if (tstype == BPF_T_NONE)
2004253a3814SLawrence Stewart 		return (BPF_TSTAMP_NONE);
2005253a3814SLawrence Stewart 	if ((tstype & BPF_T_FAST) != 0)
2006253a3814SLawrence Stewart 		return (BPF_TSTAMP_FAST);
2007253a3814SLawrence Stewart 
2008253a3814SLawrence Stewart 	return (BPF_TSTAMP_NORMAL);
2009253a3814SLawrence Stewart }
2010253a3814SLawrence Stewart 
2011253a3814SLawrence Stewart static int
2012253a3814SLawrence Stewart bpf_gettime(struct bintime *bt, int tstype, struct mbuf *m)
2013253a3814SLawrence Stewart {
2014253a3814SLawrence Stewart 	struct m_tag *tag;
2015253a3814SLawrence Stewart 	int quality;
2016253a3814SLawrence Stewart 
2017253a3814SLawrence Stewart 	quality = bpf_ts_quality(tstype);
2018253a3814SLawrence Stewart 	if (quality == BPF_TSTAMP_NONE)
2019253a3814SLawrence Stewart 		return (quality);
2020253a3814SLawrence Stewart 
2021253a3814SLawrence Stewart 	if (m != NULL) {
2022253a3814SLawrence Stewart 		tag = m_tag_locate(m, MTAG_BPF, MTAG_BPF_TIMESTAMP, NULL);
2023253a3814SLawrence Stewart 		if (tag != NULL) {
2024253a3814SLawrence Stewart 			*bt = *(struct bintime *)(tag + 1);
2025253a3814SLawrence Stewart 			return (BPF_TSTAMP_EXTERN);
2026253a3814SLawrence Stewart 		}
2027253a3814SLawrence Stewart 	}
2028253a3814SLawrence Stewart 	if (quality == BPF_TSTAMP_NORMAL)
2029253a3814SLawrence Stewart 		binuptime(bt);
2030253a3814SLawrence Stewart 	else
2031253a3814SLawrence Stewart 		getbinuptime(bt);
2032253a3814SLawrence Stewart 
2033253a3814SLawrence Stewart 	return (quality);
2034253a3814SLawrence Stewart }
2035253a3814SLawrence Stewart 
203695aab9ccSJohn-Mark Gurney /*
2037df8bae1dSRodney W. Grimes  * Incoming linkage from device drivers.  Process the packet pkt, of length
2038df8bae1dSRodney W. Grimes  * pktlen, which is stored in a contiguous buffer.  The packet is parsed
2039df8bae1dSRodney W. Grimes  * by each process' filter, and if accepted, stashed into the corresponding
2040df8bae1dSRodney W. Grimes  * buffer.
2041df8bae1dSRodney W. Grimes  */
2042df8bae1dSRodney W. Grimes void
204319ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen)
2044df8bae1dSRodney W. Grimes {
2045547d94bdSJung-uk Kim 	struct bintime bt;
20468994a245SDag-Erling Smørgrav 	struct bpf_d *d;
2047a36599ccSJung-uk Kim #ifdef BPF_JITTER
2048a36599ccSJung-uk Kim 	bpf_jit_filter *bf;
2049a36599ccSJung-uk Kim #endif
2050253a3814SLawrence Stewart 	u_int slen;
2051253a3814SLawrence Stewart 	int gottime;
2052e7bb21b3SJonathan Lemon 
2053253a3814SLawrence Stewart 	gottime = BPF_TSTAMP_NONE;
2054e4b3229aSAlexander V. Chernikov 
2055e4b3229aSAlexander V. Chernikov 	BPFIF_RLOCK(bp);
2056e4b3229aSAlexander V. Chernikov 
20574a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
2058e4b3229aSAlexander V. Chernikov 		/*
2059e4b3229aSAlexander V. Chernikov 		 * We are not using any locks for d here because:
2060e4b3229aSAlexander V. Chernikov 		 * 1) any filter change is protected by interface
2061e4b3229aSAlexander V. Chernikov 		 * write lock
2062e4b3229aSAlexander V. Chernikov 		 * 2) destroying/detaching d is protected by interface
2063e4b3229aSAlexander V. Chernikov 		 * write lock, too
2064e4b3229aSAlexander V. Chernikov 		 */
2065e4b3229aSAlexander V. Chernikov 
2066e4b3229aSAlexander V. Chernikov 		/* XXX: Do not protect counter for the sake of performance. */
2067df8bae1dSRodney W. Grimes 		++d->bd_rcount;
2068a05cf8c6SChristian S.J. Peron 		/*
2069a05cf8c6SChristian S.J. Peron 		 * NB: We dont call BPF_CHECK_DIRECTION() here since there is no
2070a05cf8c6SChristian S.J. Peron 		 * way for the caller to indiciate to us whether this packet
2071a05cf8c6SChristian S.J. Peron 		 * is inbound or outbound.  In the bpf_mtap() routines, we use
2072a05cf8c6SChristian S.J. Peron 		 * the interface pointers on the mbuf to figure it out.
2073a05cf8c6SChristian S.J. Peron 		 */
2074ae275efcSJung-uk Kim #ifdef BPF_JITTER
2075a36599ccSJung-uk Kim 		bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL;
2076a36599ccSJung-uk Kim 		if (bf != NULL)
2077a36599ccSJung-uk Kim 			slen = (*(bf->func))(pkt, pktlen, pktlen);
2078ae275efcSJung-uk Kim 		else
2079ae275efcSJung-uk Kim #endif
208093e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, pkt, pktlen, pktlen);
2081ec272d87SRobert Watson 		if (slen != 0) {
2082e4b3229aSAlexander V. Chernikov 			/*
2083e4b3229aSAlexander V. Chernikov 			 * Filter matches. Let's to acquire write lock.
2084e4b3229aSAlexander V. Chernikov 			 */
2085afa85850SAlexander V. Chernikov 			BPFD_LOCK(d);
2086e4b3229aSAlexander V. Chernikov 
208769f7644bSChristian S.J. Peron 			d->bd_fcount++;
2088253a3814SLawrence Stewart 			if (gottime < bpf_ts_quality(d->bd_tstamp))
2089253a3814SLawrence Stewart 				gottime = bpf_gettime(&bt, d->bd_tstamp, NULL);
2090ec272d87SRobert Watson #ifdef MAC
209130d239bcSRobert Watson 			if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0)
2092ec272d87SRobert Watson #endif
20934d621040SChristian S.J. Peron 				catchpacket(d, pkt, pktlen, slen,
2094547d94bdSJung-uk Kim 				    bpf_append_bytes, &bt);
2095afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
2096ec272d87SRobert Watson 		}
2097df8bae1dSRodney W. Grimes 	}
2098e4b3229aSAlexander V. Chernikov 	BPFIF_RUNLOCK(bp);
2099df8bae1dSRodney W. Grimes }
2100df8bae1dSRodney W. Grimes 
2101f81a2a49SJung-uk Kim #define	BPF_CHECK_DIRECTION(d, r, i)				\
2102f81a2a49SJung-uk Kim 	    (((d)->bd_direction == BPF_D_IN && (r) != (i)) ||	\
2103f81a2a49SJung-uk Kim 	    ((d)->bd_direction == BPF_D_OUT && (r) == (i)))
2104560a54e1SJung-uk Kim 
2105df8bae1dSRodney W. Grimes /*
2106df8bae1dSRodney W. Grimes  * Incoming linkage from device drivers, when packet is in an mbuf chain.
2107e4b3229aSAlexander V. Chernikov  * Locking model is explained in bpf_tap().
2108df8bae1dSRodney W. Grimes  */
2109df8bae1dSRodney W. Grimes void
211019ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m)
2111df8bae1dSRodney W. Grimes {
2112547d94bdSJung-uk Kim 	struct bintime bt;
2113df8bae1dSRodney W. Grimes 	struct bpf_d *d;
2114a36599ccSJung-uk Kim #ifdef BPF_JITTER
2115a36599ccSJung-uk Kim 	bpf_jit_filter *bf;
2116a36599ccSJung-uk Kim #endif
2117253a3814SLawrence Stewart 	u_int pktlen, slen;
2118253a3814SLawrence Stewart 	int gottime;
211991433904SDavid Malone 
21208cd892f7SJung-uk Kim 	/* Skip outgoing duplicate packets. */
21218cd892f7SJung-uk Kim 	if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif == NULL) {
21228cd892f7SJung-uk Kim 		m->m_flags &= ~M_PROMISC;
21238cd892f7SJung-uk Kim 		return;
21248cd892f7SJung-uk Kim 	}
21258cd892f7SJung-uk Kim 
2126f0e2422bSPoul-Henning Kamp 	pktlen = m_length(m, NULL);
2127253a3814SLawrence Stewart 	gottime = BPF_TSTAMP_NONE;
2128e4b3229aSAlexander V. Chernikov 
2129e4b3229aSAlexander V. Chernikov 	BPFIF_RLOCK(bp);
2130e4b3229aSAlexander V. Chernikov 
21314a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
2132f81a2a49SJung-uk Kim 		if (BPF_CHECK_DIRECTION(d, m->m_pkthdr.rcvif, bp->bif_ifp))
21338ed3828cSRobert Watson 			continue;
2134df8bae1dSRodney W. Grimes 		++d->bd_rcount;
2135ae275efcSJung-uk Kim #ifdef BPF_JITTER
2136a36599ccSJung-uk Kim 		bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL;
2137ae275efcSJung-uk Kim 		/* XXX We cannot handle multiple mbufs. */
2138a36599ccSJung-uk Kim 		if (bf != NULL && m->m_next == NULL)
2139a36599ccSJung-uk Kim 			slen = (*(bf->func))(mtod(m, u_char *), pktlen, pktlen);
2140ae275efcSJung-uk Kim 		else
2141ae275efcSJung-uk Kim #endif
214293e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, (u_char *)m, pktlen, 0);
21434ddfb531SChristian S.J. Peron 		if (slen != 0) {
2144afa85850SAlexander V. Chernikov 			BPFD_LOCK(d);
2145e4b3229aSAlexander V. Chernikov 
214669f7644bSChristian S.J. Peron 			d->bd_fcount++;
2147253a3814SLawrence Stewart 			if (gottime < bpf_ts_quality(d->bd_tstamp))
2148253a3814SLawrence Stewart 				gottime = bpf_gettime(&bt, d->bd_tstamp, m);
21490c7fb534SRobert Watson #ifdef MAC
215030d239bcSRobert Watson 			if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0)
21510c7fb534SRobert Watson #endif
21520c7fb534SRobert Watson 				catchpacket(d, (u_char *)m, pktlen, slen,
2153547d94bdSJung-uk Kim 				    bpf_append_mbuf, &bt);
2154afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
21554ddfb531SChristian S.J. Peron 		}
2156df8bae1dSRodney W. Grimes 	}
2157e4b3229aSAlexander V. Chernikov 	BPFIF_RUNLOCK(bp);
2158df8bae1dSRodney W. Grimes }
2159df8bae1dSRodney W. Grimes 
2160df8bae1dSRodney W. Grimes /*
2161437ffe18SSam Leffler  * Incoming linkage from device drivers, when packet is in
2162437ffe18SSam Leffler  * an mbuf chain and to be prepended by a contiguous header.
2163437ffe18SSam Leffler  */
2164437ffe18SSam Leffler void
216519ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m)
2166437ffe18SSam Leffler {
2167547d94bdSJung-uk Kim 	struct bintime bt;
2168437ffe18SSam Leffler 	struct mbuf mb;
2169437ffe18SSam Leffler 	struct bpf_d *d;
2170253a3814SLawrence Stewart 	u_int pktlen, slen;
2171253a3814SLawrence Stewart 	int gottime;
217291433904SDavid Malone 
21738cd892f7SJung-uk Kim 	/* Skip outgoing duplicate packets. */
21748cd892f7SJung-uk Kim 	if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif == NULL) {
21758cd892f7SJung-uk Kim 		m->m_flags &= ~M_PROMISC;
21768cd892f7SJung-uk Kim 		return;
21778cd892f7SJung-uk Kim 	}
21788cd892f7SJung-uk Kim 
2179437ffe18SSam Leffler 	pktlen = m_length(m, NULL);
2180437ffe18SSam Leffler 	/*
2181437ffe18SSam Leffler 	 * Craft on-stack mbuf suitable for passing to bpf_filter.
2182437ffe18SSam Leffler 	 * Note that we cut corners here; we only setup what's
2183437ffe18SSam Leffler 	 * absolutely needed--this mbuf should never go anywhere else.
2184437ffe18SSam Leffler 	 */
2185437ffe18SSam Leffler 	mb.m_next = m;
2186437ffe18SSam Leffler 	mb.m_data = data;
2187437ffe18SSam Leffler 	mb.m_len = dlen;
2188437ffe18SSam Leffler 	pktlen += dlen;
2189437ffe18SSam Leffler 
2190253a3814SLawrence Stewart 	gottime = BPF_TSTAMP_NONE;
2191e4b3229aSAlexander V. Chernikov 
2192e4b3229aSAlexander V. Chernikov 	BPFIF_RLOCK(bp);
2193e4b3229aSAlexander V. Chernikov 
21944a3feeaaSRobert Watson 	LIST_FOREACH(d, &bp->bif_dlist, bd_next) {
2195f81a2a49SJung-uk Kim 		if (BPF_CHECK_DIRECTION(d, m->m_pkthdr.rcvif, bp->bif_ifp))
2196437ffe18SSam Leffler 			continue;
2197437ffe18SSam Leffler 		++d->bd_rcount;
219893e39f0bSChristian S.J. Peron 		slen = bpf_filter(d->bd_rfilter, (u_char *)&mb, pktlen, 0);
21994ddfb531SChristian S.J. Peron 		if (slen != 0) {
2200afa85850SAlexander V. Chernikov 			BPFD_LOCK(d);
2201e4b3229aSAlexander V. Chernikov 
220269f7644bSChristian S.J. Peron 			d->bd_fcount++;
2203253a3814SLawrence Stewart 			if (gottime < bpf_ts_quality(d->bd_tstamp))
2204253a3814SLawrence Stewart 				gottime = bpf_gettime(&bt, d->bd_tstamp, m);
2205437ffe18SSam Leffler #ifdef MAC
220630d239bcSRobert Watson 			if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0)
2207437ffe18SSam Leffler #endif
2208437ffe18SSam Leffler 				catchpacket(d, (u_char *)&mb, pktlen, slen,
2209547d94bdSJung-uk Kim 				    bpf_append_mbuf, &bt);
2210afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(d);
22114ddfb531SChristian S.J. Peron 		}
2212437ffe18SSam Leffler 	}
2213e4b3229aSAlexander V. Chernikov 	BPFIF_RUNLOCK(bp);
2214437ffe18SSam Leffler }
2215437ffe18SSam Leffler 
2216560a54e1SJung-uk Kim #undef	BPF_CHECK_DIRECTION
2217560a54e1SJung-uk Kim 
2218253a3814SLawrence Stewart #undef	BPF_TSTAMP_NONE
2219253a3814SLawrence Stewart #undef	BPF_TSTAMP_FAST
2220253a3814SLawrence Stewart #undef	BPF_TSTAMP_NORMAL
2221253a3814SLawrence Stewart #undef	BPF_TSTAMP_EXTERN
2222253a3814SLawrence Stewart 
2223547d94bdSJung-uk Kim static int
2224547d94bdSJung-uk Kim bpf_hdrlen(struct bpf_d *d)
2225547d94bdSJung-uk Kim {
2226547d94bdSJung-uk Kim 	int hdrlen;
2227547d94bdSJung-uk Kim 
2228547d94bdSJung-uk Kim 	hdrlen = d->bd_bif->bif_hdrlen;
2229547d94bdSJung-uk Kim #ifndef BURN_BRIDGES
2230547d94bdSJung-uk Kim 	if (d->bd_tstamp == BPF_T_NONE ||
2231547d94bdSJung-uk Kim 	    BPF_T_FORMAT(d->bd_tstamp) == BPF_T_MICROTIME)
2232547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32
2233547d94bdSJung-uk Kim 		if (d->bd_compat32)
2234547d94bdSJung-uk Kim 			hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr32);
2235547d94bdSJung-uk Kim 		else
2236547d94bdSJung-uk Kim #endif
2237547d94bdSJung-uk Kim 			hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr);
2238547d94bdSJung-uk Kim 	else
2239547d94bdSJung-uk Kim #endif
2240547d94bdSJung-uk Kim 		hdrlen += SIZEOF_BPF_HDR(struct bpf_xhdr);
2241547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32
2242547d94bdSJung-uk Kim 	if (d->bd_compat32)
2243547d94bdSJung-uk Kim 		hdrlen = BPF_WORDALIGN32(hdrlen);
2244547d94bdSJung-uk Kim 	else
2245547d94bdSJung-uk Kim #endif
2246547d94bdSJung-uk Kim 		hdrlen = BPF_WORDALIGN(hdrlen);
2247547d94bdSJung-uk Kim 
2248547d94bdSJung-uk Kim 	return (hdrlen - d->bd_bif->bif_hdrlen);
2249547d94bdSJung-uk Kim }
2250547d94bdSJung-uk Kim 
2251547d94bdSJung-uk Kim static void
2252547d94bdSJung-uk Kim bpf_bintime2ts(struct bintime *bt, struct bpf_ts *ts, int tstype)
2253547d94bdSJung-uk Kim {
2254253a3814SLawrence Stewart 	struct bintime bt2;
2255547d94bdSJung-uk Kim 	struct timeval tsm;
2256547d94bdSJung-uk Kim 	struct timespec tsn;
2257547d94bdSJung-uk Kim 
2258253a3814SLawrence Stewart 	if ((tstype & BPF_T_MONOTONIC) == 0) {
2259253a3814SLawrence Stewart 		bt2 = *bt;
2260253a3814SLawrence Stewart 		bintime_add(&bt2, &boottimebin);
2261253a3814SLawrence Stewart 		bt = &bt2;
2262253a3814SLawrence Stewart 	}
2263547d94bdSJung-uk Kim 	switch (BPF_T_FORMAT(tstype)) {
2264547d94bdSJung-uk Kim 	case BPF_T_MICROTIME:
2265547d94bdSJung-uk Kim 		bintime2timeval(bt, &tsm);
2266547d94bdSJung-uk Kim 		ts->bt_sec = tsm.tv_sec;
2267547d94bdSJung-uk Kim 		ts->bt_frac = tsm.tv_usec;
2268547d94bdSJung-uk Kim 		break;
2269547d94bdSJung-uk Kim 	case BPF_T_NANOTIME:
2270547d94bdSJung-uk Kim 		bintime2timespec(bt, &tsn);
2271547d94bdSJung-uk Kim 		ts->bt_sec = tsn.tv_sec;
2272547d94bdSJung-uk Kim 		ts->bt_frac = tsn.tv_nsec;
2273547d94bdSJung-uk Kim 		break;
2274547d94bdSJung-uk Kim 	case BPF_T_BINTIME:
2275547d94bdSJung-uk Kim 		ts->bt_sec = bt->sec;
2276547d94bdSJung-uk Kim 		ts->bt_frac = bt->frac;
2277547d94bdSJung-uk Kim 		break;
2278547d94bdSJung-uk Kim 	}
2279547d94bdSJung-uk Kim }
2280547d94bdSJung-uk Kim 
2281437ffe18SSam Leffler /*
2282df8bae1dSRodney W. Grimes  * Move the packet data from interface memory (pkt) into the
22839e610888SDag-Erling Smørgrav  * store buffer.  "cpfn" is the routine called to do the actual data
2284df8bae1dSRodney W. Grimes  * transfer.  bcopy is passed in to copy contiguous chunks, while
22854d621040SChristian S.J. Peron  * bpf_append_mbuf is passed in to copy mbuf chains.  In the latter case,
2286df8bae1dSRodney W. Grimes  * pkt is really an mbuf.
2287df8bae1dSRodney W. Grimes  */
2288df8bae1dSRodney W. Grimes static void
228919ba8395SChristian S.J. Peron catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen,
22904d621040SChristian S.J. Peron     void (*cpfn)(struct bpf_d *, caddr_t, u_int, void *, u_int),
2291547d94bdSJung-uk Kim     struct bintime *bt)
2292df8bae1dSRodney W. Grimes {
2293547d94bdSJung-uk Kim 	struct bpf_xhdr hdr;
2294547d94bdSJung-uk Kim #ifndef BURN_BRIDGES
2295547d94bdSJung-uk Kim 	struct bpf_hdr hdr_old;
2296fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
2297547d94bdSJung-uk Kim 	struct bpf_hdr32 hdr32_old;
2298fc0a61a4SKonstantin Belousov #endif
2299547d94bdSJung-uk Kim #endif
2300547d94bdSJung-uk Kim 	int caplen, curlen, hdrlen, totlen;
23017819da79SJohn-Mark Gurney 	int do_wakeup = 0;
2302547d94bdSJung-uk Kim 	int do_timestamp;
2303547d94bdSJung-uk Kim 	int tstype;
23049e610888SDag-Erling Smørgrav 
2305afa85850SAlexander V. Chernikov 	BPFD_LOCK_ASSERT(d);
23064d621040SChristian S.J. Peron 
23074d621040SChristian S.J. Peron 	/*
23084d621040SChristian S.J. Peron 	 * Detect whether user space has released a buffer back to us, and if
23094d621040SChristian S.J. Peron 	 * so, move it from being a hold buffer to a free buffer.  This may
23104d621040SChristian S.J. Peron 	 * not be the best place to do it (for example, we might only want to
23114d621040SChristian S.J. Peron 	 * run this check if we need the space), but for now it's a reliable
23124d621040SChristian S.J. Peron 	 * spot to do it.
23134d621040SChristian S.J. Peron 	 */
2314fa0c2b34SRobert Watson 	if (d->bd_fbuf == NULL && bpf_canfreebuf(d)) {
23154d621040SChristian S.J. Peron 		d->bd_fbuf = d->bd_hbuf;
23164d621040SChristian S.J. Peron 		d->bd_hbuf = NULL;
23174d621040SChristian S.J. Peron 		d->bd_hlen = 0;
231829f612ecSChristian S.J. Peron 		bpf_buf_reclaimed(d);
23194d621040SChristian S.J. Peron 	}
23204d621040SChristian S.J. Peron 
2321df8bae1dSRodney W. Grimes 	/*
2322df8bae1dSRodney W. Grimes 	 * Figure out how many bytes to move.  If the packet is
2323df8bae1dSRodney W. Grimes 	 * greater or equal to the snapshot length, transfer that
2324df8bae1dSRodney W. Grimes 	 * much.  Otherwise, transfer the whole packet (unless
2325df8bae1dSRodney W. Grimes 	 * we hit the buffer size limit).
2326df8bae1dSRodney W. Grimes 	 */
2327547d94bdSJung-uk Kim 	hdrlen = bpf_hdrlen(d);
2328df8bae1dSRodney W. Grimes 	totlen = hdrlen + min(snaplen, pktlen);
2329df8bae1dSRodney W. Grimes 	if (totlen > d->bd_bufsize)
2330df8bae1dSRodney W. Grimes 		totlen = d->bd_bufsize;
2331df8bae1dSRodney W. Grimes 
2332df8bae1dSRodney W. Grimes 	/*
2333df8bae1dSRodney W. Grimes 	 * Round up the end of the previous packet to the next longword.
2334a7a91e65SRobert Watson 	 *
2335a7a91e65SRobert Watson 	 * Drop the packet if there's no room and no hope of room
2336a7a91e65SRobert Watson 	 * If the packet would overflow the storage buffer or the storage
2337a7a91e65SRobert Watson 	 * buffer is considered immutable by the buffer model, try to rotate
2338a7a91e65SRobert Watson 	 * the buffer and wakeup pending processes.
2339df8bae1dSRodney W. Grimes 	 */
2340fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
2341fc0a61a4SKonstantin Belousov 	if (d->bd_compat32)
2342fc0a61a4SKonstantin Belousov 		curlen = BPF_WORDALIGN32(d->bd_slen);
2343fc0a61a4SKonstantin Belousov 	else
2344fc0a61a4SKonstantin Belousov #endif
2345df8bae1dSRodney W. Grimes 		curlen = BPF_WORDALIGN(d->bd_slen);
2346a7a91e65SRobert Watson 	if (curlen + totlen > d->bd_bufsize || !bpf_canwritebuf(d)) {
2347572bde2aSRobert Watson 		if (d->bd_fbuf == NULL) {
2348df8bae1dSRodney W. Grimes 			/*
2349a7a91e65SRobert Watson 			 * There's no room in the store buffer, and no
2350a7a91e65SRobert Watson 			 * prospect of room, so drop the packet.  Notify the
2351a7a91e65SRobert Watson 			 * buffer model.
2352df8bae1dSRodney W. Grimes 			 */
2353a7a91e65SRobert Watson 			bpf_buffull(d);
2354df8bae1dSRodney W. Grimes 			++d->bd_dcount;
2355df8bae1dSRodney W. Grimes 			return;
2356df8bae1dSRodney W. Grimes 		}
2357df8bae1dSRodney W. Grimes 		ROTATE_BUFFERS(d);
23587819da79SJohn-Mark Gurney 		do_wakeup = 1;
2359df8bae1dSRodney W. Grimes 		curlen = 0;
2360a7a91e65SRobert Watson 	} else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT)
2361df8bae1dSRodney W. Grimes 		/*
23624d621040SChristian S.J. Peron 		 * Immediate mode is set, or the read timeout has already
23634d621040SChristian S.J. Peron 		 * expired during a select call.  A packet arrived, so the
23644d621040SChristian S.J. Peron 		 * reader should be woken up.
2365df8bae1dSRodney W. Grimes 		 */
23667819da79SJohn-Mark Gurney 		do_wakeup = 1;
2367547d94bdSJung-uk Kim 	caplen = totlen - hdrlen;
2368547d94bdSJung-uk Kim 	tstype = d->bd_tstamp;
2369547d94bdSJung-uk Kim 	do_timestamp = tstype != BPF_T_NONE;
2370547d94bdSJung-uk Kim #ifndef BURN_BRIDGES
2371547d94bdSJung-uk Kim 	if (tstype == BPF_T_NONE || BPF_T_FORMAT(tstype) == BPF_T_MICROTIME) {
2372547d94bdSJung-uk Kim 		struct bpf_ts ts;
2373547d94bdSJung-uk Kim 		if (do_timestamp)
2374547d94bdSJung-uk Kim 			bpf_bintime2ts(bt, &ts, tstype);
2375fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32
2376fc0a61a4SKonstantin Belousov 		if (d->bd_compat32) {
2377547d94bdSJung-uk Kim 			bzero(&hdr32_old, sizeof(hdr32_old));
2378547d94bdSJung-uk Kim 			if (do_timestamp) {
2379547d94bdSJung-uk Kim 				hdr32_old.bh_tstamp.tv_sec = ts.bt_sec;
2380547d94bdSJung-uk Kim 				hdr32_old.bh_tstamp.tv_usec = ts.bt_frac;
2381547d94bdSJung-uk Kim 			}
2382547d94bdSJung-uk Kim 			hdr32_old.bh_datalen = pktlen;
2383547d94bdSJung-uk Kim 			hdr32_old.bh_hdrlen = hdrlen;
2384547d94bdSJung-uk Kim 			hdr32_old.bh_caplen = caplen;
2385547d94bdSJung-uk Kim 			bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr32_old,
2386547d94bdSJung-uk Kim 			    sizeof(hdr32_old));
2387547d94bdSJung-uk Kim 			goto copy;
2388547d94bdSJung-uk Kim 		}
2389547d94bdSJung-uk Kim #endif
2390547d94bdSJung-uk Kim 		bzero(&hdr_old, sizeof(hdr_old));
2391547d94bdSJung-uk Kim 		if (do_timestamp) {
2392547d94bdSJung-uk Kim 			hdr_old.bh_tstamp.tv_sec = ts.bt_sec;
2393547d94bdSJung-uk Kim 			hdr_old.bh_tstamp.tv_usec = ts.bt_frac;
2394547d94bdSJung-uk Kim 		}
2395547d94bdSJung-uk Kim 		hdr_old.bh_datalen = pktlen;
2396547d94bdSJung-uk Kim 		hdr_old.bh_hdrlen = hdrlen;
2397547d94bdSJung-uk Kim 		hdr_old.bh_caplen = caplen;
2398547d94bdSJung-uk Kim 		bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr_old,
2399547d94bdSJung-uk Kim 		    sizeof(hdr_old));
2400fc0a61a4SKonstantin Belousov 		goto copy;
2401fc0a61a4SKonstantin Belousov 	}
2402fc0a61a4SKonstantin Belousov #endif
2403df8bae1dSRodney W. Grimes 
2404df8bae1dSRodney W. Grimes 	/*
24054d621040SChristian S.J. Peron 	 * Append the bpf header.  Note we append the actual header size, but
24064d621040SChristian S.J. Peron 	 * move forward the length of the header plus padding.
2407df8bae1dSRodney W. Grimes 	 */
24084d621040SChristian S.J. Peron 	bzero(&hdr, sizeof(hdr));
2409547d94bdSJung-uk Kim 	if (do_timestamp)
2410547d94bdSJung-uk Kim 		bpf_bintime2ts(bt, &hdr.bh_tstamp, tstype);
24114d621040SChristian S.J. Peron 	hdr.bh_datalen = pktlen;
24124d621040SChristian S.J. Peron 	hdr.bh_hdrlen = hdrlen;
2413547d94bdSJung-uk Kim 	hdr.bh_caplen = caplen;
24144d621040SChristian S.J. Peron 	bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr, sizeof(hdr));
24154d621040SChristian S.J. Peron 
2416df8bae1dSRodney W. Grimes 	/*
2417df8bae1dSRodney W. Grimes 	 * Copy the packet data into the store buffer and update its length.
2418df8bae1dSRodney W. Grimes 	 */
2419547d94bdSJung-uk Kim #ifndef BURN_BRIDGES
2420fc0a61a4SKonstantin Belousov copy:
2421fc0a61a4SKonstantin Belousov #endif
2422547d94bdSJung-uk Kim 	(*cpfn)(d, d->bd_sbuf, curlen + hdrlen, pkt, caplen);
2423df8bae1dSRodney W. Grimes 	d->bd_slen = curlen + totlen;
24247819da79SJohn-Mark Gurney 
24257819da79SJohn-Mark Gurney 	if (do_wakeup)
24267819da79SJohn-Mark Gurney 		bpf_wakeup(d);
2427df8bae1dSRodney W. Grimes }
2428df8bae1dSRodney W. Grimes 
2429df8bae1dSRodney W. Grimes /*
2430df8bae1dSRodney W. Grimes  * Free buffers currently in use by a descriptor.
2431df8bae1dSRodney W. Grimes  * Called on close.
2432df8bae1dSRodney W. Grimes  */
2433df8bae1dSRodney W. Grimes static void
243419ba8395SChristian S.J. Peron bpf_freed(struct bpf_d *d)
2435df8bae1dSRodney W. Grimes {
24364d621040SChristian S.J. Peron 
2437df8bae1dSRodney W. Grimes 	/*
2438df8bae1dSRodney W. Grimes 	 * We don't need to lock out interrupts since this descriptor has
2439df8bae1dSRodney W. Grimes 	 * been detached from its interface and it yet hasn't been marked
2440df8bae1dSRodney W. Grimes 	 * free.
2441df8bae1dSRodney W. Grimes 	 */
24424d621040SChristian S.J. Peron 	bpf_free(d);
244370485847SJung-uk Kim 	if (d->bd_rfilter != NULL) {
244493e39f0bSChristian S.J. Peron 		free((caddr_t)d->bd_rfilter, M_BPF);
2445ae275efcSJung-uk Kim #ifdef BPF_JITTER
244670485847SJung-uk Kim 		if (d->bd_bfilter != NULL)
2447ae275efcSJung-uk Kim 			bpf_destroy_jit_filter(d->bd_bfilter);
2448ae275efcSJung-uk Kim #endif
2449ae275efcSJung-uk Kim 	}
245070485847SJung-uk Kim 	if (d->bd_wfilter != NULL)
245193e39f0bSChristian S.J. Peron 		free((caddr_t)d->bd_wfilter, M_BPF);
2452afa85850SAlexander V. Chernikov 	mtx_destroy(&d->bd_lock);
2453df8bae1dSRodney W. Grimes }
2454df8bae1dSRodney W. Grimes 
2455df8bae1dSRodney W. Grimes /*
245624a229f4SSam Leffler  * Attach an interface to bpf.  dlt is the link layer type; hdrlen is the
245724a229f4SSam Leffler  * fixed size of the link header (variable length headers not yet supported).
2458df8bae1dSRodney W. Grimes  */
2459df8bae1dSRodney W. Grimes void
246019ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen)
2461df8bae1dSRodney W. Grimes {
246224a229f4SSam Leffler 
246324a229f4SSam Leffler 	bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf);
246424a229f4SSam Leffler }
246524a229f4SSam Leffler 
246624a229f4SSam Leffler /*
246724a229f4SSam Leffler  * Attach an interface to bpf.  ifp is a pointer to the structure
246824a229f4SSam Leffler  * defining the interface to be attached, dlt is the link layer type,
246924a229f4SSam Leffler  * and hdrlen is the fixed size of the link header (variable length
247024a229f4SSam Leffler  * headers are not yet supporrted).
247124a229f4SSam Leffler  */
247224a229f4SSam Leffler void
247319ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp)
247424a229f4SSam Leffler {
2475df8bae1dSRodney W. Grimes 	struct bpf_if *bp;
247619ba8395SChristian S.J. Peron 
247719ba8395SChristian S.J. Peron 	bp = malloc(sizeof(*bp), M_BPF, M_NOWAIT | M_ZERO);
2478572bde2aSRobert Watson 	if (bp == NULL)
2479df8bae1dSRodney W. Grimes 		panic("bpfattach");
2480df8bae1dSRodney W. Grimes 
24814a3feeaaSRobert Watson 	LIST_INIT(&bp->bif_dlist);
248251ec1eb7SAlexander V. Chernikov 	LIST_INIT(&bp->bif_wlist);
2483df8bae1dSRodney W. Grimes 	bp->bif_ifp = ifp;
2484df8bae1dSRodney W. Grimes 	bp->bif_dlt = dlt;
2485e4b3229aSAlexander V. Chernikov 	rw_init(&bp->bif_lock, "bpf interface lock");
248616d878ccSChristian S.J. Peron 	KASSERT(*driverp == NULL, ("bpfattach2: driverp already initialized"));
248716d878ccSChristian S.J. Peron 	*driverp = bp;
2488df8bae1dSRodney W. Grimes 
2489e4b3229aSAlexander V. Chernikov 	BPF_LOCK();
24904a3feeaaSRobert Watson 	LIST_INSERT_HEAD(&bpf_iflist, bp, bif_next);
2491e4b3229aSAlexander V. Chernikov 	BPF_UNLOCK();
2492df8bae1dSRodney W. Grimes 
2493547d94bdSJung-uk Kim 	bp->bif_hdrlen = hdrlen;
2494df8bae1dSRodney W. Grimes 
24952eeab939SGarrett Wollman 	if (bootverbose)
249624a229f4SSam Leffler 		if_printf(ifp, "bpf attached\n");
2497df8bae1dSRodney W. Grimes }
249853ac6efbSJulian Elischer 
2499de5d9935SRobert Watson /*
2500de5d9935SRobert Watson  * Detach bpf from an interface. This involves detaching each descriptor
25016c74ff0eSAlexander V. Chernikov  * associated with the interface. Notify each descriptor as it's detached
25026c74ff0eSAlexander V. Chernikov  * so that any sleepers wake up and get ENXIO.
2503de5d9935SRobert Watson  */
2504de5d9935SRobert Watson void
250519ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp)
2506de5d9935SRobert Watson {
25074a3feeaaSRobert Watson 	struct bpf_if	*bp;
2508de5d9935SRobert Watson 	struct bpf_d	*d;
25099a7e6bacSLawrence Stewart #ifdef INVARIANTS
25109a7e6bacSLawrence Stewart 	int ndetached;
2511de5d9935SRobert Watson 
25129a7e6bacSLawrence Stewart 	ndetached = 0;
25139a7e6bacSLawrence Stewart #endif
25149a7e6bacSLawrence Stewart 
2515afa85850SAlexander V. Chernikov 	BPF_LOCK();
25169a7e6bacSLawrence Stewart 	/* Find all bpf_if struct's which reference ifp and detach them. */
25179a7e6bacSLawrence Stewart 	do {
25184a3feeaaSRobert Watson 		LIST_FOREACH(bp, &bpf_iflist, bif_next) {
2519de5d9935SRobert Watson 			if (ifp == bp->bif_ifp)
2520de5d9935SRobert Watson 				break;
2521de5d9935SRobert Watson 		}
25229a7e6bacSLawrence Stewart 		if (bp != NULL)
25234a3feeaaSRobert Watson 			LIST_REMOVE(bp, bif_next);
2524de5d9935SRobert Watson 
25259a7e6bacSLawrence Stewart 		if (bp != NULL) {
25269a7e6bacSLawrence Stewart #ifdef INVARIANTS
25279a7e6bacSLawrence Stewart 			ndetached++;
25289a7e6bacSLawrence Stewart #endif
25294a3feeaaSRobert Watson 			while ((d = LIST_FIRST(&bp->bif_dlist)) != NULL) {
2530afa85850SAlexander V. Chernikov 				bpf_detachd_locked(d);
2531afa85850SAlexander V. Chernikov 				BPFD_LOCK(d);
2532e7bb21b3SJonathan Lemon 				bpf_wakeup(d);
2533afa85850SAlexander V. Chernikov 				BPFD_UNLOCK(d);
2534e7bb21b3SJonathan Lemon 			}
25356c74ff0eSAlexander V. Chernikov 			/* Free writer-only descriptors */
25366c74ff0eSAlexander V. Chernikov 			while ((d = LIST_FIRST(&bp->bif_wlist)) != NULL) {
2537afa85850SAlexander V. Chernikov 				bpf_detachd_locked(d);
2538afa85850SAlexander V. Chernikov 				BPFD_LOCK(d);
25396c74ff0eSAlexander V. Chernikov 				bpf_wakeup(d);
2540afa85850SAlexander V. Chernikov 				BPFD_UNLOCK(d);
25416c74ff0eSAlexander V. Chernikov 			}
2542afa85850SAlexander V. Chernikov 
2543afa85850SAlexander V. Chernikov 			/*
2544afa85850SAlexander V. Chernikov 			 * Delay freing bp till interface is detached
2545afa85850SAlexander V. Chernikov 			 * and all routes through this interface are removed.
2546afa85850SAlexander V. Chernikov 			 * Mark bp as detached to restrict new consumers.
2547afa85850SAlexander V. Chernikov 			 */
2548afa85850SAlexander V. Chernikov 			BPFIF_WLOCK(bp);
2549afa85850SAlexander V. Chernikov 			bp->flags |= BPFIF_FLAG_DYING;
2550afa85850SAlexander V. Chernikov 			BPFIF_WUNLOCK(bp);
25518eab61f3SSam Leffler 		}
25529a7e6bacSLawrence Stewart 	} while (bp != NULL);
2553afa85850SAlexander V. Chernikov 	BPF_UNLOCK();
25549a7e6bacSLawrence Stewart 
25559a7e6bacSLawrence Stewart #ifdef INVARIANTS
25569a7e6bacSLawrence Stewart 	if (ndetached == 0)
25579a7e6bacSLawrence Stewart 		printf("bpfdetach: %s was not attached\n", ifp->if_xname);
25589a7e6bacSLawrence Stewart #endif
25599a7e6bacSLawrence Stewart }
2560de5d9935SRobert Watson 
25618eab61f3SSam Leffler /*
2562afa85850SAlexander V. Chernikov  * Interface departure handler
2563afa85850SAlexander V. Chernikov  */
2564afa85850SAlexander V. Chernikov static void
2565afa85850SAlexander V. Chernikov bpf_ifdetach(void *arg __unused, struct ifnet *ifp)
2566afa85850SAlexander V. Chernikov {
2567afa85850SAlexander V. Chernikov 	struct bpf_if *bp;
2568afa85850SAlexander V. Chernikov 
2569afa85850SAlexander V. Chernikov 	if ((bp = ifp->if_bpf) == NULL)
2570afa85850SAlexander V. Chernikov 		return;
2571afa85850SAlexander V. Chernikov 
2572afa85850SAlexander V. Chernikov 	CTR3(KTR_NET, "%s: freing BPF instance %p for interface %p",
2573afa85850SAlexander V. Chernikov 	    __func__, bp, ifp);
2574afa85850SAlexander V. Chernikov 
2575afa85850SAlexander V. Chernikov 	ifp->if_bpf = NULL;
2576afa85850SAlexander V. Chernikov 	rw_destroy(&bp->bif_lock);
2577afa85850SAlexander V. Chernikov 	free(bp, M_BPF);
2578afa85850SAlexander V. Chernikov }
2579afa85850SAlexander V. Chernikov 
2580afa85850SAlexander V. Chernikov /*
25818eab61f3SSam Leffler  * Get a list of available data link type of the interface.
25828eab61f3SSam Leffler  */
25838eab61f3SSam Leffler static int
258419ba8395SChristian S.J. Peron bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl)
25858eab61f3SSam Leffler {
25868eab61f3SSam Leffler 	int n, error;
25878eab61f3SSam Leffler 	struct ifnet *ifp;
25888eab61f3SSam Leffler 	struct bpf_if *bp;
25898eab61f3SSam Leffler 
2590*97aacec6SAlexander V. Chernikov 	BPF_LOCK_ASSERT();
2591*97aacec6SAlexander V. Chernikov 
25928eab61f3SSam Leffler 	ifp = d->bd_bif->bif_ifp;
25938eab61f3SSam Leffler 	n = 0;
25948eab61f3SSam Leffler 	error = 0;
25954a3feeaaSRobert Watson 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
25968eab61f3SSam Leffler 		if (bp->bif_ifp != ifp)
25978eab61f3SSam Leffler 			continue;
25988eab61f3SSam Leffler 		if (bfl->bfl_list != NULL) {
2599*97aacec6SAlexander V. Chernikov 			if (n >= bfl->bfl_len)
26008eab61f3SSam Leffler 				return (ENOMEM);
26018eab61f3SSam Leffler 			error = copyout(&bp->bif_dlt,
26028eab61f3SSam Leffler 			    bfl->bfl_list + n, sizeof(u_int));
26038eab61f3SSam Leffler 		}
26048eab61f3SSam Leffler 		n++;
26058eab61f3SSam Leffler 	}
26068eab61f3SSam Leffler 	bfl->bfl_len = n;
26078eab61f3SSam Leffler 	return (error);
26088eab61f3SSam Leffler }
26098eab61f3SSam Leffler 
26108eab61f3SSam Leffler /*
26118eab61f3SSam Leffler  * Set the data link type of a BPF instance.
26128eab61f3SSam Leffler  */
26138eab61f3SSam Leffler static int
261419ba8395SChristian S.J. Peron bpf_setdlt(struct bpf_d *d, u_int dlt)
26158eab61f3SSam Leffler {
26168eab61f3SSam Leffler 	int error, opromisc;
26178eab61f3SSam Leffler 	struct ifnet *ifp;
26188eab61f3SSam Leffler 	struct bpf_if *bp;
26198eab61f3SSam Leffler 
26206c74ff0eSAlexander V. Chernikov 	BPF_LOCK_ASSERT();
26216c74ff0eSAlexander V. Chernikov 
26228eab61f3SSam Leffler 	if (d->bd_bif->bif_dlt == dlt)
26238eab61f3SSam Leffler 		return (0);
26248eab61f3SSam Leffler 	ifp = d->bd_bif->bif_ifp;
26256c74ff0eSAlexander V. Chernikov 
26264a3feeaaSRobert Watson 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
26278eab61f3SSam Leffler 		if (bp->bif_ifp == ifp && bp->bif_dlt == dlt)
26288eab61f3SSam Leffler 			break;
26298eab61f3SSam Leffler 	}
26306c74ff0eSAlexander V. Chernikov 
26318eab61f3SSam Leffler 	if (bp != NULL) {
26328eab61f3SSam Leffler 		opromisc = d->bd_promisc;
26338eab61f3SSam Leffler 		bpf_attachd(d, bp);
2634afa85850SAlexander V. Chernikov 		BPFD_LOCK(d);
26358eab61f3SSam Leffler 		reset_d(d);
2636afa85850SAlexander V. Chernikov 		BPFD_UNLOCK(d);
26378eab61f3SSam Leffler 		if (opromisc) {
26388eab61f3SSam Leffler 			error = ifpromisc(bp->bif_ifp, 1);
26398eab61f3SSam Leffler 			if (error)
26408eab61f3SSam Leffler 				if_printf(bp->bif_ifp,
26418eab61f3SSam Leffler 					"bpf_setdlt: ifpromisc failed (%d)\n",
26428eab61f3SSam Leffler 					error);
26438eab61f3SSam Leffler 			else
26448eab61f3SSam Leffler 				d->bd_promisc = 1;
26458eab61f3SSam Leffler 		}
26468eab61f3SSam Leffler 	}
26478eab61f3SSam Leffler 	return (bp == NULL ? EINVAL : 0);
2648de5d9935SRobert Watson }
2649de5d9935SRobert Watson 
26503f54a085SPoul-Henning Kamp static void
265119ba8395SChristian S.J. Peron bpf_drvinit(void *unused)
265253ac6efbSJulian Elischer {
2653136600feSEd Schouten 	struct cdev *dev;
265453ac6efbSJulian Elischer 
26556008862bSJohn Baldwin 	mtx_init(&bpf_mtx, "bpf global lock", NULL, MTX_DEF);
26564a3feeaaSRobert Watson 	LIST_INIT(&bpf_iflist);
2657136600feSEd Schouten 
2658136600feSEd Schouten 	dev = make_dev(&bpf_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "bpf");
2659136600feSEd Schouten 	/* For compatibility */
2660136600feSEd Schouten 	make_dev_alias(dev, "bpf0");
2661afa85850SAlexander V. Chernikov 
2662afa85850SAlexander V. Chernikov 	/* Register interface departure handler */
2663afa85850SAlexander V. Chernikov 	bpf_ifdetach_cookie = EVENTHANDLER_REGISTER(
2664afa85850SAlexander V. Chernikov 		    ifnet_departure_event, bpf_ifdetach, NULL,
2665afa85850SAlexander V. Chernikov 		    EVENTHANDLER_PRI_ANY);
26667198bf47SJulian Elischer }
266753ac6efbSJulian Elischer 
26680e37f3e1SChristian S.J. Peron /*
26690e37f3e1SChristian S.J. Peron  * Zero out the various packet counters associated with all of the bpf
26700e37f3e1SChristian S.J. Peron  * descriptors.  At some point, we will probably want to get a bit more
26710e37f3e1SChristian S.J. Peron  * granular and allow the user to specify descriptors to be zeroed.
26720e37f3e1SChristian S.J. Peron  */
26730e37f3e1SChristian S.J. Peron static void
26740e37f3e1SChristian S.J. Peron bpf_zero_counters(void)
26750e37f3e1SChristian S.J. Peron {
26760e37f3e1SChristian S.J. Peron 	struct bpf_if *bp;
26770e37f3e1SChristian S.J. Peron 	struct bpf_d *bd;
26780e37f3e1SChristian S.J. Peron 
2679e4b3229aSAlexander V. Chernikov 	BPF_LOCK();
26800e37f3e1SChristian S.J. Peron 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
2681e4b3229aSAlexander V. Chernikov 		BPFIF_RLOCK(bp);
26820e37f3e1SChristian S.J. Peron 		LIST_FOREACH(bd, &bp->bif_dlist, bd_next) {
2683afa85850SAlexander V. Chernikov 			BPFD_LOCK(bd);
26840e37f3e1SChristian S.J. Peron 			bd->bd_rcount = 0;
26850e37f3e1SChristian S.J. Peron 			bd->bd_dcount = 0;
26860e37f3e1SChristian S.J. Peron 			bd->bd_fcount = 0;
26870e37f3e1SChristian S.J. Peron 			bd->bd_wcount = 0;
26880e37f3e1SChristian S.J. Peron 			bd->bd_wfcount = 0;
26890e37f3e1SChristian S.J. Peron 			bd->bd_zcopy = 0;
2690afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(bd);
26910e37f3e1SChristian S.J. Peron 		}
2692e4b3229aSAlexander V. Chernikov 		BPFIF_RUNLOCK(bp);
26930e37f3e1SChristian S.J. Peron 	}
2694e4b3229aSAlexander V. Chernikov 	BPF_UNLOCK();
26950e37f3e1SChristian S.J. Peron }
26960e37f3e1SChristian S.J. Peron 
26976c74ff0eSAlexander V. Chernikov /*
26986c74ff0eSAlexander V. Chernikov  * Fill filter statistics
26996c74ff0eSAlexander V. Chernikov  */
270069f7644bSChristian S.J. Peron static void
270169f7644bSChristian S.J. Peron bpfstats_fill_xbpf(struct xbpf_d *d, struct bpf_d *bd)
270269f7644bSChristian S.J. Peron {
270369f7644bSChristian S.J. Peron 
270469f7644bSChristian S.J. Peron 	bzero(d, sizeof(*d));
270569f7644bSChristian S.J. Peron 	BPFD_LOCK_ASSERT(bd);
27064d621040SChristian S.J. Peron 	d->bd_structsize = sizeof(*d);
27076c74ff0eSAlexander V. Chernikov 	/* XXX: reading should be protected by global lock */
270869f7644bSChristian S.J. Peron 	d->bd_immediate = bd->bd_immediate;
270969f7644bSChristian S.J. Peron 	d->bd_promisc = bd->bd_promisc;
271069f7644bSChristian S.J. Peron 	d->bd_hdrcmplt = bd->bd_hdrcmplt;
2711560a54e1SJung-uk Kim 	d->bd_direction = bd->bd_direction;
2712560a54e1SJung-uk Kim 	d->bd_feedback = bd->bd_feedback;
271369f7644bSChristian S.J. Peron 	d->bd_async = bd->bd_async;
271469f7644bSChristian S.J. Peron 	d->bd_rcount = bd->bd_rcount;
271569f7644bSChristian S.J. Peron 	d->bd_dcount = bd->bd_dcount;
271669f7644bSChristian S.J. Peron 	d->bd_fcount = bd->bd_fcount;
271769f7644bSChristian S.J. Peron 	d->bd_sig = bd->bd_sig;
271869f7644bSChristian S.J. Peron 	d->bd_slen = bd->bd_slen;
271969f7644bSChristian S.J. Peron 	d->bd_hlen = bd->bd_hlen;
272069f7644bSChristian S.J. Peron 	d->bd_bufsize = bd->bd_bufsize;
272169f7644bSChristian S.J. Peron 	d->bd_pid = bd->bd_pid;
272269f7644bSChristian S.J. Peron 	strlcpy(d->bd_ifname,
272369f7644bSChristian S.J. Peron 	    bd->bd_bif->bif_ifp->if_xname, IFNAMSIZ);
272493e39f0bSChristian S.J. Peron 	d->bd_locked = bd->bd_locked;
27254d621040SChristian S.J. Peron 	d->bd_wcount = bd->bd_wcount;
27264d621040SChristian S.J. Peron 	d->bd_wdcount = bd->bd_wdcount;
27274d621040SChristian S.J. Peron 	d->bd_wfcount = bd->bd_wfcount;
27284d621040SChristian S.J. Peron 	d->bd_zcopy = bd->bd_zcopy;
27294d621040SChristian S.J. Peron 	d->bd_bufmode = bd->bd_bufmode;
273069f7644bSChristian S.J. Peron }
273169f7644bSChristian S.J. Peron 
27326c74ff0eSAlexander V. Chernikov /*
27336c74ff0eSAlexander V. Chernikov  * Handle `netstat -B' stats request
27346c74ff0eSAlexander V. Chernikov  */
273569f7644bSChristian S.J. Peron static int
273669f7644bSChristian S.J. Peron bpf_stats_sysctl(SYSCTL_HANDLER_ARGS)
273769f7644bSChristian S.J. Peron {
27380e37f3e1SChristian S.J. Peron 	struct xbpf_d *xbdbuf, *xbd, zerostats;
2739422a63daSChristian S.J. Peron 	int index, error;
274069f7644bSChristian S.J. Peron 	struct bpf_if *bp;
274169f7644bSChristian S.J. Peron 	struct bpf_d *bd;
274269f7644bSChristian S.J. Peron 
274369f7644bSChristian S.J. Peron 	/*
274469f7644bSChristian S.J. Peron 	 * XXX This is not technically correct. It is possible for non
274569f7644bSChristian S.J. Peron 	 * privileged users to open bpf devices. It would make sense
274669f7644bSChristian S.J. Peron 	 * if the users who opened the devices were able to retrieve
274769f7644bSChristian S.J. Peron 	 * the statistics for them, too.
274869f7644bSChristian S.J. Peron 	 */
2749acd3428bSRobert Watson 	error = priv_check(req->td, PRIV_NET_BPF);
275069f7644bSChristian S.J. Peron 	if (error)
275169f7644bSChristian S.J. Peron 		return (error);
27520e37f3e1SChristian S.J. Peron 	/*
27530e37f3e1SChristian S.J. Peron 	 * Check to see if the user is requesting that the counters be
27540e37f3e1SChristian S.J. Peron 	 * zeroed out.  Explicitly check that the supplied data is zeroed,
27550e37f3e1SChristian S.J. Peron 	 * as we aren't allowing the user to set the counters currently.
27560e37f3e1SChristian S.J. Peron 	 */
27570e37f3e1SChristian S.J. Peron 	if (req->newptr != NULL) {
27580e37f3e1SChristian S.J. Peron 		if (req->newlen != sizeof(zerostats))
27590e37f3e1SChristian S.J. Peron 			return (EINVAL);
27600e37f3e1SChristian S.J. Peron 		bzero(&zerostats, sizeof(zerostats));
27610e37f3e1SChristian S.J. Peron 		xbd = req->newptr;
27620e37f3e1SChristian S.J. Peron 		if (bcmp(xbd, &zerostats, sizeof(*xbd)) != 0)
27630e37f3e1SChristian S.J. Peron 			return (EINVAL);
27640e37f3e1SChristian S.J. Peron 		bpf_zero_counters();
27650e37f3e1SChristian S.J. Peron 		return (0);
27660e37f3e1SChristian S.J. Peron 	}
276769f7644bSChristian S.J. Peron 	if (req->oldptr == NULL)
2768422a63daSChristian S.J. Peron 		return (SYSCTL_OUT(req, 0, bpf_bpfd_cnt * sizeof(*xbd)));
276969f7644bSChristian S.J. Peron 	if (bpf_bpfd_cnt == 0)
277069f7644bSChristian S.J. Peron 		return (SYSCTL_OUT(req, 0, 0));
2771422a63daSChristian S.J. Peron 	xbdbuf = malloc(req->oldlen, M_BPF, M_WAITOK);
2772e4b3229aSAlexander V. Chernikov 	BPF_LOCK();
2773422a63daSChristian S.J. Peron 	if (req->oldlen < (bpf_bpfd_cnt * sizeof(*xbd))) {
2774e4b3229aSAlexander V. Chernikov 		BPF_UNLOCK();
2775422a63daSChristian S.J. Peron 		free(xbdbuf, M_BPF);
2776422a63daSChristian S.J. Peron 		return (ENOMEM);
2777422a63daSChristian S.J. Peron 	}
2778422a63daSChristian S.J. Peron 	index = 0;
277969f7644bSChristian S.J. Peron 	LIST_FOREACH(bp, &bpf_iflist, bif_next) {
2780e4b3229aSAlexander V. Chernikov 		BPFIF_RLOCK(bp);
278151ec1eb7SAlexander V. Chernikov 		/* Send writers-only first */
278251ec1eb7SAlexander V. Chernikov 		LIST_FOREACH(bd, &bp->bif_wlist, bd_next) {
278351ec1eb7SAlexander V. Chernikov 			xbd = &xbdbuf[index++];
2784afa85850SAlexander V. Chernikov 			BPFD_LOCK(bd);
278551ec1eb7SAlexander V. Chernikov 			bpfstats_fill_xbpf(xbd, bd);
2786afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(bd);
278751ec1eb7SAlexander V. Chernikov 		}
278869f7644bSChristian S.J. Peron 		LIST_FOREACH(bd, &bp->bif_dlist, bd_next) {
2789422a63daSChristian S.J. Peron 			xbd = &xbdbuf[index++];
2790afa85850SAlexander V. Chernikov 			BPFD_LOCK(bd);
2791422a63daSChristian S.J. Peron 			bpfstats_fill_xbpf(xbd, bd);
2792afa85850SAlexander V. Chernikov 			BPFD_UNLOCK(bd);
279369f7644bSChristian S.J. Peron 		}
2794e4b3229aSAlexander V. Chernikov 		BPFIF_RUNLOCK(bp);
279569f7644bSChristian S.J. Peron 	}
2796e4b3229aSAlexander V. Chernikov 	BPF_UNLOCK();
2797422a63daSChristian S.J. Peron 	error = SYSCTL_OUT(req, xbdbuf, index * sizeof(*xbd));
2798422a63daSChristian S.J. Peron 	free(xbdbuf, M_BPF);
279969f7644bSChristian S.J. Peron 	return (error);
280069f7644bSChristian S.J. Peron }
280169f7644bSChristian S.J. Peron 
2802237fdd78SRobert Watson SYSINIT(bpfdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE,bpf_drvinit,NULL);
280353ac6efbSJulian Elischer 
28045bb5f2c9SPeter Wemm #else /* !DEV_BPF && !NETGRAPH_BPF */
2805f8dc4716SMike Smith /*
2806f8dc4716SMike Smith  * NOP stubs to allow bpf-using drivers to load and function.
2807f8dc4716SMike Smith  *
2808f8dc4716SMike Smith  * A 'better' implementation would allow the core bpf functionality
2809f8dc4716SMike Smith  * to be loaded at runtime.
2810f8dc4716SMike Smith  */
28117eae78a4SChristian S.J. Peron static struct bpf_if bp_null;
2812f8dc4716SMike Smith 
2813f8dc4716SMike Smith void
281419ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen)
2815f8dc4716SMike Smith {
2816f8dc4716SMike Smith }
2817f8dc4716SMike Smith 
2818f8dc4716SMike Smith void
281919ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m)
2820f8dc4716SMike Smith {
2821f8dc4716SMike Smith }
2822f8dc4716SMike Smith 
2823f8dc4716SMike Smith void
282419ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *d, u_int l, struct mbuf *m)
2825437ffe18SSam Leffler {
2826437ffe18SSam Leffler }
2827437ffe18SSam Leffler 
2828437ffe18SSam Leffler void
282919ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen)
2830f8dc4716SMike Smith {
28317eae78a4SChristian S.J. Peron 
28327eae78a4SChristian S.J. Peron 	bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf);
2833f8dc4716SMike Smith }
2834f8dc4716SMike Smith 
2835da626c17SBill Paul void
283619ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp)
28375f7a7923SSam Leffler {
28387eae78a4SChristian S.J. Peron 
28397eae78a4SChristian S.J. Peron 	*driverp = &bp_null;
28405f7a7923SSam Leffler }
28415f7a7923SSam Leffler 
28425f7a7923SSam Leffler void
284319ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp)
2844da626c17SBill Paul {
2845da626c17SBill Paul }
2846da626c17SBill Paul 
2847f8dc4716SMike Smith u_int
284819ba8395SChristian S.J. Peron bpf_filter(const struct bpf_insn *pc, u_char *p, u_int wirelen, u_int buflen)
2849f8dc4716SMike Smith {
2850f8dc4716SMike Smith 	return -1;	/* "no filter" behaviour */
2851f8dc4716SMike Smith }
2852f8dc4716SMike Smith 
28535bb5f2c9SPeter Wemm int
285419ba8395SChristian S.J. Peron bpf_validate(const struct bpf_insn *f, int len)
28555bb5f2c9SPeter Wemm {
28565bb5f2c9SPeter Wemm 	return 0;		/* false */
28575bb5f2c9SPeter Wemm }
28585bb5f2c9SPeter Wemm 
28595bb5f2c9SPeter Wemm #endif /* !DEV_BPF && !NETGRAPH_BPF */
2860