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); 216ded77e02SHartmut 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 261ded77e02SHartmut Brandt static struct filterops bpfwrite_filtops = { 262ded77e02SHartmut Brandt .f_isfd = 1, 263ded77e02SHartmut Brandt .f_detach = filt_bpfdetach, 264ded77e02SHartmut Brandt .f_event = filt_bpfwrite, 265ded77e02SHartmut Brandt }; 266ded77e02SHartmut 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); 766*426682b0SMark Johnston 767*426682b0SMark Johnston /* Trigger EVFILT_WRITE events. */ 768*426682b0SMark Johnston bpf_wakeup(d); 769*426682b0SMark Johnston 770afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 77151ec1eb7SAlexander V. Chernikov bpf_bpfd_cnt++; 77251ec1eb7SAlexander V. Chernikov 77351ec1eb7SAlexander V. Chernikov CTR3(KTR_NET, "%s: bpf_attach called by pid %d, adding to %s list", 77451ec1eb7SAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer ? "writer" : "active"); 77551ec1eb7SAlexander V. Chernikov 7766c74ff0eSAlexander V. Chernikov if (op_w == 0) 77751ec1eb7SAlexander V. Chernikov EVENTHANDLER_INVOKE(bpf_track, bp->bif_ifp, bp->bif_dlt, 1); 77851ec1eb7SAlexander V. Chernikov } 77951ec1eb7SAlexander V. Chernikov 78051ec1eb7SAlexander V. Chernikov /* 781402000ffSAlexander V. Chernikov * Check if we need to upgrade our descriptor @d from write-only mode. 782402000ffSAlexander V. Chernikov */ 783402000ffSAlexander V. Chernikov static int 784699281b5SAndrey V. Elsukov bpf_check_upgrade(u_long cmd, struct bpf_d *d, struct bpf_insn *fcode, 785699281b5SAndrey V. Elsukov int flen) 786402000ffSAlexander V. Chernikov { 787402000ffSAlexander V. Chernikov int is_snap, need_upgrade; 788402000ffSAlexander V. Chernikov 789402000ffSAlexander V. Chernikov /* 790402000ffSAlexander V. Chernikov * Check if we've already upgraded or new filter is empty. 791402000ffSAlexander V. Chernikov */ 792402000ffSAlexander V. Chernikov if (d->bd_writer == 0 || fcode == NULL) 793402000ffSAlexander V. Chernikov return (0); 794402000ffSAlexander V. Chernikov 795402000ffSAlexander V. Chernikov need_upgrade = 0; 796402000ffSAlexander V. Chernikov 797402000ffSAlexander V. Chernikov /* 798402000ffSAlexander V. Chernikov * Check if cmd looks like snaplen setting from 799402000ffSAlexander V. Chernikov * pcap_bpf.c:pcap_open_live(). 800402000ffSAlexander V. Chernikov * Note we're not checking .k value here: 801caa7e52fSEitan Adler * while pcap_open_live() definitely sets to non-zero value, 802402000ffSAlexander V. Chernikov * we'd prefer to treat k=0 (deny ALL) case the same way: e.g. 803402000ffSAlexander V. Chernikov * do not consider upgrading immediately 804402000ffSAlexander V. Chernikov */ 805699281b5SAndrey V. Elsukov if (cmd == BIOCSETF && flen == 1 && 806699281b5SAndrey V. Elsukov fcode[0].code == (BPF_RET | BPF_K)) 807402000ffSAlexander V. Chernikov is_snap = 1; 808402000ffSAlexander V. Chernikov else 809402000ffSAlexander V. Chernikov is_snap = 0; 810402000ffSAlexander V. Chernikov 811402000ffSAlexander V. Chernikov if (is_snap == 0) { 812402000ffSAlexander V. Chernikov /* 813402000ffSAlexander V. Chernikov * We're setting first filter and it doesn't look like 814402000ffSAlexander V. Chernikov * setting snaplen. We're probably using bpf directly. 815402000ffSAlexander V. Chernikov * Upgrade immediately. 816402000ffSAlexander V. Chernikov */ 817402000ffSAlexander V. Chernikov need_upgrade = 1; 818402000ffSAlexander V. Chernikov } else { 819402000ffSAlexander V. Chernikov /* 820402000ffSAlexander V. Chernikov * Do not require upgrade by first BIOCSETF 821402000ffSAlexander V. Chernikov * (used to set snaplen) by pcap_open_live(). 822402000ffSAlexander V. Chernikov */ 823402000ffSAlexander V. Chernikov 824402000ffSAlexander V. Chernikov if (--d->bd_writer == 0) { 825402000ffSAlexander V. Chernikov /* 826402000ffSAlexander V. Chernikov * First snaplen filter has already 827402000ffSAlexander V. Chernikov * been set. This is probably catch-all 828402000ffSAlexander V. Chernikov * filter 829402000ffSAlexander V. Chernikov */ 830402000ffSAlexander V. Chernikov need_upgrade = 1; 831402000ffSAlexander V. Chernikov } 832402000ffSAlexander V. Chernikov } 833402000ffSAlexander V. Chernikov 834402000ffSAlexander V. Chernikov CTR5(KTR_NET, 835402000ffSAlexander V. Chernikov "%s: filter function set by pid %d, " 836402000ffSAlexander V. Chernikov "bd_writer counter %d, snap %d upgrade %d", 837402000ffSAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer, 838402000ffSAlexander V. Chernikov is_snap, need_upgrade); 839402000ffSAlexander V. Chernikov 840402000ffSAlexander V. Chernikov return (need_upgrade); 841402000ffSAlexander V. Chernikov } 842402000ffSAlexander V. Chernikov 843402000ffSAlexander V. Chernikov /* 844df8bae1dSRodney W. Grimes * Detach a file from its interface. 845df8bae1dSRodney W. Grimes */ 846df8bae1dSRodney W. Grimes static void 84719ba8395SChristian S.J. Peron bpf_detachd(struct bpf_d *d) 848df8bae1dSRodney W. Grimes { 8496c74ff0eSAlexander V. Chernikov BPF_LOCK(); 850699281b5SAndrey V. Elsukov bpf_detachd_locked(d, false); 8516c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 8526c74ff0eSAlexander V. Chernikov } 8536c74ff0eSAlexander V. Chernikov 8546c74ff0eSAlexander V. Chernikov static void 855699281b5SAndrey V. Elsukov bpf_detachd_locked(struct bpf_d *d, bool detached_ifp) 8566c74ff0eSAlexander V. Chernikov { 857df8bae1dSRodney W. Grimes struct bpf_if *bp; 85846448b5aSRobert Watson struct ifnet *ifp; 859699281b5SAndrey V. Elsukov int error; 86051ec1eb7SAlexander V. Chernikov 861e4b3229aSAlexander V. Chernikov BPF_LOCK_ASSERT(); 862699281b5SAndrey V. Elsukov CTR2(KTR_NET, "%s: detach required by pid %d", __func__, d->bd_pid); 863e4b3229aSAlexander V. Chernikov 8646c74ff0eSAlexander V. Chernikov /* Check if descriptor is attached */ 8656c74ff0eSAlexander V. Chernikov if ((bp = d->bd_bif) == NULL) 8666c74ff0eSAlexander V. Chernikov return; 8676c74ff0eSAlexander V. Chernikov 868afa85850SAlexander V. Chernikov BPFD_LOCK(d); 869de253273SAndrey V. Elsukov /* Remove d from the interface's descriptor list. */ 870de253273SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 87151ec1eb7SAlexander V. Chernikov /* Save bd_writer value */ 87251ec1eb7SAlexander V. Chernikov error = d->bd_writer; 873e4b3229aSAlexander V. Chernikov ifp = bp->bif_ifp; 874572bde2aSRobert Watson d->bd_bif = NULL; 875699281b5SAndrey V. Elsukov if (detached_ifp) { 876699281b5SAndrey V. Elsukov /* 877699281b5SAndrey V. Elsukov * Notify descriptor as it's detached, so that any 878699281b5SAndrey V. Elsukov * sleepers wake up and get ENXIO. 879699281b5SAndrey V. Elsukov */ 880699281b5SAndrey V. Elsukov bpf_wakeup(d); 881699281b5SAndrey V. Elsukov } 882afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 883e4b3229aSAlexander V. Chernikov bpf_bpfd_cnt--; 88446448b5aSRobert Watson 88551ec1eb7SAlexander V. Chernikov /* Call event handler iff d is attached */ 88651ec1eb7SAlexander V. Chernikov if (error == 0) 8875ce8d970SSam Leffler EVENTHANDLER_INVOKE(bpf_track, ifp, bp->bif_dlt, 0); 888b743c310SSam Leffler 889df8bae1dSRodney W. Grimes /* 890df8bae1dSRodney W. Grimes * Check if this descriptor had requested promiscuous mode. 891699281b5SAndrey V. Elsukov * If so and ifnet is not detached, turn it off. 892df8bae1dSRodney W. Grimes */ 893699281b5SAndrey V. Elsukov if (d->bd_promisc && !detached_ifp) { 894df8bae1dSRodney W. Grimes d->bd_promisc = 0; 89597021c24SMarko Zec CURVNET_SET(ifp->if_vnet); 89646448b5aSRobert Watson error = ifpromisc(ifp, 0); 89797021c24SMarko Zec CURVNET_RESTORE(); 8986e891d64SPoul-Henning Kamp if (error != 0 && error != ENXIO) { 899df8bae1dSRodney W. Grimes /* 9006e891d64SPoul-Henning Kamp * ENXIO can happen if a pccard is unplugged 901df8bae1dSRodney W. Grimes * Something is really wrong if we were able to put 902df8bae1dSRodney W. Grimes * the driver into promiscuous mode, but can't 903df8bae1dSRodney W. Grimes * take it out. 904df8bae1dSRodney W. Grimes */ 9058eab61f3SSam Leffler if_printf(bp->bif_ifp, 9068eab61f3SSam Leffler "bpf_detach: ifpromisc failed (%d)\n", error); 9076e891d64SPoul-Henning Kamp } 908df8bae1dSRodney W. Grimes } 909699281b5SAndrey V. Elsukov bpfif_rele(bp); 910df8bae1dSRodney W. Grimes } 911df8bae1dSRodney W. Grimes 912df8bae1dSRodney W. Grimes /* 913136600feSEd Schouten * Close the descriptor by detaching it from its interface, 914136600feSEd Schouten * deallocating its buffers, and marking it free. 915136600feSEd Schouten */ 916136600feSEd Schouten static void 917136600feSEd Schouten bpf_dtor(void *data) 918136600feSEd Schouten { 919136600feSEd Schouten struct bpf_d *d = data; 920136600feSEd Schouten 921afa85850SAlexander V. Chernikov BPFD_LOCK(d); 922136600feSEd Schouten if (d->bd_state == BPF_WAITING) 923136600feSEd Schouten callout_stop(&d->bd_callout); 924136600feSEd Schouten d->bd_state = BPF_IDLE; 925afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 926136600feSEd Schouten funsetown(&d->bd_sigio); 927136600feSEd Schouten bpf_detachd(d); 928136600feSEd Schouten #ifdef MAC 929136600feSEd Schouten mac_bpfdesc_destroy(d); 930136600feSEd Schouten #endif /* MAC */ 9316aba400aSAttilio Rao seldrain(&d->bd_sel); 932136600feSEd Schouten knlist_destroy(&d->bd_sel.si_note); 9339fee1bd1SJung-uk Kim callout_drain(&d->bd_callout); 934699281b5SAndrey V. Elsukov bpfd_rele(d); 935136600feSEd Schouten } 936136600feSEd Schouten 937136600feSEd Schouten /* 938df8bae1dSRodney W. Grimes * Open ethernet device. Returns ENXIO for illegal minor device number, 939df8bae1dSRodney W. Grimes * EBUSY if file is open by another process. 940df8bae1dSRodney W. Grimes */ 941df8bae1dSRodney W. Grimes /* ARGSUSED */ 94287f6c662SJulian Elischer static int 94319ba8395SChristian S.J. Peron bpfopen(struct cdev *dev, int flags, int fmt, struct thread *td) 944df8bae1dSRodney W. Grimes { 945e7bb21b3SJonathan Lemon struct bpf_d *d; 9464f42daa4SLuiz Otavio O Souza int error; 947df8bae1dSRodney W. Grimes 9481ede983cSDag-Erling Smørgrav d = malloc(sizeof(*d), M_BPF, M_WAITOK | M_ZERO); 949136600feSEd Schouten error = devfs_set_cdevpriv(d, bpf_dtor); 950136600feSEd Schouten if (error != 0) { 951136600feSEd Schouten free(d, M_BPF); 952136600feSEd Schouten return (error); 953136600feSEd Schouten } 9544d621040SChristian S.J. Peron 955b2b7ca49SAlexander V. Chernikov /* Setup counters */ 956b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_alloc(M_WAITOK); 957b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_alloc(M_WAITOK); 958b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_alloc(M_WAITOK); 959b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_alloc(M_WAITOK); 960b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_alloc(M_WAITOK); 961b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_alloc(M_WAITOK); 962b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_alloc(M_WAITOK); 963b2b7ca49SAlexander V. Chernikov 9644d621040SChristian S.J. Peron /* 9654d621040SChristian S.J. Peron * For historical reasons, perform a one-time initialization call to 9664d621040SChristian S.J. Peron * the buffer routines, even though we're not yet committed to a 9674d621040SChristian S.J. Peron * particular buffer method. 9684d621040SChristian S.J. Peron */ 9694d621040SChristian S.J. Peron bpf_buffer_init(d); 97071448753SAlexander Motin if ((flags & FREAD) == 0) 97171448753SAlexander Motin d->bd_writer = 2; 9723b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 9734d621040SChristian S.J. Peron d->bd_bufmode = BPF_BUFMODE_BUFFER; 97400a83887SPaul Traina d->bd_sig = SIGIO; 975560a54e1SJung-uk Kim d->bd_direction = BPF_D_INOUT; 976699281b5SAndrey V. Elsukov d->bd_refcnt = 1; 977e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 97882f4445dSRobert Watson #ifdef MAC 97930d239bcSRobert Watson mac_bpfdesc_init(d); 98030d239bcSRobert Watson mac_bpfdesc_create(td->td_ucred, d); 98182f4445dSRobert Watson #endif 982afa85850SAlexander V. Chernikov mtx_init(&d->bd_lock, devtoname(dev), "bpf cdev lock", MTX_DEF); 983afa85850SAlexander V. Chernikov callout_init_mtx(&d->bd_callout, &d->bd_lock, 0); 984afa85850SAlexander V. Chernikov knlist_init_mtx(&d->bd_sel.si_note, &d->bd_lock); 985df8bae1dSRodney W. Grimes 9861e7fe2fbSLuiz Otavio O Souza /* Disable VLAN pcp tagging. */ 9871e7fe2fbSLuiz Otavio O Souza d->bd_pcp = 0; 9881e7fe2fbSLuiz Otavio O Souza 989df8bae1dSRodney W. Grimes return (0); 990df8bae1dSRodney W. Grimes } 991df8bae1dSRodney W. Grimes 992df8bae1dSRodney W. Grimes /* 993df8bae1dSRodney W. Grimes * bpfread - read next chunk of packets from buffers 994df8bae1dSRodney W. Grimes */ 99587f6c662SJulian Elischer static int 99619ba8395SChristian S.J. Peron bpfread(struct cdev *dev, struct uio *uio, int ioflag) 997df8bae1dSRodney W. Grimes { 998136600feSEd Schouten struct bpf_d *d; 999df8bae1dSRodney W. Grimes int error; 10008df67d77SJung-uk Kim int non_block; 10018df67d77SJung-uk Kim int timed_out; 1002df8bae1dSRodney W. Grimes 1003136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1004136600feSEd Schouten if (error != 0) 1005136600feSEd Schouten return (error); 1006136600feSEd Schouten 1007df8bae1dSRodney W. Grimes /* 1008df8bae1dSRodney W. Grimes * Restrict application to use a buffer the same size as 1009df8bae1dSRodney W. Grimes * as kernel buffers. 1010df8bae1dSRodney W. Grimes */ 1011df8bae1dSRodney W. Grimes if (uio->uio_resid != d->bd_bufsize) 1012df8bae1dSRodney W. Grimes return (EINVAL); 1013df8bae1dSRodney W. Grimes 10148df67d77SJung-uk Kim non_block = ((ioflag & O_NONBLOCK) != 0); 10158df67d77SJung-uk Kim 1016afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1017e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 10184d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) { 1019afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 10204d621040SChristian S.J. Peron return (EOPNOTSUPP); 10214d621040SChristian S.J. Peron } 102281bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 102381bda851SJohn Polstra callout_stop(&d->bd_callout); 102481bda851SJohn Polstra timed_out = (d->bd_state == BPF_TIMED_OUT); 102581bda851SJohn Polstra d->bd_state = BPF_IDLE; 1026d013d902SGuy Helmer while (d->bd_hbuf_in_use) { 1027d013d902SGuy Helmer error = mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 10283b3b91e7SGuy Helmer PRINET|PCATCH, "bd_hbuf", 0); 1029d013d902SGuy Helmer if (error != 0) { 1030d013d902SGuy Helmer BPFD_UNLOCK(d); 1031d013d902SGuy Helmer return (error); 1032d013d902SGuy Helmer } 1033d013d902SGuy Helmer } 1034df8bae1dSRodney W. Grimes /* 1035df8bae1dSRodney W. Grimes * If the hold buffer is empty, then do a timed sleep, which 1036df8bae1dSRodney W. Grimes * ends when the timeout expires or when enough packets 1037df8bae1dSRodney W. Grimes * have arrived to fill the store buffer. 1038df8bae1dSRodney W. Grimes */ 1039572bde2aSRobert Watson while (d->bd_hbuf == NULL) { 10408df67d77SJung-uk Kim if (d->bd_slen != 0) { 1041df8bae1dSRodney W. Grimes /* 1042df8bae1dSRodney W. Grimes * A packet(s) either arrived since the previous 1043df8bae1dSRodney W. Grimes * read or arrived while we were asleep. 10448df67d77SJung-uk Kim */ 10458df67d77SJung-uk Kim if (d->bd_immediate || non_block || timed_out) { 10468df67d77SJung-uk Kim /* 10478df67d77SJung-uk Kim * Rotate the buffers and return what's here 10488df67d77SJung-uk Kim * if we are in immediate mode, non-blocking 10498df67d77SJung-uk Kim * flag is set, or this descriptor timed out. 1050df8bae1dSRodney W. Grimes */ 1051df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1052df8bae1dSRodney W. Grimes break; 1053df8bae1dSRodney W. Grimes } 10548df67d77SJung-uk Kim } 1055de5d9935SRobert Watson 1056de5d9935SRobert Watson /* 1057de5d9935SRobert Watson * No data is available, check to see if the bpf device 1058de5d9935SRobert Watson * is still pointed at a real interface. If not, return 1059de5d9935SRobert Watson * ENXIO so that the userland process knows to rebind 1060de5d9935SRobert Watson * it before using it again. 1061de5d9935SRobert Watson */ 1062de5d9935SRobert Watson if (d->bd_bif == NULL) { 1063afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1064de5d9935SRobert Watson return (ENXIO); 1065de5d9935SRobert Watson } 1066de5d9935SRobert Watson 10678df67d77SJung-uk Kim if (non_block) { 1068afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1069fba3cfdeSJohn Polstra return (EWOULDBLOCK); 1070fba3cfdeSJohn Polstra } 1071afa85850SAlexander V. Chernikov error = msleep(d, &d->bd_lock, PRINET|PCATCH, 1072e7bb21b3SJonathan Lemon "bpf", d->bd_rtout); 1073df8bae1dSRodney W. Grimes if (error == EINTR || error == ERESTART) { 1074afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1075df8bae1dSRodney W. Grimes return (error); 1076df8bae1dSRodney W. Grimes } 1077df8bae1dSRodney W. Grimes if (error == EWOULDBLOCK) { 1078df8bae1dSRodney W. Grimes /* 1079df8bae1dSRodney W. Grimes * On a timeout, return what's in the buffer, 1080df8bae1dSRodney W. Grimes * which may be nothing. If there is something 1081df8bae1dSRodney W. Grimes * in the store buffer, we can rotate the buffers. 1082df8bae1dSRodney W. Grimes */ 1083df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1084df8bae1dSRodney W. Grimes /* 1085df8bae1dSRodney W. Grimes * We filled up the buffer in between 1086df8bae1dSRodney W. Grimes * getting the timeout and arriving 1087df8bae1dSRodney W. Grimes * here, so we don't need to rotate. 1088df8bae1dSRodney W. Grimes */ 1089df8bae1dSRodney W. Grimes break; 1090df8bae1dSRodney W. Grimes 1091df8bae1dSRodney W. Grimes if (d->bd_slen == 0) { 1092afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1093df8bae1dSRodney W. Grimes return (0); 1094df8bae1dSRodney W. Grimes } 1095df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1096df8bae1dSRodney W. Grimes break; 1097df8bae1dSRodney W. Grimes } 1098df8bae1dSRodney W. Grimes } 1099df8bae1dSRodney W. Grimes /* 1100df8bae1dSRodney W. Grimes * At this point, we know we have something in the hold slot. 1101df8bae1dSRodney W. Grimes */ 11023b3b91e7SGuy Helmer d->bd_hbuf_in_use = 1; 1103afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1104df8bae1dSRodney W. Grimes 1105df8bae1dSRodney W. Grimes /* 1106df8bae1dSRodney W. Grimes * Move data from hold buffer into user space. 1107df8bae1dSRodney W. Grimes * We know the entire buffer is transferred since 1108df8bae1dSRodney W. Grimes * we checked above that the read buffer is bpf_bufsize bytes. 110931b32e6dSRobert Watson * 11103b3b91e7SGuy Helmer * We do not have to worry about simultaneous reads because 11113b3b91e7SGuy Helmer * we waited for sole access to the hold buffer above. 1112df8bae1dSRodney W. Grimes */ 11134d621040SChristian S.J. Peron error = bpf_uiomove(d, d->bd_hbuf, d->bd_hlen, uio); 1114df8bae1dSRodney W. Grimes 1115afa85850SAlexander V. Chernikov BPFD_LOCK(d); 11163b3b91e7SGuy Helmer KASSERT(d->bd_hbuf != NULL, ("bpfread: lost bd_hbuf")); 1117df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1118572bde2aSRobert Watson d->bd_hbuf = NULL; 1119df8bae1dSRodney W. Grimes d->bd_hlen = 0; 112029f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 11213b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 11223b3b91e7SGuy Helmer wakeup(&d->bd_hbuf_in_use); 1123afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1124df8bae1dSRodney W. Grimes 1125df8bae1dSRodney W. Grimes return (error); 1126df8bae1dSRodney W. Grimes } 1127df8bae1dSRodney W. Grimes 1128df8bae1dSRodney W. Grimes /* 1129df8bae1dSRodney W. Grimes * If there are processes sleeping on this descriptor, wake them up. 1130df8bae1dSRodney W. Grimes */ 1131e7bb21b3SJonathan Lemon static __inline void 113219ba8395SChristian S.J. Peron bpf_wakeup(struct bpf_d *d) 1133df8bae1dSRodney W. Grimes { 1134a3272e3cSChristian S.J. Peron 1135afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 113681bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 113781bda851SJohn Polstra callout_stop(&d->bd_callout); 113881bda851SJohn Polstra d->bd_state = BPF_IDLE; 113981bda851SJohn Polstra } 1140521f364bSDag-Erling Smørgrav wakeup(d); 1141831d27a9SDon Lewis if (d->bd_async && d->bd_sig && d->bd_sigio) 1142f1320723SAlfred Perlstein pgsigio(&d->bd_sigio, d->bd_sig, 0); 114300a83887SPaul Traina 1144512824f8SSeigo Tanimura selwakeuppri(&d->bd_sel, PRINET); 1145ad3b9257SJohn-Mark Gurney KNOTE_LOCKED(&d->bd_sel.si_note, 0); 1146df8bae1dSRodney W. Grimes } 1147df8bae1dSRodney W. Grimes 114881bda851SJohn Polstra static void 114919ba8395SChristian S.J. Peron bpf_timed_out(void *arg) 115081bda851SJohn Polstra { 115181bda851SJohn Polstra struct bpf_d *d = (struct bpf_d *)arg; 115281bda851SJohn Polstra 1153afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11549fee1bd1SJung-uk Kim 1155699281b5SAndrey V. Elsukov if (callout_pending(&d->bd_callout) || 1156699281b5SAndrey V. Elsukov !callout_active(&d->bd_callout)) 11579fee1bd1SJung-uk Kim return; 115881bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 115981bda851SJohn Polstra d->bd_state = BPF_TIMED_OUT; 116081bda851SJohn Polstra if (d->bd_slen != 0) 116181bda851SJohn Polstra bpf_wakeup(d); 116281bda851SJohn Polstra } 116381bda851SJohn Polstra } 116481bda851SJohn Polstra 116587f6c662SJulian Elischer static int 11664d621040SChristian S.J. Peron bpf_ready(struct bpf_d *d) 11674d621040SChristian S.J. Peron { 11684d621040SChristian S.J. Peron 1169afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11704d621040SChristian S.J. Peron 11714d621040SChristian S.J. Peron if (!bpf_canfreebuf(d) && d->bd_hlen != 0) 11724d621040SChristian S.J. Peron return (1); 11734d621040SChristian S.J. Peron if ((d->bd_immediate || d->bd_state == BPF_TIMED_OUT) && 11744d621040SChristian S.J. Peron d->bd_slen != 0) 11754d621040SChristian S.J. Peron return (1); 11764d621040SChristian S.J. Peron return (0); 11774d621040SChristian S.J. Peron } 11784d621040SChristian S.J. Peron 11794d621040SChristian S.J. Peron static int 118019ba8395SChristian S.J. Peron bpfwrite(struct cdev *dev, struct uio *uio, int ioflag) 1181df8bae1dSRodney W. Grimes { 1182699281b5SAndrey V. Elsukov struct route ro; 1183699281b5SAndrey V. Elsukov struct sockaddr dst; 1184699281b5SAndrey V. Elsukov struct epoch_tracker et; 1185699281b5SAndrey V. Elsukov struct bpf_if *bp; 1186136600feSEd Schouten struct bpf_d *d; 1187df8bae1dSRodney W. Grimes struct ifnet *ifp; 1188560a54e1SJung-uk Kim struct mbuf *m, *mc; 1189560a54e1SJung-uk Kim int error, hlen; 1190df8bae1dSRodney W. Grimes 1191136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1192136600feSEd Schouten if (error != 0) 1193136600feSEd Schouten return (error); 1194136600feSEd Schouten 1195699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 1196699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1197e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 1198b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wcount, 1); 1199699281b5SAndrey V. Elsukov if ((bp = d->bd_bif) == NULL) { 1200699281b5SAndrey V. Elsukov error = ENXIO; 1201699281b5SAndrey V. Elsukov goto out_locked; 12024d621040SChristian S.J. Peron } 1203df8bae1dSRodney W. Grimes 1204699281b5SAndrey V. Elsukov ifp = bp->bif_ifp; 12054d621040SChristian S.J. Peron if ((ifp->if_flags & IFF_UP) == 0) { 1206699281b5SAndrey V. Elsukov error = ENETDOWN; 1207699281b5SAndrey V. Elsukov goto out_locked; 12084d621040SChristian S.J. Peron } 12093518d220SSam Leffler 1210699281b5SAndrey V. Elsukov if (uio->uio_resid == 0) 1211699281b5SAndrey V. Elsukov goto out_locked; 1212df8bae1dSRodney W. Grimes 12138240bf1eSRobert Watson bzero(&dst, sizeof(dst)); 1214d83e603aSChristian S.J. Peron m = NULL; 1215d83e603aSChristian S.J. Peron hlen = 0; 1216699281b5SAndrey V. Elsukov 1217699281b5SAndrey V. Elsukov /* 1218699281b5SAndrey V. Elsukov * Take extra reference, unlock d and exit from epoch section, 1219699281b5SAndrey V. Elsukov * since bpf_movein() can sleep. 1220699281b5SAndrey V. Elsukov */ 1221699281b5SAndrey V. Elsukov bpfd_ref(d); 1222699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1223699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1224699281b5SAndrey V. Elsukov 1225699281b5SAndrey V. Elsukov error = bpf_movein(uio, (int)bp->bif_dlt, ifp, 12264fb3a820SAlexander V. Chernikov &m, &dst, &hlen, d); 1227699281b5SAndrey V. Elsukov 1228699281b5SAndrey V. Elsukov if (error != 0) { 1229b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1230699281b5SAndrey V. Elsukov bpfd_rele(d); 1231df8bae1dSRodney W. Grimes return (error); 12324d621040SChristian S.J. Peron } 1233699281b5SAndrey V. Elsukov 1234699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1235699281b5SAndrey V. Elsukov /* 1236699281b5SAndrey V. Elsukov * Check that descriptor is still attached to the interface. 1237699281b5SAndrey V. Elsukov * This can happen on bpfdetach(). To avoid access to detached 1238699281b5SAndrey V. Elsukov * ifnet, free mbuf and return ENXIO. 1239699281b5SAndrey V. Elsukov */ 1240699281b5SAndrey V. Elsukov if (d->bd_bif == NULL) { 1241699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1242699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1243699281b5SAndrey V. Elsukov bpfd_rele(d); 1244699281b5SAndrey V. Elsukov m_freem(m); 1245699281b5SAndrey V. Elsukov return (ENXIO); 1246699281b5SAndrey V. Elsukov } 1247b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wfcount, 1); 1248114ae644SMike Smith if (d->bd_hdrcmplt) 1249114ae644SMike Smith dst.sa_family = pseudo_AF_HDRCMPLT; 1250114ae644SMike Smith 1251560a54e1SJung-uk Kim if (d->bd_feedback) { 1252eb1b1807SGleb Smirnoff mc = m_dup(m, M_NOWAIT); 1253560a54e1SJung-uk Kim if (mc != NULL) 1254560a54e1SJung-uk Kim mc->m_pkthdr.rcvif = ifp; 12558cd892f7SJung-uk Kim /* Set M_PROMISC for outgoing packets to be discarded. */ 12568cd892f7SJung-uk Kim if (d->bd_direction == BPF_D_INOUT) 12578cd892f7SJung-uk Kim m->m_flags |= M_PROMISC; 1258560a54e1SJung-uk Kim } else 1259560a54e1SJung-uk Kim mc = NULL; 1260560a54e1SJung-uk Kim 1261560a54e1SJung-uk Kim m->m_pkthdr.len -= hlen; 1262560a54e1SJung-uk Kim m->m_len -= hlen; 1263560a54e1SJung-uk Kim m->m_data += hlen; /* XXX */ 1264560a54e1SJung-uk Kim 126521ca7b57SMarko Zec CURVNET_SET(ifp->if_vnet); 126682f4445dSRobert Watson #ifdef MAC 126730d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, m); 1268560a54e1SJung-uk Kim if (mc != NULL) 126930d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, mc); 127082f4445dSRobert Watson #endif 1271560a54e1SJung-uk Kim 12724fb3a820SAlexander V. Chernikov bzero(&ro, sizeof(ro)); 12734fb3a820SAlexander V. Chernikov if (hlen != 0) { 12744fb3a820SAlexander V. Chernikov ro.ro_prepend = (u_char *)&dst.sa_data; 12754fb3a820SAlexander V. Chernikov ro.ro_plen = hlen; 12764fb3a820SAlexander V. Chernikov ro.ro_flags = RT_HAS_HEADER; 12774fb3a820SAlexander V. Chernikov } 12784fb3a820SAlexander V. Chernikov 12791e7fe2fbSLuiz Otavio O Souza if (d->bd_pcp != 0) 12809ef8cd0bSKristof Provost vlan_set_pcp(m, d->bd_pcp); 12811e7fe2fbSLuiz Otavio O Souza 128282d7bf6bSAndrey V. Elsukov /* Avoid possible recursion on BPFD_LOCK(). */ 128382d7bf6bSAndrey V. Elsukov NET_EPOCH_ENTER(et); 128482d7bf6bSAndrey V. Elsukov BPFD_UNLOCK(d); 12854fb3a820SAlexander V. Chernikov error = (*ifp->if_output)(ifp, m, &dst, &ro); 12864d621040SChristian S.J. Peron if (error) 1287b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1288560a54e1SJung-uk Kim 1289560a54e1SJung-uk Kim if (mc != NULL) { 12900bf686c1SRobert Watson if (error == 0) 1291560a54e1SJung-uk Kim (*ifp->if_input)(ifp, mc); 12920bf686c1SRobert Watson else 1293560a54e1SJung-uk Kim m_freem(mc); 1294560a54e1SJung-uk Kim } 129582d7bf6bSAndrey V. Elsukov NET_EPOCH_EXIT(et); 129621ca7b57SMarko Zec CURVNET_RESTORE(); 1297699281b5SAndrey V. Elsukov bpfd_rele(d); 1298699281b5SAndrey V. Elsukov return (error); 1299560a54e1SJung-uk Kim 1300699281b5SAndrey V. Elsukov out_locked: 1301699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1302699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1303699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1304df8bae1dSRodney W. Grimes return (error); 1305df8bae1dSRodney W. Grimes } 1306df8bae1dSRodney W. Grimes 1307df8bae1dSRodney W. Grimes /* 1308e82669d9SRobert Watson * Reset a descriptor by flushing its packet buffer and clearing the receive 1309e82669d9SRobert Watson * and drop counts. This is doable for kernel-only buffers, but with 1310e82669d9SRobert Watson * zero-copy buffers, we can't write to (or rotate) buffers that are 1311e82669d9SRobert Watson * currently owned by userspace. It would be nice if we could encapsulate 1312e82669d9SRobert Watson * this logic in the buffer code rather than here. 1313df8bae1dSRodney W. Grimes */ 1314df8bae1dSRodney W. Grimes static void 131519ba8395SChristian S.J. Peron reset_d(struct bpf_d *d) 1316df8bae1dSRodney W. Grimes { 1317e7bb21b3SJonathan Lemon 1318afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 1319e82669d9SRobert Watson 13203b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 13213b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, PRINET, 13223b3b91e7SGuy Helmer "bd_hbuf", 0); 1323e82669d9SRobert Watson if ((d->bd_hbuf != NULL) && 1324e82669d9SRobert Watson (d->bd_bufmode != BPF_BUFMODE_ZBUF || bpf_canfreebuf(d))) { 1325df8bae1dSRodney W. Grimes /* Free the hold buffer. */ 1326df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1327572bde2aSRobert Watson d->bd_hbuf = NULL; 1328e82669d9SRobert Watson d->bd_hlen = 0; 132929f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 1330df8bae1dSRodney W. Grimes } 1331e82669d9SRobert Watson if (bpf_canwritebuf(d)) 1332df8bae1dSRodney W. Grimes d->bd_slen = 0; 1333b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_rcount); 1334b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_dcount); 1335b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_fcount); 1336b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wcount); 1337b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wfcount); 1338b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wdcount); 1339b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_zcopy); 1340df8bae1dSRodney W. Grimes } 1341df8bae1dSRodney W. Grimes 1342df8bae1dSRodney W. Grimes /* 1343df8bae1dSRodney W. Grimes * FIONREAD Check for read packet available. 1344df8bae1dSRodney W. Grimes * BIOCGBLEN Get buffer len [for read()]. 1345f11c3508SDavid Malone * BIOCSETF Set read filter. 1346f11c3508SDavid Malone * BIOCSETFNR Set read filter without resetting descriptor. 1347f11c3508SDavid Malone * BIOCSETWF Set write filter. 1348df8bae1dSRodney W. Grimes * BIOCFLUSH Flush read packet buffer. 1349df8bae1dSRodney W. Grimes * BIOCPROMISC Put interface into promiscuous mode. 1350df8bae1dSRodney W. Grimes * BIOCGDLT Get link layer type. 1351df8bae1dSRodney W. Grimes * BIOCGETIF Get interface name. 1352df8bae1dSRodney W. Grimes * BIOCSETIF Set interface. 1353df8bae1dSRodney W. Grimes * BIOCSRTIMEOUT Set read timeout. 1354df8bae1dSRodney W. Grimes * BIOCGRTIMEOUT Get read timeout. 1355df8bae1dSRodney W. Grimes * BIOCGSTATS Get packet stats. 1356df8bae1dSRodney W. Grimes * BIOCIMMEDIATE Set immediate mode. 1357df8bae1dSRodney W. Grimes * BIOCVERSION Get filter language version. 1358114ae644SMike Smith * BIOCGHDRCMPLT Get "header already complete" flag 1359114ae644SMike Smith * BIOCSHDRCMPLT Set "header already complete" flag 1360560a54e1SJung-uk Kim * BIOCGDIRECTION Get packet direction flag 1361560a54e1SJung-uk Kim * BIOCSDIRECTION Set packet direction flag 1362547d94bdSJung-uk Kim * BIOCGTSTAMP Get time stamp format and resolution. 1363547d94bdSJung-uk Kim * BIOCSTSTAMP Set time stamp format and resolution. 136493e39f0bSChristian S.J. Peron * BIOCLOCK Set "locked" flag 1365560a54e1SJung-uk Kim * BIOCFEEDBACK Set packet feedback mode. 13664d621040SChristian S.J. Peron * BIOCSETZBUF Set current zero-copy buffer locations. 13674d621040SChristian S.J. Peron * BIOCGETZMAX Get maximum zero-copy buffer size. 13684d621040SChristian S.J. Peron * BIOCROTZBUF Force rotation of zero-copy buffer 13694d621040SChristian S.J. Peron * BIOCSETBUFMODE Set buffer mode. 13704d621040SChristian S.J. Peron * BIOCGETBUFMODE Get current buffer mode. 13711e7fe2fbSLuiz Otavio O Souza * BIOCSETVLANPCP Set VLAN PCP tag. 1372df8bae1dSRodney W. Grimes */ 1373df8bae1dSRodney W. Grimes /* ARGSUSED */ 137487f6c662SJulian Elischer static int 137519ba8395SChristian S.J. Peron bpfioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, 137619ba8395SChristian S.J. Peron struct thread *td) 1377df8bae1dSRodney W. Grimes { 1378136600feSEd Schouten struct bpf_d *d; 1379136600feSEd Schouten int error; 1380136600feSEd Schouten 1381136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1382136600feSEd Schouten if (error != 0) 1383136600feSEd Schouten return (error); 1384df8bae1dSRodney W. Grimes 1385b75a24a0SChristian S.J. Peron /* 1386b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 1387b75a24a0SChristian S.J. Peron */ 1388afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1389e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 139081bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 139181bda851SJohn Polstra callout_stop(&d->bd_callout); 139281bda851SJohn Polstra d->bd_state = BPF_IDLE; 1393afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 139481bda851SJohn Polstra 139593e39f0bSChristian S.J. Peron if (d->bd_locked == 1) { 139693e39f0bSChristian S.J. Peron switch (cmd) { 139793e39f0bSChristian S.J. Peron case BIOCGBLEN: 139893e39f0bSChristian S.J. Peron case BIOCFLUSH: 139993e39f0bSChristian S.J. Peron case BIOCGDLT: 140093e39f0bSChristian S.J. Peron case BIOCGDLTLIST: 1401fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1402fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1403fc0a61a4SKonstantin Belousov #endif 140493e39f0bSChristian S.J. Peron case BIOCGETIF: 140593e39f0bSChristian S.J. Peron case BIOCGRTIMEOUT: 1406b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1407fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1408fc0a61a4SKonstantin Belousov #endif 140993e39f0bSChristian S.J. Peron case BIOCGSTATS: 141093e39f0bSChristian S.J. Peron case BIOCVERSION: 141193e39f0bSChristian S.J. Peron case BIOCGRSIG: 141293e39f0bSChristian S.J. Peron case BIOCGHDRCMPLT: 1413547d94bdSJung-uk Kim case BIOCSTSTAMP: 1414560a54e1SJung-uk Kim case BIOCFEEDBACK: 141593e39f0bSChristian S.J. Peron case FIONREAD: 141693e39f0bSChristian S.J. Peron case BIOCLOCK: 141793e39f0bSChristian S.J. Peron case BIOCSRTIMEOUT: 1418b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1419fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1420fc0a61a4SKonstantin Belousov #endif 142193e39f0bSChristian S.J. Peron case BIOCIMMEDIATE: 142293e39f0bSChristian S.J. Peron case TIOCGPGRP: 14234d621040SChristian S.J. Peron case BIOCROTZBUF: 142493e39f0bSChristian S.J. Peron break; 142593e39f0bSChristian S.J. Peron default: 142693e39f0bSChristian S.J. Peron return (EPERM); 142793e39f0bSChristian S.J. Peron } 142893e39f0bSChristian S.J. Peron } 1429fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1430fc0a61a4SKonstantin Belousov /* 1431fc0a61a4SKonstantin Belousov * If we see a 32-bit compat ioctl, mark the stream as 32-bit so 1432fc0a61a4SKonstantin Belousov * that it will get 32-bit packet headers. 1433fc0a61a4SKonstantin Belousov */ 1434fc0a61a4SKonstantin Belousov switch (cmd) { 1435fc0a61a4SKonstantin Belousov case BIOCSETF32: 1436fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1437fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1438fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1439fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1440fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 144174549d4bSWojciech Macek if (SV_PROC_FLAG(td->td_proc, SV_ILP32)) { 144297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1443fc0a61a4SKonstantin Belousov d->bd_compat32 = 1; 144497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1445fc0a61a4SKonstantin Belousov } 144674549d4bSWojciech Macek } 1447fc0a61a4SKonstantin Belousov #endif 1448fc0a61a4SKonstantin Belousov 144997021c24SMarko Zec CURVNET_SET(TD_TO_VNET(td)); 1450df8bae1dSRodney W. Grimes switch (cmd) { 1451df8bae1dSRodney W. Grimes default: 1452df8bae1dSRodney W. Grimes error = EINVAL; 1453df8bae1dSRodney W. Grimes break; 1454df8bae1dSRodney W. Grimes 1455df8bae1dSRodney W. Grimes /* 1456df8bae1dSRodney W. Grimes * Check for read packet available. 1457df8bae1dSRodney W. Grimes */ 1458df8bae1dSRodney W. Grimes case FIONREAD: 1459df8bae1dSRodney W. Grimes { 1460df8bae1dSRodney W. Grimes int n; 1461df8bae1dSRodney W. Grimes 1462afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1463df8bae1dSRodney W. Grimes n = d->bd_slen; 14643b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 14653b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 14663b3b91e7SGuy Helmer PRINET, "bd_hbuf", 0); 1467df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1468df8bae1dSRodney W. Grimes n += d->bd_hlen; 1469afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1470df8bae1dSRodney W. Grimes 1471df8bae1dSRodney W. Grimes *(int *)addr = n; 1472df8bae1dSRodney W. Grimes break; 1473df8bae1dSRodney W. Grimes } 1474df8bae1dSRodney W. Grimes 1475df8bae1dSRodney W. Grimes /* 1476df8bae1dSRodney W. Grimes * Get buffer len [for read()]. 1477df8bae1dSRodney W. Grimes */ 1478df8bae1dSRodney W. Grimes case BIOCGBLEN: 147997aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1480df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bufsize; 148197aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1482df8bae1dSRodney W. Grimes break; 1483df8bae1dSRodney W. Grimes 1484df8bae1dSRodney W. Grimes /* 1485df8bae1dSRodney W. Grimes * Set buffer length. 1486df8bae1dSRodney W. Grimes */ 1487df8bae1dSRodney W. Grimes case BIOCSBLEN: 14884d621040SChristian S.J. Peron error = bpf_ioctl_sblen(d, (u_int *)addr); 1489df8bae1dSRodney W. Grimes break; 1490df8bae1dSRodney W. Grimes 1491df8bae1dSRodney W. Grimes /* 1492df8bae1dSRodney W. Grimes * Set link layer read filter. 1493df8bae1dSRodney W. Grimes */ 1494df8bae1dSRodney W. Grimes case BIOCSETF: 1495f11c3508SDavid Malone case BIOCSETFNR: 149693e39f0bSChristian S.J. Peron case BIOCSETWF: 1497fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1498fc0a61a4SKonstantin Belousov case BIOCSETF32: 1499fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1500fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1501fc0a61a4SKonstantin Belousov #endif 150293e39f0bSChristian S.J. Peron error = bpf_setf(d, (struct bpf_program *)addr, cmd); 1503df8bae1dSRodney W. Grimes break; 1504df8bae1dSRodney W. Grimes 1505df8bae1dSRodney W. Grimes /* 1506df8bae1dSRodney W. Grimes * Flush read packet buffer. 1507df8bae1dSRodney W. Grimes */ 1508df8bae1dSRodney W. Grimes case BIOCFLUSH: 1509afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1510df8bae1dSRodney W. Grimes reset_d(d); 1511afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1512df8bae1dSRodney W. Grimes break; 1513df8bae1dSRodney W. Grimes 1514df8bae1dSRodney W. Grimes /* 1515df8bae1dSRodney W. Grimes * Put interface into promiscuous mode. 1516df8bae1dSRodney W. Grimes */ 1517df8bae1dSRodney W. Grimes case BIOCPROMISC: 1518572bde2aSRobert Watson if (d->bd_bif == NULL) { 1519df8bae1dSRodney W. Grimes /* 1520df8bae1dSRodney W. Grimes * No interface attached yet. 1521df8bae1dSRodney W. Grimes */ 1522df8bae1dSRodney W. Grimes error = EINVAL; 1523df8bae1dSRodney W. Grimes break; 1524df8bae1dSRodney W. Grimes } 1525df8bae1dSRodney W. Grimes if (d->bd_promisc == 0) { 1526df8bae1dSRodney W. Grimes error = ifpromisc(d->bd_bif->bif_ifp, 1); 1527df8bae1dSRodney W. Grimes if (error == 0) 1528df8bae1dSRodney W. Grimes d->bd_promisc = 1; 1529df8bae1dSRodney W. Grimes } 1530df8bae1dSRodney W. Grimes break; 1531df8bae1dSRodney W. Grimes 1532df8bae1dSRodney W. Grimes /* 15338eab61f3SSam Leffler * Get current data link type. 1534df8bae1dSRodney W. Grimes */ 1535df8bae1dSRodney W. Grimes case BIOCGDLT: 153697aacec6SAlexander V. Chernikov BPF_LOCK(); 1537572bde2aSRobert Watson if (d->bd_bif == NULL) 1538df8bae1dSRodney W. Grimes error = EINVAL; 1539df8bae1dSRodney W. Grimes else 1540df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bif->bif_dlt; 154197aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1542df8bae1dSRodney W. Grimes break; 1543df8bae1dSRodney W. Grimes 1544df8bae1dSRodney W. Grimes /* 15458eab61f3SSam Leffler * Get a list of supported data link types. 15468eab61f3SSam Leffler */ 1547fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1548fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1549fc0a61a4SKonstantin Belousov { 1550fc0a61a4SKonstantin Belousov struct bpf_dltlist32 *list32; 1551fc0a61a4SKonstantin Belousov struct bpf_dltlist dltlist; 1552fc0a61a4SKonstantin Belousov 1553fc0a61a4SKonstantin Belousov list32 = (struct bpf_dltlist32 *)addr; 1554fc0a61a4SKonstantin Belousov dltlist.bfl_len = list32->bfl_len; 1555fc0a61a4SKonstantin Belousov dltlist.bfl_list = PTRIN(list32->bfl_list); 155697aacec6SAlexander V. Chernikov BPF_LOCK(); 1557fc0a61a4SKonstantin Belousov if (d->bd_bif == NULL) 1558fc0a61a4SKonstantin Belousov error = EINVAL; 1559fc0a61a4SKonstantin Belousov else { 1560fc0a61a4SKonstantin Belousov error = bpf_getdltlist(d, &dltlist); 1561fc0a61a4SKonstantin Belousov if (error == 0) 1562fc0a61a4SKonstantin Belousov list32->bfl_len = dltlist.bfl_len; 1563fc0a61a4SKonstantin Belousov } 156497aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1565fc0a61a4SKonstantin Belousov break; 1566fc0a61a4SKonstantin Belousov } 1567fc0a61a4SKonstantin Belousov #endif 1568fc0a61a4SKonstantin Belousov 15698eab61f3SSam Leffler case BIOCGDLTLIST: 157097aacec6SAlexander V. Chernikov BPF_LOCK(); 1571572bde2aSRobert Watson if (d->bd_bif == NULL) 15728eab61f3SSam Leffler error = EINVAL; 15738eab61f3SSam Leffler else 15748eab61f3SSam Leffler error = bpf_getdltlist(d, (struct bpf_dltlist *)addr); 157597aacec6SAlexander V. Chernikov BPF_UNLOCK(); 15768eab61f3SSam Leffler break; 15778eab61f3SSam Leffler 15788eab61f3SSam Leffler /* 15798eab61f3SSam Leffler * Set data link type. 15808eab61f3SSam Leffler */ 15818eab61f3SSam Leffler case BIOCSDLT: 15826c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1583572bde2aSRobert Watson if (d->bd_bif == NULL) 15848eab61f3SSam Leffler error = EINVAL; 15858eab61f3SSam Leffler else 15868eab61f3SSam Leffler error = bpf_setdlt(d, *(u_int *)addr); 15876c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 15888eab61f3SSam Leffler break; 15898eab61f3SSam Leffler 15908eab61f3SSam Leffler /* 15911dd0feaaSArchie Cobbs * Get interface name. 1592df8bae1dSRodney W. Grimes */ 1593df8bae1dSRodney W. Grimes case BIOCGETIF: 159497aacec6SAlexander V. Chernikov BPF_LOCK(); 1595572bde2aSRobert Watson if (d->bd_bif == NULL) 1596df8bae1dSRodney W. Grimes error = EINVAL; 15971dd0feaaSArchie Cobbs else { 15981dd0feaaSArchie Cobbs struct ifnet *const ifp = d->bd_bif->bif_ifp; 15991dd0feaaSArchie Cobbs struct ifreq *const ifr = (struct ifreq *)addr; 16001dd0feaaSArchie Cobbs 16019bf40edeSBrooks Davis strlcpy(ifr->ifr_name, ifp->if_xname, 16029bf40edeSBrooks Davis sizeof(ifr->ifr_name)); 16031dd0feaaSArchie Cobbs } 160497aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1605df8bae1dSRodney W. Grimes break; 1606df8bae1dSRodney W. Grimes 1607df8bae1dSRodney W. Grimes /* 1608df8bae1dSRodney W. Grimes * Set interface. 1609df8bae1dSRodney W. Grimes */ 1610df8bae1dSRodney W. Grimes case BIOCSETIF: 16114f42daa4SLuiz Otavio O Souza { 16124f42daa4SLuiz Otavio O Souza int alloc_buf, size; 16134f42daa4SLuiz Otavio O Souza 16144f42daa4SLuiz Otavio O Souza /* 16154f42daa4SLuiz Otavio O Souza * Behavior here depends on the buffering model. If 16164f42daa4SLuiz Otavio O Souza * we're using kernel memory buffers, then we can 16174f42daa4SLuiz Otavio O Souza * allocate them here. If we're using zero-copy, 16184f42daa4SLuiz Otavio O Souza * then the user process must have registered buffers 16194f42daa4SLuiz Otavio O Souza * by the time we get here. 16204f42daa4SLuiz Otavio O Souza */ 16214f42daa4SLuiz Otavio O Souza alloc_buf = 0; 16224f42daa4SLuiz Otavio O Souza BPFD_LOCK(d); 16234f42daa4SLuiz Otavio O Souza if (d->bd_bufmode == BPF_BUFMODE_BUFFER && 16244f42daa4SLuiz Otavio O Souza d->bd_sbuf == NULL) 16254f42daa4SLuiz Otavio O Souza alloc_buf = 1; 16264f42daa4SLuiz Otavio O Souza BPFD_UNLOCK(d); 16274f42daa4SLuiz Otavio O Souza if (alloc_buf) { 16284f42daa4SLuiz Otavio O Souza size = d->bd_bufsize; 16294f42daa4SLuiz Otavio O Souza error = bpf_buffer_ioctl_sblen(d, &size); 16304f42daa4SLuiz Otavio O Souza if (error != 0) 16314f42daa4SLuiz Otavio O Souza break; 16324f42daa4SLuiz Otavio O Souza } 16336c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1634df8bae1dSRodney W. Grimes error = bpf_setif(d, (struct ifreq *)addr); 16356c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 1636df8bae1dSRodney W. Grimes break; 16374f42daa4SLuiz Otavio O Souza } 1638df8bae1dSRodney W. Grimes 1639df8bae1dSRodney W. Grimes /* 1640df8bae1dSRodney W. Grimes * Set read timeout. 1641df8bae1dSRodney W. Grimes */ 1642df8bae1dSRodney W. Grimes case BIOCSRTIMEOUT: 1643b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1644fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1645fc0a61a4SKonstantin Belousov #endif 1646df8bae1dSRodney W. Grimes { 1647df8bae1dSRodney W. Grimes struct timeval *tv = (struct timeval *)addr; 16489624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__) 1649fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1650fc0a61a4SKonstantin Belousov struct timeval tv64; 1651fc0a61a4SKonstantin Belousov 1652fc0a61a4SKonstantin Belousov if (cmd == BIOCSRTIMEOUT32) { 1653fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1654fc0a61a4SKonstantin Belousov tv = &tv64; 1655fc0a61a4SKonstantin Belousov tv->tv_sec = tv32->tv_sec; 1656fc0a61a4SKonstantin Belousov tv->tv_usec = tv32->tv_usec; 1657fc0a61a4SKonstantin Belousov } else 1658fc0a61a4SKonstantin Belousov #endif 1659fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1660df8bae1dSRodney W. Grimes 1661bdc2cdc5SAlexander Langer /* 1662bdc2cdc5SAlexander Langer * Subtract 1 tick from tvtohz() since this isn't 1663bdc2cdc5SAlexander Langer * a one-shot timer. 1664bdc2cdc5SAlexander Langer */ 1665bdc2cdc5SAlexander Langer if ((error = itimerfix(tv)) == 0) 1666bdc2cdc5SAlexander Langer d->bd_rtout = tvtohz(tv) - 1; 1667df8bae1dSRodney W. Grimes break; 1668df8bae1dSRodney W. Grimes } 1669df8bae1dSRodney W. Grimes 1670df8bae1dSRodney W. Grimes /* 1671df8bae1dSRodney W. Grimes * Get read timeout. 1672df8bae1dSRodney W. Grimes */ 1673df8bae1dSRodney W. Grimes case BIOCGRTIMEOUT: 1674b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1675fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1676fc0a61a4SKonstantin Belousov #endif 1677df8bae1dSRodney W. Grimes { 1678fc0a61a4SKonstantin Belousov struct timeval *tv; 1679b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1680fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1681fc0a61a4SKonstantin Belousov struct timeval tv64; 1682fc0a61a4SKonstantin Belousov 1683fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) 1684fc0a61a4SKonstantin Belousov tv = &tv64; 1685fc0a61a4SKonstantin Belousov else 1686fc0a61a4SKonstantin Belousov #endif 1687fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1688df8bae1dSRodney W. Grimes 1689bdc2cdc5SAlexander Langer tv->tv_sec = d->bd_rtout / hz; 1690bdc2cdc5SAlexander Langer tv->tv_usec = (d->bd_rtout % hz) * tick; 1691b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1692fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) { 1693fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1694fc0a61a4SKonstantin Belousov tv32->tv_sec = tv->tv_sec; 1695fc0a61a4SKonstantin Belousov tv32->tv_usec = tv->tv_usec; 1696fc0a61a4SKonstantin Belousov } 1697fc0a61a4SKonstantin Belousov #endif 1698fc0a61a4SKonstantin Belousov 1699df8bae1dSRodney W. Grimes break; 1700df8bae1dSRodney W. Grimes } 1701df8bae1dSRodney W. Grimes 1702df8bae1dSRodney W. Grimes /* 1703df8bae1dSRodney W. Grimes * Get packet stats. 1704df8bae1dSRodney W. Grimes */ 1705df8bae1dSRodney W. Grimes case BIOCGSTATS: 1706df8bae1dSRodney W. Grimes { 1707df8bae1dSRodney W. Grimes struct bpf_stat *bs = (struct bpf_stat *)addr; 1708df8bae1dSRodney W. Grimes 17094d621040SChristian S.J. Peron /* XXXCSJP overflow */ 1710b2b7ca49SAlexander V. Chernikov bs->bs_recv = (u_int)counter_u64_fetch(d->bd_rcount); 1711b2b7ca49SAlexander V. Chernikov bs->bs_drop = (u_int)counter_u64_fetch(d->bd_dcount); 1712df8bae1dSRodney W. Grimes break; 1713df8bae1dSRodney W. Grimes } 1714df8bae1dSRodney W. Grimes 1715df8bae1dSRodney W. Grimes /* 1716df8bae1dSRodney W. Grimes * Set immediate mode. 1717df8bae1dSRodney W. Grimes */ 1718df8bae1dSRodney W. Grimes case BIOCIMMEDIATE: 171997aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1720df8bae1dSRodney W. Grimes d->bd_immediate = *(u_int *)addr; 172197aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1722df8bae1dSRodney W. Grimes break; 1723df8bae1dSRodney W. Grimes 1724df8bae1dSRodney W. Grimes case BIOCVERSION: 1725df8bae1dSRodney W. Grimes { 1726df8bae1dSRodney W. Grimes struct bpf_version *bv = (struct bpf_version *)addr; 1727df8bae1dSRodney W. Grimes 1728df8bae1dSRodney W. Grimes bv->bv_major = BPF_MAJOR_VERSION; 1729df8bae1dSRodney W. Grimes bv->bv_minor = BPF_MINOR_VERSION; 1730df8bae1dSRodney W. Grimes break; 1731df8bae1dSRodney W. Grimes } 173200a83887SPaul Traina 1733114ae644SMike Smith /* 1734114ae644SMike Smith * Get "header already complete" flag 1735114ae644SMike Smith */ 1736114ae644SMike Smith case BIOCGHDRCMPLT: 173797aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1738114ae644SMike Smith *(u_int *)addr = d->bd_hdrcmplt; 173997aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1740114ae644SMike Smith break; 1741114ae644SMike Smith 1742114ae644SMike Smith /* 1743114ae644SMike Smith * Set "header already complete" flag 1744114ae644SMike Smith */ 1745114ae644SMike Smith case BIOCSHDRCMPLT: 174697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1747114ae644SMike Smith d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0; 174897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1749114ae644SMike Smith break; 1750114ae644SMike Smith 17518ed3828cSRobert Watson /* 1752560a54e1SJung-uk Kim * Get packet direction flag 17538ed3828cSRobert Watson */ 1754560a54e1SJung-uk Kim case BIOCGDIRECTION: 175597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1756560a54e1SJung-uk Kim *(u_int *)addr = d->bd_direction; 175797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 17588ed3828cSRobert Watson break; 17598ed3828cSRobert Watson 17608ed3828cSRobert Watson /* 1761560a54e1SJung-uk Kim * Set packet direction flag 17628ed3828cSRobert Watson */ 1763560a54e1SJung-uk Kim case BIOCSDIRECTION: 1764560a54e1SJung-uk Kim { 1765560a54e1SJung-uk Kim u_int direction; 1766560a54e1SJung-uk Kim 1767560a54e1SJung-uk Kim direction = *(u_int *)addr; 1768560a54e1SJung-uk Kim switch (direction) { 1769560a54e1SJung-uk Kim case BPF_D_IN: 1770560a54e1SJung-uk Kim case BPF_D_INOUT: 1771560a54e1SJung-uk Kim case BPF_D_OUT: 177297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1773560a54e1SJung-uk Kim d->bd_direction = direction; 177497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1775560a54e1SJung-uk Kim break; 1776560a54e1SJung-uk Kim default: 1777560a54e1SJung-uk Kim error = EINVAL; 1778560a54e1SJung-uk Kim } 1779560a54e1SJung-uk Kim } 1780560a54e1SJung-uk Kim break; 1781560a54e1SJung-uk Kim 1782547d94bdSJung-uk Kim /* 1783d0d7bcdfSJung-uk Kim * Get packet timestamp format and resolution. 1784547d94bdSJung-uk Kim */ 1785547d94bdSJung-uk Kim case BIOCGTSTAMP: 178697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1787547d94bdSJung-uk Kim *(u_int *)addr = d->bd_tstamp; 178897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1789547d94bdSJung-uk Kim break; 1790547d94bdSJung-uk Kim 1791547d94bdSJung-uk Kim /* 1792547d94bdSJung-uk Kim * Set packet timestamp format and resolution. 1793547d94bdSJung-uk Kim */ 1794547d94bdSJung-uk Kim case BIOCSTSTAMP: 1795547d94bdSJung-uk Kim { 1796547d94bdSJung-uk Kim u_int func; 1797547d94bdSJung-uk Kim 1798547d94bdSJung-uk Kim func = *(u_int *)addr; 1799547d94bdSJung-uk Kim if (BPF_T_VALID(func)) 1800547d94bdSJung-uk Kim d->bd_tstamp = func; 1801547d94bdSJung-uk Kim else 1802547d94bdSJung-uk Kim error = EINVAL; 1803547d94bdSJung-uk Kim } 1804547d94bdSJung-uk Kim break; 1805547d94bdSJung-uk Kim 1806560a54e1SJung-uk Kim case BIOCFEEDBACK: 180797aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1808560a54e1SJung-uk Kim d->bd_feedback = *(u_int *)addr; 180997aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1810560a54e1SJung-uk Kim break; 1811560a54e1SJung-uk Kim 1812560a54e1SJung-uk Kim case BIOCLOCK: 181397aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1814560a54e1SJung-uk Kim d->bd_locked = 1; 181597aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18168ed3828cSRobert Watson break; 18178ed3828cSRobert Watson 181800a83887SPaul Traina case FIONBIO: /* Non-blocking I/O */ 181900a83887SPaul Traina break; 182000a83887SPaul Traina 182100a83887SPaul Traina case FIOASYNC: /* Send signal on receive packets */ 182297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 182300a83887SPaul Traina d->bd_async = *(int *)addr; 182497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 182500a83887SPaul Traina break; 182600a83887SPaul Traina 1827831d27a9SDon Lewis case FIOSETOWN: 182897aacec6SAlexander V. Chernikov /* 182997aacec6SAlexander V. Chernikov * XXX: Add some sort of locking here? 183097aacec6SAlexander V. Chernikov * fsetown() can sleep. 183197aacec6SAlexander V. Chernikov */ 1832831d27a9SDon Lewis error = fsetown(*(int *)addr, &d->bd_sigio); 183300a83887SPaul Traina break; 183400a83887SPaul Traina 1835831d27a9SDon Lewis case FIOGETOWN: 183697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 183791e97a82SDon Lewis *(int *)addr = fgetown(&d->bd_sigio); 183897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1839831d27a9SDon Lewis break; 1840831d27a9SDon Lewis 1841831d27a9SDon Lewis /* This is deprecated, FIOSETOWN should be used instead. */ 1842831d27a9SDon Lewis case TIOCSPGRP: 1843831d27a9SDon Lewis error = fsetown(-(*(int *)addr), &d->bd_sigio); 1844831d27a9SDon Lewis break; 1845831d27a9SDon Lewis 1846831d27a9SDon Lewis /* This is deprecated, FIOGETOWN should be used instead. */ 184700a83887SPaul Traina case TIOCGPGRP: 184891e97a82SDon Lewis *(int *)addr = -fgetown(&d->bd_sigio); 184900a83887SPaul Traina break; 185000a83887SPaul Traina 185100a83887SPaul Traina case BIOCSRSIG: /* Set receive signal */ 185200a83887SPaul Traina { 185300a83887SPaul Traina u_int sig; 185400a83887SPaul Traina 185500a83887SPaul Traina sig = *(u_int *)addr; 185600a83887SPaul Traina 185700a83887SPaul Traina if (sig >= NSIG) 185800a83887SPaul Traina error = EINVAL; 185997aacec6SAlexander V. Chernikov else { 186097aacec6SAlexander V. Chernikov BPFD_LOCK(d); 186100a83887SPaul Traina d->bd_sig = sig; 186297aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 186397aacec6SAlexander V. Chernikov } 186400a83887SPaul Traina break; 186500a83887SPaul Traina } 186600a83887SPaul Traina case BIOCGRSIG: 186797aacec6SAlexander V. Chernikov BPFD_LOCK(d); 186800a83887SPaul Traina *(u_int *)addr = d->bd_sig; 186997aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 187000a83887SPaul Traina break; 18714d621040SChristian S.J. Peron 18724d621040SChristian S.J. Peron case BIOCGETBUFMODE: 187397aacec6SAlexander V. Chernikov BPFD_LOCK(d); 18744d621040SChristian S.J. Peron *(u_int *)addr = d->bd_bufmode; 187597aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18764d621040SChristian S.J. Peron break; 18774d621040SChristian S.J. Peron 18784d621040SChristian S.J. Peron case BIOCSETBUFMODE: 18794d621040SChristian S.J. Peron /* 18804d621040SChristian S.J. Peron * Allow the buffering mode to be changed as long as we 18814d621040SChristian S.J. Peron * haven't yet committed to a particular mode. Our 18824d621040SChristian S.J. Peron * definition of commitment, for now, is whether or not a 18834d621040SChristian S.J. Peron * buffer has been allocated or an interface attached, since 18844d621040SChristian S.J. Peron * that's the point where things get tricky. 18854d621040SChristian S.J. Peron */ 18864d621040SChristian S.J. Peron switch (*(u_int *)addr) { 18874d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 18884d621040SChristian S.J. Peron break; 18894d621040SChristian S.J. Peron 18904d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 18914d621040SChristian S.J. Peron if (bpf_zerocopy_enable) 18924d621040SChristian S.J. Peron break; 18934d621040SChristian S.J. Peron /* FALLSTHROUGH */ 18944d621040SChristian S.J. Peron 18954d621040SChristian S.J. Peron default: 18961b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 18974d621040SChristian S.J. Peron return (EINVAL); 18984d621040SChristian S.J. Peron } 18994d621040SChristian S.J. Peron 1900afa85850SAlexander V. Chernikov BPFD_LOCK(d); 19014d621040SChristian S.J. Peron if (d->bd_sbuf != NULL || d->bd_hbuf != NULL || 19024d621040SChristian S.J. Peron d->bd_fbuf != NULL || d->bd_bif != NULL) { 1903afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 19041b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 19054d621040SChristian S.J. Peron return (EBUSY); 19064d621040SChristian S.J. Peron } 19074d621040SChristian S.J. Peron d->bd_bufmode = *(u_int *)addr; 1908afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 19094d621040SChristian S.J. Peron break; 19104d621040SChristian S.J. Peron 19114d621040SChristian S.J. Peron case BIOCGETZMAX: 19121b610a74SBjoern A. Zeeb error = bpf_ioctl_getzmax(td, d, (size_t *)addr); 19131b610a74SBjoern A. Zeeb break; 19144d621040SChristian S.J. Peron 19154d621040SChristian S.J. Peron case BIOCSETZBUF: 19161b610a74SBjoern A. Zeeb error = bpf_ioctl_setzbuf(td, d, (struct bpf_zbuf *)addr); 19171b610a74SBjoern A. Zeeb break; 19184d621040SChristian S.J. Peron 19194d621040SChristian S.J. Peron case BIOCROTZBUF: 19201b610a74SBjoern A. Zeeb error = bpf_ioctl_rotzbuf(td, d, (struct bpf_zbuf *)addr); 19211b610a74SBjoern A. Zeeb break; 19221e7fe2fbSLuiz Otavio O Souza 19231e7fe2fbSLuiz Otavio O Souza case BIOCSETVLANPCP: 19241e7fe2fbSLuiz Otavio O Souza { 19251e7fe2fbSLuiz Otavio O Souza u_int pcp; 19261e7fe2fbSLuiz Otavio O Souza 19271e7fe2fbSLuiz Otavio O Souza pcp = *(u_int *)addr; 19281e7fe2fbSLuiz Otavio O Souza if (pcp > BPF_PRIO_MAX || pcp < 0) { 19291e7fe2fbSLuiz Otavio O Souza error = EINVAL; 19301e7fe2fbSLuiz Otavio O Souza break; 19311e7fe2fbSLuiz Otavio O Souza } 19321e7fe2fbSLuiz Otavio O Souza d->bd_pcp = pcp; 19331e7fe2fbSLuiz Otavio O Souza break; 19341e7fe2fbSLuiz Otavio O Souza } 1935df8bae1dSRodney W. Grimes } 193697021c24SMarko Zec CURVNET_RESTORE(); 1937df8bae1dSRodney W. Grimes return (error); 1938df8bae1dSRodney W. Grimes } 1939df8bae1dSRodney W. Grimes 1940df8bae1dSRodney W. Grimes /* 1941df8bae1dSRodney W. Grimes * Set d's packet filter program to fp. If this file already has a filter, 1942df8bae1dSRodney W. Grimes * free it and replace it. Returns EINVAL for bogus requests. 1943784292f8SAlexander V. Chernikov * 1944699281b5SAndrey V. Elsukov * Note we use global lock here to serialize bpf_setf() and bpf_setif() 1945699281b5SAndrey V. Elsukov * calls. 1946df8bae1dSRodney W. Grimes */ 1947f708ef1bSPoul-Henning Kamp static int 194819ba8395SChristian S.J. Peron bpf_setf(struct bpf_d *d, struct bpf_program *fp, u_long cmd) 1949df8bae1dSRodney W. Grimes { 19509b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19519b7d4a7fSJung-uk Kim struct bpf_program fp_swab; 19529b7d4a7fSJung-uk Kim struct bpf_program32 *fp32; 19539b7d4a7fSJung-uk Kim #endif 1954699281b5SAndrey V. Elsukov struct bpf_program_buffer *fcode; 1955699281b5SAndrey V. Elsukov struct bpf_insn *filter; 1956293c06a1SRuslan Ermilov #ifdef BPF_JITTER 1957699281b5SAndrey V. Elsukov bpf_jit_filter *jfunc; 1958ae275efcSJung-uk Kim #endif 19598b04b48aSJung-uk Kim size_t size; 19608b04b48aSJung-uk Kim u_int flen; 1961699281b5SAndrey V. Elsukov bool track_event; 1962df8bae1dSRodney W. Grimes 19639b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19646f731135SJung-uk Kim switch (cmd) { 19656f731135SJung-uk Kim case BIOCSETF32: 19666f731135SJung-uk Kim case BIOCSETWF32: 19676f731135SJung-uk Kim case BIOCSETFNR32: 1968fc0a61a4SKonstantin Belousov fp32 = (struct bpf_program32 *)fp; 1969fc0a61a4SKonstantin Belousov fp_swab.bf_len = fp32->bf_len; 1970699281b5SAndrey V. Elsukov fp_swab.bf_insns = 1971699281b5SAndrey V. Elsukov (struct bpf_insn *)(uintptr_t)fp32->bf_insns; 1972fc0a61a4SKonstantin Belousov fp = &fp_swab; 19736f731135SJung-uk Kim switch (cmd) { 19746f731135SJung-uk Kim case BIOCSETF32: 19756f731135SJung-uk Kim cmd = BIOCSETF; 19766f731135SJung-uk Kim break; 19776f731135SJung-uk Kim case BIOCSETWF32: 1978fc0a61a4SKonstantin Belousov cmd = BIOCSETWF; 19796f731135SJung-uk Kim break; 19806f731135SJung-uk Kim } 19816f731135SJung-uk Kim break; 1982fc0a61a4SKonstantin Belousov } 1983fc0a61a4SKonstantin Belousov #endif 19848b04b48aSJung-uk Kim 1985699281b5SAndrey V. Elsukov filter = NULL; 19868b04b48aSJung-uk Kim #ifdef BPF_JITTER 1987699281b5SAndrey V. Elsukov jfunc = NULL; 19888b04b48aSJung-uk Kim #endif 19896c74ff0eSAlexander V. Chernikov /* 19906c74ff0eSAlexander V. Chernikov * Check new filter validness before acquiring any locks. 19916c74ff0eSAlexander V. Chernikov * Allocate memory for new filter, if needed. 19926c74ff0eSAlexander V. Chernikov */ 19936c74ff0eSAlexander V. Chernikov flen = fp->bf_len; 19949b7d4a7fSJung-uk Kim if (flen > bpf_maxinsns || (fp->bf_insns == NULL && flen != 0)) 19956c74ff0eSAlexander V. Chernikov return (EINVAL); 19966c74ff0eSAlexander V. Chernikov size = flen * sizeof(*fp->bf_insns); 1997a86227d1SAlexander V. Chernikov if (size > 0) { 19989b7d4a7fSJung-uk Kim /* We're setting up new filter. Copy and check actual data. */ 1999699281b5SAndrey V. Elsukov fcode = bpf_program_buffer_alloc(size, M_WAITOK); 2000699281b5SAndrey V. Elsukov filter = (struct bpf_insn *)fcode->buffer; 2001699281b5SAndrey V. Elsukov if (copyin(fp->bf_insns, filter, size) != 0 || 2002699281b5SAndrey V. Elsukov !bpf_validate(filter, flen)) { 2003a86227d1SAlexander V. Chernikov free(fcode, M_BPF); 2004a86227d1SAlexander V. Chernikov return (EINVAL); 2005a86227d1SAlexander V. Chernikov } 2006c7b0200eSAlexander V. Chernikov #ifdef BPF_JITTER 200716a227c7SJonathan T. Looney if (cmd != BIOCSETWF) { 200816a227c7SJonathan T. Looney /* 200916a227c7SJonathan T. Looney * Filter is copied inside fcode and is 201016a227c7SJonathan T. Looney * perfectly valid. 201116a227c7SJonathan T. Looney */ 2012699281b5SAndrey V. Elsukov jfunc = bpf_jitter(filter, flen); 201316a227c7SJonathan T. Looney } 2014c7b0200eSAlexander V. Chernikov #endif 20158b04b48aSJung-uk Kim } 2016c7b0200eSAlexander V. Chernikov 2017699281b5SAndrey V. Elsukov track_event = false; 2018699281b5SAndrey V. Elsukov fcode = NULL; 20196c74ff0eSAlexander V. Chernikov 2020699281b5SAndrey V. Elsukov BPF_LOCK(); 2021afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2022699281b5SAndrey V. Elsukov /* Set up new filter. */ 20238b04b48aSJung-uk Kim if (cmd == BIOCSETWF) { 2024699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2025699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_wfilter, 2026699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2027293c06a1SRuslan Ermilov #ifdef BPF_JITTER 2028699281b5SAndrey V. Elsukov fcode->func = NULL; 2029699281b5SAndrey V. Elsukov #endif 2030699281b5SAndrey V. Elsukov } 2031699281b5SAndrey V. Elsukov d->bd_wfilter = filter; 2032699281b5SAndrey V. Elsukov } else { 2033699281b5SAndrey V. Elsukov if (d->bd_rfilter != NULL) { 2034699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_rfilter, 2035699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2036699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2037699281b5SAndrey V. Elsukov fcode->func = d->bd_bfilter; 2038699281b5SAndrey V. Elsukov #endif 2039699281b5SAndrey V. Elsukov } 2040699281b5SAndrey V. Elsukov d->bd_rfilter = filter; 2041699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2042c7b0200eSAlexander V. Chernikov d->bd_bfilter = jfunc; 2043ae275efcSJung-uk Kim #endif 2044f11c3508SDavid Malone if (cmd == BIOCSETF) 2045df8bae1dSRodney W. Grimes reset_d(d); 204651ec1eb7SAlexander V. Chernikov 2047699281b5SAndrey V. Elsukov if (bpf_check_upgrade(cmd, d, filter, flen) != 0) { 2048699281b5SAndrey V. Elsukov /* 2049699281b5SAndrey V. Elsukov * Filter can be set several times without 2050699281b5SAndrey V. Elsukov * specifying interface. In this case just mark d 2051699281b5SAndrey V. Elsukov * as reader. 2052699281b5SAndrey V. Elsukov */ 2053699281b5SAndrey V. Elsukov d->bd_writer = 0; 2054699281b5SAndrey V. Elsukov if (d->bd_bif != NULL) { 2055699281b5SAndrey V. Elsukov /* 2056699281b5SAndrey V. Elsukov * Remove descriptor from writers-only list 2057699281b5SAndrey V. Elsukov * and add it to active readers list. 2058699281b5SAndrey V. Elsukov */ 2059699281b5SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 2060699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&d->bd_bif->bif_dlist, 2061699281b5SAndrey V. Elsukov d, bd_next); 2062699281b5SAndrey V. Elsukov CTR2(KTR_NET, 2063699281b5SAndrey V. Elsukov "%s: upgrade required by pid %d", 2064699281b5SAndrey V. Elsukov __func__, d->bd_pid); 2065699281b5SAndrey V. Elsukov track_event = true; 2066699281b5SAndrey V. Elsukov } 2067699281b5SAndrey V. Elsukov } 20688b04b48aSJung-uk Kim } 2069afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2070df8bae1dSRodney W. Grimes 2071699281b5SAndrey V. Elsukov if (fcode != NULL) 20722a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpf_program_buffer_free, &fcode->epoch_ctx); 2073699281b5SAndrey V. Elsukov 2074699281b5SAndrey V. Elsukov if (track_event) 2075699281b5SAndrey V. Elsukov EVENTHANDLER_INVOKE(bpf_track, 2076699281b5SAndrey V. Elsukov d->bd_bif->bif_ifp, d->bd_bif->bif_dlt, 1); 207751ec1eb7SAlexander V. Chernikov 20786c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 2079df8bae1dSRodney W. Grimes return (0); 2080df8bae1dSRodney W. Grimes } 2081df8bae1dSRodney W. Grimes 2082df8bae1dSRodney W. Grimes /* 2083df8bae1dSRodney W. Grimes * Detach a file from its current interface (if attached at all) and attach 2084df8bae1dSRodney W. Grimes * to the interface indicated by the name stored in ifr. 2085df8bae1dSRodney W. Grimes * Return an errno or 0. 2086df8bae1dSRodney W. Grimes */ 2087df8bae1dSRodney W. Grimes static int 208819ba8395SChristian S.J. Peron bpf_setif(struct bpf_d *d, struct ifreq *ifr) 2089df8bae1dSRodney W. Grimes { 2090df8bae1dSRodney W. Grimes struct bpf_if *bp; 20919b44ff22SGarrett Wollman struct ifnet *theywant; 2092df8bae1dSRodney W. Grimes 20936c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 20946c74ff0eSAlexander V. Chernikov 20959b44ff22SGarrett Wollman theywant = ifunit(ifr->ifr_name); 209616d878ccSChristian S.J. Peron if (theywant == NULL || theywant->if_bpf == NULL) 209716d878ccSChristian S.J. Peron return (ENXIO); 20989b44ff22SGarrett Wollman 209916d878ccSChristian S.J. Peron bp = theywant->if_bpf; 2100df8bae1dSRodney W. Grimes /* 21014f42daa4SLuiz Otavio O Souza * At this point, we expect the buffer is already allocated. If not, 21024f42daa4SLuiz Otavio O Souza * return an error. 2103df8bae1dSRodney W. Grimes */ 21044d621040SChristian S.J. Peron switch (d->bd_bufmode) { 21054d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 21064d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 21074d621040SChristian S.J. Peron if (d->bd_sbuf == NULL) 21084d621040SChristian S.J. Peron return (EINVAL); 21094d621040SChristian S.J. Peron break; 21104d621040SChristian S.J. Peron 21114d621040SChristian S.J. Peron default: 21124d621040SChristian S.J. Peron panic("bpf_setif: bufmode %d", d->bd_bufmode); 21134d621040SChristian S.J. Peron } 21146c74ff0eSAlexander V. Chernikov if (bp != d->bd_bif) 2115df8bae1dSRodney W. Grimes bpf_attachd(d, bp); 2116699281b5SAndrey V. Elsukov else { 2117afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2118df8bae1dSRodney W. Grimes reset_d(d); 2119afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2120699281b5SAndrey V. Elsukov } 2121df8bae1dSRodney W. Grimes return (0); 2122df8bae1dSRodney W. Grimes } 2123df8bae1dSRodney W. Grimes 2124df8bae1dSRodney W. Grimes /* 2125243ac7d8SPeter Wemm * Support for select() and poll() system calls 2126df8bae1dSRodney W. Grimes * 2127df8bae1dSRodney W. Grimes * Return true iff the specific operation will not block indefinitely. 2128df8bae1dSRodney W. Grimes * Otherwise, return false but make a note that a selwakeup() must be done. 2129df8bae1dSRodney W. Grimes */ 213037c84183SPoul-Henning Kamp static int 213119ba8395SChristian S.J. Peron bpfpoll(struct cdev *dev, int events, struct thread *td) 2132df8bae1dSRodney W. Grimes { 2133e7bb21b3SJonathan Lemon struct bpf_d *d; 21340832fc64SGarance A Drosehn int revents; 2135df8bae1dSRodney W. Grimes 2136136600feSEd Schouten if (devfs_get_cdevpriv((void **)&d) != 0 || d->bd_bif == NULL) 2137136600feSEd Schouten return (events & 2138136600feSEd Schouten (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM)); 2139de5d9935SRobert Watson 2140b75a24a0SChristian S.J. Peron /* 2141b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2142b75a24a0SChristian S.J. Peron */ 21430832fc64SGarance A Drosehn revents = events & (POLLOUT | POLLWRNORM); 2144afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2145e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 214675c13541SPoul-Henning Kamp if (events & (POLLIN | POLLRDNORM)) { 214795aab9ccSJohn-Mark Gurney if (bpf_ready(d)) 2148243ac7d8SPeter Wemm revents |= events & (POLLIN | POLLRDNORM); 214981bda851SJohn Polstra else { 2150ed01445dSJohn Baldwin selrecord(td, &d->bd_sel); 215181bda851SJohn Polstra /* Start the read timeout if necessary. */ 215281bda851SJohn Polstra if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 215381bda851SJohn Polstra callout_reset(&d->bd_callout, d->bd_rtout, 215481bda851SJohn Polstra bpf_timed_out, d); 215581bda851SJohn Polstra d->bd_state = BPF_WAITING; 215681bda851SJohn Polstra } 215781bda851SJohn Polstra } 215875c13541SPoul-Henning Kamp } 2159afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2160243ac7d8SPeter Wemm return (revents); 2161df8bae1dSRodney W. Grimes } 2162df8bae1dSRodney W. Grimes 2163df8bae1dSRodney W. Grimes /* 216495aab9ccSJohn-Mark Gurney * Support for kevent() system call. Register EVFILT_READ filters and 216595aab9ccSJohn-Mark Gurney * reject all others. 216695aab9ccSJohn-Mark Gurney */ 216795aab9ccSJohn-Mark Gurney int 216819ba8395SChristian S.J. Peron bpfkqfilter(struct cdev *dev, struct knote *kn) 216995aab9ccSJohn-Mark Gurney { 2170136600feSEd Schouten struct bpf_d *d; 217195aab9ccSJohn-Mark Gurney 2172ded77e02SHartmut Brandt if (devfs_get_cdevpriv((void **)&d) != 0) 217395aab9ccSJohn-Mark Gurney return (1); 217495aab9ccSJohn-Mark Gurney 2175ded77e02SHartmut Brandt switch (kn->kn_filter) { 2176ded77e02SHartmut Brandt case EVFILT_READ: 2177ded77e02SHartmut Brandt kn->kn_fop = &bpfread_filtops; 2178ded77e02SHartmut Brandt break; 2179ded77e02SHartmut Brandt 2180ded77e02SHartmut Brandt case EVFILT_WRITE: 2181ded77e02SHartmut Brandt kn->kn_fop = &bpfwrite_filtops; 2182ded77e02SHartmut Brandt break; 2183ded77e02SHartmut Brandt 2184ded77e02SHartmut Brandt default: 2185ded77e02SHartmut Brandt return (1); 2186ded77e02SHartmut Brandt } 2187ded77e02SHartmut Brandt 2188b75a24a0SChristian S.J. Peron /* 2189b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2190b75a24a0SChristian S.J. Peron */ 2191afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2192e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 219395aab9ccSJohn-Mark Gurney kn->kn_hook = d; 21944b19419eSChristian S.J. Peron knlist_add(&d->bd_sel.si_note, kn, 1); 2195afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 219695aab9ccSJohn-Mark Gurney 219795aab9ccSJohn-Mark Gurney return (0); 219895aab9ccSJohn-Mark Gurney } 219995aab9ccSJohn-Mark Gurney 220095aab9ccSJohn-Mark Gurney static void 220119ba8395SChristian S.J. Peron filt_bpfdetach(struct knote *kn) 220295aab9ccSJohn-Mark Gurney { 220395aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 220495aab9ccSJohn-Mark Gurney 2205ad3b9257SJohn-Mark Gurney knlist_remove(&d->bd_sel.si_note, kn, 0); 220695aab9ccSJohn-Mark Gurney } 220795aab9ccSJohn-Mark Gurney 220895aab9ccSJohn-Mark Gurney static int 220919ba8395SChristian S.J. Peron filt_bpfread(struct knote *kn, long hint) 221095aab9ccSJohn-Mark Gurney { 221195aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 221295aab9ccSJohn-Mark Gurney int ready; 221395aab9ccSJohn-Mark Gurney 2214afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 221595aab9ccSJohn-Mark Gurney ready = bpf_ready(d); 221695aab9ccSJohn-Mark Gurney if (ready) { 221795aab9ccSJohn-Mark Gurney kn->kn_data = d->bd_slen; 221892242172SLuiz Otavio O Souza /* 221992242172SLuiz Otavio O Souza * Ignore the hold buffer if it is being copied to user space. 222092242172SLuiz Otavio O Souza */ 222192242172SLuiz Otavio O Souza if (!d->bd_hbuf_in_use && d->bd_hbuf) 222295aab9ccSJohn-Mark Gurney kn->kn_data += d->bd_hlen; 22235d7af3a1SJung-uk Kim } else if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 222495aab9ccSJohn-Mark Gurney callout_reset(&d->bd_callout, d->bd_rtout, 222595aab9ccSJohn-Mark Gurney bpf_timed_out, d); 222695aab9ccSJohn-Mark Gurney d->bd_state = BPF_WAITING; 222795aab9ccSJohn-Mark Gurney } 222895aab9ccSJohn-Mark Gurney 222995aab9ccSJohn-Mark Gurney return (ready); 223095aab9ccSJohn-Mark Gurney } 223195aab9ccSJohn-Mark Gurney 2232ded77e02SHartmut Brandt static int 2233ded77e02SHartmut Brandt filt_bpfwrite(struct knote *kn, long hint) 2234ded77e02SHartmut Brandt { 2235ded77e02SHartmut Brandt struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 2236*426682b0SMark Johnston 2237ded77e02SHartmut Brandt BPFD_LOCK_ASSERT(d); 2238ded77e02SHartmut Brandt 2239*426682b0SMark Johnston if (d->bd_bif == NULL) { 2240*426682b0SMark Johnston kn->kn_data = 0; 2241*426682b0SMark Johnston return (0); 2242*426682b0SMark Johnston } else { 2243ded77e02SHartmut Brandt kn->kn_data = d->bd_bif->bif_ifp->if_mtu; 2244ded77e02SHartmut Brandt return (1); 2245ded77e02SHartmut Brandt } 2246*426682b0SMark Johnston } 2247ded77e02SHartmut Brandt 2248253a3814SLawrence Stewart #define BPF_TSTAMP_NONE 0 2249253a3814SLawrence Stewart #define BPF_TSTAMP_FAST 1 2250253a3814SLawrence Stewart #define BPF_TSTAMP_NORMAL 2 2251253a3814SLawrence Stewart #define BPF_TSTAMP_EXTERN 3 2252253a3814SLawrence Stewart 2253253a3814SLawrence Stewart static int 2254253a3814SLawrence Stewart bpf_ts_quality(int tstype) 2255253a3814SLawrence Stewart { 2256253a3814SLawrence Stewart 2257253a3814SLawrence Stewart if (tstype == BPF_T_NONE) 2258253a3814SLawrence Stewart return (BPF_TSTAMP_NONE); 2259253a3814SLawrence Stewart if ((tstype & BPF_T_FAST) != 0) 2260253a3814SLawrence Stewart return (BPF_TSTAMP_FAST); 2261253a3814SLawrence Stewart 2262253a3814SLawrence Stewart return (BPF_TSTAMP_NORMAL); 2263253a3814SLawrence Stewart } 2264253a3814SLawrence Stewart 2265253a3814SLawrence Stewart static int 2266253a3814SLawrence Stewart bpf_gettime(struct bintime *bt, int tstype, struct mbuf *m) 2267253a3814SLawrence Stewart { 2268253a3814SLawrence Stewart struct m_tag *tag; 2269253a3814SLawrence Stewart int quality; 2270253a3814SLawrence Stewart 2271253a3814SLawrence Stewart quality = bpf_ts_quality(tstype); 2272253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NONE) 2273253a3814SLawrence Stewart return (quality); 2274253a3814SLawrence Stewart 2275253a3814SLawrence Stewart if (m != NULL) { 2276253a3814SLawrence Stewart tag = m_tag_locate(m, MTAG_BPF, MTAG_BPF_TIMESTAMP, NULL); 2277253a3814SLawrence Stewart if (tag != NULL) { 2278253a3814SLawrence Stewart *bt = *(struct bintime *)(tag + 1); 2279253a3814SLawrence Stewart return (BPF_TSTAMP_EXTERN); 2280253a3814SLawrence Stewart } 2281253a3814SLawrence Stewart } 2282253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NORMAL) 2283253a3814SLawrence Stewart binuptime(bt); 2284253a3814SLawrence Stewart else 2285253a3814SLawrence Stewart getbinuptime(bt); 2286253a3814SLawrence Stewart 2287253a3814SLawrence Stewart return (quality); 2288253a3814SLawrence Stewart } 2289253a3814SLawrence Stewart 229095aab9ccSJohn-Mark Gurney /* 2291df8bae1dSRodney W. Grimes * Incoming linkage from device drivers. Process the packet pkt, of length 2292df8bae1dSRodney W. Grimes * pktlen, which is stored in a contiguous buffer. The packet is parsed 2293df8bae1dSRodney W. Grimes * by each process' filter, and if accepted, stashed into the corresponding 2294df8bae1dSRodney W. Grimes * buffer. 2295df8bae1dSRodney W. Grimes */ 2296df8bae1dSRodney W. Grimes void 229719ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 2298df8bae1dSRodney W. Grimes { 2299699281b5SAndrey V. Elsukov struct epoch_tracker et; 2300547d94bdSJung-uk Kim struct bintime bt; 23018994a245SDag-Erling Smørgrav struct bpf_d *d; 2302a36599ccSJung-uk Kim #ifdef BPF_JITTER 2303a36599ccSJung-uk Kim bpf_jit_filter *bf; 2304a36599ccSJung-uk Kim #endif 2305253a3814SLawrence Stewart u_int slen; 2306253a3814SLawrence Stewart int gottime; 2307e7bb21b3SJonathan Lemon 2308253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2309699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2310699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2311b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2312a05cf8c6SChristian S.J. Peron /* 2313699281b5SAndrey V. Elsukov * NB: We dont call BPF_CHECK_DIRECTION() here since there 2314699281b5SAndrey V. Elsukov * is no way for the caller to indiciate to us whether this 2315699281b5SAndrey V. Elsukov * packet is inbound or outbound. In the bpf_mtap() routines, 2316699281b5SAndrey V. Elsukov * we use the interface pointers on the mbuf to figure it out. 2317a05cf8c6SChristian S.J. Peron */ 2318ae275efcSJung-uk Kim #ifdef BPF_JITTER 2319a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2320a36599ccSJung-uk Kim if (bf != NULL) 2321a36599ccSJung-uk Kim slen = (*(bf->func))(pkt, pktlen, pktlen); 2322ae275efcSJung-uk Kim else 2323ae275efcSJung-uk Kim #endif 232493e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, pkt, pktlen, pktlen); 2325ec272d87SRobert Watson if (slen != 0) { 2326e4b3229aSAlexander V. Chernikov /* 2327e4b3229aSAlexander V. Chernikov * Filter matches. Let's to acquire write lock. 2328e4b3229aSAlexander V. Chernikov */ 2329afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2330b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2331253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2332699281b5SAndrey V. Elsukov gottime = bpf_gettime(&bt, d->bd_tstamp, 2333699281b5SAndrey V. Elsukov NULL); 2334ec272d87SRobert Watson #ifdef MAC 233530d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2336ec272d87SRobert Watson #endif 23374d621040SChristian S.J. Peron catchpacket(d, pkt, pktlen, slen, 2338547d94bdSJung-uk Kim bpf_append_bytes, &bt); 2339afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2340ec272d87SRobert Watson } 2341df8bae1dSRodney W. Grimes } 2342699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2343df8bae1dSRodney W. Grimes } 2344df8bae1dSRodney W. Grimes 2345f81a2a49SJung-uk Kim #define BPF_CHECK_DIRECTION(d, r, i) \ 2346f81a2a49SJung-uk Kim (((d)->bd_direction == BPF_D_IN && (r) != (i)) || \ 2347f81a2a49SJung-uk Kim ((d)->bd_direction == BPF_D_OUT && (r) == (i))) 2348560a54e1SJung-uk Kim 2349df8bae1dSRodney W. Grimes /* 2350df8bae1dSRodney W. Grimes * Incoming linkage from device drivers, when packet is in an mbuf chain. 2351e4b3229aSAlexander V. Chernikov * Locking model is explained in bpf_tap(). 2352df8bae1dSRodney W. Grimes */ 2353df8bae1dSRodney W. Grimes void 235419ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 2355df8bae1dSRodney W. Grimes { 2356699281b5SAndrey V. Elsukov struct epoch_tracker et; 2357547d94bdSJung-uk Kim struct bintime bt; 2358df8bae1dSRodney W. Grimes struct bpf_d *d; 2359a36599ccSJung-uk Kim #ifdef BPF_JITTER 2360a36599ccSJung-uk Kim bpf_jit_filter *bf; 2361a36599ccSJung-uk Kim #endif 2362253a3814SLawrence Stewart u_int pktlen, slen; 2363253a3814SLawrence Stewart int gottime; 236491433904SDavid Malone 23658cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 2366fb3bc596SJohn Baldwin if ((m->m_flags & M_PROMISC) != 0 && m_rcvif(m) == NULL) { 23678cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 23688cd892f7SJung-uk Kim return; 23698cd892f7SJung-uk Kim } 23708cd892f7SJung-uk Kim 2371f0e2422bSPoul-Henning Kamp pktlen = m_length(m, NULL); 2372253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2373e4b3229aSAlexander V. Chernikov 2374699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2375699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2376fb3bc596SJohn Baldwin if (BPF_CHECK_DIRECTION(d, m_rcvif(m), bp->bif_ifp)) 23778ed3828cSRobert Watson continue; 2378b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2379ae275efcSJung-uk Kim #ifdef BPF_JITTER 2380a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2381ae275efcSJung-uk Kim /* XXX We cannot handle multiple mbufs. */ 2382a36599ccSJung-uk Kim if (bf != NULL && m->m_next == NULL) 2383699281b5SAndrey V. Elsukov slen = (*(bf->func))(mtod(m, u_char *), pktlen, 2384699281b5SAndrey V. Elsukov pktlen); 2385ae275efcSJung-uk Kim else 2386ae275efcSJung-uk Kim #endif 238793e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)m, pktlen, 0); 23884ddfb531SChristian S.J. Peron if (slen != 0) { 2389afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2390e4b3229aSAlexander V. Chernikov 2391b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2392253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2393253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 23940c7fb534SRobert Watson #ifdef MAC 239530d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 23960c7fb534SRobert Watson #endif 23970c7fb534SRobert Watson catchpacket(d, (u_char *)m, pktlen, slen, 2398547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2399afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 24004ddfb531SChristian S.J. Peron } 2401df8bae1dSRodney W. Grimes } 2402699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2403df8bae1dSRodney W. Grimes } 2404df8bae1dSRodney W. Grimes 2405df8bae1dSRodney W. Grimes /* 2406437ffe18SSam Leffler * Incoming linkage from device drivers, when packet is in 2407437ffe18SSam Leffler * an mbuf chain and to be prepended by a contiguous header. 2408437ffe18SSam Leffler */ 2409437ffe18SSam Leffler void 241019ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m) 2411437ffe18SSam Leffler { 2412699281b5SAndrey V. Elsukov struct epoch_tracker et; 2413547d94bdSJung-uk Kim struct bintime bt; 2414437ffe18SSam Leffler struct mbuf mb; 2415437ffe18SSam Leffler struct bpf_d *d; 2416253a3814SLawrence Stewart u_int pktlen, slen; 2417253a3814SLawrence Stewart int gottime; 241891433904SDavid Malone 24198cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 24208cd892f7SJung-uk Kim if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif == NULL) { 24218cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 24228cd892f7SJung-uk Kim return; 24238cd892f7SJung-uk Kim } 24248cd892f7SJung-uk Kim 2425437ffe18SSam Leffler pktlen = m_length(m, NULL); 2426437ffe18SSam Leffler /* 2427437ffe18SSam Leffler * Craft on-stack mbuf suitable for passing to bpf_filter. 2428437ffe18SSam Leffler * Note that we cut corners here; we only setup what's 2429437ffe18SSam Leffler * absolutely needed--this mbuf should never go anywhere else. 2430437ffe18SSam Leffler */ 243182334850SJohn Baldwin mb.m_flags = 0; 2432437ffe18SSam Leffler mb.m_next = m; 2433437ffe18SSam Leffler mb.m_data = data; 2434437ffe18SSam Leffler mb.m_len = dlen; 2435437ffe18SSam Leffler pktlen += dlen; 2436437ffe18SSam Leffler 2437253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2438e4b3229aSAlexander V. Chernikov 2439699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2440699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2441f81a2a49SJung-uk Kim if (BPF_CHECK_DIRECTION(d, m->m_pkthdr.rcvif, bp->bif_ifp)) 2442437ffe18SSam Leffler continue; 2443b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 244493e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)&mb, pktlen, 0); 24454ddfb531SChristian S.J. Peron if (slen != 0) { 2446afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2447e4b3229aSAlexander V. Chernikov 2448b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2449253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2450253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 2451437ffe18SSam Leffler #ifdef MAC 245230d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2453437ffe18SSam Leffler #endif 2454437ffe18SSam Leffler catchpacket(d, (u_char *)&mb, pktlen, slen, 2455547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2456afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 24574ddfb531SChristian S.J. Peron } 2458437ffe18SSam Leffler } 2459699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2460437ffe18SSam Leffler } 2461437ffe18SSam Leffler 2462560a54e1SJung-uk Kim #undef BPF_CHECK_DIRECTION 2463253a3814SLawrence Stewart #undef BPF_TSTAMP_NONE 2464253a3814SLawrence Stewart #undef BPF_TSTAMP_FAST 2465253a3814SLawrence Stewart #undef BPF_TSTAMP_NORMAL 2466253a3814SLawrence Stewart #undef BPF_TSTAMP_EXTERN 2467253a3814SLawrence Stewart 2468547d94bdSJung-uk Kim static int 2469547d94bdSJung-uk Kim bpf_hdrlen(struct bpf_d *d) 2470547d94bdSJung-uk Kim { 2471547d94bdSJung-uk Kim int hdrlen; 2472547d94bdSJung-uk Kim 2473547d94bdSJung-uk Kim hdrlen = d->bd_bif->bif_hdrlen; 2474547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2475547d94bdSJung-uk Kim if (d->bd_tstamp == BPF_T_NONE || 2476547d94bdSJung-uk Kim BPF_T_FORMAT(d->bd_tstamp) == BPF_T_MICROTIME) 2477547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2478547d94bdSJung-uk Kim if (d->bd_compat32) 2479547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr32); 2480547d94bdSJung-uk Kim else 2481547d94bdSJung-uk Kim #endif 2482547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr); 2483547d94bdSJung-uk Kim else 2484547d94bdSJung-uk Kim #endif 2485547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_xhdr); 2486547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2487547d94bdSJung-uk Kim if (d->bd_compat32) 2488547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN32(hdrlen); 2489547d94bdSJung-uk Kim else 2490547d94bdSJung-uk Kim #endif 2491547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN(hdrlen); 2492547d94bdSJung-uk Kim 2493547d94bdSJung-uk Kim return (hdrlen - d->bd_bif->bif_hdrlen); 2494547d94bdSJung-uk Kim } 2495547d94bdSJung-uk Kim 2496547d94bdSJung-uk Kim static void 2497547d94bdSJung-uk Kim bpf_bintime2ts(struct bintime *bt, struct bpf_ts *ts, int tstype) 2498547d94bdSJung-uk Kim { 2499584b675eSKonstantin Belousov struct bintime bt2, boottimebin; 2500547d94bdSJung-uk Kim struct timeval tsm; 2501547d94bdSJung-uk Kim struct timespec tsn; 2502547d94bdSJung-uk Kim 2503253a3814SLawrence Stewart if ((tstype & BPF_T_MONOTONIC) == 0) { 2504253a3814SLawrence Stewart bt2 = *bt; 2505584b675eSKonstantin Belousov getboottimebin(&boottimebin); 2506253a3814SLawrence Stewart bintime_add(&bt2, &boottimebin); 2507253a3814SLawrence Stewart bt = &bt2; 2508253a3814SLawrence Stewart } 2509547d94bdSJung-uk Kim switch (BPF_T_FORMAT(tstype)) { 2510547d94bdSJung-uk Kim case BPF_T_MICROTIME: 2511547d94bdSJung-uk Kim bintime2timeval(bt, &tsm); 2512547d94bdSJung-uk Kim ts->bt_sec = tsm.tv_sec; 2513547d94bdSJung-uk Kim ts->bt_frac = tsm.tv_usec; 2514547d94bdSJung-uk Kim break; 2515547d94bdSJung-uk Kim case BPF_T_NANOTIME: 2516547d94bdSJung-uk Kim bintime2timespec(bt, &tsn); 2517547d94bdSJung-uk Kim ts->bt_sec = tsn.tv_sec; 2518547d94bdSJung-uk Kim ts->bt_frac = tsn.tv_nsec; 2519547d94bdSJung-uk Kim break; 2520547d94bdSJung-uk Kim case BPF_T_BINTIME: 2521547d94bdSJung-uk Kim ts->bt_sec = bt->sec; 2522547d94bdSJung-uk Kim ts->bt_frac = bt->frac; 2523547d94bdSJung-uk Kim break; 2524547d94bdSJung-uk Kim } 2525547d94bdSJung-uk Kim } 2526547d94bdSJung-uk Kim 2527437ffe18SSam Leffler /* 2528df8bae1dSRodney W. Grimes * Move the packet data from interface memory (pkt) into the 25299e610888SDag-Erling Smørgrav * store buffer. "cpfn" is the routine called to do the actual data 2530df8bae1dSRodney W. Grimes * transfer. bcopy is passed in to copy contiguous chunks, while 25314d621040SChristian S.J. Peron * bpf_append_mbuf is passed in to copy mbuf chains. In the latter case, 2532df8bae1dSRodney W. Grimes * pkt is really an mbuf. 2533df8bae1dSRodney W. Grimes */ 2534df8bae1dSRodney W. Grimes static void 253519ba8395SChristian S.J. Peron catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen, 25364d621040SChristian S.J. Peron void (*cpfn)(struct bpf_d *, caddr_t, u_int, void *, u_int), 2537547d94bdSJung-uk Kim struct bintime *bt) 2538df8bae1dSRodney W. Grimes { 2539547d94bdSJung-uk Kim struct bpf_xhdr hdr; 2540547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2541547d94bdSJung-uk Kim struct bpf_hdr hdr_old; 2542fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2543547d94bdSJung-uk Kim struct bpf_hdr32 hdr32_old; 2544fc0a61a4SKonstantin Belousov #endif 2545547d94bdSJung-uk Kim #endif 2546547d94bdSJung-uk Kim int caplen, curlen, hdrlen, totlen; 25477819da79SJohn-Mark Gurney int do_wakeup = 0; 2548547d94bdSJung-uk Kim int do_timestamp; 2549547d94bdSJung-uk Kim int tstype; 25509e610888SDag-Erling Smørgrav 2551afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 2552de253273SAndrey V. Elsukov if (d->bd_bif == NULL) { 2553de253273SAndrey V. Elsukov /* Descriptor was detached in concurrent thread */ 2554de253273SAndrey V. Elsukov counter_u64_add(d->bd_dcount, 1); 2555de253273SAndrey V. Elsukov return; 2556de253273SAndrey V. Elsukov } 25574d621040SChristian S.J. Peron 25584d621040SChristian S.J. Peron /* 25594d621040SChristian S.J. Peron * Detect whether user space has released a buffer back to us, and if 25604d621040SChristian S.J. Peron * so, move it from being a hold buffer to a free buffer. This may 25614d621040SChristian S.J. Peron * not be the best place to do it (for example, we might only want to 25624d621040SChristian S.J. Peron * run this check if we need the space), but for now it's a reliable 25634d621040SChristian S.J. Peron * spot to do it. 25644d621040SChristian S.J. Peron */ 2565fa0c2b34SRobert Watson if (d->bd_fbuf == NULL && bpf_canfreebuf(d)) { 25664d621040SChristian S.J. Peron d->bd_fbuf = d->bd_hbuf; 25674d621040SChristian S.J. Peron d->bd_hbuf = NULL; 25684d621040SChristian S.J. Peron d->bd_hlen = 0; 256929f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 25704d621040SChristian S.J. Peron } 25714d621040SChristian S.J. Peron 2572df8bae1dSRodney W. Grimes /* 2573df8bae1dSRodney W. Grimes * Figure out how many bytes to move. If the packet is 2574df8bae1dSRodney W. Grimes * greater or equal to the snapshot length, transfer that 2575df8bae1dSRodney W. Grimes * much. Otherwise, transfer the whole packet (unless 2576df8bae1dSRodney W. Grimes * we hit the buffer size limit). 2577df8bae1dSRodney W. Grimes */ 2578547d94bdSJung-uk Kim hdrlen = bpf_hdrlen(d); 2579df8bae1dSRodney W. Grimes totlen = hdrlen + min(snaplen, pktlen); 2580df8bae1dSRodney W. Grimes if (totlen > d->bd_bufsize) 2581df8bae1dSRodney W. Grimes totlen = d->bd_bufsize; 2582df8bae1dSRodney W. Grimes 2583df8bae1dSRodney W. Grimes /* 2584df8bae1dSRodney W. Grimes * Round up the end of the previous packet to the next longword. 2585a7a91e65SRobert Watson * 2586a7a91e65SRobert Watson * Drop the packet if there's no room and no hope of room 2587a7a91e65SRobert Watson * If the packet would overflow the storage buffer or the storage 2588a7a91e65SRobert Watson * buffer is considered immutable by the buffer model, try to rotate 2589a7a91e65SRobert Watson * the buffer and wakeup pending processes. 2590df8bae1dSRodney W. Grimes */ 2591fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2592fc0a61a4SKonstantin Belousov if (d->bd_compat32) 2593fc0a61a4SKonstantin Belousov curlen = BPF_WORDALIGN32(d->bd_slen); 2594fc0a61a4SKonstantin Belousov else 2595fc0a61a4SKonstantin Belousov #endif 2596df8bae1dSRodney W. Grimes curlen = BPF_WORDALIGN(d->bd_slen); 2597a7a91e65SRobert Watson if (curlen + totlen > d->bd_bufsize || !bpf_canwritebuf(d)) { 2598572bde2aSRobert Watson if (d->bd_fbuf == NULL) { 2599df8bae1dSRodney W. Grimes /* 2600a7a91e65SRobert Watson * There's no room in the store buffer, and no 2601a7a91e65SRobert Watson * prospect of room, so drop the packet. Notify the 2602a7a91e65SRobert Watson * buffer model. 2603df8bae1dSRodney W. Grimes */ 2604a7a91e65SRobert Watson bpf_buffull(d); 2605b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_dcount, 1); 2606df8bae1dSRodney W. Grimes return; 2607df8bae1dSRodney W. Grimes } 260898fa5d85SLuiz Otavio O Souza KASSERT(!d->bd_hbuf_in_use, ("hold buffer is in use")); 2609df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 26107819da79SJohn-Mark Gurney do_wakeup = 1; 2611df8bae1dSRodney W. Grimes curlen = 0; 2612a7a91e65SRobert Watson } else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT) 2613df8bae1dSRodney W. Grimes /* 26144d621040SChristian S.J. Peron * Immediate mode is set, or the read timeout has already 26154d621040SChristian S.J. Peron * expired during a select call. A packet arrived, so the 26164d621040SChristian S.J. Peron * reader should be woken up. 2617df8bae1dSRodney W. Grimes */ 26187819da79SJohn-Mark Gurney do_wakeup = 1; 2619547d94bdSJung-uk Kim caplen = totlen - hdrlen; 2620547d94bdSJung-uk Kim tstype = d->bd_tstamp; 2621547d94bdSJung-uk Kim do_timestamp = tstype != BPF_T_NONE; 2622547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2623547d94bdSJung-uk Kim if (tstype == BPF_T_NONE || BPF_T_FORMAT(tstype) == BPF_T_MICROTIME) { 2624547d94bdSJung-uk Kim struct bpf_ts ts; 2625547d94bdSJung-uk Kim if (do_timestamp) 2626547d94bdSJung-uk Kim bpf_bintime2ts(bt, &ts, tstype); 2627fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2628fc0a61a4SKonstantin Belousov if (d->bd_compat32) { 2629547d94bdSJung-uk Kim bzero(&hdr32_old, sizeof(hdr32_old)); 2630547d94bdSJung-uk Kim if (do_timestamp) { 2631547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_sec = ts.bt_sec; 2632547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_usec = ts.bt_frac; 2633547d94bdSJung-uk Kim } 2634547d94bdSJung-uk Kim hdr32_old.bh_datalen = pktlen; 2635547d94bdSJung-uk Kim hdr32_old.bh_hdrlen = hdrlen; 2636547d94bdSJung-uk Kim hdr32_old.bh_caplen = caplen; 2637547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr32_old, 2638547d94bdSJung-uk Kim sizeof(hdr32_old)); 2639547d94bdSJung-uk Kim goto copy; 2640547d94bdSJung-uk Kim } 2641547d94bdSJung-uk Kim #endif 2642547d94bdSJung-uk Kim bzero(&hdr_old, sizeof(hdr_old)); 2643547d94bdSJung-uk Kim if (do_timestamp) { 2644547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_sec = ts.bt_sec; 2645547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_usec = ts.bt_frac; 2646547d94bdSJung-uk Kim } 2647547d94bdSJung-uk Kim hdr_old.bh_datalen = pktlen; 2648547d94bdSJung-uk Kim hdr_old.bh_hdrlen = hdrlen; 2649547d94bdSJung-uk Kim hdr_old.bh_caplen = caplen; 2650547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr_old, 2651547d94bdSJung-uk Kim sizeof(hdr_old)); 2652fc0a61a4SKonstantin Belousov goto copy; 2653fc0a61a4SKonstantin Belousov } 2654fc0a61a4SKonstantin Belousov #endif 2655df8bae1dSRodney W. Grimes 2656df8bae1dSRodney W. Grimes /* 26574d621040SChristian S.J. Peron * Append the bpf header. Note we append the actual header size, but 26584d621040SChristian S.J. Peron * move forward the length of the header plus padding. 2659df8bae1dSRodney W. Grimes */ 26604d621040SChristian S.J. Peron bzero(&hdr, sizeof(hdr)); 2661547d94bdSJung-uk Kim if (do_timestamp) 2662547d94bdSJung-uk Kim bpf_bintime2ts(bt, &hdr.bh_tstamp, tstype); 26634d621040SChristian S.J. Peron hdr.bh_datalen = pktlen; 26644d621040SChristian S.J. Peron hdr.bh_hdrlen = hdrlen; 2665547d94bdSJung-uk Kim hdr.bh_caplen = caplen; 26664d621040SChristian S.J. Peron bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr, sizeof(hdr)); 26674d621040SChristian S.J. Peron 2668df8bae1dSRodney W. Grimes /* 2669df8bae1dSRodney W. Grimes * Copy the packet data into the store buffer and update its length. 2670df8bae1dSRodney W. Grimes */ 2671547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2672fc0a61a4SKonstantin Belousov copy: 2673fc0a61a4SKonstantin Belousov #endif 2674547d94bdSJung-uk Kim (*cpfn)(d, d->bd_sbuf, curlen + hdrlen, pkt, caplen); 2675df8bae1dSRodney W. Grimes d->bd_slen = curlen + totlen; 26767819da79SJohn-Mark Gurney 26777819da79SJohn-Mark Gurney if (do_wakeup) 26787819da79SJohn-Mark Gurney bpf_wakeup(d); 2679df8bae1dSRodney W. Grimes } 2680df8bae1dSRodney W. Grimes 2681df8bae1dSRodney W. Grimes /* 2682df8bae1dSRodney W. Grimes * Free buffers currently in use by a descriptor. 2683df8bae1dSRodney W. Grimes * Called on close. 2684df8bae1dSRodney W. Grimes */ 2685df8bae1dSRodney W. Grimes static void 2686699281b5SAndrey V. Elsukov bpfd_free(epoch_context_t ctx) 2687df8bae1dSRodney W. Grimes { 2688699281b5SAndrey V. Elsukov struct bpf_d *d; 2689699281b5SAndrey V. Elsukov struct bpf_program_buffer *p; 26904d621040SChristian S.J. Peron 2691df8bae1dSRodney W. Grimes /* 2692df8bae1dSRodney W. Grimes * We don't need to lock out interrupts since this descriptor has 2693df8bae1dSRodney W. Grimes * been detached from its interface and it yet hasn't been marked 2694df8bae1dSRodney W. Grimes * free. 2695df8bae1dSRodney W. Grimes */ 2696699281b5SAndrey V. Elsukov d = __containerof(ctx, struct bpf_d, epoch_ctx); 26974d621040SChristian S.J. Peron bpf_free(d); 269870485847SJung-uk Kim if (d->bd_rfilter != NULL) { 2699699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_rfilter, 2700699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2701af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2702af1f58dfSAndrey V. Elsukov p->func = d->bd_bfilter; 2703af1f58dfSAndrey V. Elsukov #endif 2704699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2705ae275efcSJung-uk Kim } 2706699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2707699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_wfilter, 2708699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2709af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2710af1f58dfSAndrey V. Elsukov p->func = NULL; 2711af1f58dfSAndrey V. Elsukov #endif 2712699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2713699281b5SAndrey V. Elsukov } 2714b2b7ca49SAlexander V. Chernikov 2715699281b5SAndrey V. Elsukov mtx_destroy(&d->bd_lock); 2716b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_rcount); 2717b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_dcount); 2718b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_fcount); 2719b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wcount); 2720b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wfcount); 2721b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wdcount); 2722b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_zcopy); 2723699281b5SAndrey V. Elsukov free(d, M_BPF); 2724df8bae1dSRodney W. Grimes } 2725df8bae1dSRodney W. Grimes 2726df8bae1dSRodney W. Grimes /* 272724a229f4SSam Leffler * Attach an interface to bpf. dlt is the link layer type; hdrlen is the 272824a229f4SSam Leffler * fixed size of the link header (variable length headers not yet supported). 2729df8bae1dSRodney W. Grimes */ 2730df8bae1dSRodney W. Grimes void 273119ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 2732df8bae1dSRodney W. Grimes { 273324a229f4SSam Leffler 273424a229f4SSam Leffler bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 273524a229f4SSam Leffler } 273624a229f4SSam Leffler 273724a229f4SSam Leffler /* 273824a229f4SSam Leffler * Attach an interface to bpf. ifp is a pointer to the structure 273924a229f4SSam Leffler * defining the interface to be attached, dlt is the link layer type, 274024a229f4SSam Leffler * and hdrlen is the fixed size of the link header (variable length 274124a229f4SSam Leffler * headers are not yet supporrted). 274224a229f4SSam Leffler */ 274324a229f4SSam Leffler void 2744699281b5SAndrey V. Elsukov bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, 2745699281b5SAndrey V. Elsukov struct bpf_if **driverp) 274624a229f4SSam Leffler { 2747df8bae1dSRodney W. Grimes struct bpf_if *bp; 274819ba8395SChristian S.J. Peron 2749699281b5SAndrey V. Elsukov KASSERT(*driverp == NULL, 2750699281b5SAndrey V. Elsukov ("bpfattach2: driverp already initialized")); 2751df8bae1dSRodney W. Grimes 2752c5be49daSAndrey V. Elsukov bp = malloc(sizeof(*bp), M_BPF, M_WAITOK | M_ZERO); 2753c5be49daSAndrey V. Elsukov 2754699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_dlist); 2755699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_wlist); 2756df8bae1dSRodney W. Grimes bp->bif_ifp = ifp; 2757df8bae1dSRodney W. Grimes bp->bif_dlt = dlt; 2758c5be49daSAndrey V. Elsukov bp->bif_hdrlen = hdrlen; 27599ce40d32SKristof Provost bp->bif_bpf = driverp; 2760699281b5SAndrey V. Elsukov bp->bif_refcnt = 1; 276116d878ccSChristian S.J. Peron *driverp = bp; 2762699281b5SAndrey V. Elsukov /* 2763699281b5SAndrey V. Elsukov * Reference ifnet pointer, so it won't freed until 2764699281b5SAndrey V. Elsukov * we release it. 2765699281b5SAndrey V. Elsukov */ 2766699281b5SAndrey V. Elsukov if_ref(ifp); 2767e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2768699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bpf_iflist, bp, bif_next); 2769e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 2770df8bae1dSRodney W. Grimes 2771616bc4f4SBjoern A. Zeeb if (bootverbose && IS_DEFAULT_VNET(curvnet)) 277224a229f4SSam Leffler if_printf(ifp, "bpf attached\n"); 2773df8bae1dSRodney W. Grimes } 277453ac6efbSJulian Elischer 277505fc4164SBjoern A. Zeeb #ifdef VIMAGE 277605fc4164SBjoern A. Zeeb /* 277705fc4164SBjoern A. Zeeb * When moving interfaces between vnet instances we need a way to 277805fc4164SBjoern A. Zeeb * query the dlt and hdrlen before detach so we can re-attch the if_bpf 277905fc4164SBjoern A. Zeeb * after the vmove. We unfortunately have no device driver infrastructure 278005fc4164SBjoern A. Zeeb * to query the interface for these values after creation/attach, thus 278105fc4164SBjoern A. Zeeb * add this as a workaround. 278205fc4164SBjoern A. Zeeb */ 278305fc4164SBjoern A. Zeeb int 278405fc4164SBjoern A. Zeeb bpf_get_bp_params(struct bpf_if *bp, u_int *bif_dlt, u_int *bif_hdrlen) 278505fc4164SBjoern A. Zeeb { 278605fc4164SBjoern A. Zeeb 278705fc4164SBjoern A. Zeeb if (bp == NULL) 278805fc4164SBjoern A. Zeeb return (ENXIO); 278905fc4164SBjoern A. Zeeb if (bif_dlt == NULL && bif_hdrlen == NULL) 279005fc4164SBjoern A. Zeeb return (0); 279105fc4164SBjoern A. Zeeb 279205fc4164SBjoern A. Zeeb if (bif_dlt != NULL) 279305fc4164SBjoern A. Zeeb *bif_dlt = bp->bif_dlt; 279405fc4164SBjoern A. Zeeb if (bif_hdrlen != NULL) 279505fc4164SBjoern A. Zeeb *bif_hdrlen = bp->bif_hdrlen; 279605fc4164SBjoern A. Zeeb 279705fc4164SBjoern A. Zeeb return (0); 279805fc4164SBjoern A. Zeeb } 279905fc4164SBjoern A. Zeeb #endif 280005fc4164SBjoern A. Zeeb 2801de5d9935SRobert Watson /* 2802de5d9935SRobert Watson * Detach bpf from an interface. This involves detaching each descriptor 28036c74ff0eSAlexander V. Chernikov * associated with the interface. Notify each descriptor as it's detached 28046c74ff0eSAlexander V. Chernikov * so that any sleepers wake up and get ENXIO. 2805de5d9935SRobert Watson */ 2806de5d9935SRobert Watson void 280719ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 2808de5d9935SRobert Watson { 2809f079a0faSAlexander V. Chernikov struct bpf_if *bp, *bp_temp; 2810de5d9935SRobert Watson struct bpf_d *d; 28119a7e6bacSLawrence Stewart 2812afa85850SAlexander V. Chernikov BPF_LOCK(); 28139a7e6bacSLawrence Stewart /* Find all bpf_if struct's which reference ifp and detach them. */ 2814699281b5SAndrey V. Elsukov CK_LIST_FOREACH_SAFE(bp, &bpf_iflist, bif_next, bp_temp) { 2815f079a0faSAlexander V. Chernikov if (ifp != bp->bif_ifp) 2816f079a0faSAlexander V. Chernikov continue; 2817de5d9935SRobert Watson 2818699281b5SAndrey V. Elsukov CK_LIST_REMOVE(bp, bif_next); 28198bd1f0cfSMark Johnston *bp->bif_bpf = (struct bpf_if *)&dead_bpf_if; 2820f079a0faSAlexander V. Chernikov 2821699281b5SAndrey V. Elsukov CTR4(KTR_NET, 2822699281b5SAndrey V. Elsukov "%s: sheduling free for encap %d (%p) for if %p", 2823f079a0faSAlexander V. Chernikov __func__, bp->bif_dlt, bp, ifp); 2824f079a0faSAlexander V. Chernikov 2825699281b5SAndrey V. Elsukov /* Detach common descriptors */ 2826699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_dlist)) != NULL) { 2827699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 2828e7bb21b3SJonathan Lemon } 2829f079a0faSAlexander V. Chernikov 2830699281b5SAndrey V. Elsukov /* Detach writer-only descriptors */ 2831699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_wlist)) != NULL) { 2832699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 28336c74ff0eSAlexander V. Chernikov } 2834699281b5SAndrey V. Elsukov bpfif_rele(bp); 2835f079a0faSAlexander V. Chernikov } 2836f079a0faSAlexander V. Chernikov BPF_UNLOCK(); 2837afa85850SAlexander V. Chernikov } 2838afa85850SAlexander V. Chernikov 2839afa85850SAlexander V. Chernikov /* 28408eab61f3SSam Leffler * Get a list of available data link type of the interface. 28418eab61f3SSam Leffler */ 28428eab61f3SSam Leffler static int 284319ba8395SChristian S.J. Peron bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl) 28448eab61f3SSam Leffler { 28458eab61f3SSam Leffler struct ifnet *ifp; 28468eab61f3SSam Leffler struct bpf_if *bp; 284770209acaSKonstantin Belousov u_int *lst; 284870209acaSKonstantin Belousov int error, n, n1; 28498eab61f3SSam Leffler 285097aacec6SAlexander V. Chernikov BPF_LOCK_ASSERT(); 285197aacec6SAlexander V. Chernikov 28528eab61f3SSam Leffler ifp = d->bd_bif->bif_ifp; 285370209acaSKonstantin Belousov n1 = 0; 2854699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 285570209acaSKonstantin Belousov if (bp->bif_ifp == ifp) 285670209acaSKonstantin Belousov n1++; 285770209acaSKonstantin Belousov } 285870209acaSKonstantin Belousov if (bfl->bfl_list == NULL) { 285970209acaSKonstantin Belousov bfl->bfl_len = n1; 286070209acaSKonstantin Belousov return (0); 286170209acaSKonstantin Belousov } 286270209acaSKonstantin Belousov if (n1 > bfl->bfl_len) 286370209acaSKonstantin Belousov return (ENOMEM); 2864699281b5SAndrey V. Elsukov 286570209acaSKonstantin Belousov lst = malloc(n1 * sizeof(u_int), M_TEMP, M_WAITOK); 28668eab61f3SSam Leffler n = 0; 2867699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 28688eab61f3SSam Leffler if (bp->bif_ifp != ifp) 28698eab61f3SSam Leffler continue; 2870699281b5SAndrey V. Elsukov lst[n++] = bp->bif_dlt; 28718eab61f3SSam Leffler } 287270209acaSKonstantin Belousov error = copyout(lst, bfl->bfl_list, sizeof(u_int) * n); 287370209acaSKonstantin Belousov free(lst, M_TEMP); 28748eab61f3SSam Leffler bfl->bfl_len = n; 28758eab61f3SSam Leffler return (error); 28768eab61f3SSam Leffler } 28778eab61f3SSam Leffler 28788eab61f3SSam Leffler /* 28798eab61f3SSam Leffler * Set the data link type of a BPF instance. 28808eab61f3SSam Leffler */ 28818eab61f3SSam Leffler static int 288219ba8395SChristian S.J. Peron bpf_setdlt(struct bpf_d *d, u_int dlt) 28838eab61f3SSam Leffler { 28848eab61f3SSam Leffler int error, opromisc; 28858eab61f3SSam Leffler struct ifnet *ifp; 28868eab61f3SSam Leffler struct bpf_if *bp; 28878eab61f3SSam Leffler 28886c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 2889699281b5SAndrey V. Elsukov MPASS(d->bd_bif != NULL); 28906c74ff0eSAlexander V. Chernikov 2891699281b5SAndrey V. Elsukov /* 2892699281b5SAndrey V. Elsukov * It is safe to check bd_bif without BPFD_LOCK, it can not be 2893699281b5SAndrey V. Elsukov * changed while we hold global lock. 2894699281b5SAndrey V. Elsukov */ 28958eab61f3SSam Leffler if (d->bd_bif->bif_dlt == dlt) 28968eab61f3SSam Leffler return (0); 28976c74ff0eSAlexander V. Chernikov 2898699281b5SAndrey V. Elsukov ifp = d->bd_bif->bif_ifp; 2899699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 29008eab61f3SSam Leffler if (bp->bif_ifp == ifp && bp->bif_dlt == dlt) 29018eab61f3SSam Leffler break; 29028eab61f3SSam Leffler } 2903699281b5SAndrey V. Elsukov if (bp == NULL) 2904699281b5SAndrey V. Elsukov return (EINVAL); 29056c74ff0eSAlexander V. Chernikov 29068eab61f3SSam Leffler opromisc = d->bd_promisc; 29078eab61f3SSam Leffler bpf_attachd(d, bp); 29088eab61f3SSam Leffler if (opromisc) { 29098eab61f3SSam Leffler error = ifpromisc(bp->bif_ifp, 1); 29108eab61f3SSam Leffler if (error) 2911699281b5SAndrey V. Elsukov if_printf(bp->bif_ifp, "%s: ifpromisc failed (%d)\n", 2912699281b5SAndrey V. Elsukov __func__, error); 29138eab61f3SSam Leffler else 29148eab61f3SSam Leffler d->bd_promisc = 1; 29158eab61f3SSam Leffler } 2916699281b5SAndrey V. Elsukov return (0); 2917de5d9935SRobert Watson } 2918de5d9935SRobert Watson 29193f54a085SPoul-Henning Kamp static void 292019ba8395SChristian S.J. Peron bpf_drvinit(void *unused) 292153ac6efbSJulian Elischer { 2922136600feSEd Schouten struct cdev *dev; 292353ac6efbSJulian Elischer 2924f422673eSStephen Hurd sx_init(&bpf_sx, "bpf global lock"); 2925699281b5SAndrey V. Elsukov CK_LIST_INIT(&bpf_iflist); 2926136600feSEd Schouten 2927136600feSEd Schouten dev = make_dev(&bpf_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "bpf"); 2928136600feSEd Schouten /* For compatibility */ 2929136600feSEd Schouten make_dev_alias(dev, "bpf0"); 29307198bf47SJulian Elischer } 293153ac6efbSJulian Elischer 29320e37f3e1SChristian S.J. Peron /* 29330e37f3e1SChristian S.J. Peron * Zero out the various packet counters associated with all of the bpf 29340e37f3e1SChristian S.J. Peron * descriptors. At some point, we will probably want to get a bit more 29350e37f3e1SChristian S.J. Peron * granular and allow the user to specify descriptors to be zeroed. 29360e37f3e1SChristian S.J. Peron */ 29370e37f3e1SChristian S.J. Peron static void 29380e37f3e1SChristian S.J. Peron bpf_zero_counters(void) 29390e37f3e1SChristian S.J. Peron { 29400e37f3e1SChristian S.J. Peron struct bpf_if *bp; 29410e37f3e1SChristian S.J. Peron struct bpf_d *bd; 29420e37f3e1SChristian S.J. Peron 2943e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2944699281b5SAndrey V. Elsukov /* 2945699281b5SAndrey V. Elsukov * We are protected by global lock here, interfaces and 2946699281b5SAndrey V. Elsukov * descriptors can not be deleted while we hold it. 2947699281b5SAndrey V. Elsukov */ 2948699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 2949699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 2950b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_rcount); 2951b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_dcount); 2952b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_fcount); 2953b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wcount); 2954b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wfcount); 2955b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_zcopy); 29560e37f3e1SChristian S.J. Peron } 29570e37f3e1SChristian S.J. Peron } 2958e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 29590e37f3e1SChristian S.J. Peron } 29600e37f3e1SChristian S.J. Peron 29616c74ff0eSAlexander V. Chernikov /* 29626c74ff0eSAlexander V. Chernikov * Fill filter statistics 29636c74ff0eSAlexander V. Chernikov */ 296469f7644bSChristian S.J. Peron static void 296569f7644bSChristian S.J. Peron bpfstats_fill_xbpf(struct xbpf_d *d, struct bpf_d *bd) 296669f7644bSChristian S.J. Peron { 296769f7644bSChristian S.J. Peron 2968699281b5SAndrey V. Elsukov BPF_LOCK_ASSERT(); 296969f7644bSChristian S.J. Peron bzero(d, sizeof(*d)); 29704d621040SChristian S.J. Peron d->bd_structsize = sizeof(*d); 297169f7644bSChristian S.J. Peron d->bd_immediate = bd->bd_immediate; 297269f7644bSChristian S.J. Peron d->bd_promisc = bd->bd_promisc; 297369f7644bSChristian S.J. Peron d->bd_hdrcmplt = bd->bd_hdrcmplt; 2974560a54e1SJung-uk Kim d->bd_direction = bd->bd_direction; 2975560a54e1SJung-uk Kim d->bd_feedback = bd->bd_feedback; 297669f7644bSChristian S.J. Peron d->bd_async = bd->bd_async; 2977b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_fetch(bd->bd_rcount); 2978b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_fetch(bd->bd_dcount); 2979b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_fetch(bd->bd_fcount); 298069f7644bSChristian S.J. Peron d->bd_sig = bd->bd_sig; 298169f7644bSChristian S.J. Peron d->bd_slen = bd->bd_slen; 298269f7644bSChristian S.J. Peron d->bd_hlen = bd->bd_hlen; 298369f7644bSChristian S.J. Peron d->bd_bufsize = bd->bd_bufsize; 298469f7644bSChristian S.J. Peron d->bd_pid = bd->bd_pid; 298569f7644bSChristian S.J. Peron strlcpy(d->bd_ifname, 298669f7644bSChristian S.J. Peron bd->bd_bif->bif_ifp->if_xname, IFNAMSIZ); 298793e39f0bSChristian S.J. Peron d->bd_locked = bd->bd_locked; 2988b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_fetch(bd->bd_wcount); 2989b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_fetch(bd->bd_wdcount); 2990b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_fetch(bd->bd_wfcount); 2991b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_fetch(bd->bd_zcopy); 29924d621040SChristian S.J. Peron d->bd_bufmode = bd->bd_bufmode; 299369f7644bSChristian S.J. Peron } 299469f7644bSChristian S.J. Peron 29956c74ff0eSAlexander V. Chernikov /* 29966c74ff0eSAlexander V. Chernikov * Handle `netstat -B' stats request 29976c74ff0eSAlexander V. Chernikov */ 299869f7644bSChristian S.J. Peron static int 299969f7644bSChristian S.J. Peron bpf_stats_sysctl(SYSCTL_HANDLER_ARGS) 300069f7644bSChristian S.J. Peron { 30010e1152fcSHans Petter Selasky static const struct xbpf_d zerostats; 30020e1152fcSHans Petter Selasky struct xbpf_d *xbdbuf, *xbd, tempstats; 3003422a63daSChristian S.J. Peron int index, error; 300469f7644bSChristian S.J. Peron struct bpf_if *bp; 300569f7644bSChristian S.J. Peron struct bpf_d *bd; 300669f7644bSChristian S.J. Peron 300769f7644bSChristian S.J. Peron /* 300869f7644bSChristian S.J. Peron * XXX This is not technically correct. It is possible for non 300969f7644bSChristian S.J. Peron * privileged users to open bpf devices. It would make sense 301069f7644bSChristian S.J. Peron * if the users who opened the devices were able to retrieve 301169f7644bSChristian S.J. Peron * the statistics for them, too. 301269f7644bSChristian S.J. Peron */ 3013acd3428bSRobert Watson error = priv_check(req->td, PRIV_NET_BPF); 301469f7644bSChristian S.J. Peron if (error) 301569f7644bSChristian S.J. Peron return (error); 30160e37f3e1SChristian S.J. Peron /* 30170e37f3e1SChristian S.J. Peron * Check to see if the user is requesting that the counters be 30180e37f3e1SChristian S.J. Peron * zeroed out. Explicitly check that the supplied data is zeroed, 30190e37f3e1SChristian S.J. Peron * as we aren't allowing the user to set the counters currently. 30200e37f3e1SChristian S.J. Peron */ 30210e37f3e1SChristian S.J. Peron if (req->newptr != NULL) { 30220e1152fcSHans Petter Selasky if (req->newlen != sizeof(tempstats)) 30230e37f3e1SChristian S.J. Peron return (EINVAL); 30240e1152fcSHans Petter Selasky memset(&tempstats, 0, sizeof(tempstats)); 30250e1152fcSHans Petter Selasky error = SYSCTL_IN(req, &tempstats, sizeof(tempstats)); 30260e1152fcSHans Petter Selasky if (error) 30270e1152fcSHans Petter Selasky return (error); 30280e1152fcSHans Petter Selasky if (bcmp(&tempstats, &zerostats, sizeof(tempstats)) != 0) 30290e37f3e1SChristian S.J. Peron return (EINVAL); 30300e37f3e1SChristian S.J. Peron bpf_zero_counters(); 30310e37f3e1SChristian S.J. Peron return (0); 30320e37f3e1SChristian S.J. Peron } 303369f7644bSChristian S.J. Peron if (req->oldptr == NULL) 3034422a63daSChristian S.J. Peron return (SYSCTL_OUT(req, 0, bpf_bpfd_cnt * sizeof(*xbd))); 303569f7644bSChristian S.J. Peron if (bpf_bpfd_cnt == 0) 303669f7644bSChristian S.J. Peron return (SYSCTL_OUT(req, 0, 0)); 3037422a63daSChristian S.J. Peron xbdbuf = malloc(req->oldlen, M_BPF, M_WAITOK); 3038e4b3229aSAlexander V. Chernikov BPF_LOCK(); 3039422a63daSChristian S.J. Peron if (req->oldlen < (bpf_bpfd_cnt * sizeof(*xbd))) { 3040e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3041422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 3042422a63daSChristian S.J. Peron return (ENOMEM); 3043422a63daSChristian S.J. Peron } 3044422a63daSChristian S.J. Peron index = 0; 3045699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 304651ec1eb7SAlexander V. Chernikov /* Send writers-only first */ 3047699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_wlist, bd_next) { 304851ec1eb7SAlexander V. Chernikov xbd = &xbdbuf[index++]; 304951ec1eb7SAlexander V. Chernikov bpfstats_fill_xbpf(xbd, bd); 305051ec1eb7SAlexander V. Chernikov } 3051699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 3052422a63daSChristian S.J. Peron xbd = &xbdbuf[index++]; 3053422a63daSChristian S.J. Peron bpfstats_fill_xbpf(xbd, bd); 305469f7644bSChristian S.J. Peron } 305569f7644bSChristian S.J. Peron } 3056e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3057422a63daSChristian S.J. Peron error = SYSCTL_OUT(req, xbdbuf, index * sizeof(*xbd)); 3058422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 305969f7644bSChristian S.J. Peron return (error); 306069f7644bSChristian S.J. Peron } 306169f7644bSChristian S.J. Peron 3062237fdd78SRobert Watson SYSINIT(bpfdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE,bpf_drvinit,NULL); 306353ac6efbSJulian Elischer 30645bb5f2c9SPeter Wemm #else /* !DEV_BPF && !NETGRAPH_BPF */ 30658bd1f0cfSMark Johnston 3066f8dc4716SMike Smith /* 3067f8dc4716SMike Smith * NOP stubs to allow bpf-using drivers to load and function. 3068f8dc4716SMike Smith * 3069f8dc4716SMike Smith * A 'better' implementation would allow the core bpf functionality 3070f8dc4716SMike Smith * to be loaded at runtime. 3071f8dc4716SMike Smith */ 3072f8dc4716SMike Smith 3073f8dc4716SMike Smith void 307419ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 3075f8dc4716SMike Smith { 3076f8dc4716SMike Smith } 3077f8dc4716SMike Smith 3078f8dc4716SMike Smith void 307919ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 3080f8dc4716SMike Smith { 3081f8dc4716SMike Smith } 3082f8dc4716SMike Smith 3083f8dc4716SMike Smith void 308419ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *d, u_int l, struct mbuf *m) 3085437ffe18SSam Leffler { 3086437ffe18SSam Leffler } 3087437ffe18SSam Leffler 3088437ffe18SSam Leffler void 308919ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 3090f8dc4716SMike Smith { 30917eae78a4SChristian S.J. Peron 30927eae78a4SChristian S.J. Peron bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 3093f8dc4716SMike Smith } 3094f8dc4716SMike Smith 3095da626c17SBill Paul void 309619ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp) 30975f7a7923SSam Leffler { 30987eae78a4SChristian S.J. Peron 30998bd1f0cfSMark Johnston *driverp = (struct bpf_if *)&dead_bpf_if; 31005f7a7923SSam Leffler } 31015f7a7923SSam Leffler 31025f7a7923SSam Leffler void 310319ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 3104da626c17SBill Paul { 3105da626c17SBill Paul } 3106da626c17SBill Paul 3107f8dc4716SMike Smith u_int 310819ba8395SChristian S.J. Peron bpf_filter(const struct bpf_insn *pc, u_char *p, u_int wirelen, u_int buflen) 3109f8dc4716SMike Smith { 3110f8dc4716SMike Smith return -1; /* "no filter" behaviour */ 3111f8dc4716SMike Smith } 3112f8dc4716SMike Smith 31135bb5f2c9SPeter Wemm int 311419ba8395SChristian S.J. Peron bpf_validate(const struct bpf_insn *f, int len) 31155bb5f2c9SPeter Wemm { 31165bb5f2c9SPeter Wemm return 0; /* false */ 31175bb5f2c9SPeter Wemm } 31185bb5f2c9SPeter Wemm 31195bb5f2c9SPeter Wemm #endif /* !DEV_BPF && !NETGRAPH_BPF */ 312005fc4164SBjoern A. Zeeb 312105fc4164SBjoern A. Zeeb #ifdef DDB 312205fc4164SBjoern A. Zeeb static void 312305fc4164SBjoern A. Zeeb bpf_show_bpf_if(struct bpf_if *bpf_if) 312405fc4164SBjoern A. Zeeb { 312505fc4164SBjoern A. Zeeb 312605fc4164SBjoern A. Zeeb if (bpf_if == NULL) 312705fc4164SBjoern A. Zeeb return; 312805fc4164SBjoern A. Zeeb db_printf("%p:\n", bpf_if); 312905fc4164SBjoern A. Zeeb #define BPF_DB_PRINTF(f, e) db_printf(" %s = " f "\n", #e, bpf_if->e); 313005fc4164SBjoern A. Zeeb /* bif_ext.bif_next */ 313105fc4164SBjoern A. Zeeb /* bif_ext.bif_dlist */ 313205fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%#x", bif_dlt); 313305fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%u", bif_hdrlen); 313405fc4164SBjoern A. Zeeb /* bif_wlist */ 3135699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_ifp); 3136699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_bpf); 3137699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%u", bif_refcnt); 313805fc4164SBjoern A. Zeeb } 313905fc4164SBjoern A. Zeeb 314005fc4164SBjoern A. Zeeb DB_SHOW_COMMAND(bpf_if, db_show_bpf_if) 314105fc4164SBjoern A. Zeeb { 314205fc4164SBjoern A. Zeeb 314305fc4164SBjoern A. Zeeb if (!have_addr) { 314405fc4164SBjoern A. Zeeb db_printf("usage: show bpf_if <struct bpf_if *>\n"); 314505fc4164SBjoern A. Zeeb return; 314605fc4164SBjoern A. Zeeb } 314705fc4164SBjoern A. Zeeb 314805fc4164SBjoern A. Zeeb bpf_show_bpf_if((struct bpf_if *)addr); 314905fc4164SBjoern A. Zeeb } 315005fc4164SBjoern A. Zeeb #endif 3151