bpf.c revision 1.223 1 1.223 ozaki /* $NetBSD: bpf.c,v 1.223 2018/01/25 02:45:02 ozaki-r Exp $ */
2 1.13 cgd
3 1.12 mycroft /*
4 1.12 mycroft * Copyright (c) 1990, 1991, 1993
5 1.12 mycroft * The Regents of the University of California. All rights reserved.
6 1.1 cgd *
7 1.1 cgd * This code is derived from the Stanford/CMU enet packet filter,
8 1.1 cgd * (net/enet.c) distributed as part of 4.3BSD, and code contributed
9 1.36 christos * to Berkeley by Steven McCanne and Van Jacobson both of Lawrence
10 1.2 cgd * Berkeley Laboratory.
11 1.1 cgd *
12 1.1 cgd * Redistribution and use in source and binary forms, with or without
13 1.1 cgd * modification, are permitted provided that the following conditions
14 1.1 cgd * are met:
15 1.1 cgd * 1. Redistributions of source code must retain the above copyright
16 1.1 cgd * notice, this list of conditions and the following disclaimer.
17 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 cgd * notice, this list of conditions and the following disclaimer in the
19 1.1 cgd * documentation and/or other materials provided with the distribution.
20 1.83 agc * 3. Neither the name of the University nor the names of its contributors
21 1.1 cgd * may be used to endorse or promote products derived from this software
22 1.1 cgd * without specific prior written permission.
23 1.1 cgd *
24 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
25 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
28 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 1.1 cgd * SUCH DAMAGE.
35 1.1 cgd *
36 1.39 fvdl * @(#)bpf.c 8.4 (Berkeley) 1/9/95
37 1.36 christos * static char rcsid[] =
38 1.36 christos * "Header: bpf.c,v 1.67 96/09/26 22:00:52 leres Exp ";
39 1.1 cgd */
40 1.63 lukem
41 1.63 lukem #include <sys/cdefs.h>
42 1.223 ozaki __KERNEL_RCSID(0, "$NetBSD: bpf.c,v 1.223 2018/01/25 02:45:02 ozaki-r Exp $");
43 1.127 christos
44 1.127 christos #if defined(_KERNEL_OPT)
45 1.127 christos #include "opt_bpf.h"
46 1.127 christos #include "sl.h"
47 1.127 christos #include "strip.h"
48 1.205 ozaki #include "opt_net_mpsafe.h"
49 1.127 christos #endif
50 1.1 cgd
51 1.1 cgd #include <sys/param.h>
52 1.1 cgd #include <sys/systm.h>
53 1.1 cgd #include <sys/mbuf.h>
54 1.1 cgd #include <sys/buf.h>
55 1.12 mycroft #include <sys/time.h>
56 1.1 cgd #include <sys/proc.h>
57 1.1 cgd #include <sys/ioctl.h>
58 1.25 christos #include <sys/conf.h>
59 1.51 enami #include <sys/vnode.h>
60 1.105 christos #include <sys/queue.h>
61 1.145 christos #include <sys/stat.h>
62 1.154 pooka #include <sys/module.h>
63 1.155 pooka #include <sys/atomic.h>
64 1.205 ozaki #include <sys/cpu.h>
65 1.11 deraadt
66 1.1 cgd #include <sys/file.h>
67 1.105 christos #include <sys/filedesc.h>
68 1.1 cgd #include <sys/tty.h>
69 1.1 cgd #include <sys/uio.h>
70 1.11 deraadt
71 1.1 cgd #include <sys/protosw.h>
72 1.1 cgd #include <sys/socket.h>
73 1.30 mycroft #include <sys/errno.h>
74 1.30 mycroft #include <sys/kernel.h>
75 1.30 mycroft #include <sys/poll.h>
76 1.89 jonathan #include <sys/sysctl.h>
77 1.117 elad #include <sys/kauth.h>
78 1.205 ozaki #include <sys/syslog.h>
79 1.210 ozaki #include <sys/percpu.h>
80 1.213 ozaki #include <sys/pserialize.h>
81 1.213 ozaki #include <sys/lwp.h>
82 1.30 mycroft
83 1.11 deraadt #include <net/if.h>
84 1.104 christos #include <net/slip.h>
85 1.8 mycroft
86 1.1 cgd #include <net/bpf.h>
87 1.1 cgd #include <net/bpfdesc.h>
88 1.173 alnsn #include <net/bpfjit.h>
89 1.1 cgd
90 1.35 scottr #include <net/if_arc.h>
91 1.34 is #include <net/if_ether.h>
92 1.34 is
93 1.12 mycroft #include <netinet/in.h>
94 1.34 is #include <netinet/if_inarp.h>
95 1.65 wrstuden
96 1.127 christos
97 1.127 christos #include <compat/sys/sockio.h>
98 1.11 deraadt
99 1.55 jonathan #ifndef BPF_BUFSIZE
100 1.87 jonathan /*
101 1.87 jonathan * 4096 is too small for FDDI frames. 8192 is too small for gigabit Ethernet
102 1.87 jonathan * jumbos (circa 9k), ATM, or Intel gig/10gig ethernet jumbos (16k).
103 1.87 jonathan */
104 1.87 jonathan # define BPF_BUFSIZE 32768
105 1.55 jonathan #endif
106 1.1 cgd
107 1.12 mycroft #define PRINET 26 /* interruptible */
108 1.2 cgd
109 1.1 cgd /*
110 1.89 jonathan * The default read buffer size, and limit for BIOCSBLEN, is sysctl'able.
111 1.89 jonathan * XXX the default values should be computed dynamically based
112 1.89 jonathan * on available memory size and available mbuf clusters.
113 1.1 cgd */
114 1.207 ozaki static int bpf_bufsize = BPF_BUFSIZE;
115 1.207 ozaki static int bpf_maxbufsize = BPF_DFLTBUFSIZE; /* XXX set dynamically, see above */
116 1.207 ozaki static bool bpf_jit = false;
117 1.173 alnsn
118 1.173 alnsn struct bpfjit_ops bpfjit_module_ops = {
119 1.173 alnsn .bj_generate_code = NULL,
120 1.173 alnsn .bj_free_code = NULL
121 1.173 alnsn };
122 1.1 cgd
123 1.110 rpaulo /*
124 1.110 rpaulo * Global BPF statistics returned by net.bpf.stats sysctl.
125 1.110 rpaulo */
126 1.210 ozaki static struct percpu *bpf_gstats_percpu; /* struct bpf_stat */
127 1.210 ozaki
128 1.210 ozaki #define BPF_STATINC(id) \
129 1.210 ozaki { \
130 1.210 ozaki struct bpf_stat *__stats = \
131 1.210 ozaki percpu_getref(bpf_gstats_percpu); \
132 1.210 ozaki __stats->bs_##id++; \
133 1.210 ozaki percpu_putref(bpf_gstats_percpu); \
134 1.210 ozaki }
135 1.110 rpaulo
136 1.110 rpaulo /*
137 1.213 ozaki * Locking notes:
138 1.213 ozaki * - bpf_mtx (adaptive mutex) protects:
139 1.213 ozaki * - Gobal lists: bpf_iflist and bpf_dlist
140 1.213 ozaki * - struct bpf_if
141 1.213 ozaki * - bpf_close
142 1.213 ozaki * - bpf_psz (pserialize)
143 1.213 ozaki * - struct bpf_d has two mutexes:
144 1.213 ozaki * - bd_buf_mtx (spin mutex) protects the buffers that can be accessed
145 1.213 ozaki * on packet tapping
146 1.213 ozaki * - bd_mtx (adaptive mutex) protects member variables other than the buffers
147 1.213 ozaki * - Locking order: bpf_mtx => bpf_d#bd_mtx => bpf_d#bd_buf_mtx
148 1.213 ozaki * - struct bpf_d obtained via fp->f_bpf in bpf_read and bpf_write is
149 1.213 ozaki * never freed because struct bpf_d is only freed in bpf_close and
150 1.213 ozaki * bpf_close never be called while executing bpf_read and bpf_write
151 1.213 ozaki * - A filter that is assigned to bpf_d can be replaced with another filter
152 1.213 ozaki * while tapping packets, so it needs to be done atomically
153 1.213 ozaki * - struct bpf_d is iterated on bpf_dlist with psz
154 1.213 ozaki * - struct bpf_if is iterated on bpf_iflist with psz or psref
155 1.213 ozaki */
156 1.213 ozaki /*
157 1.110 rpaulo * Use a mutex to avoid a race condition between gathering the stats/peers
158 1.110 rpaulo * and opening/closing the device.
159 1.110 rpaulo */
160 1.130 xtraeme static kmutex_t bpf_mtx;
161 1.110 rpaulo
162 1.213 ozaki static struct psref_class *bpf_psref_class __read_mostly;
163 1.213 ozaki static pserialize_t bpf_psz;
164 1.213 ozaki
165 1.213 ozaki static inline void
166 1.213 ozaki bpf_if_acquire(struct bpf_if *bp, struct psref *psref)
167 1.213 ozaki {
168 1.213 ozaki
169 1.213 ozaki psref_acquire(psref, &bp->bif_psref, bpf_psref_class);
170 1.213 ozaki }
171 1.213 ozaki
172 1.213 ozaki static inline void
173 1.213 ozaki bpf_if_release(struct bpf_if *bp, struct psref *psref)
174 1.213 ozaki {
175 1.213 ozaki
176 1.213 ozaki psref_release(psref, &bp->bif_psref, bpf_psref_class);
177 1.213 ozaki }
178 1.213 ozaki
179 1.1 cgd /*
180 1.1 cgd * bpf_iflist is the list of interfaces; each corresponds to an ifnet
181 1.1 cgd * bpf_dtab holds the descriptors, indexed by minor device #
182 1.1 cgd */
183 1.209 ozaki static struct pslist_head bpf_iflist;
184 1.209 ozaki static struct pslist_head bpf_dlist;
185 1.209 ozaki
186 1.209 ozaki /* Macros for bpf_d on bpf_dlist */
187 1.215 christos #define BPF_DLIST_WRITER_INSERT_HEAD(__d) \
188 1.209 ozaki PSLIST_WRITER_INSERT_HEAD(&bpf_dlist, (__d), bd_bpf_dlist_entry)
189 1.209 ozaki #define BPF_DLIST_READER_FOREACH(__d) \
190 1.209 ozaki PSLIST_READER_FOREACH((__d), &bpf_dlist, struct bpf_d, \
191 1.209 ozaki bd_bpf_dlist_entry)
192 1.209 ozaki #define BPF_DLIST_WRITER_FOREACH(__d) \
193 1.209 ozaki PSLIST_WRITER_FOREACH((__d), &bpf_dlist, struct bpf_d, \
194 1.209 ozaki bd_bpf_dlist_entry)
195 1.209 ozaki #define BPF_DLIST_ENTRY_INIT(__d) \
196 1.209 ozaki PSLIST_ENTRY_INIT((__d), bd_bpf_dlist_entry)
197 1.209 ozaki #define BPF_DLIST_WRITER_REMOVE(__d) \
198 1.209 ozaki PSLIST_WRITER_REMOVE((__d), bd_bpf_dlist_entry)
199 1.209 ozaki #define BPF_DLIST_ENTRY_DESTROY(__d) \
200 1.209 ozaki PSLIST_ENTRY_DESTROY((__d), bd_bpf_dlist_entry)
201 1.209 ozaki
202 1.209 ozaki /* Macros for bpf_if on bpf_iflist */
203 1.209 ozaki #define BPF_IFLIST_WRITER_INSERT_HEAD(__bp) \
204 1.209 ozaki PSLIST_WRITER_INSERT_HEAD(&bpf_iflist, (__bp), bif_iflist_entry)
205 1.209 ozaki #define BPF_IFLIST_READER_FOREACH(__bp) \
206 1.209 ozaki PSLIST_READER_FOREACH((__bp), &bpf_iflist, struct bpf_if, \
207 1.209 ozaki bif_iflist_entry)
208 1.209 ozaki #define BPF_IFLIST_WRITER_FOREACH(__bp) \
209 1.209 ozaki PSLIST_WRITER_FOREACH((__bp), &bpf_iflist, struct bpf_if, \
210 1.209 ozaki bif_iflist_entry)
211 1.209 ozaki #define BPF_IFLIST_WRITER_REMOVE(__bp) \
212 1.209 ozaki PSLIST_WRITER_REMOVE((__bp), bif_iflist_entry)
213 1.209 ozaki #define BPF_IFLIST_ENTRY_INIT(__bp) \
214 1.209 ozaki PSLIST_ENTRY_INIT((__bp), bif_iflist_entry)
215 1.209 ozaki #define BPF_IFLIST_ENTRY_DESTROY(__bp) \
216 1.209 ozaki PSLIST_ENTRY_DESTROY((__bp), bif_iflist_entry)
217 1.209 ozaki
218 1.209 ozaki /* Macros for bpf_d on bpf_if#bif_dlist_pslist */
219 1.209 ozaki #define BPFIF_DLIST_READER_FOREACH(__d, __bp) \
220 1.209 ozaki PSLIST_READER_FOREACH((__d), &(__bp)->bif_dlist_head, struct bpf_d, \
221 1.209 ozaki bd_bif_dlist_entry)
222 1.209 ozaki #define BPFIF_DLIST_WRITER_INSERT_HEAD(__bp, __d) \
223 1.209 ozaki PSLIST_WRITER_INSERT_HEAD(&(__bp)->bif_dlist_head, (__d), \
224 1.209 ozaki bd_bif_dlist_entry)
225 1.209 ozaki #define BPFIF_DLIST_WRITER_REMOVE(__d) \
226 1.209 ozaki PSLIST_WRITER_REMOVE((__d), bd_bif_dlist_entry)
227 1.209 ozaki #define BPFIF_DLIST_ENTRY_INIT(__d) \
228 1.209 ozaki PSLIST_ENTRY_INIT((__d), bd_bif_dlist_entry)
229 1.209 ozaki #define BPFIF_DLIST_READER_EMPTY(__bp) \
230 1.209 ozaki (PSLIST_READER_FIRST(&(__bp)->bif_dlist_head, struct bpf_d, \
231 1.209 ozaki bd_bif_dlist_entry) == NULL)
232 1.209 ozaki #define BPFIF_DLIST_WRITER_EMPTY(__bp) \
233 1.209 ozaki (PSLIST_WRITER_FIRST(&(__bp)->bif_dlist_head, struct bpf_d, \
234 1.209 ozaki bd_bif_dlist_entry) == NULL)
235 1.209 ozaki #define BPFIF_DLIST_ENTRY_DESTROY(__d) \
236 1.209 ozaki PSLIST_ENTRY_DESTROY((__d), bd_bif_dlist_entry)
237 1.1 cgd
238 1.103 christos static int bpf_allocbufs(struct bpf_d *);
239 1.101 dyoung static void bpf_deliver(struct bpf_if *,
240 1.137 christos void *(*cpfn)(void *, const void *, size_t),
241 1.169 rmind void *, u_int, u_int, const bool);
242 1.103 christos static void bpf_freed(struct bpf_d *);
243 1.213 ozaki static void bpf_free_filter(struct bpf_filter *);
244 1.103 christos static void bpf_ifname(struct ifnet *, struct ifreq *);
245 1.137 christos static void *bpf_mcpy(void *, const void *, size_t);
246 1.160 christos static int bpf_movein(struct uio *, int, uint64_t,
247 1.103 christos struct mbuf **, struct sockaddr *);
248 1.103 christos static void bpf_attachd(struct bpf_d *, struct bpf_if *);
249 1.103 christos static void bpf_detachd(struct bpf_d *);
250 1.103 christos static int bpf_setif(struct bpf_d *, struct ifreq *);
251 1.204 ozaki static int bpf_setf(struct bpf_d *, struct bpf_program *);
252 1.103 christos static void bpf_timed_out(void *);
253 1.114 perry static inline void
254 1.103 christos bpf_wakeup(struct bpf_d *);
255 1.166 bouyer static int bpf_hdrlen(struct bpf_d *);
256 1.103 christos static void catchpacket(struct bpf_d *, u_char *, u_int, u_int,
257 1.142 christos void *(*)(void *, const void *, size_t), struct timespec *);
258 1.103 christos static void reset_d(struct bpf_d *);
259 1.103 christos static int bpf_getdltlist(struct bpf_d *, struct bpf_dltlist *);
260 1.103 christos static int bpf_setdlt(struct bpf_d *, u_int);
261 1.12 mycroft
262 1.117 elad static int bpf_read(struct file *, off_t *, struct uio *, kauth_cred_t,
263 1.105 christos int);
264 1.117 elad static int bpf_write(struct file *, off_t *, struct uio *, kauth_cred_t,
265 1.105 christos int);
266 1.135 ad static int bpf_ioctl(struct file *, u_long, void *);
267 1.135 ad static int bpf_poll(struct file *, int);
268 1.145 christos static int bpf_stat(struct file *, struct stat *);
269 1.135 ad static int bpf_close(struct file *);
270 1.105 christos static int bpf_kqfilter(struct file *, struct knote *);
271 1.105 christos
272 1.105 christos static const struct fileops bpf_fileops = {
273 1.220 christos .fo_name = "bpf",
274 1.144 ad .fo_read = bpf_read,
275 1.144 ad .fo_write = bpf_write,
276 1.144 ad .fo_ioctl = bpf_ioctl,
277 1.144 ad .fo_fcntl = fnullop_fcntl,
278 1.144 ad .fo_poll = bpf_poll,
279 1.145 christos .fo_stat = bpf_stat,
280 1.144 ad .fo_close = bpf_close,
281 1.144 ad .fo_kqfilter = bpf_kqfilter,
282 1.150 dsl .fo_restart = fnullop_restart,
283 1.105 christos };
284 1.105 christos
285 1.67 gehenna dev_type_open(bpfopen);
286 1.67 gehenna
287 1.67 gehenna const struct cdevsw bpf_cdevsw = {
288 1.182 dholland .d_open = bpfopen,
289 1.182 dholland .d_close = noclose,
290 1.182 dholland .d_read = noread,
291 1.182 dholland .d_write = nowrite,
292 1.182 dholland .d_ioctl = noioctl,
293 1.182 dholland .d_stop = nostop,
294 1.182 dholland .d_tty = notty,
295 1.182 dholland .d_poll = nopoll,
296 1.182 dholland .d_mmap = nommap,
297 1.182 dholland .d_kqfilter = nokqfilter,
298 1.185 dholland .d_discard = nodiscard,
299 1.217 ozaki .d_flag = D_OTHER | D_MPSAFE
300 1.67 gehenna };
301 1.67 gehenna
302 1.178 rmind bpfjit_func_t
303 1.178 rmind bpf_jit_generate(bpf_ctx_t *bc, void *code, size_t size)
304 1.178 rmind {
305 1.183 alnsn
306 1.178 rmind membar_consumer();
307 1.178 rmind if (bpfjit_module_ops.bj_generate_code != NULL) {
308 1.178 rmind return bpfjit_module_ops.bj_generate_code(bc, code, size);
309 1.178 rmind }
310 1.178 rmind return NULL;
311 1.178 rmind }
312 1.178 rmind
313 1.178 rmind void
314 1.178 rmind bpf_jit_freecode(bpfjit_func_t jcode)
315 1.178 rmind {
316 1.178 rmind KASSERT(bpfjit_module_ops.bj_free_code != NULL);
317 1.178 rmind bpfjit_module_ops.bj_free_code(jcode);
318 1.178 rmind }
319 1.178 rmind
320 1.12 mycroft static int
321 1.160 christos bpf_movein(struct uio *uio, int linktype, uint64_t mtu, struct mbuf **mp,
322 1.111 rpaulo struct sockaddr *sockp)
323 1.12 mycroft {
324 1.12 mycroft struct mbuf *m;
325 1.12 mycroft int error;
326 1.160 christos size_t len;
327 1.160 christos size_t hlen;
328 1.160 christos size_t align;
329 1.12 mycroft
330 1.12 mycroft /*
331 1.12 mycroft * Build a sockaddr based on the data link layer type.
332 1.12 mycroft * We do this at this level because the ethernet header
333 1.12 mycroft * is copied directly into the data field of the sockaddr.
334 1.12 mycroft * In the case of SLIP, there is no header and the packet
335 1.12 mycroft * is forwarded as is.
336 1.12 mycroft * Also, we are careful to leave room at the front of the mbuf
337 1.12 mycroft * for the link level header.
338 1.12 mycroft */
339 1.12 mycroft switch (linktype) {
340 1.12 mycroft
341 1.12 mycroft case DLT_SLIP:
342 1.12 mycroft sockp->sa_family = AF_INET;
343 1.12 mycroft hlen = 0;
344 1.36 christos align = 0;
345 1.12 mycroft break;
346 1.12 mycroft
347 1.12 mycroft case DLT_PPP:
348 1.12 mycroft sockp->sa_family = AF_UNSPEC;
349 1.12 mycroft hlen = 0;
350 1.36 christos align = 0;
351 1.12 mycroft break;
352 1.12 mycroft
353 1.12 mycroft case DLT_EN10MB:
354 1.12 mycroft sockp->sa_family = AF_UNSPEC;
355 1.12 mycroft /* XXX Would MAXLINKHDR be better? */
356 1.36 christos /* 6(dst)+6(src)+2(type) */
357 1.12 mycroft hlen = sizeof(struct ether_header);
358 1.36 christos align = 2;
359 1.17 glass break;
360 1.17 glass
361 1.17 glass case DLT_ARCNET:
362 1.17 glass sockp->sa_family = AF_UNSPEC;
363 1.17 glass hlen = ARC_HDRLEN;
364 1.36 christos align = 5;
365 1.12 mycroft break;
366 1.12 mycroft
367 1.12 mycroft case DLT_FDDI:
368 1.56 matt sockp->sa_family = AF_LINK;
369 1.56 matt /* XXX 4(FORMAC)+6(dst)+6(src) */
370 1.56 matt hlen = 16;
371 1.36 christos align = 0;
372 1.62 bjh21 break;
373 1.62 bjh21
374 1.62 bjh21 case DLT_ECONET:
375 1.62 bjh21 sockp->sa_family = AF_UNSPEC;
376 1.62 bjh21 hlen = 6;
377 1.62 bjh21 align = 2;
378 1.12 mycroft break;
379 1.12 mycroft
380 1.12 mycroft case DLT_NULL:
381 1.12 mycroft sockp->sa_family = AF_UNSPEC;
382 1.12 mycroft hlen = 0;
383 1.36 christos align = 0;
384 1.12 mycroft break;
385 1.12 mycroft
386 1.12 mycroft default:
387 1.12 mycroft return (EIO);
388 1.12 mycroft }
389 1.12 mycroft
390 1.12 mycroft len = uio->uio_resid;
391 1.36 christos /*
392 1.36 christos * If there aren't enough bytes for a link level header or the
393 1.36 christos * packet length exceeds the interface mtu, return an error.
394 1.36 christos */
395 1.160 christos if (len - hlen > mtu)
396 1.36 christos return (EMSGSIZE);
397 1.36 christos
398 1.36 christos /*
399 1.36 christos * XXX Avoid complicated buffer chaining ---
400 1.36 christos * bail if it won't fit in a single mbuf.
401 1.36 christos * (Take into account possible alignment bytes)
402 1.36 christos */
403 1.160 christos if (len + align > MCLBYTES)
404 1.12 mycroft return (EIO);
405 1.12 mycroft
406 1.77 matt m = m_gethdr(M_WAIT, MT_DATA);
407 1.197 ozaki m_reset_rcvif(m);
408 1.160 christos m->m_pkthdr.len = (int)(len - hlen);
409 1.160 christos if (len + align > MHLEN) {
410 1.77 matt m_clget(m, M_WAIT);
411 1.12 mycroft if ((m->m_flags & M_EXT) == 0) {
412 1.12 mycroft error = ENOBUFS;
413 1.12 mycroft goto bad;
414 1.12 mycroft }
415 1.12 mycroft }
416 1.36 christos
417 1.36 christos /* Insure the data is properly aligned */
418 1.36 christos if (align > 0) {
419 1.36 christos m->m_data += align;
420 1.160 christos m->m_len -= (int)align;
421 1.36 christos }
422 1.36 christos
423 1.103 christos error = uiomove(mtod(m, void *), len, uio);
424 1.36 christos if (error)
425 1.36 christos goto bad;
426 1.12 mycroft if (hlen != 0) {
427 1.103 christos memcpy(sockp->sa_data, mtod(m, void *), hlen);
428 1.12 mycroft m->m_data += hlen; /* XXX */
429 1.36 christos len -= hlen;
430 1.12 mycroft }
431 1.160 christos m->m_len = (int)len;
432 1.36 christos *mp = m;
433 1.38 mycroft return (0);
434 1.38 mycroft
435 1.38 mycroft bad:
436 1.12 mycroft m_freem(m);
437 1.12 mycroft return (error);
438 1.12 mycroft }
439 1.1 cgd
440 1.1 cgd /*
441 1.2 cgd * Attach file to the bpf interface, i.e. make d listen on bp.
442 1.1 cgd */
443 1.1 cgd static void
444 1.111 rpaulo bpf_attachd(struct bpf_d *d, struct bpf_if *bp)
445 1.1 cgd {
446 1.213 ozaki
447 1.192 christos KASSERT(mutex_owned(&bpf_mtx));
448 1.213 ozaki KASSERT(mutex_owned(d->bd_mtx));
449 1.2 cgd /*
450 1.2 cgd * Point d at bp, and add d to the interface's list of listeners.
451 1.2 cgd * Finally, point the driver's bpf cookie at the interface so
452 1.2 cgd * it will divert packets to bpf.
453 1.2 cgd */
454 1.1 cgd d->bd_bif = bp;
455 1.209 ozaki BPFIF_DLIST_WRITER_INSERT_HEAD(bp, d);
456 1.1 cgd
457 1.1 cgd *bp->bif_driverp = bp;
458 1.1 cgd }
459 1.1 cgd
460 1.2 cgd /*
461 1.2 cgd * Detach a file from its interface.
462 1.2 cgd */
463 1.1 cgd static void
464 1.111 rpaulo bpf_detachd(struct bpf_d *d)
465 1.1 cgd {
466 1.1 cgd struct bpf_if *bp;
467 1.1 cgd
468 1.192 christos KASSERT(mutex_owned(&bpf_mtx));
469 1.213 ozaki KASSERT(mutex_owned(d->bd_mtx));
470 1.192 christos
471 1.1 cgd bp = d->bd_bif;
472 1.1 cgd /*
473 1.1 cgd * Check if this descriptor had requested promiscuous mode.
474 1.1 cgd * If so, turn it off.
475 1.1 cgd */
476 1.1 cgd if (d->bd_promisc) {
477 1.180 christos int error __diagused;
478 1.18 mycroft
479 1.1 cgd d->bd_promisc = 0;
480 1.36 christos /*
481 1.36 christos * Take device out of promiscuous mode. Since we were
482 1.36 christos * able to enter promiscuous mode, we should be able
483 1.36 christos * to turn it off. But we can get an error if
484 1.36 christos * the interface was configured down, so only panic
485 1.36 christos * if we don't get an unexpected error.
486 1.36 christos */
487 1.219 ozaki KERNEL_LOCK_UNLESS_NET_MPSAFE();
488 1.36 christos error = ifpromisc(bp->bif_ifp, 0);
489 1.219 ozaki KERNEL_UNLOCK_UNLESS_NET_MPSAFE();
490 1.180 christos #ifdef DIAGNOSTIC
491 1.180 christos if (error)
492 1.180 christos printf("%s: ifpromisc failed: %d", __func__, error);
493 1.180 christos #endif
494 1.1 cgd }
495 1.209 ozaki
496 1.2 cgd /* Remove d from the interface's descriptor list. */
497 1.209 ozaki BPFIF_DLIST_WRITER_REMOVE(d);
498 1.209 ozaki
499 1.213 ozaki pserialize_perform(bpf_psz);
500 1.209 ozaki
501 1.209 ozaki if (BPFIF_DLIST_WRITER_EMPTY(bp)) {
502 1.1 cgd /*
503 1.1 cgd * Let the driver know that there are no more listeners.
504 1.1 cgd */
505 1.187 ozaki *d->bd_bif->bif_driverp = NULL;
506 1.209 ozaki }
507 1.187 ozaki d->bd_bif = NULL;
508 1.1 cgd }
509 1.1 cgd
510 1.203 pgoyette static void
511 1.203 pgoyette bpf_init(void)
512 1.154 pooka {
513 1.154 pooka
514 1.154 pooka mutex_init(&bpf_mtx, MUTEX_DEFAULT, IPL_NONE);
515 1.213 ozaki bpf_psz = pserialize_create();
516 1.213 ozaki bpf_psref_class = psref_class_create("bpf", IPL_SOFTNET);
517 1.154 pooka
518 1.209 ozaki PSLIST_INIT(&bpf_iflist);
519 1.209 ozaki PSLIST_INIT(&bpf_dlist);
520 1.154 pooka
521 1.210 ozaki bpf_gstats_percpu = percpu_alloc(sizeof(struct bpf_stat));
522 1.154 pooka
523 1.203 pgoyette return;
524 1.154 pooka }
525 1.1 cgd
526 1.1 cgd /*
527 1.203 pgoyette * bpfilterattach() is called at boot time. We don't need to do anything
528 1.203 pgoyette * here, since any initialization will happen as part of module init code.
529 1.46 bouyer */
530 1.46 bouyer /* ARGSUSED */
531 1.46 bouyer void
532 1.125 christos bpfilterattach(int n)
533 1.46 bouyer {
534 1.151 pooka
535 1.46 bouyer }
536 1.46 bouyer
537 1.46 bouyer /*
538 1.105 christos * Open ethernet device. Clones.
539 1.1 cgd */
540 1.1 cgd /* ARGSUSED */
541 1.1 cgd int
542 1.125 christos bpfopen(dev_t dev, int flag, int mode, struct lwp *l)
543 1.1 cgd {
544 1.53 augustss struct bpf_d *d;
545 1.105 christos struct file *fp;
546 1.105 christos int error, fd;
547 1.12 mycroft
548 1.191 joerg /* falloc() will fill in the descriptor for us. */
549 1.135 ad if ((error = fd_allocfile(&fp, &fd)) != 0)
550 1.105 christos return error;
551 1.2 cgd
552 1.208 ozaki d = kmem_zalloc(sizeof(*d), KM_SLEEP);
553 1.2 cgd d->bd_bufsize = bpf_bufsize;
554 1.91 darrenr d->bd_seesent = 1;
555 1.156 christos d->bd_feedback = 0;
556 1.112 christos d->bd_pid = l->l_proc->p_pid;
557 1.166 bouyer #ifdef _LP64
558 1.166 bouyer if (curproc->p_flag & PK_32)
559 1.166 bouyer d->bd_compat32 = 1;
560 1.166 bouyer #endif
561 1.145 christos getnanotime(&d->bd_btime);
562 1.145 christos d->bd_atime = d->bd_mtime = d->bd_btime;
563 1.222 ozaki callout_init(&d->bd_callout, CALLOUT_MPSAFE);
564 1.134 rmind selinit(&d->bd_sel);
565 1.173 alnsn d->bd_jitcode = NULL;
566 1.213 ozaki d->bd_filter = NULL;
567 1.209 ozaki BPF_DLIST_ENTRY_INIT(d);
568 1.209 ozaki BPFIF_DLIST_ENTRY_INIT(d);
569 1.213 ozaki d->bd_mtx = mutex_obj_alloc(MUTEX_DEFAULT, IPL_SOFTNET);
570 1.213 ozaki d->bd_buf_mtx = mutex_obj_alloc(MUTEX_DEFAULT, IPL_NET);
571 1.211 ozaki cv_init(&d->bd_cv, "bpf");
572 1.1 cgd
573 1.130 xtraeme mutex_enter(&bpf_mtx);
574 1.215 christos BPF_DLIST_WRITER_INSERT_HEAD(d);
575 1.130 xtraeme mutex_exit(&bpf_mtx);
576 1.105 christos
577 1.135 ad return fd_clone(fp, fd, flag, &bpf_fileops, d);
578 1.1 cgd }
579 1.1 cgd
580 1.1 cgd /*
581 1.1 cgd * Close the descriptor by detaching it from its interface,
582 1.1 cgd * deallocating its buffers, and marking it free.
583 1.1 cgd */
584 1.1 cgd /* ARGSUSED */
585 1.105 christos static int
586 1.135 ad bpf_close(struct file *fp)
587 1.1 cgd {
588 1.194 christos struct bpf_d *d;
589 1.1 cgd
590 1.192 christos mutex_enter(&bpf_mtx);
591 1.140 ad
592 1.194 christos if ((d = fp->f_bpf) == NULL) {
593 1.194 christos mutex_exit(&bpf_mtx);
594 1.194 christos return 0;
595 1.194 christos }
596 1.194 christos
597 1.110 rpaulo /*
598 1.110 rpaulo * Refresh the PID associated with this bpf file.
599 1.110 rpaulo */
600 1.135 ad d->bd_pid = curproc->p_pid;
601 1.110 rpaulo
602 1.213 ozaki mutex_enter(d->bd_mtx);
603 1.91 darrenr if (d->bd_state == BPF_WAITING)
604 1.213 ozaki callout_halt(&d->bd_callout, d->bd_mtx);
605 1.91 darrenr d->bd_state = BPF_IDLE;
606 1.1 cgd if (d->bd_bif)
607 1.1 cgd bpf_detachd(d);
608 1.213 ozaki mutex_exit(d->bd_mtx);
609 1.213 ozaki
610 1.209 ozaki BPF_DLIST_WRITER_REMOVE(d);
611 1.194 christos
612 1.213 ozaki pserialize_perform(bpf_psz);
613 1.194 christos mutex_exit(&bpf_mtx);
614 1.194 christos
615 1.213 ozaki BPFIF_DLIST_ENTRY_DESTROY(d);
616 1.209 ozaki BPF_DLIST_ENTRY_DESTROY(d);
617 1.213 ozaki fp->f_bpf = NULL;
618 1.213 ozaki bpf_freed(d);
619 1.129 ad callout_destroy(&d->bd_callout);
620 1.134 rmind seldestroy(&d->bd_sel);
621 1.211 ozaki mutex_obj_free(d->bd_mtx);
622 1.213 ozaki mutex_obj_free(d->bd_buf_mtx);
623 1.211 ozaki cv_destroy(&d->bd_cv);
624 1.211 ozaki
625 1.208 ozaki kmem_free(d, sizeof(*d));
626 1.140 ad
627 1.2 cgd return (0);
628 1.2 cgd }
629 1.2 cgd
630 1.2 cgd /*
631 1.1 cgd * Rotate the packet buffers in descriptor d. Move the store buffer
632 1.12 mycroft * into the hold slot, and the free buffer into the store slot.
633 1.1 cgd * Zero the length of the new store buffer.
634 1.1 cgd */
635 1.1 cgd #define ROTATE_BUFFERS(d) \
636 1.100 darrenr (d)->bd_hbuf = (d)->bd_sbuf; \
637 1.100 darrenr (d)->bd_hlen = (d)->bd_slen; \
638 1.100 darrenr (d)->bd_sbuf = (d)->bd_fbuf; \
639 1.100 darrenr (d)->bd_slen = 0; \
640 1.187 ozaki (d)->bd_fbuf = NULL;
641 1.1 cgd /*
642 1.1 cgd * bpfread - read next chunk of packets from buffers
643 1.1 cgd */
644 1.105 christos static int
645 1.125 christos bpf_read(struct file *fp, off_t *offp, struct uio *uio,
646 1.125 christos kauth_cred_t cred, int flags)
647 1.1 cgd {
648 1.188 matt struct bpf_d *d = fp->f_bpf;
649 1.91 darrenr int timed_out;
650 1.1 cgd int error;
651 1.1 cgd
652 1.145 christos getnanotime(&d->bd_atime);
653 1.1 cgd /*
654 1.12 mycroft * Restrict application to use a buffer the same size as
655 1.121 martin * the kernel buffers.
656 1.1 cgd */
657 1.1 cgd if (uio->uio_resid != d->bd_bufsize)
658 1.1 cgd return (EINVAL);
659 1.1 cgd
660 1.213 ozaki mutex_enter(d->bd_mtx);
661 1.91 darrenr if (d->bd_state == BPF_WAITING)
662 1.221 ozaki callout_halt(&d->bd_callout, d->bd_mtx);
663 1.91 darrenr timed_out = (d->bd_state == BPF_TIMED_OUT);
664 1.91 darrenr d->bd_state = BPF_IDLE;
665 1.213 ozaki mutex_exit(d->bd_mtx);
666 1.1 cgd /*
667 1.2 cgd * If the hold buffer is empty, then do a timed sleep, which
668 1.2 cgd * ends when the timeout expires or when enough packets
669 1.2 cgd * have arrived to fill the store buffer.
670 1.1 cgd */
671 1.213 ozaki mutex_enter(d->bd_buf_mtx);
672 1.187 ozaki while (d->bd_hbuf == NULL) {
673 1.105 christos if (fp->f_flag & FNONBLOCK) {
674 1.93 darrenr if (d->bd_slen == 0) {
675 1.212 ozaki error = EWOULDBLOCK;
676 1.212 ozaki goto out;
677 1.93 darrenr }
678 1.93 darrenr ROTATE_BUFFERS(d);
679 1.93 darrenr break;
680 1.93 darrenr }
681 1.93 darrenr
682 1.91 darrenr if ((d->bd_immediate || timed_out) && d->bd_slen != 0) {
683 1.1 cgd /*
684 1.1 cgd * A packet(s) either arrived since the previous
685 1.1 cgd * read or arrived while we were asleep.
686 1.1 cgd * Rotate the buffers and return what's here.
687 1.1 cgd */
688 1.1 cgd ROTATE_BUFFERS(d);
689 1.1 cgd break;
690 1.1 cgd }
691 1.211 ozaki
692 1.213 ozaki error = cv_timedwait_sig(&d->bd_cv, d->bd_buf_mtx, d->bd_rtout);
693 1.211 ozaki
694 1.212 ozaki if (error == EINTR || error == ERESTART)
695 1.212 ozaki goto out;
696 1.212 ozaki
697 1.12 mycroft if (error == EWOULDBLOCK) {
698 1.12 mycroft /*
699 1.12 mycroft * On a timeout, return what's in the buffer,
700 1.12 mycroft * which may be nothing. If there is something
701 1.12 mycroft * in the store buffer, we can rotate the buffers.
702 1.12 mycroft */
703 1.12 mycroft if (d->bd_hbuf)
704 1.1 cgd /*
705 1.12 mycroft * We filled up the buffer in between
706 1.12 mycroft * getting the timeout and arriving
707 1.12 mycroft * here, so we don't need to rotate.
708 1.1 cgd */
709 1.1 cgd break;
710 1.12 mycroft
711 1.100 darrenr if (d->bd_slen == 0) {
712 1.212 ozaki error = 0;
713 1.212 ozaki goto out;
714 1.1 cgd }
715 1.100 darrenr ROTATE_BUFFERS(d);
716 1.100 darrenr break;
717 1.1 cgd }
718 1.36 christos if (error != 0)
719 1.212 ozaki goto out;
720 1.1 cgd }
721 1.100 darrenr /*
722 1.100 darrenr * At this point, we know we have something in the hold slot.
723 1.100 darrenr */
724 1.213 ozaki mutex_exit(d->bd_buf_mtx);
725 1.100 darrenr
726 1.100 darrenr /*
727 1.100 darrenr * Move data from hold buffer into user space.
728 1.100 darrenr * We know the entire buffer is transferred since
729 1.100 darrenr * we checked above that the read buffer is bpf_bufsize bytes.
730 1.100 darrenr */
731 1.100 darrenr error = uiomove(d->bd_hbuf, d->bd_hlen, uio);
732 1.12 mycroft
733 1.213 ozaki mutex_enter(d->bd_buf_mtx);
734 1.100 darrenr d->bd_fbuf = d->bd_hbuf;
735 1.187 ozaki d->bd_hbuf = NULL;
736 1.100 darrenr d->bd_hlen = 0;
737 1.212 ozaki out:
738 1.213 ozaki mutex_exit(d->bd_buf_mtx);
739 1.100 darrenr return (error);
740 1.1 cgd }
741 1.1 cgd
742 1.1 cgd
743 1.1 cgd /*
744 1.12 mycroft * If there are processes sleeping on this descriptor, wake them up.
745 1.1 cgd */
746 1.114 perry static inline void
747 1.111 rpaulo bpf_wakeup(struct bpf_d *d)
748 1.1 cgd {
749 1.211 ozaki
750 1.213 ozaki mutex_enter(d->bd_buf_mtx);
751 1.211 ozaki cv_broadcast(&d->bd_cv);
752 1.213 ozaki mutex_exit(d->bd_buf_mtx);
753 1.211 ozaki
754 1.85 jdolecek if (d->bd_async)
755 1.223 ozaki fownsignal(d->bd_pgid, SIGIO, 0, 0, NULL);
756 1.134 rmind selnotify(&d->bd_sel, 0, 0);
757 1.1 cgd }
758 1.1 cgd
759 1.139 ad static void
760 1.111 rpaulo bpf_timed_out(void *arg)
761 1.91 darrenr {
762 1.103 christos struct bpf_d *d = arg;
763 1.91 darrenr
764 1.213 ozaki mutex_enter(d->bd_mtx);
765 1.91 darrenr if (d->bd_state == BPF_WAITING) {
766 1.91 darrenr d->bd_state = BPF_TIMED_OUT;
767 1.91 darrenr if (d->bd_slen != 0)
768 1.91 darrenr bpf_wakeup(d);
769 1.91 darrenr }
770 1.213 ozaki mutex_exit(d->bd_mtx);
771 1.91 darrenr }
772 1.91 darrenr
773 1.91 darrenr
774 1.105 christos static int
775 1.125 christos bpf_write(struct file *fp, off_t *offp, struct uio *uio,
776 1.125 christos kauth_cred_t cred, int flags)
777 1.1 cgd {
778 1.188 matt struct bpf_d *d = fp->f_bpf;
779 1.213 ozaki struct bpf_if *bp;
780 1.12 mycroft struct ifnet *ifp;
781 1.156 christos struct mbuf *m, *mc;
782 1.213 ozaki int error;
783 1.56 matt static struct sockaddr_storage dst;
784 1.213 ozaki struct psref psref;
785 1.213 ozaki int bound;
786 1.1 cgd
787 1.116 mrg m = NULL; /* XXX gcc */
788 1.116 mrg
789 1.213 ozaki bound = curlwp_bind();
790 1.213 ozaki mutex_enter(d->bd_mtx);
791 1.213 ozaki bp = d->bd_bif;
792 1.213 ozaki if (bp == NULL) {
793 1.213 ozaki mutex_exit(d->bd_mtx);
794 1.213 ozaki error = ENXIO;
795 1.213 ozaki goto out_bindx;
796 1.213 ozaki }
797 1.213 ozaki bpf_if_acquire(bp, &psref);
798 1.213 ozaki mutex_exit(d->bd_mtx);
799 1.140 ad
800 1.145 christos getnanotime(&d->bd_mtime);
801 1.1 cgd
802 1.213 ozaki ifp = bp->bif_ifp;
803 1.213 ozaki if (if_is_deactivated(ifp)) {
804 1.213 ozaki error = ENXIO;
805 1.213 ozaki goto out;
806 1.213 ozaki }
807 1.11 deraadt
808 1.140 ad if (uio->uio_resid == 0) {
809 1.213 ozaki error = 0;
810 1.213 ozaki goto out;
811 1.140 ad }
812 1.11 deraadt
813 1.213 ozaki error = bpf_movein(uio, (int)bp->bif_dlt, ifp->if_mtu, &m,
814 1.56 matt (struct sockaddr *) &dst);
815 1.213 ozaki if (error)
816 1.213 ozaki goto out;
817 1.11 deraadt
818 1.109 peter if (m->m_pkthdr.len > ifp->if_mtu) {
819 1.109 peter m_freem(m);
820 1.213 ozaki error = EMSGSIZE;
821 1.213 ozaki goto out;
822 1.109 peter }
823 1.1 cgd
824 1.40 thorpej if (d->bd_hdrcmplt)
825 1.56 matt dst.ss_family = pseudo_AF_HDRCMPLT;
826 1.40 thorpej
827 1.156 christos if (d->bd_feedback) {
828 1.156 christos mc = m_dup(m, 0, M_COPYALL, M_NOWAIT);
829 1.156 christos if (mc != NULL)
830 1.197 ozaki m_set_rcvif(mc, ifp);
831 1.156 christos /* Set M_PROMISC for outgoing packets to be discarded. */
832 1.156 christos if (1 /*d->bd_direction == BPF_D_INOUT*/)
833 1.156 christos m->m_flags |= M_PROMISC;
834 1.156 christos } else
835 1.156 christos mc = NULL;
836 1.156 christos
837 1.199 knakahar error = if_output_lock(ifp, ifp, m, (struct sockaddr *) &dst, NULL);
838 1.156 christos
839 1.156 christos if (mc != NULL) {
840 1.156 christos if (error == 0)
841 1.195 ozaki ifp->_if_input(ifp, mc);
842 1.193 christos else
843 1.193 christos m_freem(mc);
844 1.167 christos }
845 1.1 cgd /*
846 1.12 mycroft * The driver frees the mbuf.
847 1.1 cgd */
848 1.213 ozaki out:
849 1.213 ozaki bpf_if_release(bp, &psref);
850 1.213 ozaki out_bindx:
851 1.213 ozaki curlwp_bindx(bound);
852 1.213 ozaki return error;
853 1.1 cgd }
854 1.1 cgd
855 1.1 cgd /*
856 1.2 cgd * Reset a descriptor by flushing its packet buffer and clearing the
857 1.214 ozaki * receive and drop counts.
858 1.1 cgd */
859 1.1 cgd static void
860 1.111 rpaulo reset_d(struct bpf_d *d)
861 1.1 cgd {
862 1.213 ozaki
863 1.213 ozaki KASSERT(mutex_owned(d->bd_mtx));
864 1.213 ozaki
865 1.213 ozaki mutex_enter(d->bd_buf_mtx);
866 1.1 cgd if (d->bd_hbuf) {
867 1.1 cgd /* Free the hold buffer. */
868 1.1 cgd d->bd_fbuf = d->bd_hbuf;
869 1.187 ozaki d->bd_hbuf = NULL;
870 1.1 cgd }
871 1.1 cgd d->bd_slen = 0;
872 1.2 cgd d->bd_hlen = 0;
873 1.1 cgd d->bd_rcount = 0;
874 1.1 cgd d->bd_dcount = 0;
875 1.94 darrenr d->bd_ccount = 0;
876 1.213 ozaki mutex_exit(d->bd_buf_mtx);
877 1.1 cgd }
878 1.1 cgd
879 1.1 cgd /*
880 1.1 cgd * FIONREAD Check for read packet available.
881 1.1 cgd * BIOCGBLEN Get buffer len [for read()].
882 1.1 cgd * BIOCSETF Set ethernet read filter.
883 1.1 cgd * BIOCFLUSH Flush read packet buffer.
884 1.1 cgd * BIOCPROMISC Put interface into promiscuous mode.
885 1.1 cgd * BIOCGDLT Get link layer type.
886 1.1 cgd * BIOCGETIF Get interface name.
887 1.1 cgd * BIOCSETIF Set interface.
888 1.1 cgd * BIOCSRTIMEOUT Set read timeout.
889 1.1 cgd * BIOCGRTIMEOUT Get read timeout.
890 1.1 cgd * BIOCGSTATS Get packet stats.
891 1.1 cgd * BIOCIMMEDIATE Set immediate mode.
892 1.2 cgd * BIOCVERSION Get filter language version.
893 1.113 rpaulo * BIOCGHDRCMPLT Get "header already complete" flag.
894 1.113 rpaulo * BIOCSHDRCMPLT Set "header already complete" flag.
895 1.156 christos * BIOCSFEEDBACK Set packet feedback mode.
896 1.156 christos * BIOCGFEEDBACK Get packet feedback mode.
897 1.156 christos * BIOCGSEESENT Get "see sent packets" mode.
898 1.156 christos * BIOCSSEESENT Set "see sent packets" mode.
899 1.1 cgd */
900 1.1 cgd /* ARGSUSED */
901 1.105 christos static int
902 1.135 ad bpf_ioctl(struct file *fp, u_long cmd, void *addr)
903 1.1 cgd {
904 1.188 matt struct bpf_d *d = fp->f_bpf;
905 1.213 ozaki int error = 0;
906 1.1 cgd
907 1.110 rpaulo /*
908 1.110 rpaulo * Refresh the PID associated with this bpf file.
909 1.110 rpaulo */
910 1.135 ad d->bd_pid = curproc->p_pid;
911 1.166 bouyer #ifdef _LP64
912 1.166 bouyer if (curproc->p_flag & PK_32)
913 1.166 bouyer d->bd_compat32 = 1;
914 1.166 bouyer else
915 1.166 bouyer d->bd_compat32 = 0;
916 1.166 bouyer #endif
917 1.120 christos
918 1.213 ozaki mutex_enter(d->bd_mtx);
919 1.91 darrenr if (d->bd_state == BPF_WAITING)
920 1.213 ozaki callout_halt(&d->bd_callout, d->bd_mtx);
921 1.91 darrenr d->bd_state = BPF_IDLE;
922 1.213 ozaki mutex_exit(d->bd_mtx);
923 1.91 darrenr
924 1.1 cgd switch (cmd) {
925 1.1 cgd
926 1.1 cgd default:
927 1.1 cgd error = EINVAL;
928 1.1 cgd break;
929 1.1 cgd
930 1.1 cgd /*
931 1.1 cgd * Check for read packet available.
932 1.1 cgd */
933 1.1 cgd case FIONREAD:
934 1.1 cgd {
935 1.1 cgd int n;
936 1.12 mycroft
937 1.213 ozaki mutex_enter(d->bd_buf_mtx);
938 1.1 cgd n = d->bd_slen;
939 1.12 mycroft if (d->bd_hbuf)
940 1.1 cgd n += d->bd_hlen;
941 1.213 ozaki mutex_exit(d->bd_buf_mtx);
942 1.1 cgd
943 1.1 cgd *(int *)addr = n;
944 1.1 cgd break;
945 1.1 cgd }
946 1.1 cgd
947 1.1 cgd /*
948 1.2 cgd * Get buffer len [for read()].
949 1.1 cgd */
950 1.2 cgd case BIOCGBLEN:
951 1.2 cgd *(u_int *)addr = d->bd_bufsize;
952 1.1 cgd break;
953 1.2 cgd
954 1.1 cgd /*
955 1.2 cgd * Set buffer length.
956 1.1 cgd */
957 1.2 cgd case BIOCSBLEN:
958 1.208 ozaki /*
959 1.208 ozaki * Forbid to change the buffer length if buffers are already
960 1.208 ozaki * allocated.
961 1.208 ozaki */
962 1.213 ozaki mutex_enter(d->bd_mtx);
963 1.213 ozaki mutex_enter(d->bd_buf_mtx);
964 1.208 ozaki if (d->bd_bif != NULL || d->bd_sbuf != NULL)
965 1.2 cgd error = EINVAL;
966 1.2 cgd else {
967 1.53 augustss u_int size = *(u_int *)addr;
968 1.2 cgd
969 1.87 jonathan if (size > bpf_maxbufsize)
970 1.87 jonathan *(u_int *)addr = size = bpf_maxbufsize;
971 1.2 cgd else if (size < BPF_MINBUFSIZE)
972 1.2 cgd *(u_int *)addr = size = BPF_MINBUFSIZE;
973 1.2 cgd d->bd_bufsize = size;
974 1.2 cgd }
975 1.213 ozaki mutex_exit(d->bd_buf_mtx);
976 1.213 ozaki mutex_exit(d->bd_mtx);
977 1.1 cgd break;
978 1.1 cgd
979 1.1 cgd /*
980 1.2 cgd * Set link layer read filter.
981 1.1 cgd */
982 1.12 mycroft case BIOCSETF:
983 1.103 christos error = bpf_setf(d, addr);
984 1.1 cgd break;
985 1.1 cgd
986 1.1 cgd /*
987 1.1 cgd * Flush read packet buffer.
988 1.1 cgd */
989 1.1 cgd case BIOCFLUSH:
990 1.213 ozaki mutex_enter(d->bd_mtx);
991 1.1 cgd reset_d(d);
992 1.213 ozaki mutex_exit(d->bd_mtx);
993 1.1 cgd break;
994 1.1 cgd
995 1.1 cgd /*
996 1.1 cgd * Put interface into promiscuous mode.
997 1.1 cgd */
998 1.1 cgd case BIOCPROMISC:
999 1.213 ozaki mutex_enter(d->bd_mtx);
1000 1.187 ozaki if (d->bd_bif == NULL) {
1001 1.213 ozaki mutex_exit(d->bd_mtx);
1002 1.1 cgd /*
1003 1.1 cgd * No interface attached yet.
1004 1.1 cgd */
1005 1.1 cgd error = EINVAL;
1006 1.1 cgd break;
1007 1.1 cgd }
1008 1.1 cgd if (d->bd_promisc == 0) {
1009 1.219 ozaki KERNEL_LOCK_UNLESS_NET_MPSAFE();
1010 1.1 cgd error = ifpromisc(d->bd_bif->bif_ifp, 1);
1011 1.219 ozaki KERNEL_UNLOCK_UNLESS_NET_MPSAFE();
1012 1.2 cgd if (error == 0)
1013 1.2 cgd d->bd_promisc = 1;
1014 1.1 cgd }
1015 1.213 ozaki mutex_exit(d->bd_mtx);
1016 1.1 cgd break;
1017 1.1 cgd
1018 1.1 cgd /*
1019 1.1 cgd * Get device parameters.
1020 1.1 cgd */
1021 1.1 cgd case BIOCGDLT:
1022 1.213 ozaki mutex_enter(d->bd_mtx);
1023 1.187 ozaki if (d->bd_bif == NULL)
1024 1.1 cgd error = EINVAL;
1025 1.1 cgd else
1026 1.1 cgd *(u_int *)addr = d->bd_bif->bif_dlt;
1027 1.213 ozaki mutex_exit(d->bd_mtx);
1028 1.1 cgd break;
1029 1.1 cgd
1030 1.1 cgd /*
1031 1.66 onoe * Get a list of supported device parameters.
1032 1.66 onoe */
1033 1.66 onoe case BIOCGDLTLIST:
1034 1.213 ozaki mutex_enter(d->bd_mtx);
1035 1.187 ozaki if (d->bd_bif == NULL)
1036 1.66 onoe error = EINVAL;
1037 1.66 onoe else
1038 1.103 christos error = bpf_getdltlist(d, addr);
1039 1.213 ozaki mutex_exit(d->bd_mtx);
1040 1.66 onoe break;
1041 1.66 onoe
1042 1.66 onoe /*
1043 1.66 onoe * Set device parameters.
1044 1.66 onoe */
1045 1.66 onoe case BIOCSDLT:
1046 1.192 christos mutex_enter(&bpf_mtx);
1047 1.213 ozaki mutex_enter(d->bd_mtx);
1048 1.187 ozaki if (d->bd_bif == NULL)
1049 1.66 onoe error = EINVAL;
1050 1.66 onoe else
1051 1.66 onoe error = bpf_setdlt(d, *(u_int *)addr);
1052 1.213 ozaki mutex_exit(d->bd_mtx);
1053 1.192 christos mutex_exit(&bpf_mtx);
1054 1.66 onoe break;
1055 1.66 onoe
1056 1.66 onoe /*
1057 1.1 cgd * Set interface name.
1058 1.1 cgd */
1059 1.127 christos #ifdef OBIOCGETIF
1060 1.127 christos case OBIOCGETIF:
1061 1.127 christos #endif
1062 1.1 cgd case BIOCGETIF:
1063 1.213 ozaki mutex_enter(d->bd_mtx);
1064 1.187 ozaki if (d->bd_bif == NULL)
1065 1.1 cgd error = EINVAL;
1066 1.1 cgd else
1067 1.103 christos bpf_ifname(d->bd_bif->bif_ifp, addr);
1068 1.213 ozaki mutex_exit(d->bd_mtx);
1069 1.1 cgd break;
1070 1.1 cgd
1071 1.1 cgd /*
1072 1.1 cgd * Set interface.
1073 1.1 cgd */
1074 1.127 christos #ifdef OBIOCSETIF
1075 1.127 christos case OBIOCSETIF:
1076 1.127 christos #endif
1077 1.1 cgd case BIOCSETIF:
1078 1.192 christos mutex_enter(&bpf_mtx);
1079 1.103 christos error = bpf_setif(d, addr);
1080 1.192 christos mutex_exit(&bpf_mtx);
1081 1.1 cgd break;
1082 1.1 cgd
1083 1.1 cgd /*
1084 1.1 cgd * Set read timeout.
1085 1.1 cgd */
1086 1.12 mycroft case BIOCSRTIMEOUT:
1087 1.1 cgd {
1088 1.103 christos struct timeval *tv = addr;
1089 1.1 cgd
1090 1.19 cgd /* Compute number of ticks. */
1091 1.19 cgd d->bd_rtout = tv->tv_sec * hz + tv->tv_usec / tick;
1092 1.33 thorpej if ((d->bd_rtout == 0) && (tv->tv_usec != 0))
1093 1.33 thorpej d->bd_rtout = 1;
1094 1.1 cgd break;
1095 1.1 cgd }
1096 1.1 cgd
1097 1.142 christos #ifdef BIOCGORTIMEOUT
1098 1.142 christos /*
1099 1.142 christos * Get read timeout.
1100 1.142 christos */
1101 1.142 christos case BIOCGORTIMEOUT:
1102 1.142 christos {
1103 1.142 christos struct timeval50 *tv = addr;
1104 1.142 christos
1105 1.142 christos tv->tv_sec = d->bd_rtout / hz;
1106 1.142 christos tv->tv_usec = (d->bd_rtout % hz) * tick;
1107 1.142 christos break;
1108 1.142 christos }
1109 1.142 christos #endif
1110 1.142 christos
1111 1.142 christos #ifdef BIOCSORTIMEOUT
1112 1.142 christos /*
1113 1.142 christos * Set read timeout.
1114 1.142 christos */
1115 1.142 christos case BIOCSORTIMEOUT:
1116 1.142 christos {
1117 1.142 christos struct timeval50 *tv = addr;
1118 1.142 christos
1119 1.142 christos /* Compute number of ticks. */
1120 1.142 christos d->bd_rtout = tv->tv_sec * hz + tv->tv_usec / tick;
1121 1.142 christos if ((d->bd_rtout == 0) && (tv->tv_usec != 0))
1122 1.142 christos d->bd_rtout = 1;
1123 1.142 christos break;
1124 1.142 christos }
1125 1.142 christos #endif
1126 1.142 christos
1127 1.1 cgd /*
1128 1.1 cgd * Get read timeout.
1129 1.1 cgd */
1130 1.12 mycroft case BIOCGRTIMEOUT:
1131 1.1 cgd {
1132 1.103 christos struct timeval *tv = addr;
1133 1.1 cgd
1134 1.19 cgd tv->tv_sec = d->bd_rtout / hz;
1135 1.19 cgd tv->tv_usec = (d->bd_rtout % hz) * tick;
1136 1.1 cgd break;
1137 1.1 cgd }
1138 1.1 cgd /*
1139 1.1 cgd * Get packet stats.
1140 1.1 cgd */
1141 1.1 cgd case BIOCGSTATS:
1142 1.1 cgd {
1143 1.103 christos struct bpf_stat *bs = addr;
1144 1.1 cgd
1145 1.1 cgd bs->bs_recv = d->bd_rcount;
1146 1.1 cgd bs->bs_drop = d->bd_dcount;
1147 1.94 darrenr bs->bs_capt = d->bd_ccount;
1148 1.94 darrenr break;
1149 1.94 darrenr }
1150 1.94 darrenr
1151 1.94 darrenr case BIOCGSTATSOLD:
1152 1.94 darrenr {
1153 1.103 christos struct bpf_stat_old *bs = addr;
1154 1.94 darrenr
1155 1.94 darrenr bs->bs_recv = d->bd_rcount;
1156 1.94 darrenr bs->bs_drop = d->bd_dcount;
1157 1.1 cgd break;
1158 1.1 cgd }
1159 1.1 cgd
1160 1.1 cgd /*
1161 1.1 cgd * Set immediate mode.
1162 1.1 cgd */
1163 1.1 cgd case BIOCIMMEDIATE:
1164 1.1 cgd d->bd_immediate = *(u_int *)addr;
1165 1.1 cgd break;
1166 1.2 cgd
1167 1.2 cgd case BIOCVERSION:
1168 1.2 cgd {
1169 1.103 christos struct bpf_version *bv = addr;
1170 1.2 cgd
1171 1.2 cgd bv->bv_major = BPF_MAJOR_VERSION;
1172 1.2 cgd bv->bv_minor = BPF_MINOR_VERSION;
1173 1.2 cgd break;
1174 1.12 mycroft }
1175 1.23 thorpej
1176 1.40 thorpej case BIOCGHDRCMPLT: /* get "header already complete" flag */
1177 1.40 thorpej *(u_int *)addr = d->bd_hdrcmplt;
1178 1.40 thorpej break;
1179 1.40 thorpej
1180 1.40 thorpej case BIOCSHDRCMPLT: /* set "header already complete" flag */
1181 1.40 thorpej d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0;
1182 1.40 thorpej break;
1183 1.23 thorpej
1184 1.91 darrenr /*
1185 1.91 darrenr * Get "see sent packets" flag
1186 1.91 darrenr */
1187 1.91 darrenr case BIOCGSEESENT:
1188 1.91 darrenr *(u_int *)addr = d->bd_seesent;
1189 1.91 darrenr break;
1190 1.91 darrenr
1191 1.91 darrenr /*
1192 1.91 darrenr * Set "see sent" packets flag
1193 1.91 darrenr */
1194 1.91 darrenr case BIOCSSEESENT:
1195 1.91 darrenr d->bd_seesent = *(u_int *)addr;
1196 1.91 darrenr break;
1197 1.91 darrenr
1198 1.156 christos /*
1199 1.156 christos * Set "feed packets from bpf back to input" mode
1200 1.156 christos */
1201 1.156 christos case BIOCSFEEDBACK:
1202 1.156 christos d->bd_feedback = *(u_int *)addr;
1203 1.156 christos break;
1204 1.156 christos
1205 1.156 christos /*
1206 1.156 christos * Get "feed packets from bpf back to input" mode
1207 1.156 christos */
1208 1.156 christos case BIOCGFEEDBACK:
1209 1.156 christos *(u_int *)addr = d->bd_feedback;
1210 1.156 christos break;
1211 1.156 christos
1212 1.23 thorpej case FIONBIO: /* Non-blocking I/O */
1213 1.93 darrenr /*
1214 1.93 darrenr * No need to do anything special as we use IO_NDELAY in
1215 1.93 darrenr * bpfread() as an indication of whether or not to block
1216 1.93 darrenr * the read.
1217 1.93 darrenr */
1218 1.23 thorpej break;
1219 1.23 thorpej
1220 1.23 thorpej case FIOASYNC: /* Send signal on receive packets */
1221 1.222 ozaki mutex_enter(d->bd_mtx);
1222 1.23 thorpej d->bd_async = *(int *)addr;
1223 1.222 ozaki mutex_exit(d->bd_mtx);
1224 1.23 thorpej break;
1225 1.23 thorpej
1226 1.23 thorpej case TIOCSPGRP: /* Process or group to send signals to */
1227 1.85 jdolecek case FIOSETOWN:
1228 1.135 ad error = fsetown(&d->bd_pgid, cmd, addr);
1229 1.23 thorpej break;
1230 1.23 thorpej
1231 1.23 thorpej case TIOCGPGRP:
1232 1.85 jdolecek case FIOGETOWN:
1233 1.135 ad error = fgetown(d->bd_pgid, cmd, addr);
1234 1.23 thorpej break;
1235 1.1 cgd }
1236 1.1 cgd return (error);
1237 1.1 cgd }
1238 1.1 cgd
1239 1.12 mycroft /*
1240 1.2 cgd * Set d's packet filter program to fp. If this file already has a filter,
1241 1.1 cgd * free it and replace it. Returns EINVAL for bogus requests.
1242 1.1 cgd */
1243 1.204 ozaki static int
1244 1.103 christos bpf_setf(struct bpf_d *d, struct bpf_program *fp)
1245 1.1 cgd {
1246 1.213 ozaki struct bpf_insn *fcode;
1247 1.213 ozaki bpfjit_func_t jcode;
1248 1.213 ozaki size_t flen, size = 0;
1249 1.213 ozaki struct bpf_filter *oldf, *newf;
1250 1.1 cgd
1251 1.173 alnsn jcode = NULL;
1252 1.169 rmind flen = fp->bf_len;
1253 1.169 rmind
1254 1.169 rmind if ((fp->bf_insns == NULL && flen) || flen > BPF_MAXINSNS) {
1255 1.169 rmind return EINVAL;
1256 1.169 rmind }
1257 1.169 rmind
1258 1.169 rmind if (flen) {
1259 1.169 rmind /*
1260 1.169 rmind * Allocate the buffer, copy the byte-code from
1261 1.169 rmind * userspace and validate it.
1262 1.169 rmind */
1263 1.169 rmind size = flen * sizeof(*fp->bf_insns);
1264 1.208 ozaki fcode = kmem_alloc(size, KM_SLEEP);
1265 1.169 rmind if (copyin(fp->bf_insns, fcode, size) != 0 ||
1266 1.169 rmind !bpf_validate(fcode, (int)flen)) {
1267 1.208 ozaki kmem_free(fcode, size);
1268 1.169 rmind return EINVAL;
1269 1.169 rmind }
1270 1.173 alnsn membar_consumer();
1271 1.183 alnsn if (bpf_jit)
1272 1.183 alnsn jcode = bpf_jit_generate(NULL, fcode, flen);
1273 1.169 rmind } else {
1274 1.169 rmind fcode = NULL;
1275 1.1 cgd }
1276 1.1 cgd
1277 1.213 ozaki newf = kmem_alloc(sizeof(*newf), KM_SLEEP);
1278 1.213 ozaki newf->bf_insn = fcode;
1279 1.213 ozaki newf->bf_size = size;
1280 1.213 ozaki newf->bf_jitcode = jcode;
1281 1.213 ozaki d->bd_jitcode = jcode; /* XXX just for kvm(3) users */
1282 1.208 ozaki
1283 1.213 ozaki /* Need to hold bpf_mtx for pserialize_perform */
1284 1.213 ozaki mutex_enter(&bpf_mtx);
1285 1.213 ozaki mutex_enter(d->bd_mtx);
1286 1.213 ozaki oldf = d->bd_filter;
1287 1.213 ozaki d->bd_filter = newf;
1288 1.213 ozaki membar_producer();
1289 1.169 rmind reset_d(d);
1290 1.213 ozaki pserialize_perform(bpf_psz);
1291 1.213 ozaki mutex_exit(d->bd_mtx);
1292 1.213 ozaki mutex_exit(&bpf_mtx);
1293 1.1 cgd
1294 1.213 ozaki if (oldf != NULL)
1295 1.213 ozaki bpf_free_filter(oldf);
1296 1.173 alnsn
1297 1.169 rmind return 0;
1298 1.1 cgd }
1299 1.1 cgd
1300 1.1 cgd /*
1301 1.2 cgd * Detach a file from its current interface (if attached at all) and attach
1302 1.2 cgd * to the interface indicated by the name stored in ifr.
1303 1.2 cgd * Return an errno or 0.
1304 1.1 cgd */
1305 1.1 cgd static int
1306 1.103 christos bpf_setif(struct bpf_d *d, struct ifreq *ifr)
1307 1.1 cgd {
1308 1.1 cgd struct bpf_if *bp;
1309 1.1 cgd char *cp;
1310 1.213 ozaki int unit_seen, i, error;
1311 1.1 cgd
1312 1.192 christos KASSERT(mutex_owned(&bpf_mtx));
1313 1.1 cgd /*
1314 1.26 thorpej * Make sure the provided name has a unit number, and default
1315 1.26 thorpej * it to '0' if not specified.
1316 1.26 thorpej * XXX This is ugly ... do this differently?
1317 1.1 cgd */
1318 1.26 thorpej unit_seen = 0;
1319 1.1 cgd cp = ifr->ifr_name;
1320 1.26 thorpej cp[sizeof(ifr->ifr_name) - 1] = '\0'; /* sanity */
1321 1.26 thorpej while (*cp++)
1322 1.26 thorpej if (*cp >= '0' && *cp <= '9')
1323 1.26 thorpej unit_seen = 1;
1324 1.26 thorpej if (!unit_seen) {
1325 1.26 thorpej /* Make sure to leave room for the '\0'. */
1326 1.26 thorpej for (i = 0; i < (IFNAMSIZ - 1); ++i) {
1327 1.26 thorpej if ((ifr->ifr_name[i] >= 'a' &&
1328 1.26 thorpej ifr->ifr_name[i] <= 'z') ||
1329 1.26 thorpej (ifr->ifr_name[i] >= 'A' &&
1330 1.26 thorpej ifr->ifr_name[i] <= 'Z'))
1331 1.26 thorpej continue;
1332 1.26 thorpej ifr->ifr_name[i] = '0';
1333 1.1 cgd }
1334 1.1 cgd }
1335 1.26 thorpej
1336 1.1 cgd /*
1337 1.1 cgd * Look through attached interfaces for the named one.
1338 1.1 cgd */
1339 1.209 ozaki BPF_IFLIST_WRITER_FOREACH(bp) {
1340 1.1 cgd struct ifnet *ifp = bp->bif_ifp;
1341 1.1 cgd
1342 1.187 ozaki if (ifp == NULL ||
1343 1.26 thorpej strcmp(ifp->if_xname, ifr->ifr_name) != 0)
1344 1.1 cgd continue;
1345 1.66 onoe /* skip additional entry */
1346 1.152 pooka if (bp->bif_driverp != &ifp->if_bpf)
1347 1.66 onoe continue;
1348 1.1 cgd /*
1349 1.2 cgd * We found the requested interface.
1350 1.2 cgd * Allocate the packet buffers if we need to.
1351 1.2 cgd * If we're already attached to requested interface,
1352 1.2 cgd * just flush the buffer.
1353 1.1 cgd */
1354 1.213 ozaki /*
1355 1.213 ozaki * bpf_allocbufs is called only here. bpf_mtx ensures that
1356 1.213 ozaki * no race condition happen on d->bd_sbuf.
1357 1.213 ozaki */
1358 1.187 ozaki if (d->bd_sbuf == NULL) {
1359 1.2 cgd error = bpf_allocbufs(d);
1360 1.2 cgd if (error != 0)
1361 1.2 cgd return (error);
1362 1.2 cgd }
1363 1.213 ozaki mutex_enter(d->bd_mtx);
1364 1.1 cgd if (bp != d->bd_bif) {
1365 1.216 ozaki if (d->bd_bif) {
1366 1.12 mycroft /*
1367 1.1 cgd * Detach if attached to something else.
1368 1.1 cgd */
1369 1.1 cgd bpf_detachd(d);
1370 1.216 ozaki BPFIF_DLIST_ENTRY_INIT(d);
1371 1.216 ozaki }
1372 1.1 cgd
1373 1.1 cgd bpf_attachd(d, bp);
1374 1.1 cgd }
1375 1.1 cgd reset_d(d);
1376 1.213 ozaki mutex_exit(d->bd_mtx);
1377 1.1 cgd return (0);
1378 1.1 cgd }
1379 1.1 cgd /* Not found. */
1380 1.1 cgd return (ENXIO);
1381 1.1 cgd }
1382 1.1 cgd
1383 1.1 cgd /*
1384 1.26 thorpej * Copy the interface name to the ifreq.
1385 1.1 cgd */
1386 1.1 cgd static void
1387 1.103 christos bpf_ifname(struct ifnet *ifp, struct ifreq *ifr)
1388 1.1 cgd {
1389 1.41 perry memcpy(ifr->ifr_name, ifp->if_xname, IFNAMSIZ);
1390 1.1 cgd }
1391 1.1 cgd
1392 1.145 christos static int
1393 1.145 christos bpf_stat(struct file *fp, struct stat *st)
1394 1.145 christos {
1395 1.188 matt struct bpf_d *d = fp->f_bpf;
1396 1.145 christos
1397 1.145 christos (void)memset(st, 0, sizeof(*st));
1398 1.213 ozaki mutex_enter(d->bd_mtx);
1399 1.145 christos st->st_dev = makedev(cdevsw_lookup_major(&bpf_cdevsw), d->bd_pid);
1400 1.145 christos st->st_atimespec = d->bd_atime;
1401 1.145 christos st->st_mtimespec = d->bd_mtime;
1402 1.145 christos st->st_ctimespec = st->st_birthtimespec = d->bd_btime;
1403 1.146 christos st->st_uid = kauth_cred_geteuid(fp->f_cred);
1404 1.146 christos st->st_gid = kauth_cred_getegid(fp->f_cred);
1405 1.164 christos st->st_mode = S_IFCHR;
1406 1.213 ozaki mutex_exit(d->bd_mtx);
1407 1.145 christos return 0;
1408 1.145 christos }
1409 1.145 christos
1410 1.1 cgd /*
1411 1.36 christos * Support for poll() system call
1412 1.1 cgd *
1413 1.64 darrenr * Return true iff the specific operation will not block indefinitely - with
1414 1.64 darrenr * the assumption that it is safe to positively acknowledge a request for the
1415 1.64 darrenr * ability to write to the BPF device.
1416 1.134 rmind * Otherwise, return false but make a note that a selnotify() must be done.
1417 1.1 cgd */
1418 1.105 christos static int
1419 1.135 ad bpf_poll(struct file *fp, int events)
1420 1.1 cgd {
1421 1.188 matt struct bpf_d *d = fp->f_bpf;
1422 1.64 darrenr int revents;
1423 1.12 mycroft
1424 1.110 rpaulo /*
1425 1.110 rpaulo * Refresh the PID associated with this bpf file.
1426 1.110 rpaulo */
1427 1.213 ozaki mutex_enter(&bpf_mtx);
1428 1.135 ad d->bd_pid = curproc->p_pid;
1429 1.120 christos
1430 1.64 darrenr revents = events & (POLLOUT | POLLWRNORM);
1431 1.44 thorpej if (events & (POLLIN | POLLRDNORM)) {
1432 1.64 darrenr /*
1433 1.64 darrenr * An imitation of the FIONREAD ioctl code.
1434 1.64 darrenr */
1435 1.213 ozaki mutex_enter(d->bd_mtx);
1436 1.138 scw if (d->bd_hlen != 0 ||
1437 1.138 scw ((d->bd_immediate || d->bd_state == BPF_TIMED_OUT) &&
1438 1.138 scw d->bd_slen != 0)) {
1439 1.30 mycroft revents |= events & (POLLIN | POLLRDNORM);
1440 1.92 darrenr } else {
1441 1.135 ad selrecord(curlwp, &d->bd_sel);
1442 1.91 darrenr /* Start the read timeout if necessary */
1443 1.91 darrenr if (d->bd_rtout > 0 && d->bd_state == BPF_IDLE) {
1444 1.91 darrenr callout_reset(&d->bd_callout, d->bd_rtout,
1445 1.91 darrenr bpf_timed_out, d);
1446 1.91 darrenr d->bd_state = BPF_WAITING;
1447 1.91 darrenr }
1448 1.91 darrenr }
1449 1.213 ozaki mutex_exit(d->bd_mtx);
1450 1.44 thorpej }
1451 1.12 mycroft
1452 1.213 ozaki mutex_exit(&bpf_mtx);
1453 1.30 mycroft return (revents);
1454 1.75 jdolecek }
1455 1.75 jdolecek
1456 1.75 jdolecek static void
1457 1.75 jdolecek filt_bpfrdetach(struct knote *kn)
1458 1.75 jdolecek {
1459 1.75 jdolecek struct bpf_d *d = kn->kn_hook;
1460 1.75 jdolecek
1461 1.213 ozaki mutex_enter(d->bd_buf_mtx);
1462 1.76 christos SLIST_REMOVE(&d->bd_sel.sel_klist, kn, knote, kn_selnext);
1463 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1464 1.75 jdolecek }
1465 1.75 jdolecek
1466 1.75 jdolecek static int
1467 1.125 christos filt_bpfread(struct knote *kn, long hint)
1468 1.75 jdolecek {
1469 1.75 jdolecek struct bpf_d *d = kn->kn_hook;
1470 1.140 ad int rv;
1471 1.75 jdolecek
1472 1.213 ozaki mutex_enter(d->bd_buf_mtx);
1473 1.75 jdolecek kn->kn_data = d->bd_hlen;
1474 1.75 jdolecek if (d->bd_immediate)
1475 1.75 jdolecek kn->kn_data += d->bd_slen;
1476 1.140 ad rv = (kn->kn_data > 0);
1477 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1478 1.140 ad return rv;
1479 1.75 jdolecek }
1480 1.75 jdolecek
1481 1.218 maya static const struct filterops bpfread_filtops = {
1482 1.218 maya .f_isfd = 1,
1483 1.218 maya .f_attach = NULL,
1484 1.218 maya .f_detach = filt_bpfrdetach,
1485 1.218 maya .f_event = filt_bpfread,
1486 1.218 maya };
1487 1.75 jdolecek
1488 1.105 christos static int
1489 1.105 christos bpf_kqfilter(struct file *fp, struct knote *kn)
1490 1.75 jdolecek {
1491 1.188 matt struct bpf_d *d = fp->f_bpf;
1492 1.75 jdolecek struct klist *klist;
1493 1.140 ad
1494 1.213 ozaki mutex_enter(d->bd_buf_mtx);
1495 1.75 jdolecek switch (kn->kn_filter) {
1496 1.75 jdolecek case EVFILT_READ:
1497 1.76 christos klist = &d->bd_sel.sel_klist;
1498 1.75 jdolecek kn->kn_fop = &bpfread_filtops;
1499 1.75 jdolecek break;
1500 1.75 jdolecek
1501 1.75 jdolecek default:
1502 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1503 1.131 pooka return (EINVAL);
1504 1.75 jdolecek }
1505 1.75 jdolecek
1506 1.75 jdolecek kn->kn_hook = d;
1507 1.75 jdolecek
1508 1.75 jdolecek SLIST_INSERT_HEAD(klist, kn, kn_selnext);
1509 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1510 1.75 jdolecek
1511 1.75 jdolecek return (0);
1512 1.1 cgd }
1513 1.1 cgd
1514 1.1 cgd /*
1515 1.1 cgd * Copy data from an mbuf chain into a buffer. This code is derived
1516 1.1 cgd * from m_copydata in sys/uipc_mbuf.c.
1517 1.1 cgd */
1518 1.43 perry static void *
1519 1.137 christos bpf_mcpy(void *dst_arg, const void *src_arg, size_t len)
1520 1.12 mycroft {
1521 1.137 christos const struct mbuf *m;
1522 1.53 augustss u_int count;
1523 1.1 cgd u_char *dst;
1524 1.1 cgd
1525 1.12 mycroft m = src_arg;
1526 1.12 mycroft dst = dst_arg;
1527 1.1 cgd while (len > 0) {
1528 1.137 christos if (m == NULL)
1529 1.41 perry panic("bpf_mcpy");
1530 1.12 mycroft count = min(m->m_len, len);
1531 1.137 christos memcpy(dst, mtod(m, const void *), count);
1532 1.1 cgd m = m->m_next;
1533 1.1 cgd dst += count;
1534 1.1 cgd len -= count;
1535 1.1 cgd }
1536 1.137 christos return dst_arg;
1537 1.1 cgd }
1538 1.1 cgd
1539 1.1 cgd /*
1540 1.96 dyoung * Dispatch a packet to all the listeners on interface bp.
1541 1.96 dyoung *
1542 1.169 rmind * pkt pointer to the packet, either a data buffer or an mbuf chain
1543 1.169 rmind * buflen buffer length, if pkt is a data buffer
1544 1.169 rmind * cpfn a function that can copy pkt into the listener's buffer
1545 1.96 dyoung * pktlen length of the packet
1546 1.169 rmind * rcv true if packet came in
1547 1.96 dyoung */
1548 1.114 perry static inline void
1549 1.137 christos bpf_deliver(struct bpf_if *bp, void *(*cpfn)(void *, const void *, size_t),
1550 1.169 rmind void *pkt, u_int pktlen, u_int buflen, const bool rcv)
1551 1.96 dyoung {
1552 1.189 rmind uint32_t mem[BPF_MEMWORDS];
1553 1.184 christos bpf_args_t args = {
1554 1.184 christos .pkt = (const uint8_t *)pkt,
1555 1.184 christos .wirelen = pktlen,
1556 1.184 christos .buflen = buflen,
1557 1.189 rmind .mem = mem,
1558 1.184 christos .arg = NULL
1559 1.184 christos };
1560 1.169 rmind bool gottime = false;
1561 1.189 rmind struct timespec ts;
1562 1.209 ozaki struct bpf_d *d;
1563 1.213 ozaki int s;
1564 1.213 ozaki
1565 1.213 ozaki KASSERT(!cpu_intr_p());
1566 1.169 rmind
1567 1.169 rmind /*
1568 1.169 rmind * Note that the IPL does not have to be raised at this point.
1569 1.169 rmind * The only problem that could arise here is that if two different
1570 1.169 rmind * interfaces shared any data. This is not the case.
1571 1.169 rmind */
1572 1.213 ozaki s = pserialize_read_enter();
1573 1.209 ozaki BPFIF_DLIST_READER_FOREACH(d, bp) {
1574 1.213 ozaki u_int slen = 0;
1575 1.213 ozaki struct bpf_filter *filter;
1576 1.96 dyoung
1577 1.169 rmind if (!d->bd_seesent && !rcv) {
1578 1.96 dyoung continue;
1579 1.120 christos }
1580 1.213 ozaki atomic_inc_ulong(&d->bd_rcount);
1581 1.210 ozaki BPF_STATINC(recv);
1582 1.169 rmind
1583 1.213 ozaki filter = d->bd_filter;
1584 1.213 ozaki membar_datadep_consumer();
1585 1.213 ozaki if (filter != NULL) {
1586 1.213 ozaki if (filter->bf_jitcode != NULL)
1587 1.213 ozaki slen = filter->bf_jitcode(NULL, &args);
1588 1.213 ozaki else
1589 1.213 ozaki slen = bpf_filter_ext(NULL, filter->bf_insn,
1590 1.213 ozaki &args);
1591 1.213 ozaki }
1592 1.173 alnsn
1593 1.169 rmind if (!slen) {
1594 1.169 rmind continue;
1595 1.169 rmind }
1596 1.169 rmind if (!gottime) {
1597 1.169 rmind gottime = true;
1598 1.169 rmind nanotime(&ts);
1599 1.169 rmind }
1600 1.213 ozaki /* Assume catchpacket doesn't sleep */
1601 1.169 rmind catchpacket(d, pkt, pktlen, slen, cpfn, &ts);
1602 1.96 dyoung }
1603 1.213 ozaki pserialize_read_exit(s);
1604 1.96 dyoung }
1605 1.96 dyoung
1606 1.96 dyoung /*
1607 1.169 rmind * Incoming linkage from device drivers. Process the packet pkt, of length
1608 1.169 rmind * pktlen, which is stored in a contiguous buffer. The packet is parsed
1609 1.169 rmind * by each process' filter, and if accepted, stashed into the corresponding
1610 1.169 rmind * buffer.
1611 1.169 rmind */
1612 1.169 rmind static void
1613 1.169 rmind _bpf_tap(struct bpf_if *bp, u_char *pkt, u_int pktlen)
1614 1.169 rmind {
1615 1.169 rmind
1616 1.171 alnsn bpf_deliver(bp, memcpy, pkt, pktlen, pktlen, true);
1617 1.169 rmind }
1618 1.169 rmind
1619 1.169 rmind /*
1620 1.96 dyoung * Incoming linkage from device drivers, when the head of the packet is in
1621 1.96 dyoung * a buffer, and the tail is in an mbuf chain.
1622 1.96 dyoung */
1623 1.153 pooka static void
1624 1.157 joerg _bpf_mtap2(struct bpf_if *bp, void *data, u_int dlen, struct mbuf *m)
1625 1.96 dyoung {
1626 1.96 dyoung u_int pktlen;
1627 1.96 dyoung struct mbuf mb;
1628 1.96 dyoung
1629 1.156 christos /* Skip outgoing duplicate packets. */
1630 1.198 ozaki if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif_index == 0) {
1631 1.156 christos m->m_flags &= ~M_PROMISC;
1632 1.156 christos return;
1633 1.156 christos }
1634 1.156 christos
1635 1.101 dyoung pktlen = m_length(m) + dlen;
1636 1.96 dyoung
1637 1.96 dyoung /*
1638 1.96 dyoung * Craft on-stack mbuf suitable for passing to bpf_filter.
1639 1.96 dyoung * Note that we cut corners here; we only setup what's
1640 1.162 christos * absolutely needed--this mbuf should never go anywhere else.
1641 1.162 christos */
1642 1.101 dyoung (void)memset(&mb, 0, sizeof(mb));
1643 1.96 dyoung mb.m_next = m;
1644 1.96 dyoung mb.m_data = data;
1645 1.96 dyoung mb.m_len = dlen;
1646 1.96 dyoung
1647 1.198 ozaki bpf_deliver(bp, bpf_mcpy, &mb, pktlen, 0, m->m_pkthdr.rcvif_index != 0);
1648 1.96 dyoung }
1649 1.96 dyoung
1650 1.96 dyoung /*
1651 1.2 cgd * Incoming linkage from device drivers, when packet is in an mbuf chain.
1652 1.1 cgd */
1653 1.153 pooka static void
1654 1.157 joerg _bpf_mtap(struct bpf_if *bp, struct mbuf *m)
1655 1.1 cgd {
1656 1.137 christos void *(*cpfn)(void *, const void *, size_t);
1657 1.96 dyoung u_int pktlen, buflen;
1658 1.91 darrenr void *marg;
1659 1.1 cgd
1660 1.156 christos /* Skip outgoing duplicate packets. */
1661 1.198 ozaki if ((m->m_flags & M_PROMISC) != 0 && m->m_pkthdr.rcvif_index == 0) {
1662 1.156 christos m->m_flags &= ~M_PROMISC;
1663 1.156 christos return;
1664 1.156 christos }
1665 1.156 christos
1666 1.101 dyoung pktlen = m_length(m);
1667 1.1 cgd
1668 1.91 darrenr if (pktlen == m->m_len) {
1669 1.136 yamt cpfn = (void *)memcpy;
1670 1.91 darrenr marg = mtod(m, void *);
1671 1.91 darrenr buflen = pktlen;
1672 1.91 darrenr } else {
1673 1.91 darrenr cpfn = bpf_mcpy;
1674 1.91 darrenr marg = m;
1675 1.91 darrenr buflen = 0;
1676 1.91 darrenr }
1677 1.91 darrenr
1678 1.198 ozaki bpf_deliver(bp, cpfn, marg, pktlen, buflen, m->m_pkthdr.rcvif_index != 0);
1679 1.1 cgd }
1680 1.1 cgd
1681 1.1 cgd /*
1682 1.104 christos * We need to prepend the address family as
1683 1.104 christos * a four byte field. Cons up a dummy header
1684 1.104 christos * to pacify bpf. This is safe because bpf
1685 1.104 christos * will only read from the mbuf (i.e., it won't
1686 1.104 christos * try to free it or keep a pointer a to it).
1687 1.104 christos */
1688 1.153 pooka static void
1689 1.157 joerg _bpf_mtap_af(struct bpf_if *bp, uint32_t af, struct mbuf *m)
1690 1.104 christos {
1691 1.104 christos struct mbuf m0;
1692 1.107 perry
1693 1.104 christos m0.m_flags = 0;
1694 1.104 christos m0.m_next = m;
1695 1.104 christos m0.m_len = 4;
1696 1.104 christos m0.m_data = (char *)⁡
1697 1.104 christos
1698 1.157 joerg _bpf_mtap(bp, &m0);
1699 1.104 christos }
1700 1.104 christos
1701 1.104 christos /*
1702 1.104 christos * Put the SLIP pseudo-"link header" in place.
1703 1.104 christos * Note this M_PREPEND() should never fail,
1704 1.104 christos * swince we know we always have enough space
1705 1.104 christos * in the input buffer.
1706 1.104 christos */
1707 1.153 pooka static void
1708 1.157 joerg _bpf_mtap_sl_in(struct bpf_if *bp, u_char *chdr, struct mbuf **m)
1709 1.104 christos {
1710 1.104 christos u_char *hp;
1711 1.104 christos
1712 1.104 christos M_PREPEND(*m, SLIP_HDRLEN, M_DONTWAIT);
1713 1.104 christos if (*m == NULL)
1714 1.104 christos return;
1715 1.104 christos
1716 1.104 christos hp = mtod(*m, u_char *);
1717 1.104 christos hp[SLX_DIR] = SLIPDIR_IN;
1718 1.104 christos (void)memcpy(&hp[SLX_CHDR], chdr, CHDR_LEN);
1719 1.104 christos
1720 1.157 joerg _bpf_mtap(bp, *m);
1721 1.104 christos
1722 1.104 christos m_adj(*m, SLIP_HDRLEN);
1723 1.104 christos }
1724 1.104 christos
1725 1.104 christos /*
1726 1.104 christos * Put the SLIP pseudo-"link header" in
1727 1.104 christos * place. The compressed header is now
1728 1.104 christos * at the beginning of the mbuf.
1729 1.104 christos */
1730 1.153 pooka static void
1731 1.157 joerg _bpf_mtap_sl_out(struct bpf_if *bp, u_char *chdr, struct mbuf *m)
1732 1.104 christos {
1733 1.104 christos struct mbuf m0;
1734 1.104 christos u_char *hp;
1735 1.104 christos
1736 1.104 christos m0.m_flags = 0;
1737 1.104 christos m0.m_next = m;
1738 1.104 christos m0.m_data = m0.m_dat;
1739 1.104 christos m0.m_len = SLIP_HDRLEN;
1740 1.104 christos
1741 1.104 christos hp = mtod(&m0, u_char *);
1742 1.104 christos
1743 1.104 christos hp[SLX_DIR] = SLIPDIR_OUT;
1744 1.104 christos (void)memcpy(&hp[SLX_CHDR], chdr, CHDR_LEN);
1745 1.104 christos
1746 1.157 joerg _bpf_mtap(bp, &m0);
1747 1.104 christos m_freem(m);
1748 1.104 christos }
1749 1.104 christos
1750 1.205 ozaki static struct mbuf *
1751 1.205 ozaki bpf_mbuf_enqueue(struct bpf_if *bp, struct mbuf *m)
1752 1.205 ozaki {
1753 1.205 ozaki struct mbuf *dup;
1754 1.205 ozaki
1755 1.205 ozaki dup = m_dup(m, 0, M_COPYALL, M_NOWAIT);
1756 1.205 ozaki if (dup == NULL)
1757 1.205 ozaki return NULL;
1758 1.205 ozaki
1759 1.205 ozaki if (bp->bif_mbuf_tail != NULL) {
1760 1.205 ozaki bp->bif_mbuf_tail->m_nextpkt = dup;
1761 1.205 ozaki } else {
1762 1.205 ozaki bp->bif_mbuf_head = dup;
1763 1.205 ozaki }
1764 1.205 ozaki bp->bif_mbuf_tail = dup;
1765 1.205 ozaki #ifdef BPF_MTAP_SOFTINT_DEBUG
1766 1.205 ozaki log(LOG_DEBUG, "%s: enqueued mbuf=%p to %s\n",
1767 1.205 ozaki __func__, dup, bp->bif_ifp->if_xname);
1768 1.205 ozaki #endif
1769 1.205 ozaki
1770 1.205 ozaki return dup;
1771 1.205 ozaki }
1772 1.205 ozaki
1773 1.205 ozaki static struct mbuf *
1774 1.205 ozaki bpf_mbuf_dequeue(struct bpf_if *bp)
1775 1.205 ozaki {
1776 1.205 ozaki struct mbuf *m;
1777 1.205 ozaki int s;
1778 1.205 ozaki
1779 1.213 ozaki /* XXX NOMPSAFE: assumed running on one CPU */
1780 1.205 ozaki s = splnet();
1781 1.205 ozaki m = bp->bif_mbuf_head;
1782 1.205 ozaki if (m != NULL) {
1783 1.205 ozaki bp->bif_mbuf_head = m->m_nextpkt;
1784 1.205 ozaki m->m_nextpkt = NULL;
1785 1.205 ozaki
1786 1.205 ozaki if (bp->bif_mbuf_head == NULL)
1787 1.205 ozaki bp->bif_mbuf_tail = NULL;
1788 1.205 ozaki #ifdef BPF_MTAP_SOFTINT_DEBUG
1789 1.205 ozaki log(LOG_DEBUG, "%s: dequeued mbuf=%p from %s\n",
1790 1.205 ozaki __func__, m, bp->bif_ifp->if_xname);
1791 1.205 ozaki #endif
1792 1.205 ozaki }
1793 1.205 ozaki splx(s);
1794 1.205 ozaki
1795 1.205 ozaki return m;
1796 1.205 ozaki }
1797 1.205 ozaki
1798 1.205 ozaki static void
1799 1.205 ozaki bpf_mtap_si(void *arg)
1800 1.205 ozaki {
1801 1.205 ozaki struct bpf_if *bp = arg;
1802 1.205 ozaki struct mbuf *m;
1803 1.205 ozaki
1804 1.205 ozaki while ((m = bpf_mbuf_dequeue(bp)) != NULL) {
1805 1.205 ozaki #ifdef BPF_MTAP_SOFTINT_DEBUG
1806 1.205 ozaki log(LOG_DEBUG, "%s: tapping mbuf=%p on %s\n",
1807 1.205 ozaki __func__, m, bp->bif_ifp->if_xname);
1808 1.205 ozaki #endif
1809 1.205 ozaki bpf_ops->bpf_mtap(bp, m);
1810 1.205 ozaki m_freem(m);
1811 1.205 ozaki }
1812 1.205 ozaki }
1813 1.205 ozaki
1814 1.206 ozaki static void
1815 1.206 ozaki _bpf_mtap_softint(struct ifnet *ifp, struct mbuf *m)
1816 1.205 ozaki {
1817 1.205 ozaki struct bpf_if *bp = ifp->if_bpf;
1818 1.205 ozaki struct mbuf *dup;
1819 1.205 ozaki
1820 1.205 ozaki KASSERT(cpu_intr_p());
1821 1.205 ozaki
1822 1.206 ozaki /* To avoid extra invocations of the softint */
1823 1.209 ozaki if (BPFIF_DLIST_READER_EMPTY(bp))
1824 1.205 ozaki return;
1825 1.205 ozaki KASSERT(bp->bif_si != NULL);
1826 1.205 ozaki
1827 1.205 ozaki dup = bpf_mbuf_enqueue(bp, m);
1828 1.205 ozaki if (dup != NULL)
1829 1.205 ozaki softint_schedule(bp->bif_si);
1830 1.205 ozaki }
1831 1.205 ozaki
1832 1.166 bouyer static int
1833 1.166 bouyer bpf_hdrlen(struct bpf_d *d)
1834 1.166 bouyer {
1835 1.166 bouyer int hdrlen = d->bd_bif->bif_hdrlen;
1836 1.166 bouyer /*
1837 1.166 bouyer * Compute the length of the bpf header. This is not necessarily
1838 1.166 bouyer * equal to SIZEOF_BPF_HDR because we want to insert spacing such
1839 1.166 bouyer * that the network layer header begins on a longword boundary (for
1840 1.166 bouyer * performance reasons and to alleviate alignment restrictions).
1841 1.166 bouyer */
1842 1.166 bouyer #ifdef _LP64
1843 1.166 bouyer if (d->bd_compat32)
1844 1.166 bouyer return (BPF_WORDALIGN32(hdrlen + SIZEOF_BPF_HDR32) - hdrlen);
1845 1.166 bouyer else
1846 1.166 bouyer #endif
1847 1.166 bouyer return (BPF_WORDALIGN(hdrlen + SIZEOF_BPF_HDR) - hdrlen);
1848 1.166 bouyer }
1849 1.168 christos
1850 1.104 christos /*
1851 1.1 cgd * Move the packet data from interface memory (pkt) into the
1852 1.168 christos * store buffer. Call the wakeup functions if it's time to wakeup
1853 1.168 christos * a listener (buffer full), "cpfn" is the routine called to do the
1854 1.168 christos * actual data transfer. memcpy is passed in to copy contiguous chunks,
1855 1.168 christos * while bpf_mcpy is passed in to copy mbuf chains. In the latter case,
1856 1.2 cgd * pkt is really an mbuf.
1857 1.1 cgd */
1858 1.1 cgd static void
1859 1.103 christos catchpacket(struct bpf_d *d, u_char *pkt, u_int pktlen, u_int snaplen,
1860 1.142 christos void *(*cpfn)(void *, const void *, size_t), struct timespec *ts)
1861 1.53 augustss {
1862 1.176 christos char *h;
1863 1.176 christos int totlen, curlen, caplen;
1864 1.166 bouyer int hdrlen = bpf_hdrlen(d);
1865 1.138 scw int do_wakeup = 0;
1866 1.94 darrenr
1867 1.213 ozaki atomic_inc_ulong(&d->bd_ccount);
1868 1.210 ozaki BPF_STATINC(capt);
1869 1.1 cgd /*
1870 1.1 cgd * Figure out how many bytes to move. If the packet is
1871 1.1 cgd * greater or equal to the snapshot length, transfer that
1872 1.1 cgd * much. Otherwise, transfer the whole packet (unless
1873 1.1 cgd * we hit the buffer size limit).
1874 1.1 cgd */
1875 1.12 mycroft totlen = hdrlen + min(snaplen, pktlen);
1876 1.1 cgd if (totlen > d->bd_bufsize)
1877 1.1 cgd totlen = d->bd_bufsize;
1878 1.176 christos /*
1879 1.176 christos * If we adjusted totlen to fit the bufsize, it could be that
1880 1.176 christos * totlen is smaller than hdrlen because of the link layer header.
1881 1.176 christos */
1882 1.176 christos caplen = totlen - hdrlen;
1883 1.176 christos if (caplen < 0)
1884 1.176 christos caplen = 0;
1885 1.1 cgd
1886 1.213 ozaki mutex_enter(d->bd_buf_mtx);
1887 1.1 cgd /*
1888 1.1 cgd * Round up the end of the previous packet to the next longword.
1889 1.1 cgd */
1890 1.166 bouyer #ifdef _LP64
1891 1.166 bouyer if (d->bd_compat32)
1892 1.166 bouyer curlen = BPF_WORDALIGN32(d->bd_slen);
1893 1.166 bouyer else
1894 1.166 bouyer #endif
1895 1.166 bouyer curlen = BPF_WORDALIGN(d->bd_slen);
1896 1.1 cgd if (curlen + totlen > d->bd_bufsize) {
1897 1.1 cgd /*
1898 1.1 cgd * This packet will overflow the storage buffer.
1899 1.1 cgd * Rotate the buffers if we can, then wakeup any
1900 1.1 cgd * pending reads.
1901 1.1 cgd */
1902 1.187 ozaki if (d->bd_fbuf == NULL) {
1903 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1904 1.12 mycroft /*
1905 1.12 mycroft * We haven't completed the previous read yet,
1906 1.1 cgd * so drop the packet.
1907 1.1 cgd */
1908 1.213 ozaki atomic_inc_ulong(&d->bd_dcount);
1909 1.210 ozaki BPF_STATINC(drop);
1910 1.1 cgd return;
1911 1.1 cgd }
1912 1.1 cgd ROTATE_BUFFERS(d);
1913 1.138 scw do_wakeup = 1;
1914 1.1 cgd curlen = 0;
1915 1.138 scw } else if (d->bd_immediate || d->bd_state == BPF_TIMED_OUT) {
1916 1.138 scw /*
1917 1.138 scw * Immediate mode is set, or the read timeout has
1918 1.138 scw * already expired during a select call. A packet
1919 1.138 scw * arrived, so the reader should be woken up.
1920 1.138 scw */
1921 1.138 scw do_wakeup = 1;
1922 1.97 darrenr }
1923 1.1 cgd
1924 1.1 cgd /*
1925 1.1 cgd * Append the bpf header.
1926 1.1 cgd */
1927 1.176 christos h = (char *)d->bd_sbuf + curlen;
1928 1.166 bouyer #ifdef _LP64
1929 1.166 bouyer if (d->bd_compat32) {
1930 1.176 christos struct bpf_hdr32 *hp32;
1931 1.176 christos
1932 1.176 christos hp32 = (struct bpf_hdr32 *)h;
1933 1.166 bouyer hp32->bh_tstamp.tv_sec = ts->tv_sec;
1934 1.166 bouyer hp32->bh_tstamp.tv_usec = ts->tv_nsec / 1000;
1935 1.166 bouyer hp32->bh_datalen = pktlen;
1936 1.166 bouyer hp32->bh_hdrlen = hdrlen;
1937 1.176 christos hp32->bh_caplen = caplen;
1938 1.166 bouyer } else
1939 1.166 bouyer #endif
1940 1.166 bouyer {
1941 1.176 christos struct bpf_hdr *hp;
1942 1.176 christos
1943 1.176 christos hp = (struct bpf_hdr *)h;
1944 1.166 bouyer hp->bh_tstamp.tv_sec = ts->tv_sec;
1945 1.166 bouyer hp->bh_tstamp.tv_usec = ts->tv_nsec / 1000;
1946 1.166 bouyer hp->bh_datalen = pktlen;
1947 1.166 bouyer hp->bh_hdrlen = hdrlen;
1948 1.176 christos hp->bh_caplen = caplen;
1949 1.166 bouyer }
1950 1.176 christos
1951 1.176 christos /*
1952 1.176 christos * Copy the packet data into the store buffer and update its length.
1953 1.176 christos */
1954 1.176 christos (*cpfn)(h + hdrlen, pkt, caplen);
1955 1.1 cgd d->bd_slen = curlen + totlen;
1956 1.213 ozaki mutex_exit(d->bd_buf_mtx);
1957 1.97 darrenr
1958 1.97 darrenr /*
1959 1.97 darrenr * Call bpf_wakeup after bd_slen has been updated so that kevent(2)
1960 1.97 darrenr * will cause filt_bpfread() to be called with it adjusted.
1961 1.97 darrenr */
1962 1.138 scw if (do_wakeup)
1963 1.97 darrenr bpf_wakeup(d);
1964 1.1 cgd }
1965 1.1 cgd
1966 1.12 mycroft /*
1967 1.1 cgd * Initialize all nonzero fields of a descriptor.
1968 1.1 cgd */
1969 1.1 cgd static int
1970 1.103 christos bpf_allocbufs(struct bpf_d *d)
1971 1.1 cgd {
1972 1.50 enami
1973 1.208 ozaki d->bd_fbuf = kmem_alloc(d->bd_bufsize, KM_NOSLEEP);
1974 1.100 darrenr if (!d->bd_fbuf)
1975 1.79 itojun return (ENOBUFS);
1976 1.208 ozaki d->bd_sbuf = kmem_alloc(d->bd_bufsize, KM_NOSLEEP);
1977 1.100 darrenr if (!d->bd_sbuf) {
1978 1.208 ozaki kmem_free(d->bd_fbuf, d->bd_bufsize);
1979 1.79 itojun return (ENOBUFS);
1980 1.79 itojun }
1981 1.1 cgd d->bd_slen = 0;
1982 1.1 cgd d->bd_hlen = 0;
1983 1.1 cgd return (0);
1984 1.1 cgd }
1985 1.1 cgd
1986 1.213 ozaki static void
1987 1.213 ozaki bpf_free_filter(struct bpf_filter *filter)
1988 1.213 ozaki {
1989 1.213 ozaki
1990 1.213 ozaki KASSERT(filter != NULL);
1991 1.213 ozaki KASSERT(filter->bf_insn != NULL);
1992 1.213 ozaki
1993 1.213 ozaki kmem_free(filter->bf_insn, filter->bf_size);
1994 1.213 ozaki if (filter->bf_jitcode != NULL)
1995 1.213 ozaki bpf_jit_freecode(filter->bf_jitcode);
1996 1.213 ozaki kmem_free(filter, sizeof(*filter));
1997 1.213 ozaki }
1998 1.213 ozaki
1999 1.1 cgd /*
2000 1.2 cgd * Free buffers currently in use by a descriptor.
2001 1.2 cgd * Called on close.
2002 1.2 cgd */
2003 1.2 cgd static void
2004 1.103 christos bpf_freed(struct bpf_d *d)
2005 1.2 cgd {
2006 1.2 cgd /*
2007 1.2 cgd * We don't need to lock out interrupts since this descriptor has
2008 1.2 cgd * been detached from its interface and it yet hasn't been marked
2009 1.2 cgd * free.
2010 1.2 cgd */
2011 1.171 alnsn if (d->bd_sbuf != NULL) {
2012 1.208 ozaki kmem_free(d->bd_sbuf, d->bd_bufsize);
2013 1.171 alnsn if (d->bd_hbuf != NULL)
2014 1.208 ozaki kmem_free(d->bd_hbuf, d->bd_bufsize);
2015 1.171 alnsn if (d->bd_fbuf != NULL)
2016 1.208 ozaki kmem_free(d->bd_fbuf, d->bd_bufsize);
2017 1.100 darrenr }
2018 1.213 ozaki if (d->bd_filter != NULL) {
2019 1.213 ozaki bpf_free_filter(d->bd_filter);
2020 1.213 ozaki d->bd_filter = NULL;
2021 1.173 alnsn }
2022 1.213 ozaki d->bd_jitcode = NULL;
2023 1.2 cgd }
2024 1.2 cgd
2025 1.2 cgd /*
2026 1.153 pooka * Attach an interface to bpf. dlt is the link layer type;
2027 1.66 onoe * hdrlen is the fixed size of the link header for the specified dlt
2028 1.66 onoe * (variable length headers not yet supported).
2029 1.66 onoe */
2030 1.153 pooka static void
2031 1.157 joerg _bpfattach(struct ifnet *ifp, u_int dlt, u_int hdrlen, struct bpf_if **driverp)
2032 1.66 onoe {
2033 1.1 cgd struct bpf_if *bp;
2034 1.208 ozaki bp = kmem_alloc(sizeof(*bp), KM_NOSLEEP);
2035 1.187 ozaki if (bp == NULL)
2036 1.12 mycroft panic("bpfattach");
2037 1.12 mycroft
2038 1.192 christos mutex_enter(&bpf_mtx);
2039 1.103 christos bp->bif_driverp = driverp;
2040 1.1 cgd bp->bif_ifp = ifp;
2041 1.1 cgd bp->bif_dlt = dlt;
2042 1.205 ozaki bp->bif_si = NULL;
2043 1.209 ozaki BPF_IFLIST_ENTRY_INIT(bp);
2044 1.209 ozaki PSLIST_INIT(&bp->bif_dlist_head);
2045 1.213 ozaki psref_target_init(&bp->bif_psref, bpf_psref_class);
2046 1.1 cgd
2047 1.209 ozaki BPF_IFLIST_WRITER_INSERT_HEAD(bp);
2048 1.1 cgd
2049 1.187 ozaki *bp->bif_driverp = NULL;
2050 1.1 cgd
2051 1.166 bouyer bp->bif_hdrlen = hdrlen;
2052 1.192 christos mutex_exit(&bpf_mtx);
2053 1.11 deraadt #if 0
2054 1.32 christos printf("bpf: %s attached\n", ifp->if_xname);
2055 1.11 deraadt #endif
2056 1.48 thorpej }
2057 1.48 thorpej
2058 1.206 ozaki static void
2059 1.206 ozaki _bpf_mtap_softint_init(struct ifnet *ifp)
2060 1.205 ozaki {
2061 1.205 ozaki struct bpf_if *bp;
2062 1.205 ozaki
2063 1.205 ozaki mutex_enter(&bpf_mtx);
2064 1.209 ozaki BPF_IFLIST_WRITER_FOREACH(bp) {
2065 1.205 ozaki if (bp->bif_ifp != ifp)
2066 1.205 ozaki continue;
2067 1.205 ozaki
2068 1.205 ozaki bp->bif_mbuf_head = NULL;
2069 1.205 ozaki bp->bif_mbuf_tail = NULL;
2070 1.205 ozaki bp->bif_si = softint_establish(SOFTINT_NET, bpf_mtap_si, bp);
2071 1.205 ozaki if (bp->bif_si == NULL)
2072 1.205 ozaki panic("%s: softint_establish() failed", __func__);
2073 1.205 ozaki break;
2074 1.205 ozaki }
2075 1.205 ozaki mutex_exit(&bpf_mtx);
2076 1.205 ozaki
2077 1.205 ozaki if (bp == NULL)
2078 1.205 ozaki panic("%s: no bpf_if found for %s", __func__, ifp->if_xname);
2079 1.205 ozaki }
2080 1.205 ozaki
2081 1.48 thorpej /*
2082 1.48 thorpej * Remove an interface from bpf.
2083 1.48 thorpej */
2084 1.153 pooka static void
2085 1.157 joerg _bpfdetach(struct ifnet *ifp)
2086 1.48 thorpej {
2087 1.209 ozaki struct bpf_if *bp;
2088 1.51 enami struct bpf_d *d;
2089 1.105 christos int s;
2090 1.51 enami
2091 1.192 christos mutex_enter(&bpf_mtx);
2092 1.52 soren /* Nuke the vnodes for any open instances */
2093 1.209 ozaki again_d:
2094 1.209 ozaki BPF_DLIST_WRITER_FOREACH(d) {
2095 1.213 ozaki mutex_enter(d->bd_mtx);
2096 1.105 christos if (d->bd_bif != NULL && d->bd_bif->bif_ifp == ifp) {
2097 1.51 enami /*
2098 1.51 enami * Detach the descriptor from an interface now.
2099 1.51 enami * It will be free'ed later by close routine.
2100 1.51 enami */
2101 1.51 enami d->bd_promisc = 0; /* we can't touch device. */
2102 1.51 enami bpf_detachd(d);
2103 1.213 ozaki mutex_exit(d->bd_mtx);
2104 1.209 ozaki goto again_d;
2105 1.51 enami }
2106 1.213 ozaki mutex_exit(d->bd_mtx);
2107 1.51 enami }
2108 1.48 thorpej
2109 1.66 onoe again:
2110 1.209 ozaki BPF_IFLIST_WRITER_FOREACH(bp) {
2111 1.48 thorpej if (bp->bif_ifp == ifp) {
2112 1.209 ozaki BPF_IFLIST_WRITER_REMOVE(bp);
2113 1.213 ozaki
2114 1.213 ozaki pserialize_perform(bpf_psz);
2115 1.213 ozaki psref_target_destroy(&bp->bif_psref, bpf_psref_class);
2116 1.213 ozaki
2117 1.209 ozaki BPF_IFLIST_ENTRY_DESTROY(bp);
2118 1.205 ozaki if (bp->bif_si != NULL) {
2119 1.213 ozaki /* XXX NOMPSAFE: assumed running on one CPU */
2120 1.205 ozaki s = splnet();
2121 1.205 ozaki while (bp->bif_mbuf_head != NULL) {
2122 1.205 ozaki struct mbuf *m = bp->bif_mbuf_head;
2123 1.205 ozaki bp->bif_mbuf_head = m->m_nextpkt;
2124 1.205 ozaki m_freem(m);
2125 1.205 ozaki }
2126 1.205 ozaki splx(s);
2127 1.205 ozaki softint_disestablish(bp->bif_si);
2128 1.205 ozaki }
2129 1.208 ozaki kmem_free(bp, sizeof(*bp));
2130 1.66 onoe goto again;
2131 1.48 thorpej }
2132 1.48 thorpej }
2133 1.192 christos mutex_exit(&bpf_mtx);
2134 1.47 thorpej }
2135 1.47 thorpej
2136 1.47 thorpej /*
2137 1.66 onoe * Change the data link type of a interface.
2138 1.47 thorpej */
2139 1.153 pooka static void
2140 1.157 joerg _bpf_change_type(struct ifnet *ifp, u_int dlt, u_int hdrlen)
2141 1.47 thorpej {
2142 1.47 thorpej struct bpf_if *bp;
2143 1.47 thorpej
2144 1.213 ozaki mutex_enter(&bpf_mtx);
2145 1.213 ozaki BPF_IFLIST_WRITER_FOREACH(bp) {
2146 1.152 pooka if (bp->bif_driverp == &ifp->if_bpf)
2147 1.47 thorpej break;
2148 1.47 thorpej }
2149 1.47 thorpej if (bp == NULL)
2150 1.47 thorpej panic("bpf_change_type");
2151 1.47 thorpej
2152 1.47 thorpej bp->bif_dlt = dlt;
2153 1.47 thorpej
2154 1.166 bouyer bp->bif_hdrlen = hdrlen;
2155 1.213 ozaki mutex_exit(&bpf_mtx);
2156 1.66 onoe }
2157 1.66 onoe
2158 1.66 onoe /*
2159 1.66 onoe * Get a list of available data link type of the interface.
2160 1.66 onoe */
2161 1.66 onoe static int
2162 1.103 christos bpf_getdltlist(struct bpf_d *d, struct bpf_dltlist *bfl)
2163 1.66 onoe {
2164 1.66 onoe int n, error;
2165 1.66 onoe struct ifnet *ifp;
2166 1.66 onoe struct bpf_if *bp;
2167 1.213 ozaki int s, bound;
2168 1.213 ozaki
2169 1.213 ozaki KASSERT(mutex_owned(d->bd_mtx));
2170 1.66 onoe
2171 1.66 onoe ifp = d->bd_bif->bif_ifp;
2172 1.66 onoe n = 0;
2173 1.66 onoe error = 0;
2174 1.213 ozaki
2175 1.213 ozaki bound = curlwp_bind();
2176 1.213 ozaki s = pserialize_read_enter();
2177 1.209 ozaki BPF_IFLIST_READER_FOREACH(bp) {
2178 1.66 onoe if (bp->bif_ifp != ifp)
2179 1.66 onoe continue;
2180 1.66 onoe if (bfl->bfl_list != NULL) {
2181 1.213 ozaki struct psref psref;
2182 1.213 ozaki
2183 1.213 ozaki if (n >= bfl->bfl_len) {
2184 1.213 ozaki pserialize_read_exit(s);
2185 1.66 onoe return ENOMEM;
2186 1.213 ozaki }
2187 1.213 ozaki
2188 1.213 ozaki bpf_if_acquire(bp, &psref);
2189 1.213 ozaki pserialize_read_exit(s);
2190 1.213 ozaki
2191 1.66 onoe error = copyout(&bp->bif_dlt,
2192 1.66 onoe bfl->bfl_list + n, sizeof(u_int));
2193 1.213 ozaki
2194 1.213 ozaki s = pserialize_read_enter();
2195 1.213 ozaki bpf_if_release(bp, &psref);
2196 1.66 onoe }
2197 1.66 onoe n++;
2198 1.66 onoe }
2199 1.213 ozaki pserialize_read_exit(s);
2200 1.213 ozaki curlwp_bindx(bound);
2201 1.213 ozaki
2202 1.66 onoe bfl->bfl_len = n;
2203 1.66 onoe return error;
2204 1.66 onoe }
2205 1.66 onoe
2206 1.66 onoe /*
2207 1.66 onoe * Set the data link type of a BPF instance.
2208 1.66 onoe */
2209 1.66 onoe static int
2210 1.103 christos bpf_setdlt(struct bpf_d *d, u_int dlt)
2211 1.66 onoe {
2212 1.213 ozaki int error, opromisc;
2213 1.66 onoe struct ifnet *ifp;
2214 1.66 onoe struct bpf_if *bp;
2215 1.66 onoe
2216 1.192 christos KASSERT(mutex_owned(&bpf_mtx));
2217 1.213 ozaki KASSERT(mutex_owned(d->bd_mtx));
2218 1.192 christos
2219 1.66 onoe if (d->bd_bif->bif_dlt == dlt)
2220 1.66 onoe return 0;
2221 1.66 onoe ifp = d->bd_bif->bif_ifp;
2222 1.209 ozaki BPF_IFLIST_WRITER_FOREACH(bp) {
2223 1.66 onoe if (bp->bif_ifp == ifp && bp->bif_dlt == dlt)
2224 1.66 onoe break;
2225 1.66 onoe }
2226 1.66 onoe if (bp == NULL)
2227 1.66 onoe return EINVAL;
2228 1.69 thorpej opromisc = d->bd_promisc;
2229 1.66 onoe bpf_detachd(d);
2230 1.216 ozaki BPFIF_DLIST_ENTRY_INIT(d);
2231 1.66 onoe bpf_attachd(d, bp);
2232 1.66 onoe reset_d(d);
2233 1.69 thorpej if (opromisc) {
2234 1.219 ozaki KERNEL_LOCK_UNLESS_NET_MPSAFE();
2235 1.69 thorpej error = ifpromisc(bp->bif_ifp, 1);
2236 1.219 ozaki KERNEL_UNLOCK_UNLESS_NET_MPSAFE();
2237 1.69 thorpej if (error)
2238 1.69 thorpej printf("%s: bpf_setdlt: ifpromisc failed (%d)\n",
2239 1.69 thorpej bp->bif_ifp->if_xname, error);
2240 1.69 thorpej else
2241 1.69 thorpej d->bd_promisc = 1;
2242 1.69 thorpej }
2243 1.66 onoe return 0;
2244 1.1 cgd }
2245 1.89 jonathan
2246 1.89 jonathan static int
2247 1.89 jonathan sysctl_net_bpf_maxbufsize(SYSCTLFN_ARGS)
2248 1.89 jonathan {
2249 1.89 jonathan int newsize, error;
2250 1.89 jonathan struct sysctlnode node;
2251 1.89 jonathan
2252 1.89 jonathan node = *rnode;
2253 1.89 jonathan node.sysctl_data = &newsize;
2254 1.89 jonathan newsize = bpf_maxbufsize;
2255 1.89 jonathan error = sysctl_lookup(SYSCTLFN_CALL(&node));
2256 1.89 jonathan if (error || newp == NULL)
2257 1.89 jonathan return (error);
2258 1.89 jonathan
2259 1.89 jonathan if (newsize < BPF_MINBUFSIZE || newsize > BPF_MAXBUFSIZE)
2260 1.89 jonathan return (EINVAL);
2261 1.89 jonathan
2262 1.89 jonathan bpf_maxbufsize = newsize;
2263 1.89 jonathan
2264 1.89 jonathan return (0);
2265 1.89 jonathan }
2266 1.89 jonathan
2267 1.186 alnsn #if defined(MODULAR) || defined(BPFJIT)
2268 1.110 rpaulo static int
2269 1.173 alnsn sysctl_net_bpf_jit(SYSCTLFN_ARGS)
2270 1.173 alnsn {
2271 1.173 alnsn bool newval;
2272 1.173 alnsn int error;
2273 1.173 alnsn struct sysctlnode node;
2274 1.173 alnsn
2275 1.173 alnsn node = *rnode;
2276 1.173 alnsn node.sysctl_data = &newval;
2277 1.173 alnsn newval = bpf_jit;
2278 1.173 alnsn error = sysctl_lookup(SYSCTLFN_CALL(&node));
2279 1.173 alnsn if (error != 0 || newp == NULL)
2280 1.173 alnsn return error;
2281 1.173 alnsn
2282 1.173 alnsn bpf_jit = newval;
2283 1.173 alnsn
2284 1.173 alnsn /*
2285 1.173 alnsn * Do a full sync to publish new bpf_jit value and
2286 1.173 alnsn * update bpfjit_module_ops.bj_generate_code variable.
2287 1.173 alnsn */
2288 1.173 alnsn membar_sync();
2289 1.173 alnsn
2290 1.173 alnsn if (newval && bpfjit_module_ops.bj_generate_code == NULL) {
2291 1.186 alnsn printf("JIT compilation is postponed "
2292 1.173 alnsn "until after bpfjit module is loaded\n");
2293 1.173 alnsn }
2294 1.173 alnsn
2295 1.173 alnsn return 0;
2296 1.173 alnsn }
2297 1.186 alnsn #endif
2298 1.173 alnsn
2299 1.173 alnsn static int
2300 1.110 rpaulo sysctl_net_bpf_peers(SYSCTLFN_ARGS)
2301 1.110 rpaulo {
2302 1.110 rpaulo int error, elem_count;
2303 1.110 rpaulo struct bpf_d *dp;
2304 1.110 rpaulo struct bpf_d_ext dpe;
2305 1.110 rpaulo size_t len, needed, elem_size, out_size;
2306 1.110 rpaulo char *sp;
2307 1.110 rpaulo
2308 1.110 rpaulo if (namelen == 1 && name[0] == CTL_QUERY)
2309 1.110 rpaulo return (sysctl_query(SYSCTLFN_CALL(rnode)));
2310 1.110 rpaulo
2311 1.110 rpaulo if (namelen != 2)
2312 1.110 rpaulo return (EINVAL);
2313 1.110 rpaulo
2314 1.124 elad /* BPF peers is privileged information. */
2315 1.124 elad error = kauth_authorize_network(l->l_cred, KAUTH_NETWORK_INTERFACE,
2316 1.124 elad KAUTH_REQ_NETWORK_INTERFACE_GETPRIV, NULL, NULL, NULL);
2317 1.124 elad if (error)
2318 1.124 elad return (EPERM);
2319 1.110 rpaulo
2320 1.110 rpaulo len = (oldp != NULL) ? *oldlenp : 0;
2321 1.110 rpaulo sp = oldp;
2322 1.110 rpaulo elem_size = name[0];
2323 1.110 rpaulo elem_count = name[1];
2324 1.110 rpaulo out_size = MIN(sizeof(dpe), elem_size);
2325 1.110 rpaulo needed = 0;
2326 1.110 rpaulo
2327 1.110 rpaulo if (elem_size < 1 || elem_count < 0)
2328 1.110 rpaulo return (EINVAL);
2329 1.120 christos
2330 1.130 xtraeme mutex_enter(&bpf_mtx);
2331 1.209 ozaki BPF_DLIST_WRITER_FOREACH(dp) {
2332 1.110 rpaulo if (len >= elem_size && elem_count > 0) {
2333 1.110 rpaulo #define BPF_EXT(field) dpe.bde_ ## field = dp->bd_ ## field
2334 1.110 rpaulo BPF_EXT(bufsize);
2335 1.110 rpaulo BPF_EXT(promisc);
2336 1.110 rpaulo BPF_EXT(state);
2337 1.110 rpaulo BPF_EXT(immediate);
2338 1.110 rpaulo BPF_EXT(hdrcmplt);
2339 1.110 rpaulo BPF_EXT(seesent);
2340 1.110 rpaulo BPF_EXT(pid);
2341 1.110 rpaulo BPF_EXT(rcount);
2342 1.110 rpaulo BPF_EXT(dcount);
2343 1.110 rpaulo BPF_EXT(ccount);
2344 1.110 rpaulo #undef BPF_EXT
2345 1.213 ozaki mutex_enter(dp->bd_mtx);
2346 1.110 rpaulo if (dp->bd_bif)
2347 1.110 rpaulo (void)strlcpy(dpe.bde_ifname,
2348 1.110 rpaulo dp->bd_bif->bif_ifp->if_xname,
2349 1.110 rpaulo IFNAMSIZ - 1);
2350 1.110 rpaulo else
2351 1.110 rpaulo dpe.bde_ifname[0] = '\0';
2352 1.213 ozaki mutex_exit(dp->bd_mtx);
2353 1.120 christos
2354 1.110 rpaulo error = copyout(&dpe, sp, out_size);
2355 1.110 rpaulo if (error)
2356 1.110 rpaulo break;
2357 1.110 rpaulo sp += elem_size;
2358 1.110 rpaulo len -= elem_size;
2359 1.110 rpaulo }
2360 1.143 mrg needed += elem_size;
2361 1.143 mrg if (elem_count > 0 && elem_count != INT_MAX)
2362 1.143 mrg elem_count--;
2363 1.110 rpaulo }
2364 1.130 xtraeme mutex_exit(&bpf_mtx);
2365 1.110 rpaulo
2366 1.110 rpaulo *oldlenp = needed;
2367 1.120 christos
2368 1.110 rpaulo return (error);
2369 1.110 rpaulo }
2370 1.110 rpaulo
2371 1.210 ozaki static void
2372 1.210 ozaki bpf_stats(void *p, void *arg, struct cpu_info *ci __unused)
2373 1.210 ozaki {
2374 1.210 ozaki struct bpf_stat *const stats = p;
2375 1.210 ozaki struct bpf_stat *sum = arg;
2376 1.210 ozaki
2377 1.210 ozaki sum->bs_recv += stats->bs_recv;
2378 1.210 ozaki sum->bs_drop += stats->bs_drop;
2379 1.210 ozaki sum->bs_capt += stats->bs_capt;
2380 1.210 ozaki }
2381 1.210 ozaki
2382 1.210 ozaki static int
2383 1.210 ozaki bpf_sysctl_gstats_handler(SYSCTLFN_ARGS)
2384 1.210 ozaki {
2385 1.210 ozaki struct sysctlnode node;
2386 1.210 ozaki int error;
2387 1.210 ozaki struct bpf_stat sum;
2388 1.210 ozaki
2389 1.210 ozaki memset(&sum, 0, sizeof(sum));
2390 1.210 ozaki node = *rnode;
2391 1.210 ozaki
2392 1.210 ozaki percpu_foreach(bpf_gstats_percpu, bpf_stats, &sum);
2393 1.210 ozaki
2394 1.210 ozaki node.sysctl_data = ∑
2395 1.210 ozaki node.sysctl_size = sizeof(sum);
2396 1.210 ozaki error = sysctl_lookup(SYSCTLFN_CALL(&node));
2397 1.210 ozaki if (error != 0 || newp == NULL)
2398 1.210 ozaki return error;
2399 1.210 ozaki
2400 1.210 ozaki return 0;
2401 1.210 ozaki }
2402 1.210 ozaki
2403 1.159 pooka static struct sysctllog *bpf_sysctllog;
2404 1.159 pooka static void
2405 1.159 pooka sysctl_net_bpf_setup(void)
2406 1.89 jonathan {
2407 1.108 atatat const struct sysctlnode *node;
2408 1.89 jonathan
2409 1.89 jonathan node = NULL;
2410 1.159 pooka sysctl_createv(&bpf_sysctllog, 0, NULL, &node,
2411 1.90 atatat CTLFLAG_PERMANENT,
2412 1.98 atatat CTLTYPE_NODE, "bpf",
2413 1.98 atatat SYSCTL_DESCR("BPF options"),
2414 1.89 jonathan NULL, 0, NULL, 0,
2415 1.89 jonathan CTL_NET, CTL_CREATE, CTL_EOL);
2416 1.110 rpaulo if (node != NULL) {
2417 1.186 alnsn #if defined(MODULAR) || defined(BPFJIT)
2418 1.159 pooka sysctl_createv(&bpf_sysctllog, 0, NULL, NULL,
2419 1.90 atatat CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
2420 1.173 alnsn CTLTYPE_BOOL, "jit",
2421 1.173 alnsn SYSCTL_DESCR("Toggle Just-In-Time compilation"),
2422 1.173 alnsn sysctl_net_bpf_jit, 0, &bpf_jit, 0,
2423 1.173 alnsn CTL_NET, node->sysctl_num, CTL_CREATE, CTL_EOL);
2424 1.186 alnsn #endif
2425 1.173 alnsn sysctl_createv(&bpf_sysctllog, 0, NULL, NULL,
2426 1.173 alnsn CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
2427 1.98 atatat CTLTYPE_INT, "maxbufsize",
2428 1.98 atatat SYSCTL_DESCR("Maximum size for data capture buffer"),
2429 1.89 jonathan sysctl_net_bpf_maxbufsize, 0, &bpf_maxbufsize, 0,
2430 1.89 jonathan CTL_NET, node->sysctl_num, CTL_CREATE, CTL_EOL);
2431 1.159 pooka sysctl_createv(&bpf_sysctllog, 0, NULL, NULL,
2432 1.110 rpaulo CTLFLAG_PERMANENT,
2433 1.110 rpaulo CTLTYPE_STRUCT, "stats",
2434 1.110 rpaulo SYSCTL_DESCR("BPF stats"),
2435 1.210 ozaki bpf_sysctl_gstats_handler, 0, NULL, 0,
2436 1.110 rpaulo CTL_NET, node->sysctl_num, CTL_CREATE, CTL_EOL);
2437 1.159 pooka sysctl_createv(&bpf_sysctllog, 0, NULL, NULL,
2438 1.110 rpaulo CTLFLAG_PERMANENT,
2439 1.110 rpaulo CTLTYPE_STRUCT, "peers",
2440 1.110 rpaulo SYSCTL_DESCR("BPF peers"),
2441 1.110 rpaulo sysctl_net_bpf_peers, 0, NULL, 0,
2442 1.110 rpaulo CTL_NET, node->sysctl_num, CTL_CREATE, CTL_EOL);
2443 1.110 rpaulo }
2444 1.120 christos
2445 1.89 jonathan }
2446 1.153 pooka
2447 1.153 pooka struct bpf_ops bpf_ops_kernel = {
2448 1.157 joerg .bpf_attach = _bpfattach,
2449 1.157 joerg .bpf_detach = _bpfdetach,
2450 1.157 joerg .bpf_change_type = _bpf_change_type,
2451 1.157 joerg
2452 1.157 joerg .bpf_tap = _bpf_tap,
2453 1.157 joerg .bpf_mtap = _bpf_mtap,
2454 1.157 joerg .bpf_mtap2 = _bpf_mtap2,
2455 1.157 joerg .bpf_mtap_af = _bpf_mtap_af,
2456 1.157 joerg .bpf_mtap_sl_in = _bpf_mtap_sl_in,
2457 1.157 joerg .bpf_mtap_sl_out = _bpf_mtap_sl_out,
2458 1.206 ozaki
2459 1.206 ozaki .bpf_mtap_softint = _bpf_mtap_softint,
2460 1.206 ozaki .bpf_mtap_softint_init = _bpf_mtap_softint_init,
2461 1.153 pooka };
2462 1.153 pooka
2463 1.196 pgoyette MODULE(MODULE_CLASS_DRIVER, bpf, "bpf_filter");
2464 1.154 pooka
2465 1.154 pooka static int
2466 1.154 pooka bpf_modcmd(modcmd_t cmd, void *arg)
2467 1.153 pooka {
2468 1.200 pgoyette #ifdef _MODULE
2469 1.154 pooka devmajor_t bmajor, cmajor;
2470 1.200 pgoyette #endif
2471 1.202 pgoyette int error = 0;
2472 1.154 pooka
2473 1.154 pooka switch (cmd) {
2474 1.154 pooka case MODULE_CMD_INIT:
2475 1.203 pgoyette bpf_init();
2476 1.200 pgoyette #ifdef _MODULE
2477 1.201 pgoyette bmajor = cmajor = NODEVMAJOR;
2478 1.154 pooka error = devsw_attach("bpf", NULL, &bmajor,
2479 1.154 pooka &bpf_cdevsw, &cmajor);
2480 1.154 pooka if (error)
2481 1.154 pooka break;
2482 1.203 pgoyette #endif
2483 1.154 pooka
2484 1.154 pooka bpf_ops_handover_enter(&bpf_ops_kernel);
2485 1.154 pooka atomic_swap_ptr(&bpf_ops, &bpf_ops_kernel);
2486 1.154 pooka bpf_ops_handover_exit();
2487 1.159 pooka sysctl_net_bpf_setup();
2488 1.154 pooka break;
2489 1.154 pooka
2490 1.154 pooka case MODULE_CMD_FINI:
2491 1.154 pooka /*
2492 1.158 pooka * While there is no reference counting for bpf callers,
2493 1.158 pooka * unload could at least in theory be done similarly to
2494 1.158 pooka * system call disestablishment. This should even be
2495 1.158 pooka * a little simpler:
2496 1.158 pooka *
2497 1.158 pooka * 1) replace op vector with stubs
2498 1.158 pooka * 2) post update to all cpus with xc
2499 1.158 pooka * 3) check that nobody is in bpf anymore
2500 1.158 pooka * (it's doubtful we'd want something like l_sysent,
2501 1.158 pooka * but we could do something like *signed* percpu
2502 1.158 pooka * counters. if the sum is 0, we're good).
2503 1.158 pooka * 4) if fail, unroll changes
2504 1.158 pooka *
2505 1.158 pooka * NOTE: change won't be atomic to the outside. some
2506 1.158 pooka * packets may be not captured even if unload is
2507 1.158 pooka * not succesful. I think packet capture not working
2508 1.158 pooka * is a perfectly logical consequence of trying to
2509 1.158 pooka * disable packet capture.
2510 1.154 pooka */
2511 1.154 pooka error = EOPNOTSUPP;
2512 1.159 pooka /* insert sysctl teardown */
2513 1.154 pooka break;
2514 1.153 pooka
2515 1.154 pooka default:
2516 1.154 pooka error = ENOTTY;
2517 1.154 pooka break;
2518 1.154 pooka }
2519 1.154 pooka
2520 1.154 pooka return error;
2521 1.153 pooka }
2522