Commit | Line | Data |
---|---|---|
5b497af4 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
408eccce | 2 | /* PTP classifier |
408eccce DB |
3 | */ |
4 | ||
5 | /* The below program is the bpf_asm (tools/net/) representation of | |
6 | * the opcode array in the ptp_filter structure. | |
7 | * | |
8 | * For convenience, this can easily be altered and reviewed with | |
9 | * bpf_asm and bpf_dbg, e.g. `./bpf_asm -c prog` where prog is a | |
10 | * simple file containing the below program: | |
11 | * | |
12 | * ldh [12] ; load ethertype | |
13 | * | |
14 | * ; PTP over UDP over IPv4 over Ethernet | |
15 | * test_ipv4: | |
16 | * jneq #0x800, test_ipv6 ; ETH_P_IP ? | |
17 | * ldb [23] ; load proto | |
18 | * jneq #17, drop_ipv4 ; IPPROTO_UDP ? | |
19 | * ldh [20] ; load frag offset field | |
20 | * jset #0x1fff, drop_ipv4 ; don't allow fragments | |
21 | * ldxb 4*([14]&0xf) ; load IP header len | |
22 | * ldh [x + 16] ; load UDP dst port | |
23 | * jneq #319, drop_ipv4 ; is port PTP_EV_PORT ? | |
24 | * ldh [x + 22] ; load payload | |
25 | * and #0xf ; mask PTP_CLASS_VMASK | |
26 | * or #0x10 ; PTP_CLASS_IPV4 | |
27 | * ret a ; return PTP class | |
28 | * drop_ipv4: ret #0x0 ; PTP_CLASS_NONE | |
29 | * | |
30 | * ; PTP over UDP over IPv6 over Ethernet | |
31 | * test_ipv6: | |
32 | * jneq #0x86dd, test_8021q ; ETH_P_IPV6 ? | |
33 | * ldb [20] ; load proto | |
34 | * jneq #17, drop_ipv6 ; IPPROTO_UDP ? | |
35 | * ldh [56] ; load UDP dst port | |
36 | * jneq #319, drop_ipv6 ; is port PTP_EV_PORT ? | |
37 | * ldh [62] ; load payload | |
38 | * and #0xf ; mask PTP_CLASS_VMASK | |
39 | * or #0x20 ; PTP_CLASS_IPV6 | |
40 | * ret a ; return PTP class | |
41 | * drop_ipv6: ret #0x0 ; PTP_CLASS_NONE | |
42 | * | |
43 | * ; PTP over 802.1Q over Ethernet | |
44 | * test_8021q: | |
45 | * jneq #0x8100, test_ieee1588 ; ETH_P_8021Q ? | |
46 | * ldh [16] ; load inner type | |
ae5c6c6d | 47 | * jneq #0x88f7, test_8021q_ipv4 ; ETH_P_1588 ? |
408eccce DB |
48 | * ldb [18] ; load payload |
49 | * and #0x8 ; as we don't have ports here, test | |
50 | * jneq #0x0, drop_ieee1588 ; for PTP_GEN_BIT and drop these | |
51 | * ldh [18] ; reload payload | |
52 | * and #0xf ; mask PTP_CLASS_VMASK | |
5f94c943 | 53 | * or #0xc0 ; PTP_CLASS_VLAN|PTP_CLASS_L2 |
ae5c6c6d SS |
54 | * ret a ; return PTP class |
55 | * | |
56 | * ; PTP over UDP over IPv4 over 802.1Q over Ethernet | |
57 | * test_8021q_ipv4: | |
58 | * jneq #0x800, test_8021q_ipv6 ; ETH_P_IP ? | |
59 | * ldb [27] ; load proto | |
60 | * jneq #17, drop_8021q_ipv4 ; IPPROTO_UDP ? | |
61 | * ldh [24] ; load frag offset field | |
62 | * jset #0x1fff, drop_8021q_ipv4; don't allow fragments | |
63 | * ldxb 4*([18]&0xf) ; load IP header len | |
64 | * ldh [x + 20] ; load UDP dst port | |
65 | * jneq #319, drop_8021q_ipv4 ; is port PTP_EV_PORT ? | |
66 | * ldh [x + 26] ; load payload | |
67 | * and #0xf ; mask PTP_CLASS_VMASK | |
5f94c943 | 68 | * or #0x90 ; PTP_CLASS_VLAN|PTP_CLASS_IPV4 |
ae5c6c6d SS |
69 | * ret a ; return PTP class |
70 | * drop_8021q_ipv4: ret #0x0 ; PTP_CLASS_NONE | |
71 | * | |
72 | * ; PTP over UDP over IPv6 over 802.1Q over Ethernet | |
73 | * test_8021q_ipv6: | |
74 | * jneq #0x86dd, drop_8021q_ipv6 ; ETH_P_IPV6 ? | |
75 | * ldb [24] ; load proto | |
76 | * jneq #17, drop_8021q_ipv6 ; IPPROTO_UDP ? | |
77 | * ldh [60] ; load UDP dst port | |
78 | * jneq #319, drop_8021q_ipv6 ; is port PTP_EV_PORT ? | |
79 | * ldh [66] ; load payload | |
80 | * and #0xf ; mask PTP_CLASS_VMASK | |
5f94c943 | 81 | * or #0xa0 ; PTP_CLASS_VLAN|PTP_CLASS_IPV6 |
408eccce | 82 | * ret a ; return PTP class |
ae5c6c6d | 83 | * drop_8021q_ipv6: ret #0x0 ; PTP_CLASS_NONE |
408eccce DB |
84 | * |
85 | * ; PTP over Ethernet | |
86 | * test_ieee1588: | |
87 | * jneq #0x88f7, drop_ieee1588 ; ETH_P_1588 ? | |
88 | * ldb [14] ; load payload | |
89 | * and #0x8 ; as we don't have ports here, test | |
90 | * jneq #0x0, drop_ieee1588 ; for PTP_GEN_BIT and drop these | |
91 | * ldh [14] ; reload payload | |
92 | * and #0xf ; mask PTP_CLASS_VMASK | |
5f94c943 | 93 | * or #0x40 ; PTP_CLASS_L2 |
408eccce DB |
94 | * ret a ; return PTP class |
95 | * drop_ieee1588: ret #0x0 ; PTP_CLASS_NONE | |
96 | */ | |
97 | ||
98 | #include <linux/skbuff.h> | |
99 | #include <linux/filter.h> | |
100 | #include <linux/ptp_classify.h> | |
101 | ||
7ae457c1 | 102 | static struct bpf_prog *ptp_insns __read_mostly; |
408eccce DB |
103 | |
104 | unsigned int ptp_classify_raw(const struct sk_buff *skb) | |
105 | { | |
7ae457c1 | 106 | return BPF_PROG_RUN(ptp_insns, skb); |
408eccce DB |
107 | } |
108 | EXPORT_SYMBOL_GPL(ptp_classify_raw); | |
109 | ||
110 | void __init ptp_classifier_init(void) | |
111 | { | |
0f49ff07 | 112 | static struct sock_filter ptp_filter[] __initdata = { |
408eccce DB |
113 | { 0x28, 0, 0, 0x0000000c }, |
114 | { 0x15, 0, 12, 0x00000800 }, | |
115 | { 0x30, 0, 0, 0x00000017 }, | |
116 | { 0x15, 0, 9, 0x00000011 }, | |
117 | { 0x28, 0, 0, 0x00000014 }, | |
118 | { 0x45, 7, 0, 0x00001fff }, | |
119 | { 0xb1, 0, 0, 0x0000000e }, | |
120 | { 0x48, 0, 0, 0x00000010 }, | |
121 | { 0x15, 0, 4, 0x0000013f }, | |
122 | { 0x48, 0, 0, 0x00000016 }, | |
123 | { 0x54, 0, 0, 0x0000000f }, | |
124 | { 0x44, 0, 0, 0x00000010 }, | |
125 | { 0x16, 0, 0, 0x00000000 }, | |
126 | { 0x06, 0, 0, 0x00000000 }, | |
127 | { 0x15, 0, 9, 0x000086dd }, | |
128 | { 0x30, 0, 0, 0x00000014 }, | |
129 | { 0x15, 0, 6, 0x00000011 }, | |
130 | { 0x28, 0, 0, 0x00000038 }, | |
131 | { 0x15, 0, 4, 0x0000013f }, | |
132 | { 0x28, 0, 0, 0x0000003e }, | |
133 | { 0x54, 0, 0, 0x0000000f }, | |
134 | { 0x44, 0, 0, 0x00000020 }, | |
135 | { 0x16, 0, 0, 0x00000000 }, | |
136 | { 0x06, 0, 0, 0x00000000 }, | |
ae5c6c6d | 137 | { 0x15, 0, 32, 0x00008100 }, |
408eccce | 138 | { 0x28, 0, 0, 0x00000010 }, |
ae5c6c6d | 139 | { 0x15, 0, 7, 0x000088f7 }, |
408eccce DB |
140 | { 0x30, 0, 0, 0x00000012 }, |
141 | { 0x54, 0, 0, 0x00000008 }, | |
ae5c6c6d | 142 | { 0x15, 0, 35, 0x00000000 }, |
408eccce DB |
143 | { 0x28, 0, 0, 0x00000012 }, |
144 | { 0x54, 0, 0, 0x0000000f }, | |
5f94c943 | 145 | { 0x44, 0, 0, 0x000000c0 }, |
ae5c6c6d SS |
146 | { 0x16, 0, 0, 0x00000000 }, |
147 | { 0x15, 0, 12, 0x00000800 }, | |
148 | { 0x30, 0, 0, 0x0000001b }, | |
149 | { 0x15, 0, 9, 0x00000011 }, | |
150 | { 0x28, 0, 0, 0x00000018 }, | |
151 | { 0x45, 7, 0, 0x00001fff }, | |
152 | { 0xb1, 0, 0, 0x00000012 }, | |
153 | { 0x48, 0, 0, 0x00000014 }, | |
154 | { 0x15, 0, 4, 0x0000013f }, | |
155 | { 0x48, 0, 0, 0x0000001a }, | |
156 | { 0x54, 0, 0, 0x0000000f }, | |
5f94c943 | 157 | { 0x44, 0, 0, 0x00000090 }, |
ae5c6c6d SS |
158 | { 0x16, 0, 0, 0x00000000 }, |
159 | { 0x06, 0, 0, 0x00000000 }, | |
160 | { 0x15, 0, 8, 0x000086dd }, | |
161 | { 0x30, 0, 0, 0x00000018 }, | |
162 | { 0x15, 0, 6, 0x00000011 }, | |
163 | { 0x28, 0, 0, 0x0000003c }, | |
164 | { 0x15, 0, 4, 0x0000013f }, | |
165 | { 0x28, 0, 0, 0x00000042 }, | |
166 | { 0x54, 0, 0, 0x0000000f }, | |
5f94c943 | 167 | { 0x44, 0, 0, 0x000000a0 }, |
408eccce | 168 | { 0x16, 0, 0, 0x00000000 }, |
ae5c6c6d | 169 | { 0x06, 0, 0, 0x00000000 }, |
408eccce DB |
170 | { 0x15, 0, 7, 0x000088f7 }, |
171 | { 0x30, 0, 0, 0x0000000e }, | |
172 | { 0x54, 0, 0, 0x00000008 }, | |
173 | { 0x15, 0, 4, 0x00000000 }, | |
174 | { 0x28, 0, 0, 0x0000000e }, | |
175 | { 0x54, 0, 0, 0x0000000f }, | |
5f94c943 | 176 | { 0x44, 0, 0, 0x00000040 }, |
408eccce DB |
177 | { 0x16, 0, 0, 0x00000000 }, |
178 | { 0x06, 0, 0, 0x00000000 }, | |
179 | }; | |
ad910c7c AB |
180 | struct sock_fprog_kern ptp_prog; |
181 | ||
182 | ptp_prog.len = ARRAY_SIZE(ptp_filter); | |
183 | ptp_prog.filter = ptp_filter; | |
408eccce | 184 | |
7ae457c1 | 185 | BUG_ON(bpf_prog_create(&ptp_insns, &ptp_prog)); |
408eccce | 186 | } |