tcp_ipv6.c 51.7 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
#include <trace/events/tcp.h>

74 75
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,
76
				      struct request_sock *req);
L
Linus Torvalds 已提交
77 78 79

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

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

93 94 95 96
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 已提交
97
	if (dst && dst_hold_safe(dst)) {
98 99 100 101
		const struct rt6_info *rt = (const struct rt6_info *)dst;

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

106
static u32 tcp_v6_init_seq(const struct sk_buff *skb)
L
Linus Torvalds 已提交
107
{
108 109 110 111 112 113
	return secure_tcpv6_seq(ipv6_hdr(skb)->daddr.s6_addr32,
				ipv6_hdr(skb)->saddr.s6_addr32,
				tcp_hdr(skb)->dest,
				tcp_hdr(skb)->source);
}

114
static u32 tcp_v6_init_ts_off(const struct net *net, const struct sk_buff *skb)
115
{
116
	return secure_tcpv6_ts_off(net, ipv6_hdr(skb)->daddr.s6_addr32,
117
				   ipv6_hdr(skb)->saddr.s6_addr32);
L
Linus Torvalds 已提交
118 119
}

120
static int tcp_v6_connect(struct sock *sk, struct sockaddr *uaddr,
L
Linus Torvalds 已提交
121 122 123
			  int addr_len)
{
	struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr;
124
	struct inet_sock *inet = inet_sk(sk);
125
	struct inet_connection_sock *icsk = inet_csk(sk);
L
Linus Torvalds 已提交
126 127
	struct ipv6_pinfo *np = inet6_sk(sk);
	struct tcp_sock *tp = tcp_sk(sk);
128
	struct in6_addr *saddr = NULL, *final_p, final;
129
	struct ipv6_txoptions *opt;
130
	struct flowi6 fl6;
L
Linus Torvalds 已提交
131 132 133
	struct dst_entry *dst;
	int addr_type;
	int err;
134
	struct inet_timewait_death_row *tcp_death_row = &sock_net(sk)->ipv4.tcp_death_row;
L
Linus Torvalds 已提交
135

136
	if (addr_len < SIN6_LEN_RFC2133)
L
Linus Torvalds 已提交
137 138
		return -EINVAL;

139
	if (usin->sin6_family != AF_INET6)
E
Eric Dumazet 已提交
140
		return -EAFNOSUPPORT;
L
Linus Torvalds 已提交
141

142
	memset(&fl6, 0, sizeof(fl6));
L
Linus Torvalds 已提交
143 144

	if (np->sndflow) {
145 146 147
		fl6.flowlabel = usin->sin6_flowinfo&IPV6_FLOWINFO_MASK;
		IP6_ECN_flow_init(fl6.flowlabel);
		if (fl6.flowlabel&IPV6_FLOWLABEL_MASK) {
L
Linus Torvalds 已提交
148
			struct ip6_flowlabel *flowlabel;
149
			flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
150
			if (!flowlabel)
L
Linus Torvalds 已提交
151 152 153 154 155 156
				return -EINVAL;
			fl6_sock_release(flowlabel);
		}
	}

	/*
157 158 159
	 *	connect() to INADDR_ANY means loopback (BSD'ism).
	 */

160 161 162 163 164 165 166
	if (ipv6_addr_any(&usin->sin6_addr)) {
		if (ipv6_addr_v4mapped(&sk->sk_v6_rcv_saddr))
			ipv6_addr_set_v4mapped(htonl(INADDR_LOOPBACK),
					       &usin->sin6_addr);
		else
			usin->sin6_addr = in6addr_loopback;
	}
L
Linus Torvalds 已提交
167 168 169

	addr_type = ipv6_addr_type(&usin->sin6_addr);

W
Weilong Chen 已提交
170
	if (addr_type & IPV6_ADDR_MULTICAST)
L
Linus Torvalds 已提交
171 172 173 174 175 176 177 178
		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.
			 */
179
			if (!sk_dev_equal_l3scope(sk, usin->sin6_scope_id))
L
Linus Torvalds 已提交
180 181 182 183 184 185 186 187 188 189 190
				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 &&
191
	    !ipv6_addr_equal(&sk->sk_v6_daddr, &usin->sin6_addr)) {
L
Linus Torvalds 已提交
192 193 194 195 196
		tp->rx_opt.ts_recent = 0;
		tp->rx_opt.ts_recent_stamp = 0;
		tp->write_seq = 0;
	}

197
	sk->sk_v6_daddr = usin->sin6_addr;
198
	np->flow_label = fl6.flowlabel;
L
Linus Torvalds 已提交
199 200 201 202 203

	/*
	 *	TCP over IPv4
	 */

204
	if (addr_type & IPV6_ADDR_MAPPED) {
205
		u32 exthdrlen = icsk->icsk_ext_hdr_len;
L
Linus Torvalds 已提交
206 207 208 209 210 211 212 213 214 215 216
		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];

217
		icsk->icsk_af_ops = &ipv6_mapped;
L
Linus Torvalds 已提交
218
		sk->sk_backlog_rcv = tcp_v4_do_rcv;
219 220 221
#ifdef CONFIG_TCP_MD5SIG
		tp->af_specific = &tcp_sock_ipv6_mapped_specific;
#endif
L
Linus Torvalds 已提交
222 223 224 225

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

		if (err) {
226 227
			icsk->icsk_ext_hdr_len = exthdrlen;
			icsk->icsk_af_ops = &ipv6_specific;
L
Linus Torvalds 已提交
228
			sk->sk_backlog_rcv = tcp_v6_do_rcv;
229 230 231
#ifdef CONFIG_TCP_MD5SIG
			tp->af_specific = &tcp_sock_ipv6_specific;
#endif
L
Linus Torvalds 已提交
232 233
			goto failure;
		}
234
		np->saddr = sk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
235 236 237 238

		return err;
	}

239 240
	if (!ipv6_addr_any(&sk->sk_v6_rcv_saddr))
		saddr = &sk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
241

242
	fl6.flowi6_proto = IPPROTO_TCP;
243
	fl6.daddr = sk->sk_v6_daddr;
A
Alexey Dobriyan 已提交
244
	fl6.saddr = saddr ? *saddr : np->saddr;
245 246
	fl6.flowi6_oif = sk->sk_bound_dev_if;
	fl6.flowi6_mark = sk->sk_mark;
247 248
	fl6.fl6_dport = usin->sin6_port;
	fl6.fl6_sport = inet->inet_sport;
249
	fl6.flowi6_uid = sk->sk_uid;
L
Linus Torvalds 已提交
250

251
	opt = rcu_dereference_protected(np->opt, lockdep_sock_is_held(sk));
252
	final_p = fl6_update_dst(&fl6, opt, &final);
L
Linus Torvalds 已提交
253

254
	security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
V
Venkat Yekkirala 已提交
255

256
	dst = ip6_dst_lookup_flow(sk, &fl6, final_p);
257 258
	if (IS_ERR(dst)) {
		err = PTR_ERR(dst);
L
Linus Torvalds 已提交
259
		goto failure;
260
	}
L
Linus Torvalds 已提交
261

262
	if (!saddr) {
263
		saddr = &fl6.saddr;
264
		sk->sk_v6_rcv_saddr = *saddr;
L
Linus Torvalds 已提交
265 266 267
	}

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

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

274
	icsk->icsk_ext_hdr_len = 0;
275 276 277
	if (opt)
		icsk->icsk_ext_hdr_len = opt->opt_flen +
					 opt->opt_nflen;
L
Linus Torvalds 已提交
278 279 280

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

E
Eric Dumazet 已提交
281
	inet->inet_dport = usin->sin6_port;
L
Linus Torvalds 已提交
282 283

	tcp_set_state(sk, TCP_SYN_SENT);
284
	err = inet6_hash_connect(tcp_death_row, sk);
L
Linus Torvalds 已提交
285 286 287
	if (err)
		goto late_failure;

288
	sk_set_txhash(sk);
289

290 291
	if (likely(!tp->repair)) {
		if (!tp->write_seq)
292 293 294 295
			tp->write_seq = secure_tcpv6_seq(np->saddr.s6_addr32,
							 sk->sk_v6_daddr.s6_addr32,
							 inet->inet_sport,
							 inet->inet_dport);
296 297
		tp->tsoffset = secure_tcpv6_ts_off(sock_net(sk),
						   np->saddr.s6_addr32,
298
						   sk->sk_v6_daddr.s6_addr32);
299
	}
L
Linus Torvalds 已提交
300

W
Wei Wang 已提交
301 302 303 304 305
	if (tcp_fastopen_defer_connect(sk, &err))
		return err;
	if (err)
		goto late_failure;

L
Linus Torvalds 已提交
306 307 308 309 310 311 312 313 314
	err = tcp_connect(sk);
	if (err)
		goto late_failure;

	return 0;

late_failure:
	tcp_set_state(sk, TCP_CLOSE);
failure:
E
Eric Dumazet 已提交
315
	inet->inet_dport = 0;
L
Linus Torvalds 已提交
316 317 318 319
	sk->sk_route_caps = 0;
	return err;
}

320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336
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 已提交
337
static void tcp_v6_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
338
		u8 type, u8 code, int offset, __be32 info)
L
Linus Torvalds 已提交
339
{
W
Weilong Chen 已提交
340
	const struct ipv6hdr *hdr = (const struct ipv6hdr *)skb->data;
341
	const struct tcphdr *th = (struct tcphdr *)(skb->data+offset);
342 343
	struct net *net = dev_net(skb->dev);
	struct request_sock *fastopen;
L
Linus Torvalds 已提交
344
	struct ipv6_pinfo *np;
345
	struct tcp_sock *tp;
346
	__u32 seq, snd_una;
347
	struct sock *sk;
348
	bool fatal;
349
	int err;
L
Linus Torvalds 已提交
350

351 352 353
	sk = __inet6_lookup_established(net, &tcp_hashinfo,
					&hdr->daddr, th->dest,
					&hdr->saddr, ntohs(th->source),
354
					skb->dev->ifindex, inet6_sdif(skb));
L
Linus Torvalds 已提交
355

356
	if (!sk) {
E
Eric Dumazet 已提交
357 358
		__ICMP6_INC_STATS(net, __in6_dev_get(skb->dev),
				  ICMP6_MIB_INERRORS);
L
Linus Torvalds 已提交
359 360 361 362
		return;
	}

	if (sk->sk_state == TCP_TIME_WAIT) {
363
		inet_twsk_put(inet_twsk(sk));
L
Linus Torvalds 已提交
364 365
		return;
	}
366
	seq = ntohl(th->seq);
367
	fatal = icmpv6_err_convert(type, code, &err);
368
	if (sk->sk_state == TCP_NEW_SYN_RECV)
369
		return tcp_req_err(sk, seq, fatal);
L
Linus Torvalds 已提交
370 371

	bh_lock_sock(sk);
372
	if (sock_owned_by_user(sk) && type != ICMPV6_PKT_TOOBIG)
373
		__NET_INC_STATS(net, LINUX_MIB_LOCKDROPPEDICMPS);
L
Linus Torvalds 已提交
374 375 376 377

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

378
	if (ipv6_hdr(skb)->hop_limit < inet6_sk(sk)->min_hopcount) {
379
		__NET_INC_STATS(net, LINUX_MIB_TCPMINTTLDROP);
380 381 382
		goto out;
	}

L
Linus Torvalds 已提交
383
	tp = tcp_sk(sk);
384 385 386
	/* 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 已提交
387
	if (sk->sk_state != TCP_LISTEN &&
388
	    !between(seq, snd_una, tp->snd_nxt)) {
389
		__NET_INC_STATS(net, LINUX_MIB_OUTOFWINDOWICMPS);
L
Linus Torvalds 已提交
390 391 392 393 394
		goto out;
	}

	np = inet6_sk(sk);

395
	if (type == NDISC_REDIRECT) {
396 397
		if (!sock_owned_by_user(sk)) {
			struct dst_entry *dst = __sk_dst_check(sk, np->dst_cookie);
398

399 400 401
			if (dst)
				dst->ops->redirect(dst, sk, skb);
		}
402
		goto out;
403 404
	}

L
Linus Torvalds 已提交
405
	if (type == ICMPV6_PKT_TOOBIG) {
406 407 408 409 410 411 412
		/* 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;

413 414 415
		if (!ip6_sk_accept_pmtu(sk))
			goto out;

416 417 418
		tp->mtu_info = ntohl(info);
		if (!sock_owned_by_user(sk))
			tcp_v6_mtu_reduced(sk);
419
		else if (!test_and_set_bit(TCP_MTU_REDUCED_DEFERRED,
420
					   &sk->sk_tsq_flags))
421
			sock_hold(sk);
L
Linus Torvalds 已提交
422 423 424 425
		goto out;
	}


426
	/* Might be for an request_sock */
L
Linus Torvalds 已提交
427 428
	switch (sk->sk_state) {
	case TCP_SYN_SENT:
429 430 431 432
	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.
		 */
433
		if (fastopen && !fastopen->sk)
434 435
			break;

L
Linus Torvalds 已提交
436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457
		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);
}


458
static int tcp_v6_send_synack(const struct sock *sk, struct dst_entry *dst,
459
			      struct flowi *fl,
460
			      struct request_sock *req,
461
			      struct tcp_fastopen_cookie *foc,
462
			      enum tcp_synack_type synack_type)
L
Linus Torvalds 已提交
463
{
464
	struct inet_request_sock *ireq = inet_rsk(req);
L
Linus Torvalds 已提交
465
	struct ipv6_pinfo *np = inet6_sk(sk);
466
	struct ipv6_txoptions *opt;
467
	struct flowi6 *fl6 = &fl->u.ip6;
W
Weilong Chen 已提交
468
	struct sk_buff *skb;
469
	int err = -ENOMEM;
L
Linus Torvalds 已提交
470

471
	/* First, grab a route. */
472 473
	if (!dst && (dst = inet6_csk_route_req(sk, fl6, req,
					       IPPROTO_TCP)) == NULL)
474
		goto done;
475

476
	skb = tcp_make_synack(sk, dst, req, foc, synack_type);
477

L
Linus Torvalds 已提交
478
	if (skb) {
479 480
		__tcp_v6_send_check(skb, &ireq->ir_v6_loc_addr,
				    &ireq->ir_v6_rmt_addr);
L
Linus Torvalds 已提交
481

482
		fl6->daddr = ireq->ir_v6_rmt_addr;
483
		if (np->repflow && ireq->pktopts)
484 485
			fl6->flowlabel = ip6_flowlabel(ipv6_hdr(ireq->pktopts));

486
		rcu_read_lock();
487 488 489
		opt = ireq->ipv6_opt;
		if (!opt)
			opt = rcu_dereference(np->opt);
490
		err = ip6_xmit(sk, skb, fl6, sk->sk_mark, opt, np->tclass);
491
		rcu_read_unlock();
492
		err = net_xmit_eval(err);
L
Linus Torvalds 已提交
493 494 495 496 497 498
	}

done:
	return err;
}

499

500
static void tcp_v6_reqsk_destructor(struct request_sock *req)
L
Linus Torvalds 已提交
501
{
502
	kfree(inet_rsk(req)->ipv6_opt);
503
	kfree_skb(inet_rsk(req)->pktopts);
L
Linus Torvalds 已提交
504 505
}

506
#ifdef CONFIG_TCP_MD5SIG
507
static struct tcp_md5sig_key *tcp_v6_md5_do_lookup(const struct sock *sk,
508
						   const struct in6_addr *addr)
509
{
E
Eric Dumazet 已提交
510
	return tcp_md5_do_lookup(sk, (union tcp_md5_addr *)addr, AF_INET6);
511 512
}

513
static struct tcp_md5sig_key *tcp_v6_md5_lookup(const struct sock *sk,
514
						const struct sock *addr_sk)
515
{
516
	return tcp_v6_md5_do_lookup(sk, &addr_sk->sk_v6_daddr);
517 518
}

519 520
static int tcp_v6_parse_md5_keys(struct sock *sk, int optname,
				 char __user *optval, int optlen)
521 522 523
{
	struct tcp_md5sig cmd;
	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)&cmd.tcpm_addr;
524
	u8 prefixlen;
525 526 527 528 529 530 531 532 533 534

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

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

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

535 536 537 538 539 540 541 542 543 544
	if (optname == TCP_MD5SIG_EXT &&
	    cmd.tcpm_flags & TCP_MD5SIG_FLAG_PREFIX) {
		prefixlen = cmd.tcpm_prefixlen;
		if (prefixlen > 128 || (ipv6_addr_v4mapped(&sin6->sin6_addr) &&
					prefixlen > 32))
			return -EINVAL;
	} else {
		prefixlen = ipv6_addr_v4mapped(&sin6->sin6_addr) ? 32 : 128;
	}

545
	if (!cmd.tcpm_keylen) {
B
Brian Haley 已提交
546
		if (ipv6_addr_v4mapped(&sin6->sin6_addr))
E
Eric Dumazet 已提交
547
			return tcp_md5_do_del(sk, (union tcp_md5_addr *)&sin6->sin6_addr.s6_addr32[3],
548
					      AF_INET, prefixlen);
E
Eric Dumazet 已提交
549
		return tcp_md5_do_del(sk, (union tcp_md5_addr *)&sin6->sin6_addr,
550
				      AF_INET6, prefixlen);
551 552 553 554 555
	}

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

E
Eric Dumazet 已提交
556 557
	if (ipv6_addr_v4mapped(&sin6->sin6_addr))
		return tcp_md5_do_add(sk, (union tcp_md5_addr *)&sin6->sin6_addr.s6_addr32[3],
558
				      AF_INET, prefixlen, cmd.tcpm_key,
559
				      cmd.tcpm_keylen, GFP_KERNEL);
560

E
Eric Dumazet 已提交
561
	return tcp_md5_do_add(sk, (union tcp_md5_addr *)&sin6->sin6_addr,
562 563
			      AF_INET6, prefixlen, cmd.tcpm_key,
			      cmd.tcpm_keylen, GFP_KERNEL);
564 565
}

566 567 568 569
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)
570 571
{
	struct tcp6_pseudohdr *bp;
572
	struct scatterlist sg;
573
	struct tcphdr *_th;
574

575
	bp = hp->scratch;
576
	/* 1. TCP pseudo-header (RFC2460) */
A
Alexey Dobriyan 已提交
577 578
	bp->saddr = *saddr;
	bp->daddr = *daddr;
579
	bp->protocol = cpu_to_be32(IPPROTO_TCP);
A
Adam Langley 已提交
580
	bp->len = cpu_to_be32(nbytes);
581

582 583 584 585 586 587 588
	_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 已提交
589
	return crypto_ahash_update(hp->md5_req);
590
}
591

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

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

H
Herbert Xu 已提交
604
	if (crypto_ahash_init(req))
605
		goto clear_hash;
606
	if (tcp_v6_md5_hash_headers(hp, daddr, saddr, th, th->doff << 2))
607 608 609
		goto clear_hash;
	if (tcp_md5_hash_key(hp, key))
		goto clear_hash;
H
Herbert Xu 已提交
610 611
	ahash_request_set_crypt(req, NULL, md5_hash, 0);
	if (crypto_ahash_final(req))
612 613 614 615
		goto clear_hash;

	tcp_put_md5sig_pool();
	return 0;
616

617 618 619 620
clear_hash:
	tcp_put_md5sig_pool();
clear_hash_noput:
	memset(md5_hash, 0, 16);
621
	return 1;
622 623
}

624 625
static int tcp_v6_md5_hash_skb(char *md5_hash,
			       const struct tcp_md5sig_key *key,
E
Eric Dumazet 已提交
626 627
			       const struct sock *sk,
			       const struct sk_buff *skb)
628
{
629
	const struct in6_addr *saddr, *daddr;
630
	struct tcp_md5sig_pool *hp;
H
Herbert Xu 已提交
631
	struct ahash_request *req;
E
Eric Dumazet 已提交
632
	const struct tcphdr *th = tcp_hdr(skb);
633

634 635
	if (sk) { /* valid for establish/request sockets */
		saddr = &sk->sk_v6_rcv_saddr;
636
		daddr = &sk->sk_v6_daddr;
637
	} else {
638
		const struct ipv6hdr *ip6h = ipv6_hdr(skb);
639 640
		saddr = &ip6h->saddr;
		daddr = &ip6h->daddr;
641
	}
642 643 644 645

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

H
Herbert Xu 已提交
648
	if (crypto_ahash_init(req))
649 650
		goto clear_hash;

651
	if (tcp_v6_md5_hash_headers(hp, daddr, saddr, th, skb->len))
652 653 654 655 656
		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 已提交
657 658
	ahash_request_set_crypt(req, NULL, md5_hash, 0);
	if (crypto_ahash_final(req))
659 660 661 662 663 664 665 666 667 668
		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;
669 670
}

671 672 673 674
#endif

static bool tcp_v6_inbound_md5_hash(const struct sock *sk,
				    const struct sk_buff *skb)
675
{
676
#ifdef CONFIG_TCP_MD5SIG
677
	const __u8 *hash_location = NULL;
678
	struct tcp_md5sig_key *hash_expected;
679
	const struct ipv6hdr *ip6h = ipv6_hdr(skb);
E
Eric Dumazet 已提交
680
	const struct tcphdr *th = tcp_hdr(skb);
681 682 683 684
	int genhash;
	u8 newhash[16];

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

687 688
	/* We've parsed the options - do we have a hash? */
	if (!hash_expected && !hash_location)
689
		return false;
690 691

	if (hash_expected && !hash_location) {
692
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5NOTFOUND);
693
		return true;
694 695
	}

696
	if (!hash_expected && hash_location) {
697
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5UNEXPECTED);
698
		return true;
699 700 701
	}

	/* check the signature */
702 703
	genhash = tcp_v6_md5_hash_skb(newhash,
				      hash_expected,
704
				      NULL, skb);
705

706
	if (genhash || memcmp(hash_location, newhash, 16) != 0) {
707
		NET_INC_STATS(sock_net(sk), LINUX_MIB_TCPMD5FAILURE);
708 709 710 711
		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));
712
		return true;
713
	}
714
#endif
715
	return false;
716 717
}

718 719
static void tcp_v6_init_req(struct request_sock *req,
			    const struct sock *sk_listener,
720 721 722
			    struct sk_buff *skb)
{
	struct inet_request_sock *ireq = inet_rsk(req);
723
	const struct ipv6_pinfo *np = inet6_sk(sk_listener);
724 725 726 727 728

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

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

733
	if (!TCP_SKB_CB(skb)->tcp_tw_isn &&
734
	    (ipv6_opt_accepted(sk_listener, skb, &TCP_SKB_CB(skb)->header.h6) ||
735
	     np->rxopt.bits.rxinfo ||
736 737
	     np->rxopt.bits.rxoinfo || np->rxopt.bits.rxhlim ||
	     np->rxopt.bits.rxohlim || np->repflow)) {
738
		refcount_inc(&skb->users);
739 740 741 742
		ireq->pktopts = skb;
	}
}

743 744
static struct dst_entry *tcp_v6_route_req(const struct sock *sk,
					  struct flowi *fl,
745
					  const struct request_sock *req)
746
{
747
	return inet6_csk_route_req(sk, &fl->u.ip6, req, IPPROTO_TCP);
748 749
}

750
struct request_sock_ops tcp6_request_sock_ops __read_mostly = {
L
Linus Torvalds 已提交
751
	.family		=	AF_INET6,
752
	.obj_size	=	sizeof(struct tcp6_request_sock),
753
	.rtx_syn_ack	=	tcp_rtx_synack,
754 755
	.send_ack	=	tcp_v6_reqsk_send_ack,
	.destructor	=	tcp_v6_reqsk_destructor,
756
	.send_reset	=	tcp_v6_send_reset,
W
Wang Yufen 已提交
757
	.syn_ack_timeout =	tcp_syn_ack_timeout,
L
Linus Torvalds 已提交
758 759
};

760
static const struct tcp_request_sock_ops tcp_request_sock_ipv6_ops = {
761 762
	.mss_clamp	=	IPV6_MIN_MTU - sizeof(struct tcphdr) -
				sizeof(struct ipv6hdr),
763
#ifdef CONFIG_TCP_MD5SIG
764
	.req_md5_lookup	=	tcp_v6_md5_lookup,
765
	.calc_md5_hash	=	tcp_v6_md5_hash_skb,
766
#endif
767
	.init_req	=	tcp_v6_init_req,
768 769 770
#ifdef CONFIG_SYN_COOKIES
	.cookie_init_seq =	cookie_v6_init_sequence,
#endif
771
	.route_req	=	tcp_v6_route_req,
772 773
	.init_seq	=	tcp_v6_init_seq,
	.init_ts_off	=	tcp_v6_init_ts_off,
774
	.send_synack	=	tcp_v6_send_synack,
775
};
776

777
static void tcp_v6_send_response(const struct sock *sk, struct sk_buff *skb, u32 seq,
778 779
				 u32 ack, u32 win, u32 tsval, u32 tsecr,
				 int oif, struct tcp_md5sig_key *key, int rst,
780
				 u8 tclass, __be32 label)
L
Linus Torvalds 已提交
781
{
782 783
	const struct tcphdr *th = tcp_hdr(skb);
	struct tcphdr *t1;
L
Linus Torvalds 已提交
784
	struct sk_buff *buff;
785
	struct flowi6 fl6;
786
	struct net *net = sk ? sock_net(sk) : dev_net(skb_dst(skb)->dev);
787
	struct sock *ctl_sk = net->ipv6.tcp_sk;
788
	unsigned int tot_len = sizeof(struct tcphdr);
E
Eric Dumazet 已提交
789
	struct dst_entry *dst;
790
	__be32 *topt;
L
Linus Torvalds 已提交
791

792
	if (tsecr)
793
		tot_len += TCPOLEN_TSTAMP_ALIGNED;
794 795 796 797 798 799
#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 已提交
800
			 GFP_ATOMIC);
801
	if (!buff)
802
		return;
L
Linus Torvalds 已提交
803

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

806
	t1 = skb_push(buff, tot_len);
807
	skb_reset_transport_header(buff);
L
Linus Torvalds 已提交
808 809 810 811 812

	/* Swap the send and the receive. */
	memset(t1, 0, sizeof(*t1));
	t1->dest = th->source;
	t1->source = th->dest;
813
	t1->doff = tot_len / 4;
814 815 816 817 818
	t1->seq = htonl(seq);
	t1->ack_seq = htonl(ack);
	t1->ack = !rst || !th->ack;
	t1->rst = rst;
	t1->window = htons(win);
L
Linus Torvalds 已提交
819

820 821
	topt = (__be32 *)(t1 + 1);

822
	if (tsecr) {
823 824
		*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
				(TCPOPT_TIMESTAMP << 8) | TCPOLEN_TIMESTAMP);
825 826
		*topt++ = htonl(tsval);
		*topt++ = htonl(tsecr);
827 828
	}

829 830
#ifdef CONFIG_TCP_MD5SIG
	if (key) {
831 832 833
		*topt++ = htonl((TCPOPT_NOP << 24) | (TCPOPT_NOP << 16) |
				(TCPOPT_MD5SIG << 8) | TCPOLEN_MD5SIG);
		tcp_v6_md5_hash_hdr((__u8 *)topt, key,
834 835
				    &ipv6_hdr(skb)->saddr,
				    &ipv6_hdr(skb)->daddr, t1);
836 837 838
	}
#endif

839
	memset(&fl6, 0, sizeof(fl6));
A
Alexey Dobriyan 已提交
840 841
	fl6.daddr = ipv6_hdr(skb)->saddr;
	fl6.saddr = ipv6_hdr(skb)->daddr;
842
	fl6.flowlabel = label;
L
Linus Torvalds 已提交
843

844 845 846
	buff->ip_summed = CHECKSUM_PARTIAL;
	buff->csum = 0;

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

849
	fl6.flowi6_proto = IPPROTO_TCP;
850
	if (rt6_need_strict(&fl6.daddr) && !oif)
E
Eric Dumazet 已提交
851
		fl6.flowi6_oif = tcp_v6_iif(skb);
852 853 854 855 856 857
	else {
		if (!oif && netif_index_is_l3_master(net, skb->skb_iif))
			oif = skb->skb_iif;

		fl6.flowi6_oif = oif;
	}
858

859
	fl6.flowi6_mark = IP6_REPLY_MARK(net, skb->mark);
860 861
	fl6.fl6_dport = t1->dest;
	fl6.fl6_sport = t1->source;
862
	fl6.flowi6_uid = sock_net_uid(net, sk && sk_fullsock(sk) ? sk : NULL);
863
	security_skb_classify_flow(skb, flowi6_to_flowi(&fl6));
L
Linus Torvalds 已提交
864

865 866 867 868
	/* Pass a socket to ip6_dst_lookup either it is for RST
	 * Underlying function will use this to retrieve the network
	 * namespace
	 */
869
	dst = ip6_dst_lookup_flow(ctl_sk, &fl6, NULL);
870 871
	if (!IS_ERR(dst)) {
		skb_dst_set(buff, dst);
872
		ip6_xmit(ctl_sk, buff, &fl6, fl6.flowi6_mark, NULL, tclass);
873
		TCP_INC_STATS(net, TCP_MIB_OUTSEGS);
874
		if (rst)
875
			TCP_INC_STATS(net, TCP_MIB_OUTRSTS);
876
		return;
L
Linus Torvalds 已提交
877 878 879 880 881
	}

	kfree_skb(buff);
}

882
static void tcp_v6_send_reset(const struct sock *sk, struct sk_buff *skb)
L
Linus Torvalds 已提交
883
{
884
	const struct tcphdr *th = tcp_hdr(skb);
885
	u32 seq = 0, ack_seq = 0;
886
	struct tcp_md5sig_key *key = NULL;
887 888 889 890 891 892 893
#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
894
	int oif = 0;
L
Linus Torvalds 已提交
895

896
	if (th->rst)
L
Linus Torvalds 已提交
897 898
		return;

899 900 901 902
	/* 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))
903
		return;
L
Linus Torvalds 已提交
904

905
#ifdef CONFIG_TCP_MD5SIG
906
	rcu_read_lock();
907
	hash_location = tcp_parse_md5sig_option(th);
908
	if (sk && sk_fullsock(sk)) {
909 910
		key = tcp_v6_md5_do_lookup(sk, &ipv6h->saddr);
	} else if (hash_location) {
911 912 913 914 915 916 917 918
		/*
		 * 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),
919 920
					   &tcp_hashinfo, NULL, 0,
					   &ipv6h->saddr,
921
					   th->source, &ipv6h->daddr,
922 923
					   ntohs(th->source), tcp_v6_iif(skb),
					   tcp_v6_sdif(skb));
924
		if (!sk1)
925
			goto out;
926 927 928

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

931
		genhash = tcp_v6_md5_hash_skb(newhash, key, NULL, skb);
932
		if (genhash || memcmp(hash_location, newhash, 16) != 0)
933
			goto out;
934
	}
935 936
#endif

937 938 939 940 941
	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 已提交
942

943 944 945 946 947
	if (sk) {
		oif = sk->sk_bound_dev_if;
		trace_tcp_send_reset(sk, skb);
	}

948
	tcp_v6_send_response(sk, skb, seq, ack_seq, 0, 0, 0, oif, key, 1, 0, 0);
949 950

#ifdef CONFIG_TCP_MD5SIG
951 952
out:
	rcu_read_unlock();
953
#endif
954
}
L
Linus Torvalds 已提交
955

956
static void tcp_v6_send_ack(const struct sock *sk, struct sk_buff *skb, u32 seq,
957
			    u32 ack, u32 win, u32 tsval, u32 tsecr, int oif,
958
			    struct tcp_md5sig_key *key, u8 tclass,
959
			    __be32 label)
960
{
961 962
	tcp_v6_send_response(sk, skb, seq, ack, win, tsval, tsecr, oif, key, 0,
			     tclass, label);
L
Linus Torvalds 已提交
963 964 965 966
}

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

970
	tcp_v6_send_ack(sk, skb, tcptw->tw_snd_nxt, tcptw->tw_rcv_nxt,
971
			tcptw->tw_rcv_wnd >> tw->tw_rcv_wscale,
972
			tcp_time_stamp_raw() + tcptw->tw_ts_offset,
W
Wang Yufen 已提交
973
			tcptw->tw_ts_recent, tw->tw_bound_dev_if, tcp_twsk_md5_key(tcptw),
974
			tw->tw_tclass, cpu_to_be32(tw->tw_flowlabel));
L
Linus Torvalds 已提交
975

976
	inet_twsk_put(tw);
L
Linus Torvalds 已提交
977 978
}

979
static void tcp_v6_reqsk_send_ack(const struct sock *sk, struct sk_buff *skb,
980
				  struct request_sock *req)
L
Linus Torvalds 已提交
981
{
982 983 984
	/* sk->sk_state == TCP_LISTEN -> for regular TCP_SYN_RECV
	 * sk->sk_state == TCP_SYN_RECV -> for Fast Open.
	 */
985 986 987 988 989
	/* 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:
	 */
990
	tcp_v6_send_ack(sk, skb, (sk->sk_state == TCP_LISTEN) ?
991
			tcp_rsk(req)->snt_isn + 1 : tcp_sk(sk)->snd_nxt,
992 993
			tcp_rsk(req)->rcv_nxt,
			req->rsk_rcv_wnd >> inet_rsk(req)->rcv_wscale,
994
			tcp_time_stamp_raw() + tcp_rsk(req)->ts_off,
995
			req->ts_recent, sk->sk_bound_dev_if,
996
			tcp_v6_md5_do_lookup(sk, &ipv6_hdr(skb)->saddr),
997
			0, 0);
L
Linus Torvalds 已提交
998 999 1000
}


1001
static struct sock *tcp_v6_cookie_check(struct sock *sk, struct sk_buff *skb)
L
Linus Torvalds 已提交
1002
{
1003
#ifdef CONFIG_SYN_COOKIES
1004
	const struct tcphdr *th = tcp_hdr(skb);
L
Linus Torvalds 已提交
1005

1006
	if (!th->syn)
1007
		sk = cookie_v6_check(sk, skb);
L
Linus Torvalds 已提交
1008 1009 1010 1011 1012 1013 1014 1015 1016 1017
#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))
1018
		goto drop;
L
Linus Torvalds 已提交
1019

O
Octavian Purdila 已提交
1020 1021
	return tcp_conn_request(&tcp6_request_sock_ops,
				&tcp_request_sock_ipv6_ops, sk, skb);
L
Linus Torvalds 已提交
1022 1023

drop:
1024
	tcp_listendrop(sk);
L
Linus Torvalds 已提交
1025 1026 1027
	return 0; /* don't send reset */
}

1028 1029 1030 1031 1032 1033 1034 1035 1036 1037
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));
}

1038
static struct sock *tcp_v6_syn_recv_sock(const struct sock *sk, struct sk_buff *skb,
W
Weilong Chen 已提交
1039
					 struct request_sock *req,
1040 1041 1042
					 struct dst_entry *dst,
					 struct request_sock *req_unhash,
					 bool *own_req)
L
Linus Torvalds 已提交
1043
{
1044
	struct inet_request_sock *ireq;
1045 1046
	struct ipv6_pinfo *newnp;
	const struct ipv6_pinfo *np = inet6_sk(sk);
1047
	struct ipv6_txoptions *opt;
L
Linus Torvalds 已提交
1048 1049 1050 1051
	struct tcp6_sock *newtcp6sk;
	struct inet_sock *newinet;
	struct tcp_sock *newtp;
	struct sock *newsk;
1052 1053 1054
#ifdef CONFIG_TCP_MD5SIG
	struct tcp_md5sig_key *key;
#endif
1055
	struct flowi6 fl6;
L
Linus Torvalds 已提交
1056 1057 1058 1059 1060 1061

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

1062 1063
		newsk = tcp_v4_syn_recv_sock(sk, skb, req, dst,
					     req_unhash, own_req);
L
Linus Torvalds 已提交
1064

1065
		if (!newsk)
L
Linus Torvalds 已提交
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
			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));

1077
		newnp->saddr = newsk->sk_v6_rcv_saddr;
L
Linus Torvalds 已提交
1078

1079
		inet_csk(newsk)->icsk_af_ops = &ipv6_mapped;
L
Linus Torvalds 已提交
1080
		newsk->sk_backlog_rcv = tcp_v4_do_rcv;
1081 1082 1083 1084
#ifdef CONFIG_TCP_MD5SIG
		newtp->af_specific = &tcp_sock_ipv6_mapped_specific;
#endif

1085
		newnp->ipv6_mc_list = NULL;
1086 1087
		newnp->ipv6_ac_list = NULL;
		newnp->ipv6_fl_list = NULL;
L
Linus Torvalds 已提交
1088 1089
		newnp->pktoptions  = NULL;
		newnp->opt	   = NULL;
E
Eric Dumazet 已提交
1090
		newnp->mcast_oif   = tcp_v6_iif(skb);
1091
		newnp->mcast_hops  = ipv6_hdr(skb)->hop_limit;
1092
		newnp->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(skb));
1093 1094
		if (np->repflow)
			newnp->flow_label = ip6_flowlabel(ipv6_hdr(skb));
L
Linus Torvalds 已提交
1095

1096 1097 1098 1099
		/*
		 * 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 已提交
1100 1101 1102
		 */

		/* It is tricky place. Until this moment IPv4 tcp
1103
		   worked with IPv6 icsk.icsk_af_ops.
L
Linus Torvalds 已提交
1104 1105
		   Sync it now.
		 */
1106
		tcp_sync_mss(newsk, inet_csk(newsk)->icsk_pmtu_cookie);
L
Linus Torvalds 已提交
1107 1108 1109 1110

		return newsk;
	}

1111
	ireq = inet_rsk(req);
L
Linus Torvalds 已提交
1112 1113 1114 1115

	if (sk_acceptq_is_full(sk))
		goto out_overflow;

1116
	if (!dst) {
1117
		dst = inet6_csk_route_req(sk, &fl6, req, IPPROTO_TCP);
1118
		if (!dst)
L
Linus Torvalds 已提交
1119
			goto out;
1120
	}
L
Linus Torvalds 已提交
1121 1122

	newsk = tcp_create_openreq_child(sk, req, skb);
1123
	if (!newsk)
1124
		goto out_nonewsk;
L
Linus Torvalds 已提交
1125

1126 1127 1128 1129 1130
	/*
	 * 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 已提交
1131

1132
	newsk->sk_gso_type = SKB_GSO_TCPV6;
E
Eric Dumazet 已提交
1133
	ip6_dst_store(newsk, dst, NULL, NULL);
1134
	inet6_sk_rx_dst_set(newsk, skb);
L
Linus Torvalds 已提交
1135 1136 1137 1138 1139 1140 1141 1142 1143 1144

	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));

1145 1146 1147 1148
	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 已提交
1149

1150
	/* Now IPv6 options...
L
Linus Torvalds 已提交
1151 1152 1153

	   First: no IPv4 options.
	 */
1154
	newinet->inet_opt = NULL;
1155
	newnp->ipv6_mc_list = NULL;
1156
	newnp->ipv6_ac_list = NULL;
1157
	newnp->ipv6_fl_list = NULL;
L
Linus Torvalds 已提交
1158 1159 1160 1161 1162 1163

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

	newnp->pktoptions = NULL;
	newnp->opt	  = NULL;
E
Eric Dumazet 已提交
1164
	newnp->mcast_oif  = tcp_v6_iif(skb);
1165
	newnp->mcast_hops = ipv6_hdr(skb)->hop_limit;
1166
	newnp->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(skb));
1167 1168
	if (np->repflow)
		newnp->flow_label = ip6_flowlabel(ipv6_hdr(skb));
L
Linus Torvalds 已提交
1169 1170 1171 1172 1173 1174 1175

	/* 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.
	 */
1176 1177 1178
	opt = ireq->ipv6_opt;
	if (!opt)
		opt = rcu_dereference(np->opt);
1179 1180 1181 1182
	if (opt) {
		opt = ipv6_dup_options(newsk, opt);
		RCU_INIT_POINTER(newnp->opt, opt);
	}
1183
	inet_csk(newsk)->icsk_ext_hdr_len = 0;
1184 1185 1186
	if (opt)
		inet_csk(newsk)->icsk_ext_hdr_len = opt->opt_nflen +
						    opt->opt_flen;
L
Linus Torvalds 已提交
1187

1188 1189
	tcp_ca_openreq_child(newsk, dst);

L
Linus Torvalds 已提交
1190
	tcp_sync_mss(newsk, dst_mtu(dst));
E
Eric Dumazet 已提交
1191
	newtp->advmss = tcp_mss_clamp(tcp_sk(sk), dst_metric_advmss(dst));
1192

L
Linus Torvalds 已提交
1193 1194
	tcp_initialize_rcv_mss(newsk);

E
Eric Dumazet 已提交
1195 1196
	newinet->inet_daddr = newinet->inet_saddr = LOOPBACK4_IPV6;
	newinet->inet_rcv_saddr = LOOPBACK4_IPV6;
L
Linus Torvalds 已提交
1197

1198 1199
#ifdef CONFIG_TCP_MD5SIG
	/* Copy over the MD5 key from the original socket */
W
Wang Yufen 已提交
1200
	key = tcp_v6_md5_do_lookup(sk, &newsk->sk_v6_daddr);
1201
	if (key) {
1202 1203 1204 1205 1206
		/* 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.
		 */
1207
		tcp_md5_do_add(newsk, (union tcp_md5_addr *)&newsk->sk_v6_daddr,
1208
			       AF_INET6, 128, key->key, key->keylen,
1209
			       sk_gfp_mask(sk, GFP_ATOMIC));
1210 1211 1212
	}
#endif

1213
	if (__inet_inherit_port(sk, newsk) < 0) {
1214 1215
		inet_csk_prepare_forced_close(newsk);
		tcp_done(newsk);
1216 1217
		goto out;
	}
1218
	*own_req = inet_ehash_nolisten(newsk, req_to_sk(req_unhash));
E
Eric Dumazet 已提交
1219
	if (*own_req) {
1220
		tcp_move_syn(newtp, req);
E
Eric Dumazet 已提交
1221 1222 1223 1224

		/* Clone pktoptions received with SYN, if we own the req */
		if (ireq->pktopts) {
			newnp->pktoptions = skb_clone(ireq->pktopts,
1225
						      sk_gfp_mask(sk, GFP_ATOMIC));
E
Eric Dumazet 已提交
1226 1227
			consume_skb(ireq->pktopts);
			ireq->pktopts = NULL;
1228 1229
			if (newnp->pktoptions) {
				tcp_v6_restore_cb(newnp->pktoptions);
E
Eric Dumazet 已提交
1230
				skb_set_owner_r(newnp->pktoptions, newsk);
1231
			}
E
Eric Dumazet 已提交
1232
		}
E
Eric Dumazet 已提交
1233
	}
L
Linus Torvalds 已提交
1234 1235 1236 1237

	return newsk;

out_overflow:
1238
	__NET_INC_STATS(sock_net(sk), LINUX_MIB_LISTENOVERFLOWS);
1239
out_nonewsk:
L
Linus Torvalds 已提交
1240
	dst_release(dst);
1241
out:
1242
	tcp_listendrop(sk);
L
Linus Torvalds 已提交
1243 1244 1245 1246
	return NULL;
}

/* The socket must have it's spinlock held when we get
1247
 * here, unless it is a TCP_LISTEN socket.
L
Linus Torvalds 已提交
1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286
 *
 * 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);

	/*
	 *	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.
1287
					       --ANK (980728)
L
Linus Torvalds 已提交
1288 1289
	 */
	if (np->rxopt.all)
1290
		opt_skb = skb_clone(skb, sk_gfp_mask(sk, GFP_ATOMIC));
L
Linus Torvalds 已提交
1291 1292

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

1295
		sock_rps_save_rxhash(sk, skb);
1296
		sk_mark_napi_id(sk, skb);
E
Eric Dumazet 已提交
1297 1298 1299 1300 1301 1302 1303 1304
		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;
			}
		}

1305
		tcp_rcv_established(sk, skb, tcp_hdr(skb));
L
Linus Torvalds 已提交
1306 1307 1308 1309 1310
		if (opt_skb)
			goto ipv6_pktoptions;
		return 0;
	}

E
Eric Dumazet 已提交
1311
	if (tcp_checksum_complete(skb))
L
Linus Torvalds 已提交
1312 1313
		goto csum_err;

1314
	if (sk->sk_state == TCP_LISTEN) {
1315 1316
		struct sock *nsk = tcp_v6_cookie_check(sk, skb);

L
Linus Torvalds 已提交
1317 1318 1319
		if (!nsk)
			goto discard;

W
Weilong Chen 已提交
1320
		if (nsk != sk) {
L
Linus Torvalds 已提交
1321 1322 1323 1324 1325 1326
			if (tcp_child_process(sk, nsk, skb))
				goto reset;
			if (opt_skb)
				__kfree_skb(opt_skb);
			return 0;
		}
1327
	} else
1328
		sock_rps_save_rxhash(sk, skb);
L
Linus Torvalds 已提交
1329

1330
	if (tcp_rcv_state_process(sk, skb))
L
Linus Torvalds 已提交
1331 1332 1333 1334 1335 1336
		goto reset;
	if (opt_skb)
		goto ipv6_pktoptions;
	return 0;

reset:
1337
	tcp_v6_send_reset(sk, skb);
L
Linus Torvalds 已提交
1338 1339 1340 1341 1342 1343
discard:
	if (opt_skb)
		__kfree_skb(opt_skb);
	kfree_skb(skb);
	return 0;
csum_err:
1344 1345
	TCP_INC_STATS(sock_net(sk), TCP_MIB_CSUMERRORS);
	TCP_INC_STATS(sock_net(sk), TCP_MIB_INERRS);
L
Linus Torvalds 已提交
1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359
	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))) {
1360
		if (np->rxopt.bits.rxinfo || np->rxopt.bits.rxoinfo)
E
Eric Dumazet 已提交
1361
			np->mcast_oif = tcp_v6_iif(opt_skb);
1362
		if (np->rxopt.bits.rxhlim || np->rxopt.bits.rxohlim)
1363
			np->mcast_hops = ipv6_hdr(opt_skb)->hop_limit;
1364
		if (np->rxopt.bits.rxflow || np->rxopt.bits.rxtclass)
1365
			np->rcv_flowinfo = ip6_flowinfo(ipv6_hdr(opt_skb));
1366 1367
		if (np->repflow)
			np->flow_label = ip6_flowlabel(ipv6_hdr(opt_skb));
1368
		if (ipv6_opt_accepted(sk, opt_skb, &TCP_SKB_CB(opt_skb)->header.h6)) {
L
Linus Torvalds 已提交
1369
			skb_set_owner_r(opt_skb, sk);
1370
			tcp_v6_restore_cb(opt_skb);
L
Linus Torvalds 已提交
1371 1372 1373 1374 1375 1376 1377
			opt_skb = xchg(&np->pktoptions, opt_skb);
		} else {
			__kfree_skb(opt_skb);
			opt_skb = xchg(&np->pktoptions, NULL);
		}
	}

1378
	kfree_skb(opt_skb);
L
Linus Torvalds 已提交
1379 1380 1381
	return 0;
}

1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401
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;
1402 1403
	TCP_SKB_CB(skb)->has_rxtstamp =
			skb->tstamp || skb_hwtstamps(skb)->hwtstamp;
1404 1405
}

1406
static int tcp_v6_rcv(struct sk_buff *skb)
L
Linus Torvalds 已提交
1407
{
1408
	int sdif = inet6_sdif(skb);
1409
	const struct tcphdr *th;
1410
	const struct ipv6hdr *hdr;
1411
	bool refcounted;
L
Linus Torvalds 已提交
1412 1413
	struct sock *sk;
	int ret;
1414
	struct net *net = dev_net(skb->dev);
L
Linus Torvalds 已提交
1415 1416 1417 1418 1419 1420 1421

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

	/*
	 *	Count it even if it's bad.
	 */
E
Eric Dumazet 已提交
1422
	__TCP_INC_STATS(net, TCP_MIB_INSEGS);
L
Linus Torvalds 已提交
1423 1424 1425 1426

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

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

1429
	if (unlikely(th->doff < sizeof(struct tcphdr)/4))
L
Linus Torvalds 已提交
1430 1431 1432 1433
		goto bad_packet;
	if (!pskb_may_pull(skb, th->doff*4))
		goto discard_it;

1434
	if (skb_checksum_init(skb, IPPROTO_TCP, ip6_compute_pseudo))
1435
		goto csum_error;
L
Linus Torvalds 已提交
1436

1437
	th = (const struct tcphdr *)skb->data;
1438
	hdr = ipv6_hdr(skb);
L
Linus Torvalds 已提交
1439

1440
lookup:
1441
	sk = __inet6_lookup_skb(&tcp_hashinfo, skb, __tcp_hdrlen(th),
1442
				th->source, th->dest, inet6_iif(skb), sdif,
1443
				&refcounted);
L
Linus Torvalds 已提交
1444 1445 1446 1447 1448 1449 1450
	if (!sk)
		goto no_tcp_socket;

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

1451 1452
	if (sk->sk_state == TCP_NEW_SYN_RECV) {
		struct request_sock *req = inet_reqsk(sk);
1453
		struct sock *nsk;
1454 1455 1456

		sk = req->rsk_listener;
		if (tcp_v6_inbound_md5_hash(sk, skb)) {
1457
			sk_drops_add(sk, skb);
1458 1459 1460
			reqsk_put(req);
			goto discard_it;
		}
1461
		if (unlikely(sk->sk_state != TCP_LISTEN)) {
1462
			inet_csk_reqsk_queue_drop_and_put(sk, req);
1463 1464
			goto lookup;
		}
1465
		sock_hold(sk);
1466
		refcounted = true;
E
Eric Dumazet 已提交
1467
		nsk = NULL;
1468 1469 1470 1471
		if (!tcp_filter(sk, skb)) {
			th = (const struct tcphdr *)skb->data;
			hdr = ipv6_hdr(skb);
			tcp_v6_fill_cb(skb, hdr, th);
E
Eric Dumazet 已提交
1472
			nsk = tcp_check_req(sk, skb, req, false);
1473
		}
1474 1475
		if (!nsk) {
			reqsk_put(req);
1476
			goto discard_and_relse;
1477 1478 1479 1480 1481 1482
		}
		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);
1483
			goto discard_and_relse;
1484
		} else {
1485
			sock_put(sk);
1486 1487 1488
			return 0;
		}
	}
1489
	if (hdr->hop_limit < inet6_sk(sk)->min_hopcount) {
1490
		__NET_INC_STATS(net, LINUX_MIB_TCPMINTTLDROP);
1491 1492 1493
		goto discard_and_relse;
	}

L
Linus Torvalds 已提交
1494 1495 1496
	if (!xfrm6_policy_check(sk, XFRM_POLICY_IN, skb))
		goto discard_and_relse;

1497 1498 1499
	if (tcp_v6_inbound_md5_hash(sk, skb))
		goto discard_and_relse;

1500
	if (tcp_filter(sk, skb))
L
Linus Torvalds 已提交
1501
		goto discard_and_relse;
1502 1503
	th = (const struct tcphdr *)skb->data;
	hdr = ipv6_hdr(skb);
1504
	tcp_v6_fill_cb(skb, hdr, th);
L
Linus Torvalds 已提交
1505 1506 1507

	skb->dev = NULL;

1508 1509 1510 1511 1512 1513 1514
	if (sk->sk_state == TCP_LISTEN) {
		ret = tcp_v6_do_rcv(sk, skb);
		goto put_and_return;
	}

	sk_incoming_cpu_update(sk);

1515
	bh_lock_sock_nested(sk);
1516
	tcp_segs_in(tcp_sk(sk), skb);
L
Linus Torvalds 已提交
1517 1518
	ret = 0;
	if (!sock_owned_by_user(sk)) {
F
Florian Westphal 已提交
1519
		ret = tcp_v6_do_rcv(sk, skb);
E
Eric Dumazet 已提交
1520
	} else if (tcp_add_backlog(sk, skb)) {
Z
Zhu Yi 已提交
1521 1522
		goto discard_and_relse;
	}
L
Linus Torvalds 已提交
1523 1524
	bh_unlock_sock(sk);

1525
put_and_return:
1526 1527
	if (refcounted)
		sock_put(sk);
L
Linus Torvalds 已提交
1528 1529 1530 1531 1532 1533
	return ret ? -1 : 0;

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

1534 1535
	tcp_v6_fill_cb(skb, hdr, th);

E
Eric Dumazet 已提交
1536
	if (tcp_checksum_complete(skb)) {
1537
csum_error:
E
Eric Dumazet 已提交
1538
		__TCP_INC_STATS(net, TCP_MIB_CSUMERRORS);
L
Linus Torvalds 已提交
1539
bad_packet:
E
Eric Dumazet 已提交
1540
		__TCP_INC_STATS(net, TCP_MIB_INERRS);
L
Linus Torvalds 已提交
1541
	} else {
1542
		tcp_v6_send_reset(NULL, skb);
L
Linus Torvalds 已提交
1543 1544 1545 1546 1547 1548 1549
	}

discard_it:
	kfree_skb(skb);
	return 0;

discard_and_relse:
1550
	sk_drops_add(sk, skb);
1551 1552
	if (refcounted)
		sock_put(sk);
L
Linus Torvalds 已提交
1553 1554 1555 1556
	goto discard_it;

do_time_wait:
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb)) {
1557
		inet_twsk_put(inet_twsk(sk));
L
Linus Torvalds 已提交
1558 1559 1560
		goto discard_it;
	}

1561 1562
	tcp_v6_fill_cb(skb, hdr, th);

1563 1564 1565
	if (tcp_checksum_complete(skb)) {
		inet_twsk_put(inet_twsk(sk));
		goto csum_error;
L
Linus Torvalds 已提交
1566 1567
	}

1568
	switch (tcp_timewait_state_process(inet_twsk(sk), skb, th)) {
L
Linus Torvalds 已提交
1569 1570 1571 1572
	case TCP_TW_SYN:
	{
		struct sock *sk2;

1573
		sk2 = inet6_lookup_listener(dev_net(skb->dev), &tcp_hashinfo,
1574
					    skb, __tcp_hdrlen(th),
1575
					    &ipv6_hdr(skb)->saddr, th->source,
1576
					    &ipv6_hdr(skb)->daddr,
1577 1578
					    ntohs(th->dest), tcp_v6_iif(skb),
					    sdif);
1579
		if (sk2) {
1580
			struct inet_timewait_sock *tw = inet_twsk(sk);
1581
			inet_twsk_deschedule_put(tw);
L
Linus Torvalds 已提交
1582
			sk = sk2;
1583
			tcp_v6_restore_cb(skb);
1584
			refcounted = false;
L
Linus Torvalds 已提交
1585 1586 1587
			goto process;
		}
	}
1588 1589
		/* to ACK */
		/* fall through */
L
Linus Torvalds 已提交
1590 1591 1592 1593
	case TCP_TW_ACK:
		tcp_v6_timewait_ack(sk, skb);
		break;
	case TCP_TW_RST:
1594 1595 1596
		tcp_v6_send_reset(sk, skb);
		inet_twsk_deschedule_put(inet_twsk(sk));
		goto discard_it;
W
Wang Yufen 已提交
1597 1598
	case TCP_TW_SUCCESS:
		;
L
Linus Torvalds 已提交
1599 1600 1601 1602
	}
	goto discard_it;
}

E
Eric Dumazet 已提交
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620
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 已提交
1621
	/* Note : We use inet6_iif() here, not tcp_v6_iif() */
E
Eric Dumazet 已提交
1622 1623 1624
	sk = __inet6_lookup_established(dev_net(skb->dev), &tcp_hashinfo,
					&hdr->saddr, th->source,
					&hdr->daddr, ntohs(th->dest),
1625
					inet6_iif(skb), inet6_sdif(skb));
E
Eric Dumazet 已提交
1626 1627 1628
	if (sk) {
		skb->sk = sk;
		skb->destructor = sock_edemux;
1629
		if (sk_fullsock(sk)) {
1630
			struct dst_entry *dst = READ_ONCE(sk->sk_rx_dst);
1631

E
Eric Dumazet 已提交
1632
			if (dst)
E
Eric Dumazet 已提交
1633
				dst = dst_check(dst, inet6_sk(sk)->rx_dst_cookie);
E
Eric Dumazet 已提交
1634
			if (dst &&
1635
			    inet_sk(sk)->rx_dst_ifindex == skb->skb_iif)
E
Eric Dumazet 已提交
1636 1637 1638 1639 1640
				skb_dst_set_noref(skb, dst);
		}
	}
}

1641 1642 1643
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 已提交
1644
	.twsk_destructor = tcp_twsk_destructor,
1645 1646
};

1647
static const struct inet_connection_sock_af_ops ipv6_specific = {
1648 1649 1650
	.queue_xmit	   = inet6_csk_xmit,
	.send_check	   = tcp_v6_send_check,
	.rebuild_header	   = inet6_sk_rebuild_header,
E
Eric Dumazet 已提交
1651
	.sk_rx_dst_set	   = inet6_sk_rx_dst_set,
1652 1653 1654
	.conn_request	   = tcp_v6_conn_request,
	.syn_recv_sock	   = tcp_v6_syn_recv_sock,
	.net_header_len	   = sizeof(struct ipv6hdr),
1655
	.net_frag_header_len = sizeof(struct frag_hdr),
1656 1657 1658 1659
	.setsockopt	   = ipv6_setsockopt,
	.getsockopt	   = ipv6_getsockopt,
	.addr2sockaddr	   = inet6_csk_addr2sockaddr,
	.sockaddr_len	   = sizeof(struct sockaddr_in6),
1660
#ifdef CONFIG_COMPAT
1661 1662
	.compat_setsockopt = compat_ipv6_setsockopt,
	.compat_getsockopt = compat_ipv6_getsockopt,
1663
#endif
1664
	.mtu_reduced	   = tcp_v6_mtu_reduced,
L
Linus Torvalds 已提交
1665 1666
};

1667
#ifdef CONFIG_TCP_MD5SIG
1668
static const struct tcp_sock_af_ops tcp_sock_ipv6_specific = {
1669
	.md5_lookup	=	tcp_v6_md5_lookup,
1670
	.calc_md5_hash	=	tcp_v6_md5_hash_skb,
1671 1672
	.md5_parse	=	tcp_v6_parse_md5_keys,
};
1673
#endif
1674

L
Linus Torvalds 已提交
1675 1676 1677
/*
 *	TCP over IPv4 via INET6 API
 */
1678
static const struct inet_connection_sock_af_ops ipv6_mapped = {
1679 1680 1681
	.queue_xmit	   = ip_queue_xmit,
	.send_check	   = tcp_v4_send_check,
	.rebuild_header	   = inet_sk_rebuild_header,
1682
	.sk_rx_dst_set	   = inet_sk_rx_dst_set,
1683 1684 1685 1686 1687 1688 1689
	.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),
1690
#ifdef CONFIG_COMPAT
1691 1692
	.compat_setsockopt = compat_ipv6_setsockopt,
	.compat_getsockopt = compat_ipv6_getsockopt,
1693
#endif
1694
	.mtu_reduced	   = tcp_v4_mtu_reduced,
L
Linus Torvalds 已提交
1695 1696
};

1697
#ifdef CONFIG_TCP_MD5SIG
1698
static const struct tcp_sock_af_ops tcp_sock_ipv6_mapped_specific = {
1699
	.md5_lookup	=	tcp_v4_md5_lookup,
1700
	.calc_md5_hash	=	tcp_v4_md5_hash_skb,
1701 1702
	.md5_parse	=	tcp_v6_parse_md5_keys,
};
1703
#endif
1704

L
Linus Torvalds 已提交
1705 1706 1707 1708 1709
/* 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)
{
1710
	struct inet_connection_sock *icsk = inet_csk(sk);
L
Linus Torvalds 已提交
1711

1712
	tcp_init_sock(sk);
L
Linus Torvalds 已提交
1713

1714
	icsk->icsk_af_ops = &ipv6_specific;
L
Linus Torvalds 已提交
1715

1716
#ifdef CONFIG_TCP_MD5SIG
1717
	tcp_sk(sk)->af_specific = &tcp_sock_ipv6_specific;
1718 1719
#endif

L
Linus Torvalds 已提交
1720 1721 1722
	return 0;
}

1723
static void tcp_v6_destroy_sock(struct sock *sk)
L
Linus Torvalds 已提交
1724 1725
{
	tcp_v4_destroy_sock(sk);
1726
	inet6_destroy_sock(sk);
L
Linus Torvalds 已提交
1727 1728
}

1729
#ifdef CONFIG_PROC_FS
L
Linus Torvalds 已提交
1730
/* Proc filesystem TCPv6 sock list dumping. */
1731
static void get_openreq6(struct seq_file *seq,
E
Eric Dumazet 已提交
1732
			 const struct request_sock *req, int i)
L
Linus Torvalds 已提交
1733
{
1734
	long ttd = req->rsk_timer.expires - jiffies;
1735 1736
	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 已提交
1737 1738 1739 1740 1741 1742

	if (ttd < 0)
		ttd = 0;

	seq_printf(seq,
		   "%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
1743
		   "%02X %08X:%08X %02X:%08lX %08X %5u %8d %d %d %pK\n",
L
Linus Torvalds 已提交
1744 1745 1746
		   i,
		   src->s6_addr32[0], src->s6_addr32[1],
		   src->s6_addr32[2], src->s6_addr32[3],
E
Eric Dumazet 已提交
1747
		   inet_rsk(req)->ir_num,
L
Linus Torvalds 已提交
1748 1749
		   dest->s6_addr32[0], dest->s6_addr32[1],
		   dest->s6_addr32[2], dest->s6_addr32[3],
1750
		   ntohs(inet_rsk(req)->ir_rmt_port),
L
Linus Torvalds 已提交
1751
		   TCP_SYN_RECV,
W
Weilong Chen 已提交
1752
		   0, 0, /* could print option size, but that is af dependent. */
1753 1754
		   1,   /* timers active (only the expire timer) */
		   jiffies_to_clock_t(ttd),
1755
		   req->num_timeout,
E
Eric Dumazet 已提交
1756 1757
		   from_kuid_munged(seq_user_ns(seq),
				    sock_i_uid(req->rsk_listener)),
1758
		   0,  /* non standard timer */
L
Linus Torvalds 已提交
1759 1760 1761 1762 1763 1764
		   0, /* open_requests have no inode */
		   0, req);
}

static void get_tcp6_sock(struct seq_file *seq, struct sock *sp, int i)
{
1765
	const struct in6_addr *dest, *src;
L
Linus Torvalds 已提交
1766 1767 1768
	__u16 destp, srcp;
	int timer_active;
	unsigned long timer_expires;
1769 1770
	const struct inet_sock *inet = inet_sk(sp);
	const struct tcp_sock *tp = tcp_sk(sp);
1771
	const struct inet_connection_sock *icsk = inet_csk(sp);
1772
	const struct fastopen_queue *fastopenq = &icsk->icsk_accept_queue.fastopenq;
1773 1774
	int rx_queue;
	int state;
L
Linus Torvalds 已提交
1775

1776 1777
	dest  = &sp->sk_v6_daddr;
	src   = &sp->sk_v6_rcv_saddr;
E
Eric Dumazet 已提交
1778 1779
	destp = ntohs(inet->inet_dport);
	srcp  = ntohs(inet->inet_sport);
1780

1781
	if (icsk->icsk_pending == ICSK_TIME_RETRANS ||
1782
	    icsk->icsk_pending == ICSK_TIME_REO_TIMEOUT ||
1783
	    icsk->icsk_pending == ICSK_TIME_LOSS_PROBE) {
L
Linus Torvalds 已提交
1784
		timer_active	= 1;
1785 1786
		timer_expires	= icsk->icsk_timeout;
	} else if (icsk->icsk_pending == ICSK_TIME_PROBE0) {
L
Linus Torvalds 已提交
1787
		timer_active	= 4;
1788
		timer_expires	= icsk->icsk_timeout;
L
Linus Torvalds 已提交
1789 1790 1791 1792 1793 1794 1795 1796
	} else if (timer_pending(&sp->sk_timer)) {
		timer_active	= 2;
		timer_expires	= sp->sk_timer.expires;
	} else {
		timer_active	= 0;
		timer_expires = jiffies;
	}

1797
	state = inet_sk_state_load(sp);
1798 1799 1800 1801 1802 1803 1804 1805
	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 已提交
1806 1807
	seq_printf(seq,
		   "%4d: %08X%08X%08X%08X:%04X %08X%08X%08X%08X:%04X "
1808
		   "%02X %08X:%08X %02X:%08lX %08X %5u %8d %lu %d %pK %lu %lu %u %u %d\n",
L
Linus Torvalds 已提交
1809 1810 1811 1812 1813
		   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,
1814 1815 1816
		   state,
		   tp->write_seq - tp->snd_una,
		   rx_queue,
L
Linus Torvalds 已提交
1817
		   timer_active,
1818
		   jiffies_delta_to_clock_t(timer_expires - jiffies),
1819
		   icsk->icsk_retransmits,
1820
		   from_kuid_munged(seq_user_ns(seq), sock_i_uid(sp)),
1821
		   icsk->icsk_probes_out,
L
Linus Torvalds 已提交
1822
		   sock_i_ino(sp),
1823
		   refcount_read(&sp->sk_refcnt), sp,
1824 1825
		   jiffies_to_clock_t(icsk->icsk_rto),
		   jiffies_to_clock_t(icsk->icsk_ack.ato),
W
Weilong Chen 已提交
1826
		   (icsk->icsk_ack.quick << 1) | icsk->icsk_ack.pingpong,
I
Ilpo Järvinen 已提交
1827
		   tp->snd_cwnd,
1828
		   state == TCP_LISTEN ?
1829
			fastopenq->max_qlen :
1830
			(tcp_in_initial_slowstart(tp) ? -1 : tp->snd_ssthresh)
L
Linus Torvalds 已提交
1831 1832 1833
		   );
}

1834
static void get_timewait6_sock(struct seq_file *seq,
1835
			       struct inet_timewait_sock *tw, int i)
L
Linus Torvalds 已提交
1836
{
1837
	long delta = tw->tw_timer.expires - jiffies;
1838
	const struct in6_addr *dest, *src;
L
Linus Torvalds 已提交
1839 1840
	__u16 destp, srcp;

1841 1842
	dest = &tw->tw_v6_daddr;
	src  = &tw->tw_v6_rcv_saddr;
L
Linus Torvalds 已提交
1843 1844 1845 1846 1847
	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 已提交
1848
		   "%02X %08X:%08X %02X:%08lX %08X %5d %8d %d %d %pK\n",
L
Linus Torvalds 已提交
1849 1850 1851 1852 1853 1854
		   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,
1855
		   3, jiffies_delta_to_clock_t(delta), 0, 0, 0, 0,
1856
		   refcount_read(&tw->tw_refcnt), tw);
L
Linus Torvalds 已提交
1857 1858 1859 1860 1861
}

static int tcp6_seq_show(struct seq_file *seq, void *v)
{
	struct tcp_iter_state *st;
E
Eric Dumazet 已提交
1862
	struct sock *sk = v;
L
Linus Torvalds 已提交
1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874

	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;

1875 1876 1877
	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 已提交
1878
		get_openreq6(seq, v, st->num);
1879 1880
	else
		get_tcp6_sock(seq, v, st->num);
L
Linus Torvalds 已提交
1881 1882 1883 1884
out:
	return 0;
}

1885 1886 1887 1888 1889 1890 1891
static const struct file_operations tcp6_afinfo_seq_fops = {
	.open    = tcp_seq_open,
	.read    = seq_read,
	.llseek  = seq_lseek,
	.release = seq_release_net
};

L
Linus Torvalds 已提交
1892 1893 1894
static struct tcp_seq_afinfo tcp6_seq_afinfo = {
	.name		= "tcp6",
	.family		= AF_INET6,
1895
	.seq_fops	= &tcp6_afinfo_seq_fops,
1896 1897 1898
	.seq_ops	= {
		.show		= tcp6_seq_show,
	},
L
Linus Torvalds 已提交
1899 1900
};

1901
int __net_init tcp6_proc_init(struct net *net)
L
Linus Torvalds 已提交
1902
{
1903
	return tcp_proc_register(net, &tcp6_seq_afinfo);
L
Linus Torvalds 已提交
1904 1905
}

1906
void tcp6_proc_exit(struct net *net)
L
Linus Torvalds 已提交
1907
{
1908
	tcp_proc_unregister(net, &tcp6_seq_afinfo);
L
Linus Torvalds 已提交
1909 1910 1911 1912 1913 1914 1915 1916 1917
}
#endif

struct proto tcpv6_prot = {
	.name			= "TCPv6",
	.owner			= THIS_MODULE,
	.close			= tcp_close,
	.connect		= tcp_v6_connect,
	.disconnect		= tcp_disconnect,
1918
	.accept			= inet_csk_accept,
L
Linus Torvalds 已提交
1919 1920 1921 1922 1923 1924
	.ioctl			= tcp_ioctl,
	.init			= tcp_v6_init_sock,
	.destroy		= tcp_v6_destroy_sock,
	.shutdown		= tcp_shutdown,
	.setsockopt		= tcp_setsockopt,
	.getsockopt		= tcp_getsockopt,
1925
	.keepalive		= tcp_set_keepalive,
L
Linus Torvalds 已提交
1926
	.recvmsg		= tcp_recvmsg,
1927 1928
	.sendmsg		= tcp_sendmsg,
	.sendpage		= tcp_sendpage,
L
Linus Torvalds 已提交
1929
	.backlog_rcv		= tcp_v6_do_rcv,
E
Eric Dumazet 已提交
1930
	.release_cb		= tcp_release_cb,
1931
	.hash			= inet6_hash,
1932 1933
	.unhash			= inet_unhash,
	.get_port		= inet_csk_get_port,
L
Linus Torvalds 已提交
1934
	.enter_memory_pressure	= tcp_enter_memory_pressure,
1935
	.leave_memory_pressure	= tcp_leave_memory_pressure,
1936
	.stream_memory_free	= tcp_stream_memory_free,
L
Linus Torvalds 已提交
1937 1938 1939
	.sockets_allocated	= &tcp_sockets_allocated,
	.memory_allocated	= &tcp_memory_allocated,
	.memory_pressure	= &tcp_memory_pressure,
1940
	.orphan_count		= &tcp_orphan_count,
1941
	.sysctl_mem		= sysctl_tcp_mem,
1942 1943
	.sysctl_wmem_offset	= offsetof(struct net, ipv4.sysctl_tcp_wmem),
	.sysctl_rmem_offset	= offsetof(struct net, ipv4.sysctl_tcp_rmem),
L
Linus Torvalds 已提交
1944 1945
	.max_header		= MAX_TCP_HEADER,
	.obj_size		= sizeof(struct tcp6_sock),
1946
	.slab_flags		= SLAB_TYPESAFE_BY_RCU,
1947
	.twsk_prot		= &tcp6_timewait_sock_ops,
1948
	.rsk_prot		= &tcp6_request_sock_ops,
1949
	.h.hashinfo		= &tcp_hashinfo,
1950
	.no_autobind		= true,
1951 1952 1953
#ifdef CONFIG_COMPAT
	.compat_setsockopt	= compat_tcp_setsockopt,
	.compat_getsockopt	= compat_tcp_getsockopt,
G
Glauber Costa 已提交
1954
#endif
1955
	.diag_destroy		= tcp_abort,
L
Linus Torvalds 已提交
1956 1957
};

1958 1959 1960
/* thinking of making this const? Don't.
 * early_demux can change based on sysctl.
 */
1961
static struct inet6_protocol tcpv6_protocol = {
E
Eric Dumazet 已提交
1962
	.early_demux	=	tcp_v6_early_demux,
1963
	.early_demux_handler =  tcp_v6_early_demux,
L
Linus Torvalds 已提交
1964 1965 1966 1967 1968 1969 1970 1971 1972 1973
	.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,
1974 1975
	.flags		=	INET_PROTOSW_PERMANENT |
				INET_PROTOSW_ICSK,
L
Linus Torvalds 已提交
1976 1977
};

1978
static int __net_init tcpv6_net_init(struct net *net)
1979
{
1980 1981
	return inet_ctl_sock_create(&net->ipv6.tcp_sk, PF_INET6,
				    SOCK_RAW, IPPROTO_TCP, net);
1982 1983
}

1984
static void __net_exit tcpv6_net_exit(struct net *net)
1985
{
1986
	inet_ctl_sock_destroy(net->ipv6.tcp_sk);
E
Eric W. Biederman 已提交
1987 1988
}

1989
static void __net_exit tcpv6_net_exit_batch(struct list_head *net_exit_list)
E
Eric W. Biederman 已提交
1990
{
1991
	inet_twsk_purge(&tcp_hashinfo, AF_INET6);
1992 1993 1994
}

static struct pernet_operations tcpv6_net_ops = {
E
Eric W. Biederman 已提交
1995 1996 1997
	.init	    = tcpv6_net_init,
	.exit	    = tcpv6_net_exit,
	.exit_batch = tcpv6_net_exit_batch,
1998 1999
};

2000
int __init tcpv6_init(void)
L
Linus Torvalds 已提交
2001
{
2002 2003
	int ret;

2004 2005
	ret = inet6_add_protocol(&tcpv6_protocol, IPPROTO_TCP);
	if (ret)
2006
		goto out;
2007

L
Linus Torvalds 已提交
2008
	/* register inet6 protocol */
2009 2010 2011 2012
	ret = inet6_register_protosw(&tcpv6_protosw);
	if (ret)
		goto out_tcpv6_protocol;

2013
	ret = register_pernet_subsys(&tcpv6_net_ops);
2014 2015 2016 2017
	if (ret)
		goto out_tcpv6_protosw;
out:
	return ret;
2018

2019 2020
out_tcpv6_protosw:
	inet6_unregister_protosw(&tcpv6_protosw);
2021 2022
out_tcpv6_protocol:
	inet6_del_protocol(&tcpv6_protocol, IPPROTO_TCP);
2023 2024 2025
	goto out;
}

2026
void tcpv6_exit(void)
2027
{
2028
	unregister_pernet_subsys(&tcpv6_net_ops);
2029 2030
	inet6_unregister_protosw(&tcpv6_protosw);
	inet6_del_protocol(&tcpv6_protocol, IPPROTO_TCP);
L
Linus Torvalds 已提交
2031
}