[mirror_ubuntu-zesty-kernel.git] / net / core / ptp_classifier.c

/* PTP classifier
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of version 2 of the GNU General Public
 * License as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
 * General Public License for more details.
 */

/* The below program is the bpf_asm (tools/net/) representation of
 * the opcode array in the ptp_filter structure.
 *
 * For convenience, this can easily be altered and reviewed with
 * bpf_asm and bpf_dbg, e.g. `./bpf_asm -c prog` where prog is a
 * simple file containing the below program:
 *
 * ldh [12]                        ; load ethertype
 *
 * ; PTP over UDP over IPv4 over Ethernet
 * test_ipv4:
 *   jneq #0x800, test_ipv6        ; ETH_P_IP ?
 *   ldb [23]                      ; load proto
 *   jneq #17, drop_ipv4           ; IPPROTO_UDP ?
 *   ldh [20]                      ; load frag offset field
 *   jset #0x1fff, drop_ipv4       ; don't allow fragments
 *   ldxb 4*([14]&0xf)             ; load IP header len
 *   ldh [x + 16]                  ; load UDP dst port
 *   jneq #319, drop_ipv4          ; is port PTP_EV_PORT ?
 *   ldh [x + 22]                  ; load payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0x10                      ; PTP_CLASS_IPV4
 *   ret a                         ; return PTP class
 *   drop_ipv4: ret #0x0           ; PTP_CLASS_NONE
 *
 * ; PTP over UDP over IPv6 over Ethernet
 * test_ipv6:
 *   jneq #0x86dd, test_8021q      ; ETH_P_IPV6 ?
 *   ldb [20]                      ; load proto
 *   jneq #17, drop_ipv6           ; IPPROTO_UDP ?
 *   ldh [56]                      ; load UDP dst port
 *   jneq #319, drop_ipv6          ; is port PTP_EV_PORT ?
 *   ldh [62]                      ; load payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0x20                      ; PTP_CLASS_IPV6
 *   ret a                         ; return PTP class
 *   drop_ipv6: ret #0x0           ; PTP_CLASS_NONE
 *
 * ; PTP over 802.1Q over Ethernet
 * test_8021q:
 *   jneq #0x8100, test_ieee1588   ; ETH_P_8021Q ?
 *   ldh [16]                      ; load inner type
 *   jneq #0x88f7, test_8021q_ipv4 ; ETH_P_1588 ?
 *   ldb [18]                      ; load payload
 *   and #0x8                      ; as we don't have ports here, test
 *   jneq #0x0, drop_ieee1588      ; for PTP_GEN_BIT and drop these
 *   ldh [18]                      ; reload payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0xc0                      ; PTP_CLASS_VLAN|PTP_CLASS_L2
 *   ret a                         ; return PTP class
 *
 * ; PTP over UDP over IPv4 over 802.1Q over Ethernet
 * test_8021q_ipv4:
 *   jneq #0x800, test_8021q_ipv6  ; ETH_P_IP ?
 *   ldb [27]                      ; load proto
 *   jneq #17, drop_8021q_ipv4     ; IPPROTO_UDP ?
 *   ldh [24]                      ; load frag offset field
 *   jset #0x1fff, drop_8021q_ipv4; don't allow fragments
 *   ldxb 4*([18]&0xf)             ; load IP header len
 *   ldh [x + 20]                  ; load UDP dst port
 *   jneq #319, drop_8021q_ipv4    ; is port PTP_EV_PORT ?
 *   ldh [x + 26]                  ; load payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0x90                      ; PTP_CLASS_VLAN|PTP_CLASS_IPV4
 *   ret a                         ; return PTP class
 *   drop_8021q_ipv4: ret #0x0     ; PTP_CLASS_NONE
 *
 * ; PTP over UDP over IPv6 over 802.1Q over Ethernet
 * test_8021q_ipv6:
 *   jneq #0x86dd, drop_8021q_ipv6 ; ETH_P_IPV6 ?
 *   ldb [24]                      ; load proto
 *   jneq #17, drop_8021q_ipv6           ; IPPROTO_UDP ?
 *   ldh [60]                      ; load UDP dst port
 *   jneq #319, drop_8021q_ipv6          ; is port PTP_EV_PORT ?
 *   ldh [66]                      ; load payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0xa0                      ; PTP_CLASS_VLAN|PTP_CLASS_IPV6
 *   ret a                         ; return PTP class
 *   drop_8021q_ipv6: ret #0x0     ; PTP_CLASS_NONE
 *
 * ; PTP over Ethernet
 * test_ieee1588:
 *   jneq #0x88f7, drop_ieee1588   ; ETH_P_1588 ?
 *   ldb [14]                      ; load payload
 *   and #0x8                      ; as we don't have ports here, test
 *   jneq #0x0, drop_ieee1588      ; for PTP_GEN_BIT and drop these
 *   ldh [14]                      ; reload payload
 *   and #0xf                      ; mask PTP_CLASS_VMASK
 *   or #0x40                      ; PTP_CLASS_L2
 *   ret a                         ; return PTP class
 *   drop_ieee1588: ret #0x0       ; PTP_CLASS_NONE
 */

#include <linux/skbuff.h>
#include <linux/filter.h>
#include <linux/ptp_classify.h>

static struct bpf_prog *ptp_insns __read_mostly;

unsigned int ptp_classify_raw(const struct sk_buff *skb)
{
	return BPF_PROG_RUN(ptp_insns, skb);
}
EXPORT_SYMBOL_GPL(ptp_classify_raw);

void __init ptp_classifier_init(void)
{
	static struct sock_filter ptp_filter[] __initdata = {
		{ 0x28,  0,  0, 0x0000000c },
		{ 0x15,  0, 12, 0x00000800 },
		{ 0x30,  0,  0, 0x00000017 },
		{ 0x15,  0,  9, 0x00000011 },
		{ 0x28,  0,  0, 0x00000014 },
		{ 0x45,  7,  0, 0x00001fff },
		{ 0xb1,  0,  0, 0x0000000e },
		{ 0x48,  0,  0, 0x00000010 },
		{ 0x15,  0,  4, 0x0000013f },
		{ 0x48,  0,  0, 0x00000016 },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x00000010 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x06,  0,  0, 0x00000000 },
		{ 0x15,  0,  9, 0x000086dd },
		{ 0x30,  0,  0, 0x00000014 },
		{ 0x15,  0,  6, 0x00000011 },
		{ 0x28,  0,  0, 0x00000038 },
		{ 0x15,  0,  4, 0x0000013f },
		{ 0x28,  0,  0, 0x0000003e },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x00000020 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x06,  0,  0, 0x00000000 },
		{ 0x15,  0, 32, 0x00008100 },
		{ 0x28,  0,  0, 0x00000010 },
		{ 0x15,  0,  7, 0x000088f7 },
		{ 0x30,  0,  0, 0x00000012 },
		{ 0x54,  0,  0, 0x00000008 },
		{ 0x15,  0, 35, 0x00000000 },
		{ 0x28,  0,  0, 0x00000012 },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x000000c0 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x15,  0, 12, 0x00000800 },
		{ 0x30,  0,  0, 0x0000001b },
		{ 0x15,  0,  9, 0x00000011 },
		{ 0x28,  0,  0, 0x00000018 },
		{ 0x45,  7,  0, 0x00001fff },
		{ 0xb1,  0,  0, 0x00000012 },
		{ 0x48,  0,  0, 0x00000014 },
		{ 0x15,  0,  4, 0x0000013f },
		{ 0x48,  0,  0, 0x0000001a },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x00000090 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x06,  0,  0, 0x00000000 },
		{ 0x15,  0,  8, 0x000086dd },
		{ 0x30,  0,  0, 0x00000018 },
		{ 0x15,  0,  6, 0x00000011 },
		{ 0x28,  0,  0, 0x0000003c },
		{ 0x15,  0,  4, 0x0000013f },
		{ 0x28,  0,  0, 0x00000042 },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x000000a0 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x06,  0,  0, 0x00000000 },
		{ 0x15,  0,  7, 0x000088f7 },
		{ 0x30,  0,  0, 0x0000000e },
		{ 0x54,  0,  0, 0x00000008 },
		{ 0x15,  0,  4, 0x00000000 },
		{ 0x28,  0,  0, 0x0000000e },
		{ 0x54,  0,  0, 0x0000000f },
		{ 0x44,  0,  0, 0x00000040 },
		{ 0x16,  0,  0, 0x00000000 },
		{ 0x06,  0,  0, 0x00000000 },
	};
	struct sock_fprog_kern ptp_prog = {
		.len = ARRAY_SIZE(ptp_filter), .filter = ptp_filter,
	};

	BUG_ON(bpf_prog_create(&ptp_insns, &ptp_prog));
}
Commit	Line	Data
408eccce DB	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
ae5c6c6d	55	* jneq #0x88f7, test_8021q_ipv4 ; ETH_P_1588 ?
408eccce DB	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
5f94c943	61	* or #0xc0 ; PTP_CLASS_VLAN\|PTP_CLASS_L2
ae5c6c6d SS	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
5f94c943	76	* or #0x90 ; PTP_CLASS_VLAN\|PTP_CLASS_IPV4
ae5c6c6d SS	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
5f94c943	89	* or #0xa0 ; PTP_CLASS_VLAN\|PTP_CLASS_IPV6
408eccce	90	* ret a ; return PTP class
ae5c6c6d	91	* drop_8021q_ipv6: ret #0x0 ; PTP_CLASS_NONE
408eccce DB	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
5f94c943	101	* or #0x40 ; PTP_CLASS_L2
408eccce DB	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
7ae457c1	110	static struct bpf_prog *ptp_insns __read_mostly;
408eccce DB	111
	112	unsigned int ptp_classify_raw(const struct sk_buff *skb)
	113	{
7ae457c1	114	return BPF_PROG_RUN(ptp_insns, skb);
408eccce DB	115	}
	116	EXPORT_SYMBOL_GPL(ptp_classify_raw);
	117
	118	void __init ptp_classifier_init(void)
	119	{
0f49ff07	120	static struct sock_filter ptp_filter[] __initdata = {
408eccce DB	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 },
ae5c6c6d	145	{ 0x15, 0, 32, 0x00008100 },
408eccce	146	{ 0x28, 0, 0, 0x00000010 },
ae5c6c6d	147	{ 0x15, 0, 7, 0x000088f7 },
408eccce DB	148	{ 0x30, 0, 0, 0x00000012 },
408eccce DB	149	{ 0x54, 0, 0, 0x00000008 },
ae5c6c6d	150	{ 0x15, 0, 35, 0x00000000 },
408eccce DB	151	{ 0x28, 0, 0, 0x00000012 },
408eccce DB	152	{ 0x54, 0, 0, 0x0000000f },
5f94c943	153	{ 0x44, 0, 0, 0x000000c0 },
ae5c6c6d SS	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 },
5f94c943	165	{ 0x44, 0, 0, 0x00000090 },
ae5c6c6d SS	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 },
5f94c943	175	{ 0x44, 0, 0, 0x000000a0 },
408eccce	176	{ 0x16, 0, 0, 0x00000000 },
ae5c6c6d	177	{ 0x06, 0, 0, 0x00000000 },
408eccce DB	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 },
5f94c943	184	{ 0x44, 0, 0, 0x00000040 },
408eccce DB	185	{ 0x16, 0, 0, 0x00000000 },
	186	{ 0x06, 0, 0, 0x00000000 },
	187	};
b1fcd35c	188	struct sock_fprog_kern ptp_prog = {
408eccce DB	189	.len = ARRAY_SIZE(ptp_filter), .filter = ptp_filter,
	190	};
	191
7ae457c1	192	BUG_ON(bpf_prog_create(&ptp_insns, &ptp_prog));
408eccce	193	}