1fb5cd0ceSMaxim Mikityanskiy // SPDX-License-Identifier: LGPL-2.1 OR BSD-2-Clause
2fb5cd0ceSMaxim Mikityanskiy /* Copyright (c) 2022, NVIDIA CORPORATION & AFFILIATES. All rights reserved. */
3fb5cd0ceSMaxim Mikityanskiy 
4fb5cd0ceSMaxim Mikityanskiy #include "vmlinux.h"
5fb5cd0ceSMaxim Mikityanskiy 
6fb5cd0ceSMaxim Mikityanskiy #include <bpf/bpf_helpers.h>
7fb5cd0ceSMaxim Mikityanskiy #include <bpf/bpf_endian.h>
8fb5cd0ceSMaxim Mikityanskiy #include <asm/errno.h>
9fb5cd0ceSMaxim Mikityanskiy 
10784d5dc0SMaxim Mikityanskiy #define TC_ACT_OK 0
11784d5dc0SMaxim Mikityanskiy #define TC_ACT_SHOT 2
12784d5dc0SMaxim Mikityanskiy 
13fb5cd0ceSMaxim Mikityanskiy #define NSEC_PER_SEC 1000000000L
14fb5cd0ceSMaxim Mikityanskiy 
15fb5cd0ceSMaxim Mikityanskiy #define ETH_ALEN 6
16fb5cd0ceSMaxim Mikityanskiy #define ETH_P_IP 0x0800
17fb5cd0ceSMaxim Mikityanskiy #define ETH_P_IPV6 0x86DD
18fb5cd0ceSMaxim Mikityanskiy 
19fb5cd0ceSMaxim Mikityanskiy #define tcp_flag_word(tp) (((union tcp_word_hdr *)(tp))->words[3])
20fb5cd0ceSMaxim Mikityanskiy 
21fb5cd0ceSMaxim Mikityanskiy #define IP_DF 0x4000
22fb5cd0ceSMaxim Mikityanskiy #define IP_MF 0x2000
23fb5cd0ceSMaxim Mikityanskiy #define IP_OFFSET 0x1fff
24fb5cd0ceSMaxim Mikityanskiy 
25fb5cd0ceSMaxim Mikityanskiy #define NEXTHDR_TCP 6
26fb5cd0ceSMaxim Mikityanskiy 
27fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_NOP 1
28fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_EOL 0
29fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_MSS 2
30fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_WINDOW 3
31fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_SACK_PERM 4
32fb5cd0ceSMaxim Mikityanskiy #define TCPOPT_TIMESTAMP 8
33fb5cd0ceSMaxim Mikityanskiy 
34fb5cd0ceSMaxim Mikityanskiy #define TCPOLEN_MSS 4
35fb5cd0ceSMaxim Mikityanskiy #define TCPOLEN_WINDOW 3
36fb5cd0ceSMaxim Mikityanskiy #define TCPOLEN_SACK_PERM 2
37fb5cd0ceSMaxim Mikityanskiy #define TCPOLEN_TIMESTAMP 10
38fb5cd0ceSMaxim Mikityanskiy 
39fb5cd0ceSMaxim Mikityanskiy #define TCP_TS_HZ 1000
40fb5cd0ceSMaxim Mikityanskiy #define TS_OPT_WSCALE_MASK 0xf
41fb5cd0ceSMaxim Mikityanskiy #define TS_OPT_SACK (1 << 4)
42fb5cd0ceSMaxim Mikityanskiy #define TS_OPT_ECN (1 << 5)
43fb5cd0ceSMaxim Mikityanskiy #define TSBITS 6
44fb5cd0ceSMaxim Mikityanskiy #define TSMASK (((__u32)1 << TSBITS) - 1)
45fb5cd0ceSMaxim Mikityanskiy #define TCP_MAX_WSCALE 14U
46fb5cd0ceSMaxim Mikityanskiy 
47fb5cd0ceSMaxim Mikityanskiy #define IPV4_MAXLEN 60
48fb5cd0ceSMaxim Mikityanskiy #define TCP_MAXLEN 60
49fb5cd0ceSMaxim Mikityanskiy 
50fb5cd0ceSMaxim Mikityanskiy #define DEFAULT_MSS4 1460
51fb5cd0ceSMaxim Mikityanskiy #define DEFAULT_MSS6 1440
52fb5cd0ceSMaxim Mikityanskiy #define DEFAULT_WSCALE 7
53fb5cd0ceSMaxim Mikityanskiy #define DEFAULT_TTL 64
54fb5cd0ceSMaxim Mikityanskiy #define MAX_ALLOWED_PORTS 8
55fb5cd0ceSMaxim Mikityanskiy 
56*d9631d0dSEduard Zingerman #define MAX_PACKET_OFF 0xffff
57*d9631d0dSEduard Zingerman 
58fb5cd0ceSMaxim Mikityanskiy #define swap(a, b) \
59fb5cd0ceSMaxim Mikityanskiy 	do { typeof(a) __tmp = (a); (a) = (b); (b) = __tmp; } while (0)
60fb5cd0ceSMaxim Mikityanskiy 
61fb5cd0ceSMaxim Mikityanskiy #define __get_unaligned_t(type, ptr) ({						\
62fb5cd0ceSMaxim Mikityanskiy 	const struct { type x; } __attribute__((__packed__)) *__pptr = (typeof(__pptr))(ptr); \
63fb5cd0ceSMaxim Mikityanskiy 	__pptr->x;								\
64fb5cd0ceSMaxim Mikityanskiy })
65fb5cd0ceSMaxim Mikityanskiy 
66fb5cd0ceSMaxim Mikityanskiy #define get_unaligned(ptr) __get_unaligned_t(typeof(*(ptr)), (ptr))
67fb5cd0ceSMaxim Mikityanskiy 
68fb5cd0ceSMaxim Mikityanskiy struct {
69fb5cd0ceSMaxim Mikityanskiy 	__uint(type, BPF_MAP_TYPE_ARRAY);
70fb5cd0ceSMaxim Mikityanskiy 	__type(key, __u32);
71fb5cd0ceSMaxim Mikityanskiy 	__type(value, __u64);
72fb5cd0ceSMaxim Mikityanskiy 	__uint(max_entries, 2);
73fb5cd0ceSMaxim Mikityanskiy } values SEC(".maps");
74fb5cd0ceSMaxim Mikityanskiy 
75fb5cd0ceSMaxim Mikityanskiy struct {
76fb5cd0ceSMaxim Mikityanskiy 	__uint(type, BPF_MAP_TYPE_ARRAY);
77fb5cd0ceSMaxim Mikityanskiy 	__type(key, __u32);
78fb5cd0ceSMaxim Mikityanskiy 	__type(value, __u16);
79fb5cd0ceSMaxim Mikityanskiy 	__uint(max_entries, MAX_ALLOWED_PORTS);
80fb5cd0ceSMaxim Mikityanskiy } allowed_ports SEC(".maps");
81fb5cd0ceSMaxim Mikityanskiy 
8224bdfdd2SMaxim Mikityanskiy /* Some symbols defined in net/netfilter/nf_conntrack_bpf.c are unavailable in
8324bdfdd2SMaxim Mikityanskiy  * vmlinux.h if CONFIG_NF_CONNTRACK=m, so they are redefined locally.
8424bdfdd2SMaxim Mikityanskiy  */
8524bdfdd2SMaxim Mikityanskiy 
8624bdfdd2SMaxim Mikityanskiy struct bpf_ct_opts___local {
8724bdfdd2SMaxim Mikityanskiy 	s32 netns_id;
8824bdfdd2SMaxim Mikityanskiy 	s32 error;
8924bdfdd2SMaxim Mikityanskiy 	u8 l4proto;
9024bdfdd2SMaxim Mikityanskiy 	u8 dir;
9124bdfdd2SMaxim Mikityanskiy 	u8 reserved[2];
9224bdfdd2SMaxim Mikityanskiy } __attribute__((preserve_access_index));
9324bdfdd2SMaxim Mikityanskiy 
9424bdfdd2SMaxim Mikityanskiy #define BPF_F_CURRENT_NETNS (-1)
9524bdfdd2SMaxim Mikityanskiy 
96fb5cd0ceSMaxim Mikityanskiy extern struct nf_conn *bpf_xdp_ct_lookup(struct xdp_md *xdp_ctx,
97fb5cd0ceSMaxim Mikityanskiy 					 struct bpf_sock_tuple *bpf_tuple,
98fb5cd0ceSMaxim Mikityanskiy 					 __u32 len_tuple,
9924bdfdd2SMaxim Mikityanskiy 					 struct bpf_ct_opts___local *opts,
100fb5cd0ceSMaxim Mikityanskiy 					 __u32 len_opts) __ksym;
101fb5cd0ceSMaxim Mikityanskiy 
102784d5dc0SMaxim Mikityanskiy extern struct nf_conn *bpf_skb_ct_lookup(struct __sk_buff *skb_ctx,
103784d5dc0SMaxim Mikityanskiy 					 struct bpf_sock_tuple *bpf_tuple,
104784d5dc0SMaxim Mikityanskiy 					 u32 len_tuple,
10524bdfdd2SMaxim Mikityanskiy 					 struct bpf_ct_opts___local *opts,
106784d5dc0SMaxim Mikityanskiy 					 u32 len_opts) __ksym;
107784d5dc0SMaxim Mikityanskiy 
108fb5cd0ceSMaxim Mikityanskiy extern void bpf_ct_release(struct nf_conn *ct) __ksym;
109fb5cd0ceSMaxim Mikityanskiy 
swap_eth_addr(__u8 * a,__u8 * b)110fb5cd0ceSMaxim Mikityanskiy static __always_inline void swap_eth_addr(__u8 *a, __u8 *b)
111fb5cd0ceSMaxim Mikityanskiy {
112fb5cd0ceSMaxim Mikityanskiy 	__u8 tmp[ETH_ALEN];
113fb5cd0ceSMaxim Mikityanskiy 
114fb5cd0ceSMaxim Mikityanskiy 	__builtin_memcpy(tmp, a, ETH_ALEN);
115fb5cd0ceSMaxim Mikityanskiy 	__builtin_memcpy(a, b, ETH_ALEN);
116fb5cd0ceSMaxim Mikityanskiy 	__builtin_memcpy(b, tmp, ETH_ALEN);
117fb5cd0ceSMaxim Mikityanskiy }
118fb5cd0ceSMaxim Mikityanskiy 
csum_fold(__u32 csum)119fb5cd0ceSMaxim Mikityanskiy static __always_inline __u16 csum_fold(__u32 csum)
120fb5cd0ceSMaxim Mikityanskiy {
121fb5cd0ceSMaxim Mikityanskiy 	csum = (csum & 0xffff) + (csum >> 16);
122fb5cd0ceSMaxim Mikityanskiy 	csum = (csum & 0xffff) + (csum >> 16);
123fb5cd0ceSMaxim Mikityanskiy 	return (__u16)~csum;
124fb5cd0ceSMaxim Mikityanskiy }
125fb5cd0ceSMaxim Mikityanskiy 
csum_tcpudp_magic(__be32 saddr,__be32 daddr,__u32 len,__u8 proto,__u32 csum)126fb5cd0ceSMaxim Mikityanskiy static __always_inline __u16 csum_tcpudp_magic(__be32 saddr, __be32 daddr,
127fb5cd0ceSMaxim Mikityanskiy 					       __u32 len, __u8 proto,
128fb5cd0ceSMaxim Mikityanskiy 					       __u32 csum)
129fb5cd0ceSMaxim Mikityanskiy {
130fb5cd0ceSMaxim Mikityanskiy 	__u64 s = csum;
131fb5cd0ceSMaxim Mikityanskiy 
132fb5cd0ceSMaxim Mikityanskiy 	s += (__u32)saddr;
133fb5cd0ceSMaxim Mikityanskiy 	s += (__u32)daddr;
134fb5cd0ceSMaxim Mikityanskiy #if __BYTE_ORDER__ == __ORDER_BIG_ENDIAN__
135fb5cd0ceSMaxim Mikityanskiy 	s += proto + len;
136fb5cd0ceSMaxim Mikityanskiy #elif __BYTE_ORDER__ == __ORDER_LITTLE_ENDIAN__
137fb5cd0ceSMaxim Mikityanskiy 	s += (proto + len) << 8;
138fb5cd0ceSMaxim Mikityanskiy #else
139fb5cd0ceSMaxim Mikityanskiy #error Unknown endian
140fb5cd0ceSMaxim Mikityanskiy #endif
141fb5cd0ceSMaxim Mikityanskiy 	s = (s & 0xffffffff) + (s >> 32);
142fb5cd0ceSMaxim Mikityanskiy 	s = (s & 0xffffffff) + (s >> 32);
143fb5cd0ceSMaxim Mikityanskiy 
144fb5cd0ceSMaxim Mikityanskiy 	return csum_fold((__u32)s);
145fb5cd0ceSMaxim Mikityanskiy }
146fb5cd0ceSMaxim Mikityanskiy 
csum_ipv6_magic(const struct in6_addr * saddr,const struct in6_addr * daddr,__u32 len,__u8 proto,__u32 csum)147fb5cd0ceSMaxim Mikityanskiy static __always_inline __u16 csum_ipv6_magic(const struct in6_addr *saddr,
148fb5cd0ceSMaxim Mikityanskiy 					     const struct in6_addr *daddr,
149fb5cd0ceSMaxim Mikityanskiy 					     __u32 len, __u8 proto, __u32 csum)
150fb5cd0ceSMaxim Mikityanskiy {
151fb5cd0ceSMaxim Mikityanskiy 	__u64 sum = csum;
152fb5cd0ceSMaxim Mikityanskiy 	int i;
153fb5cd0ceSMaxim Mikityanskiy 
154fb5cd0ceSMaxim Mikityanskiy #pragma unroll
155fb5cd0ceSMaxim Mikityanskiy 	for (i = 0; i < 4; i++)
156fb5cd0ceSMaxim Mikityanskiy 		sum += (__u32)saddr->in6_u.u6_addr32[i];
157fb5cd0ceSMaxim Mikityanskiy 
158fb5cd0ceSMaxim Mikityanskiy #pragma unroll
159fb5cd0ceSMaxim Mikityanskiy 	for (i = 0; i < 4; i++)
160fb5cd0ceSMaxim Mikityanskiy 		sum += (__u32)daddr->in6_u.u6_addr32[i];
161fb5cd0ceSMaxim Mikityanskiy 
162fb5cd0ceSMaxim Mikityanskiy 	/* Don't combine additions to avoid 32-bit overflow. */
163fb5cd0ceSMaxim Mikityanskiy 	sum += bpf_htonl(len);
164fb5cd0ceSMaxim Mikityanskiy 	sum += bpf_htonl(proto);
165fb5cd0ceSMaxim Mikityanskiy 
166fb5cd0ceSMaxim Mikityanskiy 	sum = (sum & 0xffffffff) + (sum >> 32);
167fb5cd0ceSMaxim Mikityanskiy 	sum = (sum & 0xffffffff) + (sum >> 32);
168fb5cd0ceSMaxim Mikityanskiy 
169fb5cd0ceSMaxim Mikityanskiy 	return csum_fold((__u32)sum);
170fb5cd0ceSMaxim Mikityanskiy }
171fb5cd0ceSMaxim Mikityanskiy 
tcp_clock_ns(void)172fb5cd0ceSMaxim Mikityanskiy static __always_inline __u64 tcp_clock_ns(void)
173fb5cd0ceSMaxim Mikityanskiy {
174fb5cd0ceSMaxim Mikityanskiy 	return bpf_ktime_get_ns();
175fb5cd0ceSMaxim Mikityanskiy }
176fb5cd0ceSMaxim Mikityanskiy 
tcp_ns_to_ts(__u64 ns)177fb5cd0ceSMaxim Mikityanskiy static __always_inline __u32 tcp_ns_to_ts(__u64 ns)
178fb5cd0ceSMaxim Mikityanskiy {
179fb5cd0ceSMaxim Mikityanskiy 	return ns / (NSEC_PER_SEC / TCP_TS_HZ);
180fb5cd0ceSMaxim Mikityanskiy }
181fb5cd0ceSMaxim Mikityanskiy 
tcp_time_stamp_raw(void)182fb5cd0ceSMaxim Mikityanskiy static __always_inline __u32 tcp_time_stamp_raw(void)
183fb5cd0ceSMaxim Mikityanskiy {
184fb5cd0ceSMaxim Mikityanskiy 	return tcp_ns_to_ts(tcp_clock_ns());
185fb5cd0ceSMaxim Mikityanskiy }
186fb5cd0ceSMaxim Mikityanskiy 
187fb5cd0ceSMaxim Mikityanskiy struct tcpopt_context {
188*d9631d0dSEduard Zingerman 	void *data;
189fb5cd0ceSMaxim Mikityanskiy 	void *data_end;
190fb5cd0ceSMaxim Mikityanskiy 	__be32 *tsecr;
191fb5cd0ceSMaxim Mikityanskiy 	__u8 wscale;
192fb5cd0ceSMaxim Mikityanskiy 	bool option_timestamp;
193fb5cd0ceSMaxim Mikityanskiy 	bool option_sack;
194*d9631d0dSEduard Zingerman 	__u32 off;
195fb5cd0ceSMaxim Mikityanskiy };
196fb5cd0ceSMaxim Mikityanskiy 
next(struct tcpopt_context * ctx,__u32 sz)197*d9631d0dSEduard Zingerman static __always_inline u8 *next(struct tcpopt_context *ctx, __u32 sz)
198*d9631d0dSEduard Zingerman {
199*d9631d0dSEduard Zingerman 	__u64 off = ctx->off;
200*d9631d0dSEduard Zingerman 	__u8 *data;
201*d9631d0dSEduard Zingerman 
202*d9631d0dSEduard Zingerman 	/* Verifier forbids access to packet when offset exceeds MAX_PACKET_OFF */
203*d9631d0dSEduard Zingerman 	if (off > MAX_PACKET_OFF - sz)
204*d9631d0dSEduard Zingerman 		return NULL;
205*d9631d0dSEduard Zingerman 
206*d9631d0dSEduard Zingerman 	data = ctx->data + off;
207*d9631d0dSEduard Zingerman 	barrier_var(data);
208*d9631d0dSEduard Zingerman 	if (data + sz >= ctx->data_end)
209*d9631d0dSEduard Zingerman 		return NULL;
210*d9631d0dSEduard Zingerman 
211*d9631d0dSEduard Zingerman 	ctx->off += sz;
212*d9631d0dSEduard Zingerman 	return data;
213*d9631d0dSEduard Zingerman }
214*d9631d0dSEduard Zingerman 
tscookie_tcpopt_parse(struct tcpopt_context * ctx)215fb5cd0ceSMaxim Mikityanskiy static int tscookie_tcpopt_parse(struct tcpopt_context *ctx)
216fb5cd0ceSMaxim Mikityanskiy {
217*d9631d0dSEduard Zingerman 	__u8 *opcode, *opsize, *wscale, *tsecr;
218*d9631d0dSEduard Zingerman 	__u32 off = ctx->off;
219fb5cd0ceSMaxim Mikityanskiy 
220*d9631d0dSEduard Zingerman 	opcode = next(ctx, 1);
221*d9631d0dSEduard Zingerman 	if (!opcode)
222fb5cd0ceSMaxim Mikityanskiy 		return 1;
223fb5cd0ceSMaxim Mikityanskiy 
224*d9631d0dSEduard Zingerman 	if (*opcode == TCPOPT_EOL)
225fb5cd0ceSMaxim Mikityanskiy 		return 1;
226*d9631d0dSEduard Zingerman 	if (*opcode == TCPOPT_NOP)
227fb5cd0ceSMaxim Mikityanskiy 		return 0;
228fb5cd0ceSMaxim Mikityanskiy 
229*d9631d0dSEduard Zingerman 	opsize = next(ctx, 1);
230*d9631d0dSEduard Zingerman 	if (!opsize || *opsize < 2)
231fb5cd0ceSMaxim Mikityanskiy 		return 1;
232fb5cd0ceSMaxim Mikityanskiy 
233*d9631d0dSEduard Zingerman 	switch (*opcode) {
234fb5cd0ceSMaxim Mikityanskiy 	case TCPOPT_WINDOW:
235*d9631d0dSEduard Zingerman 		wscale = next(ctx, 1);
236*d9631d0dSEduard Zingerman 		if (!wscale)
237*d9631d0dSEduard Zingerman 			return 1;
238*d9631d0dSEduard Zingerman 		if (*opsize == TCPOLEN_WINDOW)
239*d9631d0dSEduard Zingerman 			ctx->wscale = *wscale < TCP_MAX_WSCALE ? *wscale : TCP_MAX_WSCALE;
240fb5cd0ceSMaxim Mikityanskiy 		break;
241fb5cd0ceSMaxim Mikityanskiy 	case TCPOPT_TIMESTAMP:
242*d9631d0dSEduard Zingerman 		tsecr = next(ctx, 4);
243*d9631d0dSEduard Zingerman 		if (!tsecr)
244*d9631d0dSEduard Zingerman 			return 1;
245*d9631d0dSEduard Zingerman 		if (*opsize == TCPOLEN_TIMESTAMP) {
246fb5cd0ceSMaxim Mikityanskiy 			ctx->option_timestamp = true;
247fb5cd0ceSMaxim Mikityanskiy 			/* Client's tsval becomes our tsecr. */
248*d9631d0dSEduard Zingerman 			*ctx->tsecr = get_unaligned((__be32 *)tsecr);
249fb5cd0ceSMaxim Mikityanskiy 		}
250fb5cd0ceSMaxim Mikityanskiy 		break;
251fb5cd0ceSMaxim Mikityanskiy 	case TCPOPT_SACK_PERM:
252*d9631d0dSEduard Zingerman 		if (*opsize == TCPOLEN_SACK_PERM)
253fb5cd0ceSMaxim Mikityanskiy 			ctx->option_sack = true;
254fb5cd0ceSMaxim Mikityanskiy 		break;
255fb5cd0ceSMaxim Mikityanskiy 	}
256fb5cd0ceSMaxim Mikityanskiy 
257*d9631d0dSEduard Zingerman 	ctx->off = off + *opsize;
258fb5cd0ceSMaxim Mikityanskiy 
259fb5cd0ceSMaxim Mikityanskiy 	return 0;
260fb5cd0ceSMaxim Mikityanskiy }
261fb5cd0ceSMaxim Mikityanskiy 
tscookie_tcpopt_parse_batch(__u32 index,void * context)262fb5cd0ceSMaxim Mikityanskiy static int tscookie_tcpopt_parse_batch(__u32 index, void *context)
263fb5cd0ceSMaxim Mikityanskiy {
264fb5cd0ceSMaxim Mikityanskiy 	int i;
265fb5cd0ceSMaxim Mikityanskiy 
266fb5cd0ceSMaxim Mikityanskiy 	for (i = 0; i < 7; i++)
267fb5cd0ceSMaxim Mikityanskiy 		if (tscookie_tcpopt_parse(context))
268fb5cd0ceSMaxim Mikityanskiy 			return 1;
269fb5cd0ceSMaxim Mikityanskiy 	return 0;
270fb5cd0ceSMaxim Mikityanskiy }
271fb5cd0ceSMaxim Mikityanskiy 
tscookie_init(struct tcphdr * tcp_header,__u16 tcp_len,__be32 * tsval,__be32 * tsecr,void * data,void * data_end)272fb5cd0ceSMaxim Mikityanskiy static __always_inline bool tscookie_init(struct tcphdr *tcp_header,
273fb5cd0ceSMaxim Mikityanskiy 					  __u16 tcp_len, __be32 *tsval,
274*d9631d0dSEduard Zingerman 					  __be32 *tsecr, void *data, void *data_end)
275fb5cd0ceSMaxim Mikityanskiy {
276fb5cd0ceSMaxim Mikityanskiy 	struct tcpopt_context loop_ctx = {
277*d9631d0dSEduard Zingerman 		.data = data,
278fb5cd0ceSMaxim Mikityanskiy 		.data_end = data_end,
279fb5cd0ceSMaxim Mikityanskiy 		.tsecr = tsecr,
280fb5cd0ceSMaxim Mikityanskiy 		.wscale = TS_OPT_WSCALE_MASK,
281fb5cd0ceSMaxim Mikityanskiy 		.option_timestamp = false,
282fb5cd0ceSMaxim Mikityanskiy 		.option_sack = false,
283*d9631d0dSEduard Zingerman 		/* Note: currently verifier would track .off as unbound scalar.
284*d9631d0dSEduard Zingerman 		 *       In case if verifier would at some point get smarter and
285*d9631d0dSEduard Zingerman 		 *       compute bounded value for this var, beware that it might
286*d9631d0dSEduard Zingerman 		 *       hinder bpf_loop() convergence validation.
287*d9631d0dSEduard Zingerman 		 */
288*d9631d0dSEduard Zingerman 		.off = (__u8 *)(tcp_header + 1) - (__u8 *)data,
289fb5cd0ceSMaxim Mikityanskiy 	};
290fb5cd0ceSMaxim Mikityanskiy 	u32 cookie;
291fb5cd0ceSMaxim Mikityanskiy 
292fb5cd0ceSMaxim Mikityanskiy 	bpf_loop(6, tscookie_tcpopt_parse_batch, &loop_ctx, 0);
293fb5cd0ceSMaxim Mikityanskiy 
294fb5cd0ceSMaxim Mikityanskiy 	if (!loop_ctx.option_timestamp)
295fb5cd0ceSMaxim Mikityanskiy 		return false;
296fb5cd0ceSMaxim Mikityanskiy 
297fb5cd0ceSMaxim Mikityanskiy 	cookie = tcp_time_stamp_raw() & ~TSMASK;
298fb5cd0ceSMaxim Mikityanskiy 	cookie |= loop_ctx.wscale & TS_OPT_WSCALE_MASK;
299fb5cd0ceSMaxim Mikityanskiy 	if (loop_ctx.option_sack)
300fb5cd0ceSMaxim Mikityanskiy 		cookie |= TS_OPT_SACK;
301fb5cd0ceSMaxim Mikityanskiy 	if (tcp_header->ece && tcp_header->cwr)
302fb5cd0ceSMaxim Mikityanskiy 		cookie |= TS_OPT_ECN;
303fb5cd0ceSMaxim Mikityanskiy 	*tsval = bpf_htonl(cookie);
304fb5cd0ceSMaxim Mikityanskiy 
305fb5cd0ceSMaxim Mikityanskiy 	return true;
306fb5cd0ceSMaxim Mikityanskiy }
307fb5cd0ceSMaxim Mikityanskiy 
values_get_tcpipopts(__u16 * mss,__u8 * wscale,__u8 * ttl,bool ipv6)308fb5cd0ceSMaxim Mikityanskiy static __always_inline void values_get_tcpipopts(__u16 *mss, __u8 *wscale,
309fb5cd0ceSMaxim Mikityanskiy 						 __u8 *ttl, bool ipv6)
310fb5cd0ceSMaxim Mikityanskiy {
311fb5cd0ceSMaxim Mikityanskiy 	__u32 key = 0;
312fb5cd0ceSMaxim Mikityanskiy 	__u64 *value;
313fb5cd0ceSMaxim Mikityanskiy 
314fb5cd0ceSMaxim Mikityanskiy 	value = bpf_map_lookup_elem(&values, &key);
315fb5cd0ceSMaxim Mikityanskiy 	if (value && *value != 0) {
316fb5cd0ceSMaxim Mikityanskiy 		if (ipv6)
317fb5cd0ceSMaxim Mikityanskiy 			*mss = (*value >> 32) & 0xffff;
318fb5cd0ceSMaxim Mikityanskiy 		else
319fb5cd0ceSMaxim Mikityanskiy 			*mss = *value & 0xffff;
320fb5cd0ceSMaxim Mikityanskiy 		*wscale = (*value >> 16) & 0xf;
321fb5cd0ceSMaxim Mikityanskiy 		*ttl = (*value >> 24) & 0xff;
322fb5cd0ceSMaxim Mikityanskiy 		return;
323fb5cd0ceSMaxim Mikityanskiy 	}
324fb5cd0ceSMaxim Mikityanskiy 
325fb5cd0ceSMaxim Mikityanskiy 	*mss = ipv6 ? DEFAULT_MSS6 : DEFAULT_MSS4;
326fb5cd0ceSMaxim Mikityanskiy 	*wscale = DEFAULT_WSCALE;
327fb5cd0ceSMaxim Mikityanskiy 	*ttl = DEFAULT_TTL;
328fb5cd0ceSMaxim Mikityanskiy }
329fb5cd0ceSMaxim Mikityanskiy 
values_inc_synacks(void)330fb5cd0ceSMaxim Mikityanskiy static __always_inline void values_inc_synacks(void)
331fb5cd0ceSMaxim Mikityanskiy {
332fb5cd0ceSMaxim Mikityanskiy 	__u32 key = 1;
333438a2edfSIlya Leoshkevich 	__u64 *value;
334fb5cd0ceSMaxim Mikityanskiy 
335fb5cd0ceSMaxim Mikityanskiy 	value = bpf_map_lookup_elem(&values, &key);
336fb5cd0ceSMaxim Mikityanskiy 	if (value)
337fb5cd0ceSMaxim Mikityanskiy 		__sync_fetch_and_add(value, 1);
338fb5cd0ceSMaxim Mikityanskiy }
339fb5cd0ceSMaxim Mikityanskiy 
check_port_allowed(__u16 port)340fb5cd0ceSMaxim Mikityanskiy static __always_inline bool check_port_allowed(__u16 port)
341fb5cd0ceSMaxim Mikityanskiy {
342fb5cd0ceSMaxim Mikityanskiy 	__u32 i;
343fb5cd0ceSMaxim Mikityanskiy 
344fb5cd0ceSMaxim Mikityanskiy 	for (i = 0; i < MAX_ALLOWED_PORTS; i++) {
345fb5cd0ceSMaxim Mikityanskiy 		__u32 key = i;
346fb5cd0ceSMaxim Mikityanskiy 		__u16 *value;
347fb5cd0ceSMaxim Mikityanskiy 
348fb5cd0ceSMaxim Mikityanskiy 		value = bpf_map_lookup_elem(&allowed_ports, &key);
349fb5cd0ceSMaxim Mikityanskiy 
350fb5cd0ceSMaxim Mikityanskiy 		if (!value)
351fb5cd0ceSMaxim Mikityanskiy 			break;
352fb5cd0ceSMaxim Mikityanskiy 		/* 0 is a terminator value. Check it first to avoid matching on
353fb5cd0ceSMaxim Mikityanskiy 		 * a forbidden port == 0 and returning true.
354fb5cd0ceSMaxim Mikityanskiy 		 */
355fb5cd0ceSMaxim Mikityanskiy 		if (*value == 0)
356fb5cd0ceSMaxim Mikityanskiy 			break;
357fb5cd0ceSMaxim Mikityanskiy 
358fb5cd0ceSMaxim Mikityanskiy 		if (*value == port)
359fb5cd0ceSMaxim Mikityanskiy 			return true;
360fb5cd0ceSMaxim Mikityanskiy 	}
361fb5cd0ceSMaxim Mikityanskiy 
362fb5cd0ceSMaxim Mikityanskiy 	return false;
363fb5cd0ceSMaxim Mikityanskiy }
364fb5cd0ceSMaxim Mikityanskiy 
365fb5cd0ceSMaxim Mikityanskiy struct header_pointers {
366fb5cd0ceSMaxim Mikityanskiy 	struct ethhdr *eth;
367fb5cd0ceSMaxim Mikityanskiy 	struct iphdr *ipv4;
368fb5cd0ceSMaxim Mikityanskiy 	struct ipv6hdr *ipv6;
369fb5cd0ceSMaxim Mikityanskiy 	struct tcphdr *tcp;
370fb5cd0ceSMaxim Mikityanskiy 	__u16 tcp_len;
371fb5cd0ceSMaxim Mikityanskiy };
372fb5cd0ceSMaxim Mikityanskiy 
tcp_dissect(void * data,void * data_end,struct header_pointers * hdr)373fb5cd0ceSMaxim Mikityanskiy static __always_inline int tcp_dissect(void *data, void *data_end,
374fb5cd0ceSMaxim Mikityanskiy 				       struct header_pointers *hdr)
375fb5cd0ceSMaxim Mikityanskiy {
376fb5cd0ceSMaxim Mikityanskiy 	hdr->eth = data;
377fb5cd0ceSMaxim Mikityanskiy 	if (hdr->eth + 1 > data_end)
378fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
379fb5cd0ceSMaxim Mikityanskiy 
380fb5cd0ceSMaxim Mikityanskiy 	switch (bpf_ntohs(hdr->eth->h_proto)) {
381fb5cd0ceSMaxim Mikityanskiy 	case ETH_P_IP:
382fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv6 = NULL;
383fb5cd0ceSMaxim Mikityanskiy 
384fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv4 = (void *)hdr->eth + sizeof(*hdr->eth);
385fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv4 + 1 > data_end)
386fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
387fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv4->ihl * 4 < sizeof(*hdr->ipv4))
388fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
389fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv4->version != 4)
390fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
391fb5cd0ceSMaxim Mikityanskiy 
392fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv4->protocol != IPPROTO_TCP)
393fb5cd0ceSMaxim Mikityanskiy 			return XDP_PASS;
394fb5cd0ceSMaxim Mikityanskiy 
395fb5cd0ceSMaxim Mikityanskiy 		hdr->tcp = (void *)hdr->ipv4 + hdr->ipv4->ihl * 4;
396fb5cd0ceSMaxim Mikityanskiy 		break;
397fb5cd0ceSMaxim Mikityanskiy 	case ETH_P_IPV6:
398fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv4 = NULL;
399fb5cd0ceSMaxim Mikityanskiy 
400fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv6 = (void *)hdr->eth + sizeof(*hdr->eth);
401fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv6 + 1 > data_end)
402fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
403fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv6->version != 6)
404fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
405fb5cd0ceSMaxim Mikityanskiy 
406fb5cd0ceSMaxim Mikityanskiy 		/* XXX: Extension headers are not supported and could circumvent
407fb5cd0ceSMaxim Mikityanskiy 		 * XDP SYN flood protection.
408fb5cd0ceSMaxim Mikityanskiy 		 */
409fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv6->nexthdr != NEXTHDR_TCP)
410fb5cd0ceSMaxim Mikityanskiy 			return XDP_PASS;
411fb5cd0ceSMaxim Mikityanskiy 
412fb5cd0ceSMaxim Mikityanskiy 		hdr->tcp = (void *)hdr->ipv6 + sizeof(*hdr->ipv6);
413fb5cd0ceSMaxim Mikityanskiy 		break;
414fb5cd0ceSMaxim Mikityanskiy 	default:
415fb5cd0ceSMaxim Mikityanskiy 		/* XXX: VLANs will circumvent XDP SYN flood protection. */
416fb5cd0ceSMaxim Mikityanskiy 		return XDP_PASS;
417fb5cd0ceSMaxim Mikityanskiy 	}
418fb5cd0ceSMaxim Mikityanskiy 
419fb5cd0ceSMaxim Mikityanskiy 	if (hdr->tcp + 1 > data_end)
420fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
421fb5cd0ceSMaxim Mikityanskiy 	hdr->tcp_len = hdr->tcp->doff * 4;
422fb5cd0ceSMaxim Mikityanskiy 	if (hdr->tcp_len < sizeof(*hdr->tcp))
423fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
424fb5cd0ceSMaxim Mikityanskiy 
425fb5cd0ceSMaxim Mikityanskiy 	return XDP_TX;
426fb5cd0ceSMaxim Mikityanskiy }
427fb5cd0ceSMaxim Mikityanskiy 
tcp_lookup(void * ctx,struct header_pointers * hdr,bool xdp)428784d5dc0SMaxim Mikityanskiy static __always_inline int tcp_lookup(void *ctx, struct header_pointers *hdr, bool xdp)
429fb5cd0ceSMaxim Mikityanskiy {
43024bdfdd2SMaxim Mikityanskiy 	struct bpf_ct_opts___local ct_lookup_opts = {
431fb5cd0ceSMaxim Mikityanskiy 		.netns_id = BPF_F_CURRENT_NETNS,
432fb5cd0ceSMaxim Mikityanskiy 		.l4proto = IPPROTO_TCP,
433fb5cd0ceSMaxim Mikityanskiy 	};
434fb5cd0ceSMaxim Mikityanskiy 	struct bpf_sock_tuple tup = {};
435fb5cd0ceSMaxim Mikityanskiy 	struct nf_conn *ct;
436fb5cd0ceSMaxim Mikityanskiy 	__u32 tup_size;
437fb5cd0ceSMaxim Mikityanskiy 
438fb5cd0ceSMaxim Mikityanskiy 	if (hdr->ipv4) {
439fb5cd0ceSMaxim Mikityanskiy 		/* TCP doesn't normally use fragments, and XDP can't reassemble
440fb5cd0ceSMaxim Mikityanskiy 		 * them.
441fb5cd0ceSMaxim Mikityanskiy 		 */
442fb5cd0ceSMaxim Mikityanskiy 		if ((hdr->ipv4->frag_off & bpf_htons(IP_DF | IP_MF | IP_OFFSET)) != bpf_htons(IP_DF))
443fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP;
444fb5cd0ceSMaxim Mikityanskiy 
445fb5cd0ceSMaxim Mikityanskiy 		tup.ipv4.saddr = hdr->ipv4->saddr;
446fb5cd0ceSMaxim Mikityanskiy 		tup.ipv4.daddr = hdr->ipv4->daddr;
447fb5cd0ceSMaxim Mikityanskiy 		tup.ipv4.sport = hdr->tcp->source;
448fb5cd0ceSMaxim Mikityanskiy 		tup.ipv4.dport = hdr->tcp->dest;
449fb5cd0ceSMaxim Mikityanskiy 		tup_size = sizeof(tup.ipv4);
450fb5cd0ceSMaxim Mikityanskiy 	} else if (hdr->ipv6) {
451fb5cd0ceSMaxim Mikityanskiy 		__builtin_memcpy(tup.ipv6.saddr, &hdr->ipv6->saddr, sizeof(tup.ipv6.saddr));
452fb5cd0ceSMaxim Mikityanskiy 		__builtin_memcpy(tup.ipv6.daddr, &hdr->ipv6->daddr, sizeof(tup.ipv6.daddr));
453fb5cd0ceSMaxim Mikityanskiy 		tup.ipv6.sport = hdr->tcp->source;
454fb5cd0ceSMaxim Mikityanskiy 		tup.ipv6.dport = hdr->tcp->dest;
455fb5cd0ceSMaxim Mikityanskiy 		tup_size = sizeof(tup.ipv6);
456fb5cd0ceSMaxim Mikityanskiy 	} else {
457fb5cd0ceSMaxim Mikityanskiy 		/* The verifier can't track that either ipv4 or ipv6 is not
458fb5cd0ceSMaxim Mikityanskiy 		 * NULL.
459fb5cd0ceSMaxim Mikityanskiy 		 */
460fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
461fb5cd0ceSMaxim Mikityanskiy 	}
462784d5dc0SMaxim Mikityanskiy 	if (xdp)
463fb5cd0ceSMaxim Mikityanskiy 		ct = bpf_xdp_ct_lookup(ctx, &tup, tup_size, &ct_lookup_opts, sizeof(ct_lookup_opts));
464784d5dc0SMaxim Mikityanskiy 	else
465784d5dc0SMaxim Mikityanskiy 		ct = bpf_skb_ct_lookup(ctx, &tup, tup_size, &ct_lookup_opts, sizeof(ct_lookup_opts));
466fb5cd0ceSMaxim Mikityanskiy 	if (ct) {
467fb5cd0ceSMaxim Mikityanskiy 		unsigned long status = ct->status;
468fb5cd0ceSMaxim Mikityanskiy 
469fb5cd0ceSMaxim Mikityanskiy 		bpf_ct_release(ct);
4703bb89decSJeroen van Ingen Schenau 		if (status & IPS_CONFIRMED)
471fb5cd0ceSMaxim Mikityanskiy 			return XDP_PASS;
472fb5cd0ceSMaxim Mikityanskiy 	} else if (ct_lookup_opts.error != -ENOENT) {
473fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
474fb5cd0ceSMaxim Mikityanskiy 	}
475fb5cd0ceSMaxim Mikityanskiy 
4763bb89decSJeroen van Ingen Schenau 	/* error == -ENOENT || !(status & IPS_CONFIRMED) */
477fb5cd0ceSMaxim Mikityanskiy 	return XDP_TX;
478fb5cd0ceSMaxim Mikityanskiy }
479fb5cd0ceSMaxim Mikityanskiy 
tcp_mkoptions(__be32 * buf,__be32 * tsopt,__u16 mss,__u8 wscale)480fb5cd0ceSMaxim Mikityanskiy static __always_inline __u8 tcp_mkoptions(__be32 *buf, __be32 *tsopt, __u16 mss,
481fb5cd0ceSMaxim Mikityanskiy 					  __u8 wscale)
482fb5cd0ceSMaxim Mikityanskiy {
483fb5cd0ceSMaxim Mikityanskiy 	__be32 *start = buf;
484fb5cd0ceSMaxim Mikityanskiy 
485fb5cd0ceSMaxim Mikityanskiy 	*buf++ = bpf_htonl((TCPOPT_MSS << 24) | (TCPOLEN_MSS << 16) | mss);
486fb5cd0ceSMaxim Mikityanskiy 
487fb5cd0ceSMaxim Mikityanskiy 	if (!tsopt)
488fb5cd0ceSMaxim Mikityanskiy 		return buf - start;
489fb5cd0ceSMaxim Mikityanskiy 
490fb5cd0ceSMaxim Mikityanskiy 	if (tsopt[0] & bpf_htonl(1 << 4))
491fb5cd0ceSMaxim Mikityanskiy 		*buf++ = bpf_htonl((TCPOPT_SACK_PERM << 24) |
492fb5cd0ceSMaxim Mikityanskiy 				   (TCPOLEN_SACK_PERM << 16) |
493fb5cd0ceSMaxim Mikityanskiy 				   (TCPOPT_TIMESTAMP << 8) |
494fb5cd0ceSMaxim Mikityanskiy 				   TCPOLEN_TIMESTAMP);
495fb5cd0ceSMaxim Mikityanskiy 	else
496fb5cd0ceSMaxim Mikityanskiy 		*buf++ = bpf_htonl((TCPOPT_NOP << 24) |
497fb5cd0ceSMaxim Mikityanskiy 				   (TCPOPT_NOP << 16) |
498fb5cd0ceSMaxim Mikityanskiy 				   (TCPOPT_TIMESTAMP << 8) |
499fb5cd0ceSMaxim Mikityanskiy 				   TCPOLEN_TIMESTAMP);
500fb5cd0ceSMaxim Mikityanskiy 	*buf++ = tsopt[0];
501fb5cd0ceSMaxim Mikityanskiy 	*buf++ = tsopt[1];
502fb5cd0ceSMaxim Mikityanskiy 
503fb5cd0ceSMaxim Mikityanskiy 	if ((tsopt[0] & bpf_htonl(0xf)) != bpf_htonl(0xf))
504fb5cd0ceSMaxim Mikityanskiy 		*buf++ = bpf_htonl((TCPOPT_NOP << 24) |
505fb5cd0ceSMaxim Mikityanskiy 				   (TCPOPT_WINDOW << 16) |
506fb5cd0ceSMaxim Mikityanskiy 				   (TCPOLEN_WINDOW << 8) |
507fb5cd0ceSMaxim Mikityanskiy 				   wscale);
508fb5cd0ceSMaxim Mikityanskiy 
509fb5cd0ceSMaxim Mikityanskiy 	return buf - start;
510fb5cd0ceSMaxim Mikityanskiy }
511fb5cd0ceSMaxim Mikityanskiy 
tcp_gen_synack(struct tcphdr * tcp_header,__u32 cookie,__be32 * tsopt,__u16 mss,__u8 wscale)512fb5cd0ceSMaxim Mikityanskiy static __always_inline void tcp_gen_synack(struct tcphdr *tcp_header,
513fb5cd0ceSMaxim Mikityanskiy 					   __u32 cookie, __be32 *tsopt,
514fb5cd0ceSMaxim Mikityanskiy 					   __u16 mss, __u8 wscale)
515fb5cd0ceSMaxim Mikityanskiy {
516fb5cd0ceSMaxim Mikityanskiy 	void *tcp_options;
517fb5cd0ceSMaxim Mikityanskiy 
518fb5cd0ceSMaxim Mikityanskiy 	tcp_flag_word(tcp_header) = TCP_FLAG_SYN | TCP_FLAG_ACK;
519fb5cd0ceSMaxim Mikityanskiy 	if (tsopt && (tsopt[0] & bpf_htonl(1 << 5)))
520fb5cd0ceSMaxim Mikityanskiy 		tcp_flag_word(tcp_header) |= TCP_FLAG_ECE;
521fb5cd0ceSMaxim Mikityanskiy 	tcp_header->doff = 5; /* doff is part of tcp_flag_word. */
522fb5cd0ceSMaxim Mikityanskiy 	swap(tcp_header->source, tcp_header->dest);
523fb5cd0ceSMaxim Mikityanskiy 	tcp_header->ack_seq = bpf_htonl(bpf_ntohl(tcp_header->seq) + 1);
524fb5cd0ceSMaxim Mikityanskiy 	tcp_header->seq = bpf_htonl(cookie);
525fb5cd0ceSMaxim Mikityanskiy 	tcp_header->window = 0;
526fb5cd0ceSMaxim Mikityanskiy 	tcp_header->urg_ptr = 0;
527fb5cd0ceSMaxim Mikityanskiy 	tcp_header->check = 0; /* Calculate checksum later. */
528fb5cd0ceSMaxim Mikityanskiy 
529fb5cd0ceSMaxim Mikityanskiy 	tcp_options = (void *)(tcp_header + 1);
530fb5cd0ceSMaxim Mikityanskiy 	tcp_header->doff += tcp_mkoptions(tcp_options, tsopt, mss, wscale);
531fb5cd0ceSMaxim Mikityanskiy }
532fb5cd0ceSMaxim Mikityanskiy 
tcpv4_gen_synack(struct header_pointers * hdr,__u32 cookie,__be32 * tsopt)533fb5cd0ceSMaxim Mikityanskiy static __always_inline void tcpv4_gen_synack(struct header_pointers *hdr,
534fb5cd0ceSMaxim Mikityanskiy 					     __u32 cookie, __be32 *tsopt)
535fb5cd0ceSMaxim Mikityanskiy {
536fb5cd0ceSMaxim Mikityanskiy 	__u8 wscale;
537fb5cd0ceSMaxim Mikityanskiy 	__u16 mss;
538fb5cd0ceSMaxim Mikityanskiy 	__u8 ttl;
539fb5cd0ceSMaxim Mikityanskiy 
540fb5cd0ceSMaxim Mikityanskiy 	values_get_tcpipopts(&mss, &wscale, &ttl, false);
541fb5cd0ceSMaxim Mikityanskiy 
542fb5cd0ceSMaxim Mikityanskiy 	swap_eth_addr(hdr->eth->h_source, hdr->eth->h_dest);
543fb5cd0ceSMaxim Mikityanskiy 
544fb5cd0ceSMaxim Mikityanskiy 	swap(hdr->ipv4->saddr, hdr->ipv4->daddr);
545fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv4->check = 0; /* Calculate checksum later. */
546fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv4->tos = 0;
547fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv4->id = 0;
548fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv4->ttl = ttl;
549fb5cd0ceSMaxim Mikityanskiy 
550fb5cd0ceSMaxim Mikityanskiy 	tcp_gen_synack(hdr->tcp, cookie, tsopt, mss, wscale);
551fb5cd0ceSMaxim Mikityanskiy 
552fb5cd0ceSMaxim Mikityanskiy 	hdr->tcp_len = hdr->tcp->doff * 4;
553fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv4->tot_len = bpf_htons(sizeof(*hdr->ipv4) + hdr->tcp_len);
554fb5cd0ceSMaxim Mikityanskiy }
555fb5cd0ceSMaxim Mikityanskiy 
tcpv6_gen_synack(struct header_pointers * hdr,__u32 cookie,__be32 * tsopt)556fb5cd0ceSMaxim Mikityanskiy static __always_inline void tcpv6_gen_synack(struct header_pointers *hdr,
557fb5cd0ceSMaxim Mikityanskiy 					     __u32 cookie, __be32 *tsopt)
558fb5cd0ceSMaxim Mikityanskiy {
559fb5cd0ceSMaxim Mikityanskiy 	__u8 wscale;
560fb5cd0ceSMaxim Mikityanskiy 	__u16 mss;
561fb5cd0ceSMaxim Mikityanskiy 	__u8 ttl;
562fb5cd0ceSMaxim Mikityanskiy 
563fb5cd0ceSMaxim Mikityanskiy 	values_get_tcpipopts(&mss, &wscale, &ttl, true);
564fb5cd0ceSMaxim Mikityanskiy 
565fb5cd0ceSMaxim Mikityanskiy 	swap_eth_addr(hdr->eth->h_source, hdr->eth->h_dest);
566fb5cd0ceSMaxim Mikityanskiy 
567fb5cd0ceSMaxim Mikityanskiy 	swap(hdr->ipv6->saddr, hdr->ipv6->daddr);
568fb5cd0ceSMaxim Mikityanskiy 	*(__be32 *)hdr->ipv6 = bpf_htonl(0x60000000);
569fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv6->hop_limit = ttl;
570fb5cd0ceSMaxim Mikityanskiy 
571fb5cd0ceSMaxim Mikityanskiy 	tcp_gen_synack(hdr->tcp, cookie, tsopt, mss, wscale);
572fb5cd0ceSMaxim Mikityanskiy 
573fb5cd0ceSMaxim Mikityanskiy 	hdr->tcp_len = hdr->tcp->doff * 4;
574fb5cd0ceSMaxim Mikityanskiy 	hdr->ipv6->payload_len = bpf_htons(hdr->tcp_len);
575fb5cd0ceSMaxim Mikityanskiy }
576fb5cd0ceSMaxim Mikityanskiy 
syncookie_handle_syn(struct header_pointers * hdr,void * ctx,void * data,void * data_end,bool xdp)577fb5cd0ceSMaxim Mikityanskiy static __always_inline int syncookie_handle_syn(struct header_pointers *hdr,
578784d5dc0SMaxim Mikityanskiy 						void *ctx,
579784d5dc0SMaxim Mikityanskiy 						void *data, void *data_end,
580784d5dc0SMaxim Mikityanskiy 						bool xdp)
581fb5cd0ceSMaxim Mikityanskiy {
582fb5cd0ceSMaxim Mikityanskiy 	__u32 old_pkt_size, new_pkt_size;
583fb5cd0ceSMaxim Mikityanskiy 	/* Unlike clang 10, clang 11 and 12 generate code that doesn't pass the
584fb5cd0ceSMaxim Mikityanskiy 	 * BPF verifier if tsopt is not volatile. Volatile forces it to store
585fb5cd0ceSMaxim Mikityanskiy 	 * the pointer value and use it directly, otherwise tcp_mkoptions is
586fb5cd0ceSMaxim Mikityanskiy 	 * (mis)compiled like this:
587fb5cd0ceSMaxim Mikityanskiy 	 *   if (!tsopt)
588fb5cd0ceSMaxim Mikityanskiy 	 *       return buf - start;
589fb5cd0ceSMaxim Mikityanskiy 	 *   reg = stored_return_value_of_tscookie_init;
590fb5cd0ceSMaxim Mikityanskiy 	 *   if (reg)
591fb5cd0ceSMaxim Mikityanskiy 	 *       tsopt = tsopt_buf;
592fb5cd0ceSMaxim Mikityanskiy 	 *   else
593fb5cd0ceSMaxim Mikityanskiy 	 *       tsopt = NULL;
594fb5cd0ceSMaxim Mikityanskiy 	 *   ...
595fb5cd0ceSMaxim Mikityanskiy 	 *   *buf++ = tsopt[1];
596fb5cd0ceSMaxim Mikityanskiy 	 * It creates a dead branch where tsopt is assigned NULL, but the
597fb5cd0ceSMaxim Mikityanskiy 	 * verifier can't prove it's dead and blocks the program.
598fb5cd0ceSMaxim Mikityanskiy 	 */
599fb5cd0ceSMaxim Mikityanskiy 	__be32 * volatile tsopt = NULL;
600fb5cd0ceSMaxim Mikityanskiy 	__be32 tsopt_buf[2] = {};
601fb5cd0ceSMaxim Mikityanskiy 	__u16 ip_len;
602fb5cd0ceSMaxim Mikityanskiy 	__u32 cookie;
603fb5cd0ceSMaxim Mikityanskiy 	__s64 value;
604fb5cd0ceSMaxim Mikityanskiy 
605fb5cd0ceSMaxim Mikityanskiy 	/* Checksum is not yet verified, but both checksum failure and TCP
606fb5cd0ceSMaxim Mikityanskiy 	 * header checks return XDP_DROP, so the order doesn't matter.
607fb5cd0ceSMaxim Mikityanskiy 	 */
608fb5cd0ceSMaxim Mikityanskiy 	if (hdr->tcp->fin || hdr->tcp->rst)
609fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
610fb5cd0ceSMaxim Mikityanskiy 
611fb5cd0ceSMaxim Mikityanskiy 	/* Issue SYN cookies on allowed ports, drop SYN packets on blocked
612fb5cd0ceSMaxim Mikityanskiy 	 * ports.
613fb5cd0ceSMaxim Mikityanskiy 	 */
614fb5cd0ceSMaxim Mikityanskiy 	if (!check_port_allowed(bpf_ntohs(hdr->tcp->dest)))
615fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
616fb5cd0ceSMaxim Mikityanskiy 
617fb5cd0ceSMaxim Mikityanskiy 	if (hdr->ipv4) {
618fb5cd0ceSMaxim Mikityanskiy 		/* Check the IPv4 and TCP checksums before creating a SYNACK. */
619fb5cd0ceSMaxim Mikityanskiy 		value = bpf_csum_diff(0, 0, (void *)hdr->ipv4, hdr->ipv4->ihl * 4, 0);
620fb5cd0ceSMaxim Mikityanskiy 		if (value < 0)
621fb5cd0ceSMaxim Mikityanskiy 			return XDP_ABORTED;
622fb5cd0ceSMaxim Mikityanskiy 		if (csum_fold(value) != 0)
623fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP; /* Bad IPv4 checksum. */
624fb5cd0ceSMaxim Mikityanskiy 
625fb5cd0ceSMaxim Mikityanskiy 		value = bpf_csum_diff(0, 0, (void *)hdr->tcp, hdr->tcp_len, 0);
626fb5cd0ceSMaxim Mikityanskiy 		if (value < 0)
627fb5cd0ceSMaxim Mikityanskiy 			return XDP_ABORTED;
628fb5cd0ceSMaxim Mikityanskiy 		if (csum_tcpudp_magic(hdr->ipv4->saddr, hdr->ipv4->daddr,
629fb5cd0ceSMaxim Mikityanskiy 				      hdr->tcp_len, IPPROTO_TCP, value) != 0)
630fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP; /* Bad TCP checksum. */
631fb5cd0ceSMaxim Mikityanskiy 
632fb5cd0ceSMaxim Mikityanskiy 		ip_len = sizeof(*hdr->ipv4);
633fb5cd0ceSMaxim Mikityanskiy 
634fb5cd0ceSMaxim Mikityanskiy 		value = bpf_tcp_raw_gen_syncookie_ipv4(hdr->ipv4, hdr->tcp,
635fb5cd0ceSMaxim Mikityanskiy 						       hdr->tcp_len);
636fb5cd0ceSMaxim Mikityanskiy 	} else if (hdr->ipv6) {
637fb5cd0ceSMaxim Mikityanskiy 		/* Check the TCP checksum before creating a SYNACK. */
638fb5cd0ceSMaxim Mikityanskiy 		value = bpf_csum_diff(0, 0, (void *)hdr->tcp, hdr->tcp_len, 0);
639fb5cd0ceSMaxim Mikityanskiy 		if (value < 0)
640fb5cd0ceSMaxim Mikityanskiy 			return XDP_ABORTED;
641fb5cd0ceSMaxim Mikityanskiy 		if (csum_ipv6_magic(&hdr->ipv6->saddr, &hdr->ipv6->daddr,
642fb5cd0ceSMaxim Mikityanskiy 				    hdr->tcp_len, IPPROTO_TCP, value) != 0)
643fb5cd0ceSMaxim Mikityanskiy 			return XDP_DROP; /* Bad TCP checksum. */
644fb5cd0ceSMaxim Mikityanskiy 
645fb5cd0ceSMaxim Mikityanskiy 		ip_len = sizeof(*hdr->ipv6);
646fb5cd0ceSMaxim Mikityanskiy 
647fb5cd0ceSMaxim Mikityanskiy 		value = bpf_tcp_raw_gen_syncookie_ipv6(hdr->ipv6, hdr->tcp,
648fb5cd0ceSMaxim Mikityanskiy 						       hdr->tcp_len);
649fb5cd0ceSMaxim Mikityanskiy 	} else {
650fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
651fb5cd0ceSMaxim Mikityanskiy 	}
652fb5cd0ceSMaxim Mikityanskiy 
653fb5cd0ceSMaxim Mikityanskiy 	if (value < 0)
654fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
655fb5cd0ceSMaxim Mikityanskiy 	cookie = (__u32)value;
656fb5cd0ceSMaxim Mikityanskiy 
657fb5cd0ceSMaxim Mikityanskiy 	if (tscookie_init((void *)hdr->tcp, hdr->tcp_len,
658*d9631d0dSEduard Zingerman 			  &tsopt_buf[0], &tsopt_buf[1], data, data_end))
659fb5cd0ceSMaxim Mikityanskiy 		tsopt = tsopt_buf;
660fb5cd0ceSMaxim Mikityanskiy 
661fb5cd0ceSMaxim Mikityanskiy 	/* Check that there is enough space for a SYNACK. It also covers
662fb5cd0ceSMaxim Mikityanskiy 	 * the check that the destination of the __builtin_memmove below
663fb5cd0ceSMaxim Mikityanskiy 	 * doesn't overflow.
664fb5cd0ceSMaxim Mikityanskiy 	 */
665fb5cd0ceSMaxim Mikityanskiy 	if (data + sizeof(*hdr->eth) + ip_len + TCP_MAXLEN > data_end)
666fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
667fb5cd0ceSMaxim Mikityanskiy 
668fb5cd0ceSMaxim Mikityanskiy 	if (hdr->ipv4) {
669fb5cd0ceSMaxim Mikityanskiy 		if (hdr->ipv4->ihl * 4 > sizeof(*hdr->ipv4)) {
670fb5cd0ceSMaxim Mikityanskiy 			struct tcphdr *new_tcp_header;
671fb5cd0ceSMaxim Mikityanskiy 
672fb5cd0ceSMaxim Mikityanskiy 			new_tcp_header = data + sizeof(*hdr->eth) + sizeof(*hdr->ipv4);
673fb5cd0ceSMaxim Mikityanskiy 			__builtin_memmove(new_tcp_header, hdr->tcp, sizeof(*hdr->tcp));
674fb5cd0ceSMaxim Mikityanskiy 			hdr->tcp = new_tcp_header;
675fb5cd0ceSMaxim Mikityanskiy 
676fb5cd0ceSMaxim Mikityanskiy 			hdr->ipv4->ihl = sizeof(*hdr->ipv4) / 4;
677fb5cd0ceSMaxim Mikityanskiy 		}
678fb5cd0ceSMaxim Mikityanskiy 
679fb5cd0ceSMaxim Mikityanskiy 		tcpv4_gen_synack(hdr, cookie, tsopt);
680fb5cd0ceSMaxim Mikityanskiy 	} else if (hdr->ipv6) {
681fb5cd0ceSMaxim Mikityanskiy 		tcpv6_gen_synack(hdr, cookie, tsopt);
682fb5cd0ceSMaxim Mikityanskiy 	} else {
683fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
684fb5cd0ceSMaxim Mikityanskiy 	}
685fb5cd0ceSMaxim Mikityanskiy 
686fb5cd0ceSMaxim Mikityanskiy 	/* Recalculate checksums. */
687fb5cd0ceSMaxim Mikityanskiy 	hdr->tcp->check = 0;
688fb5cd0ceSMaxim Mikityanskiy 	value = bpf_csum_diff(0, 0, (void *)hdr->tcp, hdr->tcp_len, 0);
689fb5cd0ceSMaxim Mikityanskiy 	if (value < 0)
690fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
691fb5cd0ceSMaxim Mikityanskiy 	if (hdr->ipv4) {
692fb5cd0ceSMaxim Mikityanskiy 		hdr->tcp->check = csum_tcpudp_magic(hdr->ipv4->saddr,
693fb5cd0ceSMaxim Mikityanskiy 						    hdr->ipv4->daddr,
694fb5cd0ceSMaxim Mikityanskiy 						    hdr->tcp_len,
695fb5cd0ceSMaxim Mikityanskiy 						    IPPROTO_TCP,
696fb5cd0ceSMaxim Mikityanskiy 						    value);
697fb5cd0ceSMaxim Mikityanskiy 
698fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv4->check = 0;
699fb5cd0ceSMaxim Mikityanskiy 		value = bpf_csum_diff(0, 0, (void *)hdr->ipv4, sizeof(*hdr->ipv4), 0);
700fb5cd0ceSMaxim Mikityanskiy 		if (value < 0)
701fb5cd0ceSMaxim Mikityanskiy 			return XDP_ABORTED;
702fb5cd0ceSMaxim Mikityanskiy 		hdr->ipv4->check = csum_fold(value);
703fb5cd0ceSMaxim Mikityanskiy 	} else if (hdr->ipv6) {
704fb5cd0ceSMaxim Mikityanskiy 		hdr->tcp->check = csum_ipv6_magic(&hdr->ipv6->saddr,
705fb5cd0ceSMaxim Mikityanskiy 						  &hdr->ipv6->daddr,
706fb5cd0ceSMaxim Mikityanskiy 						  hdr->tcp_len,
707fb5cd0ceSMaxim Mikityanskiy 						  IPPROTO_TCP,
708fb5cd0ceSMaxim Mikityanskiy 						  value);
709fb5cd0ceSMaxim Mikityanskiy 	} else {
710fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
711fb5cd0ceSMaxim Mikityanskiy 	}
712fb5cd0ceSMaxim Mikityanskiy 
713fb5cd0ceSMaxim Mikityanskiy 	/* Set the new packet size. */
714fb5cd0ceSMaxim Mikityanskiy 	old_pkt_size = data_end - data;
715fb5cd0ceSMaxim Mikityanskiy 	new_pkt_size = sizeof(*hdr->eth) + ip_len + hdr->tcp->doff * 4;
716784d5dc0SMaxim Mikityanskiy 	if (xdp) {
717fb5cd0ceSMaxim Mikityanskiy 		if (bpf_xdp_adjust_tail(ctx, new_pkt_size - old_pkt_size))
718fb5cd0ceSMaxim Mikityanskiy 			return XDP_ABORTED;
719784d5dc0SMaxim Mikityanskiy 	} else {
720784d5dc0SMaxim Mikityanskiy 		if (bpf_skb_change_tail(ctx, new_pkt_size, 0))
721784d5dc0SMaxim Mikityanskiy 			return XDP_ABORTED;
722784d5dc0SMaxim Mikityanskiy 	}
723fb5cd0ceSMaxim Mikityanskiy 
724fb5cd0ceSMaxim Mikityanskiy 	values_inc_synacks();
725fb5cd0ceSMaxim Mikityanskiy 
726fb5cd0ceSMaxim Mikityanskiy 	return XDP_TX;
727fb5cd0ceSMaxim Mikityanskiy }
728fb5cd0ceSMaxim Mikityanskiy 
syncookie_handle_ack(struct header_pointers * hdr)729fb5cd0ceSMaxim Mikityanskiy static __always_inline int syncookie_handle_ack(struct header_pointers *hdr)
730fb5cd0ceSMaxim Mikityanskiy {
731fb5cd0ceSMaxim Mikityanskiy 	int err;
732fb5cd0ceSMaxim Mikityanskiy 
733fb5cd0ceSMaxim Mikityanskiy 	if (hdr->tcp->rst)
734fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
735fb5cd0ceSMaxim Mikityanskiy 
736fb5cd0ceSMaxim Mikityanskiy 	if (hdr->ipv4)
737fb5cd0ceSMaxim Mikityanskiy 		err = bpf_tcp_raw_check_syncookie_ipv4(hdr->ipv4, hdr->tcp);
738fb5cd0ceSMaxim Mikityanskiy 	else if (hdr->ipv6)
739fb5cd0ceSMaxim Mikityanskiy 		err = bpf_tcp_raw_check_syncookie_ipv6(hdr->ipv6, hdr->tcp);
740fb5cd0ceSMaxim Mikityanskiy 	else
741fb5cd0ceSMaxim Mikityanskiy 		return XDP_ABORTED;
742fb5cd0ceSMaxim Mikityanskiy 	if (err)
743fb5cd0ceSMaxim Mikityanskiy 		return XDP_DROP;
744fb5cd0ceSMaxim Mikityanskiy 
745fb5cd0ceSMaxim Mikityanskiy 	return XDP_PASS;
746fb5cd0ceSMaxim Mikityanskiy }
747fb5cd0ceSMaxim Mikityanskiy 
syncookie_part1(void * ctx,void * data,void * data_end,struct header_pointers * hdr,bool xdp)748784d5dc0SMaxim Mikityanskiy static __always_inline int syncookie_part1(void *ctx, void *data, void *data_end,
749784d5dc0SMaxim Mikityanskiy 					   struct header_pointers *hdr, bool xdp)
750784d5dc0SMaxim Mikityanskiy {
751784d5dc0SMaxim Mikityanskiy 	int ret;
752784d5dc0SMaxim Mikityanskiy 
753784d5dc0SMaxim Mikityanskiy 	ret = tcp_dissect(data, data_end, hdr);
754784d5dc0SMaxim Mikityanskiy 	if (ret != XDP_TX)
755784d5dc0SMaxim Mikityanskiy 		return ret;
756784d5dc0SMaxim Mikityanskiy 
757784d5dc0SMaxim Mikityanskiy 	ret = tcp_lookup(ctx, hdr, xdp);
758784d5dc0SMaxim Mikityanskiy 	if (ret != XDP_TX)
759784d5dc0SMaxim Mikityanskiy 		return ret;
760784d5dc0SMaxim Mikityanskiy 
761784d5dc0SMaxim Mikityanskiy 	/* Packet is TCP and doesn't belong to an established connection. */
762784d5dc0SMaxim Mikityanskiy 
763784d5dc0SMaxim Mikityanskiy 	if ((hdr->tcp->syn ^ hdr->tcp->ack) != 1)
764784d5dc0SMaxim Mikityanskiy 		return XDP_DROP;
765784d5dc0SMaxim Mikityanskiy 
766784d5dc0SMaxim Mikityanskiy 	/* Grow the TCP header to TCP_MAXLEN to be able to pass any hdr->tcp_len
767784d5dc0SMaxim Mikityanskiy 	 * to bpf_tcp_raw_gen_syncookie_ipv{4,6} and pass the verifier.
768784d5dc0SMaxim Mikityanskiy 	 */
769784d5dc0SMaxim Mikityanskiy 	if (xdp) {
770784d5dc0SMaxim Mikityanskiy 		if (bpf_xdp_adjust_tail(ctx, TCP_MAXLEN - hdr->tcp_len))
771784d5dc0SMaxim Mikityanskiy 			return XDP_ABORTED;
772784d5dc0SMaxim Mikityanskiy 	} else {
773784d5dc0SMaxim Mikityanskiy 		/* Without volatile the verifier throws this error:
774784d5dc0SMaxim Mikityanskiy 		 * R9 32-bit pointer arithmetic prohibited
775784d5dc0SMaxim Mikityanskiy 		 */
776784d5dc0SMaxim Mikityanskiy 		volatile u64 old_len = data_end - data;
777784d5dc0SMaxim Mikityanskiy 
778784d5dc0SMaxim Mikityanskiy 		if (bpf_skb_change_tail(ctx, old_len + TCP_MAXLEN - hdr->tcp_len, 0))
779784d5dc0SMaxim Mikityanskiy 			return XDP_ABORTED;
780784d5dc0SMaxim Mikityanskiy 	}
781784d5dc0SMaxim Mikityanskiy 
782784d5dc0SMaxim Mikityanskiy 	return XDP_TX;
783784d5dc0SMaxim Mikityanskiy }
784784d5dc0SMaxim Mikityanskiy 
syncookie_part2(void * ctx,void * data,void * data_end,struct header_pointers * hdr,bool xdp)785784d5dc0SMaxim Mikityanskiy static __always_inline int syncookie_part2(void *ctx, void *data, void *data_end,
786784d5dc0SMaxim Mikityanskiy 					   struct header_pointers *hdr, bool xdp)
787784d5dc0SMaxim Mikityanskiy {
788784d5dc0SMaxim Mikityanskiy 	if (hdr->ipv4) {
789784d5dc0SMaxim Mikityanskiy 		hdr->eth = data;
790784d5dc0SMaxim Mikityanskiy 		hdr->ipv4 = (void *)hdr->eth + sizeof(*hdr->eth);
791784d5dc0SMaxim Mikityanskiy 		/* IPV4_MAXLEN is needed when calculating checksum.
792784d5dc0SMaxim Mikityanskiy 		 * At least sizeof(struct iphdr) is needed here to access ihl.
793784d5dc0SMaxim Mikityanskiy 		 */
794784d5dc0SMaxim Mikityanskiy 		if ((void *)hdr->ipv4 + IPV4_MAXLEN > data_end)
795784d5dc0SMaxim Mikityanskiy 			return XDP_ABORTED;
796784d5dc0SMaxim Mikityanskiy 		hdr->tcp = (void *)hdr->ipv4 + hdr->ipv4->ihl * 4;
797784d5dc0SMaxim Mikityanskiy 	} else if (hdr->ipv6) {
798784d5dc0SMaxim Mikityanskiy 		hdr->eth = data;
799784d5dc0SMaxim Mikityanskiy 		hdr->ipv6 = (void *)hdr->eth + sizeof(*hdr->eth);
800784d5dc0SMaxim Mikityanskiy 		hdr->tcp = (void *)hdr->ipv6 + sizeof(*hdr->ipv6);
801784d5dc0SMaxim Mikityanskiy 	} else {
802784d5dc0SMaxim Mikityanskiy 		return XDP_ABORTED;
803784d5dc0SMaxim Mikityanskiy 	}
804784d5dc0SMaxim Mikityanskiy 
805784d5dc0SMaxim Mikityanskiy 	if ((void *)hdr->tcp + TCP_MAXLEN > data_end)
806784d5dc0SMaxim Mikityanskiy 		return XDP_ABORTED;
807784d5dc0SMaxim Mikityanskiy 
808784d5dc0SMaxim Mikityanskiy 	/* We run out of registers, tcp_len gets spilled to the stack, and the
809784d5dc0SMaxim Mikityanskiy 	 * verifier forgets its min and max values checked above in tcp_dissect.
810784d5dc0SMaxim Mikityanskiy 	 */
811784d5dc0SMaxim Mikityanskiy 	hdr->tcp_len = hdr->tcp->doff * 4;
812784d5dc0SMaxim Mikityanskiy 	if (hdr->tcp_len < sizeof(*hdr->tcp))
813784d5dc0SMaxim Mikityanskiy 		return XDP_ABORTED;
814784d5dc0SMaxim Mikityanskiy 
815784d5dc0SMaxim Mikityanskiy 	return hdr->tcp->syn ? syncookie_handle_syn(hdr, ctx, data, data_end, xdp) :
816784d5dc0SMaxim Mikityanskiy 			       syncookie_handle_ack(hdr);
817784d5dc0SMaxim Mikityanskiy }
818784d5dc0SMaxim Mikityanskiy 
819fb5cd0ceSMaxim Mikityanskiy SEC("xdp")
syncookie_xdp(struct xdp_md * ctx)820fb5cd0ceSMaxim Mikityanskiy int syncookie_xdp(struct xdp_md *ctx)
821fb5cd0ceSMaxim Mikityanskiy {
822fb5cd0ceSMaxim Mikityanskiy 	void *data_end = (void *)(long)ctx->data_end;
823fb5cd0ceSMaxim Mikityanskiy 	void *data = (void *)(long)ctx->data;
824fb5cd0ceSMaxim Mikityanskiy 	struct header_pointers hdr;
825fb5cd0ceSMaxim Mikityanskiy 	int ret;
826fb5cd0ceSMaxim Mikityanskiy 
827784d5dc0SMaxim Mikityanskiy 	ret = syncookie_part1(ctx, data, data_end, &hdr, true);
828fb5cd0ceSMaxim Mikityanskiy 	if (ret != XDP_TX)
829fb5cd0ceSMaxim Mikityanskiy 		return ret;
830fb5cd0ceSMaxim Mikityanskiy 
831fb5cd0ceSMaxim Mikityanskiy 	data_end = (void *)(long)ctx->data_end;
832fb5cd0ceSMaxim Mikityanskiy 	data = (void *)(long)ctx->data;
833fb5cd0ceSMaxim Mikityanskiy 
834784d5dc0SMaxim Mikityanskiy 	return syncookie_part2(ctx, data, data_end, &hdr, true);
835fb5cd0ceSMaxim Mikityanskiy }
836fb5cd0ceSMaxim Mikityanskiy 
837784d5dc0SMaxim Mikityanskiy SEC("tc")
syncookie_tc(struct __sk_buff * skb)838784d5dc0SMaxim Mikityanskiy int syncookie_tc(struct __sk_buff *skb)
839784d5dc0SMaxim Mikityanskiy {
840784d5dc0SMaxim Mikityanskiy 	void *data_end = (void *)(long)skb->data_end;
841784d5dc0SMaxim Mikityanskiy 	void *data = (void *)(long)skb->data;
842784d5dc0SMaxim Mikityanskiy 	struct header_pointers hdr;
843784d5dc0SMaxim Mikityanskiy 	int ret;
844fb5cd0ceSMaxim Mikityanskiy 
845784d5dc0SMaxim Mikityanskiy 	ret = syncookie_part1(skb, data, data_end, &hdr, false);
846784d5dc0SMaxim Mikityanskiy 	if (ret != XDP_TX)
847784d5dc0SMaxim Mikityanskiy 		return ret == XDP_PASS ? TC_ACT_OK : TC_ACT_SHOT;
848fb5cd0ceSMaxim Mikityanskiy 
849784d5dc0SMaxim Mikityanskiy 	data_end = (void *)(long)skb->data_end;
850784d5dc0SMaxim Mikityanskiy 	data = (void *)(long)skb->data;
851784d5dc0SMaxim Mikityanskiy 
852784d5dc0SMaxim Mikityanskiy 	ret = syncookie_part2(skb, data, data_end, &hdr, false);
853784d5dc0SMaxim Mikityanskiy 	switch (ret) {
854784d5dc0SMaxim Mikityanskiy 	case XDP_PASS:
855784d5dc0SMaxim Mikityanskiy 		return TC_ACT_OK;
856784d5dc0SMaxim Mikityanskiy 	case XDP_TX:
857784d5dc0SMaxim Mikityanskiy 		return bpf_redirect(skb->ifindex, 0);
858784d5dc0SMaxim Mikityanskiy 	default:
859784d5dc0SMaxim Mikityanskiy 		return TC_ACT_SHOT;
860784d5dc0SMaxim Mikityanskiy 	}
861fb5cd0ceSMaxim Mikityanskiy }
862fb5cd0ceSMaxim Mikityanskiy 
863fb5cd0ceSMaxim Mikityanskiy char _license[] SEC("license") = "GPL";
864