1c398230bSWarner Losh /*- 251369649SPedro F. Giffuni * SPDX-License-Identifier: BSD-3-Clause 351369649SPedro F. Giffuni * 4df8bae1dSRodney W. Grimes * Copyright (c) 1990, 1991, 1993 5253a3814SLawrence Stewart * The Regents of the University of California. All rights reserved. 6699281b5SAndrey V. Elsukov * Copyright (c) 2019 Andrey V. Elsukov <ae@FreeBSD.org> 7df8bae1dSRodney W. Grimes * 8df8bae1dSRodney W. Grimes * This code is derived from the Stanford/CMU enet packet filter, 9df8bae1dSRodney W. Grimes * (net/enet.c) distributed as part of 4.3BSD, and code contributed 10df8bae1dSRodney W. Grimes * to Berkeley by Steven McCanne and Van Jacobson both of Lawrence 11df8bae1dSRodney W. Grimes * Berkeley Laboratory. 12df8bae1dSRodney W. Grimes * 13df8bae1dSRodney W. Grimes * Redistribution and use in source and binary forms, with or without 14df8bae1dSRodney W. Grimes * modification, are permitted provided that the following conditions 15df8bae1dSRodney W. Grimes * are met: 16df8bae1dSRodney W. Grimes * 1. Redistributions of source code must retain the above copyright 17df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer. 18df8bae1dSRodney W. Grimes * 2. Redistributions in binary form must reproduce the above copyright 19df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer in the 20df8bae1dSRodney W. Grimes * documentation and/or other materials provided with the distribution. 21fbbd9655SWarner Losh * 3. Neither the name of the University nor the names of its contributors 22df8bae1dSRodney W. Grimes * may be used to endorse or promote products derived from this software 23df8bae1dSRodney W. Grimes * without specific prior written permission. 24df8bae1dSRodney W. Grimes * 25df8bae1dSRodney W. Grimes * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 26df8bae1dSRodney W. Grimes * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 27df8bae1dSRodney W. Grimes * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 28df8bae1dSRodney W. Grimes * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 29df8bae1dSRodney W. Grimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 30df8bae1dSRodney W. Grimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 31df8bae1dSRodney W. Grimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 32df8bae1dSRodney W. Grimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 33df8bae1dSRodney W. Grimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 34df8bae1dSRodney W. Grimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 35df8bae1dSRodney W. Grimes * SUCH DAMAGE. 36df8bae1dSRodney W. Grimes * 374f252c4dSRuslan Ermilov * @(#)bpf.c 8.4 (Berkeley) 1/9/95 38df8bae1dSRodney W. Grimes */ 39df8bae1dSRodney W. Grimes 40c7866007SRobert Watson #include <sys/cdefs.h> 41c7866007SRobert Watson __FBSDID("$FreeBSD$"); 42c7866007SRobert Watson 435bb5f2c9SPeter Wemm #include "opt_bpf.h" 4405fc4164SBjoern A. Zeeb #include "opt_ddb.h" 455bb5f2c9SPeter Wemm #include "opt_netgraph.h" 46df8bae1dSRodney W. Grimes 47df8bae1dSRodney W. Grimes #include <sys/param.h> 48ce7609a4SBruce Evans #include <sys/conf.h> 49e2e050c8SConrad Meyer #include <sys/eventhandler.h> 50e76eee55SPoul-Henning Kamp #include <sys/fcntl.h> 51ebd8672cSBjoern A. Zeeb #include <sys/jail.h> 52e2e050c8SConrad Meyer #include <sys/ktr.h> 53e2e050c8SConrad Meyer #include <sys/lock.h> 544d1d4912SBruce Evans #include <sys/malloc.h> 55df8bae1dSRodney W. Grimes #include <sys/mbuf.h> 56e2e050c8SConrad Meyer #include <sys/mutex.h> 57df8bae1dSRodney W. Grimes #include <sys/time.h> 58acd3428bSRobert Watson #include <sys/priv.h> 59df8bae1dSRodney W. Grimes #include <sys/proc.h> 600310c19fSBruce Evans #include <sys/signalvar.h> 61528f627fSBruce Evans #include <sys/filio.h> 62528f627fSBruce Evans #include <sys/sockio.h> 63528f627fSBruce Evans #include <sys/ttycom.h> 64e76eee55SPoul-Henning Kamp #include <sys/uio.h> 6574549d4bSWojciech Macek #include <sys/sysent.h> 66e2e050c8SConrad Meyer #include <sys/systm.h> 67df8bae1dSRodney W. Grimes 6895aab9ccSJohn-Mark Gurney #include <sys/event.h> 6995aab9ccSJohn-Mark Gurney #include <sys/file.h> 70243ac7d8SPeter Wemm #include <sys/poll.h> 7195aab9ccSJohn-Mark Gurney #include <sys/proc.h> 72df8bae1dSRodney W. Grimes 73df8bae1dSRodney W. Grimes #include <sys/socket.h> 74df8bae1dSRodney W. Grimes 7505fc4164SBjoern A. Zeeb #ifdef DDB 7605fc4164SBjoern A. Zeeb #include <ddb/ddb.h> 7705fc4164SBjoern A. Zeeb #endif 7805fc4164SBjoern A. Zeeb 79fba9235dSBruce Evans #include <net/if.h> 8076039bc8SGleb Smirnoff #include <net/if_var.h> 811e7fe2fbSLuiz Otavio O Souza #include <net/if_vlan_var.h> 824fb3a820SAlexander V. Chernikov #include <net/if_dl.h> 83df8bae1dSRodney W. Grimes #include <net/bpf.h> 844d621040SChristian S.J. Peron #include <net/bpf_buffer.h> 85ae275efcSJung-uk Kim #ifdef BPF_JITTER 86ae275efcSJung-uk Kim #include <net/bpf_jitter.h> 87ae275efcSJung-uk Kim #endif 884d621040SChristian S.J. Peron #include <net/bpf_zerocopy.h> 89df8bae1dSRodney W. Grimes #include <net/bpfdesc.h> 904fb3a820SAlexander V. Chernikov #include <net/route.h> 91530c0060SRobert Watson #include <net/vnet.h> 92df8bae1dSRodney W. Grimes 93df8bae1dSRodney W. Grimes #include <netinet/in.h> 94df8bae1dSRodney W. Grimes #include <netinet/if_ether.h> 95df8bae1dSRodney W. Grimes #include <sys/kernel.h> 96f708ef1bSPoul-Henning Kamp #include <sys/sysctl.h> 977b778b5eSEivind Eklund 98246b5467SSam Leffler #include <net80211/ieee80211_freebsd.h> 99246b5467SSam Leffler 100aed55708SRobert Watson #include <security/mac/mac_framework.h> 101aed55708SRobert Watson 1024d621040SChristian S.J. Peron MALLOC_DEFINE(M_BPF, "BPF", "BPF data"); 10387f6c662SJulian Elischer 1042b9600b4SAndrey V. Elsukov static struct bpf_if_ext dead_bpf_if = { 105699281b5SAndrey V. Elsukov .bif_dlist = CK_LIST_HEAD_INITIALIZER() 1062b9600b4SAndrey V. Elsukov }; 1072b9600b4SAndrey V. Elsukov 108b23cbbe6SMark Johnston struct bpf_if { 109b23cbbe6SMark Johnston #define bif_next bif_ext.bif_next 110b23cbbe6SMark Johnston #define bif_dlist bif_ext.bif_dlist 111b23cbbe6SMark Johnston struct bpf_if_ext bif_ext; /* public members */ 112b23cbbe6SMark Johnston u_int bif_dlt; /* link layer type */ 113b23cbbe6SMark Johnston u_int bif_hdrlen; /* length of link header */ 114699281b5SAndrey V. Elsukov struct bpfd_list bif_wlist; /* writer-only list */ 115b23cbbe6SMark Johnston struct ifnet *bif_ifp; /* corresponding interface */ 1169ce40d32SKristof Provost struct bpf_if **bif_bpf; /* Pointer to pointer to us */ 117699281b5SAndrey V. Elsukov volatile u_int bif_refcnt; 118699281b5SAndrey V. Elsukov struct epoch_context epoch_ctx; 119b23cbbe6SMark Johnston }; 120b23cbbe6SMark Johnston 121b23cbbe6SMark Johnston CTASSERT(offsetof(struct bpf_if, bif_ext) == 0); 122b23cbbe6SMark Johnston 123699281b5SAndrey V. Elsukov struct bpf_program_buffer { 124699281b5SAndrey V. Elsukov struct epoch_context epoch_ctx; 125699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 126699281b5SAndrey V. Elsukov bpf_jit_filter *func; 127699281b5SAndrey V. Elsukov #endif 128699281b5SAndrey V. Elsukov void *buffer[0]; 129699281b5SAndrey V. Elsukov }; 130ca3cd72bSAndrey V. Elsukov 1315bb5f2c9SPeter Wemm #if defined(DEV_BPF) || defined(NETGRAPH_BPF) 13253ac6efbSJulian Elischer 133df8bae1dSRodney W. Grimes #define PRINET 26 /* interruptible */ 1341e7fe2fbSLuiz Otavio O Souza #define BPF_PRIO_MAX 7 135df8bae1dSRodney W. Grimes 136547d94bdSJung-uk Kim #define SIZEOF_BPF_HDR(type) \ 137547d94bdSJung-uk Kim (offsetof(type, bh_hdrlen) + sizeof(((type *)0)->bh_hdrlen)) 138547d94bdSJung-uk Kim 139fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 140fc0a61a4SKonstantin Belousov #include <sys/mount.h> 141fc0a61a4SKonstantin Belousov #include <compat/freebsd32/freebsd32.h> 142fc0a61a4SKonstantin Belousov #define BPF_ALIGNMENT32 sizeof(int32_t) 143d9c9c81cSPedro F. Giffuni #define BPF_WORDALIGN32(x) roundup2(x, BPF_ALIGNMENT32) 144fc0a61a4SKonstantin Belousov 145547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 146fc0a61a4SKonstantin Belousov /* 147fc0a61a4SKonstantin Belousov * 32-bit version of structure prepended to each packet. We use this header 148fc0a61a4SKonstantin Belousov * instead of the standard one for 32-bit streams. We mark the a stream as 149fc0a61a4SKonstantin Belousov * 32-bit the first time we see a 32-bit compat ioctl request. 150fc0a61a4SKonstantin Belousov */ 151fc0a61a4SKonstantin Belousov struct bpf_hdr32 { 152fc0a61a4SKonstantin Belousov struct timeval32 bh_tstamp; /* time stamp */ 153fc0a61a4SKonstantin Belousov uint32_t bh_caplen; /* length of captured portion */ 154fc0a61a4SKonstantin Belousov uint32_t bh_datalen; /* original length of packet */ 155fc0a61a4SKonstantin Belousov uint16_t bh_hdrlen; /* length of bpf header (this struct 156fc0a61a4SKonstantin Belousov plus alignment padding) */ 157fc0a61a4SKonstantin Belousov }; 158253a3814SLawrence Stewart #endif 159fc0a61a4SKonstantin Belousov 160fc0a61a4SKonstantin Belousov struct bpf_program32 { 161fc0a61a4SKonstantin Belousov u_int bf_len; 162fc0a61a4SKonstantin Belousov uint32_t bf_insns; 163fc0a61a4SKonstantin Belousov }; 164fc0a61a4SKonstantin Belousov 165fc0a61a4SKonstantin Belousov struct bpf_dltlist32 { 166fc0a61a4SKonstantin Belousov u_int bfl_len; 167fc0a61a4SKonstantin Belousov u_int bfl_list; 168fc0a61a4SKonstantin Belousov }; 169fc0a61a4SKonstantin Belousov 170fc0a61a4SKonstantin Belousov #define BIOCSETF32 _IOW('B', 103, struct bpf_program32) 171fc0a61a4SKonstantin Belousov #define BIOCSRTIMEOUT32 _IOW('B', 109, struct timeval32) 172fc0a61a4SKonstantin Belousov #define BIOCGRTIMEOUT32 _IOR('B', 110, struct timeval32) 173fc0a61a4SKonstantin Belousov #define BIOCGDLTLIST32 _IOWR('B', 121, struct bpf_dltlist32) 174fc0a61a4SKonstantin Belousov #define BIOCSETWF32 _IOW('B', 123, struct bpf_program32) 175fc0a61a4SKonstantin Belousov #define BIOCSETFNR32 _IOW('B', 130, struct bpf_program32) 176253a3814SLawrence Stewart #endif 177fc0a61a4SKonstantin Belousov 178f422673eSStephen Hurd #define BPF_LOCK() sx_xlock(&bpf_sx) 179f422673eSStephen Hurd #define BPF_UNLOCK() sx_xunlock(&bpf_sx) 180f422673eSStephen Hurd #define BPF_LOCK_ASSERT() sx_assert(&bpf_sx, SA_XLOCKED) 181df8bae1dSRodney W. Grimes /* 182d1a67300SRobert Watson * bpf_iflist is a list of BPF interface structures, each corresponding to a 183d1a67300SRobert Watson * specific DLT. The same network interface might have several BPF interface 184d1a67300SRobert Watson * structures registered by different layers in the stack (i.e., 802.11 185d1a67300SRobert Watson * frames, ethernet frames, etc). 186df8bae1dSRodney W. Grimes */ 187699281b5SAndrey V. Elsukov CK_LIST_HEAD(bpf_iflist, bpf_if); 188699281b5SAndrey V. Elsukov static struct bpf_iflist bpf_iflist; 189f422673eSStephen Hurd static struct sx bpf_sx; /* bpf global lock */ 19069f7644bSChristian S.J. Peron static int bpf_bpfd_cnt; 191df8bae1dSRodney W. Grimes 192699281b5SAndrey V. Elsukov static void bpfif_ref(struct bpf_if *); 193699281b5SAndrey V. Elsukov static void bpfif_rele(struct bpf_if *); 194699281b5SAndrey V. Elsukov 195699281b5SAndrey V. Elsukov static void bpfd_ref(struct bpf_d *); 196699281b5SAndrey V. Elsukov static void bpfd_rele(struct bpf_d *); 19719ba8395SChristian S.J. Peron static void bpf_attachd(struct bpf_d *, struct bpf_if *); 19819ba8395SChristian S.J. Peron static void bpf_detachd(struct bpf_d *); 199699281b5SAndrey V. Elsukov static void bpf_detachd_locked(struct bpf_d *, bool); 200699281b5SAndrey V. Elsukov static void bpfd_free(epoch_context_t); 201cb44b6dfSAndrew Thompson static int bpf_movein(struct uio *, int, struct ifnet *, struct mbuf **, 2024fb3a820SAlexander V. Chernikov struct sockaddr *, int *, struct bpf_d *); 203929ddbbbSAlfred Perlstein static int bpf_setif(struct bpf_d *, struct ifreq *); 204929ddbbbSAlfred Perlstein static void bpf_timed_out(void *); 205e7bb21b3SJonathan Lemon static __inline void 206929ddbbbSAlfred Perlstein bpf_wakeup(struct bpf_d *); 2074d621040SChristian S.J. Peron static void catchpacket(struct bpf_d *, u_char *, u_int, u_int, 2084d621040SChristian S.J. Peron void (*)(struct bpf_d *, caddr_t, u_int, void *, u_int), 209547d94bdSJung-uk Kim struct bintime *); 210929ddbbbSAlfred Perlstein static void reset_d(struct bpf_d *); 21193e39f0bSChristian S.J. Peron static int bpf_setf(struct bpf_d *, struct bpf_program *, u_long cmd); 2128eab61f3SSam Leffler static int bpf_getdltlist(struct bpf_d *, struct bpf_dltlist *); 2138eab61f3SSam Leffler static int bpf_setdlt(struct bpf_d *, u_int); 21495aab9ccSJohn-Mark Gurney static void filt_bpfdetach(struct knote *); 21595aab9ccSJohn-Mark Gurney static int filt_bpfread(struct knote *, long); 216*ded77e02SHartmut Brandt static int filt_bpfwrite(struct knote *, long); 217a3272e3cSChristian S.J. Peron static void bpf_drvinit(void *); 21869f7644bSChristian S.J. Peron static int bpf_stats_sysctl(SYSCTL_HANDLER_ARGS); 21969f7644bSChristian S.J. Peron 2207029da5cSPawel Biernacki SYSCTL_NODE(_net, OID_AUTO, bpf, CTLFLAG_RW | CTLFLAG_MPSAFE, 0, 2217029da5cSPawel Biernacki "bpf sysctl"); 22212dc9582SJung-uk Kim int bpf_maxinsns = BPF_MAXINSNS; 22369f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, maxinsns, CTLFLAG_RW, 22469f7644bSChristian S.J. Peron &bpf_maxinsns, 0, "Maximum bpf program instructions"); 225ffeeb924SChristian S.J. Peron static int bpf_zerocopy_enable = 0; 2264d621040SChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, zerocopy_enable, CTLFLAG_RW, 2274d621040SChristian S.J. Peron &bpf_zerocopy_enable, 0, "Enable new zero-copy BPF buffer sessions"); 2286472ac3dSEd Schouten static SYSCTL_NODE(_net_bpf, OID_AUTO, stats, CTLFLAG_MPSAFE | CTLFLAG_RW, 22969f7644bSChristian S.J. Peron bpf_stats_sysctl, "bpf statistics portal"); 230df8bae1dSRodney W. Grimes 2315f901c92SAndrew Turner VNET_DEFINE_STATIC(int, bpf_optimize_writers) = 0; 23251ec1eb7SAlexander V. Chernikov #define V_bpf_optimize_writers VNET(bpf_optimize_writers) 233c774294cSTycho Nightingale SYSCTL_INT(_net_bpf, OID_AUTO, optimize_writers, CTLFLAG_VNET | CTLFLAG_RWTUN, 2346df8a710SGleb Smirnoff &VNET_NAME(bpf_optimize_writers), 0, 23551ec1eb7SAlexander V. Chernikov "Do not send packets until BPF program is set"); 23651ec1eb7SAlexander V. Chernikov 23787f6c662SJulian Elischer static d_open_t bpfopen; 23887f6c662SJulian Elischer static d_read_t bpfread; 23987f6c662SJulian Elischer static d_write_t bpfwrite; 24087f6c662SJulian Elischer static d_ioctl_t bpfioctl; 241243ac7d8SPeter Wemm static d_poll_t bpfpoll; 24295aab9ccSJohn-Mark Gurney static d_kqfilter_t bpfkqfilter; 24387f6c662SJulian Elischer 2444e2f199eSPoul-Henning Kamp static struct cdevsw bpf_cdevsw = { 245dc08ffecSPoul-Henning Kamp .d_version = D_VERSION, 2467ac40f5fSPoul-Henning Kamp .d_open = bpfopen, 2477ac40f5fSPoul-Henning Kamp .d_read = bpfread, 2487ac40f5fSPoul-Henning Kamp .d_write = bpfwrite, 2497ac40f5fSPoul-Henning Kamp .d_ioctl = bpfioctl, 2507ac40f5fSPoul-Henning Kamp .d_poll = bpfpoll, 2517ac40f5fSPoul-Henning Kamp .d_name = "bpf", 25295aab9ccSJohn-Mark Gurney .d_kqfilter = bpfkqfilter, 2534e2f199eSPoul-Henning Kamp }; 25487f6c662SJulian Elischer 255e76d823bSRobert Watson static struct filterops bpfread_filtops = { 256e76d823bSRobert Watson .f_isfd = 1, 257e76d823bSRobert Watson .f_detach = filt_bpfdetach, 258e76d823bSRobert Watson .f_event = filt_bpfread, 259e76d823bSRobert Watson }; 26087f6c662SJulian Elischer 261*ded77e02SHartmut Brandt static struct filterops bpfwrite_filtops = { 262*ded77e02SHartmut Brandt .f_isfd = 1, 263*ded77e02SHartmut Brandt .f_detach = filt_bpfdetach, 264*ded77e02SHartmut Brandt .f_event = filt_bpfwrite, 265*ded77e02SHartmut Brandt }; 266*ded77e02SHartmut Brandt 2674d621040SChristian S.J. Peron /* 268699281b5SAndrey V. Elsukov * LOCKING MODEL USED BY BPF 269699281b5SAndrey V. Elsukov * 2706c74ff0eSAlexander V. Chernikov * Locks: 271699281b5SAndrey V. Elsukov * 1) global lock (BPF_LOCK). Sx, used to protect some global counters, 272699281b5SAndrey V. Elsukov * every bpf_iflist changes, serializes ioctl access to bpf descriptors. 273699281b5SAndrey V. Elsukov * 2) Descriptor lock. Mutex, used to protect BPF buffers and various 274699281b5SAndrey V. Elsukov * structure fields used by bpf_*tap* code. 2756c74ff0eSAlexander V. Chernikov * 276699281b5SAndrey V. Elsukov * Lock order: global lock, then descriptor lock. 2776c74ff0eSAlexander V. Chernikov * 278699281b5SAndrey V. Elsukov * There are several possible consumers: 2796c74ff0eSAlexander V. Chernikov * 280699281b5SAndrey V. Elsukov * 1. The kernel registers interface pointer with bpfattach(). 281699281b5SAndrey V. Elsukov * Each call allocates new bpf_if structure, references ifnet pointer 282699281b5SAndrey V. Elsukov * and links bpf_if into bpf_iflist chain. This is protected with global 283699281b5SAndrey V. Elsukov * lock. 2846c74ff0eSAlexander V. Chernikov * 285699281b5SAndrey V. Elsukov * 2. An userland application uses ioctl() call to bpf_d descriptor. 286699281b5SAndrey V. Elsukov * All such call are serialized with global lock. BPF filters can be 2872a4bd982SGleb Smirnoff * changed, but pointer to old filter will be freed using NET_EPOCH_CALL(). 288699281b5SAndrey V. Elsukov * Thus it should be safe for bpf_tap/bpf_mtap* code to do access to 289699281b5SAndrey V. Elsukov * filter pointers, even if change will happen during bpf_tap execution. 2902a4bd982SGleb Smirnoff * Destroying of bpf_d descriptor also is doing using NET_EPOCH_CALL(). 2916c74ff0eSAlexander V. Chernikov * 292699281b5SAndrey V. Elsukov * 3. An userland application can write packets into bpf_d descriptor. 293699281b5SAndrey V. Elsukov * There we need to be sure, that ifnet won't disappear during bpfwrite(). 2946c74ff0eSAlexander V. Chernikov * 295699281b5SAndrey V. Elsukov * 4. The kernel invokes bpf_tap/bpf_mtap* functions. The access to 296699281b5SAndrey V. Elsukov * bif_dlist is protected with net_epoch_preempt section. So, it should 297699281b5SAndrey V. Elsukov * be safe to make access to bpf_d descriptor inside the section. 298699281b5SAndrey V. Elsukov * 299699281b5SAndrey V. Elsukov * 5. The kernel invokes bpfdetach() on interface destroying. All lists 300699281b5SAndrey V. Elsukov * are modified with global lock held and actual free() is done using 3012a4bd982SGleb Smirnoff * NET_EPOCH_CALL(). 3026c74ff0eSAlexander V. Chernikov */ 3036c74ff0eSAlexander V. Chernikov 304699281b5SAndrey V. Elsukov static void 305699281b5SAndrey V. Elsukov bpfif_free(epoch_context_t ctx) 306699281b5SAndrey V. Elsukov { 307699281b5SAndrey V. Elsukov struct bpf_if *bp; 308699281b5SAndrey V. Elsukov 309699281b5SAndrey V. Elsukov bp = __containerof(ctx, struct bpf_if, epoch_ctx); 310699281b5SAndrey V. Elsukov if_rele(bp->bif_ifp); 311699281b5SAndrey V. Elsukov free(bp, M_BPF); 312699281b5SAndrey V. Elsukov } 313699281b5SAndrey V. Elsukov 314699281b5SAndrey V. Elsukov static void 315699281b5SAndrey V. Elsukov bpfif_ref(struct bpf_if *bp) 316699281b5SAndrey V. Elsukov { 317699281b5SAndrey V. Elsukov 318699281b5SAndrey V. Elsukov refcount_acquire(&bp->bif_refcnt); 319699281b5SAndrey V. Elsukov } 320699281b5SAndrey V. Elsukov 321699281b5SAndrey V. Elsukov static void 322699281b5SAndrey V. Elsukov bpfif_rele(struct bpf_if *bp) 323699281b5SAndrey V. Elsukov { 324699281b5SAndrey V. Elsukov 325699281b5SAndrey V. Elsukov if (!refcount_release(&bp->bif_refcnt)) 326699281b5SAndrey V. Elsukov return; 3272a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpfif_free, &bp->epoch_ctx); 328699281b5SAndrey V. Elsukov } 329699281b5SAndrey V. Elsukov 330699281b5SAndrey V. Elsukov static void 331699281b5SAndrey V. Elsukov bpfd_ref(struct bpf_d *d) 332699281b5SAndrey V. Elsukov { 333699281b5SAndrey V. Elsukov 334699281b5SAndrey V. Elsukov refcount_acquire(&d->bd_refcnt); 335699281b5SAndrey V. Elsukov } 336699281b5SAndrey V. Elsukov 337699281b5SAndrey V. Elsukov static void 338699281b5SAndrey V. Elsukov bpfd_rele(struct bpf_d *d) 339699281b5SAndrey V. Elsukov { 340699281b5SAndrey V. Elsukov 341699281b5SAndrey V. Elsukov if (!refcount_release(&d->bd_refcnt)) 342699281b5SAndrey V. Elsukov return; 3432a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpfd_free, &d->epoch_ctx); 344699281b5SAndrey V. Elsukov } 345699281b5SAndrey V. Elsukov 346699281b5SAndrey V. Elsukov static struct bpf_program_buffer* 347699281b5SAndrey V. Elsukov bpf_program_buffer_alloc(size_t size, int flags) 348699281b5SAndrey V. Elsukov { 349699281b5SAndrey V. Elsukov 350699281b5SAndrey V. Elsukov return (malloc(sizeof(struct bpf_program_buffer) + size, 351699281b5SAndrey V. Elsukov M_BPF, flags)); 352699281b5SAndrey V. Elsukov } 353699281b5SAndrey V. Elsukov 354699281b5SAndrey V. Elsukov static void 355699281b5SAndrey V. Elsukov bpf_program_buffer_free(epoch_context_t ctx) 356699281b5SAndrey V. Elsukov { 357699281b5SAndrey V. Elsukov struct bpf_program_buffer *ptr; 358699281b5SAndrey V. Elsukov 359699281b5SAndrey V. Elsukov ptr = __containerof(ctx, struct bpf_program_buffer, epoch_ctx); 360699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 361699281b5SAndrey V. Elsukov if (ptr->func != NULL) 362699281b5SAndrey V. Elsukov bpf_destroy_jit_filter(ptr->func); 363699281b5SAndrey V. Elsukov #endif 364699281b5SAndrey V. Elsukov free(ptr, M_BPF); 365699281b5SAndrey V. Elsukov } 366699281b5SAndrey V. Elsukov 3676c74ff0eSAlexander V. Chernikov /* 3684d621040SChristian S.J. Peron * Wrapper functions for various buffering methods. If the set of buffer 3694d621040SChristian S.J. Peron * modes expands, we will probably want to introduce a switch data structure 3704d621040SChristian S.J. Peron * similar to protosw, et. 3714d621040SChristian S.J. Peron */ 3724d621040SChristian S.J. Peron static void 3734d621040SChristian S.J. Peron bpf_append_bytes(struct bpf_d *d, caddr_t buf, u_int offset, void *src, 3744d621040SChristian S.J. Peron u_int len) 3754d621040SChristian S.J. Peron { 3764d621040SChristian S.J. Peron 377afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 3784d621040SChristian S.J. Peron 3794d621040SChristian S.J. Peron switch (d->bd_bufmode) { 3804d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 3814d621040SChristian S.J. Peron return (bpf_buffer_append_bytes(d, buf, offset, src, len)); 3824d621040SChristian S.J. Peron 3834d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 384b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_zcopy, 1); 3854d621040SChristian S.J. Peron return (bpf_zerocopy_append_bytes(d, buf, offset, src, len)); 3864d621040SChristian S.J. Peron 3874d621040SChristian S.J. Peron default: 3884d621040SChristian S.J. Peron panic("bpf_buf_append_bytes"); 3894d621040SChristian S.J. Peron } 3904d621040SChristian S.J. Peron } 3914d621040SChristian S.J. Peron 3924d621040SChristian S.J. Peron static void 3934d621040SChristian S.J. Peron bpf_append_mbuf(struct bpf_d *d, caddr_t buf, u_int offset, void *src, 3944d621040SChristian S.J. Peron u_int len) 3954d621040SChristian S.J. Peron { 3964d621040SChristian S.J. Peron 397afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 3984d621040SChristian S.J. Peron 3994d621040SChristian S.J. Peron switch (d->bd_bufmode) { 4004d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 4014d621040SChristian S.J. Peron return (bpf_buffer_append_mbuf(d, buf, offset, src, len)); 4024d621040SChristian S.J. Peron 4034d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 404b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_zcopy, 1); 4054d621040SChristian S.J. Peron return (bpf_zerocopy_append_mbuf(d, buf, offset, src, len)); 4064d621040SChristian S.J. Peron 4074d621040SChristian S.J. Peron default: 4084d621040SChristian S.J. Peron panic("bpf_buf_append_mbuf"); 4094d621040SChristian S.J. Peron } 4104d621040SChristian S.J. Peron } 4114d621040SChristian S.J. Peron 4124d621040SChristian S.J. Peron /* 41329f612ecSChristian S.J. Peron * This function gets called when the free buffer is re-assigned. 41429f612ecSChristian S.J. Peron */ 41529f612ecSChristian S.J. Peron static void 41629f612ecSChristian S.J. Peron bpf_buf_reclaimed(struct bpf_d *d) 41729f612ecSChristian S.J. Peron { 41829f612ecSChristian S.J. Peron 419afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 42029f612ecSChristian S.J. Peron 42129f612ecSChristian S.J. Peron switch (d->bd_bufmode) { 42229f612ecSChristian S.J. Peron case BPF_BUFMODE_BUFFER: 42329f612ecSChristian S.J. Peron return; 42429f612ecSChristian S.J. Peron 42529f612ecSChristian S.J. Peron case BPF_BUFMODE_ZBUF: 42629f612ecSChristian S.J. Peron bpf_zerocopy_buf_reclaimed(d); 42729f612ecSChristian S.J. Peron return; 42829f612ecSChristian S.J. Peron 42929f612ecSChristian S.J. Peron default: 43029f612ecSChristian S.J. Peron panic("bpf_buf_reclaimed"); 43129f612ecSChristian S.J. Peron } 43229f612ecSChristian S.J. Peron } 43329f612ecSChristian S.J. Peron 43429f612ecSChristian S.J. Peron /* 4354d621040SChristian S.J. Peron * If the buffer mechanism has a way to decide that a held buffer can be made 4364d621040SChristian S.J. Peron * free, then it is exposed via the bpf_canfreebuf() interface. (1) is 4374d621040SChristian S.J. Peron * returned if the buffer can be discarded, (0) is returned if it cannot. 4384d621040SChristian S.J. Peron */ 4394d621040SChristian S.J. Peron static int 4404d621040SChristian S.J. Peron bpf_canfreebuf(struct bpf_d *d) 4414d621040SChristian S.J. Peron { 4424d621040SChristian S.J. Peron 4434d621040SChristian S.J. Peron BPFD_LOCK_ASSERT(d); 4444d621040SChristian S.J. Peron 4454d621040SChristian S.J. Peron switch (d->bd_bufmode) { 4464d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 4474d621040SChristian S.J. Peron return (bpf_zerocopy_canfreebuf(d)); 4484d621040SChristian S.J. Peron } 4494d621040SChristian S.J. Peron return (0); 4504d621040SChristian S.J. Peron } 4514d621040SChristian S.J. Peron 452a7a91e65SRobert Watson /* 453a7a91e65SRobert Watson * Allow the buffer model to indicate that the current store buffer is 454a7a91e65SRobert Watson * immutable, regardless of the appearance of space. Return (1) if the 455a7a91e65SRobert Watson * buffer is writable, and (0) if not. 456a7a91e65SRobert Watson */ 457a7a91e65SRobert Watson static int 458a7a91e65SRobert Watson bpf_canwritebuf(struct bpf_d *d) 459a7a91e65SRobert Watson { 460a7a91e65SRobert Watson BPFD_LOCK_ASSERT(d); 461a7a91e65SRobert Watson 462a7a91e65SRobert Watson switch (d->bd_bufmode) { 463a7a91e65SRobert Watson case BPF_BUFMODE_ZBUF: 464a7a91e65SRobert Watson return (bpf_zerocopy_canwritebuf(d)); 465a7a91e65SRobert Watson } 466a7a91e65SRobert Watson return (1); 467a7a91e65SRobert Watson } 468a7a91e65SRobert Watson 469a7a91e65SRobert Watson /* 470a7a91e65SRobert Watson * Notify buffer model that an attempt to write to the store buffer has 471a7a91e65SRobert Watson * resulted in a dropped packet, in which case the buffer may be considered 472a7a91e65SRobert Watson * full. 473a7a91e65SRobert Watson */ 474a7a91e65SRobert Watson static void 475a7a91e65SRobert Watson bpf_buffull(struct bpf_d *d) 476a7a91e65SRobert Watson { 477a7a91e65SRobert Watson 478afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 479a7a91e65SRobert Watson 480a7a91e65SRobert Watson switch (d->bd_bufmode) { 481a7a91e65SRobert Watson case BPF_BUFMODE_ZBUF: 482a7a91e65SRobert Watson bpf_zerocopy_buffull(d); 483a7a91e65SRobert Watson break; 484a7a91e65SRobert Watson } 485a7a91e65SRobert Watson } 486a7a91e65SRobert Watson 487a7a91e65SRobert Watson /* 488a7a91e65SRobert Watson * Notify the buffer model that a buffer has moved into the hold position. 489a7a91e65SRobert Watson */ 4904d621040SChristian S.J. Peron void 4914d621040SChristian S.J. Peron bpf_bufheld(struct bpf_d *d) 4924d621040SChristian S.J. Peron { 4934d621040SChristian S.J. Peron 494afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 4954d621040SChristian S.J. Peron 4964d621040SChristian S.J. Peron switch (d->bd_bufmode) { 4974d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 4984d621040SChristian S.J. Peron bpf_zerocopy_bufheld(d); 4994d621040SChristian S.J. Peron break; 5004d621040SChristian S.J. Peron } 5014d621040SChristian S.J. Peron } 5024d621040SChristian S.J. Peron 5034d621040SChristian S.J. Peron static void 5044d621040SChristian S.J. Peron bpf_free(struct bpf_d *d) 5054d621040SChristian S.J. Peron { 5064d621040SChristian S.J. Peron 5074d621040SChristian S.J. Peron switch (d->bd_bufmode) { 5084d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 5094d621040SChristian S.J. Peron return (bpf_buffer_free(d)); 5104d621040SChristian S.J. Peron 5114d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 5124d621040SChristian S.J. Peron return (bpf_zerocopy_free(d)); 5134d621040SChristian S.J. Peron 5144d621040SChristian S.J. Peron default: 5154d621040SChristian S.J. Peron panic("bpf_buf_free"); 5164d621040SChristian S.J. Peron } 5174d621040SChristian S.J. Peron } 5184d621040SChristian S.J. Peron 5194d621040SChristian S.J. Peron static int 5204d621040SChristian S.J. Peron bpf_uiomove(struct bpf_d *d, caddr_t buf, u_int len, struct uio *uio) 5214d621040SChristian S.J. Peron { 5224d621040SChristian S.J. Peron 5234d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) 5244d621040SChristian S.J. Peron return (EOPNOTSUPP); 5254d621040SChristian S.J. Peron return (bpf_buffer_uiomove(d, buf, len, uio)); 5264d621040SChristian S.J. Peron } 5274d621040SChristian S.J. Peron 5284d621040SChristian S.J. Peron static int 5294d621040SChristian S.J. Peron bpf_ioctl_sblen(struct bpf_d *d, u_int *i) 5304d621040SChristian S.J. Peron { 5314d621040SChristian S.J. Peron 5324d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) 5334d621040SChristian S.J. Peron return (EOPNOTSUPP); 5344d621040SChristian S.J. Peron return (bpf_buffer_ioctl_sblen(d, i)); 5354d621040SChristian S.J. Peron } 5364d621040SChristian S.J. Peron 5374d621040SChristian S.J. Peron static int 5384d621040SChristian S.J. Peron bpf_ioctl_getzmax(struct thread *td, struct bpf_d *d, size_t *i) 5394d621040SChristian S.J. Peron { 5404d621040SChristian S.J. Peron 5414d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5424d621040SChristian S.J. Peron return (EOPNOTSUPP); 5434d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_getzmax(td, d, i)); 5444d621040SChristian S.J. Peron } 5454d621040SChristian S.J. Peron 5464d621040SChristian S.J. Peron static int 5474d621040SChristian S.J. Peron bpf_ioctl_rotzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz) 5484d621040SChristian S.J. Peron { 5494d621040SChristian S.J. Peron 5504d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5514d621040SChristian S.J. Peron return (EOPNOTSUPP); 5524d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_rotzbuf(td, d, bz)); 5534d621040SChristian S.J. Peron } 5544d621040SChristian S.J. Peron 5554d621040SChristian S.J. Peron static int 5564d621040SChristian S.J. Peron bpf_ioctl_setzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz) 5574d621040SChristian S.J. Peron { 5584d621040SChristian S.J. Peron 5594d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5604d621040SChristian S.J. Peron return (EOPNOTSUPP); 5614d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_setzbuf(td, d, bz)); 5624d621040SChristian S.J. Peron } 5634d621040SChristian S.J. Peron 5644d621040SChristian S.J. Peron /* 5654d621040SChristian S.J. Peron * General BPF functions. 5664d621040SChristian S.J. Peron */ 567df8bae1dSRodney W. Grimes static int 568cb44b6dfSAndrew Thompson bpf_movein(struct uio *uio, int linktype, struct ifnet *ifp, struct mbuf **mp, 5694fb3a820SAlexander V. Chernikov struct sockaddr *sockp, int *hdrlen, struct bpf_d *d) 570df8bae1dSRodney W. Grimes { 571246b5467SSam Leffler const struct ieee80211_bpf_params *p; 572cb44b6dfSAndrew Thompson struct ether_header *eh; 573df8bae1dSRodney W. Grimes struct mbuf *m; 574df8bae1dSRodney W. Grimes int error; 575df8bae1dSRodney W. Grimes int len; 576df8bae1dSRodney W. Grimes int hlen; 57793e39f0bSChristian S.J. Peron int slen; 578df8bae1dSRodney W. Grimes 579df8bae1dSRodney W. Grimes /* 580df8bae1dSRodney W. Grimes * Build a sockaddr based on the data link layer type. 581df8bae1dSRodney W. Grimes * We do this at this level because the ethernet header 582df8bae1dSRodney W. Grimes * is copied directly into the data field of the sockaddr. 583df8bae1dSRodney W. Grimes * In the case of SLIP, there is no header and the packet 584df8bae1dSRodney W. Grimes * is forwarded as is. 585df8bae1dSRodney W. Grimes * Also, we are careful to leave room at the front of the mbuf 586df8bae1dSRodney W. Grimes * for the link level header. 587df8bae1dSRodney W. Grimes */ 588df8bae1dSRodney W. Grimes switch (linktype) { 589df8bae1dSRodney W. Grimes case DLT_SLIP: 590df8bae1dSRodney W. Grimes sockp->sa_family = AF_INET; 591df8bae1dSRodney W. Grimes hlen = 0; 592df8bae1dSRodney W. Grimes break; 593df8bae1dSRodney W. Grimes 594df8bae1dSRodney W. Grimes case DLT_EN10MB: 595df8bae1dSRodney W. Grimes sockp->sa_family = AF_UNSPEC; 596df8bae1dSRodney W. Grimes /* XXX Would MAXLINKHDR be better? */ 597797f247bSMatthew N. Dodd hlen = ETHER_HDR_LEN; 598df8bae1dSRodney W. Grimes break; 599df8bae1dSRodney W. Grimes 600df8bae1dSRodney W. Grimes case DLT_FDDI: 601d41f24e7SDavid Greenman sockp->sa_family = AF_IMPLINK; 602d41f24e7SDavid Greenman hlen = 0; 603df8bae1dSRodney W. Grimes break; 604df8bae1dSRodney W. Grimes 60522f05c43SAndrey A. Chernov case DLT_RAW: 606df8bae1dSRodney W. Grimes sockp->sa_family = AF_UNSPEC; 607df8bae1dSRodney W. Grimes hlen = 0; 608df8bae1dSRodney W. Grimes break; 609df8bae1dSRodney W. Grimes 61001399f34SDavid Malone case DLT_NULL: 61101399f34SDavid Malone /* 61201399f34SDavid Malone * null interface types require a 4 byte pseudo header which 61301399f34SDavid Malone * corresponds to the address family of the packet. 61401399f34SDavid Malone */ 61501399f34SDavid Malone sockp->sa_family = AF_UNSPEC; 61601399f34SDavid Malone hlen = 4; 61701399f34SDavid Malone break; 61801399f34SDavid Malone 6194f53e3ccSKenjiro Cho case DLT_ATM_RFC1483: 6204f53e3ccSKenjiro Cho /* 6214f53e3ccSKenjiro Cho * en atm driver requires 4-byte atm pseudo header. 6224f53e3ccSKenjiro Cho * though it isn't standard, vpi:vci needs to be 6234f53e3ccSKenjiro Cho * specified anyway. 6244f53e3ccSKenjiro Cho */ 6254f53e3ccSKenjiro Cho sockp->sa_family = AF_UNSPEC; 6264f53e3ccSKenjiro Cho hlen = 12; /* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */ 6274f53e3ccSKenjiro Cho break; 6284f53e3ccSKenjiro Cho 62930fa52a6SBrian Somers case DLT_PPP: 63030fa52a6SBrian Somers sockp->sa_family = AF_UNSPEC; 63130fa52a6SBrian Somers hlen = 4; /* This should match PPP_HDRLEN */ 63230fa52a6SBrian Somers break; 63330fa52a6SBrian Somers 634246b5467SSam Leffler case DLT_IEEE802_11: /* IEEE 802.11 wireless */ 635246b5467SSam Leffler sockp->sa_family = AF_IEEE80211; 636246b5467SSam Leffler hlen = 0; 637246b5467SSam Leffler break; 638246b5467SSam Leffler 639246b5467SSam Leffler case DLT_IEEE802_11_RADIO: /* IEEE 802.11 wireless w/ phy params */ 640246b5467SSam Leffler sockp->sa_family = AF_IEEE80211; 641246b5467SSam Leffler sockp->sa_len = 12; /* XXX != 0 */ 642246b5467SSam Leffler hlen = sizeof(struct ieee80211_bpf_params); 643246b5467SSam Leffler break; 644246b5467SSam Leffler 645df8bae1dSRodney W. Grimes default: 646df8bae1dSRodney W. Grimes return (EIO); 647df8bae1dSRodney W. Grimes } 648df8bae1dSRodney W. Grimes 649df8bae1dSRodney W. Grimes len = uio->uio_resid; 650ed63043bSGleb Smirnoff if (len < hlen || len - hlen > ifp->if_mtu) 65101399f34SDavid Malone return (EMSGSIZE); 65201399f34SDavid Malone 653f13da247SFlorian Florensa /* Allocate a mbuf for our write, since m_get2 fails if len >= to MJUMPAGESIZE, use m_getjcl for bigger buffers */ 654a051ca72SKristof Provost m = m_get3(len, M_WAITOK, MT_DATA, M_PKTHDR); 655ed63043bSGleb Smirnoff if (m == NULL) 656df8bae1dSRodney W. Grimes return (EIO); 657963e4c2aSGarrett Wollman m->m_pkthdr.len = m->m_len = len; 658df8bae1dSRodney W. Grimes *mp = m; 65924a229f4SSam Leffler 66093e39f0bSChristian S.J. Peron error = uiomove(mtod(m, u_char *), len, uio); 66193e39f0bSChristian S.J. Peron if (error) 66293e39f0bSChristian S.J. Peron goto bad; 66393e39f0bSChristian S.J. Peron 6644fb3a820SAlexander V. Chernikov slen = bpf_filter(d->bd_wfilter, mtod(m, u_char *), len, len); 66593e39f0bSChristian S.J. Peron if (slen == 0) { 66693e39f0bSChristian S.J. Peron error = EPERM; 66793e39f0bSChristian S.J. Peron goto bad; 66893e39f0bSChristian S.J. Peron } 66993e39f0bSChristian S.J. Peron 670cb44b6dfSAndrew Thompson /* Check for multicast destination */ 671cb44b6dfSAndrew Thompson switch (linktype) { 672cb44b6dfSAndrew Thompson case DLT_EN10MB: 673cb44b6dfSAndrew Thompson eh = mtod(m, struct ether_header *); 674cb44b6dfSAndrew Thompson if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 675cb44b6dfSAndrew Thompson if (bcmp(ifp->if_broadcastaddr, eh->ether_dhost, 676cb44b6dfSAndrew Thompson ETHER_ADDR_LEN) == 0) 677cb44b6dfSAndrew Thompson m->m_flags |= M_BCAST; 678cb44b6dfSAndrew Thompson else 679cb44b6dfSAndrew Thompson m->m_flags |= M_MCAST; 680cb44b6dfSAndrew Thompson } 6814fb3a820SAlexander V. Chernikov if (d->bd_hdrcmplt == 0) { 6824fb3a820SAlexander V. Chernikov memcpy(eh->ether_shost, IF_LLADDR(ifp), 6834fb3a820SAlexander V. Chernikov sizeof(eh->ether_shost)); 6844fb3a820SAlexander V. Chernikov } 685cb44b6dfSAndrew Thompson break; 686cb44b6dfSAndrew Thompson } 687cb44b6dfSAndrew Thompson 688df8bae1dSRodney W. Grimes /* 68993e39f0bSChristian S.J. Peron * Make room for link header, and copy it to sockaddr 690df8bae1dSRodney W. Grimes */ 691df8bae1dSRodney W. Grimes if (hlen != 0) { 692246b5467SSam Leffler if (sockp->sa_family == AF_IEEE80211) { 693246b5467SSam Leffler /* 694246b5467SSam Leffler * Collect true length from the parameter header 695246b5467SSam Leffler * NB: sockp is known to be zero'd so if we do a 696246b5467SSam Leffler * short copy unspecified parameters will be 697246b5467SSam Leffler * zero. 698246b5467SSam Leffler * NB: packet may not be aligned after stripping 699246b5467SSam Leffler * bpf params 700246b5467SSam Leffler * XXX check ibp_vers 701246b5467SSam Leffler */ 702246b5467SSam Leffler p = mtod(m, const struct ieee80211_bpf_params *); 703246b5467SSam Leffler hlen = p->ibp_len; 704246b5467SSam Leffler if (hlen > sizeof(sockp->sa_data)) { 705246b5467SSam Leffler error = EINVAL; 706246b5467SSam Leffler goto bad; 707246b5467SSam Leffler } 708246b5467SSam Leffler } 709a09968c4SAdrian Chadd bcopy(mtod(m, const void *), sockp->sa_data, hlen); 710df8bae1dSRodney W. Grimes } 711560a54e1SJung-uk Kim *hdrlen = hlen; 71293e39f0bSChristian S.J. Peron 713df8bae1dSRodney W. Grimes return (0); 714df8bae1dSRodney W. Grimes bad: 715df8bae1dSRodney W. Grimes m_freem(m); 716df8bae1dSRodney W. Grimes return (error); 717df8bae1dSRodney W. Grimes } 718df8bae1dSRodney W. Grimes 719df8bae1dSRodney W. Grimes /* 720699281b5SAndrey V. Elsukov * Attach descriptor to the bpf interface, i.e. make d listen on bp, 721699281b5SAndrey V. Elsukov * then reset its buffers and counters with reset_d(). 722df8bae1dSRodney W. Grimes */ 723df8bae1dSRodney W. Grimes static void 72419ba8395SChristian S.J. Peron bpf_attachd(struct bpf_d *d, struct bpf_if *bp) 725df8bae1dSRodney W. Grimes { 7266c74ff0eSAlexander V. Chernikov int op_w; 7276c74ff0eSAlexander V. Chernikov 7286c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 7296c74ff0eSAlexander V. Chernikov 7306c74ff0eSAlexander V. Chernikov /* 7316c74ff0eSAlexander V. Chernikov * Save sysctl value to protect from sysctl change 7326c74ff0eSAlexander V. Chernikov * between reads 7336c74ff0eSAlexander V. Chernikov */ 73471448753SAlexander Motin op_w = V_bpf_optimize_writers || d->bd_writer; 7356c74ff0eSAlexander V. Chernikov 7366c74ff0eSAlexander V. Chernikov if (d->bd_bif != NULL) 737699281b5SAndrey V. Elsukov bpf_detachd_locked(d, false); 738df8bae1dSRodney W. Grimes /* 73951ec1eb7SAlexander V. Chernikov * Point d at bp, and add d to the interface's list. 740f87e372eSLuiz Otavio O Souza * Since there are many applications using BPF for 74151ec1eb7SAlexander V. Chernikov * sending raw packets only (dhcpd, cdpd are good examples) 74251ec1eb7SAlexander V. Chernikov * we can delay adding d to the list of active listeners until 74351ec1eb7SAlexander V. Chernikov * some filter is configured. 744df8bae1dSRodney W. Grimes */ 74551ec1eb7SAlexander V. Chernikov 746afa85850SAlexander V. Chernikov BPFD_LOCK(d); 747699281b5SAndrey V. Elsukov /* 748699281b5SAndrey V. Elsukov * Hold reference to bpif while descriptor uses this interface. 749699281b5SAndrey V. Elsukov */ 750699281b5SAndrey V. Elsukov bpfif_ref(bp); 7516c74ff0eSAlexander V. Chernikov d->bd_bif = bp; 7526c74ff0eSAlexander V. Chernikov if (op_w != 0) { 75351ec1eb7SAlexander V. Chernikov /* Add to writers-only list */ 754699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bp->bif_wlist, d, bd_next); 75551ec1eb7SAlexander V. Chernikov /* 75651ec1eb7SAlexander V. Chernikov * We decrement bd_writer on every filter set operation. 75751ec1eb7SAlexander V. Chernikov * First BIOCSETF is done by pcap_open_live() to set up 758699281b5SAndrey V. Elsukov * snap length. After that appliation usually sets its own 759699281b5SAndrey V. Elsukov * filter. 76051ec1eb7SAlexander V. Chernikov */ 76151ec1eb7SAlexander V. Chernikov d->bd_writer = 2; 76251ec1eb7SAlexander V. Chernikov } else 763699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bp->bif_dlist, d, bd_next); 764df8bae1dSRodney W. Grimes 765699281b5SAndrey V. Elsukov reset_d(d); 766afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 76751ec1eb7SAlexander V. Chernikov bpf_bpfd_cnt++; 76851ec1eb7SAlexander V. Chernikov 76951ec1eb7SAlexander V. Chernikov CTR3(KTR_NET, "%s: bpf_attach called by pid %d, adding to %s list", 77051ec1eb7SAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer ? "writer" : "active"); 77151ec1eb7SAlexander V. Chernikov 7726c74ff0eSAlexander V. Chernikov if (op_w == 0) 77351ec1eb7SAlexander V. Chernikov EVENTHANDLER_INVOKE(bpf_track, bp->bif_ifp, bp->bif_dlt, 1); 77451ec1eb7SAlexander V. Chernikov } 77551ec1eb7SAlexander V. Chernikov 77651ec1eb7SAlexander V. Chernikov /* 777402000ffSAlexander V. Chernikov * Check if we need to upgrade our descriptor @d from write-only mode. 778402000ffSAlexander V. Chernikov */ 779402000ffSAlexander V. Chernikov static int 780699281b5SAndrey V. Elsukov bpf_check_upgrade(u_long cmd, struct bpf_d *d, struct bpf_insn *fcode, 781699281b5SAndrey V. Elsukov int flen) 782402000ffSAlexander V. Chernikov { 783402000ffSAlexander V. Chernikov int is_snap, need_upgrade; 784402000ffSAlexander V. Chernikov 785402000ffSAlexander V. Chernikov /* 786402000ffSAlexander V. Chernikov * Check if we've already upgraded or new filter is empty. 787402000ffSAlexander V. Chernikov */ 788402000ffSAlexander V. Chernikov if (d->bd_writer == 0 || fcode == NULL) 789402000ffSAlexander V. Chernikov return (0); 790402000ffSAlexander V. Chernikov 791402000ffSAlexander V. Chernikov need_upgrade = 0; 792402000ffSAlexander V. Chernikov 793402000ffSAlexander V. Chernikov /* 794402000ffSAlexander V. Chernikov * Check if cmd looks like snaplen setting from 795402000ffSAlexander V. Chernikov * pcap_bpf.c:pcap_open_live(). 796402000ffSAlexander V. Chernikov * Note we're not checking .k value here: 797caa7e52fSEitan Adler * while pcap_open_live() definitely sets to non-zero value, 798402000ffSAlexander V. Chernikov * we'd prefer to treat k=0 (deny ALL) case the same way: e.g. 799402000ffSAlexander V. Chernikov * do not consider upgrading immediately 800402000ffSAlexander V. Chernikov */ 801699281b5SAndrey V. Elsukov if (cmd == BIOCSETF && flen == 1 && 802699281b5SAndrey V. Elsukov fcode[0].code == (BPF_RET | BPF_K)) 803402000ffSAlexander V. Chernikov is_snap = 1; 804402000ffSAlexander V. Chernikov else 805402000ffSAlexander V. Chernikov is_snap = 0; 806402000ffSAlexander V. Chernikov 807402000ffSAlexander V. Chernikov if (is_snap == 0) { 808402000ffSAlexander V. Chernikov /* 809402000ffSAlexander V. Chernikov * We're setting first filter and it doesn't look like 810402000ffSAlexander V. Chernikov * setting snaplen. We're probably using bpf directly. 811402000ffSAlexander V. Chernikov * Upgrade immediately. 812402000ffSAlexander V. Chernikov */ 813402000ffSAlexander V. Chernikov need_upgrade = 1; 814402000ffSAlexander V. Chernikov } else { 815402000ffSAlexander V. Chernikov /* 816402000ffSAlexander V. Chernikov * Do not require upgrade by first BIOCSETF 817402000ffSAlexander V. Chernikov * (used to set snaplen) by pcap_open_live(). 818402000ffSAlexander V. Chernikov */ 819402000ffSAlexander V. Chernikov 820402000ffSAlexander V. Chernikov if (--d->bd_writer == 0) { 821402000ffSAlexander V. Chernikov /* 822402000ffSAlexander V. Chernikov * First snaplen filter has already 823402000ffSAlexander V. Chernikov * been set. This is probably catch-all 824402000ffSAlexander V. Chernikov * filter 825402000ffSAlexander V. Chernikov */ 826402000ffSAlexander V. Chernikov need_upgrade = 1; 827402000ffSAlexander V. Chernikov } 828402000ffSAlexander V. Chernikov } 829402000ffSAlexander V. Chernikov 830402000ffSAlexander V. Chernikov CTR5(KTR_NET, 831402000ffSAlexander V. Chernikov "%s: filter function set by pid %d, " 832402000ffSAlexander V. Chernikov "bd_writer counter %d, snap %d upgrade %d", 833402000ffSAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer, 834402000ffSAlexander V. Chernikov is_snap, need_upgrade); 835402000ffSAlexander V. Chernikov 836402000ffSAlexander V. Chernikov return (need_upgrade); 837402000ffSAlexander V. Chernikov } 838402000ffSAlexander V. Chernikov 839402000ffSAlexander V. Chernikov /* 840df8bae1dSRodney W. Grimes * Detach a file from its interface. 841df8bae1dSRodney W. Grimes */ 842df8bae1dSRodney W. Grimes static void 84319ba8395SChristian S.J. Peron bpf_detachd(struct bpf_d *d) 844df8bae1dSRodney W. Grimes { 8456c74ff0eSAlexander V. Chernikov BPF_LOCK(); 846699281b5SAndrey V. Elsukov bpf_detachd_locked(d, false); 8476c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 8486c74ff0eSAlexander V. Chernikov } 8496c74ff0eSAlexander V. Chernikov 8506c74ff0eSAlexander V. Chernikov static void 851699281b5SAndrey V. Elsukov bpf_detachd_locked(struct bpf_d *d, bool detached_ifp) 8526c74ff0eSAlexander V. Chernikov { 853df8bae1dSRodney W. Grimes struct bpf_if *bp; 85446448b5aSRobert Watson struct ifnet *ifp; 855699281b5SAndrey V. Elsukov int error; 85651ec1eb7SAlexander V. Chernikov 857e4b3229aSAlexander V. Chernikov BPF_LOCK_ASSERT(); 858699281b5SAndrey V. Elsukov CTR2(KTR_NET, "%s: detach required by pid %d", __func__, d->bd_pid); 859e4b3229aSAlexander V. Chernikov 8606c74ff0eSAlexander V. Chernikov /* Check if descriptor is attached */ 8616c74ff0eSAlexander V. Chernikov if ((bp = d->bd_bif) == NULL) 8626c74ff0eSAlexander V. Chernikov return; 8636c74ff0eSAlexander V. Chernikov 864afa85850SAlexander V. Chernikov BPFD_LOCK(d); 865de253273SAndrey V. Elsukov /* Remove d from the interface's descriptor list. */ 866de253273SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 86751ec1eb7SAlexander V. Chernikov /* Save bd_writer value */ 86851ec1eb7SAlexander V. Chernikov error = d->bd_writer; 869e4b3229aSAlexander V. Chernikov ifp = bp->bif_ifp; 870572bde2aSRobert Watson d->bd_bif = NULL; 871699281b5SAndrey V. Elsukov if (detached_ifp) { 872699281b5SAndrey V. Elsukov /* 873699281b5SAndrey V. Elsukov * Notify descriptor as it's detached, so that any 874699281b5SAndrey V. Elsukov * sleepers wake up and get ENXIO. 875699281b5SAndrey V. Elsukov */ 876699281b5SAndrey V. Elsukov bpf_wakeup(d); 877699281b5SAndrey V. Elsukov } 878afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 879e4b3229aSAlexander V. Chernikov bpf_bpfd_cnt--; 88046448b5aSRobert Watson 88151ec1eb7SAlexander V. Chernikov /* Call event handler iff d is attached */ 88251ec1eb7SAlexander V. Chernikov if (error == 0) 8835ce8d970SSam Leffler EVENTHANDLER_INVOKE(bpf_track, ifp, bp->bif_dlt, 0); 884b743c310SSam Leffler 885df8bae1dSRodney W. Grimes /* 886df8bae1dSRodney W. Grimes * Check if this descriptor had requested promiscuous mode. 887699281b5SAndrey V. Elsukov * If so and ifnet is not detached, turn it off. 888df8bae1dSRodney W. Grimes */ 889699281b5SAndrey V. Elsukov if (d->bd_promisc && !detached_ifp) { 890df8bae1dSRodney W. Grimes d->bd_promisc = 0; 89197021c24SMarko Zec CURVNET_SET(ifp->if_vnet); 89246448b5aSRobert Watson error = ifpromisc(ifp, 0); 89397021c24SMarko Zec CURVNET_RESTORE(); 8946e891d64SPoul-Henning Kamp if (error != 0 && error != ENXIO) { 895df8bae1dSRodney W. Grimes /* 8966e891d64SPoul-Henning Kamp * ENXIO can happen if a pccard is unplugged 897df8bae1dSRodney W. Grimes * Something is really wrong if we were able to put 898df8bae1dSRodney W. Grimes * the driver into promiscuous mode, but can't 899df8bae1dSRodney W. Grimes * take it out. 900df8bae1dSRodney W. Grimes */ 9018eab61f3SSam Leffler if_printf(bp->bif_ifp, 9028eab61f3SSam Leffler "bpf_detach: ifpromisc failed (%d)\n", error); 9036e891d64SPoul-Henning Kamp } 904df8bae1dSRodney W. Grimes } 905699281b5SAndrey V. Elsukov bpfif_rele(bp); 906df8bae1dSRodney W. Grimes } 907df8bae1dSRodney W. Grimes 908df8bae1dSRodney W. Grimes /* 909136600feSEd Schouten * Close the descriptor by detaching it from its interface, 910136600feSEd Schouten * deallocating its buffers, and marking it free. 911136600feSEd Schouten */ 912136600feSEd Schouten static void 913136600feSEd Schouten bpf_dtor(void *data) 914136600feSEd Schouten { 915136600feSEd Schouten struct bpf_d *d = data; 916136600feSEd Schouten 917afa85850SAlexander V. Chernikov BPFD_LOCK(d); 918136600feSEd Schouten if (d->bd_state == BPF_WAITING) 919136600feSEd Schouten callout_stop(&d->bd_callout); 920136600feSEd Schouten d->bd_state = BPF_IDLE; 921afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 922136600feSEd Schouten funsetown(&d->bd_sigio); 923136600feSEd Schouten bpf_detachd(d); 924136600feSEd Schouten #ifdef MAC 925136600feSEd Schouten mac_bpfdesc_destroy(d); 926136600feSEd Schouten #endif /* MAC */ 9276aba400aSAttilio Rao seldrain(&d->bd_sel); 928136600feSEd Schouten knlist_destroy(&d->bd_sel.si_note); 9299fee1bd1SJung-uk Kim callout_drain(&d->bd_callout); 930699281b5SAndrey V. Elsukov bpfd_rele(d); 931136600feSEd Schouten } 932136600feSEd Schouten 933136600feSEd Schouten /* 934df8bae1dSRodney W. Grimes * Open ethernet device. Returns ENXIO for illegal minor device number, 935df8bae1dSRodney W. Grimes * EBUSY if file is open by another process. 936df8bae1dSRodney W. Grimes */ 937df8bae1dSRodney W. Grimes /* ARGSUSED */ 93887f6c662SJulian Elischer static int 93919ba8395SChristian S.J. Peron bpfopen(struct cdev *dev, int flags, int fmt, struct thread *td) 940df8bae1dSRodney W. Grimes { 941e7bb21b3SJonathan Lemon struct bpf_d *d; 9424f42daa4SLuiz Otavio O Souza int error; 943df8bae1dSRodney W. Grimes 9441ede983cSDag-Erling Smørgrav d = malloc(sizeof(*d), M_BPF, M_WAITOK | M_ZERO); 945136600feSEd Schouten error = devfs_set_cdevpriv(d, bpf_dtor); 946136600feSEd Schouten if (error != 0) { 947136600feSEd Schouten free(d, M_BPF); 948136600feSEd Schouten return (error); 949136600feSEd Schouten } 9504d621040SChristian S.J. Peron 951b2b7ca49SAlexander V. Chernikov /* Setup counters */ 952b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_alloc(M_WAITOK); 953b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_alloc(M_WAITOK); 954b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_alloc(M_WAITOK); 955b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_alloc(M_WAITOK); 956b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_alloc(M_WAITOK); 957b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_alloc(M_WAITOK); 958b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_alloc(M_WAITOK); 959b2b7ca49SAlexander V. Chernikov 9604d621040SChristian S.J. Peron /* 9614d621040SChristian S.J. Peron * For historical reasons, perform a one-time initialization call to 9624d621040SChristian S.J. Peron * the buffer routines, even though we're not yet committed to a 9634d621040SChristian S.J. Peron * particular buffer method. 9644d621040SChristian S.J. Peron */ 9654d621040SChristian S.J. Peron bpf_buffer_init(d); 96671448753SAlexander Motin if ((flags & FREAD) == 0) 96771448753SAlexander Motin d->bd_writer = 2; 9683b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 9694d621040SChristian S.J. Peron d->bd_bufmode = BPF_BUFMODE_BUFFER; 97000a83887SPaul Traina d->bd_sig = SIGIO; 971560a54e1SJung-uk Kim d->bd_direction = BPF_D_INOUT; 972699281b5SAndrey V. Elsukov d->bd_refcnt = 1; 973e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 97482f4445dSRobert Watson #ifdef MAC 97530d239bcSRobert Watson mac_bpfdesc_init(d); 97630d239bcSRobert Watson mac_bpfdesc_create(td->td_ucred, d); 97782f4445dSRobert Watson #endif 978afa85850SAlexander V. Chernikov mtx_init(&d->bd_lock, devtoname(dev), "bpf cdev lock", MTX_DEF); 979afa85850SAlexander V. Chernikov callout_init_mtx(&d->bd_callout, &d->bd_lock, 0); 980afa85850SAlexander V. Chernikov knlist_init_mtx(&d->bd_sel.si_note, &d->bd_lock); 981df8bae1dSRodney W. Grimes 9821e7fe2fbSLuiz Otavio O Souza /* Disable VLAN pcp tagging. */ 9831e7fe2fbSLuiz Otavio O Souza d->bd_pcp = 0; 9841e7fe2fbSLuiz Otavio O Souza 985df8bae1dSRodney W. Grimes return (0); 986df8bae1dSRodney W. Grimes } 987df8bae1dSRodney W. Grimes 988df8bae1dSRodney W. Grimes /* 989df8bae1dSRodney W. Grimes * bpfread - read next chunk of packets from buffers 990df8bae1dSRodney W. Grimes */ 99187f6c662SJulian Elischer static int 99219ba8395SChristian S.J. Peron bpfread(struct cdev *dev, struct uio *uio, int ioflag) 993df8bae1dSRodney W. Grimes { 994136600feSEd Schouten struct bpf_d *d; 995df8bae1dSRodney W. Grimes int error; 9968df67d77SJung-uk Kim int non_block; 9978df67d77SJung-uk Kim int timed_out; 998df8bae1dSRodney W. Grimes 999136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1000136600feSEd Schouten if (error != 0) 1001136600feSEd Schouten return (error); 1002136600feSEd Schouten 1003df8bae1dSRodney W. Grimes /* 1004df8bae1dSRodney W. Grimes * Restrict application to use a buffer the same size as 1005df8bae1dSRodney W. Grimes * as kernel buffers. 1006df8bae1dSRodney W. Grimes */ 1007df8bae1dSRodney W. Grimes if (uio->uio_resid != d->bd_bufsize) 1008df8bae1dSRodney W. Grimes return (EINVAL); 1009df8bae1dSRodney W. Grimes 10108df67d77SJung-uk Kim non_block = ((ioflag & O_NONBLOCK) != 0); 10118df67d77SJung-uk Kim 1012afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1013e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 10144d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) { 1015afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 10164d621040SChristian S.J. Peron return (EOPNOTSUPP); 10174d621040SChristian S.J. Peron } 101881bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 101981bda851SJohn Polstra callout_stop(&d->bd_callout); 102081bda851SJohn Polstra timed_out = (d->bd_state == BPF_TIMED_OUT); 102181bda851SJohn Polstra d->bd_state = BPF_IDLE; 1022d013d902SGuy Helmer while (d->bd_hbuf_in_use) { 1023d013d902SGuy Helmer error = mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 10243b3b91e7SGuy Helmer PRINET|PCATCH, "bd_hbuf", 0); 1025d013d902SGuy Helmer if (error != 0) { 1026d013d902SGuy Helmer BPFD_UNLOCK(d); 1027d013d902SGuy Helmer return (error); 1028d013d902SGuy Helmer } 1029d013d902SGuy Helmer } 1030df8bae1dSRodney W. Grimes /* 1031df8bae1dSRodney W. Grimes * If the hold buffer is empty, then do a timed sleep, which 1032df8bae1dSRodney W. Grimes * ends when the timeout expires or when enough packets 1033df8bae1dSRodney W. Grimes * have arrived to fill the store buffer. 1034df8bae1dSRodney W. Grimes */ 1035572bde2aSRobert Watson while (d->bd_hbuf == NULL) { 10368df67d77SJung-uk Kim if (d->bd_slen != 0) { 1037df8bae1dSRodney W. Grimes /* 1038df8bae1dSRodney W. Grimes * A packet(s) either arrived since the previous 1039df8bae1dSRodney W. Grimes * read or arrived while we were asleep. 10408df67d77SJung-uk Kim */ 10418df67d77SJung-uk Kim if (d->bd_immediate || non_block || timed_out) { 10428df67d77SJung-uk Kim /* 10438df67d77SJung-uk Kim * Rotate the buffers and return what's here 10448df67d77SJung-uk Kim * if we are in immediate mode, non-blocking 10458df67d77SJung-uk Kim * flag is set, or this descriptor timed out. 1046df8bae1dSRodney W. Grimes */ 1047df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1048df8bae1dSRodney W. Grimes break; 1049df8bae1dSRodney W. Grimes } 10508df67d77SJung-uk Kim } 1051de5d9935SRobert Watson 1052de5d9935SRobert Watson /* 1053de5d9935SRobert Watson * No data is available, check to see if the bpf device 1054de5d9935SRobert Watson * is still pointed at a real interface. If not, return 1055de5d9935SRobert Watson * ENXIO so that the userland process knows to rebind 1056de5d9935SRobert Watson * it before using it again. 1057de5d9935SRobert Watson */ 1058de5d9935SRobert Watson if (d->bd_bif == NULL) { 1059afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1060de5d9935SRobert Watson return (ENXIO); 1061de5d9935SRobert Watson } 1062de5d9935SRobert Watson 10638df67d77SJung-uk Kim if (non_block) { 1064afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1065fba3cfdeSJohn Polstra return (EWOULDBLOCK); 1066fba3cfdeSJohn Polstra } 1067afa85850SAlexander V. Chernikov error = msleep(d, &d->bd_lock, PRINET|PCATCH, 1068e7bb21b3SJonathan Lemon "bpf", d->bd_rtout); 1069df8bae1dSRodney W. Grimes if (error == EINTR || error == ERESTART) { 1070afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1071df8bae1dSRodney W. Grimes return (error); 1072df8bae1dSRodney W. Grimes } 1073df8bae1dSRodney W. Grimes if (error == EWOULDBLOCK) { 1074df8bae1dSRodney W. Grimes /* 1075df8bae1dSRodney W. Grimes * On a timeout, return what's in the buffer, 1076df8bae1dSRodney W. Grimes * which may be nothing. If there is something 1077df8bae1dSRodney W. Grimes * in the store buffer, we can rotate the buffers. 1078df8bae1dSRodney W. Grimes */ 1079df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1080df8bae1dSRodney W. Grimes /* 1081df8bae1dSRodney W. Grimes * We filled up the buffer in between 1082df8bae1dSRodney W. Grimes * getting the timeout and arriving 1083df8bae1dSRodney W. Grimes * here, so we don't need to rotate. 1084df8bae1dSRodney W. Grimes */ 1085df8bae1dSRodney W. Grimes break; 1086df8bae1dSRodney W. Grimes 1087df8bae1dSRodney W. Grimes if (d->bd_slen == 0) { 1088afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1089df8bae1dSRodney W. Grimes return (0); 1090df8bae1dSRodney W. Grimes } 1091df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1092df8bae1dSRodney W. Grimes break; 1093df8bae1dSRodney W. Grimes } 1094df8bae1dSRodney W. Grimes } 1095df8bae1dSRodney W. Grimes /* 1096df8bae1dSRodney W. Grimes * At this point, we know we have something in the hold slot. 1097df8bae1dSRodney W. Grimes */ 10983b3b91e7SGuy Helmer d->bd_hbuf_in_use = 1; 1099afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1100df8bae1dSRodney W. Grimes 1101df8bae1dSRodney W. Grimes /* 1102df8bae1dSRodney W. Grimes * Move data from hold buffer into user space. 1103df8bae1dSRodney W. Grimes * We know the entire buffer is transferred since 1104df8bae1dSRodney W. Grimes * we checked above that the read buffer is bpf_bufsize bytes. 110531b32e6dSRobert Watson * 11063b3b91e7SGuy Helmer * We do not have to worry about simultaneous reads because 11073b3b91e7SGuy Helmer * we waited for sole access to the hold buffer above. 1108df8bae1dSRodney W. Grimes */ 11094d621040SChristian S.J. Peron error = bpf_uiomove(d, d->bd_hbuf, d->bd_hlen, uio); 1110df8bae1dSRodney W. Grimes 1111afa85850SAlexander V. Chernikov BPFD_LOCK(d); 11123b3b91e7SGuy Helmer KASSERT(d->bd_hbuf != NULL, ("bpfread: lost bd_hbuf")); 1113df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1114572bde2aSRobert Watson d->bd_hbuf = NULL; 1115df8bae1dSRodney W. Grimes d->bd_hlen = 0; 111629f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 11173b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 11183b3b91e7SGuy Helmer wakeup(&d->bd_hbuf_in_use); 1119afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1120df8bae1dSRodney W. Grimes 1121df8bae1dSRodney W. Grimes return (error); 1122df8bae1dSRodney W. Grimes } 1123df8bae1dSRodney W. Grimes 1124df8bae1dSRodney W. Grimes /* 1125df8bae1dSRodney W. Grimes * If there are processes sleeping on this descriptor, wake them up. 1126df8bae1dSRodney W. Grimes */ 1127e7bb21b3SJonathan Lemon static __inline void 112819ba8395SChristian S.J. Peron bpf_wakeup(struct bpf_d *d) 1129df8bae1dSRodney W. Grimes { 1130a3272e3cSChristian S.J. Peron 1131afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 113281bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 113381bda851SJohn Polstra callout_stop(&d->bd_callout); 113481bda851SJohn Polstra d->bd_state = BPF_IDLE; 113581bda851SJohn Polstra } 1136521f364bSDag-Erling Smørgrav wakeup(d); 1137831d27a9SDon Lewis if (d->bd_async && d->bd_sig && d->bd_sigio) 1138f1320723SAlfred Perlstein pgsigio(&d->bd_sigio, d->bd_sig, 0); 113900a83887SPaul Traina 1140512824f8SSeigo Tanimura selwakeuppri(&d->bd_sel, PRINET); 1141ad3b9257SJohn-Mark Gurney KNOTE_LOCKED(&d->bd_sel.si_note, 0); 1142df8bae1dSRodney W. Grimes } 1143df8bae1dSRodney W. Grimes 114481bda851SJohn Polstra static void 114519ba8395SChristian S.J. Peron bpf_timed_out(void *arg) 114681bda851SJohn Polstra { 114781bda851SJohn Polstra struct bpf_d *d = (struct bpf_d *)arg; 114881bda851SJohn Polstra 1149afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11509fee1bd1SJung-uk Kim 1151699281b5SAndrey V. Elsukov if (callout_pending(&d->bd_callout) || 1152699281b5SAndrey V. Elsukov !callout_active(&d->bd_callout)) 11539fee1bd1SJung-uk Kim return; 115481bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 115581bda851SJohn Polstra d->bd_state = BPF_TIMED_OUT; 115681bda851SJohn Polstra if (d->bd_slen != 0) 115781bda851SJohn Polstra bpf_wakeup(d); 115881bda851SJohn Polstra } 115981bda851SJohn Polstra } 116081bda851SJohn Polstra 116187f6c662SJulian Elischer static int 11624d621040SChristian S.J. Peron bpf_ready(struct bpf_d *d) 11634d621040SChristian S.J. Peron { 11644d621040SChristian S.J. Peron 1165afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11664d621040SChristian S.J. Peron 11674d621040SChristian S.J. Peron if (!bpf_canfreebuf(d) && d->bd_hlen != 0) 11684d621040SChristian S.J. Peron return (1); 11694d621040SChristian S.J. Peron if ((d->bd_immediate || d->bd_state == BPF_TIMED_OUT) && 11704d621040SChristian S.J. Peron d->bd_slen != 0) 11714d621040SChristian S.J. Peron return (1); 11724d621040SChristian S.J. Peron return (0); 11734d621040SChristian S.J. Peron } 11744d621040SChristian S.J. Peron 11754d621040SChristian S.J. Peron static int 117619ba8395SChristian S.J. Peron bpfwrite(struct cdev *dev, struct uio *uio, int ioflag) 1177df8bae1dSRodney W. Grimes { 1178699281b5SAndrey V. Elsukov struct route ro; 1179699281b5SAndrey V. Elsukov struct sockaddr dst; 1180699281b5SAndrey V. Elsukov struct epoch_tracker et; 1181699281b5SAndrey V. Elsukov struct bpf_if *bp; 1182136600feSEd Schouten struct bpf_d *d; 1183df8bae1dSRodney W. Grimes struct ifnet *ifp; 1184560a54e1SJung-uk Kim struct mbuf *m, *mc; 1185560a54e1SJung-uk Kim int error, hlen; 1186df8bae1dSRodney W. Grimes 1187136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1188136600feSEd Schouten if (error != 0) 1189136600feSEd Schouten return (error); 1190136600feSEd Schouten 1191699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 1192699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1193e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 1194b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wcount, 1); 1195699281b5SAndrey V. Elsukov if ((bp = d->bd_bif) == NULL) { 1196699281b5SAndrey V. Elsukov error = ENXIO; 1197699281b5SAndrey V. Elsukov goto out_locked; 11984d621040SChristian S.J. Peron } 1199df8bae1dSRodney W. Grimes 1200699281b5SAndrey V. Elsukov ifp = bp->bif_ifp; 12014d621040SChristian S.J. Peron if ((ifp->if_flags & IFF_UP) == 0) { 1202699281b5SAndrey V. Elsukov error = ENETDOWN; 1203699281b5SAndrey V. Elsukov goto out_locked; 12044d621040SChristian S.J. Peron } 12053518d220SSam Leffler 1206699281b5SAndrey V. Elsukov if (uio->uio_resid == 0) 1207699281b5SAndrey V. Elsukov goto out_locked; 1208df8bae1dSRodney W. Grimes 12098240bf1eSRobert Watson bzero(&dst, sizeof(dst)); 1210d83e603aSChristian S.J. Peron m = NULL; 1211d83e603aSChristian S.J. Peron hlen = 0; 1212699281b5SAndrey V. Elsukov 1213699281b5SAndrey V. Elsukov /* 1214699281b5SAndrey V. Elsukov * Take extra reference, unlock d and exit from epoch section, 1215699281b5SAndrey V. Elsukov * since bpf_movein() can sleep. 1216699281b5SAndrey V. Elsukov */ 1217699281b5SAndrey V. Elsukov bpfd_ref(d); 1218699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1219699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1220699281b5SAndrey V. Elsukov 1221699281b5SAndrey V. Elsukov error = bpf_movein(uio, (int)bp->bif_dlt, ifp, 12224fb3a820SAlexander V. Chernikov &m, &dst, &hlen, d); 1223699281b5SAndrey V. Elsukov 1224699281b5SAndrey V. Elsukov if (error != 0) { 1225b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1226699281b5SAndrey V. Elsukov bpfd_rele(d); 1227df8bae1dSRodney W. Grimes return (error); 12284d621040SChristian S.J. Peron } 1229699281b5SAndrey V. Elsukov 1230699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1231699281b5SAndrey V. Elsukov /* 1232699281b5SAndrey V. Elsukov * Check that descriptor is still attached to the interface. 1233699281b5SAndrey V. Elsukov * This can happen on bpfdetach(). To avoid access to detached 1234699281b5SAndrey V. Elsukov * ifnet, free mbuf and return ENXIO. 1235699281b5SAndrey V. Elsukov */ 1236699281b5SAndrey V. Elsukov if (d->bd_bif == NULL) { 1237699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1238699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1239699281b5SAndrey V. Elsukov bpfd_rele(d); 1240699281b5SAndrey V. Elsukov m_freem(m); 1241699281b5SAndrey V. Elsukov return (ENXIO); 1242699281b5SAndrey V. Elsukov } 1243b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wfcount, 1); 1244114ae644SMike Smith if (d->bd_hdrcmplt) 1245114ae644SMike Smith dst.sa_family = pseudo_AF_HDRCMPLT; 1246114ae644SMike Smith 1247560a54e1SJung-uk Kim if (d->bd_feedback) { 1248eb1b1807SGleb Smirnoff mc = m_dup(m, M_NOWAIT); 1249560a54e1SJung-uk Kim if (mc != NULL) 1250560a54e1SJung-uk Kim mc->m_pkthdr.rcvif = ifp; 12518cd892f7SJung-uk Kim /* Set M_PROMISC for outgoing packets to be discarded. */ 12528cd892f7SJung-uk Kim if (d->bd_direction == BPF_D_INOUT) 12538cd892f7SJung-uk Kim m->m_flags |= M_PROMISC; 1254560a54e1SJung-uk Kim } else 1255560a54e1SJung-uk Kim mc = NULL; 1256560a54e1SJung-uk Kim 1257560a54e1SJung-uk Kim m->m_pkthdr.len -= hlen; 1258560a54e1SJung-uk Kim m->m_len -= hlen; 1259560a54e1SJung-uk Kim m->m_data += hlen; /* XXX */ 1260560a54e1SJung-uk Kim 126121ca7b57SMarko Zec CURVNET_SET(ifp->if_vnet); 126282f4445dSRobert Watson #ifdef MAC 126330d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, m); 1264560a54e1SJung-uk Kim if (mc != NULL) 126530d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, mc); 126682f4445dSRobert Watson #endif 1267560a54e1SJung-uk Kim 12684fb3a820SAlexander V. Chernikov bzero(&ro, sizeof(ro)); 12694fb3a820SAlexander V. Chernikov if (hlen != 0) { 12704fb3a820SAlexander V. Chernikov ro.ro_prepend = (u_char *)&dst.sa_data; 12714fb3a820SAlexander V. Chernikov ro.ro_plen = hlen; 12724fb3a820SAlexander V. Chernikov ro.ro_flags = RT_HAS_HEADER; 12734fb3a820SAlexander V. Chernikov } 12744fb3a820SAlexander V. Chernikov 12751e7fe2fbSLuiz Otavio O Souza if (d->bd_pcp != 0) 12769ef8cd0bSKristof Provost vlan_set_pcp(m, d->bd_pcp); 12771e7fe2fbSLuiz Otavio O Souza 127882d7bf6bSAndrey V. Elsukov /* Avoid possible recursion on BPFD_LOCK(). */ 127982d7bf6bSAndrey V. Elsukov NET_EPOCH_ENTER(et); 128082d7bf6bSAndrey V. Elsukov BPFD_UNLOCK(d); 12814fb3a820SAlexander V. Chernikov error = (*ifp->if_output)(ifp, m, &dst, &ro); 12824d621040SChristian S.J. Peron if (error) 1283b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1284560a54e1SJung-uk Kim 1285560a54e1SJung-uk Kim if (mc != NULL) { 12860bf686c1SRobert Watson if (error == 0) 1287560a54e1SJung-uk Kim (*ifp->if_input)(ifp, mc); 12880bf686c1SRobert Watson else 1289560a54e1SJung-uk Kim m_freem(mc); 1290560a54e1SJung-uk Kim } 129182d7bf6bSAndrey V. Elsukov NET_EPOCH_EXIT(et); 129221ca7b57SMarko Zec CURVNET_RESTORE(); 1293699281b5SAndrey V. Elsukov bpfd_rele(d); 1294699281b5SAndrey V. Elsukov return (error); 1295560a54e1SJung-uk Kim 1296699281b5SAndrey V. Elsukov out_locked: 1297699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1298699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1299699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1300df8bae1dSRodney W. Grimes return (error); 1301df8bae1dSRodney W. Grimes } 1302df8bae1dSRodney W. Grimes 1303df8bae1dSRodney W. Grimes /* 1304e82669d9SRobert Watson * Reset a descriptor by flushing its packet buffer and clearing the receive 1305e82669d9SRobert Watson * and drop counts. This is doable for kernel-only buffers, but with 1306e82669d9SRobert Watson * zero-copy buffers, we can't write to (or rotate) buffers that are 1307e82669d9SRobert Watson * currently owned by userspace. It would be nice if we could encapsulate 1308e82669d9SRobert Watson * this logic in the buffer code rather than here. 1309df8bae1dSRodney W. Grimes */ 1310df8bae1dSRodney W. Grimes static void 131119ba8395SChristian S.J. Peron reset_d(struct bpf_d *d) 1312df8bae1dSRodney W. Grimes { 1313e7bb21b3SJonathan Lemon 1314afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 1315e82669d9SRobert Watson 13163b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 13173b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, PRINET, 13183b3b91e7SGuy Helmer "bd_hbuf", 0); 1319e82669d9SRobert Watson if ((d->bd_hbuf != NULL) && 1320e82669d9SRobert Watson (d->bd_bufmode != BPF_BUFMODE_ZBUF || bpf_canfreebuf(d))) { 1321df8bae1dSRodney W. Grimes /* Free the hold buffer. */ 1322df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1323572bde2aSRobert Watson d->bd_hbuf = NULL; 1324e82669d9SRobert Watson d->bd_hlen = 0; 132529f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 1326df8bae1dSRodney W. Grimes } 1327e82669d9SRobert Watson if (bpf_canwritebuf(d)) 1328df8bae1dSRodney W. Grimes d->bd_slen = 0; 1329b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_rcount); 1330b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_dcount); 1331b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_fcount); 1332b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wcount); 1333b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wfcount); 1334b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wdcount); 1335b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_zcopy); 1336df8bae1dSRodney W. Grimes } 1337df8bae1dSRodney W. Grimes 1338df8bae1dSRodney W. Grimes /* 1339df8bae1dSRodney W. Grimes * FIONREAD Check for read packet available. 1340df8bae1dSRodney W. Grimes * BIOCGBLEN Get buffer len [for read()]. 1341f11c3508SDavid Malone * BIOCSETF Set read filter. 1342f11c3508SDavid Malone * BIOCSETFNR Set read filter without resetting descriptor. 1343f11c3508SDavid Malone * BIOCSETWF Set write filter. 1344df8bae1dSRodney W. Grimes * BIOCFLUSH Flush read packet buffer. 1345df8bae1dSRodney W. Grimes * BIOCPROMISC Put interface into promiscuous mode. 1346df8bae1dSRodney W. Grimes * BIOCGDLT Get link layer type. 1347df8bae1dSRodney W. Grimes * BIOCGETIF Get interface name. 1348df8bae1dSRodney W. Grimes * BIOCSETIF Set interface. 1349df8bae1dSRodney W. Grimes * BIOCSRTIMEOUT Set read timeout. 1350df8bae1dSRodney W. Grimes * BIOCGRTIMEOUT Get read timeout. 1351df8bae1dSRodney W. Grimes * BIOCGSTATS Get packet stats. 1352df8bae1dSRodney W. Grimes * BIOCIMMEDIATE Set immediate mode. 1353df8bae1dSRodney W. Grimes * BIOCVERSION Get filter language version. 1354114ae644SMike Smith * BIOCGHDRCMPLT Get "header already complete" flag 1355114ae644SMike Smith * BIOCSHDRCMPLT Set "header already complete" flag 1356560a54e1SJung-uk Kim * BIOCGDIRECTION Get packet direction flag 1357560a54e1SJung-uk Kim * BIOCSDIRECTION Set packet direction flag 1358547d94bdSJung-uk Kim * BIOCGTSTAMP Get time stamp format and resolution. 1359547d94bdSJung-uk Kim * BIOCSTSTAMP Set time stamp format and resolution. 136093e39f0bSChristian S.J. Peron * BIOCLOCK Set "locked" flag 1361560a54e1SJung-uk Kim * BIOCFEEDBACK Set packet feedback mode. 13624d621040SChristian S.J. Peron * BIOCSETZBUF Set current zero-copy buffer locations. 13634d621040SChristian S.J. Peron * BIOCGETZMAX Get maximum zero-copy buffer size. 13644d621040SChristian S.J. Peron * BIOCROTZBUF Force rotation of zero-copy buffer 13654d621040SChristian S.J. Peron * BIOCSETBUFMODE Set buffer mode. 13664d621040SChristian S.J. Peron * BIOCGETBUFMODE Get current buffer mode. 13671e7fe2fbSLuiz Otavio O Souza * BIOCSETVLANPCP Set VLAN PCP tag. 1368df8bae1dSRodney W. Grimes */ 1369df8bae1dSRodney W. Grimes /* ARGSUSED */ 137087f6c662SJulian Elischer static int 137119ba8395SChristian S.J. Peron bpfioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, 137219ba8395SChristian S.J. Peron struct thread *td) 1373df8bae1dSRodney W. Grimes { 1374136600feSEd Schouten struct bpf_d *d; 1375136600feSEd Schouten int error; 1376136600feSEd Schouten 1377136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1378136600feSEd Schouten if (error != 0) 1379136600feSEd Schouten return (error); 1380df8bae1dSRodney W. Grimes 1381b75a24a0SChristian S.J. Peron /* 1382b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 1383b75a24a0SChristian S.J. Peron */ 1384afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1385e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 138681bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 138781bda851SJohn Polstra callout_stop(&d->bd_callout); 138881bda851SJohn Polstra d->bd_state = BPF_IDLE; 1389afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 139081bda851SJohn Polstra 139193e39f0bSChristian S.J. Peron if (d->bd_locked == 1) { 139293e39f0bSChristian S.J. Peron switch (cmd) { 139393e39f0bSChristian S.J. Peron case BIOCGBLEN: 139493e39f0bSChristian S.J. Peron case BIOCFLUSH: 139593e39f0bSChristian S.J. Peron case BIOCGDLT: 139693e39f0bSChristian S.J. Peron case BIOCGDLTLIST: 1397fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1398fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1399fc0a61a4SKonstantin Belousov #endif 140093e39f0bSChristian S.J. Peron case BIOCGETIF: 140193e39f0bSChristian S.J. Peron case BIOCGRTIMEOUT: 1402b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1403fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1404fc0a61a4SKonstantin Belousov #endif 140593e39f0bSChristian S.J. Peron case BIOCGSTATS: 140693e39f0bSChristian S.J. Peron case BIOCVERSION: 140793e39f0bSChristian S.J. Peron case BIOCGRSIG: 140893e39f0bSChristian S.J. Peron case BIOCGHDRCMPLT: 1409547d94bdSJung-uk Kim case BIOCSTSTAMP: 1410560a54e1SJung-uk Kim case BIOCFEEDBACK: 141193e39f0bSChristian S.J. Peron case FIONREAD: 141293e39f0bSChristian S.J. Peron case BIOCLOCK: 141393e39f0bSChristian S.J. Peron case BIOCSRTIMEOUT: 1414b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1415fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1416fc0a61a4SKonstantin Belousov #endif 141793e39f0bSChristian S.J. Peron case BIOCIMMEDIATE: 141893e39f0bSChristian S.J. Peron case TIOCGPGRP: 14194d621040SChristian S.J. Peron case BIOCROTZBUF: 142093e39f0bSChristian S.J. Peron break; 142193e39f0bSChristian S.J. Peron default: 142293e39f0bSChristian S.J. Peron return (EPERM); 142393e39f0bSChristian S.J. Peron } 142493e39f0bSChristian S.J. Peron } 1425fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1426fc0a61a4SKonstantin Belousov /* 1427fc0a61a4SKonstantin Belousov * If we see a 32-bit compat ioctl, mark the stream as 32-bit so 1428fc0a61a4SKonstantin Belousov * that it will get 32-bit packet headers. 1429fc0a61a4SKonstantin Belousov */ 1430fc0a61a4SKonstantin Belousov switch (cmd) { 1431fc0a61a4SKonstantin Belousov case BIOCSETF32: 1432fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1433fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1434fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1435fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1436fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 143774549d4bSWojciech Macek if (SV_PROC_FLAG(td->td_proc, SV_ILP32)) { 143897aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1439fc0a61a4SKonstantin Belousov d->bd_compat32 = 1; 144097aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1441fc0a61a4SKonstantin Belousov } 144274549d4bSWojciech Macek } 1443fc0a61a4SKonstantin Belousov #endif 1444fc0a61a4SKonstantin Belousov 144597021c24SMarko Zec CURVNET_SET(TD_TO_VNET(td)); 1446df8bae1dSRodney W. Grimes switch (cmd) { 1447df8bae1dSRodney W. Grimes default: 1448df8bae1dSRodney W. Grimes error = EINVAL; 1449df8bae1dSRodney W. Grimes break; 1450df8bae1dSRodney W. Grimes 1451df8bae1dSRodney W. Grimes /* 1452df8bae1dSRodney W. Grimes * Check for read packet available. 1453df8bae1dSRodney W. Grimes */ 1454df8bae1dSRodney W. Grimes case FIONREAD: 1455df8bae1dSRodney W. Grimes { 1456df8bae1dSRodney W. Grimes int n; 1457df8bae1dSRodney W. Grimes 1458afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1459df8bae1dSRodney W. Grimes n = d->bd_slen; 14603b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 14613b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 14623b3b91e7SGuy Helmer PRINET, "bd_hbuf", 0); 1463df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1464df8bae1dSRodney W. Grimes n += d->bd_hlen; 1465afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1466df8bae1dSRodney W. Grimes 1467df8bae1dSRodney W. Grimes *(int *)addr = n; 1468df8bae1dSRodney W. Grimes break; 1469df8bae1dSRodney W. Grimes } 1470df8bae1dSRodney W. Grimes 1471df8bae1dSRodney W. Grimes /* 1472df8bae1dSRodney W. Grimes * Get buffer len [for read()]. 1473df8bae1dSRodney W. Grimes */ 1474df8bae1dSRodney W. Grimes case BIOCGBLEN: 147597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1476df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bufsize; 147797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1478df8bae1dSRodney W. Grimes break; 1479df8bae1dSRodney W. Grimes 1480df8bae1dSRodney W. Grimes /* 1481df8bae1dSRodney W. Grimes * Set buffer length. 1482df8bae1dSRodney W. Grimes */ 1483df8bae1dSRodney W. Grimes case BIOCSBLEN: 14844d621040SChristian S.J. Peron error = bpf_ioctl_sblen(d, (u_int *)addr); 1485df8bae1dSRodney W. Grimes break; 1486df8bae1dSRodney W. Grimes 1487df8bae1dSRodney W. Grimes /* 1488df8bae1dSRodney W. Grimes * Set link layer read filter. 1489df8bae1dSRodney W. Grimes */ 1490df8bae1dSRodney W. Grimes case BIOCSETF: 1491f11c3508SDavid Malone case BIOCSETFNR: 149293e39f0bSChristian S.J. Peron case BIOCSETWF: 1493fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1494fc0a61a4SKonstantin Belousov case BIOCSETF32: 1495fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1496fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1497fc0a61a4SKonstantin Belousov #endif 149893e39f0bSChristian S.J. Peron error = bpf_setf(d, (struct bpf_program *)addr, cmd); 1499df8bae1dSRodney W. Grimes break; 1500df8bae1dSRodney W. Grimes 1501df8bae1dSRodney W. Grimes /* 1502df8bae1dSRodney W. Grimes * Flush read packet buffer. 1503df8bae1dSRodney W. Grimes */ 1504df8bae1dSRodney W. Grimes case BIOCFLUSH: 1505afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1506df8bae1dSRodney W. Grimes reset_d(d); 1507afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1508df8bae1dSRodney W. Grimes break; 1509df8bae1dSRodney W. Grimes 1510df8bae1dSRodney W. Grimes /* 1511df8bae1dSRodney W. Grimes * Put interface into promiscuous mode. 1512df8bae1dSRodney W. Grimes */ 1513df8bae1dSRodney W. Grimes case BIOCPROMISC: 1514572bde2aSRobert Watson if (d->bd_bif == NULL) { 1515df8bae1dSRodney W. Grimes /* 1516df8bae1dSRodney W. Grimes * No interface attached yet. 1517df8bae1dSRodney W. Grimes */ 1518df8bae1dSRodney W. Grimes error = EINVAL; 1519df8bae1dSRodney W. Grimes break; 1520df8bae1dSRodney W. Grimes } 1521df8bae1dSRodney W. Grimes if (d->bd_promisc == 0) { 1522df8bae1dSRodney W. Grimes error = ifpromisc(d->bd_bif->bif_ifp, 1); 1523df8bae1dSRodney W. Grimes if (error == 0) 1524df8bae1dSRodney W. Grimes d->bd_promisc = 1; 1525df8bae1dSRodney W. Grimes } 1526df8bae1dSRodney W. Grimes break; 1527df8bae1dSRodney W. Grimes 1528df8bae1dSRodney W. Grimes /* 15298eab61f3SSam Leffler * Get current data link type. 1530df8bae1dSRodney W. Grimes */ 1531df8bae1dSRodney W. Grimes case BIOCGDLT: 153297aacec6SAlexander V. Chernikov BPF_LOCK(); 1533572bde2aSRobert Watson if (d->bd_bif == NULL) 1534df8bae1dSRodney W. Grimes error = EINVAL; 1535df8bae1dSRodney W. Grimes else 1536df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bif->bif_dlt; 153797aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1538df8bae1dSRodney W. Grimes break; 1539df8bae1dSRodney W. Grimes 1540df8bae1dSRodney W. Grimes /* 15418eab61f3SSam Leffler * Get a list of supported data link types. 15428eab61f3SSam Leffler */ 1543fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1544fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1545fc0a61a4SKonstantin Belousov { 1546fc0a61a4SKonstantin Belousov struct bpf_dltlist32 *list32; 1547fc0a61a4SKonstantin Belousov struct bpf_dltlist dltlist; 1548fc0a61a4SKonstantin Belousov 1549fc0a61a4SKonstantin Belousov list32 = (struct bpf_dltlist32 *)addr; 1550fc0a61a4SKonstantin Belousov dltlist.bfl_len = list32->bfl_len; 1551fc0a61a4SKonstantin Belousov dltlist.bfl_list = PTRIN(list32->bfl_list); 155297aacec6SAlexander V. Chernikov BPF_LOCK(); 1553fc0a61a4SKonstantin Belousov if (d->bd_bif == NULL) 1554fc0a61a4SKonstantin Belousov error = EINVAL; 1555fc0a61a4SKonstantin Belousov else { 1556fc0a61a4SKonstantin Belousov error = bpf_getdltlist(d, &dltlist); 1557fc0a61a4SKonstantin Belousov if (error == 0) 1558fc0a61a4SKonstantin Belousov list32->bfl_len = dltlist.bfl_len; 1559fc0a61a4SKonstantin Belousov } 156097aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1561fc0a61a4SKonstantin Belousov break; 1562fc0a61a4SKonstantin Belousov } 1563fc0a61a4SKonstantin Belousov #endif 1564fc0a61a4SKonstantin Belousov 15658eab61f3SSam Leffler case BIOCGDLTLIST: 156697aacec6SAlexander V. Chernikov BPF_LOCK(); 1567572bde2aSRobert Watson if (d->bd_bif == NULL) 15688eab61f3SSam Leffler error = EINVAL; 15698eab61f3SSam Leffler else 15708eab61f3SSam Leffler error = bpf_getdltlist(d, (struct bpf_dltlist *)addr); 157197aacec6SAlexander V. Chernikov BPF_UNLOCK(); 15728eab61f3SSam Leffler break; 15738eab61f3SSam Leffler 15748eab61f3SSam Leffler /* 15758eab61f3SSam Leffler * Set data link type. 15768eab61f3SSam Leffler */ 15778eab61f3SSam Leffler case BIOCSDLT: 15786c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1579572bde2aSRobert Watson if (d->bd_bif == NULL) 15808eab61f3SSam Leffler error = EINVAL; 15818eab61f3SSam Leffler else 15828eab61f3SSam Leffler error = bpf_setdlt(d, *(u_int *)addr); 15836c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 15848eab61f3SSam Leffler break; 15858eab61f3SSam Leffler 15868eab61f3SSam Leffler /* 15871dd0feaaSArchie Cobbs * Get interface name. 1588df8bae1dSRodney W. Grimes */ 1589df8bae1dSRodney W. Grimes case BIOCGETIF: 159097aacec6SAlexander V. Chernikov BPF_LOCK(); 1591572bde2aSRobert Watson if (d->bd_bif == NULL) 1592df8bae1dSRodney W. Grimes error = EINVAL; 15931dd0feaaSArchie Cobbs else { 15941dd0feaaSArchie Cobbs struct ifnet *const ifp = d->bd_bif->bif_ifp; 15951dd0feaaSArchie Cobbs struct ifreq *const ifr = (struct ifreq *)addr; 15961dd0feaaSArchie Cobbs 15979bf40edeSBrooks Davis strlcpy(ifr->ifr_name, ifp->if_xname, 15989bf40edeSBrooks Davis sizeof(ifr->ifr_name)); 15991dd0feaaSArchie Cobbs } 160097aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1601df8bae1dSRodney W. Grimes break; 1602df8bae1dSRodney W. Grimes 1603df8bae1dSRodney W. Grimes /* 1604df8bae1dSRodney W. Grimes * Set interface. 1605df8bae1dSRodney W. Grimes */ 1606df8bae1dSRodney W. Grimes case BIOCSETIF: 16074f42daa4SLuiz Otavio O Souza { 16084f42daa4SLuiz Otavio O Souza int alloc_buf, size; 16094f42daa4SLuiz Otavio O Souza 16104f42daa4SLuiz Otavio O Souza /* 16114f42daa4SLuiz Otavio O Souza * Behavior here depends on the buffering model. If 16124f42daa4SLuiz Otavio O Souza * we're using kernel memory buffers, then we can 16134f42daa4SLuiz Otavio O Souza * allocate them here. If we're using zero-copy, 16144f42daa4SLuiz Otavio O Souza * then the user process must have registered buffers 16154f42daa4SLuiz Otavio O Souza * by the time we get here. 16164f42daa4SLuiz Otavio O Souza */ 16174f42daa4SLuiz Otavio O Souza alloc_buf = 0; 16184f42daa4SLuiz Otavio O Souza BPFD_LOCK(d); 16194f42daa4SLuiz Otavio O Souza if (d->bd_bufmode == BPF_BUFMODE_BUFFER && 16204f42daa4SLuiz Otavio O Souza d->bd_sbuf == NULL) 16214f42daa4SLuiz Otavio O Souza alloc_buf = 1; 16224f42daa4SLuiz Otavio O Souza BPFD_UNLOCK(d); 16234f42daa4SLuiz Otavio O Souza if (alloc_buf) { 16244f42daa4SLuiz Otavio O Souza size = d->bd_bufsize; 16254f42daa4SLuiz Otavio O Souza error = bpf_buffer_ioctl_sblen(d, &size); 16264f42daa4SLuiz Otavio O Souza if (error != 0) 16274f42daa4SLuiz Otavio O Souza break; 16284f42daa4SLuiz Otavio O Souza } 16296c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1630df8bae1dSRodney W. Grimes error = bpf_setif(d, (struct ifreq *)addr); 16316c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 1632df8bae1dSRodney W. Grimes break; 16334f42daa4SLuiz Otavio O Souza } 1634df8bae1dSRodney W. Grimes 1635df8bae1dSRodney W. Grimes /* 1636df8bae1dSRodney W. Grimes * Set read timeout. 1637df8bae1dSRodney W. Grimes */ 1638df8bae1dSRodney W. Grimes case BIOCSRTIMEOUT: 1639b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1640fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1641fc0a61a4SKonstantin Belousov #endif 1642df8bae1dSRodney W. Grimes { 1643df8bae1dSRodney W. Grimes struct timeval *tv = (struct timeval *)addr; 16449624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__) 1645fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1646fc0a61a4SKonstantin Belousov struct timeval tv64; 1647fc0a61a4SKonstantin Belousov 1648fc0a61a4SKonstantin Belousov if (cmd == BIOCSRTIMEOUT32) { 1649fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1650fc0a61a4SKonstantin Belousov tv = &tv64; 1651fc0a61a4SKonstantin Belousov tv->tv_sec = tv32->tv_sec; 1652fc0a61a4SKonstantin Belousov tv->tv_usec = tv32->tv_usec; 1653fc0a61a4SKonstantin Belousov } else 1654fc0a61a4SKonstantin Belousov #endif 1655fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1656df8bae1dSRodney W. Grimes 1657bdc2cdc5SAlexander Langer /* 1658bdc2cdc5SAlexander Langer * Subtract 1 tick from tvtohz() since this isn't 1659bdc2cdc5SAlexander Langer * a one-shot timer. 1660bdc2cdc5SAlexander Langer */ 1661bdc2cdc5SAlexander Langer if ((error = itimerfix(tv)) == 0) 1662bdc2cdc5SAlexander Langer d->bd_rtout = tvtohz(tv) - 1; 1663df8bae1dSRodney W. Grimes break; 1664df8bae1dSRodney W. Grimes } 1665df8bae1dSRodney W. Grimes 1666df8bae1dSRodney W. Grimes /* 1667df8bae1dSRodney W. Grimes * Get read timeout. 1668df8bae1dSRodney W. Grimes */ 1669df8bae1dSRodney W. Grimes case BIOCGRTIMEOUT: 1670b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1671fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1672fc0a61a4SKonstantin Belousov #endif 1673df8bae1dSRodney W. Grimes { 1674fc0a61a4SKonstantin Belousov struct timeval *tv; 1675b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1676fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1677fc0a61a4SKonstantin Belousov struct timeval tv64; 1678fc0a61a4SKonstantin Belousov 1679fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) 1680fc0a61a4SKonstantin Belousov tv = &tv64; 1681fc0a61a4SKonstantin Belousov else 1682fc0a61a4SKonstantin Belousov #endif 1683fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1684df8bae1dSRodney W. Grimes 1685bdc2cdc5SAlexander Langer tv->tv_sec = d->bd_rtout / hz; 1686bdc2cdc5SAlexander Langer tv->tv_usec = (d->bd_rtout % hz) * tick; 1687b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1688fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) { 1689fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1690fc0a61a4SKonstantin Belousov tv32->tv_sec = tv->tv_sec; 1691fc0a61a4SKonstantin Belousov tv32->tv_usec = tv->tv_usec; 1692fc0a61a4SKonstantin Belousov } 1693fc0a61a4SKonstantin Belousov #endif 1694fc0a61a4SKonstantin Belousov 1695df8bae1dSRodney W. Grimes break; 1696df8bae1dSRodney W. Grimes } 1697df8bae1dSRodney W. Grimes 1698df8bae1dSRodney W. Grimes /* 1699df8bae1dSRodney W. Grimes * Get packet stats. 1700df8bae1dSRodney W. Grimes */ 1701df8bae1dSRodney W. Grimes case BIOCGSTATS: 1702df8bae1dSRodney W. Grimes { 1703df8bae1dSRodney W. Grimes struct bpf_stat *bs = (struct bpf_stat *)addr; 1704df8bae1dSRodney W. Grimes 17054d621040SChristian S.J. Peron /* XXXCSJP overflow */ 1706b2b7ca49SAlexander V. Chernikov bs->bs_recv = (u_int)counter_u64_fetch(d->bd_rcount); 1707b2b7ca49SAlexander V. Chernikov bs->bs_drop = (u_int)counter_u64_fetch(d->bd_dcount); 1708df8bae1dSRodney W. Grimes break; 1709df8bae1dSRodney W. Grimes } 1710df8bae1dSRodney W. Grimes 1711df8bae1dSRodney W. Grimes /* 1712df8bae1dSRodney W. Grimes * Set immediate mode. 1713df8bae1dSRodney W. Grimes */ 1714df8bae1dSRodney W. Grimes case BIOCIMMEDIATE: 171597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1716df8bae1dSRodney W. Grimes d->bd_immediate = *(u_int *)addr; 171797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1718df8bae1dSRodney W. Grimes break; 1719df8bae1dSRodney W. Grimes 1720df8bae1dSRodney W. Grimes case BIOCVERSION: 1721df8bae1dSRodney W. Grimes { 1722df8bae1dSRodney W. Grimes struct bpf_version *bv = (struct bpf_version *)addr; 1723df8bae1dSRodney W. Grimes 1724df8bae1dSRodney W. Grimes bv->bv_major = BPF_MAJOR_VERSION; 1725df8bae1dSRodney W. Grimes bv->bv_minor = BPF_MINOR_VERSION; 1726df8bae1dSRodney W. Grimes break; 1727df8bae1dSRodney W. Grimes } 172800a83887SPaul Traina 1729114ae644SMike Smith /* 1730114ae644SMike Smith * Get "header already complete" flag 1731114ae644SMike Smith */ 1732114ae644SMike Smith case BIOCGHDRCMPLT: 173397aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1734114ae644SMike Smith *(u_int *)addr = d->bd_hdrcmplt; 173597aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1736114ae644SMike Smith break; 1737114ae644SMike Smith 1738114ae644SMike Smith /* 1739114ae644SMike Smith * Set "header already complete" flag 1740114ae644SMike Smith */ 1741114ae644SMike Smith case BIOCSHDRCMPLT: 174297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1743114ae644SMike Smith d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0; 174497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1745114ae644SMike Smith break; 1746114ae644SMike Smith 17478ed3828cSRobert Watson /* 1748560a54e1SJung-uk Kim * Get packet direction flag 17498ed3828cSRobert Watson */ 1750560a54e1SJung-uk Kim case BIOCGDIRECTION: 175197aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1752560a54e1SJung-uk Kim *(u_int *)addr = d->bd_direction; 175397aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 17548ed3828cSRobert Watson break; 17558ed3828cSRobert Watson 17568ed3828cSRobert Watson /* 1757560a54e1SJung-uk Kim * Set packet direction flag 17588ed3828cSRobert Watson */ 1759560a54e1SJung-uk Kim case BIOCSDIRECTION: 1760560a54e1SJung-uk Kim { 1761560a54e1SJung-uk Kim u_int direction; 1762560a54e1SJung-uk Kim 1763560a54e1SJung-uk Kim direction = *(u_int *)addr; 1764560a54e1SJung-uk Kim switch (direction) { 1765560a54e1SJung-uk Kim case BPF_D_IN: 1766560a54e1SJung-uk Kim case BPF_D_INOUT: 1767560a54e1SJung-uk Kim case BPF_D_OUT: 176897aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1769560a54e1SJung-uk Kim d->bd_direction = direction; 177097aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1771560a54e1SJung-uk Kim break; 1772560a54e1SJung-uk Kim default: 1773560a54e1SJung-uk Kim error = EINVAL; 1774560a54e1SJung-uk Kim } 1775560a54e1SJung-uk Kim } 1776560a54e1SJung-uk Kim break; 1777560a54e1SJung-uk Kim 1778547d94bdSJung-uk Kim /* 1779d0d7bcdfSJung-uk Kim * Get packet timestamp format and resolution. 1780547d94bdSJung-uk Kim */ 1781547d94bdSJung-uk Kim case BIOCGTSTAMP: 178297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1783547d94bdSJung-uk Kim *(u_int *)addr = d->bd_tstamp; 178497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1785547d94bdSJung-uk Kim break; 1786547d94bdSJung-uk Kim 1787547d94bdSJung-uk Kim /* 1788547d94bdSJung-uk Kim * Set packet timestamp format and resolution. 1789547d94bdSJung-uk Kim */ 1790547d94bdSJung-uk Kim case BIOCSTSTAMP: 1791547d94bdSJung-uk Kim { 1792547d94bdSJung-uk Kim u_int func; 1793547d94bdSJung-uk Kim 1794547d94bdSJung-uk Kim func = *(u_int *)addr; 1795547d94bdSJung-uk Kim if (BPF_T_VALID(func)) 1796547d94bdSJung-uk Kim d->bd_tstamp = func; 1797547d94bdSJung-uk Kim else 1798547d94bdSJung-uk Kim error = EINVAL; 1799547d94bdSJung-uk Kim } 1800547d94bdSJung-uk Kim break; 1801547d94bdSJung-uk Kim 1802560a54e1SJung-uk Kim case BIOCFEEDBACK: 180397aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1804560a54e1SJung-uk Kim d->bd_feedback = *(u_int *)addr; 180597aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1806560a54e1SJung-uk Kim break; 1807560a54e1SJung-uk Kim 1808560a54e1SJung-uk Kim case BIOCLOCK: 180997aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1810560a54e1SJung-uk Kim d->bd_locked = 1; 181197aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18128ed3828cSRobert Watson break; 18138ed3828cSRobert Watson 181400a83887SPaul Traina case FIONBIO: /* Non-blocking I/O */ 181500a83887SPaul Traina break; 181600a83887SPaul Traina 181700a83887SPaul Traina case FIOASYNC: /* Send signal on receive packets */ 181897aacec6SAlexander V. Chernikov BPFD_LOCK(d); 181900a83887SPaul Traina d->bd_async = *(int *)addr; 182097aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 182100a83887SPaul Traina break; 182200a83887SPaul Traina 1823831d27a9SDon Lewis case FIOSETOWN: 182497aacec6SAlexander V. Chernikov /* 182597aacec6SAlexander V. Chernikov * XXX: Add some sort of locking here? 182697aacec6SAlexander V. Chernikov * fsetown() can sleep. 182797aacec6SAlexander V. Chernikov */ 1828831d27a9SDon Lewis error = fsetown(*(int *)addr, &d->bd_sigio); 182900a83887SPaul Traina break; 183000a83887SPaul Traina 1831831d27a9SDon Lewis case FIOGETOWN: 183297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 183391e97a82SDon Lewis *(int *)addr = fgetown(&d->bd_sigio); 183497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1835831d27a9SDon Lewis break; 1836831d27a9SDon Lewis 1837831d27a9SDon Lewis /* This is deprecated, FIOSETOWN should be used instead. */ 1838831d27a9SDon Lewis case TIOCSPGRP: 1839831d27a9SDon Lewis error = fsetown(-(*(int *)addr), &d->bd_sigio); 1840831d27a9SDon Lewis break; 1841831d27a9SDon Lewis 1842831d27a9SDon Lewis /* This is deprecated, FIOGETOWN should be used instead. */ 184300a83887SPaul Traina case TIOCGPGRP: 184491e97a82SDon Lewis *(int *)addr = -fgetown(&d->bd_sigio); 184500a83887SPaul Traina break; 184600a83887SPaul Traina 184700a83887SPaul Traina case BIOCSRSIG: /* Set receive signal */ 184800a83887SPaul Traina { 184900a83887SPaul Traina u_int sig; 185000a83887SPaul Traina 185100a83887SPaul Traina sig = *(u_int *)addr; 185200a83887SPaul Traina 185300a83887SPaul Traina if (sig >= NSIG) 185400a83887SPaul Traina error = EINVAL; 185597aacec6SAlexander V. Chernikov else { 185697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 185700a83887SPaul Traina d->bd_sig = sig; 185897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 185997aacec6SAlexander V. Chernikov } 186000a83887SPaul Traina break; 186100a83887SPaul Traina } 186200a83887SPaul Traina case BIOCGRSIG: 186397aacec6SAlexander V. Chernikov BPFD_LOCK(d); 186400a83887SPaul Traina *(u_int *)addr = d->bd_sig; 186597aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 186600a83887SPaul Traina break; 18674d621040SChristian S.J. Peron 18684d621040SChristian S.J. Peron case BIOCGETBUFMODE: 186997aacec6SAlexander V. Chernikov BPFD_LOCK(d); 18704d621040SChristian S.J. Peron *(u_int *)addr = d->bd_bufmode; 187197aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18724d621040SChristian S.J. Peron break; 18734d621040SChristian S.J. Peron 18744d621040SChristian S.J. Peron case BIOCSETBUFMODE: 18754d621040SChristian S.J. Peron /* 18764d621040SChristian S.J. Peron * Allow the buffering mode to be changed as long as we 18774d621040SChristian S.J. Peron * haven't yet committed to a particular mode. Our 18784d621040SChristian S.J. Peron * definition of commitment, for now, is whether or not a 18794d621040SChristian S.J. Peron * buffer has been allocated or an interface attached, since 18804d621040SChristian S.J. Peron * that's the point where things get tricky. 18814d621040SChristian S.J. Peron */ 18824d621040SChristian S.J. Peron switch (*(u_int *)addr) { 18834d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 18844d621040SChristian S.J. Peron break; 18854d621040SChristian S.J. Peron 18864d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 18874d621040SChristian S.J. Peron if (bpf_zerocopy_enable) 18884d621040SChristian S.J. Peron break; 18894d621040SChristian S.J. Peron /* FALLSTHROUGH */ 18904d621040SChristian S.J. Peron 18914d621040SChristian S.J. Peron default: 18921b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 18934d621040SChristian S.J. Peron return (EINVAL); 18944d621040SChristian S.J. Peron } 18954d621040SChristian S.J. Peron 1896afa85850SAlexander V. Chernikov BPFD_LOCK(d); 18974d621040SChristian S.J. Peron if (d->bd_sbuf != NULL || d->bd_hbuf != NULL || 18984d621040SChristian S.J. Peron d->bd_fbuf != NULL || d->bd_bif != NULL) { 1899afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 19001b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 19014d621040SChristian S.J. Peron return (EBUSY); 19024d621040SChristian S.J. Peron } 19034d621040SChristian S.J. Peron d->bd_bufmode = *(u_int *)addr; 1904afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 19054d621040SChristian S.J. Peron break; 19064d621040SChristian S.J. Peron 19074d621040SChristian S.J. Peron case BIOCGETZMAX: 19081b610a74SBjoern A. Zeeb error = bpf_ioctl_getzmax(td, d, (size_t *)addr); 19091b610a74SBjoern A. Zeeb break; 19104d621040SChristian S.J. Peron 19114d621040SChristian S.J. Peron case BIOCSETZBUF: 19121b610a74SBjoern A. Zeeb error = bpf_ioctl_setzbuf(td, d, (struct bpf_zbuf *)addr); 19131b610a74SBjoern A. Zeeb break; 19144d621040SChristian S.J. Peron 19154d621040SChristian S.J. Peron case BIOCROTZBUF: 19161b610a74SBjoern A. Zeeb error = bpf_ioctl_rotzbuf(td, d, (struct bpf_zbuf *)addr); 19171b610a74SBjoern A. Zeeb break; 19181e7fe2fbSLuiz Otavio O Souza 19191e7fe2fbSLuiz Otavio O Souza case BIOCSETVLANPCP: 19201e7fe2fbSLuiz Otavio O Souza { 19211e7fe2fbSLuiz Otavio O Souza u_int pcp; 19221e7fe2fbSLuiz Otavio O Souza 19231e7fe2fbSLuiz Otavio O Souza pcp = *(u_int *)addr; 19241e7fe2fbSLuiz Otavio O Souza if (pcp > BPF_PRIO_MAX || pcp < 0) { 19251e7fe2fbSLuiz Otavio O Souza error = EINVAL; 19261e7fe2fbSLuiz Otavio O Souza break; 19271e7fe2fbSLuiz Otavio O Souza } 19281e7fe2fbSLuiz Otavio O Souza d->bd_pcp = pcp; 19291e7fe2fbSLuiz Otavio O Souza break; 19301e7fe2fbSLuiz Otavio O Souza } 1931df8bae1dSRodney W. Grimes } 193297021c24SMarko Zec CURVNET_RESTORE(); 1933df8bae1dSRodney W. Grimes return (error); 1934df8bae1dSRodney W. Grimes } 1935df8bae1dSRodney W. Grimes 1936df8bae1dSRodney W. Grimes /* 1937df8bae1dSRodney W. Grimes * Set d's packet filter program to fp. If this file already has a filter, 1938df8bae1dSRodney W. Grimes * free it and replace it. Returns EINVAL for bogus requests. 1939784292f8SAlexander V. Chernikov * 1940699281b5SAndrey V. Elsukov * Note we use global lock here to serialize bpf_setf() and bpf_setif() 1941699281b5SAndrey V. Elsukov * calls. 1942df8bae1dSRodney W. Grimes */ 1943f708ef1bSPoul-Henning Kamp static int 194419ba8395SChristian S.J. Peron bpf_setf(struct bpf_d *d, struct bpf_program *fp, u_long cmd) 1945df8bae1dSRodney W. Grimes { 19469b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19479b7d4a7fSJung-uk Kim struct bpf_program fp_swab; 19489b7d4a7fSJung-uk Kim struct bpf_program32 *fp32; 19499b7d4a7fSJung-uk Kim #endif 1950699281b5SAndrey V. Elsukov struct bpf_program_buffer *fcode; 1951699281b5SAndrey V. Elsukov struct bpf_insn *filter; 1952293c06a1SRuslan Ermilov #ifdef BPF_JITTER 1953699281b5SAndrey V. Elsukov bpf_jit_filter *jfunc; 1954ae275efcSJung-uk Kim #endif 19558b04b48aSJung-uk Kim size_t size; 19568b04b48aSJung-uk Kim u_int flen; 1957699281b5SAndrey V. Elsukov bool track_event; 1958df8bae1dSRodney W. Grimes 19599b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19606f731135SJung-uk Kim switch (cmd) { 19616f731135SJung-uk Kim case BIOCSETF32: 19626f731135SJung-uk Kim case BIOCSETWF32: 19636f731135SJung-uk Kim case BIOCSETFNR32: 1964fc0a61a4SKonstantin Belousov fp32 = (struct bpf_program32 *)fp; 1965fc0a61a4SKonstantin Belousov fp_swab.bf_len = fp32->bf_len; 1966699281b5SAndrey V. Elsukov fp_swab.bf_insns = 1967699281b5SAndrey V. Elsukov (struct bpf_insn *)(uintptr_t)fp32->bf_insns; 1968fc0a61a4SKonstantin Belousov fp = &fp_swab; 19696f731135SJung-uk Kim switch (cmd) { 19706f731135SJung-uk Kim case BIOCSETF32: 19716f731135SJung-uk Kim cmd = BIOCSETF; 19726f731135SJung-uk Kim break; 19736f731135SJung-uk Kim case BIOCSETWF32: 1974fc0a61a4SKonstantin Belousov cmd = BIOCSETWF; 19756f731135SJung-uk Kim break; 19766f731135SJung-uk Kim } 19776f731135SJung-uk Kim break; 1978fc0a61a4SKonstantin Belousov } 1979fc0a61a4SKonstantin Belousov #endif 19808b04b48aSJung-uk Kim 1981699281b5SAndrey V. Elsukov filter = NULL; 19828b04b48aSJung-uk Kim #ifdef BPF_JITTER 1983699281b5SAndrey V. Elsukov jfunc = NULL; 19848b04b48aSJung-uk Kim #endif 19856c74ff0eSAlexander V. Chernikov /* 19866c74ff0eSAlexander V. Chernikov * Check new filter validness before acquiring any locks. 19876c74ff0eSAlexander V. Chernikov * Allocate memory for new filter, if needed. 19886c74ff0eSAlexander V. Chernikov */ 19896c74ff0eSAlexander V. Chernikov flen = fp->bf_len; 19909b7d4a7fSJung-uk Kim if (flen > bpf_maxinsns || (fp->bf_insns == NULL && flen != 0)) 19916c74ff0eSAlexander V. Chernikov return (EINVAL); 19926c74ff0eSAlexander V. Chernikov size = flen * sizeof(*fp->bf_insns); 1993a86227d1SAlexander V. Chernikov if (size > 0) { 19949b7d4a7fSJung-uk Kim /* We're setting up new filter. Copy and check actual data. */ 1995699281b5SAndrey V. Elsukov fcode = bpf_program_buffer_alloc(size, M_WAITOK); 1996699281b5SAndrey V. Elsukov filter = (struct bpf_insn *)fcode->buffer; 1997699281b5SAndrey V. Elsukov if (copyin(fp->bf_insns, filter, size) != 0 || 1998699281b5SAndrey V. Elsukov !bpf_validate(filter, flen)) { 1999a86227d1SAlexander V. Chernikov free(fcode, M_BPF); 2000a86227d1SAlexander V. Chernikov return (EINVAL); 2001a86227d1SAlexander V. Chernikov } 2002c7b0200eSAlexander V. Chernikov #ifdef BPF_JITTER 200316a227c7SJonathan T. Looney if (cmd != BIOCSETWF) { 200416a227c7SJonathan T. Looney /* 200516a227c7SJonathan T. Looney * Filter is copied inside fcode and is 200616a227c7SJonathan T. Looney * perfectly valid. 200716a227c7SJonathan T. Looney */ 2008699281b5SAndrey V. Elsukov jfunc = bpf_jitter(filter, flen); 200916a227c7SJonathan T. Looney } 2010c7b0200eSAlexander V. Chernikov #endif 20118b04b48aSJung-uk Kim } 2012c7b0200eSAlexander V. Chernikov 2013699281b5SAndrey V. Elsukov track_event = false; 2014699281b5SAndrey V. Elsukov fcode = NULL; 20156c74ff0eSAlexander V. Chernikov 2016699281b5SAndrey V. Elsukov BPF_LOCK(); 2017afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2018699281b5SAndrey V. Elsukov /* Set up new filter. */ 20198b04b48aSJung-uk Kim if (cmd == BIOCSETWF) { 2020699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2021699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_wfilter, 2022699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2023293c06a1SRuslan Ermilov #ifdef BPF_JITTER 2024699281b5SAndrey V. Elsukov fcode->func = NULL; 2025699281b5SAndrey V. Elsukov #endif 2026699281b5SAndrey V. Elsukov } 2027699281b5SAndrey V. Elsukov d->bd_wfilter = filter; 2028699281b5SAndrey V. Elsukov } else { 2029699281b5SAndrey V. Elsukov if (d->bd_rfilter != NULL) { 2030699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_rfilter, 2031699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2032699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2033699281b5SAndrey V. Elsukov fcode->func = d->bd_bfilter; 2034699281b5SAndrey V. Elsukov #endif 2035699281b5SAndrey V. Elsukov } 2036699281b5SAndrey V. Elsukov d->bd_rfilter = filter; 2037699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2038c7b0200eSAlexander V. Chernikov d->bd_bfilter = jfunc; 2039ae275efcSJung-uk Kim #endif 2040f11c3508SDavid Malone if (cmd == BIOCSETF) 2041df8bae1dSRodney W. Grimes reset_d(d); 204251ec1eb7SAlexander V. Chernikov 2043699281b5SAndrey V. Elsukov if (bpf_check_upgrade(cmd, d, filter, flen) != 0) { 2044699281b5SAndrey V. Elsukov /* 2045699281b5SAndrey V. Elsukov * Filter can be set several times without 2046699281b5SAndrey V. Elsukov * specifying interface. In this case just mark d 2047699281b5SAndrey V. Elsukov * as reader. 2048699281b5SAndrey V. Elsukov */ 2049699281b5SAndrey V. Elsukov d->bd_writer = 0; 2050699281b5SAndrey V. Elsukov if (d->bd_bif != NULL) { 2051699281b5SAndrey V. Elsukov /* 2052699281b5SAndrey V. Elsukov * Remove descriptor from writers-only list 2053699281b5SAndrey V. Elsukov * and add it to active readers list. 2054699281b5SAndrey V. Elsukov */ 2055699281b5SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 2056699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&d->bd_bif->bif_dlist, 2057699281b5SAndrey V. Elsukov d, bd_next); 2058699281b5SAndrey V. Elsukov CTR2(KTR_NET, 2059699281b5SAndrey V. Elsukov "%s: upgrade required by pid %d", 2060699281b5SAndrey V. Elsukov __func__, d->bd_pid); 2061699281b5SAndrey V. Elsukov track_event = true; 2062699281b5SAndrey V. Elsukov } 2063699281b5SAndrey V. Elsukov } 20648b04b48aSJung-uk Kim } 2065afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2066df8bae1dSRodney W. Grimes 2067699281b5SAndrey V. Elsukov if (fcode != NULL) 20682a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpf_program_buffer_free, &fcode->epoch_ctx); 2069699281b5SAndrey V. Elsukov 2070699281b5SAndrey V. Elsukov if (track_event) 2071699281b5SAndrey V. Elsukov EVENTHANDLER_INVOKE(bpf_track, 2072699281b5SAndrey V. Elsukov d->bd_bif->bif_ifp, d->bd_bif->bif_dlt, 1); 207351ec1eb7SAlexander V. Chernikov 20746c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 2075df8bae1dSRodney W. Grimes return (0); 2076df8bae1dSRodney W. Grimes } 2077df8bae1dSRodney W. Grimes 2078df8bae1dSRodney W. Grimes /* 2079df8bae1dSRodney W. Grimes * Detach a file from its current interface (if attached at all) and attach 2080df8bae1dSRodney W. Grimes * to the interface indicated by the name stored in ifr. 2081df8bae1dSRodney W. Grimes * Return an errno or 0. 2082df8bae1dSRodney W. Grimes */ 2083df8bae1dSRodney W. Grimes static int 208419ba8395SChristian S.J. Peron bpf_setif(struct bpf_d *d, struct ifreq *ifr) 2085df8bae1dSRodney W. Grimes { 2086df8bae1dSRodney W. Grimes struct bpf_if *bp; 20879b44ff22SGarrett Wollman struct ifnet *theywant; 2088df8bae1dSRodney W. Grimes 20896c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 20906c74ff0eSAlexander V. Chernikov 20919b44ff22SGarrett Wollman theywant = ifunit(ifr->ifr_name); 209216d878ccSChristian S.J. Peron if (theywant == NULL || theywant->if_bpf == NULL) 209316d878ccSChristian S.J. Peron return (ENXIO); 20949b44ff22SGarrett Wollman 209516d878ccSChristian S.J. Peron bp = theywant->if_bpf; 2096df8bae1dSRodney W. Grimes /* 20974f42daa4SLuiz Otavio O Souza * At this point, we expect the buffer is already allocated. If not, 20984f42daa4SLuiz Otavio O Souza * return an error. 2099df8bae1dSRodney W. Grimes */ 21004d621040SChristian S.J. Peron switch (d->bd_bufmode) { 21014d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 21024d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 21034d621040SChristian S.J. Peron if (d->bd_sbuf == NULL) 21044d621040SChristian S.J. Peron return (EINVAL); 21054d621040SChristian S.J. Peron break; 21064d621040SChristian S.J. Peron 21074d621040SChristian S.J. Peron default: 21084d621040SChristian S.J. Peron panic("bpf_setif: bufmode %d", d->bd_bufmode); 21094d621040SChristian S.J. Peron } 21106c74ff0eSAlexander V. Chernikov if (bp != d->bd_bif) 2111df8bae1dSRodney W. Grimes bpf_attachd(d, bp); 2112699281b5SAndrey V. Elsukov else { 2113afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2114df8bae1dSRodney W. Grimes reset_d(d); 2115afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2116699281b5SAndrey V. Elsukov } 2117df8bae1dSRodney W. Grimes return (0); 2118df8bae1dSRodney W. Grimes } 2119df8bae1dSRodney W. Grimes 2120df8bae1dSRodney W. Grimes /* 2121243ac7d8SPeter Wemm * Support for select() and poll() system calls 2122df8bae1dSRodney W. Grimes * 2123df8bae1dSRodney W. Grimes * Return true iff the specific operation will not block indefinitely. 2124df8bae1dSRodney W. Grimes * Otherwise, return false but make a note that a selwakeup() must be done. 2125df8bae1dSRodney W. Grimes */ 212637c84183SPoul-Henning Kamp static int 212719ba8395SChristian S.J. Peron bpfpoll(struct cdev *dev, int events, struct thread *td) 2128df8bae1dSRodney W. Grimes { 2129e7bb21b3SJonathan Lemon struct bpf_d *d; 21300832fc64SGarance A Drosehn int revents; 2131df8bae1dSRodney W. Grimes 2132136600feSEd Schouten if (devfs_get_cdevpriv((void **)&d) != 0 || d->bd_bif == NULL) 2133136600feSEd Schouten return (events & 2134136600feSEd Schouten (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM)); 2135de5d9935SRobert Watson 2136b75a24a0SChristian S.J. Peron /* 2137b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2138b75a24a0SChristian S.J. Peron */ 21390832fc64SGarance A Drosehn revents = events & (POLLOUT | POLLWRNORM); 2140afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2141e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 214275c13541SPoul-Henning Kamp if (events & (POLLIN | POLLRDNORM)) { 214395aab9ccSJohn-Mark Gurney if (bpf_ready(d)) 2144243ac7d8SPeter Wemm revents |= events & (POLLIN | POLLRDNORM); 214581bda851SJohn Polstra else { 2146ed01445dSJohn Baldwin selrecord(td, &d->bd_sel); 214781bda851SJohn Polstra /* Start the read timeout if necessary. */ 214881bda851SJohn Polstra if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 214981bda851SJohn Polstra callout_reset(&d->bd_callout, d->bd_rtout, 215081bda851SJohn Polstra bpf_timed_out, d); 215181bda851SJohn Polstra d->bd_state = BPF_WAITING; 215281bda851SJohn Polstra } 215381bda851SJohn Polstra } 215475c13541SPoul-Henning Kamp } 2155afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2156243ac7d8SPeter Wemm return (revents); 2157df8bae1dSRodney W. Grimes } 2158df8bae1dSRodney W. Grimes 2159df8bae1dSRodney W. Grimes /* 216095aab9ccSJohn-Mark Gurney * Support for kevent() system call. Register EVFILT_READ filters and 216195aab9ccSJohn-Mark Gurney * reject all others. 216295aab9ccSJohn-Mark Gurney */ 216395aab9ccSJohn-Mark Gurney int 216419ba8395SChristian S.J. Peron bpfkqfilter(struct cdev *dev, struct knote *kn) 216595aab9ccSJohn-Mark Gurney { 2166136600feSEd Schouten struct bpf_d *d; 216795aab9ccSJohn-Mark Gurney 2168*ded77e02SHartmut Brandt if (devfs_get_cdevpriv((void **)&d) != 0) 216995aab9ccSJohn-Mark Gurney return (1); 217095aab9ccSJohn-Mark Gurney 2171*ded77e02SHartmut Brandt switch (kn->kn_filter) { 2172*ded77e02SHartmut Brandt case EVFILT_READ: 2173*ded77e02SHartmut Brandt kn->kn_fop = &bpfread_filtops; 2174*ded77e02SHartmut Brandt break; 2175*ded77e02SHartmut Brandt 2176*ded77e02SHartmut Brandt case EVFILT_WRITE: 2177*ded77e02SHartmut Brandt kn->kn_fop = &bpfwrite_filtops; 2178*ded77e02SHartmut Brandt break; 2179*ded77e02SHartmut Brandt 2180*ded77e02SHartmut Brandt default: 2181*ded77e02SHartmut Brandt return (1); 2182*ded77e02SHartmut Brandt } 2183*ded77e02SHartmut Brandt 2184b75a24a0SChristian S.J. Peron /* 2185b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2186b75a24a0SChristian S.J. Peron */ 2187afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2188e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 218995aab9ccSJohn-Mark Gurney kn->kn_hook = d; 21904b19419eSChristian S.J. Peron knlist_add(&d->bd_sel.si_note, kn, 1); 2191afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 219295aab9ccSJohn-Mark Gurney 219395aab9ccSJohn-Mark Gurney return (0); 219495aab9ccSJohn-Mark Gurney } 219595aab9ccSJohn-Mark Gurney 219695aab9ccSJohn-Mark Gurney static void 219719ba8395SChristian S.J. Peron filt_bpfdetach(struct knote *kn) 219895aab9ccSJohn-Mark Gurney { 219995aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 220095aab9ccSJohn-Mark Gurney 2201ad3b9257SJohn-Mark Gurney knlist_remove(&d->bd_sel.si_note, kn, 0); 220295aab9ccSJohn-Mark Gurney } 220395aab9ccSJohn-Mark Gurney 220495aab9ccSJohn-Mark Gurney static int 220519ba8395SChristian S.J. Peron filt_bpfread(struct knote *kn, long hint) 220695aab9ccSJohn-Mark Gurney { 220795aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 220895aab9ccSJohn-Mark Gurney int ready; 220995aab9ccSJohn-Mark Gurney 2210afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 221195aab9ccSJohn-Mark Gurney ready = bpf_ready(d); 221295aab9ccSJohn-Mark Gurney if (ready) { 221395aab9ccSJohn-Mark Gurney kn->kn_data = d->bd_slen; 221492242172SLuiz Otavio O Souza /* 221592242172SLuiz Otavio O Souza * Ignore the hold buffer if it is being copied to user space. 221692242172SLuiz Otavio O Souza */ 221792242172SLuiz Otavio O Souza if (!d->bd_hbuf_in_use && d->bd_hbuf) 221895aab9ccSJohn-Mark Gurney kn->kn_data += d->bd_hlen; 22195d7af3a1SJung-uk Kim } else if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 222095aab9ccSJohn-Mark Gurney callout_reset(&d->bd_callout, d->bd_rtout, 222195aab9ccSJohn-Mark Gurney bpf_timed_out, d); 222295aab9ccSJohn-Mark Gurney d->bd_state = BPF_WAITING; 222395aab9ccSJohn-Mark Gurney } 222495aab9ccSJohn-Mark Gurney 222595aab9ccSJohn-Mark Gurney return (ready); 222695aab9ccSJohn-Mark Gurney } 222795aab9ccSJohn-Mark Gurney 2228*ded77e02SHartmut Brandt static int 2229*ded77e02SHartmut Brandt filt_bpfwrite(struct knote *kn, long hint) 2230*ded77e02SHartmut Brandt { 2231*ded77e02SHartmut Brandt struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 2232*ded77e02SHartmut Brandt BPFD_LOCK_ASSERT(d); 2233*ded77e02SHartmut Brandt 2234*ded77e02SHartmut Brandt kn->kn_data = d->bd_bif->bif_ifp->if_mtu; 2235*ded77e02SHartmut Brandt 2236*ded77e02SHartmut Brandt return (1); 2237*ded77e02SHartmut Brandt } 2238*ded77e02SHartmut Brandt 2239253a3814SLawrence Stewart #define BPF_TSTAMP_NONE 0 2240253a3814SLawrence Stewart #define BPF_TSTAMP_FAST 1 2241253a3814SLawrence Stewart #define BPF_TSTAMP_NORMAL 2 2242253a3814SLawrence Stewart #define BPF_TSTAMP_EXTERN 3 2243253a3814SLawrence Stewart 2244253a3814SLawrence Stewart static int 2245253a3814SLawrence Stewart bpf_ts_quality(int tstype) 2246253a3814SLawrence Stewart { 2247253a3814SLawrence Stewart 2248253a3814SLawrence Stewart if (tstype == BPF_T_NONE) 2249253a3814SLawrence Stewart return (BPF_TSTAMP_NONE); 2250253a3814SLawrence Stewart if ((tstype & BPF_T_FAST) != 0) 2251253a3814SLawrence Stewart return (BPF_TSTAMP_FAST); 2252253a3814SLawrence Stewart 2253253a3814SLawrence Stewart return (BPF_TSTAMP_NORMAL); 2254253a3814SLawrence Stewart } 2255253a3814SLawrence Stewart 2256253a3814SLawrence Stewart static int 2257253a3814SLawrence Stewart bpf_gettime(struct bintime *bt, int tstype, struct mbuf *m) 2258253a3814SLawrence Stewart { 2259253a3814SLawrence Stewart struct m_tag *tag; 2260253a3814SLawrence Stewart int quality; 2261253a3814SLawrence Stewart 2262253a3814SLawrence Stewart quality = bpf_ts_quality(tstype); 2263253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NONE) 2264253a3814SLawrence Stewart return (quality); 2265253a3814SLawrence Stewart 2266253a3814SLawrence Stewart if (m != NULL) { 2267253a3814SLawrence Stewart tag = m_tag_locate(m, MTAG_BPF, MTAG_BPF_TIMESTAMP, NULL); 2268253a3814SLawrence Stewart if (tag != NULL) { 2269253a3814SLawrence Stewart *bt = *(struct bintime *)(tag + 1); 2270253a3814SLawrence Stewart return (BPF_TSTAMP_EXTERN); 2271253a3814SLawrence Stewart } 2272253a3814SLawrence Stewart } 2273253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NORMAL) 2274253a3814SLawrence Stewart binuptime(bt); 2275253a3814SLawrence Stewart else 2276253a3814SLawrence Stewart getbinuptime(bt); 2277253a3814SLawrence Stewart 2278253a3814SLawrence Stewart return (quality); 2279253a3814SLawrence Stewart } 2280253a3814SLawrence Stewart 228195aab9ccSJohn-Mark Gurney /* 2282df8bae1dSRodney W. Grimes * Incoming linkage from device drivers. Process the packet pkt, of length 2283df8bae1dSRodney W. Grimes * pktlen, which is stored in a contiguous buffer. The packet is parsed 2284df8bae1dSRodney W. Grimes * by each process' filter, and if accepted, stashed into the corresponding 2285df8bae1dSRodney W. Grimes * buffer. 2286df8bae1dSRodney W. Grimes */ 2287df8bae1dSRodney W. Grimes void 228819ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 2289df8bae1dSRodney W. Grimes { 2290699281b5SAndrey V. Elsukov struct epoch_tracker et; 2291547d94bdSJung-uk Kim struct bintime bt; 22928994a245SDag-Erling Smørgrav struct bpf_d *d; 2293a36599ccSJung-uk Kim #ifdef BPF_JITTER 2294a36599ccSJung-uk Kim bpf_jit_filter *bf; 2295a36599ccSJung-uk Kim #endif 2296253a3814SLawrence Stewart u_int slen; 2297253a3814SLawrence Stewart int gottime; 2298e7bb21b3SJonathan Lemon 2299253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2300699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2301699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2302b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2303a05cf8c6SChristian S.J. Peron /* 2304699281b5SAndrey V. Elsukov * NB: We dont call BPF_CHECK_DIRECTION() here since there 2305699281b5SAndrey V. Elsukov * is no way for the caller to indiciate to us whether this 2306699281b5SAndrey V. Elsukov * packet is inbound or outbound. In the bpf_mtap() routines, 2307699281b5SAndrey V. Elsukov * we use the interface pointers on the mbuf to figure it out. 2308a05cf8c6SChristian S.J. Peron */ 2309ae275efcSJung-uk Kim #ifdef BPF_JITTER 2310a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2311a36599ccSJung-uk Kim if (bf != NULL) 2312a36599ccSJung-uk Kim slen = (*(bf->func))(pkt, pktlen, pktlen); 2313ae275efcSJung-uk Kim else 2314ae275efcSJung-uk Kim #endif 231593e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, pkt, pktlen, pktlen); 2316ec272d87SRobert Watson if (slen != 0) { 2317e4b3229aSAlexander V. Chernikov /* 2318e4b3229aSAlexander V. Chernikov * Filter matches. Let's to acquire write lock. 2319e4b3229aSAlexander V. Chernikov */ 2320afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2321b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2322253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2323699281b5SAndrey V. Elsukov gottime = bpf_gettime(&bt, d->bd_tstamp, 2324699281b5SAndrey V. Elsukov NULL); 2325ec272d87SRobert Watson #ifdef MAC 232630d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2327ec272d87SRobert Watson #endif 23284d621040SChristian S.J. Peron catchpacket(d, pkt, pktlen, slen, 2329547d94bdSJung-uk Kim bpf_append_bytes, &bt); 2330afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2331ec272d87SRobert Watson } 2332df8bae1dSRodney W. Grimes } 2333699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2334df8bae1dSRodney W. Grimes } 2335df8bae1dSRodney W. Grimes 2336f81a2a49SJung-uk Kim #define BPF_CHECK_DIRECTION(d, r, i) \ 2337f81a2a49SJung-uk Kim (((d)->bd_direction == BPF_D_IN && (r) != (i)) || \ 2338f81a2a49SJung-uk Kim ((d)->bd_direction == BPF_D_OUT && (r) == (i))) 2339560a54e1SJung-uk Kim 2340df8bae1dSRodney W. Grimes /* 2341df8bae1dSRodney W. Grimes * Incoming linkage from device drivers, when packet is in an mbuf chain. 2342e4b3229aSAlexander V. Chernikov * Locking model is explained in bpf_tap(). 2343df8bae1dSRodney W. Grimes */ 2344df8bae1dSRodney W. Grimes void 234519ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 2346df8bae1dSRodney W. Grimes { 2347699281b5SAndrey V. Elsukov struct epoch_tracker et; 2348547d94bdSJung-uk Kim struct bintime bt; 2349df8bae1dSRodney W. Grimes struct bpf_d *d; 2350a36599ccSJung-uk Kim #ifdef BPF_JITTER 2351a36599ccSJung-uk Kim bpf_jit_filter *bf; 2352a36599ccSJung-uk Kim #endif 2353253a3814SLawrence Stewart u_int pktlen, slen; 2354253a3814SLawrence Stewart int gottime; 235591433904SDavid Malone 23568cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 2357fb3bc596SJohn Baldwin if ((m->m_flags & M_PROMISC) != 0 && m_rcvif(m) == NULL) { 23588cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 23598cd892f7SJung-uk Kim return; 23608cd892f7SJung-uk Kim } 23618cd892f7SJung-uk Kim 2362f0e2422bSPoul-Henning Kamp pktlen = m_length(m, NULL); 2363253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2364e4b3229aSAlexander V. Chernikov 2365699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2366699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2367fb3bc596SJohn Baldwin if (BPF_CHECK_DIRECTION(d, m_rcvif(m), bp->bif_ifp)) 23688ed3828cSRobert Watson continue; 2369b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2370ae275efcSJung-uk Kim #ifdef BPF_JITTER 2371a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2372ae275efcSJung-uk Kim /* XXX We cannot handle multiple mbufs. */ 2373a36599ccSJung-uk Kim if (bf != NULL && m->m_next == NULL) 2374699281b5SAndrey V. Elsukov slen = (*(bf->func))(mtod(m, u_char *), pktlen, 2375699281b5SAndrey V. Elsukov pktlen); 2376ae275efcSJung-uk Kim else 2377ae275efcSJung-uk Kim #endif 237893e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)m, pktlen, 0); 23794ddfb531SChristian S.J. Peron if (slen != 0) { 2380afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2381e4b3229aSAlexander V. Chernikov 2382b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2383253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2384253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 23850c7fb534SRobert Watson #ifdef MAC 238630d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 23870c7fb534SRobert Watson #endif 23880c7fb534SRobert Watson catchpacket(d, (u_char *)m, pktlen, slen, 2389547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2390afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 23914ddfb531SChristian S.J. Peron } 2392df8bae1dSRodney W. Grimes } 2393699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2394df8bae1dSRodney W. Grimes } 2395df8bae1dSRodney W. Grimes 2396df8bae1dSRodney W. Grimes /* 2397437ffe18SSam Leffler * Incoming linkage from device drivers, when packet is in 2398437ffe18SSam Leffler * an mbuf chain and to be prepended by a contiguous header. 2399437ffe18SSam Leffler */ 2400437ffe18SSam Leffler void 240119ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m) 2402437ffe18SSam Leffler { 2403699281b5SAndrey V. Elsukov struct epoch_tracker et; 2404547d94bdSJung-uk Kim struct bintime bt; 2405437ffe18SSam Leffler struct mbuf mb; 2406437ffe18SSam Leffler struct bpf_d *d; 2407253a3814SLawrence Stewart u_int pktlen, slen; 2408253a3814SLawrence Stewart int gottime; 240991433904SDavid Malone 24108cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 24118cd892f7SJung-uk Kim if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif == NULL) { 24128cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 24138cd892f7SJung-uk Kim return; 24148cd892f7SJung-uk Kim } 24158cd892f7SJung-uk Kim 2416437ffe18SSam Leffler pktlen = m_length(m, NULL); 2417437ffe18SSam Leffler /* 2418437ffe18SSam Leffler * Craft on-stack mbuf suitable for passing to bpf_filter. 2419437ffe18SSam Leffler * Note that we cut corners here; we only setup what's 2420437ffe18SSam Leffler * absolutely needed--this mbuf should never go anywhere else. 2421437ffe18SSam Leffler */ 242282334850SJohn Baldwin mb.m_flags = 0; 2423437ffe18SSam Leffler mb.m_next = m; 2424437ffe18SSam Leffler mb.m_data = data; 2425437ffe18SSam Leffler mb.m_len = dlen; 2426437ffe18SSam Leffler pktlen += dlen; 2427437ffe18SSam Leffler 2428253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2429e4b3229aSAlexander V. Chernikov 2430699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2431699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2432f81a2a49SJung-uk Kim if (BPF_CHECK_DIRECTION(d, m->m_pkthdr.rcvif, bp->bif_ifp)) 2433437ffe18SSam Leffler continue; 2434b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 243593e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)&mb, pktlen, 0); 24364ddfb531SChristian S.J. Peron if (slen != 0) { 2437afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2438e4b3229aSAlexander V. Chernikov 2439b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2440253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2441253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 2442437ffe18SSam Leffler #ifdef MAC 244330d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2444437ffe18SSam Leffler #endif 2445437ffe18SSam Leffler catchpacket(d, (u_char *)&mb, pktlen, slen, 2446547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2447afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 24484ddfb531SChristian S.J. Peron } 2449437ffe18SSam Leffler } 2450699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2451437ffe18SSam Leffler } 2452437ffe18SSam Leffler 2453560a54e1SJung-uk Kim #undef BPF_CHECK_DIRECTION 2454253a3814SLawrence Stewart #undef BPF_TSTAMP_NONE 2455253a3814SLawrence Stewart #undef BPF_TSTAMP_FAST 2456253a3814SLawrence Stewart #undef BPF_TSTAMP_NORMAL 2457253a3814SLawrence Stewart #undef BPF_TSTAMP_EXTERN 2458253a3814SLawrence Stewart 2459547d94bdSJung-uk Kim static int 2460547d94bdSJung-uk Kim bpf_hdrlen(struct bpf_d *d) 2461547d94bdSJung-uk Kim { 2462547d94bdSJung-uk Kim int hdrlen; 2463547d94bdSJung-uk Kim 2464547d94bdSJung-uk Kim hdrlen = d->bd_bif->bif_hdrlen; 2465547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2466547d94bdSJung-uk Kim if (d->bd_tstamp == BPF_T_NONE || 2467547d94bdSJung-uk Kim BPF_T_FORMAT(d->bd_tstamp) == BPF_T_MICROTIME) 2468547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2469547d94bdSJung-uk Kim if (d->bd_compat32) 2470547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr32); 2471547d94bdSJung-uk Kim else 2472547d94bdSJung-uk Kim #endif 2473547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr); 2474547d94bdSJung-uk Kim else 2475547d94bdSJung-uk Kim #endif 2476547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_xhdr); 2477547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2478547d94bdSJung-uk Kim if (d->bd_compat32) 2479547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN32(hdrlen); 2480547d94bdSJung-uk Kim else 2481547d94bdSJung-uk Kim #endif 2482547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN(hdrlen); 2483547d94bdSJung-uk Kim 2484547d94bdSJung-uk Kim return (hdrlen - d->bd_bif->bif_hdrlen); 2485547d94bdSJung-uk Kim } 2486547d94bdSJung-uk Kim 2487547d94bdSJung-uk Kim static void 2488547d94bdSJung-uk Kim bpf_bintime2ts(struct bintime *bt, struct bpf_ts *ts, int tstype) 2489547d94bdSJung-uk Kim { 2490584b675eSKonstantin Belousov struct bintime bt2, boottimebin; 2491547d94bdSJung-uk Kim struct timeval tsm; 2492547d94bdSJung-uk Kim struct timespec tsn; 2493547d94bdSJung-uk Kim 2494253a3814SLawrence Stewart if ((tstype & BPF_T_MONOTONIC) == 0) { 2495253a3814SLawrence Stewart bt2 = *bt; 2496584b675eSKonstantin Belousov getboottimebin(&boottimebin); 2497253a3814SLawrence Stewart bintime_add(&bt2, &boottimebin); 2498253a3814SLawrence Stewart bt = &bt2; 2499253a3814SLawrence Stewart } 2500547d94bdSJung-uk Kim switch (BPF_T_FORMAT(tstype)) { 2501547d94bdSJung-uk Kim case BPF_T_MICROTIME: 2502547d94bdSJung-uk Kim bintime2timeval(bt, &tsm); 2503547d94bdSJung-uk Kim ts->bt_sec = tsm.tv_sec; 2504547d94bdSJung-uk Kim ts->bt_frac = tsm.tv_usec; 2505547d94bdSJung-uk Kim break; 2506547d94bdSJung-uk Kim case BPF_T_NANOTIME: 2507547d94bdSJung-uk Kim bintime2timespec(bt, &tsn); 2508547d94bdSJung-uk Kim ts->bt_sec = tsn.tv_sec; 2509547d94bdSJung-uk Kim ts->bt_frac = tsn.tv_nsec; 2510547d94bdSJung-uk Kim break; 2511547d94bdSJung-uk Kim case BPF_T_BINTIME: 2512547d94bdSJung-uk Kim ts->bt_sec = bt->sec; 2513547d94bdSJung-uk Kim ts->bt_frac = bt->frac; 2514547d94bdSJung-uk Kim break; 2515547d94bdSJung-uk Kim } 2516547d94bdSJung-uk Kim } 2517547d94bdSJung-uk Kim 2518437ffe18SSam Leffler /* 2519df8bae1dSRodney W. Grimes * Move the packet data from interface memory (pkt) into the 25209e610888SDag-Erling Smørgrav * store buffer. "cpfn" is the routine called to do the actual data 2521df8bae1dSRodney W. Grimes * transfer. bcopy is passed in to copy contiguous chunks, while 25224d621040SChristian S.J. Peron * bpf_append_mbuf is passed in to copy mbuf chains. In the latter case, 2523df8bae1dSRodney W. Grimes * pkt is really an mbuf. 2524df8bae1dSRodney W. Grimes */ 2525df8bae1dSRodney W. Grimes static void 252619ba8395SChristian S.J. Peron catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen, 25274d621040SChristian S.J. Peron void (*cpfn)(struct bpf_d *, caddr_t, u_int, void *, u_int), 2528547d94bdSJung-uk Kim struct bintime *bt) 2529df8bae1dSRodney W. Grimes { 2530547d94bdSJung-uk Kim struct bpf_xhdr hdr; 2531547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2532547d94bdSJung-uk Kim struct bpf_hdr hdr_old; 2533fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2534547d94bdSJung-uk Kim struct bpf_hdr32 hdr32_old; 2535fc0a61a4SKonstantin Belousov #endif 2536547d94bdSJung-uk Kim #endif 2537547d94bdSJung-uk Kim int caplen, curlen, hdrlen, totlen; 25387819da79SJohn-Mark Gurney int do_wakeup = 0; 2539547d94bdSJung-uk Kim int do_timestamp; 2540547d94bdSJung-uk Kim int tstype; 25419e610888SDag-Erling Smørgrav 2542afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 2543de253273SAndrey V. Elsukov if (d->bd_bif == NULL) { 2544de253273SAndrey V. Elsukov /* Descriptor was detached in concurrent thread */ 2545de253273SAndrey V. Elsukov counter_u64_add(d->bd_dcount, 1); 2546de253273SAndrey V. Elsukov return; 2547de253273SAndrey V. Elsukov } 25484d621040SChristian S.J. Peron 25494d621040SChristian S.J. Peron /* 25504d621040SChristian S.J. Peron * Detect whether user space has released a buffer back to us, and if 25514d621040SChristian S.J. Peron * so, move it from being a hold buffer to a free buffer. This may 25524d621040SChristian S.J. Peron * not be the best place to do it (for example, we might only want to 25534d621040SChristian S.J. Peron * run this check if we need the space), but for now it's a reliable 25544d621040SChristian S.J. Peron * spot to do it. 25554d621040SChristian S.J. Peron */ 2556fa0c2b34SRobert Watson if (d->bd_fbuf == NULL && bpf_canfreebuf(d)) { 25574d621040SChristian S.J. Peron d->bd_fbuf = d->bd_hbuf; 25584d621040SChristian S.J. Peron d->bd_hbuf = NULL; 25594d621040SChristian S.J. Peron d->bd_hlen = 0; 256029f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 25614d621040SChristian S.J. Peron } 25624d621040SChristian S.J. Peron 2563df8bae1dSRodney W. Grimes /* 2564df8bae1dSRodney W. Grimes * Figure out how many bytes to move. If the packet is 2565df8bae1dSRodney W. Grimes * greater or equal to the snapshot length, transfer that 2566df8bae1dSRodney W. Grimes * much. Otherwise, transfer the whole packet (unless 2567df8bae1dSRodney W. Grimes * we hit the buffer size limit). 2568df8bae1dSRodney W. Grimes */ 2569547d94bdSJung-uk Kim hdrlen = bpf_hdrlen(d); 2570df8bae1dSRodney W. Grimes totlen = hdrlen + min(snaplen, pktlen); 2571df8bae1dSRodney W. Grimes if (totlen > d->bd_bufsize) 2572df8bae1dSRodney W. Grimes totlen = d->bd_bufsize; 2573df8bae1dSRodney W. Grimes 2574df8bae1dSRodney W. Grimes /* 2575df8bae1dSRodney W. Grimes * Round up the end of the previous packet to the next longword. 2576a7a91e65SRobert Watson * 2577a7a91e65SRobert Watson * Drop the packet if there's no room and no hope of room 2578a7a91e65SRobert Watson * If the packet would overflow the storage buffer or the storage 2579a7a91e65SRobert Watson * buffer is considered immutable by the buffer model, try to rotate 2580a7a91e65SRobert Watson * the buffer and wakeup pending processes. 2581df8bae1dSRodney W. Grimes */ 2582fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2583fc0a61a4SKonstantin Belousov if (d->bd_compat32) 2584fc0a61a4SKonstantin Belousov curlen = BPF_WORDALIGN32(d->bd_slen); 2585fc0a61a4SKonstantin Belousov else 2586fc0a61a4SKonstantin Belousov #endif 2587df8bae1dSRodney W. Grimes curlen = BPF_WORDALIGN(d->bd_slen); 2588a7a91e65SRobert Watson if (curlen + totlen > d->bd_bufsize || !bpf_canwritebuf(d)) { 2589572bde2aSRobert Watson if (d->bd_fbuf == NULL) { 2590df8bae1dSRodney W. Grimes /* 2591a7a91e65SRobert Watson * There's no room in the store buffer, and no 2592a7a91e65SRobert Watson * prospect of room, so drop the packet. Notify the 2593a7a91e65SRobert Watson * buffer model. 2594df8bae1dSRodney W. Grimes */ 2595a7a91e65SRobert Watson bpf_buffull(d); 2596b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_dcount, 1); 2597df8bae1dSRodney W. Grimes return; 2598df8bae1dSRodney W. Grimes } 259998fa5d85SLuiz Otavio O Souza KASSERT(!d->bd_hbuf_in_use, ("hold buffer is in use")); 2600df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 26017819da79SJohn-Mark Gurney do_wakeup = 1; 2602df8bae1dSRodney W. Grimes curlen = 0; 2603a7a91e65SRobert Watson } else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT) 2604df8bae1dSRodney W. Grimes /* 26054d621040SChristian S.J. Peron * Immediate mode is set, or the read timeout has already 26064d621040SChristian S.J. Peron * expired during a select call. A packet arrived, so the 26074d621040SChristian S.J. Peron * reader should be woken up. 2608df8bae1dSRodney W. Grimes */ 26097819da79SJohn-Mark Gurney do_wakeup = 1; 2610547d94bdSJung-uk Kim caplen = totlen - hdrlen; 2611547d94bdSJung-uk Kim tstype = d->bd_tstamp; 2612547d94bdSJung-uk Kim do_timestamp = tstype != BPF_T_NONE; 2613547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2614547d94bdSJung-uk Kim if (tstype == BPF_T_NONE || BPF_T_FORMAT(tstype) == BPF_T_MICROTIME) { 2615547d94bdSJung-uk Kim struct bpf_ts ts; 2616547d94bdSJung-uk Kim if (do_timestamp) 2617547d94bdSJung-uk Kim bpf_bintime2ts(bt, &ts, tstype); 2618fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2619fc0a61a4SKonstantin Belousov if (d->bd_compat32) { 2620547d94bdSJung-uk Kim bzero(&hdr32_old, sizeof(hdr32_old)); 2621547d94bdSJung-uk Kim if (do_timestamp) { 2622547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_sec = ts.bt_sec; 2623547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_usec = ts.bt_frac; 2624547d94bdSJung-uk Kim } 2625547d94bdSJung-uk Kim hdr32_old.bh_datalen = pktlen; 2626547d94bdSJung-uk Kim hdr32_old.bh_hdrlen = hdrlen; 2627547d94bdSJung-uk Kim hdr32_old.bh_caplen = caplen; 2628547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr32_old, 2629547d94bdSJung-uk Kim sizeof(hdr32_old)); 2630547d94bdSJung-uk Kim goto copy; 2631547d94bdSJung-uk Kim } 2632547d94bdSJung-uk Kim #endif 2633547d94bdSJung-uk Kim bzero(&hdr_old, sizeof(hdr_old)); 2634547d94bdSJung-uk Kim if (do_timestamp) { 2635547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_sec = ts.bt_sec; 2636547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_usec = ts.bt_frac; 2637547d94bdSJung-uk Kim } 2638547d94bdSJung-uk Kim hdr_old.bh_datalen = pktlen; 2639547d94bdSJung-uk Kim hdr_old.bh_hdrlen = hdrlen; 2640547d94bdSJung-uk Kim hdr_old.bh_caplen = caplen; 2641547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr_old, 2642547d94bdSJung-uk Kim sizeof(hdr_old)); 2643fc0a61a4SKonstantin Belousov goto copy; 2644fc0a61a4SKonstantin Belousov } 2645fc0a61a4SKonstantin Belousov #endif 2646df8bae1dSRodney W. Grimes 2647df8bae1dSRodney W. Grimes /* 26484d621040SChristian S.J. Peron * Append the bpf header. Note we append the actual header size, but 26494d621040SChristian S.J. Peron * move forward the length of the header plus padding. 2650df8bae1dSRodney W. Grimes */ 26514d621040SChristian S.J. Peron bzero(&hdr, sizeof(hdr)); 2652547d94bdSJung-uk Kim if (do_timestamp) 2653547d94bdSJung-uk Kim bpf_bintime2ts(bt, &hdr.bh_tstamp, tstype); 26544d621040SChristian S.J. Peron hdr.bh_datalen = pktlen; 26554d621040SChristian S.J. Peron hdr.bh_hdrlen = hdrlen; 2656547d94bdSJung-uk Kim hdr.bh_caplen = caplen; 26574d621040SChristian S.J. Peron bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr, sizeof(hdr)); 26584d621040SChristian S.J. Peron 2659df8bae1dSRodney W. Grimes /* 2660df8bae1dSRodney W. Grimes * Copy the packet data into the store buffer and update its length. 2661df8bae1dSRodney W. Grimes */ 2662547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2663fc0a61a4SKonstantin Belousov copy: 2664fc0a61a4SKonstantin Belousov #endif 2665547d94bdSJung-uk Kim (*cpfn)(d, d->bd_sbuf, curlen + hdrlen, pkt, caplen); 2666df8bae1dSRodney W. Grimes d->bd_slen = curlen + totlen; 26677819da79SJohn-Mark Gurney 26687819da79SJohn-Mark Gurney if (do_wakeup) 26697819da79SJohn-Mark Gurney bpf_wakeup(d); 2670df8bae1dSRodney W. Grimes } 2671df8bae1dSRodney W. Grimes 2672df8bae1dSRodney W. Grimes /* 2673df8bae1dSRodney W. Grimes * Free buffers currently in use by a descriptor. 2674df8bae1dSRodney W. Grimes * Called on close. 2675df8bae1dSRodney W. Grimes */ 2676df8bae1dSRodney W. Grimes static void 2677699281b5SAndrey V. Elsukov bpfd_free(epoch_context_t ctx) 2678df8bae1dSRodney W. Grimes { 2679699281b5SAndrey V. Elsukov struct bpf_d *d; 2680699281b5SAndrey V. Elsukov struct bpf_program_buffer *p; 26814d621040SChristian S.J. Peron 2682df8bae1dSRodney W. Grimes /* 2683df8bae1dSRodney W. Grimes * We don't need to lock out interrupts since this descriptor has 2684df8bae1dSRodney W. Grimes * been detached from its interface and it yet hasn't been marked 2685df8bae1dSRodney W. Grimes * free. 2686df8bae1dSRodney W. Grimes */ 2687699281b5SAndrey V. Elsukov d = __containerof(ctx, struct bpf_d, epoch_ctx); 26884d621040SChristian S.J. Peron bpf_free(d); 268970485847SJung-uk Kim if (d->bd_rfilter != NULL) { 2690699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_rfilter, 2691699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2692af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2693af1f58dfSAndrey V. Elsukov p->func = d->bd_bfilter; 2694af1f58dfSAndrey V. Elsukov #endif 2695699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2696ae275efcSJung-uk Kim } 2697699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2698699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_wfilter, 2699699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2700af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2701af1f58dfSAndrey V. Elsukov p->func = NULL; 2702af1f58dfSAndrey V. Elsukov #endif 2703699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2704699281b5SAndrey V. Elsukov } 2705b2b7ca49SAlexander V. Chernikov 2706699281b5SAndrey V. Elsukov mtx_destroy(&d->bd_lock); 2707b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_rcount); 2708b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_dcount); 2709b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_fcount); 2710b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wcount); 2711b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wfcount); 2712b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wdcount); 2713b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_zcopy); 2714699281b5SAndrey V. Elsukov free(d, M_BPF); 2715df8bae1dSRodney W. Grimes } 2716df8bae1dSRodney W. Grimes 2717df8bae1dSRodney W. Grimes /* 271824a229f4SSam Leffler * Attach an interface to bpf. dlt is the link layer type; hdrlen is the 271924a229f4SSam Leffler * fixed size of the link header (variable length headers not yet supported). 2720df8bae1dSRodney W. Grimes */ 2721df8bae1dSRodney W. Grimes void 272219ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 2723df8bae1dSRodney W. Grimes { 272424a229f4SSam Leffler 272524a229f4SSam Leffler bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 272624a229f4SSam Leffler } 272724a229f4SSam Leffler 272824a229f4SSam Leffler /* 272924a229f4SSam Leffler * Attach an interface to bpf. ifp is a pointer to the structure 273024a229f4SSam Leffler * defining the interface to be attached, dlt is the link layer type, 273124a229f4SSam Leffler * and hdrlen is the fixed size of the link header (variable length 273224a229f4SSam Leffler * headers are not yet supporrted). 273324a229f4SSam Leffler */ 273424a229f4SSam Leffler void 2735699281b5SAndrey V. Elsukov bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, 2736699281b5SAndrey V. Elsukov struct bpf_if **driverp) 273724a229f4SSam Leffler { 2738df8bae1dSRodney W. Grimes struct bpf_if *bp; 273919ba8395SChristian S.J. Peron 2740699281b5SAndrey V. Elsukov KASSERT(*driverp == NULL, 2741699281b5SAndrey V. Elsukov ("bpfattach2: driverp already initialized")); 2742df8bae1dSRodney W. Grimes 2743c5be49daSAndrey V. Elsukov bp = malloc(sizeof(*bp), M_BPF, M_WAITOK | M_ZERO); 2744c5be49daSAndrey V. Elsukov 2745699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_dlist); 2746699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_wlist); 2747df8bae1dSRodney W. Grimes bp->bif_ifp = ifp; 2748df8bae1dSRodney W. Grimes bp->bif_dlt = dlt; 2749c5be49daSAndrey V. Elsukov bp->bif_hdrlen = hdrlen; 27509ce40d32SKristof Provost bp->bif_bpf = driverp; 2751699281b5SAndrey V. Elsukov bp->bif_refcnt = 1; 275216d878ccSChristian S.J. Peron *driverp = bp; 2753699281b5SAndrey V. Elsukov /* 2754699281b5SAndrey V. Elsukov * Reference ifnet pointer, so it won't freed until 2755699281b5SAndrey V. Elsukov * we release it. 2756699281b5SAndrey V. Elsukov */ 2757699281b5SAndrey V. Elsukov if_ref(ifp); 2758e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2759699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bpf_iflist, bp, bif_next); 2760e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 2761df8bae1dSRodney W. Grimes 2762616bc4f4SBjoern A. Zeeb if (bootverbose && IS_DEFAULT_VNET(curvnet)) 276324a229f4SSam Leffler if_printf(ifp, "bpf attached\n"); 2764df8bae1dSRodney W. Grimes } 276553ac6efbSJulian Elischer 276605fc4164SBjoern A. Zeeb #ifdef VIMAGE 276705fc4164SBjoern A. Zeeb /* 276805fc4164SBjoern A. Zeeb * When moving interfaces between vnet instances we need a way to 276905fc4164SBjoern A. Zeeb * query the dlt and hdrlen before detach so we can re-attch the if_bpf 277005fc4164SBjoern A. Zeeb * after the vmove. We unfortunately have no device driver infrastructure 277105fc4164SBjoern A. Zeeb * to query the interface for these values after creation/attach, thus 277205fc4164SBjoern A. Zeeb * add this as a workaround. 277305fc4164SBjoern A. Zeeb */ 277405fc4164SBjoern A. Zeeb int 277505fc4164SBjoern A. Zeeb bpf_get_bp_params(struct bpf_if *bp, u_int *bif_dlt, u_int *bif_hdrlen) 277605fc4164SBjoern A. Zeeb { 277705fc4164SBjoern A. Zeeb 277805fc4164SBjoern A. Zeeb if (bp == NULL) 277905fc4164SBjoern A. Zeeb return (ENXIO); 278005fc4164SBjoern A. Zeeb if (bif_dlt == NULL && bif_hdrlen == NULL) 278105fc4164SBjoern A. Zeeb return (0); 278205fc4164SBjoern A. Zeeb 278305fc4164SBjoern A. Zeeb if (bif_dlt != NULL) 278405fc4164SBjoern A. Zeeb *bif_dlt = bp->bif_dlt; 278505fc4164SBjoern A. Zeeb if (bif_hdrlen != NULL) 278605fc4164SBjoern A. Zeeb *bif_hdrlen = bp->bif_hdrlen; 278705fc4164SBjoern A. Zeeb 278805fc4164SBjoern A. Zeeb return (0); 278905fc4164SBjoern A. Zeeb } 279005fc4164SBjoern A. Zeeb #endif 279105fc4164SBjoern A. Zeeb 2792de5d9935SRobert Watson /* 2793de5d9935SRobert Watson * Detach bpf from an interface. This involves detaching each descriptor 27946c74ff0eSAlexander V. Chernikov * associated with the interface. Notify each descriptor as it's detached 27956c74ff0eSAlexander V. Chernikov * so that any sleepers wake up and get ENXIO. 2796de5d9935SRobert Watson */ 2797de5d9935SRobert Watson void 279819ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 2799de5d9935SRobert Watson { 2800f079a0faSAlexander V. Chernikov struct bpf_if *bp, *bp_temp; 2801de5d9935SRobert Watson struct bpf_d *d; 28029a7e6bacSLawrence Stewart 2803afa85850SAlexander V. Chernikov BPF_LOCK(); 28049a7e6bacSLawrence Stewart /* Find all bpf_if struct's which reference ifp and detach them. */ 2805699281b5SAndrey V. Elsukov CK_LIST_FOREACH_SAFE(bp, &bpf_iflist, bif_next, bp_temp) { 2806f079a0faSAlexander V. Chernikov if (ifp != bp->bif_ifp) 2807f079a0faSAlexander V. Chernikov continue; 2808de5d9935SRobert Watson 2809699281b5SAndrey V. Elsukov CK_LIST_REMOVE(bp, bif_next); 28108bd1f0cfSMark Johnston *bp->bif_bpf = (struct bpf_if *)&dead_bpf_if; 2811f079a0faSAlexander V. Chernikov 2812699281b5SAndrey V. Elsukov CTR4(KTR_NET, 2813699281b5SAndrey V. Elsukov "%s: sheduling free for encap %d (%p) for if %p", 2814f079a0faSAlexander V. Chernikov __func__, bp->bif_dlt, bp, ifp); 2815f079a0faSAlexander V. Chernikov 2816699281b5SAndrey V. Elsukov /* Detach common descriptors */ 2817699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_dlist)) != NULL) { 2818699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 2819e7bb21b3SJonathan Lemon } 2820f079a0faSAlexander V. Chernikov 2821699281b5SAndrey V. Elsukov /* Detach writer-only descriptors */ 2822699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_wlist)) != NULL) { 2823699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 28246c74ff0eSAlexander V. Chernikov } 2825699281b5SAndrey V. Elsukov bpfif_rele(bp); 2826f079a0faSAlexander V. Chernikov } 2827f079a0faSAlexander V. Chernikov BPF_UNLOCK(); 2828afa85850SAlexander V. Chernikov } 2829afa85850SAlexander V. Chernikov 2830afa85850SAlexander V. Chernikov /* 28318eab61f3SSam Leffler * Get a list of available data link type of the interface. 28328eab61f3SSam Leffler */ 28338eab61f3SSam Leffler static int 283419ba8395SChristian S.J. Peron bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl) 28358eab61f3SSam Leffler { 28368eab61f3SSam Leffler struct ifnet *ifp; 28378eab61f3SSam Leffler struct bpf_if *bp; 283870209acaSKonstantin Belousov u_int *lst; 283970209acaSKonstantin Belousov int error, n, n1; 28408eab61f3SSam Leffler 284197aacec6SAlexander V. Chernikov BPF_LOCK_ASSERT(); 284297aacec6SAlexander V. Chernikov 28438eab61f3SSam Leffler ifp = d->bd_bif->bif_ifp; 284470209acaSKonstantin Belousov n1 = 0; 2845699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 284670209acaSKonstantin Belousov if (bp->bif_ifp == ifp) 284770209acaSKonstantin Belousov n1++; 284870209acaSKonstantin Belousov } 284970209acaSKonstantin Belousov if (bfl->bfl_list == NULL) { 285070209acaSKonstantin Belousov bfl->bfl_len = n1; 285170209acaSKonstantin Belousov return (0); 285270209acaSKonstantin Belousov } 285370209acaSKonstantin Belousov if (n1 > bfl->bfl_len) 285470209acaSKonstantin Belousov return (ENOMEM); 2855699281b5SAndrey V. Elsukov 285670209acaSKonstantin Belousov lst = malloc(n1 * sizeof(u_int), M_TEMP, M_WAITOK); 28578eab61f3SSam Leffler n = 0; 2858699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 28598eab61f3SSam Leffler if (bp->bif_ifp != ifp) 28608eab61f3SSam Leffler continue; 2861699281b5SAndrey V. Elsukov lst[n++] = bp->bif_dlt; 28628eab61f3SSam Leffler } 286370209acaSKonstantin Belousov error = copyout(lst, bfl->bfl_list, sizeof(u_int) * n); 286470209acaSKonstantin Belousov free(lst, M_TEMP); 28658eab61f3SSam Leffler bfl->bfl_len = n; 28668eab61f3SSam Leffler return (error); 28678eab61f3SSam Leffler } 28688eab61f3SSam Leffler 28698eab61f3SSam Leffler /* 28708eab61f3SSam Leffler * Set the data link type of a BPF instance. 28718eab61f3SSam Leffler */ 28728eab61f3SSam Leffler static int 287319ba8395SChristian S.J. Peron bpf_setdlt(struct bpf_d *d, u_int dlt) 28748eab61f3SSam Leffler { 28758eab61f3SSam Leffler int error, opromisc; 28768eab61f3SSam Leffler struct ifnet *ifp; 28778eab61f3SSam Leffler struct bpf_if *bp; 28788eab61f3SSam Leffler 28796c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 2880699281b5SAndrey V. Elsukov MPASS(d->bd_bif != NULL); 28816c74ff0eSAlexander V. Chernikov 2882699281b5SAndrey V. Elsukov /* 2883699281b5SAndrey V. Elsukov * It is safe to check bd_bif without BPFD_LOCK, it can not be 2884699281b5SAndrey V. Elsukov * changed while we hold global lock. 2885699281b5SAndrey V. Elsukov */ 28868eab61f3SSam Leffler if (d->bd_bif->bif_dlt == dlt) 28878eab61f3SSam Leffler return (0); 28886c74ff0eSAlexander V. Chernikov 2889699281b5SAndrey V. Elsukov ifp = d->bd_bif->bif_ifp; 2890699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 28918eab61f3SSam Leffler if (bp->bif_ifp == ifp && bp->bif_dlt == dlt) 28928eab61f3SSam Leffler break; 28938eab61f3SSam Leffler } 2894699281b5SAndrey V. Elsukov if (bp == NULL) 2895699281b5SAndrey V. Elsukov return (EINVAL); 28966c74ff0eSAlexander V. Chernikov 28978eab61f3SSam Leffler opromisc = d->bd_promisc; 28988eab61f3SSam Leffler bpf_attachd(d, bp); 28998eab61f3SSam Leffler if (opromisc) { 29008eab61f3SSam Leffler error = ifpromisc(bp->bif_ifp, 1); 29018eab61f3SSam Leffler if (error) 2902699281b5SAndrey V. Elsukov if_printf(bp->bif_ifp, "%s: ifpromisc failed (%d)\n", 2903699281b5SAndrey V. Elsukov __func__, error); 29048eab61f3SSam Leffler else 29058eab61f3SSam Leffler d->bd_promisc = 1; 29068eab61f3SSam Leffler } 2907699281b5SAndrey V. Elsukov return (0); 2908de5d9935SRobert Watson } 2909de5d9935SRobert Watson 29103f54a085SPoul-Henning Kamp static void 291119ba8395SChristian S.J. Peron bpf_drvinit(void *unused) 291253ac6efbSJulian Elischer { 2913136600feSEd Schouten struct cdev *dev; 291453ac6efbSJulian Elischer 2915f422673eSStephen Hurd sx_init(&bpf_sx, "bpf global lock"); 2916699281b5SAndrey V. Elsukov CK_LIST_INIT(&bpf_iflist); 2917136600feSEd Schouten 2918136600feSEd Schouten dev = make_dev(&bpf_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "bpf"); 2919136600feSEd Schouten /* For compatibility */ 2920136600feSEd Schouten make_dev_alias(dev, "bpf0"); 29217198bf47SJulian Elischer } 292253ac6efbSJulian Elischer 29230e37f3e1SChristian S.J. Peron /* 29240e37f3e1SChristian S.J. Peron * Zero out the various packet counters associated with all of the bpf 29250e37f3e1SChristian S.J. Peron * descriptors. At some point, we will probably want to get a bit more 29260e37f3e1SChristian S.J. Peron * granular and allow the user to specify descriptors to be zeroed. 29270e37f3e1SChristian S.J. Peron */ 29280e37f3e1SChristian S.J. Peron static void 29290e37f3e1SChristian S.J. Peron bpf_zero_counters(void) 29300e37f3e1SChristian S.J. Peron { 29310e37f3e1SChristian S.J. Peron struct bpf_if *bp; 29320e37f3e1SChristian S.J. Peron struct bpf_d *bd; 29330e37f3e1SChristian S.J. Peron 2934e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2935699281b5SAndrey V. Elsukov /* 2936699281b5SAndrey V. Elsukov * We are protected by global lock here, interfaces and 2937699281b5SAndrey V. Elsukov * descriptors can not be deleted while we hold it. 2938699281b5SAndrey V. Elsukov */ 2939699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 2940699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 2941b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_rcount); 2942b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_dcount); 2943b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_fcount); 2944b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wcount); 2945b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wfcount); 2946b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_zcopy); 29470e37f3e1SChristian S.J. Peron } 29480e37f3e1SChristian S.J. Peron } 2949e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 29500e37f3e1SChristian S.J. Peron } 29510e37f3e1SChristian S.J. Peron 29526c74ff0eSAlexander V. Chernikov /* 29536c74ff0eSAlexander V. Chernikov * Fill filter statistics 29546c74ff0eSAlexander V. Chernikov */ 295569f7644bSChristian S.J. Peron static void 295669f7644bSChristian S.J. Peron bpfstats_fill_xbpf(struct xbpf_d *d, struct bpf_d *bd) 295769f7644bSChristian S.J. Peron { 295869f7644bSChristian S.J. Peron 2959699281b5SAndrey V. Elsukov BPF_LOCK_ASSERT(); 296069f7644bSChristian S.J. Peron bzero(d, sizeof(*d)); 29614d621040SChristian S.J. Peron d->bd_structsize = sizeof(*d); 296269f7644bSChristian S.J. Peron d->bd_immediate = bd->bd_immediate; 296369f7644bSChristian S.J. Peron d->bd_promisc = bd->bd_promisc; 296469f7644bSChristian S.J. Peron d->bd_hdrcmplt = bd->bd_hdrcmplt; 2965560a54e1SJung-uk Kim d->bd_direction = bd->bd_direction; 2966560a54e1SJung-uk Kim d->bd_feedback = bd->bd_feedback; 296769f7644bSChristian S.J. Peron d->bd_async = bd->bd_async; 2968b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_fetch(bd->bd_rcount); 2969b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_fetch(bd->bd_dcount); 2970b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_fetch(bd->bd_fcount); 297169f7644bSChristian S.J. Peron d->bd_sig = bd->bd_sig; 297269f7644bSChristian S.J. Peron d->bd_slen = bd->bd_slen; 297369f7644bSChristian S.J. Peron d->bd_hlen = bd->bd_hlen; 297469f7644bSChristian S.J. Peron d->bd_bufsize = bd->bd_bufsize; 297569f7644bSChristian S.J. Peron d->bd_pid = bd->bd_pid; 297669f7644bSChristian S.J. Peron strlcpy(d->bd_ifname, 297769f7644bSChristian S.J. Peron bd->bd_bif->bif_ifp->if_xname, IFNAMSIZ); 297893e39f0bSChristian S.J. Peron d->bd_locked = bd->bd_locked; 2979b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_fetch(bd->bd_wcount); 2980b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_fetch(bd->bd_wdcount); 2981b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_fetch(bd->bd_wfcount); 2982b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_fetch(bd->bd_zcopy); 29834d621040SChristian S.J. Peron d->bd_bufmode = bd->bd_bufmode; 298469f7644bSChristian S.J. Peron } 298569f7644bSChristian S.J. Peron 29866c74ff0eSAlexander V. Chernikov /* 29876c74ff0eSAlexander V. Chernikov * Handle `netstat -B' stats request 29886c74ff0eSAlexander V. Chernikov */ 298969f7644bSChristian S.J. Peron static int 299069f7644bSChristian S.J. Peron bpf_stats_sysctl(SYSCTL_HANDLER_ARGS) 299169f7644bSChristian S.J. Peron { 29920e1152fcSHans Petter Selasky static const struct xbpf_d zerostats; 29930e1152fcSHans Petter Selasky struct xbpf_d *xbdbuf, *xbd, tempstats; 2994422a63daSChristian S.J. Peron int index, error; 299569f7644bSChristian S.J. Peron struct bpf_if *bp; 299669f7644bSChristian S.J. Peron struct bpf_d *bd; 299769f7644bSChristian S.J. Peron 299869f7644bSChristian S.J. Peron /* 299969f7644bSChristian S.J. Peron * XXX This is not technically correct. It is possible for non 300069f7644bSChristian S.J. Peron * privileged users to open bpf devices. It would make sense 300169f7644bSChristian S.J. Peron * if the users who opened the devices were able to retrieve 300269f7644bSChristian S.J. Peron * the statistics for them, too. 300369f7644bSChristian S.J. Peron */ 3004acd3428bSRobert Watson error = priv_check(req->td, PRIV_NET_BPF); 300569f7644bSChristian S.J. Peron if (error) 300669f7644bSChristian S.J. Peron return (error); 30070e37f3e1SChristian S.J. Peron /* 30080e37f3e1SChristian S.J. Peron * Check to see if the user is requesting that the counters be 30090e37f3e1SChristian S.J. Peron * zeroed out. Explicitly check that the supplied data is zeroed, 30100e37f3e1SChristian S.J. Peron * as we aren't allowing the user to set the counters currently. 30110e37f3e1SChristian S.J. Peron */ 30120e37f3e1SChristian S.J. Peron if (req->newptr != NULL) { 30130e1152fcSHans Petter Selasky if (req->newlen != sizeof(tempstats)) 30140e37f3e1SChristian S.J. Peron return (EINVAL); 30150e1152fcSHans Petter Selasky memset(&tempstats, 0, sizeof(tempstats)); 30160e1152fcSHans Petter Selasky error = SYSCTL_IN(req, &tempstats, sizeof(tempstats)); 30170e1152fcSHans Petter Selasky if (error) 30180e1152fcSHans Petter Selasky return (error); 30190e1152fcSHans Petter Selasky if (bcmp(&tempstats, &zerostats, sizeof(tempstats)) != 0) 30200e37f3e1SChristian S.J. Peron return (EINVAL); 30210e37f3e1SChristian S.J. Peron bpf_zero_counters(); 30220e37f3e1SChristian S.J. Peron return (0); 30230e37f3e1SChristian S.J. Peron } 302469f7644bSChristian S.J. Peron if (req->oldptr == NULL) 3025422a63daSChristian S.J. Peron return (SYSCTL_OUT(req, 0, bpf_bpfd_cnt * sizeof(*xbd))); 302669f7644bSChristian S.J. Peron if (bpf_bpfd_cnt == 0) 302769f7644bSChristian S.J. Peron return (SYSCTL_OUT(req, 0, 0)); 3028422a63daSChristian S.J. Peron xbdbuf = malloc(req->oldlen, M_BPF, M_WAITOK); 3029e4b3229aSAlexander V. Chernikov BPF_LOCK(); 3030422a63daSChristian S.J. Peron if (req->oldlen < (bpf_bpfd_cnt * sizeof(*xbd))) { 3031e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3032422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 3033422a63daSChristian S.J. Peron return (ENOMEM); 3034422a63daSChristian S.J. Peron } 3035422a63daSChristian S.J. Peron index = 0; 3036699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 303751ec1eb7SAlexander V. Chernikov /* Send writers-only first */ 3038699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_wlist, bd_next) { 303951ec1eb7SAlexander V. Chernikov xbd = &xbdbuf[index++]; 304051ec1eb7SAlexander V. Chernikov bpfstats_fill_xbpf(xbd, bd); 304151ec1eb7SAlexander V. Chernikov } 3042699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 3043422a63daSChristian S.J. Peron xbd = &xbdbuf[index++]; 3044422a63daSChristian S.J. Peron bpfstats_fill_xbpf(xbd, bd); 304569f7644bSChristian S.J. Peron } 304669f7644bSChristian S.J. Peron } 3047e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3048422a63daSChristian S.J. Peron error = SYSCTL_OUT(req, xbdbuf, index * sizeof(*xbd)); 3049422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 305069f7644bSChristian S.J. Peron return (error); 305169f7644bSChristian S.J. Peron } 305269f7644bSChristian S.J. Peron 3053237fdd78SRobert Watson SYSINIT(bpfdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE,bpf_drvinit,NULL); 305453ac6efbSJulian Elischer 30555bb5f2c9SPeter Wemm #else /* !DEV_BPF && !NETGRAPH_BPF */ 30568bd1f0cfSMark Johnston 3057f8dc4716SMike Smith /* 3058f8dc4716SMike Smith * NOP stubs to allow bpf-using drivers to load and function. 3059f8dc4716SMike Smith * 3060f8dc4716SMike Smith * A 'better' implementation would allow the core bpf functionality 3061f8dc4716SMike Smith * to be loaded at runtime. 3062f8dc4716SMike Smith */ 3063f8dc4716SMike Smith 3064f8dc4716SMike Smith void 306519ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 3066f8dc4716SMike Smith { 3067f8dc4716SMike Smith } 3068f8dc4716SMike Smith 3069f8dc4716SMike Smith void 307019ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 3071f8dc4716SMike Smith { 3072f8dc4716SMike Smith } 3073f8dc4716SMike Smith 3074f8dc4716SMike Smith void 307519ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *d, u_int l, struct mbuf *m) 3076437ffe18SSam Leffler { 3077437ffe18SSam Leffler } 3078437ffe18SSam Leffler 3079437ffe18SSam Leffler void 308019ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 3081f8dc4716SMike Smith { 30827eae78a4SChristian S.J. Peron 30837eae78a4SChristian S.J. Peron bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 3084f8dc4716SMike Smith } 3085f8dc4716SMike Smith 3086da626c17SBill Paul void 308719ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp) 30885f7a7923SSam Leffler { 30897eae78a4SChristian S.J. Peron 30908bd1f0cfSMark Johnston *driverp = (struct bpf_if *)&dead_bpf_if; 30915f7a7923SSam Leffler } 30925f7a7923SSam Leffler 30935f7a7923SSam Leffler void 309419ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 3095da626c17SBill Paul { 3096da626c17SBill Paul } 3097da626c17SBill Paul 3098f8dc4716SMike Smith u_int 309919ba8395SChristian S.J. Peron bpf_filter(const struct bpf_insn *pc, u_char *p, u_int wirelen, u_int buflen) 3100f8dc4716SMike Smith { 3101f8dc4716SMike Smith return -1; /* "no filter" behaviour */ 3102f8dc4716SMike Smith } 3103f8dc4716SMike Smith 31045bb5f2c9SPeter Wemm int 310519ba8395SChristian S.J. Peron bpf_validate(const struct bpf_insn *f, int len) 31065bb5f2c9SPeter Wemm { 31075bb5f2c9SPeter Wemm return 0; /* false */ 31085bb5f2c9SPeter Wemm } 31095bb5f2c9SPeter Wemm 31105bb5f2c9SPeter Wemm #endif /* !DEV_BPF && !NETGRAPH_BPF */ 311105fc4164SBjoern A. Zeeb 311205fc4164SBjoern A. Zeeb #ifdef DDB 311305fc4164SBjoern A. Zeeb static void 311405fc4164SBjoern A. Zeeb bpf_show_bpf_if(struct bpf_if *bpf_if) 311505fc4164SBjoern A. Zeeb { 311605fc4164SBjoern A. Zeeb 311705fc4164SBjoern A. Zeeb if (bpf_if == NULL) 311805fc4164SBjoern A. Zeeb return; 311905fc4164SBjoern A. Zeeb db_printf("%p:\n", bpf_if); 312005fc4164SBjoern A. Zeeb #define BPF_DB_PRINTF(f, e) db_printf(" %s = " f "\n", #e, bpf_if->e); 312105fc4164SBjoern A. Zeeb /* bif_ext.bif_next */ 312205fc4164SBjoern A. Zeeb /* bif_ext.bif_dlist */ 312305fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%#x", bif_dlt); 312405fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%u", bif_hdrlen); 312505fc4164SBjoern A. Zeeb /* bif_wlist */ 3126699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_ifp); 3127699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_bpf); 3128699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%u", bif_refcnt); 312905fc4164SBjoern A. Zeeb } 313005fc4164SBjoern A. Zeeb 313105fc4164SBjoern A. Zeeb DB_SHOW_COMMAND(bpf_if, db_show_bpf_if) 313205fc4164SBjoern A. Zeeb { 313305fc4164SBjoern A. Zeeb 313405fc4164SBjoern A. Zeeb if (!have_addr) { 313505fc4164SBjoern A. Zeeb db_printf("usage: show bpf_if <struct bpf_if *>\n"); 313605fc4164SBjoern A. Zeeb return; 313705fc4164SBjoern A. Zeeb } 313805fc4164SBjoern A. Zeeb 313905fc4164SBjoern A. Zeeb bpf_show_bpf_if((struct bpf_if *)addr); 314005fc4164SBjoern A. Zeeb } 314105fc4164SBjoern A. Zeeb #endif 3142