h_bpf.h revision 1.1 1 1.1 alnsn /* $NetBSD: h_bpf.h,v 1.1 2014/07/07 19:34:32 alnsn Exp $ */
2 1.1 alnsn
3 1.1 alnsn /*-
4 1.1 alnsn * Copyright (c) 2014 Alexander Nasonov.
5 1.1 alnsn * All rights reserved.
6 1.1 alnsn *
7 1.1 alnsn * Redistribution and use in source and binary forms, with or without
8 1.1 alnsn * modification, are permitted provided that the following conditions
9 1.1 alnsn * are met:
10 1.1 alnsn * 1. Redistributions of source code must retain the above copyright
11 1.1 alnsn * notice, this list of conditions and the following disclaimer.
12 1.1 alnsn * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 alnsn * notice, this list of conditions and the following disclaimer in the
14 1.1 alnsn * documentation and/or other materials provided with the distribution.
15 1.1 alnsn *
16 1.1 alnsn * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
17 1.1 alnsn * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18 1.1 alnsn * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
19 1.1 alnsn * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.1 alnsn * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 alnsn * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
22 1.1 alnsn * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 alnsn * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 alnsn * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 alnsn * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 alnsn * SUCH DAMAGE.
27 1.1 alnsn */
28 1.1 alnsn
29 1.1 alnsn #ifndef _TESTS_NET_BPF_H_BPF_H_
30 1.1 alnsn #define _TESTS_NET_BPF_H_BPF_H_
31 1.1 alnsn
32 1.1 alnsn #include <sys/param.h>
33 1.1 alnsn #include <sys/mbuf.h>
34 1.1 alnsn
35 1.1 alnsn #include <net/bpf.h>
36 1.1 alnsn #include <net/bpfjit.h>
37 1.1 alnsn
38 1.1 alnsn #include <rump/rump.h>
39 1.1 alnsn #include <rump/rump_syscalls.h>
40 1.1 alnsn
41 1.1 alnsn #include <stdint.h>
42 1.1 alnsn #include <string.h>
43 1.1 alnsn
44 1.1 alnsn /* XXX These declarations don't look kosher. */
45 1.1 alnsn int rumpns_bpf_validate(const struct bpf_insn *, int);
46 1.1 alnsn unsigned int rumpns_bpf_filter_ext(const bpf_ctx_t *,
47 1.1 alnsn const struct bpf_insn *, bpf_args_t *);
48 1.1 alnsn bpfjit_func_t rumpns_bpfjit_generate_code(const bpf_ctx_t *,
49 1.1 alnsn const struct bpf_insn *, size_t);
50 1.1 alnsn void rumpns_bpfjit_free_code(bpfjit_func_t);
51 1.1 alnsn
52 1.1 alnsn /*
53 1.1 alnsn * Init mbuf chain with one or two chunks. The first chunk holds
54 1.1 alnsn * [pkt, pkt + split] bytes, the second chunk (if it's not empty)
55 1.1 alnsn * holds (pkt + split, pkt + pktsize) bytes.
56 1.1 alnsn * The function returns (const uint8_t *)mb1.
57 1.1 alnsn */
58 1.1 alnsn static inline const uint8_t *
59 1.1 alnsn init_mchain2(struct mbuf *mb1, struct mbuf *mb2,
60 1.1 alnsn char pkt[], size_t pktsize, size_t split)
61 1.1 alnsn {
62 1.1 alnsn
63 1.1 alnsn (void)memset(mb1, 0, sizeof(*mb1));
64 1.1 alnsn mb1->m_data = pkt;
65 1.1 alnsn mb1->m_next = (split < pktsize) ? mb2 : NULL;
66 1.1 alnsn mb1->m_len = (split < pktsize) ? split : pktsize;
67 1.1 alnsn
68 1.1 alnsn if (split < pktsize) {
69 1.1 alnsn (void)memset(mb2, 0, sizeof(*mb2));
70 1.1 alnsn mb2->m_next = NULL;
71 1.1 alnsn mb2->m_data = &pkt[split];
72 1.1 alnsn mb2->m_len = pktsize - split;
73 1.1 alnsn }
74 1.1 alnsn
75 1.1 alnsn return (const uint8_t*)mb1;
76 1.1 alnsn }
77 1.1 alnsn
78 1.1 alnsn /*
79 1.1 alnsn * Interpret a filter program with mbuf chain passed to bpf_filter_ext().
80 1.1 alnsn */
81 1.1 alnsn static inline unsigned int
82 1.1 alnsn interp_prog_mchain2(struct bpf_insn *insns,
83 1.1 alnsn char *pkt, size_t pktsize, size_t split)
84 1.1 alnsn {
85 1.1 alnsn uint32_t mem[BPF_MEMWORDS];
86 1.1 alnsn struct mbuf mb1, mb2;
87 1.1 alnsn bpf_args_t args;
88 1.1 alnsn unsigned int res;
89 1.1 alnsn
90 1.1 alnsn args.pkt = init_mchain2(&mb1, &mb2, pkt, pktsize, split);
91 1.1 alnsn args.buflen = 0;
92 1.1 alnsn args.wirelen = pktsize;
93 1.1 alnsn args.mem = mem;
94 1.1 alnsn
95 1.1 alnsn rump_schedule();
96 1.1 alnsn res = rumpns_bpf_filter_ext(NULL, insns, &args);
97 1.1 alnsn rump_unschedule();
98 1.1 alnsn
99 1.1 alnsn return res;
100 1.1 alnsn }
101 1.1 alnsn
102 1.1 alnsn /*
103 1.1 alnsn * Compile and run a filter program with mbuf chain passed to compiled function.
104 1.1 alnsn */
105 1.1 alnsn static inline unsigned int
106 1.1 alnsn exec_prog_mchain2(struct bpf_insn *insns, size_t insn_count,
107 1.1 alnsn char *pkt, size_t pktsize, size_t split)
108 1.1 alnsn {
109 1.1 alnsn bpfjit_func_t fn;
110 1.1 alnsn struct mbuf mb1, mb2;
111 1.1 alnsn bpf_args_t args;
112 1.1 alnsn unsigned int res;
113 1.1 alnsn
114 1.1 alnsn args.pkt = init_mchain2(&mb1, &mb2, pkt, pktsize, split);
115 1.1 alnsn args.buflen = 0;
116 1.1 alnsn args.wirelen = pktsize;
117 1.1 alnsn
118 1.1 alnsn rump_schedule();
119 1.1 alnsn fn = rumpns_bpfjit_generate_code(NULL, insns, insn_count);
120 1.1 alnsn rump_unschedule();
121 1.1 alnsn
122 1.1 alnsn res = fn(NULL, &args);
123 1.1 alnsn
124 1.1 alnsn rump_schedule();
125 1.1 alnsn rumpns_bpfjit_free_code(fn);
126 1.1 alnsn rump_unschedule();
127 1.1 alnsn
128 1.1 alnsn return res;
129 1.1 alnsn }
130 1.1 alnsn
131 1.1 alnsn static inline bool
132 1.1 alnsn prog_validate(struct bpf_insn *insns, size_t insn_count)
133 1.1 alnsn {
134 1.1 alnsn bool res;
135 1.1 alnsn
136 1.1 alnsn rump_schedule();
137 1.1 alnsn res = rumpns_bpf_validate(insns, insn_count);
138 1.1 alnsn rump_unschedule();
139 1.1 alnsn
140 1.1 alnsn return res;
141 1.1 alnsn }
142 1.1 alnsn
143 1.1 alnsn #endif /* _TESTS_NET_BPF_H_BPF_H_ */
144