tcp_ipv6.c 50.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *	TCP over IPv6
3
 *	Linux INET6 implementation
L
Linus Torvalds 已提交
4 5
 *
 *	Authors:
6
 *	Pedro Roque		<roque@di.fc.ul.pt>
L
Linus Torvalds 已提交
7
 *
8
 *	Based on:
L
Linus Torvalds 已提交
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
 *	linux/net/ipv4/tcp.c
 *	linux/net/ipv4/tcp_input.c
 *	linux/net/ipv4/tcp_output.c
 *
 *	Fixes:
 *	Hideaki YOSHIFUJI	:	sin6_scope_id support
 *	YOSHIFUJI Hideaki @USAGI and:	Support IPV6_V6ONLY socket option, which
 *	Alexey Kuznetsov		allow both IPv4 and IPv6 sockets to bind
 *					a single port at the same time.
 *	YOSHIFUJI Hideaki @USAGI:	convert /proc/net/tcp6 to seq_file.
 *
 *	This program is free software; you can redistribute it and/or
 *      modify it under the terms of the GNU General Public License
 *      as published by the Free Software Foundation; either version
 *      2 of the License, or (at your option) any later version.
 */

H
Herbert Xu 已提交
26
#include <linux/bottom_half.h>
L
Linus Torvalds 已提交
27 28 29 30 31 32 33 34 35 36 37 38 39 40
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/jiffies.h>
#include <linux/in.h>
#include <linux/in6.h>
#include <linux/netdevice.h>
#include <linux/init.h>
#include <linux/jhash.h>
#include <linux/ipsec.h>
#include <linux/times.h>
41
#include <linux/slab.h>
W
Wang Yufen 已提交
42
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
43 44 45 46 47 48
#include <linux/ipv6.h>
#include <linux/icmpv6.h>
#include <linux/random.h>

#include <net/tcp.h>
#include <net/ndisc.h>
49
#include <net/inet6_hashtables.h>
50
#include <net/inet6_connection_sock.h>
L
Linus Torvalds 已提交
51 52 53 54 55 56 57 58 59 60
#include <net/ipv6.h>
#include <net/transp_v6.h>
#include <net/addrconf.h>
#include <net/ip6_route.h>
#include <net/ip6_checksum.h>
#include <net/inet_ecn.h>
#include <net/protocol.h>
#include <net/xfrm.h>
#include <net/snmp.h>
#include <net/dsfield.h>
61
#include <net/timewait_sock.h>
62
#include <net/inet_common.h>
63
#include <net/secure_seq.h>
64
#include <net/busy_poll.h>
L
Linus Torvalds 已提交
65 66 67 68

#include <linux/proc_fs.h>
#include <linux/seq_file.h>

H
Herbert Xu 已提交
69
#include <crypto/hash.h>
70 71
#include <linux/scatterlist.h>

72 73
static void	tcp_v6_send_reset(const struct sock *sk, struct sk_buff *skb);
static void	tcp_v6_reqsk_send_ack(const struct sock *sk, struct sk_buff *skb,
74
				      struct request_sock *req);
L
Linus Torvalds 已提交
75 76 77

static int	tcp_v6_do_rcv(struct sock *sk, struct sk_buff *skb);

78 79
static const struct inet_connection_sock_af_ops ipv6_mapped;
static const struct inet_connection_sock_af_ops ipv6_specific;
80
#ifdef CONFIG_TCP_MD5SIG
81 82
static const struct tcp_sock_af_ops tcp_sock_ipv6_specific;
static const struct tcp_sock_af_ops tcp_sock_ipv6_mapped_specific;
83
#else
84
static struct tcp_md5sig_key *tcp_v6_md5_do_lookup(const struct sock *sk,
85
						   const struct in6_addr *addr)
86 87 88
{
	return NULL;
}
89
#endif
L
Linus Torvalds 已提交
90

91 92 93 94
static void inet6_sk_rx_dst_set(struct sock *sk, const struct sk_buff *skb)
{
	struct dst_entry *dst = skb_dst(skb);

E
Eric Dumazet 已提交
95
	if (dst && dst_hold_safe(dst)) {
96 97 98 99
		const struct rt6_info *rt = (const struct rt6_info *)dst;

		sk->sk_rx_dst = dst;
		inet_sk(sk)->rx_dst_ifindex = skb->skb_iif;
100
		inet6_sk(sk)->rx_dst_cookie = rt6_get_cookie(rt);
101
	}
102 103
}

104
static __u32 tcp_v6_init_sequence(const struct sk_buff *skb)
L
Linus Torvalds 已提交
105
{
106 107
	return secure_tcpv6_sequence_number(ipv6_hdr(skb)->daddr.s6_addr32,
					    ipv6_hdr(skb)->saddr.s6_addr32,
108 109
					    tcp_hdr(skb)->dest,
					    tcp_hdr(skb)->source);
L
Linus Torvalds 已提交
110 111
}

112
static int tcp_v6_connect(struct sock *sk, struct sockaddr *uaddr,
L
Linus Torvalds 已提交
113 114 115
			  int addr_len)
{
	struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr;
116
	struct inet_sock *inet = inet_sk(sk);
117
	struct inet_connection_sock *icsk = inet_csk(sk);
L
Linus Torvalds 已提交
118 119
	struct ipv6_pinfo *np = inet6_sk(sk);
	struct tcp_sock *tp = tcp_sk(sk);
120
	struct in6_addr *saddr = NULL, *final_p, final;
121
	struct ipv6_txoptions *opt;
122
	struct flowi6 fl6;
L
Linus Torvalds 已提交
123 124 125 126
	struct dst_entry *dst;
	int addr_type;
	int err;

127
	if (addr_len < SIN6_LEN_RFC2133)
L
Linus Torvalds 已提交
128 129
		return -EINVAL;

130
	if (usin->sin6_family != AF_INET6)
E
Eric Dumazet 已提交
131
		return -EAFNOSUPPORT;
L
Linus Torvalds 已提交
132

133
	memset(&fl6, 0, sizeof(fl6));
L
Linus Torvalds 已提交
134 135

	if (np->sndflow) {
136 137 138
		fl6.flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK;
		IP6_ECN_flow_init(fl6.flowlabel);
		if (fl6.flowlabel&IPV6_FLOWLABEL_MASK) {
L
Linus Torvalds 已提交
139
			struct ip6_flowlabel *flowlabel;
140
			flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
141
			if (!flowlabel)
L
Linus Torvalds 已提交
142 143 144 145 146 147
				return -EINVAL;
			fl6_sock_release(flowlabel);
		}
	}

	/*
148 149 150
	 *	connect() to INADDR_ANY means loopback (BSD'ism).
	 */

W
Weilong Chen 已提交
151
	if (ipv6_addr_any(&usin->sin6_addr))
152
		usin->sin6_addr.s6_addr[15] = 0x1;
L
Linus Torvalds 已提交
153 154 155

	addr_type = ipv6_addr_type(&usin->sin6_addr);

W
Weilong Chen 已提交
156
	if (addr_type & IPV6_ADDR_MULTICAST)
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177
		return -ENETUNREACH;

	if (addr_type&IPV6_ADDR_LINKLOCAL) {
		if (addr_len >= sizeof(struct sockaddr_in6) &&
		    usin->sin6_scope_id) {
			/* If interface is set while binding, indices
			 * must coincide.
			 */
			if (sk->sk_bound_dev_if &&
			    sk->sk_bound_dev_if != usin->sin6_scope_id)
				return -EINVAL;

			sk->sk_bound_dev_if = usin->sin6_scope_id;
		}

		/* Connect to link-local address requires an interface */
		if (!sk->sk_bound_dev_if)
			return -EINVAL;
	}

	if (tp->rx_opt.ts_recent_stamp &&
178
	    !ipv6_addr_equal(&sk->sk_v6_daddr, &usin->sin6_addr)) {
L
Linus Torvalds 已提交
179 180 181 182 183
		tp->rx_opt.ts_recent = 0;
		tp->rx_opt.ts_recent_stamp = 0;
		tp->write_seq = 0;
	}

184
	sk->sk_v6_daddr = usin->sin6_addr;
185
	np->flow_label = fl6.flowlabel;
L
Linus Torvalds 已提交
186 187 188 189 190 191

	/*
	 *	TCP over IPv4
	 */

	if (addr_type == IPV6_ADDR_MAPPED) {
192
		u32 exthdrlen = icsk->icsk_ext_hdr_len;
L
Linus Torvalds 已提交
193 194 195 196 197 198 199 200 201 202 203
		struct sockaddr_in sin;

		SOCK_DEBUG(sk, "connect: ipv4 mapped\n");

		if (__ipv6_only_sock(sk))
			return -ENETUNREACH;

		sin.sin_family = AF_INET;
		sin.sin_port = usin->sin6_port;
		sin.sin_addr.s_addr = usin->sin6_addr.s6_addr32[3];

204
		icsk->icsk_af_ops = &ipv6_mapped;
L
Linus Torvalds 已提交
205
		sk->sk_backlog_rcv = tcp_v4_do_rcv;
206 207 208
#ifdef CONFIG_TCP_MD5SIG
		tp->af_specific = &tcp_sock_ipv6_mapped_specific;
#endif
L
Linus Torvalds 已提交
209 210 211 212

		err = tcp_v4_connect(sk, (struct sockaddr *)&sin, sizeof(sin));

		if (err) {
213 214
			icsk->icsk_ext_hdr_len = exthdrlen;
			icsk->icsk_af_ops = &ipv6_specific;
L
Linus Torvalds 已提交
215
			sk->sk_backlog_rcv = tcp_v6_do_rcv;
216 217 218
#ifdef CONFIG_TCP_MD5SIG
			tp->af_specific = &tcp_sock_ipv6_specific;
#endif
L
Linus Torvalds 已提交
219 220
			goto failure;
		}
221
		np->saddr = sk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
222 223 224 225

		return err;
	}

226 227
	if (!ipv6_addr_any(&sk->sk_v6_rcv_saddr))
		saddr = &sk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
228

229
	fl6.flowi6_proto = IPPROTO_TCP;
230
	fl6.daddr = sk->sk_v6_daddr;
A
Alexey Dobriyan 已提交
231
	fl6.saddr = saddr ? *saddr : np->saddr;
232 233
	fl6.flowi6_oif = sk->sk_bound_dev_if;
	fl6.flowi6_mark = sk->sk_mark;
234 235
	fl6.fl6_dport = usin->sin6_port;
	fl6.fl6_sport = inet->inet_sport;
L
Linus Torvalds 已提交
236

237
	opt = rcu_dereference_protected(np->opt, lockdep_sock_is_held(sk));
238
	final_p = fl6_update_dst(&fl6, opt, &final);
L
Linus Torvalds 已提交
239

240
	security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
V
Venkat Yekkirala 已提交
241

242
	dst = ip6_dst_lookup_flow(sk, &fl6, final_p);
243 244
	if (IS_ERR(dst)) {
		err = PTR_ERR(dst);
L
Linus Torvalds 已提交
245
		goto failure;
246
	}
L
Linus Torvalds 已提交
247

248
	if (!saddr) {
249
		saddr = &fl6.saddr;
250
		sk->sk_v6_rcv_saddr = *saddr;
L
Linus Torvalds 已提交
251 252 253
	}

	/* set the source address */
A
Alexey Dobriyan 已提交
254
	np->saddr = *saddr;
E
Eric Dumazet 已提交
255
	inet->inet_rcv_saddr = LOOPBACK4_IPV6;
L
Linus Torvalds 已提交
256

H
Herbert Xu 已提交
257
	sk->sk_gso_type = SKB_GSO_TCPV6;
E
Eric Dumazet 已提交
258
	ip6_dst_store(sk, dst, NULL, NULL);
L
Linus Torvalds 已提交
259

260 261
	if (tcp_death_row.sysctl_tw_recycle &&
	    !tp->rx_opt.ts_recent_stamp &&
262
	    ipv6_addr_equal(&fl6.daddr, &sk->sk_v6_daddr))
263
		tcp_fetch_timewait_stamp(sk, dst);
264

265
	icsk->icsk_ext_hdr_len = 0;
266 267 268
	if (opt)
		icsk->icsk_ext_hdr_len = opt->opt_flen +
					 opt->opt_nflen;
L
Linus Torvalds 已提交
269 270 271

	tp->rx_opt.mss_clamp = IPV6_MIN_MTU - sizeof(struct tcphdr) - sizeof(struct ipv6hdr);

E
Eric Dumazet 已提交
272
	inet->inet_dport = usin->sin6_port;
L
Linus Torvalds 已提交
273 274

	tcp_set_state(sk, TCP_SYN_SENT);
275
	err = inet6_hash_connect(&tcp_death_row, sk);
L
Linus Torvalds 已提交
276 277 278
	if (err)
		goto late_failure;

279
	sk_set_txhash(sk);
280

A
Andrey Vagin 已提交
281
	if (!tp->write_seq && likely(!tp->repair))
L
Linus Torvalds 已提交
282
		tp->write_seq = secure_tcpv6_sequence_number(np->saddr.s6_addr32,
283
							     sk->sk_v6_daddr.s6_addr32,
E
Eric Dumazet 已提交
284 285
							     inet->inet_sport,
							     inet->inet_dport);
L
Linus Torvalds 已提交
286 287 288 289 290 291 292 293 294 295 296

	err = tcp_connect(sk);
	if (err)
		goto late_failure;

	return 0;

late_failure:
	tcp_set_state(sk, TCP_CLOSE);
	__sk_dst_reset(sk);
failure:
E
Eric Dumazet 已提交
297
	inet->inet_dport = 0;
L
Linus Torvalds 已提交
298 299 300 301
	sk->sk_route_caps = 0;
	return err;
}

302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318
static void tcp_v6_mtu_reduced(struct sock *sk)
{
	struct dst_entry *dst;

	if ((1 << sk->sk_state) & (TCPF_LISTEN | TCPF_CLOSE))
		return;

	dst = inet6_csk_update_pmtu(sk, tcp_sk(sk)->mtu_info);
	if (!dst)
		return;

	if (inet_csk(sk)->icsk_pmtu_cookie > dst_mtu(dst)) {
		tcp_sync_mss(sk, dst_mtu(dst));
		tcp_simple_retransmit(sk);
	}
}

L
Linus Torvalds 已提交
319
static void tcp_v6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
320
		u8 type, u8 code, int offset, __be32 info)
L
Linus Torvalds 已提交
321
{
W
Weilong Chen 已提交
322
	const struct ipv6hdr *hdr = (const struct ipv6hdr *)skb->data;
323
	const struct tcphdr *th = (struct tcphdr *)(skb->data+offset);
324 325
	struct net *net = dev_net(skb->dev);
	struct request_sock *fastopen;
L
Linus Torvalds 已提交
326
	struct ipv6_pinfo *np;
327
	struct tcp_sock *tp;
328
	__u32 seq, snd_una;
329
	struct sock *sk;
330
	bool fatal;
331
	int err;
L
Linus Torvalds 已提交
332

333 334 335 336
	sk = __inet6_lookup_established(net, &tcp_hashinfo,
					&hdr->daddr, th->dest,
					&hdr->saddr, ntohs(th->source),
					skb->dev->ifindex);
L
Linus Torvalds 已提交
337

338
	if (!sk) {
E
Eric Dumazet 已提交
339 340
		__ICMP6_INC_STATS(net, __in6_dev_get(skb->dev),
				  ICMP6_MIB_INERRORS);
L
Linus Torvalds 已提交
341 342 343 344
		return;
	}

	if (sk->sk_state == TCP_TIME_WAIT) {
345
		inet_twsk_put(inet_twsk(sk));
L
Linus Torvalds 已提交
346 347
		return;
	}
348
	seq = ntohl(th->seq);
349
	fatal = icmpv6_err_convert(type, code, &err);
350
	if (sk->sk_state == TCP_NEW_SYN_RECV)
351
		return tcp_req_err(sk, seq, fatal);
L
Linus Torvalds 已提交
352 353

	bh_lock_sock(sk);
354
	if (sock_owned_by_user(sk) && type != ICMPV6_PKT_TOOBIG)
355
		__NET_INC_STATS(net, LINUX_MIB_LOCKDROPPEDICMPS);
L
Linus Torvalds 已提交
356 357 358 359

	if (sk->sk_state == TCP_CLOSE)
		goto out;

360
	if (ipv6_hdr(skb)->hop_limit < inet6_sk(sk)->min_hopcount) {
361
		__NET_INC_STATS(net, LINUX_MIB_TCPMINTTLDROP);
362 363 364
		goto out;
	}

L
Linus Torvalds 已提交
365
	tp = tcp_sk(sk);
366 367 368
	/* XXX (TFO) - tp->snd_una should be ISN (tcp_create_openreq_child() */
	fastopen = tp->fastopen_rsk;
	snd_una = fastopen ? tcp_rsk(fastopen)->snt_isn : tp->snd_una;
L
Linus Torvalds 已提交
369
	if (sk->sk_state != TCP_LISTEN &&
370
	    !between(seq, snd_una, tp->snd_nxt)) {
371
		__NET_INC_STATS(net, LINUX_MIB_OUTOFWINDOWICMPS);
L
Linus Torvalds 已提交
372 373 374 375 376
		goto out;
	}

	np = inet6_sk(sk);

377 378 379
	if (type == NDISC_REDIRECT) {
		struct dst_entry *dst = __sk_dst_check(sk, np->dst_cookie);

380
		if (dst)
381
			dst->ops->redirect(dst, sk, skb);
382
		goto out;
383 384
	}

L
Linus Torvalds 已提交
385
	if (type == ICMPV6_PKT_TOOBIG) {
386 387 388 389 390 391 392
		/* We are not interested in TCP_LISTEN and open_requests
		 * (SYN-ACKs send out by Linux are always <576bytes so
		 * they should go through unfragmented).
		 */
		if (sk->sk_state == TCP_LISTEN)
			goto out;

393 394 395
		if (!ip6_sk_accept_pmtu(sk))
			goto out;

396 397 398
		tp->mtu_info = ntohl(info);
		if (!sock_owned_by_user(sk))
			tcp_v6_mtu_reduced(sk);
399 400 401
		else if (!test_and_set_bit(TCP_MTU_REDUCED_DEFERRED,
					   &tp->tsq_flags))
			sock_hold(sk);
L
Linus Torvalds 已提交
402 403 404 405
		goto out;
	}


406
	/* Might be for an request_sock */
L
Linus Torvalds 已提交
407 408
	switch (sk->sk_state) {
	case TCP_SYN_SENT:
409 410 411 412
	case TCP_SYN_RECV:
		/* Only in fast or simultaneous open. If a fast open socket is
		 * is already accepted it is treated as a connected one below.
		 */
413
		if (fastopen && !fastopen->sk)
414 415
			break;

L
Linus Torvalds 已提交
416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437
		if (!sock_owned_by_user(sk)) {
			sk->sk_err = err;
			sk->sk_error_report(sk);		/* Wake people up to see the error (see connect in sock.c) */

			tcp_done(sk);
		} else
			sk->sk_err_soft = err;
		goto out;
	}

	if (!sock_owned_by_user(sk) && np->recverr) {
		sk->sk_err = err;
		sk->sk_error_report(sk);
	} else
		sk->sk_err_soft = err;

out:
	bh_unlock_sock(sk);
	sock_put(sk);
}


438
static int tcp_v6_send_synack(const struct sock *sk, struct dst_entry *dst,
439
			      struct flowi *fl,
440
			      struct request_sock *req,
441
			      struct tcp_fastopen_cookie *foc,
442
			      enum tcp_synack_type synack_type)
L
Linus Torvalds 已提交
443
{
444
	struct inet_request_sock *ireq = inet_rsk(req);
L
Linus Torvalds 已提交
445
	struct ipv6_pinfo *np = inet6_sk(sk);
446
	struct ipv6_txoptions *opt;
447
	struct flowi6 *fl6 = &fl->u.ip6;
W
Weilong Chen 已提交
448
	struct sk_buff *skb;
449
	int err = -ENOMEM;
L
Linus Torvalds 已提交
450

451
	/* First, grab a route. */
452 453
	if (!dst && (dst = inet6_csk_route_req(sk, fl6, req,
					       IPPROTO_TCP)) == NULL)
454
		goto done;
455

456
	skb = tcp_make_synack(sk, dst, req, foc, synack_type);
457

L
Linus Torvalds 已提交
458
	if (skb) {
459 460
		__tcp_v6_send_check(skb, &ireq->ir_v6_loc_addr,
				    &ireq->ir_v6_rmt_addr);
L
Linus Torvalds 已提交
461

462
		fl6->daddr = ireq->ir_v6_rmt_addr;
463
		if (np->repflow && ireq->pktopts)
464 465
			fl6->flowlabel = ip6_flowlabel(ipv6_hdr(ireq->pktopts));

466
		rcu_read_lock();
467 468 469 470
		opt = ireq->ipv6_opt;
		if (!opt)
			opt = rcu_dereference(np->opt);
		err = ip6_xmit(sk, skb, fl6, opt, np->tclass);
471
		rcu_read_unlock();
472
		err = net_xmit_eval(err);
L
Linus Torvalds 已提交
473 474 475 476 477 478
	}

done:
	return err;
}

479

480
static void tcp_v6_reqsk_destructor(struct request_sock *req)
L
Linus Torvalds 已提交
481
{
482
	kfree(inet_rsk(req)->ipv6_opt);
483
	kfree_skb(inet_rsk(req)->pktopts);
L
Linus Torvalds 已提交
484 485
}

486
#ifdef CONFIG_TCP_MD5SIG
487
static struct tcp_md5sig_key *tcp_v6_md5_do_lookup(const struct sock *sk,
488
						   const struct in6_addr *addr)
489
{
E
Eric Dumazet 已提交
490
	return tcp_md5_do_lookup(sk, (union tcp_md5_addr *)addr, AF_INET6);
491 492
}

493
static struct tcp_md5sig_key *tcp_v6_md5_lookup(const struct sock *sk,
494
						const struct sock *addr_sk)
495
{
496
	return tcp_v6_md5_do_lookup(sk, &addr_sk->sk_v6_daddr);
497 498
}

W
Wang Yufen 已提交
499 500
static int tcp_v6_parse_md5_keys(struct sock *sk, char __user *optval,
				 int optlen)
501 502 503 504 505 506 507 508 509 510 511 512 513 514
{
	struct tcp_md5sig cmd;
	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&cmd.tcpm_addr;

	if (optlen < sizeof(cmd))
		return -EINVAL;

	if (copy_from_user(&cmd, optval, sizeof(cmd)))
		return -EFAULT;

	if (sin6->sin6_family != AF_INET6)
		return -EINVAL;

	if (!cmd.tcpm_keylen) {
B
Brian Haley 已提交
515
		if (ipv6_addr_v4mapped(&sin6->sin6_addr))
E
Eric Dumazet 已提交
516 517 518 519
			return tcp_md5_do_del(sk, (union tcp_md5_addr *)&sin6->sin6_addr.s6_addr32[3],
					      AF_INET);
		return tcp_md5_do_del(sk, (union tcp_md5_addr *)&sin6->sin6_addr,
				      AF_INET6);
520 521 522 523 524
	}

	if (cmd.tcpm_keylen > TCP_MD5SIG_MAXKEYLEN)
		return -EINVAL;

E
Eric Dumazet 已提交
525 526 527
	if (ipv6_addr_v4mapped(&sin6->sin6_addr))
		return tcp_md5_do_add(sk, (union tcp_md5_addr *)&sin6->sin6_addr.s6_addr32[3],
				      AF_INET, cmd.tcpm_key, cmd.tcpm_keylen, GFP_KERNEL);
528

E
Eric Dumazet 已提交
529 530
	return tcp_md5_do_add(sk, (union tcp_md5_addr *)&sin6->sin6_addr,
			      AF_INET6, cmd.tcpm_key, cmd.tcpm_keylen, GFP_KERNEL);
531 532
}

533 534 535 536
static int tcp_v6_md5_hash_headers(struct tcp_md5sig_pool *hp,
				   const struct in6_addr *daddr,
				   const struct in6_addr *saddr,
				   const struct tcphdr *th, int nbytes)
537 538
{
	struct tcp6_pseudohdr *bp;
539
	struct scatterlist sg;
540
	struct tcphdr *_th;
541

542
	bp = hp->scratch;
543
	/* 1. TCP pseudo-header (RFC2460) */
A
Alexey Dobriyan 已提交
544 545
	bp->saddr = *saddr;
	bp->daddr = *daddr;
546
	bp->protocol = cpu_to_be32(IPPROTO_TCP);
A
Adam Langley 已提交
547
	bp->len = cpu_to_be32(nbytes);
548

549 550 551 552 553 554 555
	_th = (struct tcphdr *)(bp + 1);
	memcpy(_th, th, sizeof(*th));
	_th->check = 0;

	sg_init_one(&sg, bp, sizeof(*bp) + sizeof(*th));
	ahash_request_set_crypt(hp->md5_req, &sg, NULL,
				sizeof(*bp) + sizeof(*th));
H
Herbert Xu 已提交
556
	return crypto_ahash_update(hp->md5_req);
557
}
558

559
static int tcp_v6_md5_hash_hdr(char *md5_hash, const struct tcp_md5sig_key *key,
560
			       const struct in6_addr *daddr, struct in6_addr *saddr,
E
Eric Dumazet 已提交
561
			       const struct tcphdr *th)
562 563
{
	struct tcp_md5sig_pool *hp;
H
Herbert Xu 已提交
564
	struct ahash_request *req;
565 566 567 568

	hp = tcp_get_md5sig_pool();
	if (!hp)
		goto clear_hash_noput;
H
Herbert Xu 已提交
569
	req = hp->md5_req;
570

H
Herbert Xu 已提交
571
	if (crypto_ahash_init(req))
572
		goto clear_hash;
573
	if (tcp_v6_md5_hash_headers(hp, daddr, saddr, th, th->doff << 2))
574 575 576
		goto clear_hash;
	if (tcp_md5_hash_key(hp, key))
		goto clear_hash;
H
Herbert Xu 已提交
577 578
	ahash_request_set_crypt(req, NULL, md5_hash, 0);
	if (crypto_ahash_final(req))
579 580 581 582
		goto clear_hash;

	tcp_put_md5sig_pool();
	return 0;
583

584 585 586 587
clear_hash:
	tcp_put_md5sig_pool();
clear_hash_noput:
	memset(md5_hash, 0, 16);
588
	return 1;
589 590
}

591 592
static int tcp_v6_md5_hash_skb(char *md5_hash,
			       const struct tcp_md5sig_key *key,
E
Eric Dumazet 已提交
593 594
			       const struct sock *sk,
			       const struct sk_buff *skb)
595
{
596
	const struct in6_addr *saddr, *daddr;
597
	struct tcp_md5sig_pool *hp;
H
Herbert Xu 已提交
598
	struct ahash_request *req;
E
Eric Dumazet 已提交
599
	const struct tcphdr *th = tcp_hdr(skb);
600

601 602
	if (sk) { /* valid for establish/request sockets */
		saddr = &sk->sk_v6_rcv_saddr;
603
		daddr = &sk->sk_v6_daddr;
604
	} else {
605
		const struct ipv6hdr *ip6h = ipv6_hdr(skb);
606 607
		saddr = &ip6h->saddr;
		daddr = &ip6h->daddr;
608
	}
609 610 611 612

	hp = tcp_get_md5sig_pool();
	if (!hp)
		goto clear_hash_noput;
H
Herbert Xu 已提交
613
	req = hp->md5_req;
614

H
Herbert Xu 已提交
615
	if (crypto_ahash_init(req))
616 617
		goto clear_hash;

618
	if (tcp_v6_md5_hash_headers(hp, daddr, saddr, th, skb->len))
619 620 621 622 623
		goto clear_hash;
	if (tcp_md5_hash_skb_data(hp, skb, th->doff << 2))
		goto clear_hash;
	if (tcp_md5_hash_key(hp, key))
		goto clear_hash;
H
Herbert Xu 已提交
624 625
	ahash_request_set_crypt(req, NULL, md5_hash, 0);
	if (crypto_ahash_final(req))
626 627 628 629 630 631 632 633 634 635
		goto clear_hash;

	tcp_put_md5sig_pool();
	return 0;

clear_hash:
	tcp_put_md5sig_pool();
clear_hash_noput:
	memset(md5_hash, 0, 16);
	return 1;
636 637
}

638 639 640 641
#endif

static bool tcp_v6_inbound_md5_hash(const struct sock *sk,
				    const struct sk_buff *skb)
642
{
643
#ifdef CONFIG_TCP_MD5SIG
644
	const __u8 *hash_location = NULL;
645
	struct tcp_md5sig_key *hash_expected;
646
	const struct ipv6hdr *ip6h = ipv6_hdr(skb);
E
Eric Dumazet 已提交
647
	const struct tcphdr *th = tcp_hdr(skb);
648 649 650 651
	int genhash;
	u8 newhash[16];

	hash_expected = tcp_v6_md5_do_lookup(sk, &ip6h->saddr);
652
	hash_location = tcp_parse_md5sig_option(th);
653

654 655
	/* We've parsed the options - do we have a hash? */
	if (!hash_expected && !hash_location)
656
		return false;
657 658

	if (hash_expected && !hash_location) {
659
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5NOTFOUND);
660
		return true;
661 662
	}

663
	if (!hash_expected && hash_location) {
664
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5UNEXPECTED);
665
		return true;
666 667 668
	}

	/* check the signature */
669 670
	genhash = tcp_v6_md5_hash_skb(newhash,
				      hash_expected,
671
				      NULL, skb);
672

673
	if (genhash || memcmp(hash_location, newhash, 16) != 0) {
674
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5FAILURE);
675 676 677 678
		net_info_ratelimited("MD5 Hash %s for [%pI6c]:%u->[%pI6c]:%u\n",
				     genhash ? "failed" : "mismatch",
				     &ip6h->saddr, ntohs(th->source),
				     &ip6h->daddr, ntohs(th->dest));
679
		return true;
680
	}
681
#endif
682
	return false;
683 684
}

685 686
static void tcp_v6_init_req(struct request_sock *req,
			    const struct sock *sk_listener,
687 688 689
			    struct sk_buff *skb)
{
	struct inet_request_sock *ireq = inet_rsk(req);
690
	const struct ipv6_pinfo *np = inet6_sk(sk_listener);
691 692 693 694 695

	ireq->ir_v6_rmt_addr = ipv6_hdr(skb)->saddr;
	ireq->ir_v6_loc_addr = ipv6_hdr(skb)->daddr;

	/* So that link locals have meaning */
696
	if (!sk_listener->sk_bound_dev_if &&
697
	    ipv6_addr_type(&ireq->ir_v6_rmt_addr) & IPV6_ADDR_LINKLOCAL)
E
Eric Dumazet 已提交
698
		ireq->ir_iif = tcp_v6_iif(skb);
699

700
	if (!TCP_SKB_CB(skb)->tcp_tw_isn &&
701
	    (ipv6_opt_accepted(sk_listener, skb, &TCP_SKB_CB(skb)->header.h6) ||
702
	     np->rxopt.bits.rxinfo ||
703 704 705 706 707 708 709
	     np->rxopt.bits.rxoinfo || np->rxopt.bits.rxhlim ||
	     np->rxopt.bits.rxohlim || np->repflow)) {
		atomic_inc(&skb->users);
		ireq->pktopts = skb;
	}
}

710 711
static struct dst_entry *tcp_v6_route_req(const struct sock *sk,
					  struct flowi *fl,
712 713 714 715 716
					  const struct request_sock *req,
					  bool *strict)
{
	if (strict)
		*strict = true;
717
	return inet6_csk_route_req(sk, &fl->u.ip6, req, IPPROTO_TCP);
718 719
}

720
struct request_sock_ops tcp6_request_sock_ops __read_mostly = {
L
Linus Torvalds 已提交
721
	.family		=	AF_INET6,
722
	.obj_size	=	sizeof(struct tcp6_request_sock),
723
	.rtx_syn_ack	=	tcp_rtx_synack,
724 725
	.send_ack	=	tcp_v6_reqsk_send_ack,
	.destructor	=	tcp_v6_reqsk_destructor,
726
	.send_reset	=	tcp_v6_send_reset,
W
Wang Yufen 已提交
727
	.syn_ack_timeout =	tcp_syn_ack_timeout,
L
Linus Torvalds 已提交
728 729
};

730
static const struct tcp_request_sock_ops tcp_request_sock_ipv6_ops = {
731 732
	.mss_clamp	=	IPV6_MIN_MTU - sizeof(struct tcphdr) -
				sizeof(struct ipv6hdr),
733
#ifdef CONFIG_TCP_MD5SIG
734
	.req_md5_lookup	=	tcp_v6_md5_lookup,
735
	.calc_md5_hash	=	tcp_v6_md5_hash_skb,
736
#endif
737
	.init_req	=	tcp_v6_init_req,
738 739 740
#ifdef CONFIG_SYN_COOKIES
	.cookie_init_seq =	cookie_v6_init_sequence,
#endif
741
	.route_req	=	tcp_v6_route_req,
742
	.init_seq	=	tcp_v6_init_sequence,
743
	.send_synack	=	tcp_v6_send_synack,
744
};
745

746
static void tcp_v6_send_response(const struct sock *sk, struct sk_buff *skb, u32 seq,
747 748
				 u32 ack, u32 win, u32 tsval, u32 tsecr,
				 int oif, struct tcp_md5sig_key *key, int rst,
749
				 u8 tclass, __be32 label)
L
Linus Torvalds 已提交
750
{
751 752
	const struct tcphdr *th = tcp_hdr(skb);
	struct tcphdr *t1;
L
Linus Torvalds 已提交
753
	struct sk_buff *buff;
754
	struct flowi6 fl6;
755
	struct net *net = sk ? sock_net(sk) : dev_net(skb_dst(skb)->dev);
756
	struct sock *ctl_sk = net->ipv6.tcp_sk;
757
	unsigned int tot_len = sizeof(struct tcphdr);
E
Eric Dumazet 已提交
758
	struct dst_entry *dst;
759
	__be32 *topt;
L
Linus Torvalds 已提交
760

761
	if (tsecr)
762
		tot_len += TCPOLEN_TSTAMP_ALIGNED;
763 764 765 766 767 768
#ifdef CONFIG_TCP_MD5SIG
	if (key)
		tot_len += TCPOLEN_MD5SIG_ALIGNED;
#endif

	buff = alloc_skb(MAX_HEADER + sizeof(struct ipv6hdr) + tot_len,
L
Linus Torvalds 已提交
769
			 GFP_ATOMIC);
770
	if (!buff)
771
		return;
L
Linus Torvalds 已提交
772

773
	skb_reserve(buff, MAX_HEADER + sizeof(struct ipv6hdr) + tot_len);
L
Linus Torvalds 已提交
774

775
	t1 = (struct tcphdr *) skb_push(buff, tot_len);
776
	skb_reset_transport_header(buff);
L
Linus Torvalds 已提交
777 778 779 780 781

	/* Swap the send and the receive. */
	memset(t1, 0, sizeof(*t1));
	t1->dest = th->source;
	t1->source = th->dest;
782
	t1->doff = tot_len / 4;
783 784 785 786 787
	t1->seq = htonl(seq);
	t1->ack_seq = htonl(ack);
	t1->ack = !rst || !th->ack;
	t1->rst = rst;
	t1->window = htons(win);
L
Linus Torvalds 已提交
788

789 790
	topt = (__be32 *)(t1 + 1);

791
	if (tsecr) {
792 793
		*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
				(TCPOPT_TIMESTAMP << 8) | TCPOLEN_TIMESTAMP);
794 795
		*topt++ = htonl(tsval);
		*topt++ = htonl(tsecr);
796 797
	}

798 799
#ifdef CONFIG_TCP_MD5SIG
	if (key) {
800 801 802
		*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
				(TCPOPT_MD5SIG << 8) | TCPOLEN_MD5SIG);
		tcp_v6_md5_hash_hdr((__u8 *)topt, key,
803 804
				    &ipv6_hdr(skb)->saddr,
				    &ipv6_hdr(skb)->daddr, t1);
805 806 807
	}
#endif

808
	memset(&fl6, 0, sizeof(fl6));
A
Alexey Dobriyan 已提交
809 810
	fl6.daddr = ipv6_hdr(skb)->saddr;
	fl6.saddr = ipv6_hdr(skb)->daddr;
811
	fl6.flowlabel = label;
L
Linus Torvalds 已提交
812

813 814 815
	buff->ip_summed = CHECKSUM_PARTIAL;
	buff->csum = 0;

816
	__tcp_v6_send_check(buff, &fl6.saddr, &fl6.daddr);
L
Linus Torvalds 已提交
817

818
	fl6.flowi6_proto = IPPROTO_TCP;
819
	if (rt6_need_strict(&fl6.daddr) && !oif)
E
Eric Dumazet 已提交
820
		fl6.flowi6_oif = tcp_v6_iif(skb);
821 822
	else
		fl6.flowi6_oif = oif ? : skb->skb_iif;
823

824
	fl6.flowi6_mark = IP6_REPLY_MARK(net, skb->mark);
825 826
	fl6.fl6_dport = t1->dest;
	fl6.fl6_sport = t1->source;
827
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
828

829 830 831 832
	/* Pass a socket to ip6_dst_lookup either it is for RST
	 * Underlying function will use this to retrieve the network
	 * namespace
	 */
833
	dst = ip6_dst_lookup_flow(ctl_sk, &fl6, NULL);
834 835
	if (!IS_ERR(dst)) {
		skb_dst_set(buff, dst);
836
		ip6_xmit(ctl_sk, buff, &fl6, NULL, tclass);
837
		TCP_INC_STATS(net, TCP_MIB_OUTSEGS);
838
		if (rst)
839
			TCP_INC_STATS(net, TCP_MIB_OUTRSTS);
840
		return;
L
Linus Torvalds 已提交
841 842 843 844 845
	}

	kfree_skb(buff);
}

846
static void tcp_v6_send_reset(const struct sock *sk, struct sk_buff *skb)
L
Linus Torvalds 已提交
847
{
848
	const struct tcphdr *th = tcp_hdr(skb);
849
	u32 seq = 0, ack_seq = 0;
850
	struct tcp_md5sig_key *key = NULL;
851 852 853 854 855 856 857
#ifdef CONFIG_TCP_MD5SIG
	const __u8 *hash_location = NULL;
	struct ipv6hdr *ipv6h = ipv6_hdr(skb);
	unsigned char newhash[16];
	int genhash;
	struct sock *sk1 = NULL;
#endif
W
Wang Yufen 已提交
858
	int oif;
L
Linus Torvalds 已提交
859

860
	if (th->rst)
L
Linus Torvalds 已提交
861 862
		return;

863 864 865 866
	/* If sk not NULL, it means we did a successful lookup and incoming
	 * route had to be correct. prequeue might have dropped our dst.
	 */
	if (!sk && !ipv6_unicast_destination(skb))
867
		return;
L
Linus Torvalds 已提交
868

869
#ifdef CONFIG_TCP_MD5SIG
870
	rcu_read_lock();
871
	hash_location = tcp_parse_md5sig_option(th);
872
	if (sk && sk_fullsock(sk)) {
873 874
		key = tcp_v6_md5_do_lookup(sk, &ipv6h->saddr);
	} else if (hash_location) {
875 876 877 878 879 880 881 882
		/*
		 * active side is lost. Try to find listening socket through
		 * source port, and then find md5 key through listening socket.
		 * we are not loose security here:
		 * Incoming packet is checked with md5 hash with finding key,
		 * no RST generated if md5 hash doesn't match.
		 */
		sk1 = inet6_lookup_listener(dev_net(skb_dst(skb)->dev),
883 884
					   &tcp_hashinfo, NULL, 0,
					   &ipv6h->saddr,
885
					   th->source, &ipv6h->daddr,
E
Eric Dumazet 已提交
886
					   ntohs(th->source), tcp_v6_iif(skb));
887
		if (!sk1)
888
			goto out;
889 890 891

		key = tcp_v6_md5_do_lookup(sk1, &ipv6h->saddr);
		if (!key)
892
			goto out;
893

894
		genhash = tcp_v6_md5_hash_skb(newhash, key, NULL, skb);
895
		if (genhash || memcmp(hash_location, newhash, 16) != 0)
896
			goto out;
897
	}
898 899
#endif

900 901 902 903 904
	if (th->ack)
		seq = ntohl(th->ack_seq);
	else
		ack_seq = ntohl(th->seq) + th->syn + th->fin + skb->len -
			  (th->doff << 2);
L
Linus Torvalds 已提交
905

W
Wang Yufen 已提交
906
	oif = sk ? sk->sk_bound_dev_if : 0;
907
	tcp_v6_send_response(sk, skb, seq, ack_seq, 0, 0, 0, oif, key, 1, 0, 0);
908 909

#ifdef CONFIG_TCP_MD5SIG
910 911
out:
	rcu_read_unlock();
912
#endif
913
}
L
Linus Torvalds 已提交
914

915
static void tcp_v6_send_ack(const struct sock *sk, struct sk_buff *skb, u32 seq,
916
			    u32 ack, u32 win, u32 tsval, u32 tsecr, int oif,
917
			    struct tcp_md5sig_key *key, u8 tclass,
918
			    __be32 label)
919
{
920 921
	tcp_v6_send_response(sk, skb, seq, ack, win, tsval, tsecr, oif, key, 0,
			     tclass, label);
L
Linus Torvalds 已提交
922 923 924 925
}

static void tcp_v6_timewait_ack(struct sock *sk, struct sk_buff *skb)
{
926
	struct inet_timewait_sock *tw = inet_twsk(sk);
927
	struct tcp_timewait_sock *tcptw = tcp_twsk(sk);
L
Linus Torvalds 已提交
928

929
	tcp_v6_send_ack(sk, skb, tcptw->tw_snd_nxt, tcptw->tw_rcv_nxt,
930
			tcptw->tw_rcv_wnd >> tw->tw_rcv_wscale,
931
			tcp_time_stamp + tcptw->tw_ts_offset,
W
Wang Yufen 已提交
932
			tcptw->tw_ts_recent, tw->tw_bound_dev_if, tcp_twsk_md5_key(tcptw),
933
			tw->tw_tclass, cpu_to_be32(tw->tw_flowlabel));
L
Linus Torvalds 已提交
934

935
	inet_twsk_put(tw);
L
Linus Torvalds 已提交
936 937
}

938
static void tcp_v6_reqsk_send_ack(const struct sock *sk, struct sk_buff *skb,
939
				  struct request_sock *req)
L
Linus Torvalds 已提交
940
{
941 942 943
	/* sk->sk_state == TCP_LISTEN -> for regular TCP_SYN_RECV
	 * sk->sk_state == TCP_SYN_RECV -> for Fast Open.
	 */
944 945 946 947 948
	/* RFC 7323 2.3
	 * The window field (SEG.WND) of every outgoing segment, with the
	 * exception of <SYN> segments, MUST be right-shifted by
	 * Rcv.Wind.Shift bits:
	 */
949
	tcp_v6_send_ack(sk, skb, (sk->sk_state == TCP_LISTEN) ?
950
			tcp_rsk(req)->snt_isn + 1 : tcp_sk(sk)->snd_nxt,
951 952
			tcp_rsk(req)->rcv_nxt,
			req->rsk_rcv_wnd >> inet_rsk(req)->rcv_wscale,
953
			tcp_time_stamp, req->ts_recent, sk->sk_bound_dev_if,
954 955
			tcp_v6_md5_do_lookup(sk, &ipv6_hdr(skb)->daddr),
			0, 0);
L
Linus Torvalds 已提交
956 957 958
}


959
static struct sock *tcp_v6_cookie_check(struct sock *sk, struct sk_buff *skb)
L
Linus Torvalds 已提交
960
{
961
#ifdef CONFIG_SYN_COOKIES
962
	const struct tcphdr *th = tcp_hdr(skb);
L
Linus Torvalds 已提交
963

964
	if (!th->syn)
965
		sk = cookie_v6_check(sk, skb);
L
Linus Torvalds 已提交
966 967 968 969 970 971 972 973 974 975
#endif
	return sk;
}

static int tcp_v6_conn_request(struct sock *sk, struct sk_buff *skb)
{
	if (skb->protocol == htons(ETH_P_IP))
		return tcp_v4_conn_request(sk, skb);

	if (!ipv6_unicast_destination(skb))
976
		goto drop;
L
Linus Torvalds 已提交
977

O
Octavian Purdila 已提交
978 979
	return tcp_conn_request(&tcp6_request_sock_ops,
				&tcp_request_sock_ipv6_ops, sk, skb);
L
Linus Torvalds 已提交
980 981

drop:
982
	tcp_listendrop(sk);
L
Linus Torvalds 已提交
983 984 985
	return 0; /* don't send reset */
}

986
static struct sock *tcp_v6_syn_recv_sock(const struct sock *sk, struct sk_buff *skb,
W
Weilong Chen 已提交
987
					 struct request_sock *req,
988 989 990
					 struct dst_entry *dst,
					 struct request_sock *req_unhash,
					 bool *own_req)
L
Linus Torvalds 已提交
991
{
992
	struct inet_request_sock *ireq;
993 994
	struct ipv6_pinfo *newnp;
	const struct ipv6_pinfo *np = inet6_sk(sk);
995
	struct ipv6_txoptions *opt;
L
Linus Torvalds 已提交
996 997 998 999
	struct tcp6_sock *newtcp6sk;
	struct inet_sock *newinet;
	struct tcp_sock *newtp;
	struct sock *newsk;
1000 1001 1002
#ifdef CONFIG_TCP_MD5SIG
	struct tcp_md5sig_key *key;
#endif
1003
	struct flowi6 fl6;
L
Linus Torvalds 已提交
1004 1005 1006 1007 1008 1009

	if (skb->protocol == htons(ETH_P_IP)) {
		/*
		 *	v6 mapped
		 */

1010 1011
		newsk = tcp_v4_syn_recv_sock(sk, skb, req, dst,
					     req_unhash, own_req);
L
Linus Torvalds 已提交
1012

1013
		if (!newsk)
L
Linus Torvalds 已提交
1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
			return NULL;

		newtcp6sk = (struct tcp6_sock *)newsk;
		inet_sk(newsk)->pinet6 = &newtcp6sk->inet6;

		newinet = inet_sk(newsk);
		newnp = inet6_sk(newsk);
		newtp = tcp_sk(newsk);

		memcpy(newnp, np, sizeof(struct ipv6_pinfo));

1025
		newnp->saddr = newsk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
1026

1027
		inet_csk(newsk)->icsk_af_ops = &ipv6_mapped;
L
Linus Torvalds 已提交
1028
		newsk->sk_backlog_rcv = tcp_v4_do_rcv;
1029 1030 1031 1032
#ifdef CONFIG_TCP_MD5SIG
		newtp->af_specific = &tcp_sock_ipv6_mapped_specific;
#endif

1033 1034
		newnp->ipv6_ac_list = NULL;
		newnp->ipv6_fl_list = NULL;
L
Linus Torvalds 已提交
1035 1036
		newnp->pktoptions  = NULL;
		newnp->opt	   = NULL;
E
Eric Dumazet 已提交
1037
		newnp->mcast_oif   = tcp_v6_iif(skb);
1038
		newnp->mcast_hops  = ipv6_hdr(skb)->hop_limit;
1039
		newnp->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(skb));
1040 1041
		if (np->repflow)
			newnp->flow_label = ip6_flowlabel(ipv6_hdr(skb));
L
Linus Torvalds 已提交
1042

1043 1044 1045 1046
		/*
		 * No need to charge this sock to the relevant IPv6 refcnt debug socks count
		 * here, tcp_create_openreq_child now does this for us, see the comment in
		 * that function for the gory details. -acme
L
Linus Torvalds 已提交
1047 1048 1049
		 */

		/* It is tricky place. Until this moment IPv4 tcp
1050
		   worked with IPv6 icsk.icsk_af_ops.
L
Linus Torvalds 已提交
1051 1052
		   Sync it now.
		 */
1053
		tcp_sync_mss(newsk, inet_csk(newsk)->icsk_pmtu_cookie);
L
Linus Torvalds 已提交
1054 1055 1056 1057

		return newsk;
	}

1058
	ireq = inet_rsk(req);
L
Linus Torvalds 已提交
1059 1060 1061 1062

	if (sk_acceptq_is_full(sk))
		goto out_overflow;

1063
	if (!dst) {
1064
		dst = inet6_csk_route_req(sk, &fl6, req, IPPROTO_TCP);
1065
		if (!dst)
L
Linus Torvalds 已提交
1066
			goto out;
1067
	}
L
Linus Torvalds 已提交
1068 1069

	newsk = tcp_create_openreq_child(sk, req, skb);
1070
	if (!newsk)
1071
		goto out_nonewsk;
L
Linus Torvalds 已提交
1072

1073 1074 1075 1076 1077
	/*
	 * No need to charge this sock to the relevant IPv6 refcnt debug socks
	 * count here, tcp_create_openreq_child now does this for us, see the
	 * comment in that function for the gory details. -acme
	 */
L
Linus Torvalds 已提交
1078

1079
	newsk->sk_gso_type = SKB_GSO_TCPV6;
E
Eric Dumazet 已提交
1080
	ip6_dst_store(newsk, dst, NULL, NULL);
1081
	inet6_sk_rx_dst_set(newsk, skb);
L
Linus Torvalds 已提交
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091

	newtcp6sk = (struct tcp6_sock *)newsk;
	inet_sk(newsk)->pinet6 = &newtcp6sk->inet6;

	newtp = tcp_sk(newsk);
	newinet = inet_sk(newsk);
	newnp = inet6_sk(newsk);

	memcpy(newnp, np, sizeof(struct ipv6_pinfo));

1092 1093 1094 1095
	newsk->sk_v6_daddr = ireq->ir_v6_rmt_addr;
	newnp->saddr = ireq->ir_v6_loc_addr;
	newsk->sk_v6_rcv_saddr = ireq->ir_v6_loc_addr;
	newsk->sk_bound_dev_if = ireq->ir_iif;
L
Linus Torvalds 已提交
1096

1097
	/* Now IPv6 options...
L
Linus Torvalds 已提交
1098 1099 1100

	   First: no IPv4 options.
	 */
1101
	newinet->inet_opt = NULL;
1102
	newnp->ipv6_ac_list = NULL;
1103
	newnp->ipv6_fl_list = NULL;
L
Linus Torvalds 已提交
1104 1105 1106 1107 1108 1109

	/* Clone RX bits */
	newnp->rxopt.all = np->rxopt.all;

	newnp->pktoptions = NULL;
	newnp->opt	  = NULL;
E
Eric Dumazet 已提交
1110
	newnp->mcast_oif  = tcp_v6_iif(skb);
1111
	newnp->mcast_hops = ipv6_hdr(skb)->hop_limit;
1112
	newnp->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(skb));
1113 1114
	if (np->repflow)
		newnp->flow_label = ip6_flowlabel(ipv6_hdr(skb));
L
Linus Torvalds 已提交
1115 1116 1117 1118 1119 1120 1121

	/* Clone native IPv6 options from listening socket (if any)

	   Yes, keeping reference count would be much more clever,
	   but we make one more one thing there: reattach optmem
	   to newsk.
	 */
1122 1123 1124
	opt = ireq->ipv6_opt;
	if (!opt)
		opt = rcu_dereference(np->opt);
1125 1126 1127 1128
	if (opt) {
		opt = ipv6_dup_options(newsk, opt);
		RCU_INIT_POINTER(newnp->opt, opt);
	}
1129
	inet_csk(newsk)->icsk_ext_hdr_len = 0;
1130 1131 1132
	if (opt)
		inet_csk(newsk)->icsk_ext_hdr_len = opt->opt_nflen +
						    opt->opt_flen;
L
Linus Torvalds 已提交
1133

1134 1135
	tcp_ca_openreq_child(newsk, dst);

L
Linus Torvalds 已提交
1136
	tcp_sync_mss(newsk, dst_mtu(dst));
1137
	newtp->advmss = dst_metric_advmss(dst);
1138 1139 1140 1141
	if (tcp_sk(sk)->rx_opt.user_mss &&
	    tcp_sk(sk)->rx_opt.user_mss < newtp->advmss)
		newtp->advmss = tcp_sk(sk)->rx_opt.user_mss;

L
Linus Torvalds 已提交
1142 1143
	tcp_initialize_rcv_mss(newsk);

E
Eric Dumazet 已提交
1144 1145
	newinet->inet_daddr = newinet->inet_saddr = LOOPBACK4_IPV6;
	newinet->inet_rcv_saddr = LOOPBACK4_IPV6;
L
Linus Torvalds 已提交
1146

1147 1148
#ifdef CONFIG_TCP_MD5SIG
	/* Copy over the MD5 key from the original socket */
W
Wang Yufen 已提交
1149
	key = tcp_v6_md5_do_lookup(sk, &newsk->sk_v6_daddr);
1150
	if (key) {
1151 1152 1153 1154 1155
		/* We're using one, so create a matching key
		 * on the newsk structure. If we fail to get
		 * memory, then we end up not copying the key
		 * across. Shucks.
		 */
1156
		tcp_md5_do_add(newsk, (union tcp_md5_addr *)&newsk->sk_v6_daddr,
1157
			       AF_INET6, key->key, key->keylen,
1158
			       sk_gfp_mask(sk, GFP_ATOMIC));
1159 1160 1161
	}
#endif

1162
	if (__inet_inherit_port(sk, newsk) < 0) {
1163 1164
		inet_csk_prepare_forced_close(newsk);
		tcp_done(newsk);
1165 1166
		goto out;
	}
1167
	*own_req = inet_ehash_nolisten(newsk, req_to_sk(req_unhash));
E
Eric Dumazet 已提交
1168
	if (*own_req) {
1169
		tcp_move_syn(newtp, req);
E
Eric Dumazet 已提交
1170 1171 1172 1173

		/* Clone pktoptions received with SYN, if we own the req */
		if (ireq->pktopts) {
			newnp->pktoptions = skb_clone(ireq->pktopts,
1174
						      sk_gfp_mask(sk, GFP_ATOMIC));
E
Eric Dumazet 已提交
1175 1176 1177 1178 1179
			consume_skb(ireq->pktopts);
			ireq->pktopts = NULL;
			if (newnp->pktoptions)
				skb_set_owner_r(newnp->pktoptions, newsk);
		}
E
Eric Dumazet 已提交
1180
	}
L
Linus Torvalds 已提交
1181 1182 1183 1184

	return newsk;

out_overflow:
1185
	__NET_INC_STATS(sock_net(sk), LINUX_MIB_LISTENOVERFLOWS);
1186
out_nonewsk:
L
Linus Torvalds 已提交
1187
	dst_release(dst);
1188
out:
1189
	tcp_listendrop(sk);
L
Linus Torvalds 已提交
1190 1191 1192
	return NULL;
}

1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
static void tcp_v6_restore_cb(struct sk_buff *skb)
{
	/* We need to move header back to the beginning if xfrm6_policy_check()
	 * and tcp_v6_fill_cb() are going to be called again.
	 * ip6_datagram_recv_specific_ctl() also expects IP6CB to be there.
	 */
	memmove(IP6CB(skb), &TCP_SKB_CB(skb)->header.h6,
		sizeof(struct inet6_skb_parm));
}

L
Linus Torvalds 已提交
1203
/* The socket must have it's spinlock held when we get
1204
 * here, unless it is a TCP_LISTEN socket.
L
Linus Torvalds 已提交
1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227
 *
 * We have a potential double-lock case here, so even when
 * doing backlog processing we use the BH locking scheme.
 * This is because we cannot sleep with the original spinlock
 * held.
 */
static int tcp_v6_do_rcv(struct sock *sk, struct sk_buff *skb)
{
	struct ipv6_pinfo *np = inet6_sk(sk);
	struct tcp_sock *tp;
	struct sk_buff *opt_skb = NULL;

	/* Imagine: socket is IPv6. IPv4 packet arrives,
	   goes to IPv4 receive handler and backlogged.
	   From backlog it always goes here. Kerboom...
	   Fortunately, tcp_rcv_established and rcv_established
	   handle them correctly, but it is not case with
	   tcp_v6_hnd_req and tcp_v6_send_reset().   --ANK
	 */

	if (skb->protocol == htons(ETH_P_IP))
		return tcp_v4_do_rcv(sk, skb);

1228
	if (sk_filter(sk, skb))
L
Linus Torvalds 已提交
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246
		goto discard;

	/*
	 *	socket locking is here for SMP purposes as backlog rcv
	 *	is currently called with bh processing disabled.
	 */

	/* Do Stevens' IPV6_PKTOPTIONS.

	   Yes, guys, it is the only place in our code, where we
	   may make it not affecting IPv4.
	   The rest of code is protocol independent,
	   and I do not like idea to uglify IPv4.

	   Actually, all the idea behind IPV6_PKTOPTIONS
	   looks not very well thought. For now we latch
	   options, received in the last packet, enqueued
	   by tcp. Feel free to propose better solution.
1247
					       --ANK (980728)
L
Linus Torvalds 已提交
1248 1249
	 */
	if (np->rxopt.all)
1250
		opt_skb = skb_clone(skb, sk_gfp_mask(sk, GFP_ATOMIC));
L
Linus Torvalds 已提交
1251 1252

	if (sk->sk_state == TCP_ESTABLISHED) { /* Fast path */
E
Eric Dumazet 已提交
1253 1254
		struct dst_entry *dst = sk->sk_rx_dst;

1255
		sock_rps_save_rxhash(sk, skb);
1256
		sk_mark_napi_id(sk, skb);
E
Eric Dumazet 已提交
1257 1258 1259 1260 1261 1262 1263 1264
		if (dst) {
			if (inet_sk(sk)->rx_dst_ifindex != skb->skb_iif ||
			    dst->ops->check(dst, np->rx_dst_cookie) == NULL) {
				dst_release(dst);
				sk->sk_rx_dst = NULL;
			}
		}

1265
		tcp_rcv_established(sk, skb, tcp_hdr(skb), skb->len);
L
Linus Torvalds 已提交
1266 1267 1268 1269 1270
		if (opt_skb)
			goto ipv6_pktoptions;
		return 0;
	}

E
Eric Dumazet 已提交
1271
	if (tcp_checksum_complete(skb))
L
Linus Torvalds 已提交
1272 1273
		goto csum_err;

1274
	if (sk->sk_state == TCP_LISTEN) {
1275 1276
		struct sock *nsk = tcp_v6_cookie_check(sk, skb);

L
Linus Torvalds 已提交
1277 1278 1279
		if (!nsk)
			goto discard;

W
Weilong Chen 已提交
1280
		if (nsk != sk) {
1281
			sock_rps_save_rxhash(nsk, skb);
1282
			sk_mark_napi_id(nsk, skb);
L
Linus Torvalds 已提交
1283 1284 1285 1286 1287 1288
			if (tcp_child_process(sk, nsk, skb))
				goto reset;
			if (opt_skb)
				__kfree_skb(opt_skb);
			return 0;
		}
1289
	} else
1290
		sock_rps_save_rxhash(sk, skb);
L
Linus Torvalds 已提交
1291

1292
	if (tcp_rcv_state_process(sk, skb))
L
Linus Torvalds 已提交
1293 1294 1295 1296 1297 1298
		goto reset;
	if (opt_skb)
		goto ipv6_pktoptions;
	return 0;

reset:
1299
	tcp_v6_send_reset(sk, skb);
L
Linus Torvalds 已提交
1300 1301 1302 1303 1304 1305
discard:
	if (opt_skb)
		__kfree_skb(opt_skb);
	kfree_skb(skb);
	return 0;
csum_err:
1306 1307
	TCP_INC_STATS(sock_net(sk), TCP_MIB_CSUMERRORS);
	TCP_INC_STATS(sock_net(sk), TCP_MIB_INERRS);
L
Linus Torvalds 已提交
1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
	goto discard;


ipv6_pktoptions:
	/* Do you ask, what is it?

	   1. skb was enqueued by tcp.
	   2. skb is added to tail of read queue, rather than out of order.
	   3. socket is not in passive state.
	   4. Finally, it really contains options, which user wants to receive.
	 */
	tp = tcp_sk(sk);
	if (TCP_SKB_CB(opt_skb)->end_seq == tp->rcv_nxt &&
	    !((1 << sk->sk_state) & (TCPF_CLOSE | TCPF_LISTEN))) {
1322
		if (np->rxopt.bits.rxinfo || np->rxopt.bits.rxoinfo)
E
Eric Dumazet 已提交
1323
			np->mcast_oif = tcp_v6_iif(opt_skb);
1324
		if (np->rxopt.bits.rxhlim || np->rxopt.bits.rxohlim)
1325
			np->mcast_hops = ipv6_hdr(opt_skb)->hop_limit;
1326
		if (np->rxopt.bits.rxflow || np->rxopt.bits.rxtclass)
1327
			np->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(opt_skb));
1328 1329
		if (np->repflow)
			np->flow_label = ip6_flowlabel(ipv6_hdr(opt_skb));
1330
		if (ipv6_opt_accepted(sk, opt_skb, &TCP_SKB_CB(opt_skb)->header.h6)) {
L
Linus Torvalds 已提交
1331
			skb_set_owner_r(opt_skb, sk);
1332
			tcp_v6_restore_cb(opt_skb);
L
Linus Torvalds 已提交
1333 1334 1335 1336 1337 1338 1339
			opt_skb = xchg(&np->pktoptions, opt_skb);
		} else {
			__kfree_skb(opt_skb);
			opt_skb = xchg(&np->pktoptions, NULL);
		}
	}

1340
	kfree_skb(opt_skb);
L
Linus Torvalds 已提交
1341 1342 1343
	return 0;
}

1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365
static void tcp_v6_fill_cb(struct sk_buff *skb, const struct ipv6hdr *hdr,
			   const struct tcphdr *th)
{
	/* This is tricky: we move IP6CB at its correct location into
	 * TCP_SKB_CB(). It must be done after xfrm6_policy_check(), because
	 * _decode_session6() uses IP6CB().
	 * barrier() makes sure compiler won't play aliasing games.
	 */
	memmove(&TCP_SKB_CB(skb)->header.h6, IP6CB(skb),
		sizeof(struct inet6_skb_parm));
	barrier();

	TCP_SKB_CB(skb)->seq = ntohl(th->seq);
	TCP_SKB_CB(skb)->end_seq = (TCP_SKB_CB(skb)->seq + th->syn + th->fin +
				    skb->len - th->doff*4);
	TCP_SKB_CB(skb)->ack_seq = ntohl(th->ack_seq);
	TCP_SKB_CB(skb)->tcp_flags = tcp_flag_byte(th);
	TCP_SKB_CB(skb)->tcp_tw_isn = 0;
	TCP_SKB_CB(skb)->ip_dsfield = ipv6_get_dsfield(hdr);
	TCP_SKB_CB(skb)->sacked = 0;
}

1366
static int tcp_v6_rcv(struct sk_buff *skb)
L
Linus Torvalds 已提交
1367
{
1368
	const struct tcphdr *th;
1369
	const struct ipv6hdr *hdr;
1370
	bool refcounted;
L
Linus Torvalds 已提交
1371 1372
	struct sock *sk;
	int ret;
1373
	struct net *net = dev_net(skb->dev);
L
Linus Torvalds 已提交
1374 1375 1376 1377 1378 1379 1380

	if (skb->pkt_type != PACKET_HOST)
		goto discard_it;

	/*
	 *	Count it even if it's bad.
	 */
E
Eric Dumazet 已提交
1381
	__TCP_INC_STATS(net, TCP_MIB_INSEGS);
L
Linus Torvalds 已提交
1382 1383 1384 1385

	if (!pskb_may_pull(skb, sizeof(struct tcphdr)))
		goto discard_it;

1386
	th = (const struct tcphdr *)skb->data;
L
Linus Torvalds 已提交
1387

1388
	if (unlikely(th->doff < sizeof(struct tcphdr)/4))
L
Linus Torvalds 已提交
1389 1390 1391 1392
		goto bad_packet;
	if (!pskb_may_pull(skb, th->doff*4))
		goto discard_it;

1393
	if (skb_checksum_init(skb, IPPROTO_TCP, ip6_compute_pseudo))
1394
		goto csum_error;
L
Linus Torvalds 已提交
1395

1396
	th = (const struct tcphdr *)skb->data;
1397
	hdr = ipv6_hdr(skb);
L
Linus Torvalds 已提交
1398

1399
lookup:
1400
	sk = __inet6_lookup_skb(&tcp_hashinfo, skb, __tcp_hdrlen(th),
1401 1402
				th->source, th->dest, inet6_iif(skb),
				&refcounted);
L
Linus Torvalds 已提交
1403 1404 1405 1406 1407 1408 1409
	if (!sk)
		goto no_tcp_socket;

process:
	if (sk->sk_state == TCP_TIME_WAIT)
		goto do_time_wait;

1410 1411
	if (sk->sk_state == TCP_NEW_SYN_RECV) {
		struct request_sock *req = inet_reqsk(sk);
1412
		struct sock *nsk;
1413 1414 1415 1416

		sk = req->rsk_listener;
		tcp_v6_fill_cb(skb, hdr, th);
		if (tcp_v6_inbound_md5_hash(sk, skb)) {
1417
			sk_drops_add(sk, skb);
1418 1419 1420
			reqsk_put(req);
			goto discard_it;
		}
1421
		if (unlikely(sk->sk_state != TCP_LISTEN)) {
1422
			inet_csk_reqsk_queue_drop_and_put(sk, req);
1423 1424
			goto lookup;
		}
1425
		sock_hold(sk);
1426
		refcounted = true;
1427
		nsk = tcp_check_req(sk, skb, req, false);
1428 1429
		if (!nsk) {
			reqsk_put(req);
1430
			goto discard_and_relse;
1431 1432 1433 1434 1435 1436
		}
		if (nsk == sk) {
			reqsk_put(req);
			tcp_v6_restore_cb(skb);
		} else if (tcp_child_process(sk, nsk, skb)) {
			tcp_v6_send_reset(nsk, skb);
1437
			goto discard_and_relse;
1438
		} else {
1439
			sock_put(sk);
1440 1441 1442
			return 0;
		}
	}
1443
	if (hdr->hop_limit < inet6_sk(sk)->min_hopcount) {
1444
		__NET_INC_STATS(net, LINUX_MIB_TCPMINTTLDROP);
1445 1446 1447
		goto discard_and_relse;
	}

L
Linus Torvalds 已提交
1448 1449 1450
	if (!xfrm6_policy_check(sk, XFRM_POLICY_IN, skb))
		goto discard_and_relse;

1451 1452
	tcp_v6_fill_cb(skb, hdr, th);

1453 1454 1455
	if (tcp_v6_inbound_md5_hash(sk, skb))
		goto discard_and_relse;

1456
	if (sk_filter(sk, skb))
L
Linus Torvalds 已提交
1457 1458 1459 1460
		goto discard_and_relse;

	skb->dev = NULL;

1461 1462 1463 1464 1465 1466 1467
	if (sk->sk_state == TCP_LISTEN) {
		ret = tcp_v6_do_rcv(sk, skb);
		goto put_and_return;
	}

	sk_incoming_cpu_update(sk);

1468
	bh_lock_sock_nested(sk);
1469
	tcp_segs_in(tcp_sk(sk), skb);
L
Linus Torvalds 已提交
1470 1471
	ret = 0;
	if (!sock_owned_by_user(sk)) {
D
Dan Williams 已提交
1472
		if (!tcp_prequeue(sk, skb))
1473
			ret = tcp_v6_do_rcv(sk, skb);
E
Eric Dumazet 已提交
1474
	} else if (tcp_add_backlog(sk, skb)) {
Z
Zhu Yi 已提交
1475 1476
		goto discard_and_relse;
	}
L
Linus Torvalds 已提交
1477 1478
	bh_unlock_sock(sk);

1479
put_and_return:
1480 1481
	if (refcounted)
		sock_put(sk);
L
Linus Torvalds 已提交
1482 1483 1484 1485 1486 1487
	return ret ? -1 : 0;

no_tcp_socket:
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb))
		goto discard_it;

1488 1489
	tcp_v6_fill_cb(skb, hdr, th);

E
Eric Dumazet 已提交
1490
	if (tcp_checksum_complete(skb)) {
1491
csum_error:
E
Eric Dumazet 已提交
1492
		__TCP_INC_STATS(net, TCP_MIB_CSUMERRORS);
L
Linus Torvalds 已提交
1493
bad_packet:
E
Eric Dumazet 已提交
1494
		__TCP_INC_STATS(net, TCP_MIB_INERRS);
L
Linus Torvalds 已提交
1495
	} else {
1496
		tcp_v6_send_reset(NULL, skb);
L
Linus Torvalds 已提交
1497 1498 1499 1500 1501 1502 1503
	}

discard_it:
	kfree_skb(skb);
	return 0;

discard_and_relse:
1504
	sk_drops_add(sk, skb);
1505 1506
	if (refcounted)
		sock_put(sk);
L
Linus Torvalds 已提交
1507 1508 1509 1510
	goto discard_it;

do_time_wait:
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
1511
		inet_twsk_put(inet_twsk(sk));
L
Linus Torvalds 已提交
1512 1513 1514
		goto discard_it;
	}

1515 1516
	tcp_v6_fill_cb(skb, hdr, th);

1517 1518 1519
	if (tcp_checksum_complete(skb)) {
		inet_twsk_put(inet_twsk(sk));
		goto csum_error;
L
Linus Torvalds 已提交
1520 1521
	}

1522
	switch (tcp_timewait_state_process(inet_twsk(sk), skb, th)) {
L
Linus Torvalds 已提交
1523 1524 1525 1526
	case TCP_TW_SYN:
	{
		struct sock *sk2;

1527
		sk2 = inet6_lookup_listener(dev_net(skb->dev), &tcp_hashinfo,
1528
					    skb, __tcp_hdrlen(th),
1529
					    &ipv6_hdr(skb)->saddr, th->source,
1530
					    &ipv6_hdr(skb)->daddr,
E
Eric Dumazet 已提交
1531
					    ntohs(th->dest), tcp_v6_iif(skb));
1532
		if (sk2) {
1533
			struct inet_timewait_sock *tw = inet_twsk(sk);
1534
			inet_twsk_deschedule_put(tw);
L
Linus Torvalds 已提交
1535
			sk = sk2;
1536
			tcp_v6_restore_cb(skb);
1537
			refcounted = false;
L
Linus Torvalds 已提交
1538 1539 1540 1541 1542 1543 1544 1545
			goto process;
		}
		/* Fall through to ACK */
	}
	case TCP_TW_ACK:
		tcp_v6_timewait_ack(sk, skb);
		break;
	case TCP_TW_RST:
1546
		tcp_v6_restore_cb(skb);
1547 1548 1549
		tcp_v6_send_reset(sk, skb);
		inet_twsk_deschedule_put(inet_twsk(sk));
		goto discard_it;
W
Wang Yufen 已提交
1550 1551
	case TCP_TW_SUCCESS:
		;
L
Linus Torvalds 已提交
1552 1553 1554 1555
	}
	goto discard_it;
}

E
Eric Dumazet 已提交
1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573
static void tcp_v6_early_demux(struct sk_buff *skb)
{
	const struct ipv6hdr *hdr;
	const struct tcphdr *th;
	struct sock *sk;

	if (skb->pkt_type != PACKET_HOST)
		return;

	if (!pskb_may_pull(skb, skb_transport_offset(skb) + sizeof(struct tcphdr)))
		return;

	hdr = ipv6_hdr(skb);
	th = tcp_hdr(skb);

	if (th->doff < sizeof(struct tcphdr) / 4)
		return;

E
Eric Dumazet 已提交
1574
	/* Note : We use inet6_iif() here, not tcp_v6_iif() */
E
Eric Dumazet 已提交
1575 1576 1577 1578 1579 1580 1581
	sk = __inet6_lookup_established(dev_net(skb->dev), &tcp_hashinfo,
					&hdr->saddr, th->source,
					&hdr->daddr, ntohs(th->dest),
					inet6_iif(skb));
	if (sk) {
		skb->sk = sk;
		skb->destructor = sock_edemux;
1582
		if (sk_fullsock(sk)) {
1583
			struct dst_entry *dst = READ_ONCE(sk->sk_rx_dst);
1584

E
Eric Dumazet 已提交
1585
			if (dst)
E
Eric Dumazet 已提交
1586
				dst = dst_check(dst, inet6_sk(sk)->rx_dst_cookie);
E
Eric Dumazet 已提交
1587
			if (dst &&
1588
			    inet_sk(sk)->rx_dst_ifindex == skb->skb_iif)
E
Eric Dumazet 已提交
1589 1590 1591 1592 1593
				skb_dst_set_noref(skb, dst);
		}
	}
}

1594 1595 1596
static struct timewait_sock_ops tcp6_timewait_sock_ops = {
	.twsk_obj_size	= sizeof(struct tcp6_timewait_sock),
	.twsk_unique	= tcp_twsk_unique,
W
Wang Yufen 已提交
1597
	.twsk_destructor = tcp_twsk_destructor,
1598 1599
};

1600
static const struct inet_connection_sock_af_ops ipv6_specific = {
1601 1602 1603
	.queue_xmit	   = inet6_csk_xmit,
	.send_check	   = tcp_v6_send_check,
	.rebuild_header	   = inet6_sk_rebuild_header,
E
Eric Dumazet 已提交
1604
	.sk_rx_dst_set	   = inet6_sk_rx_dst_set,
1605 1606 1607
	.conn_request	   = tcp_v6_conn_request,
	.syn_recv_sock	   = tcp_v6_syn_recv_sock,
	.net_header_len	   = sizeof(struct ipv6hdr),
1608
	.net_frag_header_len = sizeof(struct frag_hdr),
1609 1610 1611 1612
	.setsockopt	   = ipv6_setsockopt,
	.getsockopt	   = ipv6_getsockopt,
	.addr2sockaddr	   = inet6_csk_addr2sockaddr,
	.sockaddr_len	   = sizeof(struct sockaddr_in6),
1613
	.bind_conflict	   = inet6_csk_bind_conflict,
1614
#ifdef CONFIG_COMPAT
1615 1616
	.compat_setsockopt = compat_ipv6_setsockopt,
	.compat_getsockopt = compat_ipv6_getsockopt,
1617
#endif
1618
	.mtu_reduced	   = tcp_v6_mtu_reduced,
L
Linus Torvalds 已提交
1619 1620
};

1621
#ifdef CONFIG_TCP_MD5SIG
1622
static const struct tcp_sock_af_ops tcp_sock_ipv6_specific = {
1623
	.md5_lookup	=	tcp_v6_md5_lookup,
1624
	.calc_md5_hash	=	tcp_v6_md5_hash_skb,
1625 1626
	.md5_parse	=	tcp_v6_parse_md5_keys,
};
1627
#endif
1628

L
Linus Torvalds 已提交
1629 1630 1631
/*
 *	TCP over IPv4 via INET6 API
 */
1632
static const struct inet_connection_sock_af_ops ipv6_mapped = {
1633 1634 1635
	.queue_xmit	   = ip_queue_xmit,
	.send_check	   = tcp_v4_send_check,
	.rebuild_header	   = inet_sk_rebuild_header,
1636
	.sk_rx_dst_set	   = inet_sk_rx_dst_set,
1637 1638 1639 1640 1641 1642 1643
	.conn_request	   = tcp_v6_conn_request,
	.syn_recv_sock	   = tcp_v6_syn_recv_sock,
	.net_header_len	   = sizeof(struct iphdr),
	.setsockopt	   = ipv6_setsockopt,
	.getsockopt	   = ipv6_getsockopt,
	.addr2sockaddr	   = inet6_csk_addr2sockaddr,
	.sockaddr_len	   = sizeof(struct sockaddr_in6),
1644
	.bind_conflict	   = inet6_csk_bind_conflict,
1645
#ifdef CONFIG_COMPAT
1646 1647
	.compat_setsockopt = compat_ipv6_setsockopt,
	.compat_getsockopt = compat_ipv6_getsockopt,
1648
#endif
1649
	.mtu_reduced	   = tcp_v4_mtu_reduced,
L
Linus Torvalds 已提交
1650 1651
};

1652
#ifdef CONFIG_TCP_MD5SIG
1653
static const struct tcp_sock_af_ops tcp_sock_ipv6_mapped_specific = {
1654
	.md5_lookup	=	tcp_v4_md5_lookup,
1655
	.calc_md5_hash	=	tcp_v4_md5_hash_skb,
1656 1657
	.md5_parse	=	tcp_v6_parse_md5_keys,
};
1658
#endif
1659

L
Linus Torvalds 已提交
1660 1661 1662 1663 1664
/* NOTE: A lot of things set to zero explicitly by call to
 *       sk_alloc() so need not be done here.
 */
static int tcp_v6_init_sock(struct sock *sk)
{
1665
	struct inet_connection_sock *icsk = inet_csk(sk);
L
Linus Torvalds 已提交
1666

1667
	tcp_init_sock(sk);
L
Linus Torvalds 已提交
1668

1669
	icsk->icsk_af_ops = &ipv6_specific;
L
Linus Torvalds 已提交
1670

1671
#ifdef CONFIG_TCP_MD5SIG
1672
	tcp_sk(sk)->af_specific = &tcp_sock_ipv6_specific;
1673 1674
#endif

L
Linus Torvalds 已提交
1675 1676 1677
	return 0;
}

1678
static void tcp_v6_destroy_sock(struct sock *sk)
L
Linus Torvalds 已提交
1679 1680
{
	tcp_v4_destroy_sock(sk);
1681
	inet6_destroy_sock(sk);
L
Linus Torvalds 已提交
1682 1683
}

1684
#ifdef CONFIG_PROC_FS
L
Linus Torvalds 已提交
1685
/* Proc filesystem TCPv6 sock list dumping. */
1686
static void get_openreq6(struct seq_file *seq,
E
Eric Dumazet 已提交
1687
			 const struct request_sock *req, int i)
L
Linus Torvalds 已提交
1688
{
1689
	long ttd = req->rsk_timer.expires - jiffies;
1690 1691
	const struct in6_addr *src = &inet_rsk(req)->ir_v6_loc_addr;
	const struct in6_addr *dest = &inet_rsk(req)->ir_v6_rmt_addr;
L
Linus Torvalds 已提交
1692 1693 1694 1695 1696 1697

	if (ttd < 0)
		ttd = 0;

	seq_printf(seq,
		   "%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
1698
		   "%02X %08X:%08X %02X:%08lX %08X %5u %8d %d %d %pK\n",
L
Linus Torvalds 已提交
1699 1700 1701
		   i,
		   src->s6_addr32[0], src->s6_addr32[1],
		   src->s6_addr32[2], src->s6_addr32[3],
E
Eric Dumazet 已提交
1702
		   inet_rsk(req)->ir_num,
L
Linus Torvalds 已提交
1703 1704
		   dest->s6_addr32[0], dest->s6_addr32[1],
		   dest->s6_addr32[2], dest->s6_addr32[3],
1705
		   ntohs(inet_rsk(req)->ir_rmt_port),
L
Linus Torvalds 已提交
1706
		   TCP_SYN_RECV,
W
Weilong Chen 已提交
1707
		   0, 0, /* could print option size, but that is af dependent. */
1708 1709
		   1,   /* timers active (only the expire timer) */
		   jiffies_to_clock_t(ttd),
1710
		   req->num_timeout,
E
Eric Dumazet 已提交
1711 1712
		   from_kuid_munged(seq_user_ns(seq),
				    sock_i_uid(req->rsk_listener)),
1713
		   0,  /* non standard timer */
L
Linus Torvalds 已提交
1714 1715 1716 1717 1718 1719
		   0, /* open_requests have no inode */
		   0, req);
}

static void get_tcp6_sock(struct seq_file *seq, struct sock *sp, int i)
{
1720
	const struct in6_addr *dest, *src;
L
Linus Torvalds 已提交
1721 1722 1723
	__u16 destp, srcp;
	int timer_active;
	unsigned long timer_expires;
1724 1725
	const struct inet_sock *inet = inet_sk(sp);
	const struct tcp_sock *tp = tcp_sk(sp);
1726
	const struct inet_connection_sock *icsk = inet_csk(sp);
1727
	const struct fastopen_queue *fastopenq = &icsk->icsk_accept_queue.fastopenq;
1728 1729
	int rx_queue;
	int state;
L
Linus Torvalds 已提交
1730

1731 1732
	dest  = &sp->sk_v6_daddr;
	src   = &sp->sk_v6_rcv_saddr;
E
Eric Dumazet 已提交
1733 1734
	destp = ntohs(inet->inet_dport);
	srcp  = ntohs(inet->inet_sport);
1735

1736 1737 1738
	if (icsk->icsk_pending == ICSK_TIME_RETRANS ||
	    icsk->icsk_pending == ICSK_TIME_EARLY_RETRANS ||
	    icsk->icsk_pending == ICSK_TIME_LOSS_PROBE) {
L
Linus Torvalds 已提交
1739
		timer_active	= 1;
1740 1741
		timer_expires	= icsk->icsk_timeout;
	} else if (icsk->icsk_pending == ICSK_TIME_PROBE0) {
L
Linus Torvalds 已提交
1742
		timer_active	= 4;
1743
		timer_expires	= icsk->icsk_timeout;
L
Linus Torvalds 已提交
1744 1745 1746 1747 1748 1749 1750 1751
	} else if (timer_pending(&sp->sk_timer)) {
		timer_active	= 2;
		timer_expires	= sp->sk_timer.expires;
	} else {
		timer_active	= 0;
		timer_expires = jiffies;
	}

1752 1753 1754 1755 1756 1757 1758 1759 1760
	state = sk_state_load(sp);
	if (state == TCP_LISTEN)
		rx_queue = sp->sk_ack_backlog;
	else
		/* Because we don't lock the socket,
		 * we might find a transient negative value.
		 */
		rx_queue = max_t(int, tp->rcv_nxt - tp->copied_seq, 0);

L
Linus Torvalds 已提交
1761 1762
	seq_printf(seq,
		   "%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
1763
		   "%02X %08X:%08X %02X:%08lX %08X %5u %8d %lu %d %pK %lu %lu %u %u %d\n",
L
Linus Torvalds 已提交
1764 1765 1766 1767 1768
		   i,
		   src->s6_addr32[0], src->s6_addr32[1],
		   src->s6_addr32[2], src->s6_addr32[3], srcp,
		   dest->s6_addr32[0], dest->s6_addr32[1],
		   dest->s6_addr32[2], dest->s6_addr32[3], destp,
1769 1770 1771
		   state,
		   tp->write_seq - tp->snd_una,
		   rx_queue,
L
Linus Torvalds 已提交
1772
		   timer_active,
1773
		   jiffies_delta_to_clock_t(timer_expires - jiffies),
1774
		   icsk->icsk_retransmits,
1775
		   from_kuid_munged(seq_user_ns(seq), sock_i_uid(sp)),
1776
		   icsk->icsk_probes_out,
L
Linus Torvalds 已提交
1777 1778
		   sock_i_ino(sp),
		   atomic_read(&sp->sk_refcnt), sp,
1779 1780
		   jiffies_to_clock_t(icsk->icsk_rto),
		   jiffies_to_clock_t(icsk->icsk_ack.ato),
W
Weilong Chen 已提交
1781
		   (icsk->icsk_ack.quick << 1) | icsk->icsk_ack.pingpong,
I
Ilpo Järvinen 已提交
1782
		   tp->snd_cwnd,
1783
		   state == TCP_LISTEN ?
1784
			fastopenq->max_qlen :
1785
			(tcp_in_initial_slowstart(tp) ? -1 : tp->snd_ssthresh)
L
Linus Torvalds 已提交
1786 1787 1788
		   );
}

1789
static void get_timewait6_sock(struct seq_file *seq,
1790
			       struct inet_timewait_sock *tw, int i)
L
Linus Torvalds 已提交
1791
{
1792
	long delta = tw->tw_timer.expires - jiffies;
1793
	const struct in6_addr *dest, *src;
L
Linus Torvalds 已提交
1794 1795
	__u16 destp, srcp;

1796 1797
	dest = &tw->tw_v6_daddr;
	src  = &tw->tw_v6_rcv_saddr;
L
Linus Torvalds 已提交
1798 1799 1800 1801 1802
	destp = ntohs(tw->tw_dport);
	srcp  = ntohs(tw->tw_sport);

	seq_printf(seq,
		   "%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
D
Dan Rosenberg 已提交
1803
		   "%02X %08X:%08X %02X:%08lX %08X %5d %8d %d %d %pK\n",
L
Linus Torvalds 已提交
1804 1805 1806 1807 1808 1809
		   i,
		   src->s6_addr32[0], src->s6_addr32[1],
		   src->s6_addr32[2], src->s6_addr32[3], srcp,
		   dest->s6_addr32[0], dest->s6_addr32[1],
		   dest->s6_addr32[2], dest->s6_addr32[3], destp,
		   tw->tw_substate, 0, 0,
1810
		   3, jiffies_delta_to_clock_t(delta), 0, 0, 0, 0,
L
Linus Torvalds 已提交
1811 1812 1813 1814 1815 1816
		   atomic_read(&tw->tw_refcnt), tw);
}

static int tcp6_seq_show(struct seq_file *seq, void *v)
{
	struct tcp_iter_state *st;
E
Eric Dumazet 已提交
1817
	struct sock *sk = v;
L
Linus Torvalds 已提交
1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829

	if (v == SEQ_START_TOKEN) {
		seq_puts(seq,
			 "  sl  "
			 "local_address                         "
			 "remote_address                        "
			 "st tx_queue rx_queue tr tm->when retrnsmt"
			 "   uid  timeout inode\n");
		goto out;
	}
	st = seq->private;

1830 1831 1832
	if (sk->sk_state == TCP_TIME_WAIT)
		get_timewait6_sock(seq, v, st->num);
	else if (sk->sk_state == TCP_NEW_SYN_RECV)
E
Eric Dumazet 已提交
1833
		get_openreq6(seq, v, st->num);
1834 1835
	else
		get_tcp6_sock(seq, v, st->num);
L
Linus Torvalds 已提交
1836 1837 1838 1839
out:
	return 0;
}

1840 1841 1842 1843 1844 1845 1846 1847
static const struct file_operations tcp6_afinfo_seq_fops = {
	.owner   = THIS_MODULE,
	.open    = tcp_seq_open,
	.read    = seq_read,
	.llseek  = seq_lseek,
	.release = seq_release_net
};

L
Linus Torvalds 已提交
1848 1849 1850
static struct tcp_seq_afinfo tcp6_seq_afinfo = {
	.name		= "tcp6",
	.family		= AF_INET6,
1851
	.seq_fops	= &tcp6_afinfo_seq_fops,
1852 1853 1854
	.seq_ops	= {
		.show		= tcp6_seq_show,
	},
L
Linus Torvalds 已提交
1855 1856
};

1857
int __net_init tcp6_proc_init(struct net *net)
L
Linus Torvalds 已提交
1858
{
1859
	return tcp_proc_register(net, &tcp6_seq_afinfo);
L
Linus Torvalds 已提交
1860 1861
}

1862
void tcp6_proc_exit(struct net *net)
L
Linus Torvalds 已提交
1863
{
1864
	tcp_proc_unregister(net, &tcp6_seq_afinfo);
L
Linus Torvalds 已提交
1865 1866 1867 1868 1869 1870 1871 1872 1873
}
#endif

struct proto tcpv6_prot = {
	.name			= "TCPv6",
	.owner			= THIS_MODULE,
	.close			= tcp_close,
	.connect		= tcp_v6_connect,
	.disconnect		= tcp_disconnect,
1874
	.accept			= inet_csk_accept,
L
Linus Torvalds 已提交
1875 1876 1877 1878 1879 1880 1881
	.ioctl			= tcp_ioctl,
	.init			= tcp_v6_init_sock,
	.destroy		= tcp_v6_destroy_sock,
	.shutdown		= tcp_shutdown,
	.setsockopt		= tcp_setsockopt,
	.getsockopt		= tcp_getsockopt,
	.recvmsg		= tcp_recvmsg,
1882 1883
	.sendmsg		= tcp_sendmsg,
	.sendpage		= tcp_sendpage,
L
Linus Torvalds 已提交
1884
	.backlog_rcv		= tcp_v6_do_rcv,
E
Eric Dumazet 已提交
1885
	.release_cb		= tcp_release_cb,
1886
	.hash			= inet6_hash,
1887 1888
	.unhash			= inet_unhash,
	.get_port		= inet_csk_get_port,
L
Linus Torvalds 已提交
1889
	.enter_memory_pressure	= tcp_enter_memory_pressure,
1890
	.stream_memory_free	= tcp_stream_memory_free,
L
Linus Torvalds 已提交
1891 1892 1893
	.sockets_allocated	= &tcp_sockets_allocated,
	.memory_allocated	= &tcp_memory_allocated,
	.memory_pressure	= &tcp_memory_pressure,
1894
	.orphan_count		= &tcp_orphan_count,
1895
	.sysctl_mem		= sysctl_tcp_mem,
L
Linus Torvalds 已提交
1896 1897 1898 1899
	.sysctl_wmem		= sysctl_tcp_wmem,
	.sysctl_rmem		= sysctl_tcp_rmem,
	.max_header		= MAX_TCP_HEADER,
	.obj_size		= sizeof(struct tcp6_sock),
1900
	.slab_flags		= SLAB_DESTROY_BY_RCU,
1901
	.twsk_prot		= &tcp6_timewait_sock_ops,
1902
	.rsk_prot		= &tcp6_request_sock_ops,
1903
	.h.hashinfo		= &tcp_hashinfo,
1904
	.no_autobind		= true,
1905 1906 1907
#ifdef CONFIG_COMPAT
	.compat_setsockopt	= compat_tcp_setsockopt,
	.compat_getsockopt	= compat_tcp_getsockopt,
G
Glauber Costa 已提交
1908
#endif
1909
	.diag_destroy		= tcp_abort,
L
Linus Torvalds 已提交
1910 1911
};

1912
static const struct inet6_protocol tcpv6_protocol = {
E
Eric Dumazet 已提交
1913
	.early_demux	=	tcp_v6_early_demux,
L
Linus Torvalds 已提交
1914 1915 1916 1917 1918 1919 1920 1921 1922 1923
	.handler	=	tcp_v6_rcv,
	.err_handler	=	tcp_v6_err,
	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
};

static struct inet_protosw tcpv6_protosw = {
	.type		=	SOCK_STREAM,
	.protocol	=	IPPROTO_TCP,
	.prot		=	&tcpv6_prot,
	.ops		=	&inet6_stream_ops,
1924 1925
	.flags		=	INET_PROTOSW_PERMANENT |
				INET_PROTOSW_ICSK,
L
Linus Torvalds 已提交
1926 1927
};

1928
static int __net_init tcpv6_net_init(struct net *net)
1929
{
1930 1931
	return inet_ctl_sock_create(&net->ipv6.tcp_sk, PF_INET6,
				    SOCK_RAW, IPPROTO_TCP, net);
1932 1933
}

1934
static void __net_exit tcpv6_net_exit(struct net *net)
1935
{
1936
	inet_ctl_sock_destroy(net->ipv6.tcp_sk);
E
Eric W. Biederman 已提交
1937 1938
}

1939
static void __net_exit tcpv6_net_exit_batch(struct list_head *net_exit_list)
E
Eric W. Biederman 已提交
1940 1941
{
	inet_twsk_purge(&tcp_hashinfo, &tcp_death_row, AF_INET6);
1942 1943 1944
}

static struct pernet_operations tcpv6_net_ops = {
E
Eric W. Biederman 已提交
1945 1946 1947
	.init	    = tcpv6_net_init,
	.exit	    = tcpv6_net_exit,
	.exit_batch = tcpv6_net_exit_batch,
1948 1949
};

1950
int __init tcpv6_init(void)
L
Linus Torvalds 已提交
1951
{
1952 1953
	int ret;

1954 1955
	ret = inet6_add_protocol(&tcpv6_protocol, IPPROTO_TCP);
	if (ret)
1956
		goto out;
1957

L
Linus Torvalds 已提交
1958
	/* register inet6 protocol */
1959 1960 1961 1962
	ret = inet6_register_protosw(&tcpv6_protosw);
	if (ret)
		goto out_tcpv6_protocol;

1963
	ret = register_pernet_subsys(&tcpv6_net_ops);
1964 1965 1966 1967
	if (ret)
		goto out_tcpv6_protosw;
out:
	return ret;
1968

1969 1970
out_tcpv6_protosw:
	inet6_unregister_protosw(&tcpv6_protosw);
1971 1972
out_tcpv6_protocol:
	inet6_del_protocol(&tcpv6_protocol, IPPROTO_TCP);
1973 1974 1975
	goto out;
}

1976
void tcpv6_exit(void)
1977
{
1978
	unregister_pernet_subsys(&tcpv6_net_ops);
1979 1980
	inet6_unregister_protosw(&tcpv6_protosw);
	inet6_del_protocol(&tcpv6_protocol, IPPROTO_TCP);
L
Linus Torvalds 已提交
1981
}