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); 216a3272e3cSChristian S.J. Peron static void bpf_drvinit(void *); 21769f7644bSChristian S.J. Peron static int bpf_stats_sysctl(SYSCTL_HANDLER_ARGS); 21869f7644bSChristian S.J. Peron 2197029da5cSPawel Biernacki SYSCTL_NODE(_net, OID_AUTO, bpf, CTLFLAG_RW | CTLFLAG_MPSAFE, 0, 2207029da5cSPawel Biernacki "bpf sysctl"); 22112dc9582SJung-uk Kim int bpf_maxinsns = BPF_MAXINSNS; 22269f7644bSChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, maxinsns, CTLFLAG_RW, 22369f7644bSChristian S.J. Peron &bpf_maxinsns, 0, "Maximum bpf program instructions"); 224ffeeb924SChristian S.J. Peron static int bpf_zerocopy_enable = 0; 2254d621040SChristian S.J. Peron SYSCTL_INT(_net_bpf, OID_AUTO, zerocopy_enable, CTLFLAG_RW, 2264d621040SChristian S.J. Peron &bpf_zerocopy_enable, 0, "Enable new zero-copy BPF buffer sessions"); 2276472ac3dSEd Schouten static SYSCTL_NODE(_net_bpf, OID_AUTO, stats, CTLFLAG_MPSAFE | CTLFLAG_RW, 22869f7644bSChristian S.J. Peron bpf_stats_sysctl, "bpf statistics portal"); 229df8bae1dSRodney W. Grimes 2305f901c92SAndrew Turner VNET_DEFINE_STATIC(int, bpf_optimize_writers) = 0; 23151ec1eb7SAlexander V. Chernikov #define V_bpf_optimize_writers VNET(bpf_optimize_writers) 232c774294cSTycho Nightingale SYSCTL_INT(_net_bpf, OID_AUTO, optimize_writers, CTLFLAG_VNET | CTLFLAG_RWTUN, 2336df8a710SGleb Smirnoff &VNET_NAME(bpf_optimize_writers), 0, 23451ec1eb7SAlexander V. Chernikov "Do not send packets until BPF program is set"); 23551ec1eb7SAlexander V. Chernikov 23687f6c662SJulian Elischer static d_open_t bpfopen; 23787f6c662SJulian Elischer static d_read_t bpfread; 23887f6c662SJulian Elischer static d_write_t bpfwrite; 23987f6c662SJulian Elischer static d_ioctl_t bpfioctl; 240243ac7d8SPeter Wemm static d_poll_t bpfpoll; 24195aab9ccSJohn-Mark Gurney static d_kqfilter_t bpfkqfilter; 24287f6c662SJulian Elischer 2434e2f199eSPoul-Henning Kamp static struct cdevsw bpf_cdevsw = { 244dc08ffecSPoul-Henning Kamp .d_version = D_VERSION, 2457ac40f5fSPoul-Henning Kamp .d_open = bpfopen, 2467ac40f5fSPoul-Henning Kamp .d_read = bpfread, 2477ac40f5fSPoul-Henning Kamp .d_write = bpfwrite, 2487ac40f5fSPoul-Henning Kamp .d_ioctl = bpfioctl, 2497ac40f5fSPoul-Henning Kamp .d_poll = bpfpoll, 2507ac40f5fSPoul-Henning Kamp .d_name = "bpf", 25195aab9ccSJohn-Mark Gurney .d_kqfilter = bpfkqfilter, 2524e2f199eSPoul-Henning Kamp }; 25387f6c662SJulian Elischer 254e76d823bSRobert Watson static struct filterops bpfread_filtops = { 255e76d823bSRobert Watson .f_isfd = 1, 256e76d823bSRobert Watson .f_detach = filt_bpfdetach, 257e76d823bSRobert Watson .f_event = filt_bpfread, 258e76d823bSRobert Watson }; 25987f6c662SJulian Elischer 2604d621040SChristian S.J. Peron /* 261699281b5SAndrey V. Elsukov * LOCKING MODEL USED BY BPF 262699281b5SAndrey V. Elsukov * 2636c74ff0eSAlexander V. Chernikov * Locks: 264699281b5SAndrey V. Elsukov * 1) global lock (BPF_LOCK). Sx, used to protect some global counters, 265699281b5SAndrey V. Elsukov * every bpf_iflist changes, serializes ioctl access to bpf descriptors. 266699281b5SAndrey V. Elsukov * 2) Descriptor lock. Mutex, used to protect BPF buffers and various 267699281b5SAndrey V. Elsukov * structure fields used by bpf_*tap* code. 2686c74ff0eSAlexander V. Chernikov * 269699281b5SAndrey V. Elsukov * Lock order: global lock, then descriptor lock. 2706c74ff0eSAlexander V. Chernikov * 271699281b5SAndrey V. Elsukov * There are several possible consumers: 2726c74ff0eSAlexander V. Chernikov * 273699281b5SAndrey V. Elsukov * 1. The kernel registers interface pointer with bpfattach(). 274699281b5SAndrey V. Elsukov * Each call allocates new bpf_if structure, references ifnet pointer 275699281b5SAndrey V. Elsukov * and links bpf_if into bpf_iflist chain. This is protected with global 276699281b5SAndrey V. Elsukov * lock. 2776c74ff0eSAlexander V. Chernikov * 278699281b5SAndrey V. Elsukov * 2. An userland application uses ioctl() call to bpf_d descriptor. 279699281b5SAndrey V. Elsukov * All such call are serialized with global lock. BPF filters can be 2802a4bd982SGleb Smirnoff * changed, but pointer to old filter will be freed using NET_EPOCH_CALL(). 281699281b5SAndrey V. Elsukov * Thus it should be safe for bpf_tap/bpf_mtap* code to do access to 282699281b5SAndrey V. Elsukov * filter pointers, even if change will happen during bpf_tap execution. 2832a4bd982SGleb Smirnoff * Destroying of bpf_d descriptor also is doing using NET_EPOCH_CALL(). 2846c74ff0eSAlexander V. Chernikov * 285699281b5SAndrey V. Elsukov * 3. An userland application can write packets into bpf_d descriptor. 286699281b5SAndrey V. Elsukov * There we need to be sure, that ifnet won't disappear during bpfwrite(). 2876c74ff0eSAlexander V. Chernikov * 288699281b5SAndrey V. Elsukov * 4. The kernel invokes bpf_tap/bpf_mtap* functions. The access to 289699281b5SAndrey V. Elsukov * bif_dlist is protected with net_epoch_preempt section. So, it should 290699281b5SAndrey V. Elsukov * be safe to make access to bpf_d descriptor inside the section. 291699281b5SAndrey V. Elsukov * 292699281b5SAndrey V. Elsukov * 5. The kernel invokes bpfdetach() on interface destroying. All lists 293699281b5SAndrey V. Elsukov * are modified with global lock held and actual free() is done using 2942a4bd982SGleb Smirnoff * NET_EPOCH_CALL(). 2956c74ff0eSAlexander V. Chernikov */ 2966c74ff0eSAlexander V. Chernikov 297699281b5SAndrey V. Elsukov static void 298699281b5SAndrey V. Elsukov bpfif_free(epoch_context_t ctx) 299699281b5SAndrey V. Elsukov { 300699281b5SAndrey V. Elsukov struct bpf_if *bp; 301699281b5SAndrey V. Elsukov 302699281b5SAndrey V. Elsukov bp = __containerof(ctx, struct bpf_if, epoch_ctx); 303699281b5SAndrey V. Elsukov if_rele(bp->bif_ifp); 304699281b5SAndrey V. Elsukov free(bp, M_BPF); 305699281b5SAndrey V. Elsukov } 306699281b5SAndrey V. Elsukov 307699281b5SAndrey V. Elsukov static void 308699281b5SAndrey V. Elsukov bpfif_ref(struct bpf_if *bp) 309699281b5SAndrey V. Elsukov { 310699281b5SAndrey V. Elsukov 311699281b5SAndrey V. Elsukov refcount_acquire(&bp->bif_refcnt); 312699281b5SAndrey V. Elsukov } 313699281b5SAndrey V. Elsukov 314699281b5SAndrey V. Elsukov static void 315699281b5SAndrey V. Elsukov bpfif_rele(struct bpf_if *bp) 316699281b5SAndrey V. Elsukov { 317699281b5SAndrey V. Elsukov 318699281b5SAndrey V. Elsukov if (!refcount_release(&bp->bif_refcnt)) 319699281b5SAndrey V. Elsukov return; 3202a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpfif_free, &bp->epoch_ctx); 321699281b5SAndrey V. Elsukov } 322699281b5SAndrey V. Elsukov 323699281b5SAndrey V. Elsukov static void 324699281b5SAndrey V. Elsukov bpfd_ref(struct bpf_d *d) 325699281b5SAndrey V. Elsukov { 326699281b5SAndrey V. Elsukov 327699281b5SAndrey V. Elsukov refcount_acquire(&d->bd_refcnt); 328699281b5SAndrey V. Elsukov } 329699281b5SAndrey V. Elsukov 330699281b5SAndrey V. Elsukov static void 331699281b5SAndrey V. Elsukov bpfd_rele(struct bpf_d *d) 332699281b5SAndrey V. Elsukov { 333699281b5SAndrey V. Elsukov 334699281b5SAndrey V. Elsukov if (!refcount_release(&d->bd_refcnt)) 335699281b5SAndrey V. Elsukov return; 3362a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpfd_free, &d->epoch_ctx); 337699281b5SAndrey V. Elsukov } 338699281b5SAndrey V. Elsukov 339699281b5SAndrey V. Elsukov static struct bpf_program_buffer* 340699281b5SAndrey V. Elsukov bpf_program_buffer_alloc(size_t size, int flags) 341699281b5SAndrey V. Elsukov { 342699281b5SAndrey V. Elsukov 343699281b5SAndrey V. Elsukov return (malloc(sizeof(struct bpf_program_buffer) + size, 344699281b5SAndrey V. Elsukov M_BPF, flags)); 345699281b5SAndrey V. Elsukov } 346699281b5SAndrey V. Elsukov 347699281b5SAndrey V. Elsukov static void 348699281b5SAndrey V. Elsukov bpf_program_buffer_free(epoch_context_t ctx) 349699281b5SAndrey V. Elsukov { 350699281b5SAndrey V. Elsukov struct bpf_program_buffer *ptr; 351699281b5SAndrey V. Elsukov 352699281b5SAndrey V. Elsukov ptr = __containerof(ctx, struct bpf_program_buffer, epoch_ctx); 353699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 354699281b5SAndrey V. Elsukov if (ptr->func != NULL) 355699281b5SAndrey V. Elsukov bpf_destroy_jit_filter(ptr->func); 356699281b5SAndrey V. Elsukov #endif 357699281b5SAndrey V. Elsukov free(ptr, M_BPF); 358699281b5SAndrey V. Elsukov } 359699281b5SAndrey V. Elsukov 3606c74ff0eSAlexander V. Chernikov /* 3614d621040SChristian S.J. Peron * Wrapper functions for various buffering methods. If the set of buffer 3624d621040SChristian S.J. Peron * modes expands, we will probably want to introduce a switch data structure 3634d621040SChristian S.J. Peron * similar to protosw, et. 3644d621040SChristian S.J. Peron */ 3654d621040SChristian S.J. Peron static void 3664d621040SChristian S.J. Peron bpf_append_bytes(struct bpf_d *d, caddr_t buf, u_int offset, void *src, 3674d621040SChristian S.J. Peron u_int len) 3684d621040SChristian S.J. Peron { 3694d621040SChristian S.J. Peron 370afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 3714d621040SChristian S.J. Peron 3724d621040SChristian S.J. Peron switch (d->bd_bufmode) { 3734d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 3744d621040SChristian S.J. Peron return (bpf_buffer_append_bytes(d, buf, offset, src, len)); 3754d621040SChristian S.J. Peron 3764d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 377b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_zcopy, 1); 3784d621040SChristian S.J. Peron return (bpf_zerocopy_append_bytes(d, buf, offset, src, len)); 3794d621040SChristian S.J. Peron 3804d621040SChristian S.J. Peron default: 3814d621040SChristian S.J. Peron panic("bpf_buf_append_bytes"); 3824d621040SChristian S.J. Peron } 3834d621040SChristian S.J. Peron } 3844d621040SChristian S.J. Peron 3854d621040SChristian S.J. Peron static void 3864d621040SChristian S.J. Peron bpf_append_mbuf(struct bpf_d *d, caddr_t buf, u_int offset, void *src, 3874d621040SChristian S.J. Peron u_int len) 3884d621040SChristian S.J. Peron { 3894d621040SChristian S.J. Peron 390afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 3914d621040SChristian S.J. Peron 3924d621040SChristian S.J. Peron switch (d->bd_bufmode) { 3934d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 3944d621040SChristian S.J. Peron return (bpf_buffer_append_mbuf(d, buf, offset, src, len)); 3954d621040SChristian S.J. Peron 3964d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 397b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_zcopy, 1); 3984d621040SChristian S.J. Peron return (bpf_zerocopy_append_mbuf(d, buf, offset, src, len)); 3994d621040SChristian S.J. Peron 4004d621040SChristian S.J. Peron default: 4014d621040SChristian S.J. Peron panic("bpf_buf_append_mbuf"); 4024d621040SChristian S.J. Peron } 4034d621040SChristian S.J. Peron } 4044d621040SChristian S.J. Peron 4054d621040SChristian S.J. Peron /* 40629f612ecSChristian S.J. Peron * This function gets called when the free buffer is re-assigned. 40729f612ecSChristian S.J. Peron */ 40829f612ecSChristian S.J. Peron static void 40929f612ecSChristian S.J. Peron bpf_buf_reclaimed(struct bpf_d *d) 41029f612ecSChristian S.J. Peron { 41129f612ecSChristian S.J. Peron 412afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 41329f612ecSChristian S.J. Peron 41429f612ecSChristian S.J. Peron switch (d->bd_bufmode) { 41529f612ecSChristian S.J. Peron case BPF_BUFMODE_BUFFER: 41629f612ecSChristian S.J. Peron return; 41729f612ecSChristian S.J. Peron 41829f612ecSChristian S.J. Peron case BPF_BUFMODE_ZBUF: 41929f612ecSChristian S.J. Peron bpf_zerocopy_buf_reclaimed(d); 42029f612ecSChristian S.J. Peron return; 42129f612ecSChristian S.J. Peron 42229f612ecSChristian S.J. Peron default: 42329f612ecSChristian S.J. Peron panic("bpf_buf_reclaimed"); 42429f612ecSChristian S.J. Peron } 42529f612ecSChristian S.J. Peron } 42629f612ecSChristian S.J. Peron 42729f612ecSChristian S.J. Peron /* 4284d621040SChristian S.J. Peron * If the buffer mechanism has a way to decide that a held buffer can be made 4294d621040SChristian S.J. Peron * free, then it is exposed via the bpf_canfreebuf() interface. (1) is 4304d621040SChristian S.J. Peron * returned if the buffer can be discarded, (0) is returned if it cannot. 4314d621040SChristian S.J. Peron */ 4324d621040SChristian S.J. Peron static int 4334d621040SChristian S.J. Peron bpf_canfreebuf(struct bpf_d *d) 4344d621040SChristian S.J. Peron { 4354d621040SChristian S.J. Peron 4364d621040SChristian S.J. Peron BPFD_LOCK_ASSERT(d); 4374d621040SChristian S.J. Peron 4384d621040SChristian S.J. Peron switch (d->bd_bufmode) { 4394d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 4404d621040SChristian S.J. Peron return (bpf_zerocopy_canfreebuf(d)); 4414d621040SChristian S.J. Peron } 4424d621040SChristian S.J. Peron return (0); 4434d621040SChristian S.J. Peron } 4444d621040SChristian S.J. Peron 445a7a91e65SRobert Watson /* 446a7a91e65SRobert Watson * Allow the buffer model to indicate that the current store buffer is 447a7a91e65SRobert Watson * immutable, regardless of the appearance of space. Return (1) if the 448a7a91e65SRobert Watson * buffer is writable, and (0) if not. 449a7a91e65SRobert Watson */ 450a7a91e65SRobert Watson static int 451a7a91e65SRobert Watson bpf_canwritebuf(struct bpf_d *d) 452a7a91e65SRobert Watson { 453a7a91e65SRobert Watson BPFD_LOCK_ASSERT(d); 454a7a91e65SRobert Watson 455a7a91e65SRobert Watson switch (d->bd_bufmode) { 456a7a91e65SRobert Watson case BPF_BUFMODE_ZBUF: 457a7a91e65SRobert Watson return (bpf_zerocopy_canwritebuf(d)); 458a7a91e65SRobert Watson } 459a7a91e65SRobert Watson return (1); 460a7a91e65SRobert Watson } 461a7a91e65SRobert Watson 462a7a91e65SRobert Watson /* 463a7a91e65SRobert Watson * Notify buffer model that an attempt to write to the store buffer has 464a7a91e65SRobert Watson * resulted in a dropped packet, in which case the buffer may be considered 465a7a91e65SRobert Watson * full. 466a7a91e65SRobert Watson */ 467a7a91e65SRobert Watson static void 468a7a91e65SRobert Watson bpf_buffull(struct bpf_d *d) 469a7a91e65SRobert Watson { 470a7a91e65SRobert Watson 471afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 472a7a91e65SRobert Watson 473a7a91e65SRobert Watson switch (d->bd_bufmode) { 474a7a91e65SRobert Watson case BPF_BUFMODE_ZBUF: 475a7a91e65SRobert Watson bpf_zerocopy_buffull(d); 476a7a91e65SRobert Watson break; 477a7a91e65SRobert Watson } 478a7a91e65SRobert Watson } 479a7a91e65SRobert Watson 480a7a91e65SRobert Watson /* 481a7a91e65SRobert Watson * Notify the buffer model that a buffer has moved into the hold position. 482a7a91e65SRobert Watson */ 4834d621040SChristian S.J. Peron void 4844d621040SChristian S.J. Peron bpf_bufheld(struct bpf_d *d) 4854d621040SChristian S.J. Peron { 4864d621040SChristian S.J. Peron 487afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 4884d621040SChristian S.J. Peron 4894d621040SChristian S.J. Peron switch (d->bd_bufmode) { 4904d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 4914d621040SChristian S.J. Peron bpf_zerocopy_bufheld(d); 4924d621040SChristian S.J. Peron break; 4934d621040SChristian S.J. Peron } 4944d621040SChristian S.J. Peron } 4954d621040SChristian S.J. Peron 4964d621040SChristian S.J. Peron static void 4974d621040SChristian S.J. Peron bpf_free(struct bpf_d *d) 4984d621040SChristian S.J. Peron { 4994d621040SChristian S.J. Peron 5004d621040SChristian S.J. Peron switch (d->bd_bufmode) { 5014d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 5024d621040SChristian S.J. Peron return (bpf_buffer_free(d)); 5034d621040SChristian S.J. Peron 5044d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 5054d621040SChristian S.J. Peron return (bpf_zerocopy_free(d)); 5064d621040SChristian S.J. Peron 5074d621040SChristian S.J. Peron default: 5084d621040SChristian S.J. Peron panic("bpf_buf_free"); 5094d621040SChristian S.J. Peron } 5104d621040SChristian S.J. Peron } 5114d621040SChristian S.J. Peron 5124d621040SChristian S.J. Peron static int 5134d621040SChristian S.J. Peron bpf_uiomove(struct bpf_d *d, caddr_t buf, u_int len, struct uio *uio) 5144d621040SChristian S.J. Peron { 5154d621040SChristian S.J. Peron 5164d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) 5174d621040SChristian S.J. Peron return (EOPNOTSUPP); 5184d621040SChristian S.J. Peron return (bpf_buffer_uiomove(d, buf, len, uio)); 5194d621040SChristian S.J. Peron } 5204d621040SChristian S.J. Peron 5214d621040SChristian S.J. Peron static int 5224d621040SChristian S.J. Peron bpf_ioctl_sblen(struct bpf_d *d, u_int *i) 5234d621040SChristian S.J. Peron { 5244d621040SChristian S.J. Peron 5254d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) 5264d621040SChristian S.J. Peron return (EOPNOTSUPP); 5274d621040SChristian S.J. Peron return (bpf_buffer_ioctl_sblen(d, i)); 5284d621040SChristian S.J. Peron } 5294d621040SChristian S.J. Peron 5304d621040SChristian S.J. Peron static int 5314d621040SChristian S.J. Peron bpf_ioctl_getzmax(struct thread *td, struct bpf_d *d, size_t *i) 5324d621040SChristian S.J. Peron { 5334d621040SChristian S.J. Peron 5344d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5354d621040SChristian S.J. Peron return (EOPNOTSUPP); 5364d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_getzmax(td, d, i)); 5374d621040SChristian S.J. Peron } 5384d621040SChristian S.J. Peron 5394d621040SChristian S.J. Peron static int 5404d621040SChristian S.J. Peron bpf_ioctl_rotzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz) 5414d621040SChristian S.J. Peron { 5424d621040SChristian S.J. Peron 5434d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5444d621040SChristian S.J. Peron return (EOPNOTSUPP); 5454d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_rotzbuf(td, d, bz)); 5464d621040SChristian S.J. Peron } 5474d621040SChristian S.J. Peron 5484d621040SChristian S.J. Peron static int 5494d621040SChristian S.J. Peron bpf_ioctl_setzbuf(struct thread *td, struct bpf_d *d, struct bpf_zbuf *bz) 5504d621040SChristian S.J. Peron { 5514d621040SChristian S.J. Peron 5524d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_ZBUF) 5534d621040SChristian S.J. Peron return (EOPNOTSUPP); 5544d621040SChristian S.J. Peron return (bpf_zerocopy_ioctl_setzbuf(td, d, bz)); 5554d621040SChristian S.J. Peron } 5564d621040SChristian S.J. Peron 5574d621040SChristian S.J. Peron /* 5584d621040SChristian S.J. Peron * General BPF functions. 5594d621040SChristian S.J. Peron */ 560df8bae1dSRodney W. Grimes static int 561cb44b6dfSAndrew Thompson bpf_movein(struct uio *uio, int linktype, struct ifnet *ifp, struct mbuf **mp, 5624fb3a820SAlexander V. Chernikov struct sockaddr *sockp, int *hdrlen, struct bpf_d *d) 563df8bae1dSRodney W. Grimes { 564246b5467SSam Leffler const struct ieee80211_bpf_params *p; 565cb44b6dfSAndrew Thompson struct ether_header *eh; 566df8bae1dSRodney W. Grimes struct mbuf *m; 567df8bae1dSRodney W. Grimes int error; 568df8bae1dSRodney W. Grimes int len; 569df8bae1dSRodney W. Grimes int hlen; 57093e39f0bSChristian S.J. Peron int slen; 571df8bae1dSRodney W. Grimes 572df8bae1dSRodney W. Grimes /* 573df8bae1dSRodney W. Grimes * Build a sockaddr based on the data link layer type. 574df8bae1dSRodney W. Grimes * We do this at this level because the ethernet header 575df8bae1dSRodney W. Grimes * is copied directly into the data field of the sockaddr. 576df8bae1dSRodney W. Grimes * In the case of SLIP, there is no header and the packet 577df8bae1dSRodney W. Grimes * is forwarded as is. 578df8bae1dSRodney W. Grimes * Also, we are careful to leave room at the front of the mbuf 579df8bae1dSRodney W. Grimes * for the link level header. 580df8bae1dSRodney W. Grimes */ 581df8bae1dSRodney W. Grimes switch (linktype) { 582df8bae1dSRodney W. Grimes case DLT_SLIP: 583df8bae1dSRodney W. Grimes sockp->sa_family = AF_INET; 584df8bae1dSRodney W. Grimes hlen = 0; 585df8bae1dSRodney W. Grimes break; 586df8bae1dSRodney W. Grimes 587df8bae1dSRodney W. Grimes case DLT_EN10MB: 588df8bae1dSRodney W. Grimes sockp->sa_family = AF_UNSPEC; 589df8bae1dSRodney W. Grimes /* XXX Would MAXLINKHDR be better? */ 590797f247bSMatthew N. Dodd hlen = ETHER_HDR_LEN; 591df8bae1dSRodney W. Grimes break; 592df8bae1dSRodney W. Grimes 593df8bae1dSRodney W. Grimes case DLT_FDDI: 594d41f24e7SDavid Greenman sockp->sa_family = AF_IMPLINK; 595d41f24e7SDavid Greenman hlen = 0; 596df8bae1dSRodney W. Grimes break; 597df8bae1dSRodney W. Grimes 59822f05c43SAndrey A. Chernov case DLT_RAW: 599df8bae1dSRodney W. Grimes sockp->sa_family = AF_UNSPEC; 600df8bae1dSRodney W. Grimes hlen = 0; 601df8bae1dSRodney W. Grimes break; 602df8bae1dSRodney W. Grimes 60301399f34SDavid Malone case DLT_NULL: 60401399f34SDavid Malone /* 60501399f34SDavid Malone * null interface types require a 4 byte pseudo header which 60601399f34SDavid Malone * corresponds to the address family of the packet. 60701399f34SDavid Malone */ 60801399f34SDavid Malone sockp->sa_family = AF_UNSPEC; 60901399f34SDavid Malone hlen = 4; 61001399f34SDavid Malone break; 61101399f34SDavid Malone 6124f53e3ccSKenjiro Cho case DLT_ATM_RFC1483: 6134f53e3ccSKenjiro Cho /* 6144f53e3ccSKenjiro Cho * en atm driver requires 4-byte atm pseudo header. 6154f53e3ccSKenjiro Cho * though it isn't standard, vpi:vci needs to be 6164f53e3ccSKenjiro Cho * specified anyway. 6174f53e3ccSKenjiro Cho */ 6184f53e3ccSKenjiro Cho sockp->sa_family = AF_UNSPEC; 6194f53e3ccSKenjiro Cho hlen = 12; /* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */ 6204f53e3ccSKenjiro Cho break; 6214f53e3ccSKenjiro Cho 62230fa52a6SBrian Somers case DLT_PPP: 62330fa52a6SBrian Somers sockp->sa_family = AF_UNSPEC; 62430fa52a6SBrian Somers hlen = 4; /* This should match PPP_HDRLEN */ 62530fa52a6SBrian Somers break; 62630fa52a6SBrian Somers 627246b5467SSam Leffler case DLT_IEEE802_11: /* IEEE 802.11 wireless */ 628246b5467SSam Leffler sockp->sa_family = AF_IEEE80211; 629246b5467SSam Leffler hlen = 0; 630246b5467SSam Leffler break; 631246b5467SSam Leffler 632246b5467SSam Leffler case DLT_IEEE802_11_RADIO: /* IEEE 802.11 wireless w/ phy params */ 633246b5467SSam Leffler sockp->sa_family = AF_IEEE80211; 634246b5467SSam Leffler sockp->sa_len = 12; /* XXX != 0 */ 635246b5467SSam Leffler hlen = sizeof(struct ieee80211_bpf_params); 636246b5467SSam Leffler break; 637246b5467SSam Leffler 638df8bae1dSRodney W. Grimes default: 639df8bae1dSRodney W. Grimes return (EIO); 640df8bae1dSRodney W. Grimes } 641df8bae1dSRodney W. Grimes 642df8bae1dSRodney W. Grimes len = uio->uio_resid; 643ed63043bSGleb Smirnoff if (len < hlen || len - hlen > ifp->if_mtu) 64401399f34SDavid Malone return (EMSGSIZE); 64501399f34SDavid Malone 646f13da247SFlorian Florensa /* Allocate a mbuf for our write, since m_get2 fails if len >= to MJUMPAGESIZE, use m_getjcl for bigger buffers */ 647*a051ca72SKristof Provost m = m_get3(len, M_WAITOK, MT_DATA, M_PKTHDR); 648ed63043bSGleb Smirnoff if (m == NULL) 649df8bae1dSRodney W. Grimes return (EIO); 650963e4c2aSGarrett Wollman m->m_pkthdr.len = m->m_len = len; 651df8bae1dSRodney W. Grimes *mp = m; 65224a229f4SSam Leffler 65393e39f0bSChristian S.J. Peron error = uiomove(mtod(m, u_char *), len, uio); 65493e39f0bSChristian S.J. Peron if (error) 65593e39f0bSChristian S.J. Peron goto bad; 65693e39f0bSChristian S.J. Peron 6574fb3a820SAlexander V. Chernikov slen = bpf_filter(d->bd_wfilter, mtod(m, u_char *), len, len); 65893e39f0bSChristian S.J. Peron if (slen == 0) { 65993e39f0bSChristian S.J. Peron error = EPERM; 66093e39f0bSChristian S.J. Peron goto bad; 66193e39f0bSChristian S.J. Peron } 66293e39f0bSChristian S.J. Peron 663cb44b6dfSAndrew Thompson /* Check for multicast destination */ 664cb44b6dfSAndrew Thompson switch (linktype) { 665cb44b6dfSAndrew Thompson case DLT_EN10MB: 666cb44b6dfSAndrew Thompson eh = mtod(m, struct ether_header *); 667cb44b6dfSAndrew Thompson if (ETHER_IS_MULTICAST(eh->ether_dhost)) { 668cb44b6dfSAndrew Thompson if (bcmp(ifp->if_broadcastaddr, eh->ether_dhost, 669cb44b6dfSAndrew Thompson ETHER_ADDR_LEN) == 0) 670cb44b6dfSAndrew Thompson m->m_flags |= M_BCAST; 671cb44b6dfSAndrew Thompson else 672cb44b6dfSAndrew Thompson m->m_flags |= M_MCAST; 673cb44b6dfSAndrew Thompson } 6744fb3a820SAlexander V. Chernikov if (d->bd_hdrcmplt == 0) { 6754fb3a820SAlexander V. Chernikov memcpy(eh->ether_shost, IF_LLADDR(ifp), 6764fb3a820SAlexander V. Chernikov sizeof(eh->ether_shost)); 6774fb3a820SAlexander V. Chernikov } 678cb44b6dfSAndrew Thompson break; 679cb44b6dfSAndrew Thompson } 680cb44b6dfSAndrew Thompson 681df8bae1dSRodney W. Grimes /* 68293e39f0bSChristian S.J. Peron * Make room for link header, and copy it to sockaddr 683df8bae1dSRodney W. Grimes */ 684df8bae1dSRodney W. Grimes if (hlen != 0) { 685246b5467SSam Leffler if (sockp->sa_family == AF_IEEE80211) { 686246b5467SSam Leffler /* 687246b5467SSam Leffler * Collect true length from the parameter header 688246b5467SSam Leffler * NB: sockp is known to be zero'd so if we do a 689246b5467SSam Leffler * short copy unspecified parameters will be 690246b5467SSam Leffler * zero. 691246b5467SSam Leffler * NB: packet may not be aligned after stripping 692246b5467SSam Leffler * bpf params 693246b5467SSam Leffler * XXX check ibp_vers 694246b5467SSam Leffler */ 695246b5467SSam Leffler p = mtod(m, const struct ieee80211_bpf_params *); 696246b5467SSam Leffler hlen = p->ibp_len; 697246b5467SSam Leffler if (hlen > sizeof(sockp->sa_data)) { 698246b5467SSam Leffler error = EINVAL; 699246b5467SSam Leffler goto bad; 700246b5467SSam Leffler } 701246b5467SSam Leffler } 702a09968c4SAdrian Chadd bcopy(mtod(m, const void *), sockp->sa_data, hlen); 703df8bae1dSRodney W. Grimes } 704560a54e1SJung-uk Kim *hdrlen = hlen; 70593e39f0bSChristian S.J. Peron 706df8bae1dSRodney W. Grimes return (0); 707df8bae1dSRodney W. Grimes bad: 708df8bae1dSRodney W. Grimes m_freem(m); 709df8bae1dSRodney W. Grimes return (error); 710df8bae1dSRodney W. Grimes } 711df8bae1dSRodney W. Grimes 712df8bae1dSRodney W. Grimes /* 713699281b5SAndrey V. Elsukov * Attach descriptor to the bpf interface, i.e. make d listen on bp, 714699281b5SAndrey V. Elsukov * then reset its buffers and counters with reset_d(). 715df8bae1dSRodney W. Grimes */ 716df8bae1dSRodney W. Grimes static void 71719ba8395SChristian S.J. Peron bpf_attachd(struct bpf_d *d, struct bpf_if *bp) 718df8bae1dSRodney W. Grimes { 7196c74ff0eSAlexander V. Chernikov int op_w; 7206c74ff0eSAlexander V. Chernikov 7216c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 7226c74ff0eSAlexander V. Chernikov 7236c74ff0eSAlexander V. Chernikov /* 7246c74ff0eSAlexander V. Chernikov * Save sysctl value to protect from sysctl change 7256c74ff0eSAlexander V. Chernikov * between reads 7266c74ff0eSAlexander V. Chernikov */ 72771448753SAlexander Motin op_w = V_bpf_optimize_writers || d->bd_writer; 7286c74ff0eSAlexander V. Chernikov 7296c74ff0eSAlexander V. Chernikov if (d->bd_bif != NULL) 730699281b5SAndrey V. Elsukov bpf_detachd_locked(d, false); 731df8bae1dSRodney W. Grimes /* 73251ec1eb7SAlexander V. Chernikov * Point d at bp, and add d to the interface's list. 733f87e372eSLuiz Otavio O Souza * Since there are many applications using BPF for 73451ec1eb7SAlexander V. Chernikov * sending raw packets only (dhcpd, cdpd are good examples) 73551ec1eb7SAlexander V. Chernikov * we can delay adding d to the list of active listeners until 73651ec1eb7SAlexander V. Chernikov * some filter is configured. 737df8bae1dSRodney W. Grimes */ 73851ec1eb7SAlexander V. Chernikov 739afa85850SAlexander V. Chernikov BPFD_LOCK(d); 740699281b5SAndrey V. Elsukov /* 741699281b5SAndrey V. Elsukov * Hold reference to bpif while descriptor uses this interface. 742699281b5SAndrey V. Elsukov */ 743699281b5SAndrey V. Elsukov bpfif_ref(bp); 7446c74ff0eSAlexander V. Chernikov d->bd_bif = bp; 7456c74ff0eSAlexander V. Chernikov if (op_w != 0) { 74651ec1eb7SAlexander V. Chernikov /* Add to writers-only list */ 747699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bp->bif_wlist, d, bd_next); 74851ec1eb7SAlexander V. Chernikov /* 74951ec1eb7SAlexander V. Chernikov * We decrement bd_writer on every filter set operation. 75051ec1eb7SAlexander V. Chernikov * First BIOCSETF is done by pcap_open_live() to set up 751699281b5SAndrey V. Elsukov * snap length. After that appliation usually sets its own 752699281b5SAndrey V. Elsukov * filter. 75351ec1eb7SAlexander V. Chernikov */ 75451ec1eb7SAlexander V. Chernikov d->bd_writer = 2; 75551ec1eb7SAlexander V. Chernikov } else 756699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bp->bif_dlist, d, bd_next); 757df8bae1dSRodney W. Grimes 758699281b5SAndrey V. Elsukov reset_d(d); 759afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 76051ec1eb7SAlexander V. Chernikov bpf_bpfd_cnt++; 76151ec1eb7SAlexander V. Chernikov 76251ec1eb7SAlexander V. Chernikov CTR3(KTR_NET, "%s: bpf_attach called by pid %d, adding to %s list", 76351ec1eb7SAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer ? "writer" : "active"); 76451ec1eb7SAlexander V. Chernikov 7656c74ff0eSAlexander V. Chernikov if (op_w == 0) 76651ec1eb7SAlexander V. Chernikov EVENTHANDLER_INVOKE(bpf_track, bp->bif_ifp, bp->bif_dlt, 1); 76751ec1eb7SAlexander V. Chernikov } 76851ec1eb7SAlexander V. Chernikov 76951ec1eb7SAlexander V. Chernikov /* 770402000ffSAlexander V. Chernikov * Check if we need to upgrade our descriptor @d from write-only mode. 771402000ffSAlexander V. Chernikov */ 772402000ffSAlexander V. Chernikov static int 773699281b5SAndrey V. Elsukov bpf_check_upgrade(u_long cmd, struct bpf_d *d, struct bpf_insn *fcode, 774699281b5SAndrey V. Elsukov int flen) 775402000ffSAlexander V. Chernikov { 776402000ffSAlexander V. Chernikov int is_snap, need_upgrade; 777402000ffSAlexander V. Chernikov 778402000ffSAlexander V. Chernikov /* 779402000ffSAlexander V. Chernikov * Check if we've already upgraded or new filter is empty. 780402000ffSAlexander V. Chernikov */ 781402000ffSAlexander V. Chernikov if (d->bd_writer == 0 || fcode == NULL) 782402000ffSAlexander V. Chernikov return (0); 783402000ffSAlexander V. Chernikov 784402000ffSAlexander V. Chernikov need_upgrade = 0; 785402000ffSAlexander V. Chernikov 786402000ffSAlexander V. Chernikov /* 787402000ffSAlexander V. Chernikov * Check if cmd looks like snaplen setting from 788402000ffSAlexander V. Chernikov * pcap_bpf.c:pcap_open_live(). 789402000ffSAlexander V. Chernikov * Note we're not checking .k value here: 790caa7e52fSEitan Adler * while pcap_open_live() definitely sets to non-zero value, 791402000ffSAlexander V. Chernikov * we'd prefer to treat k=0 (deny ALL) case the same way: e.g. 792402000ffSAlexander V. Chernikov * do not consider upgrading immediately 793402000ffSAlexander V. Chernikov */ 794699281b5SAndrey V. Elsukov if (cmd == BIOCSETF && flen == 1 && 795699281b5SAndrey V. Elsukov fcode[0].code == (BPF_RET | BPF_K)) 796402000ffSAlexander V. Chernikov is_snap = 1; 797402000ffSAlexander V. Chernikov else 798402000ffSAlexander V. Chernikov is_snap = 0; 799402000ffSAlexander V. Chernikov 800402000ffSAlexander V. Chernikov if (is_snap == 0) { 801402000ffSAlexander V. Chernikov /* 802402000ffSAlexander V. Chernikov * We're setting first filter and it doesn't look like 803402000ffSAlexander V. Chernikov * setting snaplen. We're probably using bpf directly. 804402000ffSAlexander V. Chernikov * Upgrade immediately. 805402000ffSAlexander V. Chernikov */ 806402000ffSAlexander V. Chernikov need_upgrade = 1; 807402000ffSAlexander V. Chernikov } else { 808402000ffSAlexander V. Chernikov /* 809402000ffSAlexander V. Chernikov * Do not require upgrade by first BIOCSETF 810402000ffSAlexander V. Chernikov * (used to set snaplen) by pcap_open_live(). 811402000ffSAlexander V. Chernikov */ 812402000ffSAlexander V. Chernikov 813402000ffSAlexander V. Chernikov if (--d->bd_writer == 0) { 814402000ffSAlexander V. Chernikov /* 815402000ffSAlexander V. Chernikov * First snaplen filter has already 816402000ffSAlexander V. Chernikov * been set. This is probably catch-all 817402000ffSAlexander V. Chernikov * filter 818402000ffSAlexander V. Chernikov */ 819402000ffSAlexander V. Chernikov need_upgrade = 1; 820402000ffSAlexander V. Chernikov } 821402000ffSAlexander V. Chernikov } 822402000ffSAlexander V. Chernikov 823402000ffSAlexander V. Chernikov CTR5(KTR_NET, 824402000ffSAlexander V. Chernikov "%s: filter function set by pid %d, " 825402000ffSAlexander V. Chernikov "bd_writer counter %d, snap %d upgrade %d", 826402000ffSAlexander V. Chernikov __func__, d->bd_pid, d->bd_writer, 827402000ffSAlexander V. Chernikov is_snap, need_upgrade); 828402000ffSAlexander V. Chernikov 829402000ffSAlexander V. Chernikov return (need_upgrade); 830402000ffSAlexander V. Chernikov } 831402000ffSAlexander V. Chernikov 832402000ffSAlexander V. Chernikov /* 833df8bae1dSRodney W. Grimes * Detach a file from its interface. 834df8bae1dSRodney W. Grimes */ 835df8bae1dSRodney W. Grimes static void 83619ba8395SChristian S.J. Peron bpf_detachd(struct bpf_d *d) 837df8bae1dSRodney W. Grimes { 8386c74ff0eSAlexander V. Chernikov BPF_LOCK(); 839699281b5SAndrey V. Elsukov bpf_detachd_locked(d, false); 8406c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 8416c74ff0eSAlexander V. Chernikov } 8426c74ff0eSAlexander V. Chernikov 8436c74ff0eSAlexander V. Chernikov static void 844699281b5SAndrey V. Elsukov bpf_detachd_locked(struct bpf_d *d, bool detached_ifp) 8456c74ff0eSAlexander V. Chernikov { 846df8bae1dSRodney W. Grimes struct bpf_if *bp; 84746448b5aSRobert Watson struct ifnet *ifp; 848699281b5SAndrey V. Elsukov int error; 84951ec1eb7SAlexander V. Chernikov 850e4b3229aSAlexander V. Chernikov BPF_LOCK_ASSERT(); 851699281b5SAndrey V. Elsukov CTR2(KTR_NET, "%s: detach required by pid %d", __func__, d->bd_pid); 852e4b3229aSAlexander V. Chernikov 8536c74ff0eSAlexander V. Chernikov /* Check if descriptor is attached */ 8546c74ff0eSAlexander V. Chernikov if ((bp = d->bd_bif) == NULL) 8556c74ff0eSAlexander V. Chernikov return; 8566c74ff0eSAlexander V. Chernikov 857afa85850SAlexander V. Chernikov BPFD_LOCK(d); 858de253273SAndrey V. Elsukov /* Remove d from the interface's descriptor list. */ 859de253273SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 86051ec1eb7SAlexander V. Chernikov /* Save bd_writer value */ 86151ec1eb7SAlexander V. Chernikov error = d->bd_writer; 862e4b3229aSAlexander V. Chernikov ifp = bp->bif_ifp; 863572bde2aSRobert Watson d->bd_bif = NULL; 864699281b5SAndrey V. Elsukov if (detached_ifp) { 865699281b5SAndrey V. Elsukov /* 866699281b5SAndrey V. Elsukov * Notify descriptor as it's detached, so that any 867699281b5SAndrey V. Elsukov * sleepers wake up and get ENXIO. 868699281b5SAndrey V. Elsukov */ 869699281b5SAndrey V. Elsukov bpf_wakeup(d); 870699281b5SAndrey V. Elsukov } 871afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 872e4b3229aSAlexander V. Chernikov bpf_bpfd_cnt--; 87346448b5aSRobert Watson 87451ec1eb7SAlexander V. Chernikov /* Call event handler iff d is attached */ 87551ec1eb7SAlexander V. Chernikov if (error == 0) 8765ce8d970SSam Leffler EVENTHANDLER_INVOKE(bpf_track, ifp, bp->bif_dlt, 0); 877b743c310SSam Leffler 878df8bae1dSRodney W. Grimes /* 879df8bae1dSRodney W. Grimes * Check if this descriptor had requested promiscuous mode. 880699281b5SAndrey V. Elsukov * If so and ifnet is not detached, turn it off. 881df8bae1dSRodney W. Grimes */ 882699281b5SAndrey V. Elsukov if (d->bd_promisc && !detached_ifp) { 883df8bae1dSRodney W. Grimes d->bd_promisc = 0; 88497021c24SMarko Zec CURVNET_SET(ifp->if_vnet); 88546448b5aSRobert Watson error = ifpromisc(ifp, 0); 88697021c24SMarko Zec CURVNET_RESTORE(); 8876e891d64SPoul-Henning Kamp if (error != 0 && error != ENXIO) { 888df8bae1dSRodney W. Grimes /* 8896e891d64SPoul-Henning Kamp * ENXIO can happen if a pccard is unplugged 890df8bae1dSRodney W. Grimes * Something is really wrong if we were able to put 891df8bae1dSRodney W. Grimes * the driver into promiscuous mode, but can't 892df8bae1dSRodney W. Grimes * take it out. 893df8bae1dSRodney W. Grimes */ 8948eab61f3SSam Leffler if_printf(bp->bif_ifp, 8958eab61f3SSam Leffler "bpf_detach: ifpromisc failed (%d)\n", error); 8966e891d64SPoul-Henning Kamp } 897df8bae1dSRodney W. Grimes } 898699281b5SAndrey V. Elsukov bpfif_rele(bp); 899df8bae1dSRodney W. Grimes } 900df8bae1dSRodney W. Grimes 901df8bae1dSRodney W. Grimes /* 902136600feSEd Schouten * Close the descriptor by detaching it from its interface, 903136600feSEd Schouten * deallocating its buffers, and marking it free. 904136600feSEd Schouten */ 905136600feSEd Schouten static void 906136600feSEd Schouten bpf_dtor(void *data) 907136600feSEd Schouten { 908136600feSEd Schouten struct bpf_d *d = data; 909136600feSEd Schouten 910afa85850SAlexander V. Chernikov BPFD_LOCK(d); 911136600feSEd Schouten if (d->bd_state == BPF_WAITING) 912136600feSEd Schouten callout_stop(&d->bd_callout); 913136600feSEd Schouten d->bd_state = BPF_IDLE; 914afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 915136600feSEd Schouten funsetown(&d->bd_sigio); 916136600feSEd Schouten bpf_detachd(d); 917136600feSEd Schouten #ifdef MAC 918136600feSEd Schouten mac_bpfdesc_destroy(d); 919136600feSEd Schouten #endif /* MAC */ 9206aba400aSAttilio Rao seldrain(&d->bd_sel); 921136600feSEd Schouten knlist_destroy(&d->bd_sel.si_note); 9229fee1bd1SJung-uk Kim callout_drain(&d->bd_callout); 923699281b5SAndrey V. Elsukov bpfd_rele(d); 924136600feSEd Schouten } 925136600feSEd Schouten 926136600feSEd Schouten /* 927df8bae1dSRodney W. Grimes * Open ethernet device. Returns ENXIO for illegal minor device number, 928df8bae1dSRodney W. Grimes * EBUSY if file is open by another process. 929df8bae1dSRodney W. Grimes */ 930df8bae1dSRodney W. Grimes /* ARGSUSED */ 93187f6c662SJulian Elischer static int 93219ba8395SChristian S.J. Peron bpfopen(struct cdev *dev, int flags, int fmt, struct thread *td) 933df8bae1dSRodney W. Grimes { 934e7bb21b3SJonathan Lemon struct bpf_d *d; 9354f42daa4SLuiz Otavio O Souza int error; 936df8bae1dSRodney W. Grimes 9371ede983cSDag-Erling Smørgrav d = malloc(sizeof(*d), M_BPF, M_WAITOK | M_ZERO); 938136600feSEd Schouten error = devfs_set_cdevpriv(d, bpf_dtor); 939136600feSEd Schouten if (error != 0) { 940136600feSEd Schouten free(d, M_BPF); 941136600feSEd Schouten return (error); 942136600feSEd Schouten } 9434d621040SChristian S.J. Peron 944b2b7ca49SAlexander V. Chernikov /* Setup counters */ 945b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_alloc(M_WAITOK); 946b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_alloc(M_WAITOK); 947b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_alloc(M_WAITOK); 948b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_alloc(M_WAITOK); 949b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_alloc(M_WAITOK); 950b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_alloc(M_WAITOK); 951b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_alloc(M_WAITOK); 952b2b7ca49SAlexander V. Chernikov 9534d621040SChristian S.J. Peron /* 9544d621040SChristian S.J. Peron * For historical reasons, perform a one-time initialization call to 9554d621040SChristian S.J. Peron * the buffer routines, even though we're not yet committed to a 9564d621040SChristian S.J. Peron * particular buffer method. 9574d621040SChristian S.J. Peron */ 9584d621040SChristian S.J. Peron bpf_buffer_init(d); 95971448753SAlexander Motin if ((flags & FREAD) == 0) 96071448753SAlexander Motin d->bd_writer = 2; 9613b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 9624d621040SChristian S.J. Peron d->bd_bufmode = BPF_BUFMODE_BUFFER; 96300a83887SPaul Traina d->bd_sig = SIGIO; 964560a54e1SJung-uk Kim d->bd_direction = BPF_D_INOUT; 965699281b5SAndrey V. Elsukov d->bd_refcnt = 1; 966e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 96782f4445dSRobert Watson #ifdef MAC 96830d239bcSRobert Watson mac_bpfdesc_init(d); 96930d239bcSRobert Watson mac_bpfdesc_create(td->td_ucred, d); 97082f4445dSRobert Watson #endif 971afa85850SAlexander V. Chernikov mtx_init(&d->bd_lock, devtoname(dev), "bpf cdev lock", MTX_DEF); 972afa85850SAlexander V. Chernikov callout_init_mtx(&d->bd_callout, &d->bd_lock, 0); 973afa85850SAlexander V. Chernikov knlist_init_mtx(&d->bd_sel.si_note, &d->bd_lock); 974df8bae1dSRodney W. Grimes 9751e7fe2fbSLuiz Otavio O Souza /* Disable VLAN pcp tagging. */ 9761e7fe2fbSLuiz Otavio O Souza d->bd_pcp = 0; 9771e7fe2fbSLuiz Otavio O Souza 978df8bae1dSRodney W. Grimes return (0); 979df8bae1dSRodney W. Grimes } 980df8bae1dSRodney W. Grimes 981df8bae1dSRodney W. Grimes /* 982df8bae1dSRodney W. Grimes * bpfread - read next chunk of packets from buffers 983df8bae1dSRodney W. Grimes */ 98487f6c662SJulian Elischer static int 98519ba8395SChristian S.J. Peron bpfread(struct cdev *dev, struct uio *uio, int ioflag) 986df8bae1dSRodney W. Grimes { 987136600feSEd Schouten struct bpf_d *d; 988df8bae1dSRodney W. Grimes int error; 9898df67d77SJung-uk Kim int non_block; 9908df67d77SJung-uk Kim int timed_out; 991df8bae1dSRodney W. Grimes 992136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 993136600feSEd Schouten if (error != 0) 994136600feSEd Schouten return (error); 995136600feSEd Schouten 996df8bae1dSRodney W. Grimes /* 997df8bae1dSRodney W. Grimes * Restrict application to use a buffer the same size as 998df8bae1dSRodney W. Grimes * as kernel buffers. 999df8bae1dSRodney W. Grimes */ 1000df8bae1dSRodney W. Grimes if (uio->uio_resid != d->bd_bufsize) 1001df8bae1dSRodney W. Grimes return (EINVAL); 1002df8bae1dSRodney W. Grimes 10038df67d77SJung-uk Kim non_block = ((ioflag & O_NONBLOCK) != 0); 10048df67d77SJung-uk Kim 1005afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1006e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 10074d621040SChristian S.J. Peron if (d->bd_bufmode != BPF_BUFMODE_BUFFER) { 1008afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 10094d621040SChristian S.J. Peron return (EOPNOTSUPP); 10104d621040SChristian S.J. Peron } 101181bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 101281bda851SJohn Polstra callout_stop(&d->bd_callout); 101381bda851SJohn Polstra timed_out = (d->bd_state == BPF_TIMED_OUT); 101481bda851SJohn Polstra d->bd_state = BPF_IDLE; 1015d013d902SGuy Helmer while (d->bd_hbuf_in_use) { 1016d013d902SGuy Helmer error = mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 10173b3b91e7SGuy Helmer PRINET|PCATCH, "bd_hbuf", 0); 1018d013d902SGuy Helmer if (error != 0) { 1019d013d902SGuy Helmer BPFD_UNLOCK(d); 1020d013d902SGuy Helmer return (error); 1021d013d902SGuy Helmer } 1022d013d902SGuy Helmer } 1023df8bae1dSRodney W. Grimes /* 1024df8bae1dSRodney W. Grimes * If the hold buffer is empty, then do a timed sleep, which 1025df8bae1dSRodney W. Grimes * ends when the timeout expires or when enough packets 1026df8bae1dSRodney W. Grimes * have arrived to fill the store buffer. 1027df8bae1dSRodney W. Grimes */ 1028572bde2aSRobert Watson while (d->bd_hbuf == NULL) { 10298df67d77SJung-uk Kim if (d->bd_slen != 0) { 1030df8bae1dSRodney W. Grimes /* 1031df8bae1dSRodney W. Grimes * A packet(s) either arrived since the previous 1032df8bae1dSRodney W. Grimes * read or arrived while we were asleep. 10338df67d77SJung-uk Kim */ 10348df67d77SJung-uk Kim if (d->bd_immediate || non_block || timed_out) { 10358df67d77SJung-uk Kim /* 10368df67d77SJung-uk Kim * Rotate the buffers and return what's here 10378df67d77SJung-uk Kim * if we are in immediate mode, non-blocking 10388df67d77SJung-uk Kim * flag is set, or this descriptor timed out. 1039df8bae1dSRodney W. Grimes */ 1040df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1041df8bae1dSRodney W. Grimes break; 1042df8bae1dSRodney W. Grimes } 10438df67d77SJung-uk Kim } 1044de5d9935SRobert Watson 1045de5d9935SRobert Watson /* 1046de5d9935SRobert Watson * No data is available, check to see if the bpf device 1047de5d9935SRobert Watson * is still pointed at a real interface. If not, return 1048de5d9935SRobert Watson * ENXIO so that the userland process knows to rebind 1049de5d9935SRobert Watson * it before using it again. 1050de5d9935SRobert Watson */ 1051de5d9935SRobert Watson if (d->bd_bif == NULL) { 1052afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1053de5d9935SRobert Watson return (ENXIO); 1054de5d9935SRobert Watson } 1055de5d9935SRobert Watson 10568df67d77SJung-uk Kim if (non_block) { 1057afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1058fba3cfdeSJohn Polstra return (EWOULDBLOCK); 1059fba3cfdeSJohn Polstra } 1060afa85850SAlexander V. Chernikov error = msleep(d, &d->bd_lock, PRINET|PCATCH, 1061e7bb21b3SJonathan Lemon "bpf", d->bd_rtout); 1062df8bae1dSRodney W. Grimes if (error == EINTR || error == ERESTART) { 1063afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1064df8bae1dSRodney W. Grimes return (error); 1065df8bae1dSRodney W. Grimes } 1066df8bae1dSRodney W. Grimes if (error == EWOULDBLOCK) { 1067df8bae1dSRodney W. Grimes /* 1068df8bae1dSRodney W. Grimes * On a timeout, return what's in the buffer, 1069df8bae1dSRodney W. Grimes * which may be nothing. If there is something 1070df8bae1dSRodney W. Grimes * in the store buffer, we can rotate the buffers. 1071df8bae1dSRodney W. Grimes */ 1072df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1073df8bae1dSRodney W. Grimes /* 1074df8bae1dSRodney W. Grimes * We filled up the buffer in between 1075df8bae1dSRodney W. Grimes * getting the timeout and arriving 1076df8bae1dSRodney W. Grimes * here, so we don't need to rotate. 1077df8bae1dSRodney W. Grimes */ 1078df8bae1dSRodney W. Grimes break; 1079df8bae1dSRodney W. Grimes 1080df8bae1dSRodney W. Grimes if (d->bd_slen == 0) { 1081afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1082df8bae1dSRodney W. Grimes return (0); 1083df8bae1dSRodney W. Grimes } 1084df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 1085df8bae1dSRodney W. Grimes break; 1086df8bae1dSRodney W. Grimes } 1087df8bae1dSRodney W. Grimes } 1088df8bae1dSRodney W. Grimes /* 1089df8bae1dSRodney W. Grimes * At this point, we know we have something in the hold slot. 1090df8bae1dSRodney W. Grimes */ 10913b3b91e7SGuy Helmer d->bd_hbuf_in_use = 1; 1092afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1093df8bae1dSRodney W. Grimes 1094df8bae1dSRodney W. Grimes /* 1095df8bae1dSRodney W. Grimes * Move data from hold buffer into user space. 1096df8bae1dSRodney W. Grimes * We know the entire buffer is transferred since 1097df8bae1dSRodney W. Grimes * we checked above that the read buffer is bpf_bufsize bytes. 109831b32e6dSRobert Watson * 10993b3b91e7SGuy Helmer * We do not have to worry about simultaneous reads because 11003b3b91e7SGuy Helmer * we waited for sole access to the hold buffer above. 1101df8bae1dSRodney W. Grimes */ 11024d621040SChristian S.J. Peron error = bpf_uiomove(d, d->bd_hbuf, d->bd_hlen, uio); 1103df8bae1dSRodney W. Grimes 1104afa85850SAlexander V. Chernikov BPFD_LOCK(d); 11053b3b91e7SGuy Helmer KASSERT(d->bd_hbuf != NULL, ("bpfread: lost bd_hbuf")); 1106df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1107572bde2aSRobert Watson d->bd_hbuf = NULL; 1108df8bae1dSRodney W. Grimes d->bd_hlen = 0; 110929f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 11103b3b91e7SGuy Helmer d->bd_hbuf_in_use = 0; 11113b3b91e7SGuy Helmer wakeup(&d->bd_hbuf_in_use); 1112afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1113df8bae1dSRodney W. Grimes 1114df8bae1dSRodney W. Grimes return (error); 1115df8bae1dSRodney W. Grimes } 1116df8bae1dSRodney W. Grimes 1117df8bae1dSRodney W. Grimes /* 1118df8bae1dSRodney W. Grimes * If there are processes sleeping on this descriptor, wake them up. 1119df8bae1dSRodney W. Grimes */ 1120e7bb21b3SJonathan Lemon static __inline void 112119ba8395SChristian S.J. Peron bpf_wakeup(struct bpf_d *d) 1122df8bae1dSRodney W. Grimes { 1123a3272e3cSChristian S.J. Peron 1124afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 112581bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 112681bda851SJohn Polstra callout_stop(&d->bd_callout); 112781bda851SJohn Polstra d->bd_state = BPF_IDLE; 112881bda851SJohn Polstra } 1129521f364bSDag-Erling Smørgrav wakeup(d); 1130831d27a9SDon Lewis if (d->bd_async && d->bd_sig && d->bd_sigio) 1131f1320723SAlfred Perlstein pgsigio(&d->bd_sigio, d->bd_sig, 0); 113200a83887SPaul Traina 1133512824f8SSeigo Tanimura selwakeuppri(&d->bd_sel, PRINET); 1134ad3b9257SJohn-Mark Gurney KNOTE_LOCKED(&d->bd_sel.si_note, 0); 1135df8bae1dSRodney W. Grimes } 1136df8bae1dSRodney W. Grimes 113781bda851SJohn Polstra static void 113819ba8395SChristian S.J. Peron bpf_timed_out(void *arg) 113981bda851SJohn Polstra { 114081bda851SJohn Polstra struct bpf_d *d = (struct bpf_d *)arg; 114181bda851SJohn Polstra 1142afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11439fee1bd1SJung-uk Kim 1144699281b5SAndrey V. Elsukov if (callout_pending(&d->bd_callout) || 1145699281b5SAndrey V. Elsukov !callout_active(&d->bd_callout)) 11469fee1bd1SJung-uk Kim return; 114781bda851SJohn Polstra if (d->bd_state == BPF_WAITING) { 114881bda851SJohn Polstra d->bd_state = BPF_TIMED_OUT; 114981bda851SJohn Polstra if (d->bd_slen != 0) 115081bda851SJohn Polstra bpf_wakeup(d); 115181bda851SJohn Polstra } 115281bda851SJohn Polstra } 115381bda851SJohn Polstra 115487f6c662SJulian Elischer static int 11554d621040SChristian S.J. Peron bpf_ready(struct bpf_d *d) 11564d621040SChristian S.J. Peron { 11574d621040SChristian S.J. Peron 1158afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 11594d621040SChristian S.J. Peron 11604d621040SChristian S.J. Peron if (!bpf_canfreebuf(d) && d->bd_hlen != 0) 11614d621040SChristian S.J. Peron return (1); 11624d621040SChristian S.J. Peron if ((d->bd_immediate || d->bd_state == BPF_TIMED_OUT) && 11634d621040SChristian S.J. Peron d->bd_slen != 0) 11644d621040SChristian S.J. Peron return (1); 11654d621040SChristian S.J. Peron return (0); 11664d621040SChristian S.J. Peron } 11674d621040SChristian S.J. Peron 11684d621040SChristian S.J. Peron static int 116919ba8395SChristian S.J. Peron bpfwrite(struct cdev *dev, struct uio *uio, int ioflag) 1170df8bae1dSRodney W. Grimes { 1171699281b5SAndrey V. Elsukov struct route ro; 1172699281b5SAndrey V. Elsukov struct sockaddr dst; 1173699281b5SAndrey V. Elsukov struct epoch_tracker et; 1174699281b5SAndrey V. Elsukov struct bpf_if *bp; 1175136600feSEd Schouten struct bpf_d *d; 1176df8bae1dSRodney W. Grimes struct ifnet *ifp; 1177560a54e1SJung-uk Kim struct mbuf *m, *mc; 1178560a54e1SJung-uk Kim int error, hlen; 1179df8bae1dSRodney W. Grimes 1180136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1181136600feSEd Schouten if (error != 0) 1182136600feSEd Schouten return (error); 1183136600feSEd Schouten 1184699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 1185699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1186e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 1187b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wcount, 1); 1188699281b5SAndrey V. Elsukov if ((bp = d->bd_bif) == NULL) { 1189699281b5SAndrey V. Elsukov error = ENXIO; 1190699281b5SAndrey V. Elsukov goto out_locked; 11914d621040SChristian S.J. Peron } 1192df8bae1dSRodney W. Grimes 1193699281b5SAndrey V. Elsukov ifp = bp->bif_ifp; 11944d621040SChristian S.J. Peron if ((ifp->if_flags & IFF_UP) == 0) { 1195699281b5SAndrey V. Elsukov error = ENETDOWN; 1196699281b5SAndrey V. Elsukov goto out_locked; 11974d621040SChristian S.J. Peron } 11983518d220SSam Leffler 1199699281b5SAndrey V. Elsukov if (uio->uio_resid == 0) 1200699281b5SAndrey V. Elsukov goto out_locked; 1201df8bae1dSRodney W. Grimes 12028240bf1eSRobert Watson bzero(&dst, sizeof(dst)); 1203d83e603aSChristian S.J. Peron m = NULL; 1204d83e603aSChristian S.J. Peron hlen = 0; 1205699281b5SAndrey V. Elsukov 1206699281b5SAndrey V. Elsukov /* 1207699281b5SAndrey V. Elsukov * Take extra reference, unlock d and exit from epoch section, 1208699281b5SAndrey V. Elsukov * since bpf_movein() can sleep. 1209699281b5SAndrey V. Elsukov */ 1210699281b5SAndrey V. Elsukov bpfd_ref(d); 1211699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1212699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1213699281b5SAndrey V. Elsukov 1214699281b5SAndrey V. Elsukov error = bpf_movein(uio, (int)bp->bif_dlt, ifp, 12154fb3a820SAlexander V. Chernikov &m, &dst, &hlen, d); 1216699281b5SAndrey V. Elsukov 1217699281b5SAndrey V. Elsukov if (error != 0) { 1218b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1219699281b5SAndrey V. Elsukov bpfd_rele(d); 1220df8bae1dSRodney W. Grimes return (error); 12214d621040SChristian S.J. Peron } 1222699281b5SAndrey V. Elsukov 1223699281b5SAndrey V. Elsukov BPFD_LOCK(d); 1224699281b5SAndrey V. Elsukov /* 1225699281b5SAndrey V. Elsukov * Check that descriptor is still attached to the interface. 1226699281b5SAndrey V. Elsukov * This can happen on bpfdetach(). To avoid access to detached 1227699281b5SAndrey V. Elsukov * ifnet, free mbuf and return ENXIO. 1228699281b5SAndrey V. Elsukov */ 1229699281b5SAndrey V. Elsukov if (d->bd_bif == NULL) { 1230699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1231699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1232699281b5SAndrey V. Elsukov bpfd_rele(d); 1233699281b5SAndrey V. Elsukov m_freem(m); 1234699281b5SAndrey V. Elsukov return (ENXIO); 1235699281b5SAndrey V. Elsukov } 1236b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wfcount, 1); 1237114ae644SMike Smith if (d->bd_hdrcmplt) 1238114ae644SMike Smith dst.sa_family = pseudo_AF_HDRCMPLT; 1239114ae644SMike Smith 1240560a54e1SJung-uk Kim if (d->bd_feedback) { 1241eb1b1807SGleb Smirnoff mc = m_dup(m, M_NOWAIT); 1242560a54e1SJung-uk Kim if (mc != NULL) 1243560a54e1SJung-uk Kim mc->m_pkthdr.rcvif = ifp; 12448cd892f7SJung-uk Kim /* Set M_PROMISC for outgoing packets to be discarded. */ 12458cd892f7SJung-uk Kim if (d->bd_direction == BPF_D_INOUT) 12468cd892f7SJung-uk Kim m->m_flags |= M_PROMISC; 1247560a54e1SJung-uk Kim } else 1248560a54e1SJung-uk Kim mc = NULL; 1249560a54e1SJung-uk Kim 1250560a54e1SJung-uk Kim m->m_pkthdr.len -= hlen; 1251560a54e1SJung-uk Kim m->m_len -= hlen; 1252560a54e1SJung-uk Kim m->m_data += hlen; /* XXX */ 1253560a54e1SJung-uk Kim 125421ca7b57SMarko Zec CURVNET_SET(ifp->if_vnet); 125582f4445dSRobert Watson #ifdef MAC 125630d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, m); 1257560a54e1SJung-uk Kim if (mc != NULL) 125830d239bcSRobert Watson mac_bpfdesc_create_mbuf(d, mc); 125982f4445dSRobert Watson #endif 1260560a54e1SJung-uk Kim 12614fb3a820SAlexander V. Chernikov bzero(&ro, sizeof(ro)); 12624fb3a820SAlexander V. Chernikov if (hlen != 0) { 12634fb3a820SAlexander V. Chernikov ro.ro_prepend = (u_char *)&dst.sa_data; 12644fb3a820SAlexander V. Chernikov ro.ro_plen = hlen; 12654fb3a820SAlexander V. Chernikov ro.ro_flags = RT_HAS_HEADER; 12664fb3a820SAlexander V. Chernikov } 12674fb3a820SAlexander V. Chernikov 12681e7fe2fbSLuiz Otavio O Souza if (d->bd_pcp != 0) 12699ef8cd0bSKristof Provost vlan_set_pcp(m, d->bd_pcp); 12701e7fe2fbSLuiz Otavio O Souza 127182d7bf6bSAndrey V. Elsukov /* Avoid possible recursion on BPFD_LOCK(). */ 127282d7bf6bSAndrey V. Elsukov NET_EPOCH_ENTER(et); 127382d7bf6bSAndrey V. Elsukov BPFD_UNLOCK(d); 12744fb3a820SAlexander V. Chernikov error = (*ifp->if_output)(ifp, m, &dst, &ro); 12754d621040SChristian S.J. Peron if (error) 1276b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_wdcount, 1); 1277560a54e1SJung-uk Kim 1278560a54e1SJung-uk Kim if (mc != NULL) { 12790bf686c1SRobert Watson if (error == 0) 1280560a54e1SJung-uk Kim (*ifp->if_input)(ifp, mc); 12810bf686c1SRobert Watson else 1282560a54e1SJung-uk Kim m_freem(mc); 1283560a54e1SJung-uk Kim } 128482d7bf6bSAndrey V. Elsukov NET_EPOCH_EXIT(et); 128521ca7b57SMarko Zec CURVNET_RESTORE(); 1286699281b5SAndrey V. Elsukov bpfd_rele(d); 1287699281b5SAndrey V. Elsukov return (error); 1288560a54e1SJung-uk Kim 1289699281b5SAndrey V. Elsukov out_locked: 1290699281b5SAndrey V. Elsukov counter_u64_add(d->bd_wdcount, 1); 1291699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 1292699281b5SAndrey V. Elsukov BPFD_UNLOCK(d); 1293df8bae1dSRodney W. Grimes return (error); 1294df8bae1dSRodney W. Grimes } 1295df8bae1dSRodney W. Grimes 1296df8bae1dSRodney W. Grimes /* 1297e82669d9SRobert Watson * Reset a descriptor by flushing its packet buffer and clearing the receive 1298e82669d9SRobert Watson * and drop counts. This is doable for kernel-only buffers, but with 1299e82669d9SRobert Watson * zero-copy buffers, we can't write to (or rotate) buffers that are 1300e82669d9SRobert Watson * currently owned by userspace. It would be nice if we could encapsulate 1301e82669d9SRobert Watson * this logic in the buffer code rather than here. 1302df8bae1dSRodney W. Grimes */ 1303df8bae1dSRodney W. Grimes static void 130419ba8395SChristian S.J. Peron reset_d(struct bpf_d *d) 1305df8bae1dSRodney W. Grimes { 1306e7bb21b3SJonathan Lemon 1307afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 1308e82669d9SRobert Watson 13093b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 13103b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, PRINET, 13113b3b91e7SGuy Helmer "bd_hbuf", 0); 1312e82669d9SRobert Watson if ((d->bd_hbuf != NULL) && 1313e82669d9SRobert Watson (d->bd_bufmode != BPF_BUFMODE_ZBUF || bpf_canfreebuf(d))) { 1314df8bae1dSRodney W. Grimes /* Free the hold buffer. */ 1315df8bae1dSRodney W. Grimes d->bd_fbuf = d->bd_hbuf; 1316572bde2aSRobert Watson d->bd_hbuf = NULL; 1317e82669d9SRobert Watson d->bd_hlen = 0; 131829f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 1319df8bae1dSRodney W. Grimes } 1320e82669d9SRobert Watson if (bpf_canwritebuf(d)) 1321df8bae1dSRodney W. Grimes d->bd_slen = 0; 1322b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_rcount); 1323b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_dcount); 1324b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_fcount); 1325b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wcount); 1326b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wfcount); 1327b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_wdcount); 1328b2b7ca49SAlexander V. Chernikov counter_u64_zero(d->bd_zcopy); 1329df8bae1dSRodney W. Grimes } 1330df8bae1dSRodney W. Grimes 1331df8bae1dSRodney W. Grimes /* 1332df8bae1dSRodney W. Grimes * FIONREAD Check for read packet available. 1333df8bae1dSRodney W. Grimes * BIOCGBLEN Get buffer len [for read()]. 1334f11c3508SDavid Malone * BIOCSETF Set read filter. 1335f11c3508SDavid Malone * BIOCSETFNR Set read filter without resetting descriptor. 1336f11c3508SDavid Malone * BIOCSETWF Set write filter. 1337df8bae1dSRodney W. Grimes * BIOCFLUSH Flush read packet buffer. 1338df8bae1dSRodney W. Grimes * BIOCPROMISC Put interface into promiscuous mode. 1339df8bae1dSRodney W. Grimes * BIOCGDLT Get link layer type. 1340df8bae1dSRodney W. Grimes * BIOCGETIF Get interface name. 1341df8bae1dSRodney W. Grimes * BIOCSETIF Set interface. 1342df8bae1dSRodney W. Grimes * BIOCSRTIMEOUT Set read timeout. 1343df8bae1dSRodney W. Grimes * BIOCGRTIMEOUT Get read timeout. 1344df8bae1dSRodney W. Grimes * BIOCGSTATS Get packet stats. 1345df8bae1dSRodney W. Grimes * BIOCIMMEDIATE Set immediate mode. 1346df8bae1dSRodney W. Grimes * BIOCVERSION Get filter language version. 1347114ae644SMike Smith * BIOCGHDRCMPLT Get "header already complete" flag 1348114ae644SMike Smith * BIOCSHDRCMPLT Set "header already complete" flag 1349560a54e1SJung-uk Kim * BIOCGDIRECTION Get packet direction flag 1350560a54e1SJung-uk Kim * BIOCSDIRECTION Set packet direction flag 1351547d94bdSJung-uk Kim * BIOCGTSTAMP Get time stamp format and resolution. 1352547d94bdSJung-uk Kim * BIOCSTSTAMP Set time stamp format and resolution. 135393e39f0bSChristian S.J. Peron * BIOCLOCK Set "locked" flag 1354560a54e1SJung-uk Kim * BIOCFEEDBACK Set packet feedback mode. 13554d621040SChristian S.J. Peron * BIOCSETZBUF Set current zero-copy buffer locations. 13564d621040SChristian S.J. Peron * BIOCGETZMAX Get maximum zero-copy buffer size. 13574d621040SChristian S.J. Peron * BIOCROTZBUF Force rotation of zero-copy buffer 13584d621040SChristian S.J. Peron * BIOCSETBUFMODE Set buffer mode. 13594d621040SChristian S.J. Peron * BIOCGETBUFMODE Get current buffer mode. 13601e7fe2fbSLuiz Otavio O Souza * BIOCSETVLANPCP Set VLAN PCP tag. 1361df8bae1dSRodney W. Grimes */ 1362df8bae1dSRodney W. Grimes /* ARGSUSED */ 136387f6c662SJulian Elischer static int 136419ba8395SChristian S.J. Peron bpfioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flags, 136519ba8395SChristian S.J. Peron struct thread *td) 1366df8bae1dSRodney W. Grimes { 1367136600feSEd Schouten struct bpf_d *d; 1368136600feSEd Schouten int error; 1369136600feSEd Schouten 1370136600feSEd Schouten error = devfs_get_cdevpriv((void **)&d); 1371136600feSEd Schouten if (error != 0) 1372136600feSEd Schouten return (error); 1373df8bae1dSRodney W. Grimes 1374b75a24a0SChristian S.J. Peron /* 1375b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 1376b75a24a0SChristian S.J. Peron */ 1377afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1378e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 137981bda851SJohn Polstra if (d->bd_state == BPF_WAITING) 138081bda851SJohn Polstra callout_stop(&d->bd_callout); 138181bda851SJohn Polstra d->bd_state = BPF_IDLE; 1382afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 138381bda851SJohn Polstra 138493e39f0bSChristian S.J. Peron if (d->bd_locked == 1) { 138593e39f0bSChristian S.J. Peron switch (cmd) { 138693e39f0bSChristian S.J. Peron case BIOCGBLEN: 138793e39f0bSChristian S.J. Peron case BIOCFLUSH: 138893e39f0bSChristian S.J. Peron case BIOCGDLT: 138993e39f0bSChristian S.J. Peron case BIOCGDLTLIST: 1390fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1391fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1392fc0a61a4SKonstantin Belousov #endif 139393e39f0bSChristian S.J. Peron case BIOCGETIF: 139493e39f0bSChristian S.J. Peron case BIOCGRTIMEOUT: 1395b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1396fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1397fc0a61a4SKonstantin Belousov #endif 139893e39f0bSChristian S.J. Peron case BIOCGSTATS: 139993e39f0bSChristian S.J. Peron case BIOCVERSION: 140093e39f0bSChristian S.J. Peron case BIOCGRSIG: 140193e39f0bSChristian S.J. Peron case BIOCGHDRCMPLT: 1402547d94bdSJung-uk Kim case BIOCSTSTAMP: 1403560a54e1SJung-uk Kim case BIOCFEEDBACK: 140493e39f0bSChristian S.J. Peron case FIONREAD: 140593e39f0bSChristian S.J. Peron case BIOCLOCK: 140693e39f0bSChristian S.J. Peron case BIOCSRTIMEOUT: 1407b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1408fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1409fc0a61a4SKonstantin Belousov #endif 141093e39f0bSChristian S.J. Peron case BIOCIMMEDIATE: 141193e39f0bSChristian S.J. Peron case TIOCGPGRP: 14124d621040SChristian S.J. Peron case BIOCROTZBUF: 141393e39f0bSChristian S.J. Peron break; 141493e39f0bSChristian S.J. Peron default: 141593e39f0bSChristian S.J. Peron return (EPERM); 141693e39f0bSChristian S.J. Peron } 141793e39f0bSChristian S.J. Peron } 1418fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1419fc0a61a4SKonstantin Belousov /* 1420fc0a61a4SKonstantin Belousov * If we see a 32-bit compat ioctl, mark the stream as 32-bit so 1421fc0a61a4SKonstantin Belousov * that it will get 32-bit packet headers. 1422fc0a61a4SKonstantin Belousov */ 1423fc0a61a4SKonstantin Belousov switch (cmd) { 1424fc0a61a4SKonstantin Belousov case BIOCSETF32: 1425fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1426fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1427fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1428fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1429fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 143074549d4bSWojciech Macek if (SV_PROC_FLAG(td->td_proc, SV_ILP32)) { 143197aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1432fc0a61a4SKonstantin Belousov d->bd_compat32 = 1; 143397aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1434fc0a61a4SKonstantin Belousov } 143574549d4bSWojciech Macek } 1436fc0a61a4SKonstantin Belousov #endif 1437fc0a61a4SKonstantin Belousov 143897021c24SMarko Zec CURVNET_SET(TD_TO_VNET(td)); 1439df8bae1dSRodney W. Grimes switch (cmd) { 1440df8bae1dSRodney W. Grimes default: 1441df8bae1dSRodney W. Grimes error = EINVAL; 1442df8bae1dSRodney W. Grimes break; 1443df8bae1dSRodney W. Grimes 1444df8bae1dSRodney W. Grimes /* 1445df8bae1dSRodney W. Grimes * Check for read packet available. 1446df8bae1dSRodney W. Grimes */ 1447df8bae1dSRodney W. Grimes case FIONREAD: 1448df8bae1dSRodney W. Grimes { 1449df8bae1dSRodney W. Grimes int n; 1450df8bae1dSRodney W. Grimes 1451afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1452df8bae1dSRodney W. Grimes n = d->bd_slen; 14533b3b91e7SGuy Helmer while (d->bd_hbuf_in_use) 14543b3b91e7SGuy Helmer mtx_sleep(&d->bd_hbuf_in_use, &d->bd_lock, 14553b3b91e7SGuy Helmer PRINET, "bd_hbuf", 0); 1456df8bae1dSRodney W. Grimes if (d->bd_hbuf) 1457df8bae1dSRodney W. Grimes n += d->bd_hlen; 1458afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1459df8bae1dSRodney W. Grimes 1460df8bae1dSRodney W. Grimes *(int *)addr = n; 1461df8bae1dSRodney W. Grimes break; 1462df8bae1dSRodney W. Grimes } 1463df8bae1dSRodney W. Grimes 1464df8bae1dSRodney W. Grimes /* 1465df8bae1dSRodney W. Grimes * Get buffer len [for read()]. 1466df8bae1dSRodney W. Grimes */ 1467df8bae1dSRodney W. Grimes case BIOCGBLEN: 146897aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1469df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bufsize; 147097aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1471df8bae1dSRodney W. Grimes break; 1472df8bae1dSRodney W. Grimes 1473df8bae1dSRodney W. Grimes /* 1474df8bae1dSRodney W. Grimes * Set buffer length. 1475df8bae1dSRodney W. Grimes */ 1476df8bae1dSRodney W. Grimes case BIOCSBLEN: 14774d621040SChristian S.J. Peron error = bpf_ioctl_sblen(d, (u_int *)addr); 1478df8bae1dSRodney W. Grimes break; 1479df8bae1dSRodney W. Grimes 1480df8bae1dSRodney W. Grimes /* 1481df8bae1dSRodney W. Grimes * Set link layer read filter. 1482df8bae1dSRodney W. Grimes */ 1483df8bae1dSRodney W. Grimes case BIOCSETF: 1484f11c3508SDavid Malone case BIOCSETFNR: 148593e39f0bSChristian S.J. Peron case BIOCSETWF: 1486fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1487fc0a61a4SKonstantin Belousov case BIOCSETF32: 1488fc0a61a4SKonstantin Belousov case BIOCSETFNR32: 1489fc0a61a4SKonstantin Belousov case BIOCSETWF32: 1490fc0a61a4SKonstantin Belousov #endif 149193e39f0bSChristian S.J. Peron error = bpf_setf(d, (struct bpf_program *)addr, cmd); 1492df8bae1dSRodney W. Grimes break; 1493df8bae1dSRodney W. Grimes 1494df8bae1dSRodney W. Grimes /* 1495df8bae1dSRodney W. Grimes * Flush read packet buffer. 1496df8bae1dSRodney W. Grimes */ 1497df8bae1dSRodney W. Grimes case BIOCFLUSH: 1498afa85850SAlexander V. Chernikov BPFD_LOCK(d); 1499df8bae1dSRodney W. Grimes reset_d(d); 1500afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 1501df8bae1dSRodney W. Grimes break; 1502df8bae1dSRodney W. Grimes 1503df8bae1dSRodney W. Grimes /* 1504df8bae1dSRodney W. Grimes * Put interface into promiscuous mode. 1505df8bae1dSRodney W. Grimes */ 1506df8bae1dSRodney W. Grimes case BIOCPROMISC: 1507572bde2aSRobert Watson if (d->bd_bif == NULL) { 1508df8bae1dSRodney W. Grimes /* 1509df8bae1dSRodney W. Grimes * No interface attached yet. 1510df8bae1dSRodney W. Grimes */ 1511df8bae1dSRodney W. Grimes error = EINVAL; 1512df8bae1dSRodney W. Grimes break; 1513df8bae1dSRodney W. Grimes } 1514df8bae1dSRodney W. Grimes if (d->bd_promisc == 0) { 1515df8bae1dSRodney W. Grimes error = ifpromisc(d->bd_bif->bif_ifp, 1); 1516df8bae1dSRodney W. Grimes if (error == 0) 1517df8bae1dSRodney W. Grimes d->bd_promisc = 1; 1518df8bae1dSRodney W. Grimes } 1519df8bae1dSRodney W. Grimes break; 1520df8bae1dSRodney W. Grimes 1521df8bae1dSRodney W. Grimes /* 15228eab61f3SSam Leffler * Get current data link type. 1523df8bae1dSRodney W. Grimes */ 1524df8bae1dSRodney W. Grimes case BIOCGDLT: 152597aacec6SAlexander V. Chernikov BPF_LOCK(); 1526572bde2aSRobert Watson if (d->bd_bif == NULL) 1527df8bae1dSRodney W. Grimes error = EINVAL; 1528df8bae1dSRodney W. Grimes else 1529df8bae1dSRodney W. Grimes *(u_int *)addr = d->bd_bif->bif_dlt; 153097aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1531df8bae1dSRodney W. Grimes break; 1532df8bae1dSRodney W. Grimes 1533df8bae1dSRodney W. Grimes /* 15348eab61f3SSam Leffler * Get a list of supported data link types. 15358eab61f3SSam Leffler */ 1536fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 1537fc0a61a4SKonstantin Belousov case BIOCGDLTLIST32: 1538fc0a61a4SKonstantin Belousov { 1539fc0a61a4SKonstantin Belousov struct bpf_dltlist32 *list32; 1540fc0a61a4SKonstantin Belousov struct bpf_dltlist dltlist; 1541fc0a61a4SKonstantin Belousov 1542fc0a61a4SKonstantin Belousov list32 = (struct bpf_dltlist32 *)addr; 1543fc0a61a4SKonstantin Belousov dltlist.bfl_len = list32->bfl_len; 1544fc0a61a4SKonstantin Belousov dltlist.bfl_list = PTRIN(list32->bfl_list); 154597aacec6SAlexander V. Chernikov BPF_LOCK(); 1546fc0a61a4SKonstantin Belousov if (d->bd_bif == NULL) 1547fc0a61a4SKonstantin Belousov error = EINVAL; 1548fc0a61a4SKonstantin Belousov else { 1549fc0a61a4SKonstantin Belousov error = bpf_getdltlist(d, &dltlist); 1550fc0a61a4SKonstantin Belousov if (error == 0) 1551fc0a61a4SKonstantin Belousov list32->bfl_len = dltlist.bfl_len; 1552fc0a61a4SKonstantin Belousov } 155397aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1554fc0a61a4SKonstantin Belousov break; 1555fc0a61a4SKonstantin Belousov } 1556fc0a61a4SKonstantin Belousov #endif 1557fc0a61a4SKonstantin Belousov 15588eab61f3SSam Leffler case BIOCGDLTLIST: 155997aacec6SAlexander V. Chernikov BPF_LOCK(); 1560572bde2aSRobert Watson if (d->bd_bif == NULL) 15618eab61f3SSam Leffler error = EINVAL; 15628eab61f3SSam Leffler else 15638eab61f3SSam Leffler error = bpf_getdltlist(d, (struct bpf_dltlist *)addr); 156497aacec6SAlexander V. Chernikov BPF_UNLOCK(); 15658eab61f3SSam Leffler break; 15668eab61f3SSam Leffler 15678eab61f3SSam Leffler /* 15688eab61f3SSam Leffler * Set data link type. 15698eab61f3SSam Leffler */ 15708eab61f3SSam Leffler case BIOCSDLT: 15716c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1572572bde2aSRobert Watson if (d->bd_bif == NULL) 15738eab61f3SSam Leffler error = EINVAL; 15748eab61f3SSam Leffler else 15758eab61f3SSam Leffler error = bpf_setdlt(d, *(u_int *)addr); 15766c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 15778eab61f3SSam Leffler break; 15788eab61f3SSam Leffler 15798eab61f3SSam Leffler /* 15801dd0feaaSArchie Cobbs * Get interface name. 1581df8bae1dSRodney W. Grimes */ 1582df8bae1dSRodney W. Grimes case BIOCGETIF: 158397aacec6SAlexander V. Chernikov BPF_LOCK(); 1584572bde2aSRobert Watson if (d->bd_bif == NULL) 1585df8bae1dSRodney W. Grimes error = EINVAL; 15861dd0feaaSArchie Cobbs else { 15871dd0feaaSArchie Cobbs struct ifnet *const ifp = d->bd_bif->bif_ifp; 15881dd0feaaSArchie Cobbs struct ifreq *const ifr = (struct ifreq *)addr; 15891dd0feaaSArchie Cobbs 15909bf40edeSBrooks Davis strlcpy(ifr->ifr_name, ifp->if_xname, 15919bf40edeSBrooks Davis sizeof(ifr->ifr_name)); 15921dd0feaaSArchie Cobbs } 159397aacec6SAlexander V. Chernikov BPF_UNLOCK(); 1594df8bae1dSRodney W. Grimes break; 1595df8bae1dSRodney W. Grimes 1596df8bae1dSRodney W. Grimes /* 1597df8bae1dSRodney W. Grimes * Set interface. 1598df8bae1dSRodney W. Grimes */ 1599df8bae1dSRodney W. Grimes case BIOCSETIF: 16004f42daa4SLuiz Otavio O Souza { 16014f42daa4SLuiz Otavio O Souza int alloc_buf, size; 16024f42daa4SLuiz Otavio O Souza 16034f42daa4SLuiz Otavio O Souza /* 16044f42daa4SLuiz Otavio O Souza * Behavior here depends on the buffering model. If 16054f42daa4SLuiz Otavio O Souza * we're using kernel memory buffers, then we can 16064f42daa4SLuiz Otavio O Souza * allocate them here. If we're using zero-copy, 16074f42daa4SLuiz Otavio O Souza * then the user process must have registered buffers 16084f42daa4SLuiz Otavio O Souza * by the time we get here. 16094f42daa4SLuiz Otavio O Souza */ 16104f42daa4SLuiz Otavio O Souza alloc_buf = 0; 16114f42daa4SLuiz Otavio O Souza BPFD_LOCK(d); 16124f42daa4SLuiz Otavio O Souza if (d->bd_bufmode == BPF_BUFMODE_BUFFER && 16134f42daa4SLuiz Otavio O Souza d->bd_sbuf == NULL) 16144f42daa4SLuiz Otavio O Souza alloc_buf = 1; 16154f42daa4SLuiz Otavio O Souza BPFD_UNLOCK(d); 16164f42daa4SLuiz Otavio O Souza if (alloc_buf) { 16174f42daa4SLuiz Otavio O Souza size = d->bd_bufsize; 16184f42daa4SLuiz Otavio O Souza error = bpf_buffer_ioctl_sblen(d, &size); 16194f42daa4SLuiz Otavio O Souza if (error != 0) 16204f42daa4SLuiz Otavio O Souza break; 16214f42daa4SLuiz Otavio O Souza } 16226c74ff0eSAlexander V. Chernikov BPF_LOCK(); 1623df8bae1dSRodney W. Grimes error = bpf_setif(d, (struct ifreq *)addr); 16246c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 1625df8bae1dSRodney W. Grimes break; 16264f42daa4SLuiz Otavio O Souza } 1627df8bae1dSRodney W. Grimes 1628df8bae1dSRodney W. Grimes /* 1629df8bae1dSRodney W. Grimes * Set read timeout. 1630df8bae1dSRodney W. Grimes */ 1631df8bae1dSRodney W. Grimes case BIOCSRTIMEOUT: 1632b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1633fc0a61a4SKonstantin Belousov case BIOCSRTIMEOUT32: 1634fc0a61a4SKonstantin Belousov #endif 1635df8bae1dSRodney W. Grimes { 1636df8bae1dSRodney W. Grimes struct timeval *tv = (struct timeval *)addr; 16379624d947SJuli Mallett #if defined(COMPAT_FREEBSD32) && !defined(__mips__) 1638fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1639fc0a61a4SKonstantin Belousov struct timeval tv64; 1640fc0a61a4SKonstantin Belousov 1641fc0a61a4SKonstantin Belousov if (cmd == BIOCSRTIMEOUT32) { 1642fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1643fc0a61a4SKonstantin Belousov tv = &tv64; 1644fc0a61a4SKonstantin Belousov tv->tv_sec = tv32->tv_sec; 1645fc0a61a4SKonstantin Belousov tv->tv_usec = tv32->tv_usec; 1646fc0a61a4SKonstantin Belousov } else 1647fc0a61a4SKonstantin Belousov #endif 1648fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1649df8bae1dSRodney W. Grimes 1650bdc2cdc5SAlexander Langer /* 1651bdc2cdc5SAlexander Langer * Subtract 1 tick from tvtohz() since this isn't 1652bdc2cdc5SAlexander Langer * a one-shot timer. 1653bdc2cdc5SAlexander Langer */ 1654bdc2cdc5SAlexander Langer if ((error = itimerfix(tv)) == 0) 1655bdc2cdc5SAlexander Langer d->bd_rtout = tvtohz(tv) - 1; 1656df8bae1dSRodney W. Grimes break; 1657df8bae1dSRodney W. Grimes } 1658df8bae1dSRodney W. Grimes 1659df8bae1dSRodney W. Grimes /* 1660df8bae1dSRodney W. Grimes * Get read timeout. 1661df8bae1dSRodney W. Grimes */ 1662df8bae1dSRodney W. Grimes case BIOCGRTIMEOUT: 1663b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1664fc0a61a4SKonstantin Belousov case BIOCGRTIMEOUT32: 1665fc0a61a4SKonstantin Belousov #endif 1666df8bae1dSRodney W. Grimes { 1667fc0a61a4SKonstantin Belousov struct timeval *tv; 1668b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1669fc0a61a4SKonstantin Belousov struct timeval32 *tv32; 1670fc0a61a4SKonstantin Belousov struct timeval tv64; 1671fc0a61a4SKonstantin Belousov 1672fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) 1673fc0a61a4SKonstantin Belousov tv = &tv64; 1674fc0a61a4SKonstantin Belousov else 1675fc0a61a4SKonstantin Belousov #endif 1676fc0a61a4SKonstantin Belousov tv = (struct timeval *)addr; 1677df8bae1dSRodney W. Grimes 1678bdc2cdc5SAlexander Langer tv->tv_sec = d->bd_rtout / hz; 1679bdc2cdc5SAlexander Langer tv->tv_usec = (d->bd_rtout % hz) * tick; 1680b4366092SJustin Hibbits #if defined(COMPAT_FREEBSD32) && defined(__amd64__) 1681fc0a61a4SKonstantin Belousov if (cmd == BIOCGRTIMEOUT32) { 1682fc0a61a4SKonstantin Belousov tv32 = (struct timeval32 *)addr; 1683fc0a61a4SKonstantin Belousov tv32->tv_sec = tv->tv_sec; 1684fc0a61a4SKonstantin Belousov tv32->tv_usec = tv->tv_usec; 1685fc0a61a4SKonstantin Belousov } 1686fc0a61a4SKonstantin Belousov #endif 1687fc0a61a4SKonstantin Belousov 1688df8bae1dSRodney W. Grimes break; 1689df8bae1dSRodney W. Grimes } 1690df8bae1dSRodney W. Grimes 1691df8bae1dSRodney W. Grimes /* 1692df8bae1dSRodney W. Grimes * Get packet stats. 1693df8bae1dSRodney W. Grimes */ 1694df8bae1dSRodney W. Grimes case BIOCGSTATS: 1695df8bae1dSRodney W. Grimes { 1696df8bae1dSRodney W. Grimes struct bpf_stat *bs = (struct bpf_stat *)addr; 1697df8bae1dSRodney W. Grimes 16984d621040SChristian S.J. Peron /* XXXCSJP overflow */ 1699b2b7ca49SAlexander V. Chernikov bs->bs_recv = (u_int)counter_u64_fetch(d->bd_rcount); 1700b2b7ca49SAlexander V. Chernikov bs->bs_drop = (u_int)counter_u64_fetch(d->bd_dcount); 1701df8bae1dSRodney W. Grimes break; 1702df8bae1dSRodney W. Grimes } 1703df8bae1dSRodney W. Grimes 1704df8bae1dSRodney W. Grimes /* 1705df8bae1dSRodney W. Grimes * Set immediate mode. 1706df8bae1dSRodney W. Grimes */ 1707df8bae1dSRodney W. Grimes case BIOCIMMEDIATE: 170897aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1709df8bae1dSRodney W. Grimes d->bd_immediate = *(u_int *)addr; 171097aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1711df8bae1dSRodney W. Grimes break; 1712df8bae1dSRodney W. Grimes 1713df8bae1dSRodney W. Grimes case BIOCVERSION: 1714df8bae1dSRodney W. Grimes { 1715df8bae1dSRodney W. Grimes struct bpf_version *bv = (struct bpf_version *)addr; 1716df8bae1dSRodney W. Grimes 1717df8bae1dSRodney W. Grimes bv->bv_major = BPF_MAJOR_VERSION; 1718df8bae1dSRodney W. Grimes bv->bv_minor = BPF_MINOR_VERSION; 1719df8bae1dSRodney W. Grimes break; 1720df8bae1dSRodney W. Grimes } 172100a83887SPaul Traina 1722114ae644SMike Smith /* 1723114ae644SMike Smith * Get "header already complete" flag 1724114ae644SMike Smith */ 1725114ae644SMike Smith case BIOCGHDRCMPLT: 172697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1727114ae644SMike Smith *(u_int *)addr = d->bd_hdrcmplt; 172897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1729114ae644SMike Smith break; 1730114ae644SMike Smith 1731114ae644SMike Smith /* 1732114ae644SMike Smith * Set "header already complete" flag 1733114ae644SMike Smith */ 1734114ae644SMike Smith case BIOCSHDRCMPLT: 173597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1736114ae644SMike Smith d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0; 173797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1738114ae644SMike Smith break; 1739114ae644SMike Smith 17408ed3828cSRobert Watson /* 1741560a54e1SJung-uk Kim * Get packet direction flag 17428ed3828cSRobert Watson */ 1743560a54e1SJung-uk Kim case BIOCGDIRECTION: 174497aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1745560a54e1SJung-uk Kim *(u_int *)addr = d->bd_direction; 174697aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 17478ed3828cSRobert Watson break; 17488ed3828cSRobert Watson 17498ed3828cSRobert Watson /* 1750560a54e1SJung-uk Kim * Set packet direction flag 17518ed3828cSRobert Watson */ 1752560a54e1SJung-uk Kim case BIOCSDIRECTION: 1753560a54e1SJung-uk Kim { 1754560a54e1SJung-uk Kim u_int direction; 1755560a54e1SJung-uk Kim 1756560a54e1SJung-uk Kim direction = *(u_int *)addr; 1757560a54e1SJung-uk Kim switch (direction) { 1758560a54e1SJung-uk Kim case BPF_D_IN: 1759560a54e1SJung-uk Kim case BPF_D_INOUT: 1760560a54e1SJung-uk Kim case BPF_D_OUT: 176197aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1762560a54e1SJung-uk Kim d->bd_direction = direction; 176397aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1764560a54e1SJung-uk Kim break; 1765560a54e1SJung-uk Kim default: 1766560a54e1SJung-uk Kim error = EINVAL; 1767560a54e1SJung-uk Kim } 1768560a54e1SJung-uk Kim } 1769560a54e1SJung-uk Kim break; 1770560a54e1SJung-uk Kim 1771547d94bdSJung-uk Kim /* 1772d0d7bcdfSJung-uk Kim * Get packet timestamp format and resolution. 1773547d94bdSJung-uk Kim */ 1774547d94bdSJung-uk Kim case BIOCGTSTAMP: 177597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1776547d94bdSJung-uk Kim *(u_int *)addr = d->bd_tstamp; 177797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1778547d94bdSJung-uk Kim break; 1779547d94bdSJung-uk Kim 1780547d94bdSJung-uk Kim /* 1781547d94bdSJung-uk Kim * Set packet timestamp format and resolution. 1782547d94bdSJung-uk Kim */ 1783547d94bdSJung-uk Kim case BIOCSTSTAMP: 1784547d94bdSJung-uk Kim { 1785547d94bdSJung-uk Kim u_int func; 1786547d94bdSJung-uk Kim 1787547d94bdSJung-uk Kim func = *(u_int *)addr; 1788547d94bdSJung-uk Kim if (BPF_T_VALID(func)) 1789547d94bdSJung-uk Kim d->bd_tstamp = func; 1790547d94bdSJung-uk Kim else 1791547d94bdSJung-uk Kim error = EINVAL; 1792547d94bdSJung-uk Kim } 1793547d94bdSJung-uk Kim break; 1794547d94bdSJung-uk Kim 1795560a54e1SJung-uk Kim case BIOCFEEDBACK: 179697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1797560a54e1SJung-uk Kim d->bd_feedback = *(u_int *)addr; 179897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1799560a54e1SJung-uk Kim break; 1800560a54e1SJung-uk Kim 1801560a54e1SJung-uk Kim case BIOCLOCK: 180297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 1803560a54e1SJung-uk Kim d->bd_locked = 1; 180497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18058ed3828cSRobert Watson break; 18068ed3828cSRobert Watson 180700a83887SPaul Traina case FIONBIO: /* Non-blocking I/O */ 180800a83887SPaul Traina break; 180900a83887SPaul Traina 181000a83887SPaul Traina case FIOASYNC: /* Send signal on receive packets */ 181197aacec6SAlexander V. Chernikov BPFD_LOCK(d); 181200a83887SPaul Traina d->bd_async = *(int *)addr; 181397aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 181400a83887SPaul Traina break; 181500a83887SPaul Traina 1816831d27a9SDon Lewis case FIOSETOWN: 181797aacec6SAlexander V. Chernikov /* 181897aacec6SAlexander V. Chernikov * XXX: Add some sort of locking here? 181997aacec6SAlexander V. Chernikov * fsetown() can sleep. 182097aacec6SAlexander V. Chernikov */ 1821831d27a9SDon Lewis error = fsetown(*(int *)addr, &d->bd_sigio); 182200a83887SPaul Traina break; 182300a83887SPaul Traina 1824831d27a9SDon Lewis case FIOGETOWN: 182597aacec6SAlexander V. Chernikov BPFD_LOCK(d); 182691e97a82SDon Lewis *(int *)addr = fgetown(&d->bd_sigio); 182797aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 1828831d27a9SDon Lewis break; 1829831d27a9SDon Lewis 1830831d27a9SDon Lewis /* This is deprecated, FIOSETOWN should be used instead. */ 1831831d27a9SDon Lewis case TIOCSPGRP: 1832831d27a9SDon Lewis error = fsetown(-(*(int *)addr), &d->bd_sigio); 1833831d27a9SDon Lewis break; 1834831d27a9SDon Lewis 1835831d27a9SDon Lewis /* This is deprecated, FIOGETOWN should be used instead. */ 183600a83887SPaul Traina case TIOCGPGRP: 183791e97a82SDon Lewis *(int *)addr = -fgetown(&d->bd_sigio); 183800a83887SPaul Traina break; 183900a83887SPaul Traina 184000a83887SPaul Traina case BIOCSRSIG: /* Set receive signal */ 184100a83887SPaul Traina { 184200a83887SPaul Traina u_int sig; 184300a83887SPaul Traina 184400a83887SPaul Traina sig = *(u_int *)addr; 184500a83887SPaul Traina 184600a83887SPaul Traina if (sig >= NSIG) 184700a83887SPaul Traina error = EINVAL; 184897aacec6SAlexander V. Chernikov else { 184997aacec6SAlexander V. Chernikov BPFD_LOCK(d); 185000a83887SPaul Traina d->bd_sig = sig; 185197aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 185297aacec6SAlexander V. Chernikov } 185300a83887SPaul Traina break; 185400a83887SPaul Traina } 185500a83887SPaul Traina case BIOCGRSIG: 185697aacec6SAlexander V. Chernikov BPFD_LOCK(d); 185700a83887SPaul Traina *(u_int *)addr = d->bd_sig; 185897aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 185900a83887SPaul Traina break; 18604d621040SChristian S.J. Peron 18614d621040SChristian S.J. Peron case BIOCGETBUFMODE: 186297aacec6SAlexander V. Chernikov BPFD_LOCK(d); 18634d621040SChristian S.J. Peron *(u_int *)addr = d->bd_bufmode; 186497aacec6SAlexander V. Chernikov BPFD_UNLOCK(d); 18654d621040SChristian S.J. Peron break; 18664d621040SChristian S.J. Peron 18674d621040SChristian S.J. Peron case BIOCSETBUFMODE: 18684d621040SChristian S.J. Peron /* 18694d621040SChristian S.J. Peron * Allow the buffering mode to be changed as long as we 18704d621040SChristian S.J. Peron * haven't yet committed to a particular mode. Our 18714d621040SChristian S.J. Peron * definition of commitment, for now, is whether or not a 18724d621040SChristian S.J. Peron * buffer has been allocated or an interface attached, since 18734d621040SChristian S.J. Peron * that's the point where things get tricky. 18744d621040SChristian S.J. Peron */ 18754d621040SChristian S.J. Peron switch (*(u_int *)addr) { 18764d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 18774d621040SChristian S.J. Peron break; 18784d621040SChristian S.J. Peron 18794d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 18804d621040SChristian S.J. Peron if (bpf_zerocopy_enable) 18814d621040SChristian S.J. Peron break; 18824d621040SChristian S.J. Peron /* FALLSTHROUGH */ 18834d621040SChristian S.J. Peron 18844d621040SChristian S.J. Peron default: 18851b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 18864d621040SChristian S.J. Peron return (EINVAL); 18874d621040SChristian S.J. Peron } 18884d621040SChristian S.J. Peron 1889afa85850SAlexander V. Chernikov BPFD_LOCK(d); 18904d621040SChristian S.J. Peron if (d->bd_sbuf != NULL || d->bd_hbuf != NULL || 18914d621040SChristian S.J. Peron d->bd_fbuf != NULL || d->bd_bif != NULL) { 1892afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 18931b610a74SBjoern A. Zeeb CURVNET_RESTORE(); 18944d621040SChristian S.J. Peron return (EBUSY); 18954d621040SChristian S.J. Peron } 18964d621040SChristian S.J. Peron d->bd_bufmode = *(u_int *)addr; 1897afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 18984d621040SChristian S.J. Peron break; 18994d621040SChristian S.J. Peron 19004d621040SChristian S.J. Peron case BIOCGETZMAX: 19011b610a74SBjoern A. Zeeb error = bpf_ioctl_getzmax(td, d, (size_t *)addr); 19021b610a74SBjoern A. Zeeb break; 19034d621040SChristian S.J. Peron 19044d621040SChristian S.J. Peron case BIOCSETZBUF: 19051b610a74SBjoern A. Zeeb error = bpf_ioctl_setzbuf(td, d, (struct bpf_zbuf *)addr); 19061b610a74SBjoern A. Zeeb break; 19074d621040SChristian S.J. Peron 19084d621040SChristian S.J. Peron case BIOCROTZBUF: 19091b610a74SBjoern A. Zeeb error = bpf_ioctl_rotzbuf(td, d, (struct bpf_zbuf *)addr); 19101b610a74SBjoern A. Zeeb break; 19111e7fe2fbSLuiz Otavio O Souza 19121e7fe2fbSLuiz Otavio O Souza case BIOCSETVLANPCP: 19131e7fe2fbSLuiz Otavio O Souza { 19141e7fe2fbSLuiz Otavio O Souza u_int pcp; 19151e7fe2fbSLuiz Otavio O Souza 19161e7fe2fbSLuiz Otavio O Souza pcp = *(u_int *)addr; 19171e7fe2fbSLuiz Otavio O Souza if (pcp > BPF_PRIO_MAX || pcp < 0) { 19181e7fe2fbSLuiz Otavio O Souza error = EINVAL; 19191e7fe2fbSLuiz Otavio O Souza break; 19201e7fe2fbSLuiz Otavio O Souza } 19211e7fe2fbSLuiz Otavio O Souza d->bd_pcp = pcp; 19221e7fe2fbSLuiz Otavio O Souza break; 19231e7fe2fbSLuiz Otavio O Souza } 1924df8bae1dSRodney W. Grimes } 192597021c24SMarko Zec CURVNET_RESTORE(); 1926df8bae1dSRodney W. Grimes return (error); 1927df8bae1dSRodney W. Grimes } 1928df8bae1dSRodney W. Grimes 1929df8bae1dSRodney W. Grimes /* 1930df8bae1dSRodney W. Grimes * Set d's packet filter program to fp. If this file already has a filter, 1931df8bae1dSRodney W. Grimes * free it and replace it. Returns EINVAL for bogus requests. 1932784292f8SAlexander V. Chernikov * 1933699281b5SAndrey V. Elsukov * Note we use global lock here to serialize bpf_setf() and bpf_setif() 1934699281b5SAndrey V. Elsukov * calls. 1935df8bae1dSRodney W. Grimes */ 1936f708ef1bSPoul-Henning Kamp static int 193719ba8395SChristian S.J. Peron bpf_setf(struct bpf_d *d, struct bpf_program *fp, u_long cmd) 1938df8bae1dSRodney W. Grimes { 19399b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19409b7d4a7fSJung-uk Kim struct bpf_program fp_swab; 19419b7d4a7fSJung-uk Kim struct bpf_program32 *fp32; 19429b7d4a7fSJung-uk Kim #endif 1943699281b5SAndrey V. Elsukov struct bpf_program_buffer *fcode; 1944699281b5SAndrey V. Elsukov struct bpf_insn *filter; 1945293c06a1SRuslan Ermilov #ifdef BPF_JITTER 1946699281b5SAndrey V. Elsukov bpf_jit_filter *jfunc; 1947ae275efcSJung-uk Kim #endif 19488b04b48aSJung-uk Kim size_t size; 19498b04b48aSJung-uk Kim u_int flen; 1950699281b5SAndrey V. Elsukov bool track_event; 1951df8bae1dSRodney W. Grimes 19529b7d4a7fSJung-uk Kim #ifdef COMPAT_FREEBSD32 19536f731135SJung-uk Kim switch (cmd) { 19546f731135SJung-uk Kim case BIOCSETF32: 19556f731135SJung-uk Kim case BIOCSETWF32: 19566f731135SJung-uk Kim case BIOCSETFNR32: 1957fc0a61a4SKonstantin Belousov fp32 = (struct bpf_program32 *)fp; 1958fc0a61a4SKonstantin Belousov fp_swab.bf_len = fp32->bf_len; 1959699281b5SAndrey V. Elsukov fp_swab.bf_insns = 1960699281b5SAndrey V. Elsukov (struct bpf_insn *)(uintptr_t)fp32->bf_insns; 1961fc0a61a4SKonstantin Belousov fp = &fp_swab; 19626f731135SJung-uk Kim switch (cmd) { 19636f731135SJung-uk Kim case BIOCSETF32: 19646f731135SJung-uk Kim cmd = BIOCSETF; 19656f731135SJung-uk Kim break; 19666f731135SJung-uk Kim case BIOCSETWF32: 1967fc0a61a4SKonstantin Belousov cmd = BIOCSETWF; 19686f731135SJung-uk Kim break; 19696f731135SJung-uk Kim } 19706f731135SJung-uk Kim break; 1971fc0a61a4SKonstantin Belousov } 1972fc0a61a4SKonstantin Belousov #endif 19738b04b48aSJung-uk Kim 1974699281b5SAndrey V. Elsukov filter = NULL; 19758b04b48aSJung-uk Kim #ifdef BPF_JITTER 1976699281b5SAndrey V. Elsukov jfunc = NULL; 19778b04b48aSJung-uk Kim #endif 19786c74ff0eSAlexander V. Chernikov /* 19796c74ff0eSAlexander V. Chernikov * Check new filter validness before acquiring any locks. 19806c74ff0eSAlexander V. Chernikov * Allocate memory for new filter, if needed. 19816c74ff0eSAlexander V. Chernikov */ 19826c74ff0eSAlexander V. Chernikov flen = fp->bf_len; 19839b7d4a7fSJung-uk Kim if (flen > bpf_maxinsns || (fp->bf_insns == NULL && flen != 0)) 19846c74ff0eSAlexander V. Chernikov return (EINVAL); 19856c74ff0eSAlexander V. Chernikov size = flen * sizeof(*fp->bf_insns); 1986a86227d1SAlexander V. Chernikov if (size > 0) { 19879b7d4a7fSJung-uk Kim /* We're setting up new filter. Copy and check actual data. */ 1988699281b5SAndrey V. Elsukov fcode = bpf_program_buffer_alloc(size, M_WAITOK); 1989699281b5SAndrey V. Elsukov filter = (struct bpf_insn *)fcode->buffer; 1990699281b5SAndrey V. Elsukov if (copyin(fp->bf_insns, filter, size) != 0 || 1991699281b5SAndrey V. Elsukov !bpf_validate(filter, flen)) { 1992a86227d1SAlexander V. Chernikov free(fcode, M_BPF); 1993a86227d1SAlexander V. Chernikov return (EINVAL); 1994a86227d1SAlexander V. Chernikov } 1995c7b0200eSAlexander V. Chernikov #ifdef BPF_JITTER 199616a227c7SJonathan T. Looney if (cmd != BIOCSETWF) { 199716a227c7SJonathan T. Looney /* 199816a227c7SJonathan T. Looney * Filter is copied inside fcode and is 199916a227c7SJonathan T. Looney * perfectly valid. 200016a227c7SJonathan T. Looney */ 2001699281b5SAndrey V. Elsukov jfunc = bpf_jitter(filter, flen); 200216a227c7SJonathan T. Looney } 2003c7b0200eSAlexander V. Chernikov #endif 20048b04b48aSJung-uk Kim } 2005c7b0200eSAlexander V. Chernikov 2006699281b5SAndrey V. Elsukov track_event = false; 2007699281b5SAndrey V. Elsukov fcode = NULL; 20086c74ff0eSAlexander V. Chernikov 2009699281b5SAndrey V. Elsukov BPF_LOCK(); 2010afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2011699281b5SAndrey V. Elsukov /* Set up new filter. */ 20128b04b48aSJung-uk Kim if (cmd == BIOCSETWF) { 2013699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2014699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_wfilter, 2015699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2016293c06a1SRuslan Ermilov #ifdef BPF_JITTER 2017699281b5SAndrey V. Elsukov fcode->func = NULL; 2018699281b5SAndrey V. Elsukov #endif 2019699281b5SAndrey V. Elsukov } 2020699281b5SAndrey V. Elsukov d->bd_wfilter = filter; 2021699281b5SAndrey V. Elsukov } else { 2022699281b5SAndrey V. Elsukov if (d->bd_rfilter != NULL) { 2023699281b5SAndrey V. Elsukov fcode = __containerof((void *)d->bd_rfilter, 2024699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2025699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2026699281b5SAndrey V. Elsukov fcode->func = d->bd_bfilter; 2027699281b5SAndrey V. Elsukov #endif 2028699281b5SAndrey V. Elsukov } 2029699281b5SAndrey V. Elsukov d->bd_rfilter = filter; 2030699281b5SAndrey V. Elsukov #ifdef BPF_JITTER 2031c7b0200eSAlexander V. Chernikov d->bd_bfilter = jfunc; 2032ae275efcSJung-uk Kim #endif 2033f11c3508SDavid Malone if (cmd == BIOCSETF) 2034df8bae1dSRodney W. Grimes reset_d(d); 203551ec1eb7SAlexander V. Chernikov 2036699281b5SAndrey V. Elsukov if (bpf_check_upgrade(cmd, d, filter, flen) != 0) { 2037699281b5SAndrey V. Elsukov /* 2038699281b5SAndrey V. Elsukov * Filter can be set several times without 2039699281b5SAndrey V. Elsukov * specifying interface. In this case just mark d 2040699281b5SAndrey V. Elsukov * as reader. 2041699281b5SAndrey V. Elsukov */ 2042699281b5SAndrey V. Elsukov d->bd_writer = 0; 2043699281b5SAndrey V. Elsukov if (d->bd_bif != NULL) { 2044699281b5SAndrey V. Elsukov /* 2045699281b5SAndrey V. Elsukov * Remove descriptor from writers-only list 2046699281b5SAndrey V. Elsukov * and add it to active readers list. 2047699281b5SAndrey V. Elsukov */ 2048699281b5SAndrey V. Elsukov CK_LIST_REMOVE(d, bd_next); 2049699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&d->bd_bif->bif_dlist, 2050699281b5SAndrey V. Elsukov d, bd_next); 2051699281b5SAndrey V. Elsukov CTR2(KTR_NET, 2052699281b5SAndrey V. Elsukov "%s: upgrade required by pid %d", 2053699281b5SAndrey V. Elsukov __func__, d->bd_pid); 2054699281b5SAndrey V. Elsukov track_event = true; 2055699281b5SAndrey V. Elsukov } 2056699281b5SAndrey V. Elsukov } 20578b04b48aSJung-uk Kim } 2058afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2059df8bae1dSRodney W. Grimes 2060699281b5SAndrey V. Elsukov if (fcode != NULL) 20612a4bd982SGleb Smirnoff NET_EPOCH_CALL(bpf_program_buffer_free, &fcode->epoch_ctx); 2062699281b5SAndrey V. Elsukov 2063699281b5SAndrey V. Elsukov if (track_event) 2064699281b5SAndrey V. Elsukov EVENTHANDLER_INVOKE(bpf_track, 2065699281b5SAndrey V. Elsukov d->bd_bif->bif_ifp, d->bd_bif->bif_dlt, 1); 206651ec1eb7SAlexander V. Chernikov 20676c74ff0eSAlexander V. Chernikov BPF_UNLOCK(); 2068df8bae1dSRodney W. Grimes return (0); 2069df8bae1dSRodney W. Grimes } 2070df8bae1dSRodney W. Grimes 2071df8bae1dSRodney W. Grimes /* 2072df8bae1dSRodney W. Grimes * Detach a file from its current interface (if attached at all) and attach 2073df8bae1dSRodney W. Grimes * to the interface indicated by the name stored in ifr. 2074df8bae1dSRodney W. Grimes * Return an errno or 0. 2075df8bae1dSRodney W. Grimes */ 2076df8bae1dSRodney W. Grimes static int 207719ba8395SChristian S.J. Peron bpf_setif(struct bpf_d *d, struct ifreq *ifr) 2078df8bae1dSRodney W. Grimes { 2079df8bae1dSRodney W. Grimes struct bpf_if *bp; 20809b44ff22SGarrett Wollman struct ifnet *theywant; 2081df8bae1dSRodney W. Grimes 20826c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 20836c74ff0eSAlexander V. Chernikov 20849b44ff22SGarrett Wollman theywant = ifunit(ifr->ifr_name); 208516d878ccSChristian S.J. Peron if (theywant == NULL || theywant->if_bpf == NULL) 208616d878ccSChristian S.J. Peron return (ENXIO); 20879b44ff22SGarrett Wollman 208816d878ccSChristian S.J. Peron bp = theywant->if_bpf; 2089df8bae1dSRodney W. Grimes /* 20904f42daa4SLuiz Otavio O Souza * At this point, we expect the buffer is already allocated. If not, 20914f42daa4SLuiz Otavio O Souza * return an error. 2092df8bae1dSRodney W. Grimes */ 20934d621040SChristian S.J. Peron switch (d->bd_bufmode) { 20944d621040SChristian S.J. Peron case BPF_BUFMODE_BUFFER: 20954d621040SChristian S.J. Peron case BPF_BUFMODE_ZBUF: 20964d621040SChristian S.J. Peron if (d->bd_sbuf == NULL) 20974d621040SChristian S.J. Peron return (EINVAL); 20984d621040SChristian S.J. Peron break; 20994d621040SChristian S.J. Peron 21004d621040SChristian S.J. Peron default: 21014d621040SChristian S.J. Peron panic("bpf_setif: bufmode %d", d->bd_bufmode); 21024d621040SChristian S.J. Peron } 21036c74ff0eSAlexander V. Chernikov if (bp != d->bd_bif) 2104df8bae1dSRodney W. Grimes bpf_attachd(d, bp); 2105699281b5SAndrey V. Elsukov else { 2106afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2107df8bae1dSRodney W. Grimes reset_d(d); 2108afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2109699281b5SAndrey V. Elsukov } 2110df8bae1dSRodney W. Grimes return (0); 2111df8bae1dSRodney W. Grimes } 2112df8bae1dSRodney W. Grimes 2113df8bae1dSRodney W. Grimes /* 2114243ac7d8SPeter Wemm * Support for select() and poll() system calls 2115df8bae1dSRodney W. Grimes * 2116df8bae1dSRodney W. Grimes * Return true iff the specific operation will not block indefinitely. 2117df8bae1dSRodney W. Grimes * Otherwise, return false but make a note that a selwakeup() must be done. 2118df8bae1dSRodney W. Grimes */ 211937c84183SPoul-Henning Kamp static int 212019ba8395SChristian S.J. Peron bpfpoll(struct cdev *dev, int events, struct thread *td) 2121df8bae1dSRodney W. Grimes { 2122e7bb21b3SJonathan Lemon struct bpf_d *d; 21230832fc64SGarance A Drosehn int revents; 2124df8bae1dSRodney W. Grimes 2125136600feSEd Schouten if (devfs_get_cdevpriv((void **)&d) != 0 || d->bd_bif == NULL) 2126136600feSEd Schouten return (events & 2127136600feSEd Schouten (POLLHUP|POLLIN|POLLRDNORM|POLLOUT|POLLWRNORM)); 2128de5d9935SRobert Watson 2129b75a24a0SChristian S.J. Peron /* 2130b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2131b75a24a0SChristian S.J. Peron */ 21320832fc64SGarance A Drosehn revents = events & (POLLOUT | POLLWRNORM); 2133afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2134e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH(d, td); 213575c13541SPoul-Henning Kamp if (events & (POLLIN | POLLRDNORM)) { 213695aab9ccSJohn-Mark Gurney if (bpf_ready(d)) 2137243ac7d8SPeter Wemm revents |= events & (POLLIN | POLLRDNORM); 213881bda851SJohn Polstra else { 2139ed01445dSJohn Baldwin selrecord(td, &d->bd_sel); 214081bda851SJohn Polstra /* Start the read timeout if necessary. */ 214181bda851SJohn Polstra if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 214281bda851SJohn Polstra callout_reset(&d->bd_callout, d->bd_rtout, 214381bda851SJohn Polstra bpf_timed_out, d); 214481bda851SJohn Polstra d->bd_state = BPF_WAITING; 214581bda851SJohn Polstra } 214681bda851SJohn Polstra } 214775c13541SPoul-Henning Kamp } 2148afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2149243ac7d8SPeter Wemm return (revents); 2150df8bae1dSRodney W. Grimes } 2151df8bae1dSRodney W. Grimes 2152df8bae1dSRodney W. Grimes /* 215395aab9ccSJohn-Mark Gurney * Support for kevent() system call. Register EVFILT_READ filters and 215495aab9ccSJohn-Mark Gurney * reject all others. 215595aab9ccSJohn-Mark Gurney */ 215695aab9ccSJohn-Mark Gurney int 215719ba8395SChristian S.J. Peron bpfkqfilter(struct cdev *dev, struct knote *kn) 215895aab9ccSJohn-Mark Gurney { 2159136600feSEd Schouten struct bpf_d *d; 216095aab9ccSJohn-Mark Gurney 2161136600feSEd Schouten if (devfs_get_cdevpriv((void **)&d) != 0 || 2162136600feSEd Schouten kn->kn_filter != EVFILT_READ) 216395aab9ccSJohn-Mark Gurney return (1); 216495aab9ccSJohn-Mark Gurney 2165b75a24a0SChristian S.J. Peron /* 2166b75a24a0SChristian S.J. Peron * Refresh PID associated with this descriptor. 2167b75a24a0SChristian S.J. Peron */ 2168afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2169e4b3229aSAlexander V. Chernikov BPF_PID_REFRESH_CUR(d); 217095aab9ccSJohn-Mark Gurney kn->kn_fop = &bpfread_filtops; 217195aab9ccSJohn-Mark Gurney kn->kn_hook = d; 21724b19419eSChristian S.J. Peron knlist_add(&d->bd_sel.si_note, kn, 1); 2173afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 217495aab9ccSJohn-Mark Gurney 217595aab9ccSJohn-Mark Gurney return (0); 217695aab9ccSJohn-Mark Gurney } 217795aab9ccSJohn-Mark Gurney 217895aab9ccSJohn-Mark Gurney static void 217919ba8395SChristian S.J. Peron filt_bpfdetach(struct knote *kn) 218095aab9ccSJohn-Mark Gurney { 218195aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 218295aab9ccSJohn-Mark Gurney 2183ad3b9257SJohn-Mark Gurney knlist_remove(&d->bd_sel.si_note, kn, 0); 218495aab9ccSJohn-Mark Gurney } 218595aab9ccSJohn-Mark Gurney 218695aab9ccSJohn-Mark Gurney static int 218719ba8395SChristian S.J. Peron filt_bpfread(struct knote *kn, long hint) 218895aab9ccSJohn-Mark Gurney { 218995aab9ccSJohn-Mark Gurney struct bpf_d *d = (struct bpf_d *)kn->kn_hook; 219095aab9ccSJohn-Mark Gurney int ready; 219195aab9ccSJohn-Mark Gurney 2192afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 219395aab9ccSJohn-Mark Gurney ready = bpf_ready(d); 219495aab9ccSJohn-Mark Gurney if (ready) { 219595aab9ccSJohn-Mark Gurney kn->kn_data = d->bd_slen; 219692242172SLuiz Otavio O Souza /* 219792242172SLuiz Otavio O Souza * Ignore the hold buffer if it is being copied to user space. 219892242172SLuiz Otavio O Souza */ 219992242172SLuiz Otavio O Souza if (!d->bd_hbuf_in_use && d->bd_hbuf) 220095aab9ccSJohn-Mark Gurney kn->kn_data += d->bd_hlen; 22015d7af3a1SJung-uk Kim } else if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) { 220295aab9ccSJohn-Mark Gurney callout_reset(&d->bd_callout, d->bd_rtout, 220395aab9ccSJohn-Mark Gurney bpf_timed_out, d); 220495aab9ccSJohn-Mark Gurney d->bd_state = BPF_WAITING; 220595aab9ccSJohn-Mark Gurney } 220695aab9ccSJohn-Mark Gurney 220795aab9ccSJohn-Mark Gurney return (ready); 220895aab9ccSJohn-Mark Gurney } 220995aab9ccSJohn-Mark Gurney 2210253a3814SLawrence Stewart #define BPF_TSTAMP_NONE 0 2211253a3814SLawrence Stewart #define BPF_TSTAMP_FAST 1 2212253a3814SLawrence Stewart #define BPF_TSTAMP_NORMAL 2 2213253a3814SLawrence Stewart #define BPF_TSTAMP_EXTERN 3 2214253a3814SLawrence Stewart 2215253a3814SLawrence Stewart static int 2216253a3814SLawrence Stewart bpf_ts_quality(int tstype) 2217253a3814SLawrence Stewart { 2218253a3814SLawrence Stewart 2219253a3814SLawrence Stewart if (tstype == BPF_T_NONE) 2220253a3814SLawrence Stewart return (BPF_TSTAMP_NONE); 2221253a3814SLawrence Stewart if ((tstype & BPF_T_FAST) != 0) 2222253a3814SLawrence Stewart return (BPF_TSTAMP_FAST); 2223253a3814SLawrence Stewart 2224253a3814SLawrence Stewart return (BPF_TSTAMP_NORMAL); 2225253a3814SLawrence Stewart } 2226253a3814SLawrence Stewart 2227253a3814SLawrence Stewart static int 2228253a3814SLawrence Stewart bpf_gettime(struct bintime *bt, int tstype, struct mbuf *m) 2229253a3814SLawrence Stewart { 2230253a3814SLawrence Stewart struct m_tag *tag; 2231253a3814SLawrence Stewart int quality; 2232253a3814SLawrence Stewart 2233253a3814SLawrence Stewart quality = bpf_ts_quality(tstype); 2234253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NONE) 2235253a3814SLawrence Stewart return (quality); 2236253a3814SLawrence Stewart 2237253a3814SLawrence Stewart if (m != NULL) { 2238253a3814SLawrence Stewart tag = m_tag_locate(m, MTAG_BPF, MTAG_BPF_TIMESTAMP, NULL); 2239253a3814SLawrence Stewart if (tag != NULL) { 2240253a3814SLawrence Stewart *bt = *(struct bintime *)(tag + 1); 2241253a3814SLawrence Stewart return (BPF_TSTAMP_EXTERN); 2242253a3814SLawrence Stewart } 2243253a3814SLawrence Stewart } 2244253a3814SLawrence Stewart if (quality == BPF_TSTAMP_NORMAL) 2245253a3814SLawrence Stewart binuptime(bt); 2246253a3814SLawrence Stewart else 2247253a3814SLawrence Stewart getbinuptime(bt); 2248253a3814SLawrence Stewart 2249253a3814SLawrence Stewart return (quality); 2250253a3814SLawrence Stewart } 2251253a3814SLawrence Stewart 225295aab9ccSJohn-Mark Gurney /* 2253df8bae1dSRodney W. Grimes * Incoming linkage from device drivers. Process the packet pkt, of length 2254df8bae1dSRodney W. Grimes * pktlen, which is stored in a contiguous buffer. The packet is parsed 2255df8bae1dSRodney W. Grimes * by each process' filter, and if accepted, stashed into the corresponding 2256df8bae1dSRodney W. Grimes * buffer. 2257df8bae1dSRodney W. Grimes */ 2258df8bae1dSRodney W. Grimes void 225919ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 2260df8bae1dSRodney W. Grimes { 2261699281b5SAndrey V. Elsukov struct epoch_tracker et; 2262547d94bdSJung-uk Kim struct bintime bt; 22638994a245SDag-Erling Smørgrav struct bpf_d *d; 2264a36599ccSJung-uk Kim #ifdef BPF_JITTER 2265a36599ccSJung-uk Kim bpf_jit_filter *bf; 2266a36599ccSJung-uk Kim #endif 2267253a3814SLawrence Stewart u_int slen; 2268253a3814SLawrence Stewart int gottime; 2269e7bb21b3SJonathan Lemon 2270253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2271699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2272699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2273b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2274a05cf8c6SChristian S.J. Peron /* 2275699281b5SAndrey V. Elsukov * NB: We dont call BPF_CHECK_DIRECTION() here since there 2276699281b5SAndrey V. Elsukov * is no way for the caller to indiciate to us whether this 2277699281b5SAndrey V. Elsukov * packet is inbound or outbound. In the bpf_mtap() routines, 2278699281b5SAndrey V. Elsukov * we use the interface pointers on the mbuf to figure it out. 2279a05cf8c6SChristian S.J. Peron */ 2280ae275efcSJung-uk Kim #ifdef BPF_JITTER 2281a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2282a36599ccSJung-uk Kim if (bf != NULL) 2283a36599ccSJung-uk Kim slen = (*(bf->func))(pkt, pktlen, pktlen); 2284ae275efcSJung-uk Kim else 2285ae275efcSJung-uk Kim #endif 228693e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, pkt, pktlen, pktlen); 2287ec272d87SRobert Watson if (slen != 0) { 2288e4b3229aSAlexander V. Chernikov /* 2289e4b3229aSAlexander V. Chernikov * Filter matches. Let's to acquire write lock. 2290e4b3229aSAlexander V. Chernikov */ 2291afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2292b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2293253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2294699281b5SAndrey V. Elsukov gottime = bpf_gettime(&bt, d->bd_tstamp, 2295699281b5SAndrey V. Elsukov NULL); 2296ec272d87SRobert Watson #ifdef MAC 229730d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2298ec272d87SRobert Watson #endif 22994d621040SChristian S.J. Peron catchpacket(d, pkt, pktlen, slen, 2300547d94bdSJung-uk Kim bpf_append_bytes, &bt); 2301afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 2302ec272d87SRobert Watson } 2303df8bae1dSRodney W. Grimes } 2304699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2305df8bae1dSRodney W. Grimes } 2306df8bae1dSRodney W. Grimes 2307f81a2a49SJung-uk Kim #define BPF_CHECK_DIRECTION(d, r, i) \ 2308f81a2a49SJung-uk Kim (((d)->bd_direction == BPF_D_IN && (r) != (i)) || \ 2309f81a2a49SJung-uk Kim ((d)->bd_direction == BPF_D_OUT && (r) == (i))) 2310560a54e1SJung-uk Kim 2311df8bae1dSRodney W. Grimes /* 2312df8bae1dSRodney W. Grimes * Incoming linkage from device drivers, when packet is in an mbuf chain. 2313e4b3229aSAlexander V. Chernikov * Locking model is explained in bpf_tap(). 2314df8bae1dSRodney W. Grimes */ 2315df8bae1dSRodney W. Grimes void 231619ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 2317df8bae1dSRodney W. Grimes { 2318699281b5SAndrey V. Elsukov struct epoch_tracker et; 2319547d94bdSJung-uk Kim struct bintime bt; 2320df8bae1dSRodney W. Grimes struct bpf_d *d; 2321a36599ccSJung-uk Kim #ifdef BPF_JITTER 2322a36599ccSJung-uk Kim bpf_jit_filter *bf; 2323a36599ccSJung-uk Kim #endif 2324253a3814SLawrence Stewart u_int pktlen, slen; 2325253a3814SLawrence Stewart int gottime; 232691433904SDavid Malone 23278cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 2328fb3bc596SJohn Baldwin if ((m->m_flags & M_PROMISC) != 0 && m_rcvif(m) == NULL) { 23298cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 23308cd892f7SJung-uk Kim return; 23318cd892f7SJung-uk Kim } 23328cd892f7SJung-uk Kim 2333f0e2422bSPoul-Henning Kamp pktlen = m_length(m, NULL); 2334253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2335e4b3229aSAlexander V. Chernikov 2336699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2337699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2338fb3bc596SJohn Baldwin if (BPF_CHECK_DIRECTION(d, m_rcvif(m), bp->bif_ifp)) 23398ed3828cSRobert Watson continue; 2340b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 2341ae275efcSJung-uk Kim #ifdef BPF_JITTER 2342a36599ccSJung-uk Kim bf = bpf_jitter_enable != 0 ? d->bd_bfilter : NULL; 2343ae275efcSJung-uk Kim /* XXX We cannot handle multiple mbufs. */ 2344a36599ccSJung-uk Kim if (bf != NULL && m->m_next == NULL) 2345699281b5SAndrey V. Elsukov slen = (*(bf->func))(mtod(m, u_char *), pktlen, 2346699281b5SAndrey V. Elsukov pktlen); 2347ae275efcSJung-uk Kim else 2348ae275efcSJung-uk Kim #endif 234993e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)m, pktlen, 0); 23504ddfb531SChristian S.J. Peron if (slen != 0) { 2351afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2352e4b3229aSAlexander V. Chernikov 2353b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2354253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2355253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 23560c7fb534SRobert Watson #ifdef MAC 235730d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 23580c7fb534SRobert Watson #endif 23590c7fb534SRobert Watson catchpacket(d, (u_char *)m, pktlen, slen, 2360547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2361afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 23624ddfb531SChristian S.J. Peron } 2363df8bae1dSRodney W. Grimes } 2364699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2365df8bae1dSRodney W. Grimes } 2366df8bae1dSRodney W. Grimes 2367df8bae1dSRodney W. Grimes /* 2368437ffe18SSam Leffler * Incoming linkage from device drivers, when packet is in 2369437ffe18SSam Leffler * an mbuf chain and to be prepended by a contiguous header. 2370437ffe18SSam Leffler */ 2371437ffe18SSam Leffler void 237219ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m) 2373437ffe18SSam Leffler { 2374699281b5SAndrey V. Elsukov struct epoch_tracker et; 2375547d94bdSJung-uk Kim struct bintime bt; 2376437ffe18SSam Leffler struct mbuf mb; 2377437ffe18SSam Leffler struct bpf_d *d; 2378253a3814SLawrence Stewart u_int pktlen, slen; 2379253a3814SLawrence Stewart int gottime; 238091433904SDavid Malone 23818cd892f7SJung-uk Kim /* Skip outgoing duplicate packets. */ 23828cd892f7SJung-uk Kim if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif == NULL) { 23838cd892f7SJung-uk Kim m->m_flags &= ~M_PROMISC; 23848cd892f7SJung-uk Kim return; 23858cd892f7SJung-uk Kim } 23868cd892f7SJung-uk Kim 2387437ffe18SSam Leffler pktlen = m_length(m, NULL); 2388437ffe18SSam Leffler /* 2389437ffe18SSam Leffler * Craft on-stack mbuf suitable for passing to bpf_filter. 2390437ffe18SSam Leffler * Note that we cut corners here; we only setup what's 2391437ffe18SSam Leffler * absolutely needed--this mbuf should never go anywhere else. 2392437ffe18SSam Leffler */ 239382334850SJohn Baldwin mb.m_flags = 0; 2394437ffe18SSam Leffler mb.m_next = m; 2395437ffe18SSam Leffler mb.m_data = data; 2396437ffe18SSam Leffler mb.m_len = dlen; 2397437ffe18SSam Leffler pktlen += dlen; 2398437ffe18SSam Leffler 2399253a3814SLawrence Stewart gottime = BPF_TSTAMP_NONE; 2400e4b3229aSAlexander V. Chernikov 2401699281b5SAndrey V. Elsukov NET_EPOCH_ENTER(et); 2402699281b5SAndrey V. Elsukov CK_LIST_FOREACH(d, &bp->bif_dlist, bd_next) { 2403f81a2a49SJung-uk Kim if (BPF_CHECK_DIRECTION(d, m->m_pkthdr.rcvif, bp->bif_ifp)) 2404437ffe18SSam Leffler continue; 2405b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_rcount, 1); 240693e39f0bSChristian S.J. Peron slen = bpf_filter(d->bd_rfilter, (u_char *)&mb, pktlen, 0); 24074ddfb531SChristian S.J. Peron if (slen != 0) { 2408afa85850SAlexander V. Chernikov BPFD_LOCK(d); 2409e4b3229aSAlexander V. Chernikov 2410b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_fcount, 1); 2411253a3814SLawrence Stewart if (gottime < bpf_ts_quality(d->bd_tstamp)) 2412253a3814SLawrence Stewart gottime = bpf_gettime(&bt, d->bd_tstamp, m); 2413437ffe18SSam Leffler #ifdef MAC 241430d239bcSRobert Watson if (mac_bpfdesc_check_receive(d, bp->bif_ifp) == 0) 2415437ffe18SSam Leffler #endif 2416437ffe18SSam Leffler catchpacket(d, (u_char *)&mb, pktlen, slen, 2417547d94bdSJung-uk Kim bpf_append_mbuf, &bt); 2418afa85850SAlexander V. Chernikov BPFD_UNLOCK(d); 24194ddfb531SChristian S.J. Peron } 2420437ffe18SSam Leffler } 2421699281b5SAndrey V. Elsukov NET_EPOCH_EXIT(et); 2422437ffe18SSam Leffler } 2423437ffe18SSam Leffler 2424560a54e1SJung-uk Kim #undef BPF_CHECK_DIRECTION 2425253a3814SLawrence Stewart #undef BPF_TSTAMP_NONE 2426253a3814SLawrence Stewart #undef BPF_TSTAMP_FAST 2427253a3814SLawrence Stewart #undef BPF_TSTAMP_NORMAL 2428253a3814SLawrence Stewart #undef BPF_TSTAMP_EXTERN 2429253a3814SLawrence Stewart 2430547d94bdSJung-uk Kim static int 2431547d94bdSJung-uk Kim bpf_hdrlen(struct bpf_d *d) 2432547d94bdSJung-uk Kim { 2433547d94bdSJung-uk Kim int hdrlen; 2434547d94bdSJung-uk Kim 2435547d94bdSJung-uk Kim hdrlen = d->bd_bif->bif_hdrlen; 2436547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2437547d94bdSJung-uk Kim if (d->bd_tstamp == BPF_T_NONE || 2438547d94bdSJung-uk Kim BPF_T_FORMAT(d->bd_tstamp) == BPF_T_MICROTIME) 2439547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2440547d94bdSJung-uk Kim if (d->bd_compat32) 2441547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr32); 2442547d94bdSJung-uk Kim else 2443547d94bdSJung-uk Kim #endif 2444547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_hdr); 2445547d94bdSJung-uk Kim else 2446547d94bdSJung-uk Kim #endif 2447547d94bdSJung-uk Kim hdrlen += SIZEOF_BPF_HDR(struct bpf_xhdr); 2448547d94bdSJung-uk Kim #ifdef COMPAT_FREEBSD32 2449547d94bdSJung-uk Kim if (d->bd_compat32) 2450547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN32(hdrlen); 2451547d94bdSJung-uk Kim else 2452547d94bdSJung-uk Kim #endif 2453547d94bdSJung-uk Kim hdrlen = BPF_WORDALIGN(hdrlen); 2454547d94bdSJung-uk Kim 2455547d94bdSJung-uk Kim return (hdrlen - d->bd_bif->bif_hdrlen); 2456547d94bdSJung-uk Kim } 2457547d94bdSJung-uk Kim 2458547d94bdSJung-uk Kim static void 2459547d94bdSJung-uk Kim bpf_bintime2ts(struct bintime *bt, struct bpf_ts *ts, int tstype) 2460547d94bdSJung-uk Kim { 2461584b675eSKonstantin Belousov struct bintime bt2, boottimebin; 2462547d94bdSJung-uk Kim struct timeval tsm; 2463547d94bdSJung-uk Kim struct timespec tsn; 2464547d94bdSJung-uk Kim 2465253a3814SLawrence Stewart if ((tstype & BPF_T_MONOTONIC) == 0) { 2466253a3814SLawrence Stewart bt2 = *bt; 2467584b675eSKonstantin Belousov getboottimebin(&boottimebin); 2468253a3814SLawrence Stewart bintime_add(&bt2, &boottimebin); 2469253a3814SLawrence Stewart bt = &bt2; 2470253a3814SLawrence Stewart } 2471547d94bdSJung-uk Kim switch (BPF_T_FORMAT(tstype)) { 2472547d94bdSJung-uk Kim case BPF_T_MICROTIME: 2473547d94bdSJung-uk Kim bintime2timeval(bt, &tsm); 2474547d94bdSJung-uk Kim ts->bt_sec = tsm.tv_sec; 2475547d94bdSJung-uk Kim ts->bt_frac = tsm.tv_usec; 2476547d94bdSJung-uk Kim break; 2477547d94bdSJung-uk Kim case BPF_T_NANOTIME: 2478547d94bdSJung-uk Kim bintime2timespec(bt, &tsn); 2479547d94bdSJung-uk Kim ts->bt_sec = tsn.tv_sec; 2480547d94bdSJung-uk Kim ts->bt_frac = tsn.tv_nsec; 2481547d94bdSJung-uk Kim break; 2482547d94bdSJung-uk Kim case BPF_T_BINTIME: 2483547d94bdSJung-uk Kim ts->bt_sec = bt->sec; 2484547d94bdSJung-uk Kim ts->bt_frac = bt->frac; 2485547d94bdSJung-uk Kim break; 2486547d94bdSJung-uk Kim } 2487547d94bdSJung-uk Kim } 2488547d94bdSJung-uk Kim 2489437ffe18SSam Leffler /* 2490df8bae1dSRodney W. Grimes * Move the packet data from interface memory (pkt) into the 24919e610888SDag-Erling Smørgrav * store buffer. "cpfn" is the routine called to do the actual data 2492df8bae1dSRodney W. Grimes * transfer. bcopy is passed in to copy contiguous chunks, while 24934d621040SChristian S.J. Peron * bpf_append_mbuf is passed in to copy mbuf chains. In the latter case, 2494df8bae1dSRodney W. Grimes * pkt is really an mbuf. 2495df8bae1dSRodney W. Grimes */ 2496df8bae1dSRodney W. Grimes static void 249719ba8395SChristian S.J. Peron catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen, 24984d621040SChristian S.J. Peron void (*cpfn)(struct bpf_d *, caddr_t, u_int, void *, u_int), 2499547d94bdSJung-uk Kim struct bintime *bt) 2500df8bae1dSRodney W. Grimes { 2501547d94bdSJung-uk Kim struct bpf_xhdr hdr; 2502547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2503547d94bdSJung-uk Kim struct bpf_hdr hdr_old; 2504fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2505547d94bdSJung-uk Kim struct bpf_hdr32 hdr32_old; 2506fc0a61a4SKonstantin Belousov #endif 2507547d94bdSJung-uk Kim #endif 2508547d94bdSJung-uk Kim int caplen, curlen, hdrlen, totlen; 25097819da79SJohn-Mark Gurney int do_wakeup = 0; 2510547d94bdSJung-uk Kim int do_timestamp; 2511547d94bdSJung-uk Kim int tstype; 25129e610888SDag-Erling Smørgrav 2513afa85850SAlexander V. Chernikov BPFD_LOCK_ASSERT(d); 2514de253273SAndrey V. Elsukov if (d->bd_bif == NULL) { 2515de253273SAndrey V. Elsukov /* Descriptor was detached in concurrent thread */ 2516de253273SAndrey V. Elsukov counter_u64_add(d->bd_dcount, 1); 2517de253273SAndrey V. Elsukov return; 2518de253273SAndrey V. Elsukov } 25194d621040SChristian S.J. Peron 25204d621040SChristian S.J. Peron /* 25214d621040SChristian S.J. Peron * Detect whether user space has released a buffer back to us, and if 25224d621040SChristian S.J. Peron * so, move it from being a hold buffer to a free buffer. This may 25234d621040SChristian S.J. Peron * not be the best place to do it (for example, we might only want to 25244d621040SChristian S.J. Peron * run this check if we need the space), but for now it's a reliable 25254d621040SChristian S.J. Peron * spot to do it. 25264d621040SChristian S.J. Peron */ 2527fa0c2b34SRobert Watson if (d->bd_fbuf == NULL && bpf_canfreebuf(d)) { 25284d621040SChristian S.J. Peron d->bd_fbuf = d->bd_hbuf; 25294d621040SChristian S.J. Peron d->bd_hbuf = NULL; 25304d621040SChristian S.J. Peron d->bd_hlen = 0; 253129f612ecSChristian S.J. Peron bpf_buf_reclaimed(d); 25324d621040SChristian S.J. Peron } 25334d621040SChristian S.J. Peron 2534df8bae1dSRodney W. Grimes /* 2535df8bae1dSRodney W. Grimes * Figure out how many bytes to move. If the packet is 2536df8bae1dSRodney W. Grimes * greater or equal to the snapshot length, transfer that 2537df8bae1dSRodney W. Grimes * much. Otherwise, transfer the whole packet (unless 2538df8bae1dSRodney W. Grimes * we hit the buffer size limit). 2539df8bae1dSRodney W. Grimes */ 2540547d94bdSJung-uk Kim hdrlen = bpf_hdrlen(d); 2541df8bae1dSRodney W. Grimes totlen = hdrlen + min(snaplen, pktlen); 2542df8bae1dSRodney W. Grimes if (totlen > d->bd_bufsize) 2543df8bae1dSRodney W. Grimes totlen = d->bd_bufsize; 2544df8bae1dSRodney W. Grimes 2545df8bae1dSRodney W. Grimes /* 2546df8bae1dSRodney W. Grimes * Round up the end of the previous packet to the next longword. 2547a7a91e65SRobert Watson * 2548a7a91e65SRobert Watson * Drop the packet if there's no room and no hope of room 2549a7a91e65SRobert Watson * If the packet would overflow the storage buffer or the storage 2550a7a91e65SRobert Watson * buffer is considered immutable by the buffer model, try to rotate 2551a7a91e65SRobert Watson * the buffer and wakeup pending processes. 2552df8bae1dSRodney W. Grimes */ 2553fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2554fc0a61a4SKonstantin Belousov if (d->bd_compat32) 2555fc0a61a4SKonstantin Belousov curlen = BPF_WORDALIGN32(d->bd_slen); 2556fc0a61a4SKonstantin Belousov else 2557fc0a61a4SKonstantin Belousov #endif 2558df8bae1dSRodney W. Grimes curlen = BPF_WORDALIGN(d->bd_slen); 2559a7a91e65SRobert Watson if (curlen + totlen > d->bd_bufsize || !bpf_canwritebuf(d)) { 2560572bde2aSRobert Watson if (d->bd_fbuf == NULL) { 2561df8bae1dSRodney W. Grimes /* 2562a7a91e65SRobert Watson * There's no room in the store buffer, and no 2563a7a91e65SRobert Watson * prospect of room, so drop the packet. Notify the 2564a7a91e65SRobert Watson * buffer model. 2565df8bae1dSRodney W. Grimes */ 2566a7a91e65SRobert Watson bpf_buffull(d); 2567b2b7ca49SAlexander V. Chernikov counter_u64_add(d->bd_dcount, 1); 2568df8bae1dSRodney W. Grimes return; 2569df8bae1dSRodney W. Grimes } 257098fa5d85SLuiz Otavio O Souza KASSERT(!d->bd_hbuf_in_use, ("hold buffer is in use")); 2571df8bae1dSRodney W. Grimes ROTATE_BUFFERS(d); 25727819da79SJohn-Mark Gurney do_wakeup = 1; 2573df8bae1dSRodney W. Grimes curlen = 0; 2574a7a91e65SRobert Watson } else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT) 2575df8bae1dSRodney W. Grimes /* 25764d621040SChristian S.J. Peron * Immediate mode is set, or the read timeout has already 25774d621040SChristian S.J. Peron * expired during a select call. A packet arrived, so the 25784d621040SChristian S.J. Peron * reader should be woken up. 2579df8bae1dSRodney W. Grimes */ 25807819da79SJohn-Mark Gurney do_wakeup = 1; 2581547d94bdSJung-uk Kim caplen = totlen - hdrlen; 2582547d94bdSJung-uk Kim tstype = d->bd_tstamp; 2583547d94bdSJung-uk Kim do_timestamp = tstype != BPF_T_NONE; 2584547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2585547d94bdSJung-uk Kim if (tstype == BPF_T_NONE || BPF_T_FORMAT(tstype) == BPF_T_MICROTIME) { 2586547d94bdSJung-uk Kim struct bpf_ts ts; 2587547d94bdSJung-uk Kim if (do_timestamp) 2588547d94bdSJung-uk Kim bpf_bintime2ts(bt, &ts, tstype); 2589fc0a61a4SKonstantin Belousov #ifdef COMPAT_FREEBSD32 2590fc0a61a4SKonstantin Belousov if (d->bd_compat32) { 2591547d94bdSJung-uk Kim bzero(&hdr32_old, sizeof(hdr32_old)); 2592547d94bdSJung-uk Kim if (do_timestamp) { 2593547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_sec = ts.bt_sec; 2594547d94bdSJung-uk Kim hdr32_old.bh_tstamp.tv_usec = ts.bt_frac; 2595547d94bdSJung-uk Kim } 2596547d94bdSJung-uk Kim hdr32_old.bh_datalen = pktlen; 2597547d94bdSJung-uk Kim hdr32_old.bh_hdrlen = hdrlen; 2598547d94bdSJung-uk Kim hdr32_old.bh_caplen = caplen; 2599547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr32_old, 2600547d94bdSJung-uk Kim sizeof(hdr32_old)); 2601547d94bdSJung-uk Kim goto copy; 2602547d94bdSJung-uk Kim } 2603547d94bdSJung-uk Kim #endif 2604547d94bdSJung-uk Kim bzero(&hdr_old, sizeof(hdr_old)); 2605547d94bdSJung-uk Kim if (do_timestamp) { 2606547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_sec = ts.bt_sec; 2607547d94bdSJung-uk Kim hdr_old.bh_tstamp.tv_usec = ts.bt_frac; 2608547d94bdSJung-uk Kim } 2609547d94bdSJung-uk Kim hdr_old.bh_datalen = pktlen; 2610547d94bdSJung-uk Kim hdr_old.bh_hdrlen = hdrlen; 2611547d94bdSJung-uk Kim hdr_old.bh_caplen = caplen; 2612547d94bdSJung-uk Kim bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr_old, 2613547d94bdSJung-uk Kim sizeof(hdr_old)); 2614fc0a61a4SKonstantin Belousov goto copy; 2615fc0a61a4SKonstantin Belousov } 2616fc0a61a4SKonstantin Belousov #endif 2617df8bae1dSRodney W. Grimes 2618df8bae1dSRodney W. Grimes /* 26194d621040SChristian S.J. Peron * Append the bpf header. Note we append the actual header size, but 26204d621040SChristian S.J. Peron * move forward the length of the header plus padding. 2621df8bae1dSRodney W. Grimes */ 26224d621040SChristian S.J. Peron bzero(&hdr, sizeof(hdr)); 2623547d94bdSJung-uk Kim if (do_timestamp) 2624547d94bdSJung-uk Kim bpf_bintime2ts(bt, &hdr.bh_tstamp, tstype); 26254d621040SChristian S.J. Peron hdr.bh_datalen = pktlen; 26264d621040SChristian S.J. Peron hdr.bh_hdrlen = hdrlen; 2627547d94bdSJung-uk Kim hdr.bh_caplen = caplen; 26284d621040SChristian S.J. Peron bpf_append_bytes(d, d->bd_sbuf, curlen, &hdr, sizeof(hdr)); 26294d621040SChristian S.J. Peron 2630df8bae1dSRodney W. Grimes /* 2631df8bae1dSRodney W. Grimes * Copy the packet data into the store buffer and update its length. 2632df8bae1dSRodney W. Grimes */ 2633547d94bdSJung-uk Kim #ifndef BURN_BRIDGES 2634fc0a61a4SKonstantin Belousov copy: 2635fc0a61a4SKonstantin Belousov #endif 2636547d94bdSJung-uk Kim (*cpfn)(d, d->bd_sbuf, curlen + hdrlen, pkt, caplen); 2637df8bae1dSRodney W. Grimes d->bd_slen = curlen + totlen; 26387819da79SJohn-Mark Gurney 26397819da79SJohn-Mark Gurney if (do_wakeup) 26407819da79SJohn-Mark Gurney bpf_wakeup(d); 2641df8bae1dSRodney W. Grimes } 2642df8bae1dSRodney W. Grimes 2643df8bae1dSRodney W. Grimes /* 2644df8bae1dSRodney W. Grimes * Free buffers currently in use by a descriptor. 2645df8bae1dSRodney W. Grimes * Called on close. 2646df8bae1dSRodney W. Grimes */ 2647df8bae1dSRodney W. Grimes static void 2648699281b5SAndrey V. Elsukov bpfd_free(epoch_context_t ctx) 2649df8bae1dSRodney W. Grimes { 2650699281b5SAndrey V. Elsukov struct bpf_d *d; 2651699281b5SAndrey V. Elsukov struct bpf_program_buffer *p; 26524d621040SChristian S.J. Peron 2653df8bae1dSRodney W. Grimes /* 2654df8bae1dSRodney W. Grimes * We don't need to lock out interrupts since this descriptor has 2655df8bae1dSRodney W. Grimes * been detached from its interface and it yet hasn't been marked 2656df8bae1dSRodney W. Grimes * free. 2657df8bae1dSRodney W. Grimes */ 2658699281b5SAndrey V. Elsukov d = __containerof(ctx, struct bpf_d, epoch_ctx); 26594d621040SChristian S.J. Peron bpf_free(d); 266070485847SJung-uk Kim if (d->bd_rfilter != NULL) { 2661699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_rfilter, 2662699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2663af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2664af1f58dfSAndrey V. Elsukov p->func = d->bd_bfilter; 2665af1f58dfSAndrey V. Elsukov #endif 2666699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2667ae275efcSJung-uk Kim } 2668699281b5SAndrey V. Elsukov if (d->bd_wfilter != NULL) { 2669699281b5SAndrey V. Elsukov p = __containerof((void *)d->bd_wfilter, 2670699281b5SAndrey V. Elsukov struct bpf_program_buffer, buffer); 2671af1f58dfSAndrey V. Elsukov #ifdef BPF_JITTER 2672af1f58dfSAndrey V. Elsukov p->func = NULL; 2673af1f58dfSAndrey V. Elsukov #endif 2674699281b5SAndrey V. Elsukov bpf_program_buffer_free(&p->epoch_ctx); 2675699281b5SAndrey V. Elsukov } 2676b2b7ca49SAlexander V. Chernikov 2677699281b5SAndrey V. Elsukov mtx_destroy(&d->bd_lock); 2678b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_rcount); 2679b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_dcount); 2680b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_fcount); 2681b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wcount); 2682b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wfcount); 2683b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_wdcount); 2684b2b7ca49SAlexander V. Chernikov counter_u64_free(d->bd_zcopy); 2685699281b5SAndrey V. Elsukov free(d, M_BPF); 2686df8bae1dSRodney W. Grimes } 2687df8bae1dSRodney W. Grimes 2688df8bae1dSRodney W. Grimes /* 268924a229f4SSam Leffler * Attach an interface to bpf. dlt is the link layer type; hdrlen is the 269024a229f4SSam Leffler * fixed size of the link header (variable length headers not yet supported). 2691df8bae1dSRodney W. Grimes */ 2692df8bae1dSRodney W. Grimes void 269319ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 2694df8bae1dSRodney W. Grimes { 269524a229f4SSam Leffler 269624a229f4SSam Leffler bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 269724a229f4SSam Leffler } 269824a229f4SSam Leffler 269924a229f4SSam Leffler /* 270024a229f4SSam Leffler * Attach an interface to bpf. ifp is a pointer to the structure 270124a229f4SSam Leffler * defining the interface to be attached, dlt is the link layer type, 270224a229f4SSam Leffler * and hdrlen is the fixed size of the link header (variable length 270324a229f4SSam Leffler * headers are not yet supporrted). 270424a229f4SSam Leffler */ 270524a229f4SSam Leffler void 2706699281b5SAndrey V. Elsukov bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, 2707699281b5SAndrey V. Elsukov struct bpf_if **driverp) 270824a229f4SSam Leffler { 2709df8bae1dSRodney W. Grimes struct bpf_if *bp; 271019ba8395SChristian S.J. Peron 2711699281b5SAndrey V. Elsukov KASSERT(*driverp == NULL, 2712699281b5SAndrey V. Elsukov ("bpfattach2: driverp already initialized")); 2713df8bae1dSRodney W. Grimes 2714c5be49daSAndrey V. Elsukov bp = malloc(sizeof(*bp), M_BPF, M_WAITOK | M_ZERO); 2715c5be49daSAndrey V. Elsukov 2716699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_dlist); 2717699281b5SAndrey V. Elsukov CK_LIST_INIT(&bp->bif_wlist); 2718df8bae1dSRodney W. Grimes bp->bif_ifp = ifp; 2719df8bae1dSRodney W. Grimes bp->bif_dlt = dlt; 2720c5be49daSAndrey V. Elsukov bp->bif_hdrlen = hdrlen; 27219ce40d32SKristof Provost bp->bif_bpf = driverp; 2722699281b5SAndrey V. Elsukov bp->bif_refcnt = 1; 272316d878ccSChristian S.J. Peron *driverp = bp; 2724699281b5SAndrey V. Elsukov /* 2725699281b5SAndrey V. Elsukov * Reference ifnet pointer, so it won't freed until 2726699281b5SAndrey V. Elsukov * we release it. 2727699281b5SAndrey V. Elsukov */ 2728699281b5SAndrey V. Elsukov if_ref(ifp); 2729e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2730699281b5SAndrey V. Elsukov CK_LIST_INSERT_HEAD(&bpf_iflist, bp, bif_next); 2731e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 2732df8bae1dSRodney W. Grimes 2733616bc4f4SBjoern A. Zeeb if (bootverbose && IS_DEFAULT_VNET(curvnet)) 273424a229f4SSam Leffler if_printf(ifp, "bpf attached\n"); 2735df8bae1dSRodney W. Grimes } 273653ac6efbSJulian Elischer 273705fc4164SBjoern A. Zeeb #ifdef VIMAGE 273805fc4164SBjoern A. Zeeb /* 273905fc4164SBjoern A. Zeeb * When moving interfaces between vnet instances we need a way to 274005fc4164SBjoern A. Zeeb * query the dlt and hdrlen before detach so we can re-attch the if_bpf 274105fc4164SBjoern A. Zeeb * after the vmove. We unfortunately have no device driver infrastructure 274205fc4164SBjoern A. Zeeb * to query the interface for these values after creation/attach, thus 274305fc4164SBjoern A. Zeeb * add this as a workaround. 274405fc4164SBjoern A. Zeeb */ 274505fc4164SBjoern A. Zeeb int 274605fc4164SBjoern A. Zeeb bpf_get_bp_params(struct bpf_if *bp, u_int *bif_dlt, u_int *bif_hdrlen) 274705fc4164SBjoern A. Zeeb { 274805fc4164SBjoern A. Zeeb 274905fc4164SBjoern A. Zeeb if (bp == NULL) 275005fc4164SBjoern A. Zeeb return (ENXIO); 275105fc4164SBjoern A. Zeeb if (bif_dlt == NULL && bif_hdrlen == NULL) 275205fc4164SBjoern A. Zeeb return (0); 275305fc4164SBjoern A. Zeeb 275405fc4164SBjoern A. Zeeb if (bif_dlt != NULL) 275505fc4164SBjoern A. Zeeb *bif_dlt = bp->bif_dlt; 275605fc4164SBjoern A. Zeeb if (bif_hdrlen != NULL) 275705fc4164SBjoern A. Zeeb *bif_hdrlen = bp->bif_hdrlen; 275805fc4164SBjoern A. Zeeb 275905fc4164SBjoern A. Zeeb return (0); 276005fc4164SBjoern A. Zeeb } 276105fc4164SBjoern A. Zeeb #endif 276205fc4164SBjoern A. Zeeb 2763de5d9935SRobert Watson /* 2764de5d9935SRobert Watson * Detach bpf from an interface. This involves detaching each descriptor 27656c74ff0eSAlexander V. Chernikov * associated with the interface. Notify each descriptor as it's detached 27666c74ff0eSAlexander V. Chernikov * so that any sleepers wake up and get ENXIO. 2767de5d9935SRobert Watson */ 2768de5d9935SRobert Watson void 276919ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 2770de5d9935SRobert Watson { 2771f079a0faSAlexander V. Chernikov struct bpf_if *bp, *bp_temp; 2772de5d9935SRobert Watson struct bpf_d *d; 27739a7e6bacSLawrence Stewart 2774afa85850SAlexander V. Chernikov BPF_LOCK(); 27759a7e6bacSLawrence Stewart /* Find all bpf_if struct's which reference ifp and detach them. */ 2776699281b5SAndrey V. Elsukov CK_LIST_FOREACH_SAFE(bp, &bpf_iflist, bif_next, bp_temp) { 2777f079a0faSAlexander V. Chernikov if (ifp != bp->bif_ifp) 2778f079a0faSAlexander V. Chernikov continue; 2779de5d9935SRobert Watson 2780699281b5SAndrey V. Elsukov CK_LIST_REMOVE(bp, bif_next); 27818bd1f0cfSMark Johnston *bp->bif_bpf = (struct bpf_if *)&dead_bpf_if; 2782f079a0faSAlexander V. Chernikov 2783699281b5SAndrey V. Elsukov CTR4(KTR_NET, 2784699281b5SAndrey V. Elsukov "%s: sheduling free for encap %d (%p) for if %p", 2785f079a0faSAlexander V. Chernikov __func__, bp->bif_dlt, bp, ifp); 2786f079a0faSAlexander V. Chernikov 2787699281b5SAndrey V. Elsukov /* Detach common descriptors */ 2788699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_dlist)) != NULL) { 2789699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 2790e7bb21b3SJonathan Lemon } 2791f079a0faSAlexander V. Chernikov 2792699281b5SAndrey V. Elsukov /* Detach writer-only descriptors */ 2793699281b5SAndrey V. Elsukov while ((d = CK_LIST_FIRST(&bp->bif_wlist)) != NULL) { 2794699281b5SAndrey V. Elsukov bpf_detachd_locked(d, true); 27956c74ff0eSAlexander V. Chernikov } 2796699281b5SAndrey V. Elsukov bpfif_rele(bp); 2797f079a0faSAlexander V. Chernikov } 2798f079a0faSAlexander V. Chernikov BPF_UNLOCK(); 2799afa85850SAlexander V. Chernikov } 2800afa85850SAlexander V. Chernikov 2801afa85850SAlexander V. Chernikov /* 28028eab61f3SSam Leffler * Get a list of available data link type of the interface. 28038eab61f3SSam Leffler */ 28048eab61f3SSam Leffler static int 280519ba8395SChristian S.J. Peron bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl) 28068eab61f3SSam Leffler { 28078eab61f3SSam Leffler struct ifnet *ifp; 28088eab61f3SSam Leffler struct bpf_if *bp; 280970209acaSKonstantin Belousov u_int *lst; 281070209acaSKonstantin Belousov int error, n, n1; 28118eab61f3SSam Leffler 281297aacec6SAlexander V. Chernikov BPF_LOCK_ASSERT(); 281397aacec6SAlexander V. Chernikov 28148eab61f3SSam Leffler ifp = d->bd_bif->bif_ifp; 281570209acaSKonstantin Belousov n1 = 0; 2816699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 281770209acaSKonstantin Belousov if (bp->bif_ifp == ifp) 281870209acaSKonstantin Belousov n1++; 281970209acaSKonstantin Belousov } 282070209acaSKonstantin Belousov if (bfl->bfl_list == NULL) { 282170209acaSKonstantin Belousov bfl->bfl_len = n1; 282270209acaSKonstantin Belousov return (0); 282370209acaSKonstantin Belousov } 282470209acaSKonstantin Belousov if (n1 > bfl->bfl_len) 282570209acaSKonstantin Belousov return (ENOMEM); 2826699281b5SAndrey V. Elsukov 282770209acaSKonstantin Belousov lst = malloc(n1 * sizeof(u_int), M_TEMP, M_WAITOK); 28288eab61f3SSam Leffler n = 0; 2829699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 28308eab61f3SSam Leffler if (bp->bif_ifp != ifp) 28318eab61f3SSam Leffler continue; 2832699281b5SAndrey V. Elsukov lst[n++] = bp->bif_dlt; 28338eab61f3SSam Leffler } 283470209acaSKonstantin Belousov error = copyout(lst, bfl->bfl_list, sizeof(u_int) * n); 283570209acaSKonstantin Belousov free(lst, M_TEMP); 28368eab61f3SSam Leffler bfl->bfl_len = n; 28378eab61f3SSam Leffler return (error); 28388eab61f3SSam Leffler } 28398eab61f3SSam Leffler 28408eab61f3SSam Leffler /* 28418eab61f3SSam Leffler * Set the data link type of a BPF instance. 28428eab61f3SSam Leffler */ 28438eab61f3SSam Leffler static int 284419ba8395SChristian S.J. Peron bpf_setdlt(struct bpf_d *d, u_int dlt) 28458eab61f3SSam Leffler { 28468eab61f3SSam Leffler int error, opromisc; 28478eab61f3SSam Leffler struct ifnet *ifp; 28488eab61f3SSam Leffler struct bpf_if *bp; 28498eab61f3SSam Leffler 28506c74ff0eSAlexander V. Chernikov BPF_LOCK_ASSERT(); 2851699281b5SAndrey V. Elsukov MPASS(d->bd_bif != NULL); 28526c74ff0eSAlexander V. Chernikov 2853699281b5SAndrey V. Elsukov /* 2854699281b5SAndrey V. Elsukov * It is safe to check bd_bif without BPFD_LOCK, it can not be 2855699281b5SAndrey V. Elsukov * changed while we hold global lock. 2856699281b5SAndrey V. Elsukov */ 28578eab61f3SSam Leffler if (d->bd_bif->bif_dlt == dlt) 28588eab61f3SSam Leffler return (0); 28596c74ff0eSAlexander V. Chernikov 2860699281b5SAndrey V. Elsukov ifp = d->bd_bif->bif_ifp; 2861699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 28628eab61f3SSam Leffler if (bp->bif_ifp == ifp && bp->bif_dlt == dlt) 28638eab61f3SSam Leffler break; 28648eab61f3SSam Leffler } 2865699281b5SAndrey V. Elsukov if (bp == NULL) 2866699281b5SAndrey V. Elsukov return (EINVAL); 28676c74ff0eSAlexander V. Chernikov 28688eab61f3SSam Leffler opromisc = d->bd_promisc; 28698eab61f3SSam Leffler bpf_attachd(d, bp); 28708eab61f3SSam Leffler if (opromisc) { 28718eab61f3SSam Leffler error = ifpromisc(bp->bif_ifp, 1); 28728eab61f3SSam Leffler if (error) 2873699281b5SAndrey V. Elsukov if_printf(bp->bif_ifp, "%s: ifpromisc failed (%d)\n", 2874699281b5SAndrey V. Elsukov __func__, error); 28758eab61f3SSam Leffler else 28768eab61f3SSam Leffler d->bd_promisc = 1; 28778eab61f3SSam Leffler } 2878699281b5SAndrey V. Elsukov return (0); 2879de5d9935SRobert Watson } 2880de5d9935SRobert Watson 28813f54a085SPoul-Henning Kamp static void 288219ba8395SChristian S.J. Peron bpf_drvinit(void *unused) 288353ac6efbSJulian Elischer { 2884136600feSEd Schouten struct cdev *dev; 288553ac6efbSJulian Elischer 2886f422673eSStephen Hurd sx_init(&bpf_sx, "bpf global lock"); 2887699281b5SAndrey V. Elsukov CK_LIST_INIT(&bpf_iflist); 2888136600feSEd Schouten 2889136600feSEd Schouten dev = make_dev(&bpf_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "bpf"); 2890136600feSEd Schouten /* For compatibility */ 2891136600feSEd Schouten make_dev_alias(dev, "bpf0"); 28927198bf47SJulian Elischer } 289353ac6efbSJulian Elischer 28940e37f3e1SChristian S.J. Peron /* 28950e37f3e1SChristian S.J. Peron * Zero out the various packet counters associated with all of the bpf 28960e37f3e1SChristian S.J. Peron * descriptors. At some point, we will probably want to get a bit more 28970e37f3e1SChristian S.J. Peron * granular and allow the user to specify descriptors to be zeroed. 28980e37f3e1SChristian S.J. Peron */ 28990e37f3e1SChristian S.J. Peron static void 29000e37f3e1SChristian S.J. Peron bpf_zero_counters(void) 29010e37f3e1SChristian S.J. Peron { 29020e37f3e1SChristian S.J. Peron struct bpf_if *bp; 29030e37f3e1SChristian S.J. Peron struct bpf_d *bd; 29040e37f3e1SChristian S.J. Peron 2905e4b3229aSAlexander V. Chernikov BPF_LOCK(); 2906699281b5SAndrey V. Elsukov /* 2907699281b5SAndrey V. Elsukov * We are protected by global lock here, interfaces and 2908699281b5SAndrey V. Elsukov * descriptors can not be deleted while we hold it. 2909699281b5SAndrey V. Elsukov */ 2910699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 2911699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 2912b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_rcount); 2913b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_dcount); 2914b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_fcount); 2915b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wcount); 2916b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_wfcount); 2917b2b7ca49SAlexander V. Chernikov counter_u64_zero(bd->bd_zcopy); 29180e37f3e1SChristian S.J. Peron } 29190e37f3e1SChristian S.J. Peron } 2920e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 29210e37f3e1SChristian S.J. Peron } 29220e37f3e1SChristian S.J. Peron 29236c74ff0eSAlexander V. Chernikov /* 29246c74ff0eSAlexander V. Chernikov * Fill filter statistics 29256c74ff0eSAlexander V. Chernikov */ 292669f7644bSChristian S.J. Peron static void 292769f7644bSChristian S.J. Peron bpfstats_fill_xbpf(struct xbpf_d *d, struct bpf_d *bd) 292869f7644bSChristian S.J. Peron { 292969f7644bSChristian S.J. Peron 2930699281b5SAndrey V. Elsukov BPF_LOCK_ASSERT(); 293169f7644bSChristian S.J. Peron bzero(d, sizeof(*d)); 29324d621040SChristian S.J. Peron d->bd_structsize = sizeof(*d); 293369f7644bSChristian S.J. Peron d->bd_immediate = bd->bd_immediate; 293469f7644bSChristian S.J. Peron d->bd_promisc = bd->bd_promisc; 293569f7644bSChristian S.J. Peron d->bd_hdrcmplt = bd->bd_hdrcmplt; 2936560a54e1SJung-uk Kim d->bd_direction = bd->bd_direction; 2937560a54e1SJung-uk Kim d->bd_feedback = bd->bd_feedback; 293869f7644bSChristian S.J. Peron d->bd_async = bd->bd_async; 2939b2b7ca49SAlexander V. Chernikov d->bd_rcount = counter_u64_fetch(bd->bd_rcount); 2940b2b7ca49SAlexander V. Chernikov d->bd_dcount = counter_u64_fetch(bd->bd_dcount); 2941b2b7ca49SAlexander V. Chernikov d->bd_fcount = counter_u64_fetch(bd->bd_fcount); 294269f7644bSChristian S.J. Peron d->bd_sig = bd->bd_sig; 294369f7644bSChristian S.J. Peron d->bd_slen = bd->bd_slen; 294469f7644bSChristian S.J. Peron d->bd_hlen = bd->bd_hlen; 294569f7644bSChristian S.J. Peron d->bd_bufsize = bd->bd_bufsize; 294669f7644bSChristian S.J. Peron d->bd_pid = bd->bd_pid; 294769f7644bSChristian S.J. Peron strlcpy(d->bd_ifname, 294869f7644bSChristian S.J. Peron bd->bd_bif->bif_ifp->if_xname, IFNAMSIZ); 294993e39f0bSChristian S.J. Peron d->bd_locked = bd->bd_locked; 2950b2b7ca49SAlexander V. Chernikov d->bd_wcount = counter_u64_fetch(bd->bd_wcount); 2951b2b7ca49SAlexander V. Chernikov d->bd_wdcount = counter_u64_fetch(bd->bd_wdcount); 2952b2b7ca49SAlexander V. Chernikov d->bd_wfcount = counter_u64_fetch(bd->bd_wfcount); 2953b2b7ca49SAlexander V. Chernikov d->bd_zcopy = counter_u64_fetch(bd->bd_zcopy); 29544d621040SChristian S.J. Peron d->bd_bufmode = bd->bd_bufmode; 295569f7644bSChristian S.J. Peron } 295669f7644bSChristian S.J. Peron 29576c74ff0eSAlexander V. Chernikov /* 29586c74ff0eSAlexander V. Chernikov * Handle `netstat -B' stats request 29596c74ff0eSAlexander V. Chernikov */ 296069f7644bSChristian S.J. Peron static int 296169f7644bSChristian S.J. Peron bpf_stats_sysctl(SYSCTL_HANDLER_ARGS) 296269f7644bSChristian S.J. Peron { 29630e1152fcSHans Petter Selasky static const struct xbpf_d zerostats; 29640e1152fcSHans Petter Selasky struct xbpf_d *xbdbuf, *xbd, tempstats; 2965422a63daSChristian S.J. Peron int index, error; 296669f7644bSChristian S.J. Peron struct bpf_if *bp; 296769f7644bSChristian S.J. Peron struct bpf_d *bd; 296869f7644bSChristian S.J. Peron 296969f7644bSChristian S.J. Peron /* 297069f7644bSChristian S.J. Peron * XXX This is not technically correct. It is possible for non 297169f7644bSChristian S.J. Peron * privileged users to open bpf devices. It would make sense 297269f7644bSChristian S.J. Peron * if the users who opened the devices were able to retrieve 297369f7644bSChristian S.J. Peron * the statistics for them, too. 297469f7644bSChristian S.J. Peron */ 2975acd3428bSRobert Watson error = priv_check(req->td, PRIV_NET_BPF); 297669f7644bSChristian S.J. Peron if (error) 297769f7644bSChristian S.J. Peron return (error); 29780e37f3e1SChristian S.J. Peron /* 29790e37f3e1SChristian S.J. Peron * Check to see if the user is requesting that the counters be 29800e37f3e1SChristian S.J. Peron * zeroed out. Explicitly check that the supplied data is zeroed, 29810e37f3e1SChristian S.J. Peron * as we aren't allowing the user to set the counters currently. 29820e37f3e1SChristian S.J. Peron */ 29830e37f3e1SChristian S.J. Peron if (req->newptr != NULL) { 29840e1152fcSHans Petter Selasky if (req->newlen != sizeof(tempstats)) 29850e37f3e1SChristian S.J. Peron return (EINVAL); 29860e1152fcSHans Petter Selasky memset(&tempstats, 0, sizeof(tempstats)); 29870e1152fcSHans Petter Selasky error = SYSCTL_IN(req, &tempstats, sizeof(tempstats)); 29880e1152fcSHans Petter Selasky if (error) 29890e1152fcSHans Petter Selasky return (error); 29900e1152fcSHans Petter Selasky if (bcmp(&tempstats, &zerostats, sizeof(tempstats)) != 0) 29910e37f3e1SChristian S.J. Peron return (EINVAL); 29920e37f3e1SChristian S.J. Peron bpf_zero_counters(); 29930e37f3e1SChristian S.J. Peron return (0); 29940e37f3e1SChristian S.J. Peron } 299569f7644bSChristian S.J. Peron if (req->oldptr == NULL) 2996422a63daSChristian S.J. Peron return (SYSCTL_OUT(req, 0, bpf_bpfd_cnt * sizeof(*xbd))); 299769f7644bSChristian S.J. Peron if (bpf_bpfd_cnt == 0) 299869f7644bSChristian S.J. Peron return (SYSCTL_OUT(req, 0, 0)); 2999422a63daSChristian S.J. Peron xbdbuf = malloc(req->oldlen, M_BPF, M_WAITOK); 3000e4b3229aSAlexander V. Chernikov BPF_LOCK(); 3001422a63daSChristian S.J. Peron if (req->oldlen < (bpf_bpfd_cnt * sizeof(*xbd))) { 3002e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3003422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 3004422a63daSChristian S.J. Peron return (ENOMEM); 3005422a63daSChristian S.J. Peron } 3006422a63daSChristian S.J. Peron index = 0; 3007699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bp, &bpf_iflist, bif_next) { 300851ec1eb7SAlexander V. Chernikov /* Send writers-only first */ 3009699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_wlist, bd_next) { 301051ec1eb7SAlexander V. Chernikov xbd = &xbdbuf[index++]; 301151ec1eb7SAlexander V. Chernikov bpfstats_fill_xbpf(xbd, bd); 301251ec1eb7SAlexander V. Chernikov } 3013699281b5SAndrey V. Elsukov CK_LIST_FOREACH(bd, &bp->bif_dlist, bd_next) { 3014422a63daSChristian S.J. Peron xbd = &xbdbuf[index++]; 3015422a63daSChristian S.J. Peron bpfstats_fill_xbpf(xbd, bd); 301669f7644bSChristian S.J. Peron } 301769f7644bSChristian S.J. Peron } 3018e4b3229aSAlexander V. Chernikov BPF_UNLOCK(); 3019422a63daSChristian S.J. Peron error = SYSCTL_OUT(req, xbdbuf, index * sizeof(*xbd)); 3020422a63daSChristian S.J. Peron free(xbdbuf, M_BPF); 302169f7644bSChristian S.J. Peron return (error); 302269f7644bSChristian S.J. Peron } 302369f7644bSChristian S.J. Peron 3024237fdd78SRobert Watson SYSINIT(bpfdev,SI_SUB_DRIVERS,SI_ORDER_MIDDLE,bpf_drvinit,NULL); 302553ac6efbSJulian Elischer 30265bb5f2c9SPeter Wemm #else /* !DEV_BPF && !NETGRAPH_BPF */ 30278bd1f0cfSMark Johnston 3028f8dc4716SMike Smith /* 3029f8dc4716SMike Smith * NOP stubs to allow bpf-using drivers to load and function. 3030f8dc4716SMike Smith * 3031f8dc4716SMike Smith * A 'better' implementation would allow the core bpf functionality 3032f8dc4716SMike Smith * to be loaded at runtime. 3033f8dc4716SMike Smith */ 3034f8dc4716SMike Smith 3035f8dc4716SMike Smith void 303619ba8395SChristian S.J. Peron bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen) 3037f8dc4716SMike Smith { 3038f8dc4716SMike Smith } 3039f8dc4716SMike Smith 3040f8dc4716SMike Smith void 304119ba8395SChristian S.J. Peron bpf_mtap(struct bpf_if *bp, struct mbuf *m) 3042f8dc4716SMike Smith { 3043f8dc4716SMike Smith } 3044f8dc4716SMike Smith 3045f8dc4716SMike Smith void 304619ba8395SChristian S.J. Peron bpf_mtap2(struct bpf_if *bp, void *d, u_int l, struct mbuf *m) 3047437ffe18SSam Leffler { 3048437ffe18SSam Leffler } 3049437ffe18SSam Leffler 3050437ffe18SSam Leffler void 305119ba8395SChristian S.J. Peron bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen) 3052f8dc4716SMike Smith { 30537eae78a4SChristian S.J. Peron 30547eae78a4SChristian S.J. Peron bpfattach2(ifp, dlt, hdrlen, &ifp->if_bpf); 3055f8dc4716SMike Smith } 3056f8dc4716SMike Smith 3057da626c17SBill Paul void 305819ba8395SChristian S.J. Peron bpfattach2(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp) 30595f7a7923SSam Leffler { 30607eae78a4SChristian S.J. Peron 30618bd1f0cfSMark Johnston *driverp = (struct bpf_if *)&dead_bpf_if; 30625f7a7923SSam Leffler } 30635f7a7923SSam Leffler 30645f7a7923SSam Leffler void 306519ba8395SChristian S.J. Peron bpfdetach(struct ifnet *ifp) 3066da626c17SBill Paul { 3067da626c17SBill Paul } 3068da626c17SBill Paul 3069f8dc4716SMike Smith u_int 307019ba8395SChristian S.J. Peron bpf_filter(const struct bpf_insn *pc, u_char *p, u_int wirelen, u_int buflen) 3071f8dc4716SMike Smith { 3072f8dc4716SMike Smith return -1; /* "no filter" behaviour */ 3073f8dc4716SMike Smith } 3074f8dc4716SMike Smith 30755bb5f2c9SPeter Wemm int 307619ba8395SChristian S.J. Peron bpf_validate(const struct bpf_insn *f, int len) 30775bb5f2c9SPeter Wemm { 30785bb5f2c9SPeter Wemm return 0; /* false */ 30795bb5f2c9SPeter Wemm } 30805bb5f2c9SPeter Wemm 30815bb5f2c9SPeter Wemm #endif /* !DEV_BPF && !NETGRAPH_BPF */ 308205fc4164SBjoern A. Zeeb 308305fc4164SBjoern A. Zeeb #ifdef DDB 308405fc4164SBjoern A. Zeeb static void 308505fc4164SBjoern A. Zeeb bpf_show_bpf_if(struct bpf_if *bpf_if) 308605fc4164SBjoern A. Zeeb { 308705fc4164SBjoern A. Zeeb 308805fc4164SBjoern A. Zeeb if (bpf_if == NULL) 308905fc4164SBjoern A. Zeeb return; 309005fc4164SBjoern A. Zeeb db_printf("%p:\n", bpf_if); 309105fc4164SBjoern A. Zeeb #define BPF_DB_PRINTF(f, e) db_printf(" %s = " f "\n", #e, bpf_if->e); 309205fc4164SBjoern A. Zeeb /* bif_ext.bif_next */ 309305fc4164SBjoern A. Zeeb /* bif_ext.bif_dlist */ 309405fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%#x", bif_dlt); 309505fc4164SBjoern A. Zeeb BPF_DB_PRINTF("%u", bif_hdrlen); 309605fc4164SBjoern A. Zeeb /* bif_wlist */ 3097699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_ifp); 3098699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%p", bif_bpf); 3099699281b5SAndrey V. Elsukov BPF_DB_PRINTF("%u", bif_refcnt); 310005fc4164SBjoern A. Zeeb } 310105fc4164SBjoern A. Zeeb 310205fc4164SBjoern A. Zeeb DB_SHOW_COMMAND(bpf_if, db_show_bpf_if) 310305fc4164SBjoern A. Zeeb { 310405fc4164SBjoern A. Zeeb 310505fc4164SBjoern A. Zeeb if (!have_addr) { 310605fc4164SBjoern A. Zeeb db_printf("usage: show bpf_if <struct bpf_if *>\n"); 310705fc4164SBjoern A. Zeeb return; 310805fc4164SBjoern A. Zeeb } 310905fc4164SBjoern A. Zeeb 311005fc4164SBjoern A. Zeeb bpf_show_bpf_if((struct bpf_if *)addr); 311105fc4164SBjoern A. Zeeb } 311205fc4164SBjoern A. Zeeb #endif 3113