udp.c 40.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *	UDP 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 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
 *
 *	Based on linux/ipv4/udp.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.
 *      Kazunori MIYAZAWA @USAGI:       change process style to use ip6_append_data
 *      YOSHIFUJI Hideaki @USAGI:	convert /proc/net/udp6 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.
 */

#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/in6.h>
#include <linux/netdevice.h>
#include <linux/if_arp.h>
#include <linux/ipv6.h>
#include <linux/icmpv6.h>
#include <linux/init.h>
35
#include <linux/module.h>
36
#include <linux/skbuff.h>
37
#include <linux/slab.h>
L
Linus Torvalds 已提交
38 39 40 41 42 43 44
#include <asm/uaccess.h>

#include <net/ndisc.h>
#include <net/protocol.h>
#include <net/transp_v6.h>
#include <net/ip6_route.h>
#include <net/raw.h>
45
#include <net/tcp_states.h>
L
Linus Torvalds 已提交
46 47
#include <net/ip6_checksum.h>
#include <net/xfrm.h>
48
#include <net/inet6_hashtables.h>
49
#include <net/busy_poll.h>
50
#include <net/sock_reuseport.h>
L
Linus Torvalds 已提交
51 52 53

#include <linux/proc_fs.h>
#include <linux/seq_file.h>
54
#include <trace/events/skb.h>
55
#include "udp_impl.h"
L
Linus Torvalds 已提交
56

57 58 59 60 61
static u32 udp6_ehashfn(const struct net *net,
			const struct in6_addr *laddr,
			const u16 lport,
			const struct in6_addr *faddr,
			const __be16 fport)
62
{
63 64 65 66 67 68 69 70 71 72 73 74 75
	static u32 udp6_ehash_secret __read_mostly;
	static u32 udp_ipv6_hash_secret __read_mostly;

	u32 lhash, fhash;

	net_get_random_once(&udp6_ehash_secret,
			    sizeof(udp6_ehash_secret));
	net_get_random_once(&udp_ipv6_hash_secret,
			    sizeof(udp_ipv6_hash_secret));

	lhash = (__force u32)laddr->s6_addr32[3];
	fhash = __ipv6_addr_jhash(faddr, udp_ipv6_hash_secret);

76
	return __inet6_ehashfn(lhash, lport, fhash, fport,
77
			       udp_ipv6_hash_secret + net_hash_mix(net));
78 79
}

80 81 82 83 84 85 86 87
/* match_wildcard == true:  IPV6_ADDR_ANY equals to any IPv6 addresses if IPv6
 *                          only, and any IPv4 addresses if not IPv6 only
 * match_wildcard == false: addresses must be exactly the same, i.e.
 *                          IPV6_ADDR_ANY only equals to IPV6_ADDR_ANY,
 *                          and 0.0.0.0 equals to 0.0.0.0 only
 */
int ipv6_rcv_saddr_equal(const struct sock *sk, const struct sock *sk2,
			 bool match_wildcard)
88 89 90
{
	const struct in6_addr *sk2_rcv_saddr6 = inet6_rcv_saddr(sk2);
	int sk2_ipv6only = inet_v6_ipv6only(sk2);
91
	int addr_type = ipv6_addr_type(&sk->sk_v6_rcv_saddr);
92 93 94
	int addr_type2 = sk2_rcv_saddr6 ? ipv6_addr_type(sk2_rcv_saddr6) : IPV6_ADDR_MAPPED;

	/* if both are mapped, treat as IPv4 */
95 96 97 98 99 100 101 102 103 104 105 106
	if (addr_type == IPV6_ADDR_MAPPED && addr_type2 == IPV6_ADDR_MAPPED) {
		if (!sk2_ipv6only) {
			if (sk->sk_rcv_saddr == sk2->sk_rcv_saddr)
				return 1;
			if (!sk->sk_rcv_saddr || !sk2->sk_rcv_saddr)
				return match_wildcard;
		}
		return 0;
	}

	if (addr_type == IPV6_ADDR_ANY && addr_type2 == IPV6_ADDR_ANY)
		return 1;
107

108
	if (addr_type2 == IPV6_ADDR_ANY && match_wildcard &&
109 110 111
	    !(sk2_ipv6only && addr_type == IPV6_ADDR_MAPPED))
		return 1;

112
	if (addr_type == IPV6_ADDR_ANY && match_wildcard &&
113
	    !(ipv6_only_sock(sk) && addr_type2 == IPV6_ADDR_MAPPED))
114 115 116
		return 1;

	if (sk2_rcv_saddr6 &&
117
	    ipv6_addr_equal(&sk->sk_v6_rcv_saddr, sk2_rcv_saddr6))
118 119 120 121 122
		return 1;

	return 0;
}

123 124 125
static u32 udp6_portaddr_hash(const struct net *net,
			      const struct in6_addr *addr6,
			      unsigned int port)
126 127 128 129 130
{
	unsigned int hash, mix = net_hash_mix(net);

	if (ipv6_addr_any(addr6))
		hash = jhash_1word(0, mix);
B
Brian Haley 已提交
131
	else if (ipv6_addr_v4mapped(addr6))
132
		hash = jhash_1word((__force u32)addr6->s6_addr32[3], mix);
133
	else
134
		hash = jhash2((__force u32 *)addr6->s6_addr32, 4, mix);
135 136 137 138

	return hash ^ port;
}

139
int udp_v6_get_port(struct sock *sk, unsigned short snum)
L
Linus Torvalds 已提交
140
{
E
Eric Dumazet 已提交
141 142
	unsigned int hash2_nulladdr =
		udp6_portaddr_hash(sock_net(sk), &in6addr_any, snum);
143
	unsigned int hash2_partial =
144
		udp6_portaddr_hash(sock_net(sk), &sk->sk_v6_rcv_saddr, 0);
E
Eric Dumazet 已提交
145

146
	/* precompute partial secondary hash */
E
Eric Dumazet 已提交
147 148
	udp_sk(sk)->udp_portaddr_hash = hash2_partial;
	return udp_lib_get_port(sk, snum, ipv6_rcv_saddr_equal, hash2_nulladdr);
L
Linus Torvalds 已提交
149 150
}

E
Eric Dumazet 已提交
151 152 153
static void udp_v6_rehash(struct sock *sk)
{
	u16 new_hash = udp6_portaddr_hash(sock_net(sk),
154
					  &sk->sk_v6_rcv_saddr,
E
Eric Dumazet 已提交
155 156 157 158 159
					  inet_sk(sk)->inet_num);

	udp_lib_rehash(sk, new_hash);
}

160 161
static inline int compute_score(struct sock *sk, struct net *net,
				unsigned short hnum,
162 163
				const struct in6_addr *saddr, __be16 sport,
				const struct in6_addr *daddr, __be16 dport,
164 165
				int dif)
{
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
	int score;
	struct inet_sock *inet;

	if (!net_eq(sock_net(sk), net) ||
	    udp_sk(sk)->udp_port_hash != hnum ||
	    sk->sk_family != PF_INET6)
		return -1;

	score = 0;
	inet = inet_sk(sk);

	if (inet->inet_dport) {
		if (inet->inet_dport != sport)
			return -1;
		score++;
	}

	if (!ipv6_addr_any(&sk->sk_v6_rcv_saddr)) {
		if (!ipv6_addr_equal(&sk->sk_v6_rcv_saddr, daddr))
			return -1;
		score++;
	}

	if (!ipv6_addr_any(&sk->sk_v6_daddr)) {
		if (!ipv6_addr_equal(&sk->sk_v6_daddr, saddr))
			return -1;
		score++;
	}

	if (sk->sk_bound_dev_if) {
		if (sk->sk_bound_dev_if != dif)
			return -1;
		score++;
199
	}
200

201 202 203
	if (sk->sk_incoming_cpu == raw_smp_processor_id())
		score++;

204 205 206
	return score;
}

E
Eric Dumazet 已提交
207
static inline int compute_score2(struct sock *sk, struct net *net,
208 209 210
				 const struct in6_addr *saddr, __be16 sport,
				 const struct in6_addr *daddr,
				 unsigned short hnum, int dif)
E
Eric Dumazet 已提交
211
{
212 213
	int score;
	struct inet_sock *inet;
E
Eric Dumazet 已提交
214

215 216 217 218
	if (!net_eq(sock_net(sk), net) ||
	    udp_sk(sk)->udp_port_hash != hnum ||
	    sk->sk_family != PF_INET6)
		return -1;
E
Eric Dumazet 已提交
219

220 221 222 223 224 225 226 227 228 229 230 231 232 233
	if (!ipv6_addr_equal(&sk->sk_v6_rcv_saddr, daddr))
		return -1;

	score = 0;
	inet = inet_sk(sk);

	if (inet->inet_dport) {
		if (inet->inet_dport != sport)
			return -1;
		score++;
	}

	if (!ipv6_addr_any(&sk->sk_v6_daddr)) {
		if (!ipv6_addr_equal(&sk->sk_v6_daddr, saddr))
E
Eric Dumazet 已提交
234
			return -1;
235
		score++;
E
Eric Dumazet 已提交
236
	}
237 238 239 240 241 242 243

	if (sk->sk_bound_dev_if) {
		if (sk->sk_bound_dev_if != dif)
			return -1;
		score++;
	}

244 245 246
	if (sk->sk_incoming_cpu == raw_smp_processor_id())
		score++;

E
Eric Dumazet 已提交
247 248 249 250 251 252 253 254 255 256 257
	return score;
}

/* called with read_rcu_lock() */
static struct sock *udp6_lib_lookup2(struct net *net,
		const struct in6_addr *saddr, __be16 sport,
		const struct in6_addr *daddr, unsigned int hnum, int dif,
		struct udp_hslot *hslot2, unsigned int slot2)
{
	struct sock *sk, *result;
	struct hlist_nulls_node *node;
258 259
	int score, badness, matches = 0, reuseport = 0;
	u32 hash = 0;
E
Eric Dumazet 已提交
260 261 262 263 264 265 266 267 268 269

begin:
	result = NULL;
	badness = -1;
	udp_portaddr_for_each_entry_rcu(sk, node, &hslot2->head) {
		score = compute_score2(sk, net, saddr, sport,
				      daddr, hnum, dif);
		if (score > badness) {
			result = sk;
			badness = score;
270 271
			reuseport = sk->sk_reuseport;
			if (reuseport) {
272
				struct sock *sk2;
273 274
				hash = udp6_ehashfn(net, daddr, hnum,
						    saddr, sport);
275
				sk2 = reuseport_select_sock(sk, hash, NULL, 0);
276 277 278 279
				if (sk2) {
					result = sk2;
					goto found;
				}
280
				matches = 1;
281
			}
282 283
		} else if (score == badness && reuseport) {
			matches++;
284
			if (reciprocal_scale(hash, matches) == 0)
285 286
				result = sk;
			hash = next_pseudo_random32(hash);
E
Eric Dumazet 已提交
287 288 289 290 291 292 293 294 295 296 297
		}
	}
	/*
	 * if the nulls value we got at the end of this lookup is
	 * not the expected one, we must restart lookup.
	 * We probably met an item that was moved to another chain.
	 */
	if (get_nulls_value(node) != slot2)
		goto begin;

	if (result) {
298
found:
E
Eric Dumazet 已提交
299
		if (unlikely(!atomic_inc_not_zero_hint(&result->sk_refcnt, 2)))
E
Eric Dumazet 已提交
300 301 302 303 304 305 306 307 308 309
			result = NULL;
		else if (unlikely(compute_score2(result, net, saddr, sport,
				  daddr, hnum, dif) < badness)) {
			sock_put(result);
			goto begin;
		}
	}
	return result;
}

310
struct sock *__udp6_lib_lookup(struct net *net,
311 312
				      const struct in6_addr *saddr, __be16 sport,
				      const struct in6_addr *daddr, __be16 dport,
313 314
				      int dif, struct udp_table *udptable,
				      struct sk_buff *skb)
L
Linus Torvalds 已提交
315
{
316
	struct sock *sk, *result;
317
	struct hlist_nulls_node *node;
L
Linus Torvalds 已提交
318
	unsigned short hnum = ntohs(dport);
E
Eric Dumazet 已提交
319 320
	unsigned int hash2, slot2, slot = udp_hashfn(net, hnum, udptable->mask);
	struct udp_hslot *hslot2, *hslot = &udptable->hash[slot];
321 322
	int score, badness, matches = 0, reuseport = 0;
	u32 hash = 0;
323

324
	rcu_read_lock();
E
Eric Dumazet 已提交
325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
	if (hslot->count > 10) {
		hash2 = udp6_portaddr_hash(net, daddr, hnum);
		slot2 = hash2 & udptable->mask;
		hslot2 = &udptable->hash2[slot2];
		if (hslot->count < hslot2->count)
			goto begin;

		result = udp6_lib_lookup2(net, saddr, sport,
					  daddr, hnum, dif,
					  hslot2, slot2);
		if (!result) {
			hash2 = udp6_portaddr_hash(net, &in6addr_any, hnum);
			slot2 = hash2 & udptable->mask;
			hslot2 = &udptable->hash2[slot2];
			if (hslot->count < hslot2->count)
				goto begin;

342 343
			result = udp6_lib_lookup2(net, saddr, sport,
						  &in6addr_any, hnum, dif,
E
Eric Dumazet 已提交
344 345 346 347 348
						  hslot2, slot2);
		}
		rcu_read_unlock();
		return result;
	}
349 350 351
begin:
	result = NULL;
	badness = -1;
352
	sk_nulls_for_each_rcu(sk, node, &hslot->head) {
353 354 355 356
		score = compute_score(sk, net, hnum, saddr, sport, daddr, dport, dif);
		if (score > badness) {
			result = sk;
			badness = score;
357 358
			reuseport = sk->sk_reuseport;
			if (reuseport) {
359
				struct sock *sk2;
360 361
				hash = udp6_ehashfn(net, daddr, hnum,
						    saddr, sport);
362 363
				sk2 = reuseport_select_sock(sk, hash, skb,
							sizeof(struct udphdr));
364 365 366 367
				if (sk2) {
					result = sk2;
					goto found;
				}
368 369 370 371
				matches = 1;
			}
		} else if (score == badness && reuseport) {
			matches++;
372
			if (reciprocal_scale(hash, matches) == 0)
373 374
				result = sk;
			hash = next_pseudo_random32(hash);
L
Linus Torvalds 已提交
375 376
		}
	}
377 378 379 380 381
	/*
	 * if the nulls value we got at the end of this lookup is
	 * not the expected one, we must restart lookup.
	 * We probably met an item that was moved to another chain.
	 */
E
Eric Dumazet 已提交
382
	if (get_nulls_value(node) != slot)
383 384
		goto begin;

385
	if (result) {
386
found:
E
Eric Dumazet 已提交
387
		if (unlikely(!atomic_inc_not_zero_hint(&result->sk_refcnt, 2)))
388 389 390 391 392 393 394 395
			result = NULL;
		else if (unlikely(compute_score(result, net, hnum, saddr, sport,
					daddr, dport, dif) < badness)) {
			sock_put(result);
			goto begin;
		}
	}
	rcu_read_unlock();
L
Linus Torvalds 已提交
396 397
	return result;
}
398
EXPORT_SYMBOL_GPL(__udp6_lib_lookup);
L
Linus Torvalds 已提交
399

400 401
static struct sock *__udp6_lib_lookup_skb(struct sk_buff *skb,
					  __be16 sport, __be16 dport,
402
					  struct udp_table *udptable)
403
{
404
	struct sock *sk;
405
	const struct ipv6hdr *iph = ipv6_hdr(skb);
406

407 408
	sk = skb_steal_sock(skb);
	if (unlikely(sk))
409
		return sk;
E
Eric Dumazet 已提交
410 411
	return __udp6_lib_lookup(dev_net(skb_dst(skb)->dev), &iph->saddr, sport,
				 &iph->daddr, dport, inet6_iif(skb),
412
				 udptable, skb);
413 414
}

415 416 417
struct sock *udp6_lib_lookup(struct net *net, const struct in6_addr *saddr, __be16 sport,
			     const struct in6_addr *daddr, __be16 dport, int dif)
{
418
	return __udp6_lib_lookup(net, saddr, sport, daddr, dport, dif, &udp_table, NULL);
419 420 421
}
EXPORT_SYMBOL_GPL(udp6_lib_lookup);

L
Linus Torvalds 已提交
422
/*
423 424
 *	This should be easy, if there is something there we
 *	return it, otherwise we block.
L
Linus Torvalds 已提交
425 426
 */

427
int udpv6_recvmsg(struct sock *sk, struct msghdr *msg, size_t len,
L
Linus Torvalds 已提交
428 429 430 431
		  int noblock, int flags, int *addr_len)
{
	struct ipv6_pinfo *np = inet6_sk(sk);
	struct inet_sock *inet = inet_sk(sk);
432
	struct sk_buff *skb;
433
	unsigned int ulen, copied;
434
	int peeked, off = 0;
435 436
	int err;
	int is_udplite = IS_UDPLITE(sk);
437
	bool checksum_valid = false;
438
	int is_udp4;
439
	bool slow;
L
Linus Torvalds 已提交
440 441

	if (flags & MSG_ERRQUEUE)
442
		return ipv6_recv_error(sk, msg, len, addr_len);
L
Linus Torvalds 已提交
443

444
	if (np->rxpmtu && np->rxopt.bits.rxpmtu)
445
		return ipv6_recv_rxpmtu(sk, msg, len, addr_len);
446

L
Linus Torvalds 已提交
447
try_again:
448
	skb = __skb_recv_datagram(sk, flags | (noblock ? MSG_DONTWAIT : 0),
449
				  &peeked, &off, &err);
L
Linus Torvalds 已提交
450 451 452
	if (!skb)
		goto out;

453
	ulen = skb->len - sizeof(struct udphdr);
454 455 456 457
	copied = len;
	if (copied > ulen)
		copied = ulen;
	else if (copied < ulen)
458
		msg->msg_flags |= MSG_TRUNC;
L
Linus Torvalds 已提交
459

460 461
	is_udp4 = (skb->protocol == htons(ETH_P_IP));

462
	/*
463 464 465
	 * If checksum is needed at all, try to do it while copying the
	 * data.  If the data is truncated, or if we only want a partial
	 * coverage checksum (UDP-Lite), do it before the copy.
466 467
	 */

468
	if (copied < ulen || UDP_SKB_CB(skb)->partial_cov) {
469 470
		checksum_valid = !udp_lib_checksum_complete(skb);
		if (!checksum_valid)
L
Linus Torvalds 已提交
471
			goto csum_copy_err;
472 473
	}

474
	if (checksum_valid || skb_csum_unnecessary(skb))
475 476
		err = skb_copy_datagram_msg(skb, sizeof(struct udphdr),
					    msg, copied);
477
	else {
478
		err = skb_copy_and_csum_datagram_msg(skb, sizeof(struct udphdr), msg);
L
Linus Torvalds 已提交
479 480 481
		if (err == -EINVAL)
			goto csum_copy_err;
	}
482 483
	if (unlikely(err)) {
		trace_kfree_skb(skb, udpv6_recvmsg);
484 485 486 487 488 489 490 491 492 493 494
		if (!peeked) {
			atomic_inc(&sk->sk_drops);
			if (is_udp4)
				UDP_INC_STATS_USER(sock_net(sk),
						   UDP_MIB_INERRORS,
						   is_udplite);
			else
				UDP6_INC_STATS_USER(sock_net(sk),
						    UDP_MIB_INERRORS,
						    is_udplite);
		}
L
Linus Torvalds 已提交
495
		goto out_free;
496
	}
497 498 499 500 501 502 503 504
	if (!peeked) {
		if (is_udp4)
			UDP_INC_STATS_USER(sock_net(sk),
					UDP_MIB_INDATAGRAMS, is_udplite);
		else
			UDP6_INC_STATS_USER(sock_net(sk),
					UDP_MIB_INDATAGRAMS, is_udplite);
	}
505

506
	sock_recv_ts_and_drops(msg, sk, skb);
L
Linus Torvalds 已提交
507 508 509

	/* Copy the address. */
	if (msg->msg_name) {
510
		DECLARE_SOCKADDR(struct sockaddr_in6 *, sin6, msg->msg_name);
L
Linus Torvalds 已提交
511
		sin6->sin6_family = AF_INET6;
512
		sin6->sin6_port = udp_hdr(skb)->source;
L
Linus Torvalds 已提交
513 514
		sin6->sin6_flowinfo = 0;

515
		if (is_udp4) {
B
Brian Haley 已提交
516 517
			ipv6_addr_set_v4mapped(ip_hdr(skb)->saddr,
					       &sin6->sin6_addr);
518 519
			sin6->sin6_scope_id = 0;
		} else {
A
Alexey Dobriyan 已提交
520
			sin6->sin6_addr = ipv6_hdr(skb)->saddr;
521 522
			sin6->sin6_scope_id =
				ipv6_iface_scope_id(&sin6->sin6_addr,
523
						    inet6_iif(skb));
L
Linus Torvalds 已提交
524
		}
525
		*addr_len = sizeof(*sin6);
L
Linus Torvalds 已提交
526
	}
527 528 529 530

	if (np->rxopt.all)
		ip6_datagram_recv_common_ctl(sk, msg, skb);

531
	if (is_udp4) {
L
Linus Torvalds 已提交
532 533 534 535
		if (inet->cmsg_flags)
			ip_cmsg_recv(msg, skb);
	} else {
		if (np->rxopt.all)
536
			ip6_datagram_recv_specific_ctl(sk, msg, skb);
537
	}
L
Linus Torvalds 已提交
538

539
	err = copied;
L
Linus Torvalds 已提交
540
	if (flags & MSG_TRUNC)
541
		err = ulen;
L
Linus Torvalds 已提交
542 543

out_free:
544
	skb_free_datagram_locked(sk, skb);
L
Linus Torvalds 已提交
545 546 547 548
out:
	return err;

csum_copy_err:
549
	slow = lock_sock_fast(sk);
550
	if (!skb_kill_datagram(sk, skb, flags)) {
551 552 553
		if (is_udp4) {
			UDP_INC_STATS_USER(sock_net(sk),
					UDP_MIB_CSUMERRORS, is_udplite);
554 555
			UDP_INC_STATS_USER(sock_net(sk),
					UDP_MIB_INERRORS, is_udplite);
556 557 558
		} else {
			UDP6_INC_STATS_USER(sock_net(sk),
					UDP_MIB_CSUMERRORS, is_udplite);
559 560
			UDP6_INC_STATS_USER(sock_net(sk),
					UDP_MIB_INERRORS, is_udplite);
561
		}
562
	}
563
	unlock_sock_fast(sk, slow);
L
Linus Torvalds 已提交
564

565 566
	/* starting over for a new packet, but check if we need to yield */
	cond_resched();
567
	msg->msg_flags &= ~MSG_TRUNC;
L
Linus Torvalds 已提交
568 569 570
	goto try_again;
}

571
void __udp6_lib_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
572
		    u8 type, u8 code, int offset, __be32 info,
573
		    struct udp_table *udptable)
L
Linus Torvalds 已提交
574 575
{
	struct ipv6_pinfo *np;
576 577 578
	const struct ipv6hdr *hdr = (const struct ipv6hdr *)skb->data;
	const struct in6_addr *saddr = &hdr->saddr;
	const struct in6_addr *daddr = &hdr->daddr;
579
	struct udphdr *uh = (struct udphdr *)(skb->data+offset);
L
Linus Torvalds 已提交
580 581
	struct sock *sk;
	int err;
582
	struct net *net = dev_net(skb->dev);
L
Linus Torvalds 已提交
583

584
	sk = __udp6_lib_lookup(net, daddr, uh->dest, saddr, uh->source,
585
			       inet6_iif(skb), udptable, skb);
586
	if (!sk) {
587 588
		ICMP6_INC_STATS_BH(net, __in6_dev_get(skb->dev),
				   ICMP6_MIB_INERRORS);
L
Linus Torvalds 已提交
589
		return;
590
	}
L
Linus Torvalds 已提交
591

592 593 594
	if (type == ICMPV6_PKT_TOOBIG) {
		if (!ip6_sk_accept_pmtu(sk))
			goto out;
595
		ip6_sk_update_pmtu(skb, sk, info);
596
	}
597
	if (type == NDISC_REDIRECT) {
598
		ip6_sk_redirect(skb, sk);
599 600
		goto out;
	}
601

L
Linus Torvalds 已提交
602 603 604 605 606 607 608 609
	np = inet6_sk(sk);

	if (!icmpv6_err_convert(type, code, &err) && !np->recverr)
		goto out;

	if (sk->sk_state != TCP_ESTABLISHED && !np->recverr)
		goto out;

610
	if (np->recverr)
L
Linus Torvalds 已提交
611
		ipv6_icmp_error(sk, skb, err, uh->dest, ntohl(info), (u8 *)(uh+1));
612

L
Linus Torvalds 已提交
613 614 615 616 617 618
	sk->sk_err = err;
	sk->sk_error_report(sk);
out:
	sock_put(sk);
}

619 620 621 622
static int __udpv6_queue_rcv_skb(struct sock *sk, struct sk_buff *skb)
{
	int rc;

623
	if (!ipv6_addr_any(&sk->sk_v6_daddr)) {
624
		sock_rps_save_rxhash(sk, skb);
625
		sk_mark_napi_id(sk, skb);
E
Eric Dumazet 已提交
626
		sk_incoming_cpu_update(sk);
627
	}
628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643

	rc = sock_queue_rcv_skb(sk, skb);
	if (rc < 0) {
		int is_udplite = IS_UDPLITE(sk);

		/* Note that an ENOMEM error is charged twice */
		if (rc == -ENOMEM)
			UDP6_INC_STATS_BH(sock_net(sk),
					UDP_MIB_RCVBUFERRORS, is_udplite);
		UDP6_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
		kfree_skb(skb);
		return -1;
	}
	return 0;
}

644
static __inline__ void udpv6_err(struct sk_buff *skb,
645
				 struct inet6_skb_parm *opt, u8 type,
646
				 u8 code, int offset, __be32 info)
647
{
648
	__udp6_lib_err(skb, opt, type, code, offset, info, &udp_table);
649 650
}

651 652 653 654 655 656 657 658
static struct static_key udpv6_encap_needed __read_mostly;
void udpv6_encap_enable(void)
{
	if (!static_key_enabled(&udpv6_encap_needed))
		static_key_slow_inc(&udpv6_encap_needed);
}
EXPORT_SYMBOL(udpv6_encap_enable);

659
int udpv6_queue_rcv_skb(struct sock *sk, struct sk_buff *skb)
L
Linus Torvalds 已提交
660
{
661
	struct udp_sock *up = udp_sk(sk);
662
	int rc;
W
Wang Chen 已提交
663
	int is_udplite = IS_UDPLITE(sk);
664

665 666
	if (!xfrm6_policy_check(sk, XFRM_POLICY_IN, skb))
		goto drop;
L
Linus Torvalds 已提交
667

668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683
	if (static_key_false(&udpv6_encap_needed) && up->encap_type) {
		int (*encap_rcv)(struct sock *sk, struct sk_buff *skb);

		/*
		 * This is an encapsulation socket so pass the skb to
		 * the socket's udp_encap_rcv() hook. Otherwise, just
		 * fall through and pass this up the UDP socket.
		 * up->encap_rcv() returns the following value:
		 * =0 if skb was successfully passed to the encap
		 *    handler or was discarded by it.
		 * >0 if skb should be passed on to UDP.
		 * <0 if skb should be resubmitted as proto -N
		 */

		/* if we're overly short, let UDP handle it */
		encap_rcv = ACCESS_ONCE(up->encap_rcv);
684
		if (skb->len > sizeof(struct udphdr) && encap_rcv) {
685 686
			int ret;

687 688 689 690
			/* Verify checksum before giving to encap */
			if (udp_lib_checksum_complete(skb))
				goto csum_error;

691 692 693 694 695 696 697 698 699 700 701 702
			ret = encap_rcv(sk, skb);
			if (ret <= 0) {
				UDP_INC_STATS_BH(sock_net(sk),
						 UDP_MIB_INDATAGRAMS,
						 is_udplite);
				return -ret;
			}
		}

		/* FALLTHROUGH -- it's a UDP Packet */
	}

703 704 705
	/*
	 * UDP-Lite specific tests, ignored on UDP sockets (see net/ipv4/udp.c).
	 */
W
Wang Chen 已提交
706
	if ((is_udplite & UDPLITE_RECV_CC)  &&  UDP_SKB_CB(skb)->partial_cov) {
707 708

		if (up->pcrlen == 0) {          /* full coverage was set  */
709 710
			net_dbg_ratelimited("UDPLITE6: partial coverage %d while full coverage %d requested\n",
					    UDP_SKB_CB(skb)->cscov, skb->len);
711 712 713
			goto drop;
		}
		if (UDP_SKB_CB(skb)->cscov  <  up->pcrlen) {
714 715
			net_dbg_ratelimited("UDPLITE6: coverage %d too small, need min %d\n",
					    UDP_SKB_CB(skb)->cscov, up->pcrlen);
716 717
			goto drop;
		}
L
Linus Torvalds 已提交
718 719
	}

720
	if (rcu_access_pointer(sk->sk_filter)) {
721
		if (udp_lib_checksum_complete(skb))
722
			goto csum_error;
723
	}
724

725
	if (sk_rcvqueues_full(sk, sk->sk_rcvbuf)) {
726 727
		UDP6_INC_STATS_BH(sock_net(sk),
				  UDP_MIB_RCVBUFERRORS, is_udplite);
728
		goto drop;
729
	}
730

731
	skb_dst_drop(skb);
732

733 734 735 736 737 738 739 740 741
	bh_lock_sock(sk);
	rc = 0;
	if (!sock_owned_by_user(sk))
		rc = __udpv6_queue_rcv_skb(sk, skb);
	else if (sk_add_backlog(sk, skb, sk->sk_rcvbuf)) {
		bh_unlock_sock(sk);
		goto drop;
	}
	bh_unlock_sock(sk);
742 743

	return rc;
744

745 746
csum_error:
	UDP6_INC_STATS_BH(sock_net(sk), UDP_MIB_CSUMERRORS, is_udplite);
747
drop:
748
	UDP6_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
749
	atomic_inc(&sk->sk_drops);
750 751
	kfree_skb(skb);
	return -1;
L
Linus Torvalds 已提交
752 753
}

754 755 756 757
static bool __udp_v6_is_mcast_sock(struct net *net, struct sock *sk,
				   __be16 loc_port, const struct in6_addr *loc_addr,
				   __be16 rmt_port, const struct in6_addr *rmt_addr,
				   int dif, unsigned short hnum)
L
Linus Torvalds 已提交
758
{
759
	struct inet_sock *inet = inet_sk(sk);
L
Linus Torvalds 已提交
760

761 762 763 764 765 766 767 768
	if (!net_eq(sock_net(sk), net))
		return false;

	if (udp_sk(sk)->udp_port_hash != hnum ||
	    sk->sk_family != PF_INET6 ||
	    (inet->inet_dport && inet->inet_dport != rmt_port) ||
	    (!ipv6_addr_any(&sk->sk_v6_daddr) &&
		    !ipv6_addr_equal(&sk->sk_v6_daddr, rmt_addr)) ||
769 770 771
	    (sk->sk_bound_dev_if && sk->sk_bound_dev_if != dif) ||
	    (!ipv6_addr_any(&sk->sk_v6_rcv_saddr) &&
		    !ipv6_addr_equal(&sk->sk_v6_rcv_saddr, loc_addr)))
772 773 774 775
		return false;
	if (!inet6_mc_check(sk, loc_addr, rmt_addr))
		return false;
	return true;
L
Linus Torvalds 已提交
776 777
}

778 779 780
static void flush_stack(struct sock **stack, unsigned int count,
			struct sk_buff *skb, unsigned int final)
{
781
	struct sk_buff *skb1 = NULL;
782
	struct sock *sk;
783
	unsigned int i;
784 785

	for (i = 0; i < count; i++) {
786
		sk = stack[i];
787
		if (likely(!skb1))
788 789 790 791 792 793 794
			skb1 = (i == final) ? skb : skb_clone(skb, GFP_ATOMIC);
		if (!skb1) {
			atomic_inc(&sk->sk_drops);
			UDP6_INC_STATS_BH(sock_net(sk), UDP_MIB_RCVBUFERRORS,
					  IS_UDPLITE(sk));
			UDP6_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS,
					  IS_UDPLITE(sk));
795
		}
796 797 798

		if (skb1 && udpv6_queue_rcv_skb(sk, skb1) <= 0)
			skb1 = NULL;
799
		sock_put(sk);
800
	}
801 802
	if (unlikely(skb1))
		kfree_skb(skb1);
803
}
804 805 806 807 808 809

static void udp6_csum_zero_error(struct sk_buff *skb)
{
	/* RFC 2460 section 8.1 says that we SHOULD log
	 * this error. Well, it is reasonable.
	 */
810 811 812
	net_dbg_ratelimited("IPv6: udp checksum is 0 for [%pI6c]:%u->[%pI6c]:%u\n",
			    &ipv6_hdr(skb)->saddr, ntohs(udp_hdr(skb)->source),
			    &ipv6_hdr(skb)->daddr, ntohs(udp_hdr(skb)->dest));
813 814
}

L
Linus Torvalds 已提交
815 816 817 818
/*
 * Note: called only from the BH handler context,
 * so we don't need to lock the hashes.
 */
819
static int __udp6_lib_mcast_deliver(struct net *net, struct sk_buff *skb,
820
		const struct in6_addr *saddr, const struct in6_addr *daddr,
821
		struct udp_table *udptable, int proto)
L
Linus Torvalds 已提交
822
{
823
	struct sock *sk, *stack[256 / sizeof(struct sock *)];
824
	const struct udphdr *uh = udp_hdr(skb);
825 826 827 828
	struct hlist_nulls_node *node;
	unsigned short hnum = ntohs(uh->dest);
	struct udp_hslot *hslot = udp_hashslot(udptable, net, hnum);
	int dif = inet6_iif(skb);
829 830
	unsigned int count = 0, offset = offsetof(typeof(*sk), sk_nulls_node);
	unsigned int hash2 = 0, hash2_any = 0, use_hash2 = (hslot->count > 10);
831
	bool inner_flushed = false;
832 833 834 835 836 837 838 839 840

	if (use_hash2) {
		hash2_any = udp6_portaddr_hash(net, &in6addr_any, hnum) &
			    udp_table.mask;
		hash2 = udp6_portaddr_hash(net, daddr, hnum) & udp_table.mask;
start_lookup:
		hslot = &udp_table.hash2[hash2];
		offset = offsetof(typeof(*sk), __sk_common.skc_portaddr_node);
	}
L
Linus Torvalds 已提交
841

842
	spin_lock(&hslot->lock);
843
	sk_nulls_for_each_entry_offset(sk, node, &hslot->head, offset) {
844 845 846 847 848 849 850 851 852 853
		if (__udp_v6_is_mcast_sock(net, sk,
					   uh->dest, daddr,
					   uh->source, saddr,
					   dif, hnum) &&
		    /* If zero checksum and no_check is not on for
		     * the socket then skip it.
		     */
		    (uh->check || udp_sk(sk)->no_check6_rx)) {
			if (unlikely(count == ARRAY_SIZE(stack))) {
				flush_stack(stack, count, skb, ~0);
854
				inner_flushed = true;
855 856
				count = 0;
			}
857
			stack[count++] = sk;
858
			sock_hold(sk);
H
Hideo Aoki 已提交
859
		}
L
Linus Torvalds 已提交
860
	}
861

862
	spin_unlock(&hslot->lock);
863

864 865 866 867 868 869
	/* Also lookup *:port if we are using hash2 and haven't done so yet. */
	if (use_hash2 && hash2 != hash2_any) {
		hash2 = hash2_any;
		goto start_lookup;
	}

870 871 872
	if (count) {
		flush_stack(stack, count, skb, count - 1);
	} else {
873 874 875 876
		if (!inner_flushed)
			UDP_INC_STATS_BH(net, UDP_MIB_IGNOREDMULTI,
					 proto == IPPROTO_UDPLITE);
		consume_skb(skb);
877
	}
878
	return 0;
L
Linus Torvalds 已提交
879 880
}

881
int __udp6_lib_rcv(struct sk_buff *skb, struct udp_table *udptable,
882
		   int proto)
L
Linus Torvalds 已提交
883
{
884
	struct net *net = dev_net(skb->dev);
L
Linus Torvalds 已提交
885
	struct sock *sk;
886
	struct udphdr *uh;
887
	const struct in6_addr *saddr, *daddr;
L
Linus Torvalds 已提交
888 889 890
	u32 ulen = 0;

	if (!pskb_may_pull(skb, sizeof(struct udphdr)))
891
		goto discard;
L
Linus Torvalds 已提交
892

893 894
	saddr = &ipv6_hdr(skb)->saddr;
	daddr = &ipv6_hdr(skb)->daddr;
895
	uh = udp_hdr(skb);
L
Linus Torvalds 已提交
896 897

	ulen = ntohs(uh->len);
898 899
	if (ulen > skb->len)
		goto short_packet;
L
Linus Torvalds 已提交
900

901 902
	if (proto == IPPROTO_UDP) {
		/* UDP validates ulen. */
L
Linus Torvalds 已提交
903

904 905 906
		/* Check for jumbo payload */
		if (ulen == 0)
			ulen = skb->len;
L
Linus Torvalds 已提交
907

908 909
		if (ulen < sizeof(*uh))
			goto short_packet;
L
Linus Torvalds 已提交
910

911 912 913
		if (ulen < skb->len) {
			if (pskb_trim_rcsum(skb, ulen))
				goto short_packet;
914 915
			saddr = &ipv6_hdr(skb)->saddr;
			daddr = &ipv6_hdr(skb)->daddr;
916
			uh = udp_hdr(skb);
917 918
		}
	}
L
Linus Torvalds 已提交
919

920
	if (udp6_csum_init(skb, uh, proto))
921
		goto csum_error;
922

923 924
	/*
	 *	Multicast receive code
L
Linus Torvalds 已提交
925
	 */
926
	if (ipv6_addr_is_multicast(daddr))
927
		return __udp6_lib_mcast_deliver(net, skb,
928
				saddr, daddr, udptable, proto);
L
Linus Torvalds 已提交
929 930 931

	/* Unicast */

932
	/*
L
Linus Torvalds 已提交
933 934 935
	 * check socket cache ... must talk to Alan about his plans
	 * for sock caches... i'll skip this for now.
	 */
936
	sk = __udp6_lib_lookup_skb(skb, uh->source, uh->dest, udptable);
937
	if (sk) {
938 939
		int ret;

940
		if (!uh->check && !udp_sk(sk)->no_check6_rx) {
941
			sock_put(sk);
942 943 944 945
			udp6_csum_zero_error(skb);
			goto csum_error;
		}

946
		if (inet_get_convert_csum(sk) && uh->check && !IS_UDPLITE(sk))
947 948 949
			skb_checksum_try_convert(skb, IPPROTO_UDP, uh->check,
						 ip6_compute_pseudo);

950
		ret = udpv6_queue_rcv_skb(sk, skb);
951
		sock_put(sk);
L
Linus Torvalds 已提交
952

953 954 955 956 957
		/* a return value > 0 means to resubmit the input, but
		 * it wants the return to be -protocol, or 0
		 */
		if (ret > 0)
			return -ret;
L
Linus Torvalds 已提交
958

S
Stephen Hemminger 已提交
959
		return 0;
L
Linus Torvalds 已提交
960
	}
961

962 963 964 965 966
	if (!uh->check) {
		udp6_csum_zero_error(skb);
		goto csum_error;
	}

967
	if (!xfrm6_policy_check(NULL, XFRM_POLICY_IN, skb))
968
		goto discard;
969 970

	if (udp_lib_checksum_complete(skb))
971
		goto csum_error;
972 973 974 975 976

	UDP6_INC_STATS_BH(net, UDP_MIB_NOPORTS, proto == IPPROTO_UDPLITE);
	icmpv6_send(skb, ICMPV6_DEST_UNREACH, ICMPV6_PORT_UNREACH, 0);

	kfree_skb(skb);
S
Stephen Hemminger 已提交
977
	return 0;
L
Linus Torvalds 已提交
978

979
short_packet:
980 981 982 983 984
	net_dbg_ratelimited("UDP%sv6: short packet: From [%pI6c]:%u %d/%d to [%pI6c]:%u\n",
			    proto == IPPROTO_UDPLITE ? "-Lite" : "",
			    saddr, ntohs(uh->source),
			    ulen, skb->len,
			    daddr, ntohs(uh->dest));
985 986 987
	goto discard;
csum_error:
	UDP6_INC_STATS_BH(net, UDP_MIB_CSUMERRORS, proto == IPPROTO_UDPLITE);
L
Linus Torvalds 已提交
988
discard:
989
	UDP6_INC_STATS_BH(net, UDP_MIB_INERRORS, proto == IPPROTO_UDPLITE);
L
Linus Torvalds 已提交
990
	kfree_skb(skb);
S
Stephen Hemminger 已提交
991
	return 0;
L
Linus Torvalds 已提交
992
}
993

994
static __inline__ int udpv6_rcv(struct sk_buff *skb)
995
{
996
	return __udp6_lib_rcv(skb, &udp_table, IPPROTO_UDP);
997 998
}

L
Linus Torvalds 已提交
999 1000 1001 1002 1003 1004 1005
/*
 * Throw away all pending data and cancel the corking. Socket is locked.
 */
static void udp_v6_flush_pending_frames(struct sock *sk)
{
	struct udp_sock *up = udp_sk(sk);

1006 1007 1008
	if (up->pending == AF_INET)
		udp_flush_pending_frames(sk);
	else if (up->pending) {
L
Linus Torvalds 已提交
1009 1010 1011
		up->len = 0;
		up->pending = 0;
		ip6_flush_pending_frames(sk);
1012
	}
L
Linus Torvalds 已提交
1013 1014
}

1015
/**
1016 1017 1018 1019
 *	udp6_hwcsum_outgoing  -  handle outgoing HW checksumming
 *	@sk:	socket we are sending on
 *	@skb:	sk_buff containing the filled-in UDP header
 *		(checksum field must be zeroed out)
1020 1021 1022 1023 1024 1025 1026
 */
static void udp6_hwcsum_outgoing(struct sock *sk, struct sk_buff *skb,
				 const struct in6_addr *saddr,
				 const struct in6_addr *daddr, int len)
{
	unsigned int offset;
	struct udphdr *uh = udp_hdr(skb);
V
Vlad Yasevich 已提交
1027
	struct sk_buff *frags = skb_shinfo(skb)->frag_list;
1028 1029
	__wsum csum = 0;

V
Vlad Yasevich 已提交
1030
	if (!frags) {
1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045
		/* Only one fragment on the socket.  */
		skb->csum_start = skb_transport_header(skb) - skb->head;
		skb->csum_offset = offsetof(struct udphdr, check);
		uh->check = ~csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP, 0);
	} else {
		/*
		 * HW-checksum won't work as there are two or more
		 * fragments on the socket so that all csums of sk_buffs
		 * should be together
		 */
		offset = skb_transport_offset(skb);
		skb->csum = skb_checksum(skb, offset, skb->len - offset, 0);

		skb->ip_summed = CHECKSUM_NONE;

V
Vlad Yasevich 已提交
1046 1047 1048
		do {
			csum = csum_add(csum, frags->csum);
		} while ((frags = frags->next));
1049 1050 1051 1052 1053 1054 1055 1056

		uh->check = csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP,
					    csum);
		if (uh->check == 0)
			uh->check = CSUM_MANGLED_0;
	}
}

L
Linus Torvalds 已提交
1057 1058 1059 1060
/*
 *	Sending
 */

V
Vlad Yasevich 已提交
1061
static int udp_v6_send_skb(struct sk_buff *skb, struct flowi6 *fl6)
L
Linus Torvalds 已提交
1062
{
V
Vlad Yasevich 已提交
1063
	struct sock *sk = skb->sk;
L
Linus Torvalds 已提交
1064 1065
	struct udphdr *uh;
	int err = 0;
W
Wang Chen 已提交
1066
	int is_udplite = IS_UDPLITE(sk);
1067
	__wsum csum = 0;
V
Vlad Yasevich 已提交
1068 1069
	int offset = skb_transport_offset(skb);
	int len = skb->len - offset;
L
Linus Torvalds 已提交
1070 1071 1072 1073

	/*
	 * Create a UDP header
	 */
1074
	uh = udp_hdr(skb);
1075 1076
	uh->source = fl6->fl6_sport;
	uh->dest = fl6->fl6_dport;
V
Vlad Yasevich 已提交
1077
	uh->len = htons(len);
L
Linus Torvalds 已提交
1078 1079
	uh->check = 0;

W
Wang Chen 已提交
1080
	if (is_udplite)
V
Vlad Yasevich 已提交
1081 1082
		csum = udplite_csum(skb);
	else if (udp_sk(sk)->no_check6_tx) {   /* UDP csum disabled */
1083 1084 1085
		skb->ip_summed = CHECKSUM_NONE;
		goto send;
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) { /* UDP hardware csum */
V
Vlad Yasevich 已提交
1086
		udp6_hwcsum_outgoing(sk, skb, &fl6->saddr, &fl6->daddr, len);
1087 1088
		goto send;
	} else
V
Vlad Yasevich 已提交
1089
		csum = udp_csum(skb);
L
Linus Torvalds 已提交
1090

1091
	/* add protocol-dependent pseudo-header */
1092
	uh->check = csum_ipv6_magic(&fl6->saddr, &fl6->daddr,
V
Vlad Yasevich 已提交
1093
				    len, fl6->flowi6_proto, csum);
L
Linus Torvalds 已提交
1094
	if (uh->check == 0)
1095
		uh->check = CSUM_MANGLED_0;
L
Linus Torvalds 已提交
1096

1097
send:
V
Vlad Yasevich 已提交
1098
	err = ip6_send_skb(skb);
E
Eric Dumazet 已提交
1099 1100 1101 1102 1103 1104 1105 1106 1107
	if (err) {
		if (err == -ENOBUFS && !inet6_sk(sk)->recverr) {
			UDP6_INC_STATS_USER(sock_net(sk),
					    UDP_MIB_SNDBUFERRORS, is_udplite);
			err = 0;
		}
	} else
		UDP6_INC_STATS_USER(sock_net(sk),
				    UDP_MIB_OUTDATAGRAMS, is_udplite);
V
Vlad Yasevich 已提交
1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131
	return err;
}

static int udp_v6_push_pending_frames(struct sock *sk)
{
	struct sk_buff *skb;
	struct udp_sock  *up = udp_sk(sk);
	struct flowi6 fl6;
	int err = 0;

	if (up->pending == AF_INET)
		return udp_push_pending_frames(sk);

	/* ip6_finish_skb will release the cork, so make a copy of
	 * fl6 here.
	 */
	fl6 = inet_sk(sk)->cork.fl.u.ip6;

	skb = ip6_finish_skb(sk);
	if (!skb)
		goto out;

	err = udp_v6_send_skb(skb, &fl6);

L
Linus Torvalds 已提交
1132 1133 1134 1135 1136 1137
out:
	up->len = 0;
	up->pending = 0;
	return err;
}

1138
int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, size_t len)
L
Linus Torvalds 已提交
1139 1140 1141 1142 1143
{
	struct ipv6_txoptions opt_space;
	struct udp_sock *up = udp_sk(sk);
	struct inet_sock *inet = inet_sk(sk);
	struct ipv6_pinfo *np = inet6_sk(sk);
1144
	DECLARE_SOCKADDR(struct sockaddr_in6 *, sin6, msg->msg_name);
1145
	struct in6_addr *daddr, *final_p, final;
L
Linus Torvalds 已提交
1146
	struct ipv6_txoptions *opt = NULL;
1147
	struct ipv6_txoptions *opt_to_free = NULL;
L
Linus Torvalds 已提交
1148
	struct ip6_flowlabel *flowlabel = NULL;
1149
	struct flowi6 fl6;
L
Linus Torvalds 已提交
1150 1151 1152 1153
	struct dst_entry *dst;
	int addr_len = msg->msg_namelen;
	int ulen = len;
	int hlimit = -1;
1154
	int tclass = -1;
1155
	int dontfrag = -1;
L
Linus Torvalds 已提交
1156 1157
	int corkreq = up->corkflag || msg->msg_flags&MSG_MORE;
	int err;
1158
	int connected = 0;
W
Wang Chen 已提交
1159
	int is_udplite = IS_UDPLITE(sk);
1160
	int (*getfrag)(void *, char *, int, int, int, struct sk_buff *);
L
Linus Torvalds 已提交
1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185

	/* destination address check */
	if (sin6) {
		if (addr_len < offsetof(struct sockaddr, sa_data))
			return -EINVAL;

		switch (sin6->sin6_family) {
		case AF_INET6:
			if (addr_len < SIN6_LEN_RFC2133)
				return -EINVAL;
			daddr = &sin6->sin6_addr;
			break;
		case AF_INET:
			goto do_udp_sendmsg;
		case AF_UNSPEC:
			msg->msg_name = sin6 = NULL;
			msg->msg_namelen = addr_len = 0;
			daddr = NULL;
			break;
		default:
			return -EINVAL;
		}
	} else if (!up->pending) {
		if (sk->sk_state != TCP_ESTABLISHED)
			return -EDESTADDRREQ;
1186
		daddr = &sk->sk_v6_daddr;
1187
	} else
L
Linus Torvalds 已提交
1188 1189 1190
		daddr = NULL;

	if (daddr) {
B
Brian Haley 已提交
1191
		if (ipv6_addr_v4mapped(daddr)) {
L
Linus Torvalds 已提交
1192 1193
			struct sockaddr_in sin;
			sin.sin_family = AF_INET;
E
Eric Dumazet 已提交
1194
			sin.sin_port = sin6 ? sin6->sin6_port : inet->inet_dport;
L
Linus Torvalds 已提交
1195 1196 1197 1198 1199 1200
			sin.sin_addr.s_addr = daddr->s6_addr32[3];
			msg->msg_name = &sin;
			msg->msg_namelen = sizeof(sin);
do_udp_sendmsg:
			if (__ipv6_only_sock(sk))
				return -ENETUNREACH;
1201
			return udp_sendmsg(sk, msg, len);
L
Linus Torvalds 已提交
1202 1203 1204 1205
		}
	}

	if (up->pending == AF_INET)
1206
		return udp_sendmsg(sk, msg, len);
L
Linus Torvalds 已提交
1207 1208

	/* Rough check on arithmetic overflow,
1209
	   better check is made in ip6_append_data().
L
Linus Torvalds 已提交
1210 1211 1212
	   */
	if (len > INT_MAX - sizeof(struct udphdr))
		return -EMSGSIZE;
1213

1214
	getfrag  =  is_udplite ?  udplite_getfrag : ip_generic_getfrag;
L
Linus Torvalds 已提交
1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
	if (up->pending) {
		/*
		 * There are pending frames.
		 * The socket lock must be held while it's corked.
		 */
		lock_sock(sk);
		if (likely(up->pending)) {
			if (unlikely(up->pending != AF_INET6)) {
				release_sock(sk);
				return -EAFNOSUPPORT;
			}
			dst = NULL;
			goto do_append_data;
		}
		release_sock(sk);
	}
	ulen += sizeof(struct udphdr);

1233
	memset(&fl6, 0, sizeof(fl6));
L
Linus Torvalds 已提交
1234 1235 1236 1237 1238

	if (sin6) {
		if (sin6->sin6_port == 0)
			return -EINVAL;

1239
		fl6.fl6_dport = sin6->sin6_port;
L
Linus Torvalds 已提交
1240 1241 1242
		daddr = &sin6->sin6_addr;

		if (np->sndflow) {
1243 1244 1245
			fl6.flowlabel = sin6->sin6_flowinfo&IPV6_FLOWINFO_MASK;
			if (fl6.flowlabel&IPV6_FLOWLABEL_MASK) {
				flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
1246
				if (!flowlabel)
L
Linus Torvalds 已提交
1247 1248 1249 1250 1251 1252 1253 1254 1255
					return -EINVAL;
			}
		}

		/*
		 * Otherwise it will be difficult to maintain
		 * sk->sk_dst_cache.
		 */
		if (sk->sk_state == TCP_ESTABLISHED &&
1256 1257
		    ipv6_addr_equal(daddr, &sk->sk_v6_daddr))
			daddr = &sk->sk_v6_daddr;
L
Linus Torvalds 已提交
1258 1259 1260

		if (addr_len >= sizeof(struct sockaddr_in6) &&
		    sin6->sin6_scope_id &&
1261
		    __ipv6_addr_needs_scope_id(__ipv6_addr_type(daddr)))
1262
			fl6.flowi6_oif = sin6->sin6_scope_id;
L
Linus Torvalds 已提交
1263 1264 1265 1266
	} else {
		if (sk->sk_state != TCP_ESTABLISHED)
			return -EDESTADDRREQ;

1267
		fl6.fl6_dport = inet->inet_dport;
1268
		daddr = &sk->sk_v6_daddr;
1269
		fl6.flowlabel = np->flow_label;
1270
		connected = 1;
L
Linus Torvalds 已提交
1271 1272
	}

1273 1274
	if (!fl6.flowi6_oif)
		fl6.flowi6_oif = sk->sk_bound_dev_if;
L
Linus Torvalds 已提交
1275

1276 1277
	if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->sticky_pktinfo.ipi6_ifindex;
1278

1279
	fl6.flowi6_mark = sk->sk_mark;
B
Brian Haley 已提交
1280

L
Linus Torvalds 已提交
1281 1282 1283 1284 1285
	if (msg->msg_controllen) {
		opt = &opt_space;
		memset(opt, 0, sizeof(struct ipv6_txoptions));
		opt->tot_len = sizeof(*opt);

1286 1287
		err = ip6_datagram_send_ctl(sock_net(sk), sk, msg, &fl6, opt,
					    &hlimit, &tclass, &dontfrag);
L
Linus Torvalds 已提交
1288 1289 1290 1291
		if (err < 0) {
			fl6_sock_release(flowlabel);
			return err;
		}
1292 1293
		if ((fl6.flowlabel&IPV6_FLOWLABEL_MASK) && !flowlabel) {
			flowlabel = fl6_sock_lookup(sk, fl6.flowlabel);
1294
			if (!flowlabel)
L
Linus Torvalds 已提交
1295 1296 1297 1298
				return -EINVAL;
		}
		if (!(opt->opt_nflen|opt->opt_flen))
			opt = NULL;
1299
		connected = 0;
L
Linus Torvalds 已提交
1300
	}
1301 1302 1303 1304
	if (!opt) {
		opt = txopt_get(np);
		opt_to_free = opt;
	}
1305 1306 1307
	if (flowlabel)
		opt = fl6_merge_options(&opt_space, flowlabel, opt);
	opt = ipv6_fixup_options(&opt_space, opt);
L
Linus Torvalds 已提交
1308

1309
	fl6.flowi6_proto = sk->sk_protocol;
1310
	if (!ipv6_addr_any(daddr))
A
Alexey Dobriyan 已提交
1311
		fl6.daddr = *daddr;
1312
	else
1313 1314
		fl6.daddr.s6_addr[15] = 0x1; /* :: means loopback (BSD'ism) */
	if (ipv6_addr_any(&fl6.saddr) && !ipv6_addr_any(&np->saddr))
A
Alexey Dobriyan 已提交
1315
		fl6.saddr = np->saddr;
1316
	fl6.fl6_sport = inet->inet_sport;
1317

1318
	final_p = fl6_update_dst(&fl6, opt, &final);
1319
	if (final_p)
1320
		connected = 0;
L
Linus Torvalds 已提交
1321

1322 1323
	if (!fl6.flowi6_oif && ipv6_addr_is_multicast(&fl6.daddr)) {
		fl6.flowi6_oif = np->mcast_oif;
1324
		connected = 0;
1325 1326
	} else if (!fl6.flowi6_oif)
		fl6.flowi6_oif = np->ucast_oif;
L
Linus Torvalds 已提交
1327

1328
	security_sk_classify_flow(sk, flowi6_to_flowi(&fl6));
V
Venkat Yekkirala 已提交
1329

1330
	dst = ip6_sk_dst_lookup_flow(sk, &fl6, final_p);
1331 1332 1333
	if (IS_ERR(dst)) {
		err = PTR_ERR(dst);
		dst = NULL;
L
Linus Torvalds 已提交
1334
		goto out;
1335
	}
L
Linus Torvalds 已提交
1336

1337 1338
	if (hlimit < 0)
		hlimit = ip6_sk_dst_hoplimit(np, &fl6, dst);
L
Linus Torvalds 已提交
1339

G
Gerrit Renker 已提交
1340
	if (tclass < 0)
1341 1342
		tclass = np->tclass;

L
Linus Torvalds 已提交
1343 1344 1345 1346
	if (msg->msg_flags&MSG_CONFIRM)
		goto do_confirm;
back_from_confirm:

1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360
	/* Lockless fast path for the non-corking case */
	if (!corkreq) {
		struct sk_buff *skb;

		skb = ip6_make_skb(sk, getfrag, msg, ulen,
				   sizeof(struct udphdr), hlimit, tclass, opt,
				   &fl6, (struct rt6_info *)dst,
				   msg->msg_flags, dontfrag);
		err = PTR_ERR(skb);
		if (!IS_ERR_OR_NULL(skb))
			err = udp_v6_send_skb(skb, &fl6);
		goto release_dst;
	}

L
Linus Torvalds 已提交
1361 1362 1363 1364 1365 1366
	lock_sock(sk);
	if (unlikely(up->pending)) {
		/* The socket is already corked while preparing it. */
		/* ... which is an evident application bug. --ANK */
		release_sock(sk);

1367
		net_dbg_ratelimited("udp cork app bug 2\n");
L
Linus Torvalds 已提交
1368 1369 1370 1371 1372 1373 1374
		err = -EINVAL;
		goto out;
	}

	up->pending = AF_INET6;

do_append_data:
1375 1376
	if (dontfrag < 0)
		dontfrag = np->dontfrag;
L
Linus Torvalds 已提交
1377
	up->len += ulen;
1378
	err = ip6_append_data(sk, getfrag, msg, ulen,
1379
		sizeof(struct udphdr), hlimit, tclass, opt, &fl6,
1380
		(struct rt6_info *)dst,
1381
		corkreq ? msg->msg_flags|MSG_MORE : msg->msg_flags, dontfrag);
L
Linus Torvalds 已提交
1382 1383 1384
	if (err)
		udp_v6_flush_pending_frames(sk);
	else if (!corkreq)
1385
		err = udp_v6_push_pending_frames(sk);
H
Herbert Xu 已提交
1386 1387
	else if (unlikely(skb_queue_empty(&sk->sk_write_queue)))
		up->pending = 0;
L
Linus Torvalds 已提交
1388

1389 1390 1391 1392 1393
	if (err > 0)
		err = np->recverr ? net_xmit_errno(err) : 0;
	release_sock(sk);

release_dst:
1394 1395 1396
	if (dst) {
		if (connected) {
			ip6_dst_store(sk, dst,
1397 1398
				      ipv6_addr_equal(&fl6.daddr, &sk->sk_v6_daddr) ?
				      &sk->sk_v6_daddr : NULL,
1399
#ifdef CONFIG_IPV6_SUBTREES
1400
				      ipv6_addr_equal(&fl6.saddr, &np->saddr) ?
1401 1402 1403
				      &np->saddr :
#endif
				      NULL);
1404 1405 1406
		} else {
			dst_release(dst);
		}
1407
		dst = NULL;
1408 1409
	}

L
Linus Torvalds 已提交
1410
out:
1411
	dst_release(dst);
L
Linus Torvalds 已提交
1412
	fl6_sock_release(flowlabel);
1413
	txopt_put(opt_to_free);
1414
	if (!err)
L
Linus Torvalds 已提交
1415
		return len;
1416 1417 1418 1419 1420 1421 1422 1423
	/*
	 * ENOBUFS = no kernel mem, SOCK_NOSPACE = no sndbuf space.  Reporting
	 * ENOBUFS might not be good (it's not tunable per se), but otherwise
	 * we don't have a good statistic (IpOutDiscards but it can be too many
	 * things).  We could add another new stat but at least for now that
	 * seems like overkill.
	 */
	if (err == -ENOBUFS || test_bit(SOCK_NOSPACE, &sk->sk_socket->flags)) {
1424 1425
		UDP6_INC_STATS_USER(sock_net(sk),
				UDP_MIB_SNDBUFERRORS, is_udplite);
1426
	}
L
Linus Torvalds 已提交
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
	return err;

do_confirm:
	dst_confirm(dst);
	if (!(msg->msg_flags&MSG_PROBE) || len)
		goto back_from_confirm;
	err = 0;
	goto out;
}

1437
void udpv6_destroy_sock(struct sock *sk)
L
Linus Torvalds 已提交
1438
{
T
Tom Parkin 已提交
1439
	struct udp_sock *up = udp_sk(sk);
L
Linus Torvalds 已提交
1440 1441 1442 1443
	lock_sock(sk);
	udp_v6_flush_pending_frames(sk);
	release_sock(sk);

T
Tom Parkin 已提交
1444 1445 1446 1447 1448 1449 1450
	if (static_key_false(&udpv6_encap_needed) && up->encap_type) {
		void (*encap_destroy)(struct sock *sk);
		encap_destroy = ACCESS_ONCE(up->encap_destroy);
		if (encap_destroy)
			encap_destroy(sk);
	}

L
Linus Torvalds 已提交
1451 1452 1453 1454 1455 1456
	inet6_destroy_sock(sk);
}

/*
 *	Socket option code for UDP
 */
1457
int udpv6_setsockopt(struct sock *sk, int level, int optname,
1458
		     char __user *optval, unsigned int optlen)
1459
{
1460
	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1461 1462
		return udp_lib_setsockopt(sk, level, optname, optval, optlen,
					  udp_v6_push_pending_frames);
1463
	return ipv6_setsockopt(sk, level, optname, optval, optlen);
1464 1465 1466
}

#ifdef CONFIG_COMPAT
1467
int compat_udpv6_setsockopt(struct sock *sk, int level, int optname,
1468
			    char __user *optval, unsigned int optlen)
1469
{
1470
	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1471 1472
		return udp_lib_setsockopt(sk, level, optname, optval, optlen,
					  udp_v6_push_pending_frames);
1473
	return compat_ipv6_setsockopt(sk, level, optname, optval, optlen);
1474 1475 1476
}
#endif

1477 1478
int udpv6_getsockopt(struct sock *sk, int level, int optname,
		     char __user *optval, int __user *optlen)
1479
{
1480
	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1481
		return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1482
	return ipv6_getsockopt(sk, level, optname, optval, optlen);
1483 1484 1485
}

#ifdef CONFIG_COMPAT
1486 1487
int compat_udpv6_getsockopt(struct sock *sk, int level, int optname,
			    char __user *optval, int __user *optlen)
1488
{
1489
	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1490
		return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1491
	return compat_ipv6_getsockopt(sk, level, optname, optval, optlen);
1492 1493 1494
}
#endif

1495
static const struct inet6_protocol udpv6_protocol = {
L
Linus Torvalds 已提交
1496 1497 1498 1499 1500 1501 1502
	.handler	=	udpv6_rcv,
	.err_handler	=	udpv6_err,
	.flags		=	INET6_PROTO_NOPOLICY|INET6_PROTO_FINAL,
};

/* ------------------------------------------------------------------------ */
#ifdef CONFIG_PROC_FS
1503
int udp6_seq_show(struct seq_file *seq, void *v)
L
Linus Torvalds 已提交
1504
{
1505 1506 1507 1508 1509 1510 1511 1512 1513
	if (v == SEQ_START_TOKEN) {
		seq_puts(seq, IPV6_SEQ_DGRAM_HEADER);
	} else {
		int bucket = ((struct udp_iter_state *)seq->private)->bucket;
		struct inet_sock *inet = inet_sk(v);
		__u16 srcp = ntohs(inet->inet_sport);
		__u16 destp = ntohs(inet->inet_dport);
		ip6_dgram_sock_seq_show(seq, v, srcp, destp, bucket);
	}
L
Linus Torvalds 已提交
1514 1515 1516
	return 0;
}

1517 1518 1519 1520 1521 1522 1523 1524
static const struct file_operations udp6_afinfo_seq_fops = {
	.owner    = THIS_MODULE,
	.open     = udp_seq_open,
	.read     = seq_read,
	.llseek   = seq_lseek,
	.release  = seq_release_net
};

L
Linus Torvalds 已提交
1525 1526 1527
static struct udp_seq_afinfo udp6_seq_afinfo = {
	.name		= "udp6",
	.family		= AF_INET6,
1528
	.udp_table	= &udp_table,
1529
	.seq_fops	= &udp6_afinfo_seq_fops,
1530 1531 1532
	.seq_ops	= {
		.show		= udp6_seq_show,
	},
L
Linus Torvalds 已提交
1533 1534
};

1535
int __net_init udp6_proc_init(struct net *net)
L
Linus Torvalds 已提交
1536
{
1537
	return udp_proc_register(net, &udp6_seq_afinfo);
L
Linus Torvalds 已提交
1538 1539
}

I
Ian Morris 已提交
1540 1541
void udp6_proc_exit(struct net *net)
{
1542
	udp_proc_unregister(net, &udp6_seq_afinfo);
L
Linus Torvalds 已提交
1543 1544 1545
}
#endif /* CONFIG_PROC_FS */

E
Eric Dumazet 已提交
1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556
void udp_v6_clear_sk(struct sock *sk, int size)
{
	struct inet_sock *inet = inet_sk(sk);

	/* we do not want to clear pinet6 field, because of RCU lookups */
	sk_prot_clear_portaddr_nulls(sk, offsetof(struct inet_sock, pinet6));

	size -= offsetof(struct inet_sock, pinet6) + sizeof(inet->pinet6);
	memset(&inet->pinet6 + 1, 0, size);
}

L
Linus Torvalds 已提交
1557 1558 1559
/* ------------------------------------------------------------------------ */

struct proto udpv6_prot = {
1560 1561
	.name		   = "UDPv6",
	.owner		   = THIS_MODULE,
1562
	.close		   = udp_lib_close,
1563 1564 1565 1566 1567 1568 1569 1570
	.connect	   = ip6_datagram_connect,
	.disconnect	   = udp_disconnect,
	.ioctl		   = udp_ioctl,
	.destroy	   = udpv6_destroy_sock,
	.setsockopt	   = udpv6_setsockopt,
	.getsockopt	   = udpv6_getsockopt,
	.sendmsg	   = udpv6_sendmsg,
	.recvmsg	   = udpv6_recvmsg,
1571
	.backlog_rcv	   = __udpv6_queue_rcv_skb,
1572 1573
	.hash		   = udp_lib_hash,
	.unhash		   = udp_lib_unhash,
E
Eric Dumazet 已提交
1574
	.rehash		   = udp_v6_rehash,
1575
	.get_port	   = udp_v6_get_port,
H
Hideo Aoki 已提交
1576 1577 1578 1579
	.memory_allocated  = &udp_memory_allocated,
	.sysctl_mem	   = sysctl_udp_mem,
	.sysctl_wmem	   = &sysctl_udp_wmem_min,
	.sysctl_rmem	   = &sysctl_udp_rmem_min,
1580
	.obj_size	   = sizeof(struct udp6_sock),
1581
	.slab_flags	   = SLAB_DESTROY_BY_RCU,
1582
	.h.udp_table	   = &udp_table,
1583
#ifdef CONFIG_COMPAT
1584 1585
	.compat_setsockopt = compat_udpv6_setsockopt,
	.compat_getsockopt = compat_udpv6_getsockopt,
1586
#endif
E
Eric Dumazet 已提交
1587
	.clear_sk	   = udp_v6_clear_sk,
L
Linus Torvalds 已提交
1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
};

static struct inet_protosw udpv6_protosw = {
	.type =      SOCK_DGRAM,
	.protocol =  IPPROTO_UDP,
	.prot =      &udpv6_prot,
	.ops =       &inet6_dgram_ops,
	.flags =     INET_PROTOSW_PERMANENT,
};

1598
int __init udpv6_init(void)
L
Linus Torvalds 已提交
1599
{
1600 1601
	int ret;

1602 1603
	ret = inet6_add_protocol(&udpv6_protocol, IPPROTO_UDP);
	if (ret)
1604
		goto out;
1605

1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616
	ret = inet6_register_protosw(&udpv6_protosw);
	if (ret)
		goto out_udpv6_protocol;
out:
	return ret;

out_udpv6_protocol:
	inet6_del_protocol(&udpv6_protocol, IPPROTO_UDP);
	goto out;
}

1617
void udpv6_exit(void)
1618 1619 1620
{
	inet6_unregister_protosw(&udpv6_protosw);
	inet6_del_protocol(&udpv6_protocol, IPPROTO_UDP);
L
Linus Torvalds 已提交
1621
}