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