xref: /linux/net/ipv4/udp.c (revision 8822b64a0fa64a5dd1dfcf837c5b0be83f8c05d1)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * INET		An implementation of the TCP/IP protocol suite for the LINUX
31da177e4SLinus Torvalds  *		operating system.  INET is implemented using the  BSD Socket
41da177e4SLinus Torvalds  *		interface as the means of communication with the user level.
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  *		The User Datagram Protocol (UDP).
71da177e4SLinus Torvalds  *
802c30a84SJesper Juhl  * Authors:	Ross Biro
91da177e4SLinus Torvalds  *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
101da177e4SLinus Torvalds  *		Arnt Gulbrandsen, <agulbra@nvg.unit.no>
11113aa838SAlan Cox  *		Alan Cox, <alan@lxorguk.ukuu.org.uk>
121da177e4SLinus Torvalds  *		Hirokazu Takahashi, <taka@valinux.co.jp>
131da177e4SLinus Torvalds  *
141da177e4SLinus Torvalds  * Fixes:
151da177e4SLinus Torvalds  *		Alan Cox	:	verify_area() calls
161da177e4SLinus Torvalds  *		Alan Cox	: 	stopped close while in use off icmp
171da177e4SLinus Torvalds  *					messages. Not a fix but a botch that
181da177e4SLinus Torvalds  *					for udp at least is 'valid'.
191da177e4SLinus Torvalds  *		Alan Cox	:	Fixed icmp handling properly
201da177e4SLinus Torvalds  *		Alan Cox	: 	Correct error for oversized datagrams
211da177e4SLinus Torvalds  *		Alan Cox	:	Tidied select() semantics.
221da177e4SLinus Torvalds  *		Alan Cox	:	udp_err() fixed properly, also now
231da177e4SLinus Torvalds  *					select and read wake correctly on errors
241da177e4SLinus Torvalds  *		Alan Cox	:	udp_send verify_area moved to avoid mem leak
251da177e4SLinus Torvalds  *		Alan Cox	:	UDP can count its memory
261da177e4SLinus Torvalds  *		Alan Cox	:	send to an unknown connection causes
271da177e4SLinus Torvalds  *					an ECONNREFUSED off the icmp, but
281da177e4SLinus Torvalds  *					does NOT close.
291da177e4SLinus Torvalds  *		Alan Cox	:	Switched to new sk_buff handlers. No more backlog!
301da177e4SLinus Torvalds  *		Alan Cox	:	Using generic datagram code. Even smaller and the PEEK
311da177e4SLinus Torvalds  *					bug no longer crashes it.
321da177e4SLinus Torvalds  *		Fred Van Kempen	: 	Net2e support for sk->broadcast.
331da177e4SLinus Torvalds  *		Alan Cox	:	Uses skb_free_datagram
341da177e4SLinus Torvalds  *		Alan Cox	:	Added get/set sockopt support.
351da177e4SLinus Torvalds  *		Alan Cox	:	Broadcasting without option set returns EACCES.
361da177e4SLinus Torvalds  *		Alan Cox	:	No wakeup calls. Instead we now use the callbacks.
371da177e4SLinus Torvalds  *		Alan Cox	:	Use ip_tos and ip_ttl
381da177e4SLinus Torvalds  *		Alan Cox	:	SNMP Mibs
391da177e4SLinus Torvalds  *		Alan Cox	:	MSG_DONTROUTE, and 0.0.0.0 support.
401da177e4SLinus Torvalds  *		Matt Dillon	:	UDP length checks.
411da177e4SLinus Torvalds  *		Alan Cox	:	Smarter af_inet used properly.
421da177e4SLinus Torvalds  *		Alan Cox	:	Use new kernel side addressing.
431da177e4SLinus Torvalds  *		Alan Cox	:	Incorrect return on truncated datagram receive.
441da177e4SLinus Torvalds  *	Arnt Gulbrandsen 	:	New udp_send and stuff
451da177e4SLinus Torvalds  *		Alan Cox	:	Cache last socket
461da177e4SLinus Torvalds  *		Alan Cox	:	Route cache
471da177e4SLinus Torvalds  *		Jon Peatfield	:	Minor efficiency fix to sendto().
481da177e4SLinus Torvalds  *		Mike Shaver	:	RFC1122 checks.
491da177e4SLinus Torvalds  *		Alan Cox	:	Nonblocking error fix.
501da177e4SLinus Torvalds  *	Willy Konynenberg	:	Transparent proxying support.
511da177e4SLinus Torvalds  *		Mike McLagan	:	Routing by source
521da177e4SLinus Torvalds  *		David S. Miller	:	New socket lookup architecture.
531da177e4SLinus Torvalds  *					Last socket cache retained as it
541da177e4SLinus Torvalds  *					does have a high hit rate.
551da177e4SLinus Torvalds  *		Olaf Kirch	:	Don't linearise iovec on sendmsg.
561da177e4SLinus Torvalds  *		Andi Kleen	:	Some cleanups, cache destination entry
571da177e4SLinus Torvalds  *					for connect.
581da177e4SLinus Torvalds  *	Vitaly E. Lavrov	:	Transparent proxy revived after year coma.
591da177e4SLinus Torvalds  *		Melvin Smith	:	Check msg_name not msg_namelen in sendto(),
601da177e4SLinus Torvalds  *					return ENOTCONN for unconnected sockets (POSIX)
611da177e4SLinus Torvalds  *		Janos Farkas	:	don't deliver multi/broadcasts to a different
621da177e4SLinus Torvalds  *					bound-to-device socket
631da177e4SLinus Torvalds  *	Hirokazu Takahashi	:	HW checksumming for outgoing UDP
641da177e4SLinus Torvalds  *					datagrams.
651da177e4SLinus Torvalds  *	Hirokazu Takahashi	:	sendfile() on UDP works now.
661da177e4SLinus Torvalds  *		Arnaldo C. Melo :	convert /proc/net/udp to seq_file
671da177e4SLinus Torvalds  *	YOSHIFUJI Hideaki @USAGI and:	Support IPV6_V6ONLY socket option, which
681da177e4SLinus Torvalds  *	Alexey Kuznetsov:		allow both IPv4 and IPv6 sockets to bind
691da177e4SLinus Torvalds  *					a single port at the same time.
701da177e4SLinus Torvalds  *	Derek Atkins <derek@ihtfp.com>: Add Encapulation Support
71342f0234SJames Chapman  *	James Chapman		:	Add L2TP encapsulation type.
721da177e4SLinus Torvalds  *
731da177e4SLinus Torvalds  *
741da177e4SLinus Torvalds  *		This program is free software; you can redistribute it and/or
751da177e4SLinus Torvalds  *		modify it under the terms of the GNU General Public License
761da177e4SLinus Torvalds  *		as published by the Free Software Foundation; either version
771da177e4SLinus Torvalds  *		2 of the License, or (at your option) any later version.
781da177e4SLinus Torvalds  */
791da177e4SLinus Torvalds 
80afd46503SJoe Perches #define pr_fmt(fmt) "UDP: " fmt
81afd46503SJoe Perches 
821da177e4SLinus Torvalds #include <asm/uaccess.h>
831da177e4SLinus Torvalds #include <asm/ioctls.h>
8495766fffSHideo Aoki #include <linux/bootmem.h>
858203efb3SEric Dumazet #include <linux/highmem.h>
868203efb3SEric Dumazet #include <linux/swap.h>
871da177e4SLinus Torvalds #include <linux/types.h>
881da177e4SLinus Torvalds #include <linux/fcntl.h>
891da177e4SLinus Torvalds #include <linux/module.h>
901da177e4SLinus Torvalds #include <linux/socket.h>
911da177e4SLinus Torvalds #include <linux/sockios.h>
9214c85021SArnaldo Carvalho de Melo #include <linux/igmp.h>
931da177e4SLinus Torvalds #include <linux/in.h>
941da177e4SLinus Torvalds #include <linux/errno.h>
951da177e4SLinus Torvalds #include <linux/timer.h>
961da177e4SLinus Torvalds #include <linux/mm.h>
971da177e4SLinus Torvalds #include <linux/inet.h>
981da177e4SLinus Torvalds #include <linux/netdevice.h>
995a0e3ad6STejun Heo #include <linux/slab.h>
100c752f073SArnaldo Carvalho de Melo #include <net/tcp_states.h>
1011da177e4SLinus Torvalds #include <linux/skbuff.h>
1021da177e4SLinus Torvalds #include <linux/proc_fs.h>
1031da177e4SLinus Torvalds #include <linux/seq_file.h>
104457c4cbcSEric W. Biederman #include <net/net_namespace.h>
1051da177e4SLinus Torvalds #include <net/icmp.h>
1061da177e4SLinus Torvalds #include <net/route.h>
1071da177e4SLinus Torvalds #include <net/checksum.h>
1081da177e4SLinus Torvalds #include <net/xfrm.h>
109296f7ea7SSatoru Moriya #include <trace/events/udp.h>
110447167bfSEric Dumazet #include <linux/static_key.h>
11122911fc5SEric Dumazet #include <trace/events/skb.h>
112a5b50476SEliezer Tamir #include <net/ll_poll.h>
113ba4e58ecSGerrit Renker #include "udp_impl.h"
1141da177e4SLinus Torvalds 
115f86dcc5aSEric Dumazet struct udp_table udp_table __read_mostly;
116645ca708SEric Dumazet EXPORT_SYMBOL(udp_table);
1171da177e4SLinus Torvalds 
1188d987e5cSEric Dumazet long sysctl_udp_mem[3] __read_mostly;
11995766fffSHideo Aoki EXPORT_SYMBOL(sysctl_udp_mem);
120c482c568SEric Dumazet 
121c482c568SEric Dumazet int sysctl_udp_rmem_min __read_mostly;
12295766fffSHideo Aoki EXPORT_SYMBOL(sysctl_udp_rmem_min);
123c482c568SEric Dumazet 
124c482c568SEric Dumazet int sysctl_udp_wmem_min __read_mostly;
12595766fffSHideo Aoki EXPORT_SYMBOL(sysctl_udp_wmem_min);
12695766fffSHideo Aoki 
1278d987e5cSEric Dumazet atomic_long_t udp_memory_allocated;
12895766fffSHideo Aoki EXPORT_SYMBOL(udp_memory_allocated);
12995766fffSHideo Aoki 
130f86dcc5aSEric Dumazet #define MAX_UDP_PORTS 65536
131f86dcc5aSEric Dumazet #define PORTS_PER_CHAIN (MAX_UDP_PORTS / UDP_HTABLE_SIZE_MIN)
13298322f22SEric Dumazet 
133f24d43c0SEric Dumazet static int udp_lib_lport_inuse(struct net *net, __u16 num,
134645ca708SEric Dumazet 			       const struct udp_hslot *hslot,
13598322f22SEric Dumazet 			       unsigned long *bitmap,
136f24d43c0SEric Dumazet 			       struct sock *sk,
137f24d43c0SEric Dumazet 			       int (*saddr_comp)(const struct sock *sk1,
138f86dcc5aSEric Dumazet 						 const struct sock *sk2),
139f86dcc5aSEric Dumazet 			       unsigned int log)
14025030a7fSGerrit Renker {
141f24d43c0SEric Dumazet 	struct sock *sk2;
14288ab1932SEric Dumazet 	struct hlist_nulls_node *node;
143ba418fa3STom Herbert 	kuid_t uid = sock_i_uid(sk);
14425030a7fSGerrit Renker 
14588ab1932SEric Dumazet 	sk_nulls_for_each(sk2, node, &hslot->head)
146f24d43c0SEric Dumazet 		if (net_eq(sock_net(sk2), net) &&
147f24d43c0SEric Dumazet 		    sk2 != sk &&
148d4cada4aSEric Dumazet 		    (bitmap || udp_sk(sk2)->udp_port_hash == num) &&
149f24d43c0SEric Dumazet 		    (!sk2->sk_reuse || !sk->sk_reuse) &&
1509d4fb27dSJoe Perches 		    (!sk2->sk_bound_dev_if || !sk->sk_bound_dev_if ||
1519d4fb27dSJoe Perches 		     sk2->sk_bound_dev_if == sk->sk_bound_dev_if) &&
152ba418fa3STom Herbert 		    (!sk2->sk_reuseport || !sk->sk_reuseport ||
153ba418fa3STom Herbert 		      !uid_eq(uid, sock_i_uid(sk2))) &&
15498322f22SEric Dumazet 		    (*saddr_comp)(sk, sk2)) {
15598322f22SEric Dumazet 			if (bitmap)
156d4cada4aSEric Dumazet 				__set_bit(udp_sk(sk2)->udp_port_hash >> log,
157d4cada4aSEric Dumazet 					  bitmap);
15898322f22SEric Dumazet 			else
159fc038410SDavid S. Miller 				return 1;
16098322f22SEric Dumazet 		}
16125030a7fSGerrit Renker 	return 0;
16225030a7fSGerrit Renker }
16325030a7fSGerrit Renker 
16430fff923SEric Dumazet /*
16530fff923SEric Dumazet  * Note: we still hold spinlock of primary hash chain, so no other writer
16630fff923SEric Dumazet  * can insert/delete a socket with local_port == num
16730fff923SEric Dumazet  */
16830fff923SEric Dumazet static int udp_lib_lport_inuse2(struct net *net, __u16 num,
16930fff923SEric Dumazet 			       struct udp_hslot *hslot2,
17030fff923SEric Dumazet 			       struct sock *sk,
17130fff923SEric Dumazet 			       int (*saddr_comp)(const struct sock *sk1,
17230fff923SEric Dumazet 						 const struct sock *sk2))
17330fff923SEric Dumazet {
17430fff923SEric Dumazet 	struct sock *sk2;
17530fff923SEric Dumazet 	struct hlist_nulls_node *node;
176ba418fa3STom Herbert 	kuid_t uid = sock_i_uid(sk);
17730fff923SEric Dumazet 	int res = 0;
17830fff923SEric Dumazet 
17930fff923SEric Dumazet 	spin_lock(&hslot2->lock);
18030fff923SEric Dumazet 	udp_portaddr_for_each_entry(sk2, node, &hslot2->head)
18130fff923SEric Dumazet 		if (net_eq(sock_net(sk2), net) &&
18230fff923SEric Dumazet 		    sk2 != sk &&
18330fff923SEric Dumazet 		    (udp_sk(sk2)->udp_port_hash == num) &&
18430fff923SEric Dumazet 		    (!sk2->sk_reuse || !sk->sk_reuse) &&
1859d4fb27dSJoe Perches 		    (!sk2->sk_bound_dev_if || !sk->sk_bound_dev_if ||
1869d4fb27dSJoe Perches 		     sk2->sk_bound_dev_if == sk->sk_bound_dev_if) &&
187ba418fa3STom Herbert 		    (!sk2->sk_reuseport || !sk->sk_reuseport ||
188ba418fa3STom Herbert 		      !uid_eq(uid, sock_i_uid(sk2))) &&
18930fff923SEric Dumazet 		    (*saddr_comp)(sk, sk2)) {
19030fff923SEric Dumazet 			res = 1;
19130fff923SEric Dumazet 			break;
19230fff923SEric Dumazet 		}
19330fff923SEric Dumazet 	spin_unlock(&hslot2->lock);
19430fff923SEric Dumazet 	return res;
19530fff923SEric Dumazet }
19630fff923SEric Dumazet 
19725030a7fSGerrit Renker /**
1986ba5a3c5SPavel Emelyanov  *  udp_lib_get_port  -  UDP/-Lite port lookup for IPv4 and IPv6
19925030a7fSGerrit Renker  *
20025030a7fSGerrit Renker  *  @sk:          socket struct in question
20125030a7fSGerrit Renker  *  @snum:        port number to look up
202df2bc459SDavid S. Miller  *  @saddr_comp:  AF-dependent comparison of bound local IP addresses
20325985edcSLucas De Marchi  *  @hash2_nulladdr: AF-dependent hash value in secondary hash chains,
20430fff923SEric Dumazet  *                   with NULL address
20525030a7fSGerrit Renker  */
2066ba5a3c5SPavel Emelyanov int udp_lib_get_port(struct sock *sk, unsigned short snum,
207df2bc459SDavid S. Miller 		       int (*saddr_comp)(const struct sock *sk1,
20830fff923SEric Dumazet 					 const struct sock *sk2),
20930fff923SEric Dumazet 		     unsigned int hash2_nulladdr)
2101da177e4SLinus Torvalds {
211512615b6SEric Dumazet 	struct udp_hslot *hslot, *hslot2;
212645ca708SEric Dumazet 	struct udp_table *udptable = sk->sk_prot->h.udp_table;
21325030a7fSGerrit Renker 	int    error = 1;
2143b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(sk);
2151da177e4SLinus Torvalds 
21632c1da70SStephen Hemminger 	if (!snum) {
2179088c560SEric Dumazet 		int low, high, remaining;
21895c96174SEric Dumazet 		unsigned int rand;
21998322f22SEric Dumazet 		unsigned short first, last;
22098322f22SEric Dumazet 		DECLARE_BITMAP(bitmap, PORTS_PER_CHAIN);
2211da177e4SLinus Torvalds 
222227b60f5SStephen Hemminger 		inet_get_local_port_range(&low, &high);
223a25de534SAnton Arapov 		remaining = (high - low) + 1;
224227b60f5SStephen Hemminger 
2259088c560SEric Dumazet 		rand = net_random();
22698322f22SEric Dumazet 		first = (((u64)rand * remaining) >> 32) + low;
22798322f22SEric Dumazet 		/*
22898322f22SEric Dumazet 		 * force rand to be an odd multiple of UDP_HTABLE_SIZE
22998322f22SEric Dumazet 		 */
230f86dcc5aSEric Dumazet 		rand = (rand | 1) * (udptable->mask + 1);
2315781b235SEric Dumazet 		last = first + udptable->mask + 1;
2325781b235SEric Dumazet 		do {
233f86dcc5aSEric Dumazet 			hslot = udp_hashslot(udptable, net, first);
23498322f22SEric Dumazet 			bitmap_zero(bitmap, PORTS_PER_CHAIN);
235645ca708SEric Dumazet 			spin_lock_bh(&hslot->lock);
23698322f22SEric Dumazet 			udp_lib_lport_inuse(net, snum, hslot, bitmap, sk,
237f86dcc5aSEric Dumazet 					    saddr_comp, udptable->log);
23898322f22SEric Dumazet 
23998322f22SEric Dumazet 			snum = first;
24098322f22SEric Dumazet 			/*
24198322f22SEric Dumazet 			 * Iterate on all possible values of snum for this hash.
24298322f22SEric Dumazet 			 * Using steps of an odd multiple of UDP_HTABLE_SIZE
24398322f22SEric Dumazet 			 * give us randomization and full range coverage.
24498322f22SEric Dumazet 			 */
2459088c560SEric Dumazet 			do {
24698322f22SEric Dumazet 				if (low <= snum && snum <= high &&
247e3826f1eSAmerigo Wang 				    !test_bit(snum >> udptable->log, bitmap) &&
248e3826f1eSAmerigo Wang 				    !inet_is_reserved_local_port(snum))
24998322f22SEric Dumazet 					goto found;
25098322f22SEric Dumazet 				snum += rand;
25198322f22SEric Dumazet 			} while (snum != first);
25298322f22SEric Dumazet 			spin_unlock_bh(&hslot->lock);
2535781b235SEric Dumazet 		} while (++first != last);
25498322f22SEric Dumazet 		goto fail;
255645ca708SEric Dumazet 	} else {
256f86dcc5aSEric Dumazet 		hslot = udp_hashslot(udptable, net, snum);
257645ca708SEric Dumazet 		spin_lock_bh(&hslot->lock);
25830fff923SEric Dumazet 		if (hslot->count > 10) {
25930fff923SEric Dumazet 			int exist;
26030fff923SEric Dumazet 			unsigned int slot2 = udp_sk(sk)->udp_portaddr_hash ^ snum;
26130fff923SEric Dumazet 
26230fff923SEric Dumazet 			slot2          &= udptable->mask;
26330fff923SEric Dumazet 			hash2_nulladdr &= udptable->mask;
26430fff923SEric Dumazet 
26530fff923SEric Dumazet 			hslot2 = udp_hashslot2(udptable, slot2);
26630fff923SEric Dumazet 			if (hslot->count < hslot2->count)
26730fff923SEric Dumazet 				goto scan_primary_hash;
26830fff923SEric Dumazet 
26930fff923SEric Dumazet 			exist = udp_lib_lport_inuse2(net, snum, hslot2,
27030fff923SEric Dumazet 						     sk, saddr_comp);
27130fff923SEric Dumazet 			if (!exist && (hash2_nulladdr != slot2)) {
27230fff923SEric Dumazet 				hslot2 = udp_hashslot2(udptable, hash2_nulladdr);
27330fff923SEric Dumazet 				exist = udp_lib_lport_inuse2(net, snum, hslot2,
27430fff923SEric Dumazet 							     sk, saddr_comp);
27530fff923SEric Dumazet 			}
27630fff923SEric Dumazet 			if (exist)
27730fff923SEric Dumazet 				goto fail_unlock;
27830fff923SEric Dumazet 			else
27930fff923SEric Dumazet 				goto found;
28030fff923SEric Dumazet 		}
28130fff923SEric Dumazet scan_primary_hash:
282f86dcc5aSEric Dumazet 		if (udp_lib_lport_inuse(net, snum, hslot, NULL, sk,
283f86dcc5aSEric Dumazet 					saddr_comp, 0))
284645ca708SEric Dumazet 			goto fail_unlock;
285645ca708SEric Dumazet 	}
28698322f22SEric Dumazet found:
287c720c7e8SEric Dumazet 	inet_sk(sk)->inet_num = snum;
288d4cada4aSEric Dumazet 	udp_sk(sk)->udp_port_hash = snum;
289d4cada4aSEric Dumazet 	udp_sk(sk)->udp_portaddr_hash ^= snum;
2901da177e4SLinus Torvalds 	if (sk_unhashed(sk)) {
29188ab1932SEric Dumazet 		sk_nulls_add_node_rcu(sk, &hslot->head);
292fdcc8aa9SEric Dumazet 		hslot->count++;
293c29a0bc4SPavel Emelyanov 		sock_prot_inuse_add(sock_net(sk), sk->sk_prot, 1);
294512615b6SEric Dumazet 
295512615b6SEric Dumazet 		hslot2 = udp_hashslot2(udptable, udp_sk(sk)->udp_portaddr_hash);
296512615b6SEric Dumazet 		spin_lock(&hslot2->lock);
297512615b6SEric Dumazet 		hlist_nulls_add_head_rcu(&udp_sk(sk)->udp_portaddr_node,
298512615b6SEric Dumazet 					 &hslot2->head);
299512615b6SEric Dumazet 		hslot2->count++;
300512615b6SEric Dumazet 		spin_unlock(&hslot2->lock);
3011da177e4SLinus Torvalds 	}
30225030a7fSGerrit Renker 	error = 0;
303645ca708SEric Dumazet fail_unlock:
304645ca708SEric Dumazet 	spin_unlock_bh(&hslot->lock);
3051da177e4SLinus Torvalds fail:
30625030a7fSGerrit Renker 	return error;
3071da177e4SLinus Torvalds }
308c482c568SEric Dumazet EXPORT_SYMBOL(udp_lib_get_port);
3091da177e4SLinus Torvalds 
310499923c7SVlad Yasevich static int ipv4_rcv_saddr_equal(const struct sock *sk1, const struct sock *sk2)
311db8dac20SDavid S. Miller {
312db8dac20SDavid S. Miller 	struct inet_sock *inet1 = inet_sk(sk1), *inet2 = inet_sk(sk2);
313db8dac20SDavid S. Miller 
314db8dac20SDavid S. Miller 	return 	(!ipv6_only_sock(sk2)  &&
315c720c7e8SEric Dumazet 		 (!inet1->inet_rcv_saddr || !inet2->inet_rcv_saddr ||
316c720c7e8SEric Dumazet 		   inet1->inet_rcv_saddr == inet2->inet_rcv_saddr));
317db8dac20SDavid S. Miller }
318db8dac20SDavid S. Miller 
319d4cada4aSEric Dumazet static unsigned int udp4_portaddr_hash(struct net *net, __be32 saddr,
320d4cada4aSEric Dumazet 				       unsigned int port)
321d4cada4aSEric Dumazet {
3220eae88f3SEric Dumazet 	return jhash_1word((__force u32)saddr, net_hash_mix(net)) ^ port;
323d4cada4aSEric Dumazet }
324d4cada4aSEric Dumazet 
3256ba5a3c5SPavel Emelyanov int udp_v4_get_port(struct sock *sk, unsigned short snum)
326db8dac20SDavid S. Miller {
32730fff923SEric Dumazet 	unsigned int hash2_nulladdr =
3280eae88f3SEric Dumazet 		udp4_portaddr_hash(sock_net(sk), htonl(INADDR_ANY), snum);
32930fff923SEric Dumazet 	unsigned int hash2_partial =
33030fff923SEric Dumazet 		udp4_portaddr_hash(sock_net(sk), inet_sk(sk)->inet_rcv_saddr, 0);
33130fff923SEric Dumazet 
332d4cada4aSEric Dumazet 	/* precompute partial secondary hash */
33330fff923SEric Dumazet 	udp_sk(sk)->udp_portaddr_hash = hash2_partial;
33430fff923SEric Dumazet 	return udp_lib_get_port(sk, snum, ipv4_rcv_saddr_equal, hash2_nulladdr);
335db8dac20SDavid S. Miller }
336db8dac20SDavid S. Miller 
337645ca708SEric Dumazet static inline int compute_score(struct sock *sk, struct net *net, __be32 saddr,
338645ca708SEric Dumazet 			 unsigned short hnum,
339645ca708SEric Dumazet 			 __be16 sport, __be32 daddr, __be16 dport, int dif)
340645ca708SEric Dumazet {
341645ca708SEric Dumazet 	int score = -1;
342645ca708SEric Dumazet 
343d4cada4aSEric Dumazet 	if (net_eq(sock_net(sk), net) && udp_sk(sk)->udp_port_hash == hnum &&
344645ca708SEric Dumazet 			!ipv6_only_sock(sk)) {
345645ca708SEric Dumazet 		struct inet_sock *inet = inet_sk(sk);
346645ca708SEric Dumazet 
347ba418fa3STom Herbert 		score = (sk->sk_family == PF_INET ? 2 : 1);
348c720c7e8SEric Dumazet 		if (inet->inet_rcv_saddr) {
349c720c7e8SEric Dumazet 			if (inet->inet_rcv_saddr != daddr)
350645ca708SEric Dumazet 				return -1;
351ba418fa3STom Herbert 			score += 4;
352645ca708SEric Dumazet 		}
353c720c7e8SEric Dumazet 		if (inet->inet_daddr) {
354c720c7e8SEric Dumazet 			if (inet->inet_daddr != saddr)
355645ca708SEric Dumazet 				return -1;
356ba418fa3STom Herbert 			score += 4;
357645ca708SEric Dumazet 		}
358c720c7e8SEric Dumazet 		if (inet->inet_dport) {
359c720c7e8SEric Dumazet 			if (inet->inet_dport != sport)
360645ca708SEric Dumazet 				return -1;
361ba418fa3STom Herbert 			score += 4;
362645ca708SEric Dumazet 		}
363645ca708SEric Dumazet 		if (sk->sk_bound_dev_if) {
364645ca708SEric Dumazet 			if (sk->sk_bound_dev_if != dif)
365645ca708SEric Dumazet 				return -1;
366ba418fa3STom Herbert 			score += 4;
367645ca708SEric Dumazet 		}
368645ca708SEric Dumazet 	}
369645ca708SEric Dumazet 	return score;
370645ca708SEric Dumazet }
371645ca708SEric Dumazet 
3725051ebd2SEric Dumazet /*
3735051ebd2SEric Dumazet  * In this second variant, we check (daddr, dport) matches (inet_rcv_sadd, inet_num)
3745051ebd2SEric Dumazet  */
3755051ebd2SEric Dumazet static inline int compute_score2(struct sock *sk, struct net *net,
3765051ebd2SEric Dumazet 				 __be32 saddr, __be16 sport,
3775051ebd2SEric Dumazet 				 __be32 daddr, unsigned int hnum, int dif)
3785051ebd2SEric Dumazet {
3795051ebd2SEric Dumazet 	int score = -1;
3805051ebd2SEric Dumazet 
3815051ebd2SEric Dumazet 	if (net_eq(sock_net(sk), net) && !ipv6_only_sock(sk)) {
3825051ebd2SEric Dumazet 		struct inet_sock *inet = inet_sk(sk);
3835051ebd2SEric Dumazet 
3845051ebd2SEric Dumazet 		if (inet->inet_rcv_saddr != daddr)
3855051ebd2SEric Dumazet 			return -1;
3865051ebd2SEric Dumazet 		if (inet->inet_num != hnum)
3875051ebd2SEric Dumazet 			return -1;
3885051ebd2SEric Dumazet 
389ba418fa3STom Herbert 		score = (sk->sk_family == PF_INET ? 2 : 1);
3905051ebd2SEric Dumazet 		if (inet->inet_daddr) {
3915051ebd2SEric Dumazet 			if (inet->inet_daddr != saddr)
3925051ebd2SEric Dumazet 				return -1;
393ba418fa3STom Herbert 			score += 4;
3945051ebd2SEric Dumazet 		}
3955051ebd2SEric Dumazet 		if (inet->inet_dport) {
3965051ebd2SEric Dumazet 			if (inet->inet_dport != sport)
3975051ebd2SEric Dumazet 				return -1;
398ba418fa3STom Herbert 			score += 4;
3995051ebd2SEric Dumazet 		}
4005051ebd2SEric Dumazet 		if (sk->sk_bound_dev_if) {
4015051ebd2SEric Dumazet 			if (sk->sk_bound_dev_if != dif)
4025051ebd2SEric Dumazet 				return -1;
403ba418fa3STom Herbert 			score += 4;
4045051ebd2SEric Dumazet 		}
4055051ebd2SEric Dumazet 	}
4065051ebd2SEric Dumazet 	return score;
4075051ebd2SEric Dumazet }
4085051ebd2SEric Dumazet 
4095051ebd2SEric Dumazet 
4105051ebd2SEric Dumazet /* called with read_rcu_lock() */
4115051ebd2SEric Dumazet static struct sock *udp4_lib_lookup2(struct net *net,
4125051ebd2SEric Dumazet 		__be32 saddr, __be16 sport,
4135051ebd2SEric Dumazet 		__be32 daddr, unsigned int hnum, int dif,
4145051ebd2SEric Dumazet 		struct udp_hslot *hslot2, unsigned int slot2)
4155051ebd2SEric Dumazet {
4165051ebd2SEric Dumazet 	struct sock *sk, *result;
4175051ebd2SEric Dumazet 	struct hlist_nulls_node *node;
418ba418fa3STom Herbert 	int score, badness, matches = 0, reuseport = 0;
419ba418fa3STom Herbert 	u32 hash = 0;
4205051ebd2SEric Dumazet 
4215051ebd2SEric Dumazet begin:
4225051ebd2SEric Dumazet 	result = NULL;
423ba418fa3STom Herbert 	badness = 0;
4245051ebd2SEric Dumazet 	udp_portaddr_for_each_entry_rcu(sk, node, &hslot2->head) {
4255051ebd2SEric Dumazet 		score = compute_score2(sk, net, saddr, sport,
4265051ebd2SEric Dumazet 				      daddr, hnum, dif);
4275051ebd2SEric Dumazet 		if (score > badness) {
4285051ebd2SEric Dumazet 			result = sk;
4295051ebd2SEric Dumazet 			badness = score;
430ba418fa3STom Herbert 			reuseport = sk->sk_reuseport;
431ba418fa3STom Herbert 			if (reuseport) {
432ba418fa3STom Herbert 				hash = inet_ehashfn(net, daddr, hnum,
4337c0cadc6SEric Dumazet 						    saddr, sport);
434ba418fa3STom Herbert 				matches = 1;
435ba418fa3STom Herbert 			}
436ba418fa3STom Herbert 		} else if (score == badness && reuseport) {
437ba418fa3STom Herbert 			matches++;
438ba418fa3STom Herbert 			if (((u64)hash * matches) >> 32 == 0)
439ba418fa3STom Herbert 				result = sk;
440ba418fa3STom Herbert 			hash = next_pseudo_random32(hash);
4415051ebd2SEric Dumazet 		}
4425051ebd2SEric Dumazet 	}
4435051ebd2SEric Dumazet 	/*
4445051ebd2SEric Dumazet 	 * if the nulls value we got at the end of this lookup is
4455051ebd2SEric Dumazet 	 * not the expected one, we must restart lookup.
4465051ebd2SEric Dumazet 	 * We probably met an item that was moved to another chain.
4475051ebd2SEric Dumazet 	 */
4485051ebd2SEric Dumazet 	if (get_nulls_value(node) != slot2)
4495051ebd2SEric Dumazet 		goto begin;
4505051ebd2SEric Dumazet 	if (result) {
451c31504dcSEric Dumazet 		if (unlikely(!atomic_inc_not_zero_hint(&result->sk_refcnt, 2)))
4525051ebd2SEric Dumazet 			result = NULL;
4535051ebd2SEric Dumazet 		else if (unlikely(compute_score2(result, net, saddr, sport,
4545051ebd2SEric Dumazet 				  daddr, hnum, dif) < badness)) {
4555051ebd2SEric Dumazet 			sock_put(result);
4565051ebd2SEric Dumazet 			goto begin;
4575051ebd2SEric Dumazet 		}
4585051ebd2SEric Dumazet 	}
4595051ebd2SEric Dumazet 	return result;
4605051ebd2SEric Dumazet }
4615051ebd2SEric Dumazet 
462db8dac20SDavid S. Miller /* UDP is nearly always wildcards out the wazoo, it makes no sense to try
463db8dac20SDavid S. Miller  * harder than this. -DaveM
464db8dac20SDavid S. Miller  */
465fce82338SPavel Emelyanov struct sock *__udp4_lib_lookup(struct net *net, __be32 saddr,
466db8dac20SDavid S. Miller 		__be16 sport, __be32 daddr, __be16 dport,
467645ca708SEric Dumazet 		int dif, struct udp_table *udptable)
468db8dac20SDavid S. Miller {
469271b72c7SEric Dumazet 	struct sock *sk, *result;
47088ab1932SEric Dumazet 	struct hlist_nulls_node *node;
471db8dac20SDavid S. Miller 	unsigned short hnum = ntohs(dport);
4725051ebd2SEric Dumazet 	unsigned int hash2, slot2, slot = udp_hashfn(net, hnum, udptable->mask);
4735051ebd2SEric Dumazet 	struct udp_hslot *hslot2, *hslot = &udptable->hash[slot];
474ba418fa3STom Herbert 	int score, badness, matches = 0, reuseport = 0;
475ba418fa3STom Herbert 	u32 hash = 0;
476db8dac20SDavid S. Miller 
477271b72c7SEric Dumazet 	rcu_read_lock();
4785051ebd2SEric Dumazet 	if (hslot->count > 10) {
4795051ebd2SEric Dumazet 		hash2 = udp4_portaddr_hash(net, daddr, hnum);
4805051ebd2SEric Dumazet 		slot2 = hash2 & udptable->mask;
4815051ebd2SEric Dumazet 		hslot2 = &udptable->hash2[slot2];
4825051ebd2SEric Dumazet 		if (hslot->count < hslot2->count)
4835051ebd2SEric Dumazet 			goto begin;
4845051ebd2SEric Dumazet 
4855051ebd2SEric Dumazet 		result = udp4_lib_lookup2(net, saddr, sport,
4865051ebd2SEric Dumazet 					  daddr, hnum, dif,
4875051ebd2SEric Dumazet 					  hslot2, slot2);
4885051ebd2SEric Dumazet 		if (!result) {
4890eae88f3SEric Dumazet 			hash2 = udp4_portaddr_hash(net, htonl(INADDR_ANY), hnum);
4905051ebd2SEric Dumazet 			slot2 = hash2 & udptable->mask;
4915051ebd2SEric Dumazet 			hslot2 = &udptable->hash2[slot2];
4925051ebd2SEric Dumazet 			if (hslot->count < hslot2->count)
4935051ebd2SEric Dumazet 				goto begin;
4945051ebd2SEric Dumazet 
4951223c67cSJorge Boncompte [DTI2] 			result = udp4_lib_lookup2(net, saddr, sport,
4960eae88f3SEric Dumazet 						  htonl(INADDR_ANY), hnum, dif,
4975051ebd2SEric Dumazet 						  hslot2, slot2);
4985051ebd2SEric Dumazet 		}
4995051ebd2SEric Dumazet 		rcu_read_unlock();
5005051ebd2SEric Dumazet 		return result;
5015051ebd2SEric Dumazet 	}
502271b72c7SEric Dumazet begin:
503271b72c7SEric Dumazet 	result = NULL;
504ba418fa3STom Herbert 	badness = 0;
50588ab1932SEric Dumazet 	sk_nulls_for_each_rcu(sk, node, &hslot->head) {
506645ca708SEric Dumazet 		score = compute_score(sk, net, saddr, hnum, sport,
507645ca708SEric Dumazet 				      daddr, dport, dif);
508645ca708SEric Dumazet 		if (score > badness) {
509db8dac20SDavid S. Miller 			result = sk;
510db8dac20SDavid S. Miller 			badness = score;
511ba418fa3STom Herbert 			reuseport = sk->sk_reuseport;
512ba418fa3STom Herbert 			if (reuseport) {
513ba418fa3STom Herbert 				hash = inet_ehashfn(net, daddr, hnum,
5147c0cadc6SEric Dumazet 						    saddr, sport);
515ba418fa3STom Herbert 				matches = 1;
516ba418fa3STom Herbert 			}
517ba418fa3STom Herbert 		} else if (score == badness && reuseport) {
518ba418fa3STom Herbert 			matches++;
519ba418fa3STom Herbert 			if (((u64)hash * matches) >> 32 == 0)
520ba418fa3STom Herbert 				result = sk;
521ba418fa3STom Herbert 			hash = next_pseudo_random32(hash);
522db8dac20SDavid S. Miller 		}
523db8dac20SDavid S. Miller 	}
52488ab1932SEric Dumazet 	/*
52588ab1932SEric Dumazet 	 * if the nulls value we got at the end of this lookup is
52688ab1932SEric Dumazet 	 * not the expected one, we must restart lookup.
52788ab1932SEric Dumazet 	 * We probably met an item that was moved to another chain.
52888ab1932SEric Dumazet 	 */
5295051ebd2SEric Dumazet 	if (get_nulls_value(node) != slot)
53088ab1932SEric Dumazet 		goto begin;
53188ab1932SEric Dumazet 
532271b72c7SEric Dumazet 	if (result) {
533c31504dcSEric Dumazet 		if (unlikely(!atomic_inc_not_zero_hint(&result->sk_refcnt, 2)))
534271b72c7SEric Dumazet 			result = NULL;
535271b72c7SEric Dumazet 		else if (unlikely(compute_score(result, net, saddr, hnum, sport,
536271b72c7SEric Dumazet 				  daddr, dport, dif) < badness)) {
537271b72c7SEric Dumazet 			sock_put(result);
538271b72c7SEric Dumazet 			goto begin;
539271b72c7SEric Dumazet 		}
540271b72c7SEric Dumazet 	}
541271b72c7SEric Dumazet 	rcu_read_unlock();
542db8dac20SDavid S. Miller 	return result;
543db8dac20SDavid S. Miller }
544fce82338SPavel Emelyanov EXPORT_SYMBOL_GPL(__udp4_lib_lookup);
545db8dac20SDavid S. Miller 
546607c4aafSKOVACS Krisztian static inline struct sock *__udp4_lib_lookup_skb(struct sk_buff *skb,
547607c4aafSKOVACS Krisztian 						 __be16 sport, __be16 dport,
548645ca708SEric Dumazet 						 struct udp_table *udptable)
549607c4aafSKOVACS Krisztian {
55023542618SKOVACS Krisztian 	struct sock *sk;
551607c4aafSKOVACS Krisztian 	const struct iphdr *iph = ip_hdr(skb);
552607c4aafSKOVACS Krisztian 
55323542618SKOVACS Krisztian 	if (unlikely(sk = skb_steal_sock(skb)))
55423542618SKOVACS Krisztian 		return sk;
55523542618SKOVACS Krisztian 	else
556adf30907SEric Dumazet 		return __udp4_lib_lookup(dev_net(skb_dst(skb)->dev), iph->saddr, sport,
557607c4aafSKOVACS Krisztian 					 iph->daddr, dport, inet_iif(skb),
558607c4aafSKOVACS Krisztian 					 udptable);
559607c4aafSKOVACS Krisztian }
560607c4aafSKOVACS Krisztian 
561bcd41303SKOVACS Krisztian struct sock *udp4_lib_lookup(struct net *net, __be32 saddr, __be16 sport,
562bcd41303SKOVACS Krisztian 			     __be32 daddr, __be16 dport, int dif)
563bcd41303SKOVACS Krisztian {
564645ca708SEric Dumazet 	return __udp4_lib_lookup(net, saddr, sport, daddr, dport, dif, &udp_table);
565bcd41303SKOVACS Krisztian }
566bcd41303SKOVACS Krisztian EXPORT_SYMBOL_GPL(udp4_lib_lookup);
567bcd41303SKOVACS Krisztian 
568920a4611SEric Dumazet static inline struct sock *udp_v4_mcast_next(struct net *net, struct sock *sk,
569db8dac20SDavid S. Miller 					     __be16 loc_port, __be32 loc_addr,
570db8dac20SDavid S. Miller 					     __be16 rmt_port, __be32 rmt_addr,
571db8dac20SDavid S. Miller 					     int dif)
572db8dac20SDavid S. Miller {
57388ab1932SEric Dumazet 	struct hlist_nulls_node *node;
574db8dac20SDavid S. Miller 	struct sock *s = sk;
575db8dac20SDavid S. Miller 	unsigned short hnum = ntohs(loc_port);
576db8dac20SDavid S. Miller 
57788ab1932SEric Dumazet 	sk_nulls_for_each_from(s, node) {
578db8dac20SDavid S. Miller 		struct inet_sock *inet = inet_sk(s);
579db8dac20SDavid S. Miller 
580920a4611SEric Dumazet 		if (!net_eq(sock_net(s), net) ||
581d4cada4aSEric Dumazet 		    udp_sk(s)->udp_port_hash != hnum ||
582c720c7e8SEric Dumazet 		    (inet->inet_daddr && inet->inet_daddr != rmt_addr) ||
583c720c7e8SEric Dumazet 		    (inet->inet_dport != rmt_port && inet->inet_dport) ||
584c720c7e8SEric Dumazet 		    (inet->inet_rcv_saddr &&
585c720c7e8SEric Dumazet 		     inet->inet_rcv_saddr != loc_addr) ||
586db8dac20SDavid S. Miller 		    ipv6_only_sock(s) ||
587db8dac20SDavid S. Miller 		    (s->sk_bound_dev_if && s->sk_bound_dev_if != dif))
588db8dac20SDavid S. Miller 			continue;
589db8dac20SDavid S. Miller 		if (!ip_mc_sf_allow(s, loc_addr, rmt_addr, dif))
590db8dac20SDavid S. Miller 			continue;
591db8dac20SDavid S. Miller 		goto found;
592db8dac20SDavid S. Miller 	}
593db8dac20SDavid S. Miller 	s = NULL;
594db8dac20SDavid S. Miller found:
595db8dac20SDavid S. Miller 	return s;
596db8dac20SDavid S. Miller }
597db8dac20SDavid S. Miller 
598db8dac20SDavid S. Miller /*
599db8dac20SDavid S. Miller  * This routine is called by the ICMP module when it gets some
600db8dac20SDavid S. Miller  * sort of error condition.  If err < 0 then the socket should
601db8dac20SDavid S. Miller  * be closed and the error returned to the user.  If err > 0
602db8dac20SDavid S. Miller  * it's just the icmp type << 8 | icmp code.
603db8dac20SDavid S. Miller  * Header points to the ip header of the error packet. We move
604db8dac20SDavid S. Miller  * on past this. Then (as it used to claim before adjustment)
605db8dac20SDavid S. Miller  * header points to the first 8 bytes of the udp header.  We need
606db8dac20SDavid S. Miller  * to find the appropriate port.
607db8dac20SDavid S. Miller  */
608db8dac20SDavid S. Miller 
609645ca708SEric Dumazet void __udp4_lib_err(struct sk_buff *skb, u32 info, struct udp_table *udptable)
610db8dac20SDavid S. Miller {
611db8dac20SDavid S. Miller 	struct inet_sock *inet;
612b71d1d42SEric Dumazet 	const struct iphdr *iph = (const struct iphdr *)skb->data;
613db8dac20SDavid S. Miller 	struct udphdr *uh = (struct udphdr *)(skb->data+(iph->ihl<<2));
614db8dac20SDavid S. Miller 	const int type = icmp_hdr(skb)->type;
615db8dac20SDavid S. Miller 	const int code = icmp_hdr(skb)->code;
616db8dac20SDavid S. Miller 	struct sock *sk;
617db8dac20SDavid S. Miller 	int harderr;
618db8dac20SDavid S. Miller 	int err;
619fd54d716SPavel Emelyanov 	struct net *net = dev_net(skb->dev);
620db8dac20SDavid S. Miller 
621fd54d716SPavel Emelyanov 	sk = __udp4_lib_lookup(net, iph->daddr, uh->dest,
622db8dac20SDavid S. Miller 			iph->saddr, uh->source, skb->dev->ifindex, udptable);
623db8dac20SDavid S. Miller 	if (sk == NULL) {
624dcfc23caSPavel Emelyanov 		ICMP_INC_STATS_BH(net, ICMP_MIB_INERRORS);
625db8dac20SDavid S. Miller 		return;	/* No socket for error */
626db8dac20SDavid S. Miller 	}
627db8dac20SDavid S. Miller 
628db8dac20SDavid S. Miller 	err = 0;
629db8dac20SDavid S. Miller 	harderr = 0;
630db8dac20SDavid S. Miller 	inet = inet_sk(sk);
631db8dac20SDavid S. Miller 
632db8dac20SDavid S. Miller 	switch (type) {
633db8dac20SDavid S. Miller 	default:
634db8dac20SDavid S. Miller 	case ICMP_TIME_EXCEEDED:
635db8dac20SDavid S. Miller 		err = EHOSTUNREACH;
636db8dac20SDavid S. Miller 		break;
637db8dac20SDavid S. Miller 	case ICMP_SOURCE_QUENCH:
638db8dac20SDavid S. Miller 		goto out;
639db8dac20SDavid S. Miller 	case ICMP_PARAMETERPROB:
640db8dac20SDavid S. Miller 		err = EPROTO;
641db8dac20SDavid S. Miller 		harderr = 1;
642db8dac20SDavid S. Miller 		break;
643db8dac20SDavid S. Miller 	case ICMP_DEST_UNREACH:
644db8dac20SDavid S. Miller 		if (code == ICMP_FRAG_NEEDED) { /* Path MTU discovery */
64536393395SDavid S. Miller 			ipv4_sk_update_pmtu(skb, sk, info);
646db8dac20SDavid S. Miller 			if (inet->pmtudisc != IP_PMTUDISC_DONT) {
647db8dac20SDavid S. Miller 				err = EMSGSIZE;
648db8dac20SDavid S. Miller 				harderr = 1;
649db8dac20SDavid S. Miller 				break;
650db8dac20SDavid S. Miller 			}
651db8dac20SDavid S. Miller 			goto out;
652db8dac20SDavid S. Miller 		}
653db8dac20SDavid S. Miller 		err = EHOSTUNREACH;
654db8dac20SDavid S. Miller 		if (code <= NR_ICMP_UNREACH) {
655db8dac20SDavid S. Miller 			harderr = icmp_err_convert[code].fatal;
656db8dac20SDavid S. Miller 			err = icmp_err_convert[code].errno;
657db8dac20SDavid S. Miller 		}
658db8dac20SDavid S. Miller 		break;
65955be7a9cSDavid S. Miller 	case ICMP_REDIRECT:
66055be7a9cSDavid S. Miller 		ipv4_sk_redirect(skb, sk);
66155be7a9cSDavid S. Miller 		break;
662db8dac20SDavid S. Miller 	}
663db8dac20SDavid S. Miller 
664db8dac20SDavid S. Miller 	/*
665db8dac20SDavid S. Miller 	 *      RFC1122: OK.  Passes ICMP errors back to application, as per
666db8dac20SDavid S. Miller 	 *	4.1.3.3.
667db8dac20SDavid S. Miller 	 */
668db8dac20SDavid S. Miller 	if (!inet->recverr) {
669db8dac20SDavid S. Miller 		if (!harderr || sk->sk_state != TCP_ESTABLISHED)
670db8dac20SDavid S. Miller 			goto out;
671b1faf566SEric Dumazet 	} else
672db8dac20SDavid S. Miller 		ip_icmp_error(sk, skb, err, uh->dest, info, (u8 *)(uh+1));
673b1faf566SEric Dumazet 
674db8dac20SDavid S. Miller 	sk->sk_err = err;
675db8dac20SDavid S. Miller 	sk->sk_error_report(sk);
676db8dac20SDavid S. Miller out:
677db8dac20SDavid S. Miller 	sock_put(sk);
678db8dac20SDavid S. Miller }
679db8dac20SDavid S. Miller 
680db8dac20SDavid S. Miller void udp_err(struct sk_buff *skb, u32 info)
681db8dac20SDavid S. Miller {
682645ca708SEric Dumazet 	__udp4_lib_err(skb, info, &udp_table);
683db8dac20SDavid S. Miller }
684db8dac20SDavid S. Miller 
685db8dac20SDavid S. Miller /*
686db8dac20SDavid S. Miller  * Throw away all pending data and cancel the corking. Socket is locked.
687db8dac20SDavid S. Miller  */
68836d926b9SDenis V. Lunev void udp_flush_pending_frames(struct sock *sk)
689db8dac20SDavid S. Miller {
690db8dac20SDavid S. Miller 	struct udp_sock *up = udp_sk(sk);
691db8dac20SDavid S. Miller 
692db8dac20SDavid S. Miller 	if (up->pending) {
693db8dac20SDavid S. Miller 		up->len = 0;
694db8dac20SDavid S. Miller 		up->pending = 0;
695db8dac20SDavid S. Miller 		ip_flush_pending_frames(sk);
696db8dac20SDavid S. Miller 	}
697db8dac20SDavid S. Miller }
69836d926b9SDenis V. Lunev EXPORT_SYMBOL(udp_flush_pending_frames);
699db8dac20SDavid S. Miller 
700db8dac20SDavid S. Miller /**
701f6b9664fSHerbert Xu  * 	udp4_hwcsum  -  handle outgoing HW checksumming
702db8dac20SDavid S. Miller  * 	@skb: 	sk_buff containing the filled-in UDP header
703db8dac20SDavid S. Miller  * 	        (checksum field must be zeroed out)
704f6b9664fSHerbert Xu  *	@src:	source IP address
705f6b9664fSHerbert Xu  *	@dst:	destination IP address
706db8dac20SDavid S. Miller  */
707f6b9664fSHerbert Xu static void udp4_hwcsum(struct sk_buff *skb, __be32 src, __be32 dst)
708db8dac20SDavid S. Miller {
709db8dac20SDavid S. Miller 	struct udphdr *uh = udp_hdr(skb);
710f6b9664fSHerbert Xu 	struct sk_buff *frags = skb_shinfo(skb)->frag_list;
711f6b9664fSHerbert Xu 	int offset = skb_transport_offset(skb);
712f6b9664fSHerbert Xu 	int len = skb->len - offset;
713f6b9664fSHerbert Xu 	int hlen = len;
714db8dac20SDavid S. Miller 	__wsum csum = 0;
715db8dac20SDavid S. Miller 
716f6b9664fSHerbert Xu 	if (!frags) {
717db8dac20SDavid S. Miller 		/*
718db8dac20SDavid S. Miller 		 * Only one fragment on the socket.
719db8dac20SDavid S. Miller 		 */
720db8dac20SDavid S. Miller 		skb->csum_start = skb_transport_header(skb) - skb->head;
721db8dac20SDavid S. Miller 		skb->csum_offset = offsetof(struct udphdr, check);
722f6b9664fSHerbert Xu 		uh->check = ~csum_tcpudp_magic(src, dst, len,
723f6b9664fSHerbert Xu 					       IPPROTO_UDP, 0);
724db8dac20SDavid S. Miller 	} else {
725db8dac20SDavid S. Miller 		/*
726db8dac20SDavid S. Miller 		 * HW-checksum won't work as there are two or more
727db8dac20SDavid S. Miller 		 * fragments on the socket so that all csums of sk_buffs
728db8dac20SDavid S. Miller 		 * should be together
729db8dac20SDavid S. Miller 		 */
730f6b9664fSHerbert Xu 		do {
731f6b9664fSHerbert Xu 			csum = csum_add(csum, frags->csum);
732f6b9664fSHerbert Xu 			hlen -= frags->len;
733f6b9664fSHerbert Xu 		} while ((frags = frags->next));
734db8dac20SDavid S. Miller 
735f6b9664fSHerbert Xu 		csum = skb_checksum(skb, offset, hlen, csum);
736db8dac20SDavid S. Miller 		skb->ip_summed = CHECKSUM_NONE;
737db8dac20SDavid S. Miller 
738db8dac20SDavid S. Miller 		uh->check = csum_tcpudp_magic(src, dst, len, IPPROTO_UDP, csum);
739db8dac20SDavid S. Miller 		if (uh->check == 0)
740db8dac20SDavid S. Miller 			uh->check = CSUM_MANGLED_0;
741db8dac20SDavid S. Miller 	}
742db8dac20SDavid S. Miller }
743db8dac20SDavid S. Miller 
74479ab0531SDavid S. Miller static int udp_send_skb(struct sk_buff *skb, struct flowi4 *fl4)
745f6b9664fSHerbert Xu {
746f6b9664fSHerbert Xu 	struct sock *sk = skb->sk;
747f6b9664fSHerbert Xu 	struct inet_sock *inet = inet_sk(sk);
748f6b9664fSHerbert Xu 	struct udphdr *uh;
749f6b9664fSHerbert Xu 	int err = 0;
750f6b9664fSHerbert Xu 	int is_udplite = IS_UDPLITE(sk);
751f6b9664fSHerbert Xu 	int offset = skb_transport_offset(skb);
752f6b9664fSHerbert Xu 	int len = skb->len - offset;
753f6b9664fSHerbert Xu 	__wsum csum = 0;
754f6b9664fSHerbert Xu 
755f6b9664fSHerbert Xu 	/*
756f6b9664fSHerbert Xu 	 * Create a UDP header
757f6b9664fSHerbert Xu 	 */
758f6b9664fSHerbert Xu 	uh = udp_hdr(skb);
759f6b9664fSHerbert Xu 	uh->source = inet->inet_sport;
76079ab0531SDavid S. Miller 	uh->dest = fl4->fl4_dport;
761f6b9664fSHerbert Xu 	uh->len = htons(len);
762f6b9664fSHerbert Xu 	uh->check = 0;
763f6b9664fSHerbert Xu 
764f6b9664fSHerbert Xu 	if (is_udplite)  				 /*     UDP-Lite      */
765f6b9664fSHerbert Xu 		csum = udplite_csum(skb);
766f6b9664fSHerbert Xu 
767f6b9664fSHerbert Xu 	else if (sk->sk_no_check == UDP_CSUM_NOXMIT) {   /* UDP csum disabled */
768f6b9664fSHerbert Xu 
769f6b9664fSHerbert Xu 		skb->ip_summed = CHECKSUM_NONE;
770f6b9664fSHerbert Xu 		goto send;
771f6b9664fSHerbert Xu 
772f6b9664fSHerbert Xu 	} else if (skb->ip_summed == CHECKSUM_PARTIAL) { /* UDP hardware csum */
773f6b9664fSHerbert Xu 
77479ab0531SDavid S. Miller 		udp4_hwcsum(skb, fl4->saddr, fl4->daddr);
775f6b9664fSHerbert Xu 		goto send;
776f6b9664fSHerbert Xu 
777f6b9664fSHerbert Xu 	} else
778f6b9664fSHerbert Xu 		csum = udp_csum(skb);
779f6b9664fSHerbert Xu 
780f6b9664fSHerbert Xu 	/* add protocol-dependent pseudo-header */
78179ab0531SDavid S. Miller 	uh->check = csum_tcpudp_magic(fl4->saddr, fl4->daddr, len,
782f6b9664fSHerbert Xu 				      sk->sk_protocol, csum);
783f6b9664fSHerbert Xu 	if (uh->check == 0)
784f6b9664fSHerbert Xu 		uh->check = CSUM_MANGLED_0;
785f6b9664fSHerbert Xu 
786f6b9664fSHerbert Xu send:
787b5ec8eeaSEric Dumazet 	err = ip_send_skb(sock_net(sk), skb);
788f6b9664fSHerbert Xu 	if (err) {
789f6b9664fSHerbert Xu 		if (err == -ENOBUFS && !inet->recverr) {
790f6b9664fSHerbert Xu 			UDP_INC_STATS_USER(sock_net(sk),
791f6b9664fSHerbert Xu 					   UDP_MIB_SNDBUFERRORS, is_udplite);
792f6b9664fSHerbert Xu 			err = 0;
793f6b9664fSHerbert Xu 		}
794f6b9664fSHerbert Xu 	} else
795f6b9664fSHerbert Xu 		UDP_INC_STATS_USER(sock_net(sk),
796f6b9664fSHerbert Xu 				   UDP_MIB_OUTDATAGRAMS, is_udplite);
797f6b9664fSHerbert Xu 	return err;
798f6b9664fSHerbert Xu }
799f6b9664fSHerbert Xu 
800db8dac20SDavid S. Miller /*
801db8dac20SDavid S. Miller  * Push out all pending data as one UDP datagram. Socket is locked.
802db8dac20SDavid S. Miller  */
803*8822b64aSHannes Frederic Sowa int udp_push_pending_frames(struct sock *sk)
804db8dac20SDavid S. Miller {
805db8dac20SDavid S. Miller 	struct udp_sock  *up = udp_sk(sk);
806db8dac20SDavid S. Miller 	struct inet_sock *inet = inet_sk(sk);
807b6f21b26SDavid S. Miller 	struct flowi4 *fl4 = &inet->cork.fl.u.ip4;
808db8dac20SDavid S. Miller 	struct sk_buff *skb;
809db8dac20SDavid S. Miller 	int err = 0;
810db8dac20SDavid S. Miller 
81177968b78SDavid S. Miller 	skb = ip_finish_skb(sk, fl4);
812f6b9664fSHerbert Xu 	if (!skb)
813db8dac20SDavid S. Miller 		goto out;
814db8dac20SDavid S. Miller 
81579ab0531SDavid S. Miller 	err = udp_send_skb(skb, fl4);
816db8dac20SDavid S. Miller 
817db8dac20SDavid S. Miller out:
818db8dac20SDavid S. Miller 	up->len = 0;
819db8dac20SDavid S. Miller 	up->pending = 0;
820db8dac20SDavid S. Miller 	return err;
821db8dac20SDavid S. Miller }
822*8822b64aSHannes Frederic Sowa EXPORT_SYMBOL(udp_push_pending_frames);
823db8dac20SDavid S. Miller 
824db8dac20SDavid S. Miller int udp_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
825db8dac20SDavid S. Miller 		size_t len)
826db8dac20SDavid S. Miller {
827db8dac20SDavid S. Miller 	struct inet_sock *inet = inet_sk(sk);
828db8dac20SDavid S. Miller 	struct udp_sock *up = udp_sk(sk);
829e474995fSDavid S. Miller 	struct flowi4 fl4_stack;
830b6f21b26SDavid S. Miller 	struct flowi4 *fl4;
831db8dac20SDavid S. Miller 	int ulen = len;
832db8dac20SDavid S. Miller 	struct ipcm_cookie ipc;
833db8dac20SDavid S. Miller 	struct rtable *rt = NULL;
834db8dac20SDavid S. Miller 	int free = 0;
835db8dac20SDavid S. Miller 	int connected = 0;
836db8dac20SDavid S. Miller 	__be32 daddr, faddr, saddr;
837db8dac20SDavid S. Miller 	__be16 dport;
838db8dac20SDavid S. Miller 	u8  tos;
839db8dac20SDavid S. Miller 	int err, is_udplite = IS_UDPLITE(sk);
840db8dac20SDavid S. Miller 	int corkreq = up->corkflag || msg->msg_flags&MSG_MORE;
841db8dac20SDavid S. Miller 	int (*getfrag)(void *, char *, int, int, int, struct sk_buff *);
842903ab86dSHerbert Xu 	struct sk_buff *skb;
843f6d8bd05SEric Dumazet 	struct ip_options_data opt_copy;
844db8dac20SDavid S. Miller 
845db8dac20SDavid S. Miller 	if (len > 0xFFFF)
846db8dac20SDavid S. Miller 		return -EMSGSIZE;
847db8dac20SDavid S. Miller 
848db8dac20SDavid S. Miller 	/*
849db8dac20SDavid S. Miller 	 *	Check the flags.
850db8dac20SDavid S. Miller 	 */
851db8dac20SDavid S. Miller 
852db8dac20SDavid S. Miller 	if (msg->msg_flags & MSG_OOB) /* Mirror BSD error message compatibility */
853db8dac20SDavid S. Miller 		return -EOPNOTSUPP;
854db8dac20SDavid S. Miller 
855db8dac20SDavid S. Miller 	ipc.opt = NULL;
8562244d07bSOliver Hartkopp 	ipc.tx_flags = 0;
857db8dac20SDavid S. Miller 
858903ab86dSHerbert Xu 	getfrag = is_udplite ? udplite_getfrag : ip_generic_getfrag;
859903ab86dSHerbert Xu 
860f5fca608SDavid S. Miller 	fl4 = &inet->cork.fl.u.ip4;
861db8dac20SDavid S. Miller 	if (up->pending) {
862db8dac20SDavid S. Miller 		/*
863db8dac20SDavid S. Miller 		 * There are pending frames.
864db8dac20SDavid S. Miller 		 * The socket lock must be held while it's corked.
865db8dac20SDavid S. Miller 		 */
866db8dac20SDavid S. Miller 		lock_sock(sk);
867db8dac20SDavid S. Miller 		if (likely(up->pending)) {
868db8dac20SDavid S. Miller 			if (unlikely(up->pending != AF_INET)) {
869db8dac20SDavid S. Miller 				release_sock(sk);
870db8dac20SDavid S. Miller 				return -EINVAL;
871db8dac20SDavid S. Miller 			}
872db8dac20SDavid S. Miller 			goto do_append_data;
873db8dac20SDavid S. Miller 		}
874db8dac20SDavid S. Miller 		release_sock(sk);
875db8dac20SDavid S. Miller 	}
876db8dac20SDavid S. Miller 	ulen += sizeof(struct udphdr);
877db8dac20SDavid S. Miller 
878db8dac20SDavid S. Miller 	/*
879db8dac20SDavid S. Miller 	 *	Get and verify the address.
880db8dac20SDavid S. Miller 	 */
881db8dac20SDavid S. Miller 	if (msg->msg_name) {
882db8dac20SDavid S. Miller 		struct sockaddr_in *usin = (struct sockaddr_in *)msg->msg_name;
883db8dac20SDavid S. Miller 		if (msg->msg_namelen < sizeof(*usin))
884db8dac20SDavid S. Miller 			return -EINVAL;
885db8dac20SDavid S. Miller 		if (usin->sin_family != AF_INET) {
886db8dac20SDavid S. Miller 			if (usin->sin_family != AF_UNSPEC)
887db8dac20SDavid S. Miller 				return -EAFNOSUPPORT;
888db8dac20SDavid S. Miller 		}
889db8dac20SDavid S. Miller 
890db8dac20SDavid S. Miller 		daddr = usin->sin_addr.s_addr;
891db8dac20SDavid S. Miller 		dport = usin->sin_port;
892db8dac20SDavid S. Miller 		if (dport == 0)
893db8dac20SDavid S. Miller 			return -EINVAL;
894db8dac20SDavid S. Miller 	} else {
895db8dac20SDavid S. Miller 		if (sk->sk_state != TCP_ESTABLISHED)
896db8dac20SDavid S. Miller 			return -EDESTADDRREQ;
897c720c7e8SEric Dumazet 		daddr = inet->inet_daddr;
898c720c7e8SEric Dumazet 		dport = inet->inet_dport;
899db8dac20SDavid S. Miller 		/* Open fast path for connected socket.
900db8dac20SDavid S. Miller 		   Route will not be used, if at least one option is set.
901db8dac20SDavid S. Miller 		 */
902db8dac20SDavid S. Miller 		connected = 1;
903db8dac20SDavid S. Miller 	}
904c720c7e8SEric Dumazet 	ipc.addr = inet->inet_saddr;
905db8dac20SDavid S. Miller 
906db8dac20SDavid S. Miller 	ipc.oif = sk->sk_bound_dev_if;
907bf84a010SDaniel Borkmann 
908bf84a010SDaniel Borkmann 	sock_tx_timestamp(sk, &ipc.tx_flags);
909bf84a010SDaniel Borkmann 
910db8dac20SDavid S. Miller 	if (msg->msg_controllen) {
9113b1e0a65SYOSHIFUJI Hideaki 		err = ip_cmsg_send(sock_net(sk), msg, &ipc);
912db8dac20SDavid S. Miller 		if (err)
913db8dac20SDavid S. Miller 			return err;
914db8dac20SDavid S. Miller 		if (ipc.opt)
915db8dac20SDavid S. Miller 			free = 1;
916db8dac20SDavid S. Miller 		connected = 0;
917db8dac20SDavid S. Miller 	}
918f6d8bd05SEric Dumazet 	if (!ipc.opt) {
919f6d8bd05SEric Dumazet 		struct ip_options_rcu *inet_opt;
920f6d8bd05SEric Dumazet 
921f6d8bd05SEric Dumazet 		rcu_read_lock();
922f6d8bd05SEric Dumazet 		inet_opt = rcu_dereference(inet->inet_opt);
923f6d8bd05SEric Dumazet 		if (inet_opt) {
924f6d8bd05SEric Dumazet 			memcpy(&opt_copy, inet_opt,
925f6d8bd05SEric Dumazet 			       sizeof(*inet_opt) + inet_opt->opt.optlen);
926f6d8bd05SEric Dumazet 			ipc.opt = &opt_copy.opt;
927f6d8bd05SEric Dumazet 		}
928f6d8bd05SEric Dumazet 		rcu_read_unlock();
929f6d8bd05SEric Dumazet 	}
930db8dac20SDavid S. Miller 
931db8dac20SDavid S. Miller 	saddr = ipc.addr;
932db8dac20SDavid S. Miller 	ipc.addr = faddr = daddr;
933db8dac20SDavid S. Miller 
934f6d8bd05SEric Dumazet 	if (ipc.opt && ipc.opt->opt.srr) {
935db8dac20SDavid S. Miller 		if (!daddr)
936db8dac20SDavid S. Miller 			return -EINVAL;
937f6d8bd05SEric Dumazet 		faddr = ipc.opt->opt.faddr;
938db8dac20SDavid S. Miller 		connected = 0;
939db8dac20SDavid S. Miller 	}
940db8dac20SDavid S. Miller 	tos = RT_TOS(inet->tos);
941db8dac20SDavid S. Miller 	if (sock_flag(sk, SOCK_LOCALROUTE) ||
942db8dac20SDavid S. Miller 	    (msg->msg_flags & MSG_DONTROUTE) ||
943f6d8bd05SEric Dumazet 	    (ipc.opt && ipc.opt->opt.is_strictroute)) {
944db8dac20SDavid S. Miller 		tos |= RTO_ONLINK;
945db8dac20SDavid S. Miller 		connected = 0;
946db8dac20SDavid S. Miller 	}
947db8dac20SDavid S. Miller 
948db8dac20SDavid S. Miller 	if (ipv4_is_multicast(daddr)) {
949db8dac20SDavid S. Miller 		if (!ipc.oif)
950db8dac20SDavid S. Miller 			ipc.oif = inet->mc_index;
951db8dac20SDavid S. Miller 		if (!saddr)
952db8dac20SDavid S. Miller 			saddr = inet->mc_addr;
953db8dac20SDavid S. Miller 		connected = 0;
95476e21053SErich E. Hoover 	} else if (!ipc.oif)
95576e21053SErich E. Hoover 		ipc.oif = inet->uc_index;
956db8dac20SDavid S. Miller 
957db8dac20SDavid S. Miller 	if (connected)
958db8dac20SDavid S. Miller 		rt = (struct rtable *)sk_dst_check(sk, 0);
959db8dac20SDavid S. Miller 
960db8dac20SDavid S. Miller 	if (rt == NULL) {
96184a3aa00SPavel Emelyanov 		struct net *net = sock_net(sk);
96284a3aa00SPavel Emelyanov 
963e474995fSDavid S. Miller 		fl4 = &fl4_stack;
964e474995fSDavid S. Miller 		flowi4_init_output(fl4, ipc.oif, sk->sk_mark, tos,
965c0951cbcSDavid S. Miller 				   RT_SCOPE_UNIVERSE, sk->sk_protocol,
966c0951cbcSDavid S. Miller 				   inet_sk_flowi_flags(sk)|FLOWI_FLAG_CAN_SLEEP,
967c0951cbcSDavid S. Miller 				   faddr, saddr, dport, inet->inet_sport);
968c0951cbcSDavid S. Miller 
969e474995fSDavid S. Miller 		security_sk_classify_flow(sk, flowi4_to_flowi(fl4));
970e474995fSDavid S. Miller 		rt = ip_route_output_flow(net, fl4, sk);
971b23dd4feSDavid S. Miller 		if (IS_ERR(rt)) {
972b23dd4feSDavid S. Miller 			err = PTR_ERR(rt);
97306dc94b1SDavid S. Miller 			rt = NULL;
974db8dac20SDavid S. Miller 			if (err == -ENETUNREACH)
9757c73a6faSPavel Emelyanov 				IP_INC_STATS_BH(net, IPSTATS_MIB_OUTNOROUTES);
976db8dac20SDavid S. Miller 			goto out;
977db8dac20SDavid S. Miller 		}
978db8dac20SDavid S. Miller 
979db8dac20SDavid S. Miller 		err = -EACCES;
980db8dac20SDavid S. Miller 		if ((rt->rt_flags & RTCF_BROADCAST) &&
981db8dac20SDavid S. Miller 		    !sock_flag(sk, SOCK_BROADCAST))
982db8dac20SDavid S. Miller 			goto out;
983db8dac20SDavid S. Miller 		if (connected)
984d8d1f30bSChangli Gao 			sk_dst_set(sk, dst_clone(&rt->dst));
985db8dac20SDavid S. Miller 	}
986db8dac20SDavid S. Miller 
987db8dac20SDavid S. Miller 	if (msg->msg_flags&MSG_CONFIRM)
988db8dac20SDavid S. Miller 		goto do_confirm;
989db8dac20SDavid S. Miller back_from_confirm:
990db8dac20SDavid S. Miller 
991e474995fSDavid S. Miller 	saddr = fl4->saddr;
992db8dac20SDavid S. Miller 	if (!ipc.addr)
993e474995fSDavid S. Miller 		daddr = ipc.addr = fl4->daddr;
994db8dac20SDavid S. Miller 
995903ab86dSHerbert Xu 	/* Lockless fast path for the non-corking case. */
996903ab86dSHerbert Xu 	if (!corkreq) {
99777968b78SDavid S. Miller 		skb = ip_make_skb(sk, fl4, getfrag, msg->msg_iov, ulen,
998903ab86dSHerbert Xu 				  sizeof(struct udphdr), &ipc, &rt,
999903ab86dSHerbert Xu 				  msg->msg_flags);
1000903ab86dSHerbert Xu 		err = PTR_ERR(skb);
100150c3a487SYOSHIFUJI Hideaki / 吉藤英明 		if (!IS_ERR_OR_NULL(skb))
100279ab0531SDavid S. Miller 			err = udp_send_skb(skb, fl4);
1003903ab86dSHerbert Xu 		goto out;
1004903ab86dSHerbert Xu 	}
1005903ab86dSHerbert Xu 
1006db8dac20SDavid S. Miller 	lock_sock(sk);
1007db8dac20SDavid S. Miller 	if (unlikely(up->pending)) {
1008db8dac20SDavid S. Miller 		/* The socket is already corked while preparing it. */
1009db8dac20SDavid S. Miller 		/* ... which is an evident application bug. --ANK */
1010db8dac20SDavid S. Miller 		release_sock(sk);
1011db8dac20SDavid S. Miller 
1012afd46503SJoe Perches 		LIMIT_NETDEBUG(KERN_DEBUG pr_fmt("cork app bug 2\n"));
1013db8dac20SDavid S. Miller 		err = -EINVAL;
1014db8dac20SDavid S. Miller 		goto out;
1015db8dac20SDavid S. Miller 	}
1016db8dac20SDavid S. Miller 	/*
1017db8dac20SDavid S. Miller 	 *	Now cork the socket to pend data.
1018db8dac20SDavid S. Miller 	 */
1019b6f21b26SDavid S. Miller 	fl4 = &inet->cork.fl.u.ip4;
1020b6f21b26SDavid S. Miller 	fl4->daddr = daddr;
1021b6f21b26SDavid S. Miller 	fl4->saddr = saddr;
10229cce96dfSDavid S. Miller 	fl4->fl4_dport = dport;
10239cce96dfSDavid S. Miller 	fl4->fl4_sport = inet->inet_sport;
1024db8dac20SDavid S. Miller 	up->pending = AF_INET;
1025db8dac20SDavid S. Miller 
1026db8dac20SDavid S. Miller do_append_data:
1027db8dac20SDavid S. Miller 	up->len += ulen;
1028f5fca608SDavid S. Miller 	err = ip_append_data(sk, fl4, getfrag, msg->msg_iov, ulen,
10292e77d89bSEric Dumazet 			     sizeof(struct udphdr), &ipc, &rt,
1030db8dac20SDavid S. Miller 			     corkreq ? msg->msg_flags|MSG_MORE : msg->msg_flags);
1031db8dac20SDavid S. Miller 	if (err)
1032db8dac20SDavid S. Miller 		udp_flush_pending_frames(sk);
1033db8dac20SDavid S. Miller 	else if (!corkreq)
1034db8dac20SDavid S. Miller 		err = udp_push_pending_frames(sk);
1035db8dac20SDavid S. Miller 	else if (unlikely(skb_queue_empty(&sk->sk_write_queue)))
1036db8dac20SDavid S. Miller 		up->pending = 0;
1037db8dac20SDavid S. Miller 	release_sock(sk);
1038db8dac20SDavid S. Miller 
1039db8dac20SDavid S. Miller out:
1040db8dac20SDavid S. Miller 	ip_rt_put(rt);
1041db8dac20SDavid S. Miller 	if (free)
1042db8dac20SDavid S. Miller 		kfree(ipc.opt);
1043db8dac20SDavid S. Miller 	if (!err)
1044db8dac20SDavid S. Miller 		return len;
1045db8dac20SDavid S. Miller 	/*
1046db8dac20SDavid S. Miller 	 * ENOBUFS = no kernel mem, SOCK_NOSPACE = no sndbuf space.  Reporting
1047db8dac20SDavid S. Miller 	 * ENOBUFS might not be good (it's not tunable per se), but otherwise
1048db8dac20SDavid S. Miller 	 * we don't have a good statistic (IpOutDiscards but it can be too many
1049db8dac20SDavid S. Miller 	 * things).  We could add another new stat but at least for now that
1050db8dac20SDavid S. Miller 	 * seems like overkill.
1051db8dac20SDavid S. Miller 	 */
1052db8dac20SDavid S. Miller 	if (err == -ENOBUFS || test_bit(SOCK_NOSPACE, &sk->sk_socket->flags)) {
1053629ca23cSPavel Emelyanov 		UDP_INC_STATS_USER(sock_net(sk),
1054629ca23cSPavel Emelyanov 				UDP_MIB_SNDBUFERRORS, is_udplite);
1055db8dac20SDavid S. Miller 	}
1056db8dac20SDavid S. Miller 	return err;
1057db8dac20SDavid S. Miller 
1058db8dac20SDavid S. Miller do_confirm:
1059d8d1f30bSChangli Gao 	dst_confirm(&rt->dst);
1060db8dac20SDavid S. Miller 	if (!(msg->msg_flags&MSG_PROBE) || len)
1061db8dac20SDavid S. Miller 		goto back_from_confirm;
1062db8dac20SDavid S. Miller 	err = 0;
1063db8dac20SDavid S. Miller 	goto out;
1064db8dac20SDavid S. Miller }
1065c482c568SEric Dumazet EXPORT_SYMBOL(udp_sendmsg);
1066db8dac20SDavid S. Miller 
1067db8dac20SDavid S. Miller int udp_sendpage(struct sock *sk, struct page *page, int offset,
1068db8dac20SDavid S. Miller 		 size_t size, int flags)
1069db8dac20SDavid S. Miller {
1070f5fca608SDavid S. Miller 	struct inet_sock *inet = inet_sk(sk);
1071db8dac20SDavid S. Miller 	struct udp_sock *up = udp_sk(sk);
1072db8dac20SDavid S. Miller 	int ret;
1073db8dac20SDavid S. Miller 
1074db8dac20SDavid S. Miller 	if (!up->pending) {
1075db8dac20SDavid S. Miller 		struct msghdr msg = {	.msg_flags = flags|MSG_MORE };
1076db8dac20SDavid S. Miller 
1077db8dac20SDavid S. Miller 		/* Call udp_sendmsg to specify destination address which
1078db8dac20SDavid S. Miller 		 * sendpage interface can't pass.
1079db8dac20SDavid S. Miller 		 * This will succeed only when the socket is connected.
1080db8dac20SDavid S. Miller 		 */
1081db8dac20SDavid S. Miller 		ret = udp_sendmsg(NULL, sk, &msg, 0);
1082db8dac20SDavid S. Miller 		if (ret < 0)
1083db8dac20SDavid S. Miller 			return ret;
1084db8dac20SDavid S. Miller 	}
1085db8dac20SDavid S. Miller 
1086db8dac20SDavid S. Miller 	lock_sock(sk);
1087db8dac20SDavid S. Miller 
1088db8dac20SDavid S. Miller 	if (unlikely(!up->pending)) {
1089db8dac20SDavid S. Miller 		release_sock(sk);
1090db8dac20SDavid S. Miller 
1091afd46503SJoe Perches 		LIMIT_NETDEBUG(KERN_DEBUG pr_fmt("udp cork app bug 3\n"));
1092db8dac20SDavid S. Miller 		return -EINVAL;
1093db8dac20SDavid S. Miller 	}
1094db8dac20SDavid S. Miller 
1095f5fca608SDavid S. Miller 	ret = ip_append_page(sk, &inet->cork.fl.u.ip4,
1096f5fca608SDavid S. Miller 			     page, offset, size, flags);
1097db8dac20SDavid S. Miller 	if (ret == -EOPNOTSUPP) {
1098db8dac20SDavid S. Miller 		release_sock(sk);
1099db8dac20SDavid S. Miller 		return sock_no_sendpage(sk->sk_socket, page, offset,
1100db8dac20SDavid S. Miller 					size, flags);
1101db8dac20SDavid S. Miller 	}
1102db8dac20SDavid S. Miller 	if (ret < 0) {
1103db8dac20SDavid S. Miller 		udp_flush_pending_frames(sk);
1104db8dac20SDavid S. Miller 		goto out;
1105db8dac20SDavid S. Miller 	}
1106db8dac20SDavid S. Miller 
1107db8dac20SDavid S. Miller 	up->len += size;
1108db8dac20SDavid S. Miller 	if (!(up->corkflag || (flags&MSG_MORE)))
1109db8dac20SDavid S. Miller 		ret = udp_push_pending_frames(sk);
1110db8dac20SDavid S. Miller 	if (!ret)
1111db8dac20SDavid S. Miller 		ret = size;
1112db8dac20SDavid S. Miller out:
1113db8dac20SDavid S. Miller 	release_sock(sk);
1114db8dac20SDavid S. Miller 	return ret;
1115db8dac20SDavid S. Miller }
1116db8dac20SDavid S. Miller 
111785584672SEric Dumazet 
111885584672SEric Dumazet /**
111985584672SEric Dumazet  *	first_packet_length	- return length of first packet in receive queue
112085584672SEric Dumazet  *	@sk: socket
112185584672SEric Dumazet  *
112285584672SEric Dumazet  *	Drops all bad checksum frames, until a valid one is found.
112385584672SEric Dumazet  *	Returns the length of found skb, or 0 if none is found.
112485584672SEric Dumazet  */
112585584672SEric Dumazet static unsigned int first_packet_length(struct sock *sk)
112685584672SEric Dumazet {
112785584672SEric Dumazet 	struct sk_buff_head list_kill, *rcvq = &sk->sk_receive_queue;
112885584672SEric Dumazet 	struct sk_buff *skb;
112985584672SEric Dumazet 	unsigned int res;
113085584672SEric Dumazet 
113185584672SEric Dumazet 	__skb_queue_head_init(&list_kill);
113285584672SEric Dumazet 
113385584672SEric Dumazet 	spin_lock_bh(&rcvq->lock);
113485584672SEric Dumazet 	while ((skb = skb_peek(rcvq)) != NULL &&
113585584672SEric Dumazet 		udp_lib_checksum_complete(skb)) {
11366a5dc9e5SEric Dumazet 		UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_CSUMERRORS,
11376a5dc9e5SEric Dumazet 				 IS_UDPLITE(sk));
113885584672SEric Dumazet 		UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS,
113985584672SEric Dumazet 				 IS_UDPLITE(sk));
11408edf19c2SEric Dumazet 		atomic_inc(&sk->sk_drops);
114185584672SEric Dumazet 		__skb_unlink(skb, rcvq);
114285584672SEric Dumazet 		__skb_queue_tail(&list_kill, skb);
114385584672SEric Dumazet 	}
114485584672SEric Dumazet 	res = skb ? skb->len : 0;
114585584672SEric Dumazet 	spin_unlock_bh(&rcvq->lock);
114685584672SEric Dumazet 
114785584672SEric Dumazet 	if (!skb_queue_empty(&list_kill)) {
11488a74ad60SEric Dumazet 		bool slow = lock_sock_fast(sk);
11498a74ad60SEric Dumazet 
115085584672SEric Dumazet 		__skb_queue_purge(&list_kill);
115185584672SEric Dumazet 		sk_mem_reclaim_partial(sk);
11528a74ad60SEric Dumazet 		unlock_sock_fast(sk, slow);
115385584672SEric Dumazet 	}
115485584672SEric Dumazet 	return res;
115585584672SEric Dumazet }
115685584672SEric Dumazet 
11571da177e4SLinus Torvalds /*
11581da177e4SLinus Torvalds  *	IOCTL requests applicable to the UDP protocol
11591da177e4SLinus Torvalds  */
11601da177e4SLinus Torvalds 
11611da177e4SLinus Torvalds int udp_ioctl(struct sock *sk, int cmd, unsigned long arg)
11621da177e4SLinus Torvalds {
11636516c655SStephen Hemminger 	switch (cmd) {
11641da177e4SLinus Torvalds 	case SIOCOUTQ:
11651da177e4SLinus Torvalds 	{
116631e6d363SEric Dumazet 		int amount = sk_wmem_alloc_get(sk);
116731e6d363SEric Dumazet 
11681da177e4SLinus Torvalds 		return put_user(amount, (int __user *)arg);
11691da177e4SLinus Torvalds 	}
11701da177e4SLinus Torvalds 
11711da177e4SLinus Torvalds 	case SIOCINQ:
11721da177e4SLinus Torvalds 	{
117385584672SEric Dumazet 		unsigned int amount = first_packet_length(sk);
11741da177e4SLinus Torvalds 
117585584672SEric Dumazet 		if (amount)
11761da177e4SLinus Torvalds 			/*
11771da177e4SLinus Torvalds 			 * We will only return the amount
11781da177e4SLinus Torvalds 			 * of this packet since that is all
11791da177e4SLinus Torvalds 			 * that will be read.
11801da177e4SLinus Torvalds 			 */
118185584672SEric Dumazet 			amount -= sizeof(struct udphdr);
118285584672SEric Dumazet 
11831da177e4SLinus Torvalds 		return put_user(amount, (int __user *)arg);
11841da177e4SLinus Torvalds 	}
11851da177e4SLinus Torvalds 
11861da177e4SLinus Torvalds 	default:
11871da177e4SLinus Torvalds 		return -ENOIOCTLCMD;
11881da177e4SLinus Torvalds 	}
11896516c655SStephen Hemminger 
11906516c655SStephen Hemminger 	return 0;
11911da177e4SLinus Torvalds }
1192c482c568SEric Dumazet EXPORT_SYMBOL(udp_ioctl);
11931da177e4SLinus Torvalds 
1194db8dac20SDavid S. Miller /*
1195db8dac20SDavid S. Miller  * 	This should be easy, if there is something there we
1196db8dac20SDavid S. Miller  * 	return it, otherwise we block.
1197db8dac20SDavid S. Miller  */
1198db8dac20SDavid S. Miller 
1199db8dac20SDavid S. Miller int udp_recvmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg,
1200db8dac20SDavid S. Miller 		size_t len, int noblock, int flags, int *addr_len)
1201db8dac20SDavid S. Miller {
1202db8dac20SDavid S. Miller 	struct inet_sock *inet = inet_sk(sk);
1203db8dac20SDavid S. Miller 	struct sockaddr_in *sin = (struct sockaddr_in *)msg->msg_name;
1204db8dac20SDavid S. Miller 	struct sk_buff *skb;
120559c2cdaeSDavid S. Miller 	unsigned int ulen, copied;
12063f518bf7SPavel Emelyanov 	int peeked, off = 0;
1207db8dac20SDavid S. Miller 	int err;
1208db8dac20SDavid S. Miller 	int is_udplite = IS_UDPLITE(sk);
12098a74ad60SEric Dumazet 	bool slow;
1210db8dac20SDavid S. Miller 
1211db8dac20SDavid S. Miller 	/*
1212db8dac20SDavid S. Miller 	 *	Check any passed addresses
1213db8dac20SDavid S. Miller 	 */
1214db8dac20SDavid S. Miller 	if (addr_len)
1215db8dac20SDavid S. Miller 		*addr_len = sizeof(*sin);
1216db8dac20SDavid S. Miller 
1217db8dac20SDavid S. Miller 	if (flags & MSG_ERRQUEUE)
1218db8dac20SDavid S. Miller 		return ip_recv_error(sk, msg, len);
1219db8dac20SDavid S. Miller 
1220db8dac20SDavid S. Miller try_again:
1221db8dac20SDavid S. Miller 	skb = __skb_recv_datagram(sk, flags | (noblock ? MSG_DONTWAIT : 0),
12223f518bf7SPavel Emelyanov 				  &peeked, &off, &err);
1223db8dac20SDavid S. Miller 	if (!skb)
1224db8dac20SDavid S. Miller 		goto out;
1225db8dac20SDavid S. Miller 
1226db8dac20SDavid S. Miller 	ulen = skb->len - sizeof(struct udphdr);
122759c2cdaeSDavid S. Miller 	copied = len;
122859c2cdaeSDavid S. Miller 	if (copied > ulen)
122959c2cdaeSDavid S. Miller 		copied = ulen;
123059c2cdaeSDavid S. Miller 	else if (copied < ulen)
1231db8dac20SDavid S. Miller 		msg->msg_flags |= MSG_TRUNC;
1232db8dac20SDavid S. Miller 
1233db8dac20SDavid S. Miller 	/*
1234db8dac20SDavid S. Miller 	 * If checksum is needed at all, try to do it while copying the
1235db8dac20SDavid S. Miller 	 * data.  If the data is truncated, or if we only want a partial
1236db8dac20SDavid S. Miller 	 * coverage checksum (UDP-Lite), do it before the copy.
1237db8dac20SDavid S. Miller 	 */
1238db8dac20SDavid S. Miller 
123959c2cdaeSDavid S. Miller 	if (copied < ulen || UDP_SKB_CB(skb)->partial_cov) {
1240db8dac20SDavid S. Miller 		if (udp_lib_checksum_complete(skb))
1241db8dac20SDavid S. Miller 			goto csum_copy_err;
1242db8dac20SDavid S. Miller 	}
1243db8dac20SDavid S. Miller 
1244db8dac20SDavid S. Miller 	if (skb_csum_unnecessary(skb))
1245db8dac20SDavid S. Miller 		err = skb_copy_datagram_iovec(skb, sizeof(struct udphdr),
124659c2cdaeSDavid S. Miller 					      msg->msg_iov, copied);
1247db8dac20SDavid S. Miller 	else {
1248c482c568SEric Dumazet 		err = skb_copy_and_csum_datagram_iovec(skb,
1249c482c568SEric Dumazet 						       sizeof(struct udphdr),
1250c482c568SEric Dumazet 						       msg->msg_iov);
1251db8dac20SDavid S. Miller 
1252db8dac20SDavid S. Miller 		if (err == -EINVAL)
1253db8dac20SDavid S. Miller 			goto csum_copy_err;
1254db8dac20SDavid S. Miller 	}
1255db8dac20SDavid S. Miller 
125622911fc5SEric Dumazet 	if (unlikely(err)) {
125722911fc5SEric Dumazet 		trace_kfree_skb(skb, udp_recvmsg);
1258979402b1SEric Dumazet 		if (!peeked) {
1259979402b1SEric Dumazet 			atomic_inc(&sk->sk_drops);
1260979402b1SEric Dumazet 			UDP_INC_STATS_USER(sock_net(sk),
1261979402b1SEric Dumazet 					   UDP_MIB_INERRORS, is_udplite);
1262979402b1SEric Dumazet 		}
1263db8dac20SDavid S. Miller 		goto out_free;
126422911fc5SEric Dumazet 	}
1265db8dac20SDavid S. Miller 
1266db8dac20SDavid S. Miller 	if (!peeked)
1267629ca23cSPavel Emelyanov 		UDP_INC_STATS_USER(sock_net(sk),
1268629ca23cSPavel Emelyanov 				UDP_MIB_INDATAGRAMS, is_udplite);
1269db8dac20SDavid S. Miller 
12703b885787SNeil Horman 	sock_recv_ts_and_drops(msg, sk, skb);
1271db8dac20SDavid S. Miller 
1272db8dac20SDavid S. Miller 	/* Copy the address. */
1273c482c568SEric Dumazet 	if (sin) {
1274db8dac20SDavid S. Miller 		sin->sin_family = AF_INET;
1275db8dac20SDavid S. Miller 		sin->sin_port = udp_hdr(skb)->source;
1276db8dac20SDavid S. Miller 		sin->sin_addr.s_addr = ip_hdr(skb)->saddr;
1277db8dac20SDavid S. Miller 		memset(sin->sin_zero, 0, sizeof(sin->sin_zero));
1278db8dac20SDavid S. Miller 	}
1279db8dac20SDavid S. Miller 	if (inet->cmsg_flags)
1280db8dac20SDavid S. Miller 		ip_cmsg_recv(msg, skb);
1281db8dac20SDavid S. Miller 
128259c2cdaeSDavid S. Miller 	err = copied;
1283db8dac20SDavid S. Miller 	if (flags & MSG_TRUNC)
1284db8dac20SDavid S. Miller 		err = ulen;
1285db8dac20SDavid S. Miller 
1286db8dac20SDavid S. Miller out_free:
12879d410c79SEric Dumazet 	skb_free_datagram_locked(sk, skb);
1288db8dac20SDavid S. Miller out:
1289db8dac20SDavid S. Miller 	return err;
1290db8dac20SDavid S. Miller 
1291db8dac20SDavid S. Miller csum_copy_err:
12928a74ad60SEric Dumazet 	slow = lock_sock_fast(sk);
12936a5dc9e5SEric Dumazet 	if (!skb_kill_datagram(sk, skb, flags)) {
12946a5dc9e5SEric Dumazet 		UDP_INC_STATS_USER(sock_net(sk), UDP_MIB_CSUMERRORS, is_udplite);
1295629ca23cSPavel Emelyanov 		UDP_INC_STATS_USER(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
12966a5dc9e5SEric Dumazet 	}
12978a74ad60SEric Dumazet 	unlock_sock_fast(sk, slow);
1298db8dac20SDavid S. Miller 
1299db8dac20SDavid S. Miller 	if (noblock)
1300db8dac20SDavid S. Miller 		return -EAGAIN;
13019cfaa8deSXufeng Zhang 
13029cfaa8deSXufeng Zhang 	/* starting over for a new packet */
13039cfaa8deSXufeng Zhang 	msg->msg_flags &= ~MSG_TRUNC;
1304db8dac20SDavid S. Miller 	goto try_again;
1305db8dac20SDavid S. Miller }
1306db8dac20SDavid S. Miller 
1307db8dac20SDavid S. Miller 
13081da177e4SLinus Torvalds int udp_disconnect(struct sock *sk, int flags)
13091da177e4SLinus Torvalds {
13101da177e4SLinus Torvalds 	struct inet_sock *inet = inet_sk(sk);
13111da177e4SLinus Torvalds 	/*
13121da177e4SLinus Torvalds 	 *	1003.1g - break association.
13131da177e4SLinus Torvalds 	 */
13141da177e4SLinus Torvalds 
13151da177e4SLinus Torvalds 	sk->sk_state = TCP_CLOSE;
1316c720c7e8SEric Dumazet 	inet->inet_daddr = 0;
1317c720c7e8SEric Dumazet 	inet->inet_dport = 0;
1318bdeab991STom Herbert 	sock_rps_reset_rxhash(sk);
13191da177e4SLinus Torvalds 	sk->sk_bound_dev_if = 0;
13201da177e4SLinus Torvalds 	if (!(sk->sk_userlocks & SOCK_BINDADDR_LOCK))
13211da177e4SLinus Torvalds 		inet_reset_saddr(sk);
13221da177e4SLinus Torvalds 
13231da177e4SLinus Torvalds 	if (!(sk->sk_userlocks & SOCK_BINDPORT_LOCK)) {
13241da177e4SLinus Torvalds 		sk->sk_prot->unhash(sk);
1325c720c7e8SEric Dumazet 		inet->inet_sport = 0;
13261da177e4SLinus Torvalds 	}
13271da177e4SLinus Torvalds 	sk_dst_reset(sk);
13281da177e4SLinus Torvalds 	return 0;
13291da177e4SLinus Torvalds }
1330c482c568SEric Dumazet EXPORT_SYMBOL(udp_disconnect);
13311da177e4SLinus Torvalds 
1332645ca708SEric Dumazet void udp_lib_unhash(struct sock *sk)
1333645ca708SEric Dumazet {
1334723b4610SEric Dumazet 	if (sk_hashed(sk)) {
1335645ca708SEric Dumazet 		struct udp_table *udptable = sk->sk_prot->h.udp_table;
1336512615b6SEric Dumazet 		struct udp_hslot *hslot, *hslot2;
1337512615b6SEric Dumazet 
1338512615b6SEric Dumazet 		hslot  = udp_hashslot(udptable, sock_net(sk),
1339d4cada4aSEric Dumazet 				      udp_sk(sk)->udp_port_hash);
1340512615b6SEric Dumazet 		hslot2 = udp_hashslot2(udptable, udp_sk(sk)->udp_portaddr_hash);
1341645ca708SEric Dumazet 
1342c8db3fecSEric Dumazet 		spin_lock_bh(&hslot->lock);
134388ab1932SEric Dumazet 		if (sk_nulls_del_node_init_rcu(sk)) {
1344fdcc8aa9SEric Dumazet 			hslot->count--;
1345c720c7e8SEric Dumazet 			inet_sk(sk)->inet_num = 0;
1346645ca708SEric Dumazet 			sock_prot_inuse_add(sock_net(sk), sk->sk_prot, -1);
1347512615b6SEric Dumazet 
1348512615b6SEric Dumazet 			spin_lock(&hslot2->lock);
1349512615b6SEric Dumazet 			hlist_nulls_del_init_rcu(&udp_sk(sk)->udp_portaddr_node);
1350512615b6SEric Dumazet 			hslot2->count--;
1351512615b6SEric Dumazet 			spin_unlock(&hslot2->lock);
1352645ca708SEric Dumazet 		}
1353c8db3fecSEric Dumazet 		spin_unlock_bh(&hslot->lock);
1354645ca708SEric Dumazet 	}
1355723b4610SEric Dumazet }
1356645ca708SEric Dumazet EXPORT_SYMBOL(udp_lib_unhash);
1357645ca708SEric Dumazet 
1358719f8358SEric Dumazet /*
1359719f8358SEric Dumazet  * inet_rcv_saddr was changed, we must rehash secondary hash
1360719f8358SEric Dumazet  */
1361719f8358SEric Dumazet void udp_lib_rehash(struct sock *sk, u16 newhash)
1362719f8358SEric Dumazet {
1363719f8358SEric Dumazet 	if (sk_hashed(sk)) {
1364719f8358SEric Dumazet 		struct udp_table *udptable = sk->sk_prot->h.udp_table;
1365719f8358SEric Dumazet 		struct udp_hslot *hslot, *hslot2, *nhslot2;
1366719f8358SEric Dumazet 
1367719f8358SEric Dumazet 		hslot2 = udp_hashslot2(udptable, udp_sk(sk)->udp_portaddr_hash);
1368719f8358SEric Dumazet 		nhslot2 = udp_hashslot2(udptable, newhash);
1369719f8358SEric Dumazet 		udp_sk(sk)->udp_portaddr_hash = newhash;
1370719f8358SEric Dumazet 		if (hslot2 != nhslot2) {
1371719f8358SEric Dumazet 			hslot = udp_hashslot(udptable, sock_net(sk),
1372719f8358SEric Dumazet 					     udp_sk(sk)->udp_port_hash);
1373719f8358SEric Dumazet 			/* we must lock primary chain too */
1374719f8358SEric Dumazet 			spin_lock_bh(&hslot->lock);
1375719f8358SEric Dumazet 
1376719f8358SEric Dumazet 			spin_lock(&hslot2->lock);
1377719f8358SEric Dumazet 			hlist_nulls_del_init_rcu(&udp_sk(sk)->udp_portaddr_node);
1378719f8358SEric Dumazet 			hslot2->count--;
1379719f8358SEric Dumazet 			spin_unlock(&hslot2->lock);
1380719f8358SEric Dumazet 
1381719f8358SEric Dumazet 			spin_lock(&nhslot2->lock);
1382719f8358SEric Dumazet 			hlist_nulls_add_head_rcu(&udp_sk(sk)->udp_portaddr_node,
1383719f8358SEric Dumazet 						 &nhslot2->head);
1384719f8358SEric Dumazet 			nhslot2->count++;
1385719f8358SEric Dumazet 			spin_unlock(&nhslot2->lock);
1386719f8358SEric Dumazet 
1387719f8358SEric Dumazet 			spin_unlock_bh(&hslot->lock);
1388719f8358SEric Dumazet 		}
1389719f8358SEric Dumazet 	}
1390719f8358SEric Dumazet }
1391719f8358SEric Dumazet EXPORT_SYMBOL(udp_lib_rehash);
1392719f8358SEric Dumazet 
1393719f8358SEric Dumazet static void udp_v4_rehash(struct sock *sk)
1394719f8358SEric Dumazet {
1395719f8358SEric Dumazet 	u16 new_hash = udp4_portaddr_hash(sock_net(sk),
1396719f8358SEric Dumazet 					  inet_sk(sk)->inet_rcv_saddr,
1397719f8358SEric Dumazet 					  inet_sk(sk)->inet_num);
1398719f8358SEric Dumazet 	udp_lib_rehash(sk, new_hash);
1399719f8358SEric Dumazet }
1400719f8358SEric Dumazet 
140193821778SHerbert Xu static int __udp_queue_rcv_skb(struct sock *sk, struct sk_buff *skb)
140293821778SHerbert Xu {
1403fec5e652STom Herbert 	int rc;
140493821778SHerbert Xu 
1405fec5e652STom Herbert 	if (inet_sk(sk)->inet_daddr)
1406bdeab991STom Herbert 		sock_rps_save_rxhash(sk, skb);
1407fec5e652STom Herbert 
1408d826eb14SEric Dumazet 	rc = sock_queue_rcv_skb(sk, skb);
1409766e9037SEric Dumazet 	if (rc < 0) {
1410766e9037SEric Dumazet 		int is_udplite = IS_UDPLITE(sk);
1411766e9037SEric Dumazet 
141293821778SHerbert Xu 		/* Note that an ENOMEM error is charged twice */
1413766e9037SEric Dumazet 		if (rc == -ENOMEM)
141493821778SHerbert Xu 			UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_RCVBUFERRORS,
141593821778SHerbert Xu 					 is_udplite);
1416766e9037SEric Dumazet 		UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
1417766e9037SEric Dumazet 		kfree_skb(skb);
1418296f7ea7SSatoru Moriya 		trace_udp_fail_queue_rcv_skb(rc, sk);
1419766e9037SEric Dumazet 		return -1;
142093821778SHerbert Xu 	}
142193821778SHerbert Xu 
142293821778SHerbert Xu 	return 0;
142393821778SHerbert Xu 
142493821778SHerbert Xu }
142593821778SHerbert Xu 
1426447167bfSEric Dumazet static struct static_key udp_encap_needed __read_mostly;
1427447167bfSEric Dumazet void udp_encap_enable(void)
1428447167bfSEric Dumazet {
1429447167bfSEric Dumazet 	if (!static_key_enabled(&udp_encap_needed))
1430447167bfSEric Dumazet 		static_key_slow_inc(&udp_encap_needed);
1431447167bfSEric Dumazet }
1432447167bfSEric Dumazet EXPORT_SYMBOL(udp_encap_enable);
1433447167bfSEric Dumazet 
1434db8dac20SDavid S. Miller /* returns:
1435db8dac20SDavid S. Miller  *  -1: error
1436db8dac20SDavid S. Miller  *   0: success
1437db8dac20SDavid S. Miller  *  >0: "udp encap" protocol resubmission
1438db8dac20SDavid S. Miller  *
1439db8dac20SDavid S. Miller  * Note that in the success and error cases, the skb is assumed to
1440db8dac20SDavid S. Miller  * have either been requeued or freed.
1441db8dac20SDavid S. Miller  */
1442db8dac20SDavid S. Miller int udp_queue_rcv_skb(struct sock *sk, struct sk_buff *skb)
1443db8dac20SDavid S. Miller {
1444db8dac20SDavid S. Miller 	struct udp_sock *up = udp_sk(sk);
1445db8dac20SDavid S. Miller 	int rc;
1446db8dac20SDavid S. Miller 	int is_udplite = IS_UDPLITE(sk);
1447db8dac20SDavid S. Miller 
1448db8dac20SDavid S. Miller 	/*
1449db8dac20SDavid S. Miller 	 *	Charge it to the socket, dropping if the queue is full.
1450db8dac20SDavid S. Miller 	 */
1451db8dac20SDavid S. Miller 	if (!xfrm4_policy_check(sk, XFRM_POLICY_IN, skb))
1452db8dac20SDavid S. Miller 		goto drop;
1453db8dac20SDavid S. Miller 	nf_reset(skb);
1454db8dac20SDavid S. Miller 
1455447167bfSEric Dumazet 	if (static_key_false(&udp_encap_needed) && up->encap_type) {
14560ad92ad0SEric Dumazet 		int (*encap_rcv)(struct sock *sk, struct sk_buff *skb);
14570ad92ad0SEric Dumazet 
1458db8dac20SDavid S. Miller 		/*
1459db8dac20SDavid S. Miller 		 * This is an encapsulation socket so pass the skb to
1460db8dac20SDavid S. Miller 		 * the socket's udp_encap_rcv() hook. Otherwise, just
1461db8dac20SDavid S. Miller 		 * fall through and pass this up the UDP socket.
1462db8dac20SDavid S. Miller 		 * up->encap_rcv() returns the following value:
1463db8dac20SDavid S. Miller 		 * =0 if skb was successfully passed to the encap
1464db8dac20SDavid S. Miller 		 *    handler or was discarded by it.
1465db8dac20SDavid S. Miller 		 * >0 if skb should be passed on to UDP.
1466db8dac20SDavid S. Miller 		 * <0 if skb should be resubmitted as proto -N
1467db8dac20SDavid S. Miller 		 */
1468db8dac20SDavid S. Miller 
1469db8dac20SDavid S. Miller 		/* if we're overly short, let UDP handle it */
14700ad92ad0SEric Dumazet 		encap_rcv = ACCESS_ONCE(up->encap_rcv);
14710ad92ad0SEric Dumazet 		if (skb->len > sizeof(struct udphdr) && encap_rcv != NULL) {
1472db8dac20SDavid S. Miller 			int ret;
1473db8dac20SDavid S. Miller 
14740ad92ad0SEric Dumazet 			ret = encap_rcv(sk, skb);
1475db8dac20SDavid S. Miller 			if (ret <= 0) {
14760283328eSPavel Emelyanov 				UDP_INC_STATS_BH(sock_net(sk),
14770283328eSPavel Emelyanov 						 UDP_MIB_INDATAGRAMS,
1478db8dac20SDavid S. Miller 						 is_udplite);
1479db8dac20SDavid S. Miller 				return -ret;
1480db8dac20SDavid S. Miller 			}
1481db8dac20SDavid S. Miller 		}
1482db8dac20SDavid S. Miller 
1483db8dac20SDavid S. Miller 		/* FALLTHROUGH -- it's a UDP Packet */
1484db8dac20SDavid S. Miller 	}
1485db8dac20SDavid S. Miller 
1486db8dac20SDavid S. Miller 	/*
1487db8dac20SDavid S. Miller 	 * 	UDP-Lite specific tests, ignored on UDP sockets
1488db8dac20SDavid S. Miller 	 */
1489db8dac20SDavid S. Miller 	if ((is_udplite & UDPLITE_RECV_CC)  &&  UDP_SKB_CB(skb)->partial_cov) {
1490db8dac20SDavid S. Miller 
1491db8dac20SDavid S. Miller 		/*
1492db8dac20SDavid S. Miller 		 * MIB statistics other than incrementing the error count are
1493db8dac20SDavid S. Miller 		 * disabled for the following two types of errors: these depend
1494db8dac20SDavid S. Miller 		 * on the application settings, not on the functioning of the
1495db8dac20SDavid S. Miller 		 * protocol stack as such.
1496db8dac20SDavid S. Miller 		 *
1497db8dac20SDavid S. Miller 		 * RFC 3828 here recommends (sec 3.3): "There should also be a
1498db8dac20SDavid S. Miller 		 * way ... to ... at least let the receiving application block
1499db8dac20SDavid S. Miller 		 * delivery of packets with coverage values less than a value
1500db8dac20SDavid S. Miller 		 * provided by the application."
1501db8dac20SDavid S. Miller 		 */
1502db8dac20SDavid S. Miller 		if (up->pcrlen == 0) {          /* full coverage was set  */
1503afd46503SJoe Perches 			LIMIT_NETDEBUG(KERN_WARNING "UDPLite: partial coverage %d while full coverage %d requested\n",
1504db8dac20SDavid S. Miller 				       UDP_SKB_CB(skb)->cscov, skb->len);
1505db8dac20SDavid S. Miller 			goto drop;
1506db8dac20SDavid S. Miller 		}
1507db8dac20SDavid S. Miller 		/* The next case involves violating the min. coverage requested
1508db8dac20SDavid S. Miller 		 * by the receiver. This is subtle: if receiver wants x and x is
1509db8dac20SDavid S. Miller 		 * greater than the buffersize/MTU then receiver will complain
1510db8dac20SDavid S. Miller 		 * that it wants x while sender emits packets of smaller size y.
1511db8dac20SDavid S. Miller 		 * Therefore the above ...()->partial_cov statement is essential.
1512db8dac20SDavid S. Miller 		 */
1513db8dac20SDavid S. Miller 		if (UDP_SKB_CB(skb)->cscov  <  up->pcrlen) {
1514afd46503SJoe Perches 			LIMIT_NETDEBUG(KERN_WARNING "UDPLite: coverage %d too small, need min %d\n",
1515db8dac20SDavid S. Miller 				       UDP_SKB_CB(skb)->cscov, up->pcrlen);
1516db8dac20SDavid S. Miller 			goto drop;
1517db8dac20SDavid S. Miller 		}
1518db8dac20SDavid S. Miller 	}
1519db8dac20SDavid S. Miller 
152033d480ceSEric Dumazet 	if (rcu_access_pointer(sk->sk_filter) &&
152133d480ceSEric Dumazet 	    udp_lib_checksum_complete(skb))
15226a5dc9e5SEric Dumazet 		goto csum_error;
1523db8dac20SDavid S. Miller 
1524c377411fSEric Dumazet 
1525f545a38fSEric Dumazet 	if (sk_rcvqueues_full(sk, skb, sk->sk_rcvbuf))
1526c377411fSEric Dumazet 		goto drop;
1527c377411fSEric Dumazet 
152893821778SHerbert Xu 	rc = 0;
1529db8dac20SDavid S. Miller 
1530d826eb14SEric Dumazet 	ipv4_pktinfo_prepare(skb);
153193821778SHerbert Xu 	bh_lock_sock(sk);
153293821778SHerbert Xu 	if (!sock_owned_by_user(sk))
153393821778SHerbert Xu 		rc = __udp_queue_rcv_skb(sk, skb);
1534f545a38fSEric Dumazet 	else if (sk_add_backlog(sk, skb, sk->sk_rcvbuf)) {
153555349790SZhu Yi 		bh_unlock_sock(sk);
153655349790SZhu Yi 		goto drop;
153755349790SZhu Yi 	}
153893821778SHerbert Xu 	bh_unlock_sock(sk);
153993821778SHerbert Xu 
154093821778SHerbert Xu 	return rc;
1541db8dac20SDavid S. Miller 
15426a5dc9e5SEric Dumazet csum_error:
15436a5dc9e5SEric Dumazet 	UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_CSUMERRORS, is_udplite);
1544db8dac20SDavid S. Miller drop:
15450283328eSPavel Emelyanov 	UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS, is_udplite);
15468edf19c2SEric Dumazet 	atomic_inc(&sk->sk_drops);
1547db8dac20SDavid S. Miller 	kfree_skb(skb);
1548db8dac20SDavid S. Miller 	return -1;
1549db8dac20SDavid S. Miller }
1550db8dac20SDavid S. Miller 
15511240d137SEric Dumazet 
15521240d137SEric Dumazet static void flush_stack(struct sock **stack, unsigned int count,
15531240d137SEric Dumazet 			struct sk_buff *skb, unsigned int final)
15541240d137SEric Dumazet {
15551240d137SEric Dumazet 	unsigned int i;
15561240d137SEric Dumazet 	struct sk_buff *skb1 = NULL;
1557f6b8f32cSEric Dumazet 	struct sock *sk;
15581240d137SEric Dumazet 
15591240d137SEric Dumazet 	for (i = 0; i < count; i++) {
1560f6b8f32cSEric Dumazet 		sk = stack[i];
15611240d137SEric Dumazet 		if (likely(skb1 == NULL))
15621240d137SEric Dumazet 			skb1 = (i == final) ? skb : skb_clone(skb, GFP_ATOMIC);
15631240d137SEric Dumazet 
1564f6b8f32cSEric Dumazet 		if (!skb1) {
1565f6b8f32cSEric Dumazet 			atomic_inc(&sk->sk_drops);
1566f6b8f32cSEric Dumazet 			UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_RCVBUFERRORS,
1567f6b8f32cSEric Dumazet 					 IS_UDPLITE(sk));
1568f6b8f32cSEric Dumazet 			UDP_INC_STATS_BH(sock_net(sk), UDP_MIB_INERRORS,
1569f6b8f32cSEric Dumazet 					 IS_UDPLITE(sk));
1570f6b8f32cSEric Dumazet 		}
1571f6b8f32cSEric Dumazet 
1572f6b8f32cSEric Dumazet 		if (skb1 && udp_queue_rcv_skb(sk, skb1) <= 0)
15731240d137SEric Dumazet 			skb1 = NULL;
15741240d137SEric Dumazet 	}
15751240d137SEric Dumazet 	if (unlikely(skb1))
15761240d137SEric Dumazet 		kfree_skb(skb1);
15771240d137SEric Dumazet }
15781240d137SEric Dumazet 
1579db8dac20SDavid S. Miller /*
1580db8dac20SDavid S. Miller  *	Multicasts and broadcasts go to each listener.
1581db8dac20SDavid S. Miller  *
15821240d137SEric Dumazet  *	Note: called only from the BH handler context.
1583db8dac20SDavid S. Miller  */
1584e3163493SPavel Emelyanov static int __udp4_lib_mcast_deliver(struct net *net, struct sk_buff *skb,
1585db8dac20SDavid S. Miller 				    struct udphdr  *uh,
1586db8dac20SDavid S. Miller 				    __be32 saddr, __be32 daddr,
1587645ca708SEric Dumazet 				    struct udp_table *udptable)
1588db8dac20SDavid S. Miller {
15891240d137SEric Dumazet 	struct sock *sk, *stack[256 / sizeof(struct sock *)];
1590f86dcc5aSEric Dumazet 	struct udp_hslot *hslot = udp_hashslot(udptable, net, ntohs(uh->dest));
1591db8dac20SDavid S. Miller 	int dif;
15921240d137SEric Dumazet 	unsigned int i, count = 0;
1593db8dac20SDavid S. Miller 
1594645ca708SEric Dumazet 	spin_lock(&hslot->lock);
159588ab1932SEric Dumazet 	sk = sk_nulls_head(&hslot->head);
1596db8dac20SDavid S. Miller 	dif = skb->dev->ifindex;
1597920a4611SEric Dumazet 	sk = udp_v4_mcast_next(net, sk, uh->dest, daddr, uh->source, saddr, dif);
15981240d137SEric Dumazet 	while (sk) {
15991240d137SEric Dumazet 		stack[count++] = sk;
16001240d137SEric Dumazet 		sk = udp_v4_mcast_next(net, sk_nulls_next(sk), uh->dest,
16011240d137SEric Dumazet 				       daddr, uh->source, saddr, dif);
16021240d137SEric Dumazet 		if (unlikely(count == ARRAY_SIZE(stack))) {
16031240d137SEric Dumazet 			if (!sk)
16041240d137SEric Dumazet 				break;
16051240d137SEric Dumazet 			flush_stack(stack, count, skb, ~0);
16061240d137SEric Dumazet 			count = 0;
1607db8dac20SDavid S. Miller 		}
16081240d137SEric Dumazet 	}
16091240d137SEric Dumazet 	/*
16101240d137SEric Dumazet 	 * before releasing chain lock, we must take a reference on sockets
16111240d137SEric Dumazet 	 */
16121240d137SEric Dumazet 	for (i = 0; i < count; i++)
16131240d137SEric Dumazet 		sock_hold(stack[i]);
16141240d137SEric Dumazet 
1615645ca708SEric Dumazet 	spin_unlock(&hslot->lock);
16161240d137SEric Dumazet 
16171240d137SEric Dumazet 	/*
16181240d137SEric Dumazet 	 * do the slow work with no lock held
16191240d137SEric Dumazet 	 */
16201240d137SEric Dumazet 	if (count) {
16211240d137SEric Dumazet 		flush_stack(stack, count, skb, count - 1);
16221240d137SEric Dumazet 
16231240d137SEric Dumazet 		for (i = 0; i < count; i++)
16241240d137SEric Dumazet 			sock_put(stack[i]);
16251240d137SEric Dumazet 	} else {
16261240d137SEric Dumazet 		kfree_skb(skb);
16271240d137SEric Dumazet 	}
1628db8dac20SDavid S. Miller 	return 0;
1629db8dac20SDavid S. Miller }
1630db8dac20SDavid S. Miller 
1631db8dac20SDavid S. Miller /* Initialize UDP checksum. If exited with zero value (success),
1632db8dac20SDavid S. Miller  * CHECKSUM_UNNECESSARY means, that no more checks are required.
1633db8dac20SDavid S. Miller  * Otherwise, csum completion requires chacksumming packet body,
1634db8dac20SDavid S. Miller  * including udp header and folding it to skb->csum.
1635db8dac20SDavid S. Miller  */
1636db8dac20SDavid S. Miller static inline int udp4_csum_init(struct sk_buff *skb, struct udphdr *uh,
1637db8dac20SDavid S. Miller 				 int proto)
1638db8dac20SDavid S. Miller {
1639db8dac20SDavid S. Miller 	const struct iphdr *iph;
1640db8dac20SDavid S. Miller 	int err;
1641db8dac20SDavid S. Miller 
1642db8dac20SDavid S. Miller 	UDP_SKB_CB(skb)->partial_cov = 0;
1643db8dac20SDavid S. Miller 	UDP_SKB_CB(skb)->cscov = skb->len;
1644db8dac20SDavid S. Miller 
1645db8dac20SDavid S. Miller 	if (proto == IPPROTO_UDPLITE) {
1646db8dac20SDavid S. Miller 		err = udplite_checksum_init(skb, uh);
1647db8dac20SDavid S. Miller 		if (err)
1648db8dac20SDavid S. Miller 			return err;
1649db8dac20SDavid S. Miller 	}
1650db8dac20SDavid S. Miller 
1651db8dac20SDavid S. Miller 	iph = ip_hdr(skb);
1652db8dac20SDavid S. Miller 	if (uh->check == 0) {
1653db8dac20SDavid S. Miller 		skb->ip_summed = CHECKSUM_UNNECESSARY;
1654db8dac20SDavid S. Miller 	} else if (skb->ip_summed == CHECKSUM_COMPLETE) {
1655db8dac20SDavid S. Miller 		if (!csum_tcpudp_magic(iph->saddr, iph->daddr, skb->len,
1656db8dac20SDavid S. Miller 				      proto, skb->csum))
1657db8dac20SDavid S. Miller 			skb->ip_summed = CHECKSUM_UNNECESSARY;
1658db8dac20SDavid S. Miller 	}
1659db8dac20SDavid S. Miller 	if (!skb_csum_unnecessary(skb))
1660db8dac20SDavid S. Miller 		skb->csum = csum_tcpudp_nofold(iph->saddr, iph->daddr,
1661db8dac20SDavid S. Miller 					       skb->len, proto, 0);
1662db8dac20SDavid S. Miller 	/* Probably, we should checksum udp header (it should be in cache
1663db8dac20SDavid S. Miller 	 * in any case) and data in tiny packets (< rx copybreak).
1664db8dac20SDavid S. Miller 	 */
1665db8dac20SDavid S. Miller 
1666db8dac20SDavid S. Miller 	return 0;
1667db8dac20SDavid S. Miller }
1668db8dac20SDavid S. Miller 
1669db8dac20SDavid S. Miller /*
1670db8dac20SDavid S. Miller  *	All we need to do is get the socket, and then do a checksum.
1671db8dac20SDavid S. Miller  */
1672db8dac20SDavid S. Miller 
1673645ca708SEric Dumazet int __udp4_lib_rcv(struct sk_buff *skb, struct udp_table *udptable,
1674db8dac20SDavid S. Miller 		   int proto)
1675db8dac20SDavid S. Miller {
1676db8dac20SDavid S. Miller 	struct sock *sk;
16777b5e56f9SJesper Dangaard Brouer 	struct udphdr *uh;
1678db8dac20SDavid S. Miller 	unsigned short ulen;
1679adf30907SEric Dumazet 	struct rtable *rt = skb_rtable(skb);
16802783ef23SJesper Dangaard Brouer 	__be32 saddr, daddr;
16810283328eSPavel Emelyanov 	struct net *net = dev_net(skb->dev);
1682db8dac20SDavid S. Miller 
1683db8dac20SDavid S. Miller 	/*
1684db8dac20SDavid S. Miller 	 *  Validate the packet.
1685db8dac20SDavid S. Miller 	 */
1686db8dac20SDavid S. Miller 	if (!pskb_may_pull(skb, sizeof(struct udphdr)))
1687db8dac20SDavid S. Miller 		goto drop;		/* No space for header. */
1688db8dac20SDavid S. Miller 
16897b5e56f9SJesper Dangaard Brouer 	uh   = udp_hdr(skb);
1690db8dac20SDavid S. Miller 	ulen = ntohs(uh->len);
1691ccc2d97cSBjørn Mork 	saddr = ip_hdr(skb)->saddr;
1692ccc2d97cSBjørn Mork 	daddr = ip_hdr(skb)->daddr;
1693ccc2d97cSBjørn Mork 
1694db8dac20SDavid S. Miller 	if (ulen > skb->len)
1695db8dac20SDavid S. Miller 		goto short_packet;
1696db8dac20SDavid S. Miller 
1697db8dac20SDavid S. Miller 	if (proto == IPPROTO_UDP) {
1698db8dac20SDavid S. Miller 		/* UDP validates ulen. */
1699db8dac20SDavid S. Miller 		if (ulen < sizeof(*uh) || pskb_trim_rcsum(skb, ulen))
1700db8dac20SDavid S. Miller 			goto short_packet;
1701db8dac20SDavid S. Miller 		uh = udp_hdr(skb);
1702db8dac20SDavid S. Miller 	}
1703db8dac20SDavid S. Miller 
1704db8dac20SDavid S. Miller 	if (udp4_csum_init(skb, uh, proto))
1705db8dac20SDavid S. Miller 		goto csum_error;
1706db8dac20SDavid S. Miller 
1707db8dac20SDavid S. Miller 	if (rt->rt_flags & (RTCF_BROADCAST|RTCF_MULTICAST))
1708e3163493SPavel Emelyanov 		return __udp4_lib_mcast_deliver(net, skb, uh,
1709e3163493SPavel Emelyanov 				saddr, daddr, udptable);
1710db8dac20SDavid S. Miller 
1711607c4aafSKOVACS Krisztian 	sk = __udp4_lib_lookup_skb(skb, uh->source, uh->dest, udptable);
1712db8dac20SDavid S. Miller 
1713db8dac20SDavid S. Miller 	if (sk != NULL) {
1714a5b50476SEliezer Tamir 		int ret;
1715a5b50476SEliezer Tamir 
1716a5b50476SEliezer Tamir 		sk_mark_ll(sk, skb);
1717a5b50476SEliezer Tamir 		ret = udp_queue_rcv_skb(sk, skb);
1718db8dac20SDavid S. Miller 		sock_put(sk);
1719db8dac20SDavid S. Miller 
1720db8dac20SDavid S. Miller 		/* a return value > 0 means to resubmit the input, but
1721db8dac20SDavid S. Miller 		 * it wants the return to be -protocol, or 0
1722db8dac20SDavid S. Miller 		 */
1723db8dac20SDavid S. Miller 		if (ret > 0)
1724db8dac20SDavid S. Miller 			return -ret;
1725db8dac20SDavid S. Miller 		return 0;
1726db8dac20SDavid S. Miller 	}
1727db8dac20SDavid S. Miller 
1728db8dac20SDavid S. Miller 	if (!xfrm4_policy_check(NULL, XFRM_POLICY_IN, skb))
1729db8dac20SDavid S. Miller 		goto drop;
1730db8dac20SDavid S. Miller 	nf_reset(skb);
1731db8dac20SDavid S. Miller 
1732db8dac20SDavid S. Miller 	/* No socket. Drop packet silently, if checksum is wrong */
1733db8dac20SDavid S. Miller 	if (udp_lib_checksum_complete(skb))
1734db8dac20SDavid S. Miller 		goto csum_error;
1735db8dac20SDavid S. Miller 
17360283328eSPavel Emelyanov 	UDP_INC_STATS_BH(net, UDP_MIB_NOPORTS, proto == IPPROTO_UDPLITE);
1737db8dac20SDavid S. Miller 	icmp_send(skb, ICMP_DEST_UNREACH, ICMP_PORT_UNREACH, 0);
1738db8dac20SDavid S. Miller 
1739db8dac20SDavid S. Miller 	/*
1740db8dac20SDavid S. Miller 	 * Hmm.  We got an UDP packet to a port to which we
1741db8dac20SDavid S. Miller 	 * don't wanna listen.  Ignore it.
1742db8dac20SDavid S. Miller 	 */
1743db8dac20SDavid S. Miller 	kfree_skb(skb);
1744db8dac20SDavid S. Miller 	return 0;
1745db8dac20SDavid S. Miller 
1746db8dac20SDavid S. Miller short_packet:
1747673d57e7SHarvey Harrison 	LIMIT_NETDEBUG(KERN_DEBUG "UDP%s: short packet: From %pI4:%u %d/%d to %pI4:%u\n",
1748afd46503SJoe Perches 		       proto == IPPROTO_UDPLITE ? "Lite" : "",
1749afd46503SJoe Perches 		       &saddr, ntohs(uh->source),
1750afd46503SJoe Perches 		       ulen, skb->len,
1751afd46503SJoe Perches 		       &daddr, ntohs(uh->dest));
1752db8dac20SDavid S. Miller 	goto drop;
1753db8dac20SDavid S. Miller 
1754db8dac20SDavid S. Miller csum_error:
1755db8dac20SDavid S. Miller 	/*
1756db8dac20SDavid S. Miller 	 * RFC1122: OK.  Discards the bad packet silently (as far as
1757db8dac20SDavid S. Miller 	 * the network is concerned, anyway) as per 4.1.3.4 (MUST).
1758db8dac20SDavid S. Miller 	 */
1759673d57e7SHarvey Harrison 	LIMIT_NETDEBUG(KERN_DEBUG "UDP%s: bad checksum. From %pI4:%u to %pI4:%u ulen %d\n",
1760afd46503SJoe Perches 		       proto == IPPROTO_UDPLITE ? "Lite" : "",
1761afd46503SJoe Perches 		       &saddr, ntohs(uh->source), &daddr, ntohs(uh->dest),
1762db8dac20SDavid S. Miller 		       ulen);
17636a5dc9e5SEric Dumazet 	UDP_INC_STATS_BH(net, UDP_MIB_CSUMERRORS, proto == IPPROTO_UDPLITE);
1764db8dac20SDavid S. Miller drop:
17650283328eSPavel Emelyanov 	UDP_INC_STATS_BH(net, UDP_MIB_INERRORS, proto == IPPROTO_UDPLITE);
1766db8dac20SDavid S. Miller 	kfree_skb(skb);
1767db8dac20SDavid S. Miller 	return 0;
1768db8dac20SDavid S. Miller }
1769db8dac20SDavid S. Miller 
1770db8dac20SDavid S. Miller int udp_rcv(struct sk_buff *skb)
1771db8dac20SDavid S. Miller {
1772645ca708SEric Dumazet 	return __udp4_lib_rcv(skb, &udp_table, IPPROTO_UDP);
1773db8dac20SDavid S. Miller }
1774db8dac20SDavid S. Miller 
17757d06b2e0SBrian Haley void udp_destroy_sock(struct sock *sk)
1776db8dac20SDavid S. Miller {
177744046a59STom Parkin 	struct udp_sock *up = udp_sk(sk);
17788a74ad60SEric Dumazet 	bool slow = lock_sock_fast(sk);
1779db8dac20SDavid S. Miller 	udp_flush_pending_frames(sk);
17808a74ad60SEric Dumazet 	unlock_sock_fast(sk, slow);
178144046a59STom Parkin 	if (static_key_false(&udp_encap_needed) && up->encap_type) {
178244046a59STom Parkin 		void (*encap_destroy)(struct sock *sk);
178344046a59STom Parkin 		encap_destroy = ACCESS_ONCE(up->encap_destroy);
178444046a59STom Parkin 		if (encap_destroy)
178544046a59STom Parkin 			encap_destroy(sk);
178644046a59STom Parkin 	}
1787db8dac20SDavid S. Miller }
1788db8dac20SDavid S. Miller 
17891da177e4SLinus Torvalds /*
17901da177e4SLinus Torvalds  *	Socket option code for UDP
17911da177e4SLinus Torvalds  */
17924c0a6cb0SGerrit Renker int udp_lib_setsockopt(struct sock *sk, int level, int optname,
1793b7058842SDavid S. Miller 		       char __user *optval, unsigned int optlen,
17944c0a6cb0SGerrit Renker 		       int (*push_pending_frames)(struct sock *))
17951da177e4SLinus Torvalds {
17961da177e4SLinus Torvalds 	struct udp_sock *up = udp_sk(sk);
17971da177e4SLinus Torvalds 	int val;
17981da177e4SLinus Torvalds 	int err = 0;
1799b2bf1e26SWang Chen 	int is_udplite = IS_UDPLITE(sk);
18001da177e4SLinus Torvalds 
18011da177e4SLinus Torvalds 	if (optlen < sizeof(int))
18021da177e4SLinus Torvalds 		return -EINVAL;
18031da177e4SLinus Torvalds 
18041da177e4SLinus Torvalds 	if (get_user(val, (int __user *)optval))
18051da177e4SLinus Torvalds 		return -EFAULT;
18061da177e4SLinus Torvalds 
18071da177e4SLinus Torvalds 	switch (optname) {
18081da177e4SLinus Torvalds 	case UDP_CORK:
18091da177e4SLinus Torvalds 		if (val != 0) {
18101da177e4SLinus Torvalds 			up->corkflag = 1;
18111da177e4SLinus Torvalds 		} else {
18121da177e4SLinus Torvalds 			up->corkflag = 0;
18131da177e4SLinus Torvalds 			lock_sock(sk);
18144c0a6cb0SGerrit Renker 			(*push_pending_frames)(sk);
18151da177e4SLinus Torvalds 			release_sock(sk);
18161da177e4SLinus Torvalds 		}
18171da177e4SLinus Torvalds 		break;
18181da177e4SLinus Torvalds 
18191da177e4SLinus Torvalds 	case UDP_ENCAP:
18201da177e4SLinus Torvalds 		switch (val) {
18211da177e4SLinus Torvalds 		case 0:
18221da177e4SLinus Torvalds 		case UDP_ENCAP_ESPINUDP:
18231da177e4SLinus Torvalds 		case UDP_ENCAP_ESPINUDP_NON_IKE:
1824067b207bSJames Chapman 			up->encap_rcv = xfrm4_udp_encap_rcv;
1825067b207bSJames Chapman 			/* FALLTHROUGH */
1826342f0234SJames Chapman 		case UDP_ENCAP_L2TPINUDP:
18271da177e4SLinus Torvalds 			up->encap_type = val;
1828447167bfSEric Dumazet 			udp_encap_enable();
18291da177e4SLinus Torvalds 			break;
18301da177e4SLinus Torvalds 		default:
18311da177e4SLinus Torvalds 			err = -ENOPROTOOPT;
18321da177e4SLinus Torvalds 			break;
18331da177e4SLinus Torvalds 		}
18341da177e4SLinus Torvalds 		break;
18351da177e4SLinus Torvalds 
1836ba4e58ecSGerrit Renker 	/*
1837ba4e58ecSGerrit Renker 	 * 	UDP-Lite's partial checksum coverage (RFC 3828).
1838ba4e58ecSGerrit Renker 	 */
1839ba4e58ecSGerrit Renker 	/* The sender sets actual checksum coverage length via this option.
1840ba4e58ecSGerrit Renker 	 * The case coverage > packet length is handled by send module. */
1841ba4e58ecSGerrit Renker 	case UDPLITE_SEND_CSCOV:
1842b2bf1e26SWang Chen 		if (!is_udplite)         /* Disable the option on UDP sockets */
1843ba4e58ecSGerrit Renker 			return -ENOPROTOOPT;
1844ba4e58ecSGerrit Renker 		if (val != 0 && val < 8) /* Illegal coverage: use default (8) */
1845ba4e58ecSGerrit Renker 			val = 8;
18464be929beSAlexey Dobriyan 		else if (val > USHRT_MAX)
18474be929beSAlexey Dobriyan 			val = USHRT_MAX;
1848ba4e58ecSGerrit Renker 		up->pcslen = val;
1849ba4e58ecSGerrit Renker 		up->pcflag |= UDPLITE_SEND_CC;
1850ba4e58ecSGerrit Renker 		break;
1851ba4e58ecSGerrit Renker 
1852ba4e58ecSGerrit Renker 	/* The receiver specifies a minimum checksum coverage value. To make
1853ba4e58ecSGerrit Renker 	 * sense, this should be set to at least 8 (as done below). If zero is
1854ba4e58ecSGerrit Renker 	 * used, this again means full checksum coverage.                     */
1855ba4e58ecSGerrit Renker 	case UDPLITE_RECV_CSCOV:
1856b2bf1e26SWang Chen 		if (!is_udplite)         /* Disable the option on UDP sockets */
1857ba4e58ecSGerrit Renker 			return -ENOPROTOOPT;
1858ba4e58ecSGerrit Renker 		if (val != 0 && val < 8) /* Avoid silly minimal values.       */
1859ba4e58ecSGerrit Renker 			val = 8;
18604be929beSAlexey Dobriyan 		else if (val > USHRT_MAX)
18614be929beSAlexey Dobriyan 			val = USHRT_MAX;
1862ba4e58ecSGerrit Renker 		up->pcrlen = val;
1863ba4e58ecSGerrit Renker 		up->pcflag |= UDPLITE_RECV_CC;
1864ba4e58ecSGerrit Renker 		break;
1865ba4e58ecSGerrit Renker 
18661da177e4SLinus Torvalds 	default:
18671da177e4SLinus Torvalds 		err = -ENOPROTOOPT;
18681da177e4SLinus Torvalds 		break;
18696516c655SStephen Hemminger 	}
18701da177e4SLinus Torvalds 
18711da177e4SLinus Torvalds 	return err;
18721da177e4SLinus Torvalds }
1873c482c568SEric Dumazet EXPORT_SYMBOL(udp_lib_setsockopt);
18741da177e4SLinus Torvalds 
1875db8dac20SDavid S. Miller int udp_setsockopt(struct sock *sk, int level, int optname,
1876b7058842SDavid S. Miller 		   char __user *optval, unsigned int optlen)
1877db8dac20SDavid S. Miller {
1878db8dac20SDavid S. Miller 	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1879db8dac20SDavid S. Miller 		return udp_lib_setsockopt(sk, level, optname, optval, optlen,
1880db8dac20SDavid S. Miller 					  udp_push_pending_frames);
1881db8dac20SDavid S. Miller 	return ip_setsockopt(sk, level, optname, optval, optlen);
1882db8dac20SDavid S. Miller }
1883db8dac20SDavid S. Miller 
1884db8dac20SDavid S. Miller #ifdef CONFIG_COMPAT
1885db8dac20SDavid S. Miller int compat_udp_setsockopt(struct sock *sk, int level, int optname,
1886b7058842SDavid S. Miller 			  char __user *optval, unsigned int optlen)
1887db8dac20SDavid S. Miller {
1888db8dac20SDavid S. Miller 	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1889db8dac20SDavid S. Miller 		return udp_lib_setsockopt(sk, level, optname, optval, optlen,
1890db8dac20SDavid S. Miller 					  udp_push_pending_frames);
1891db8dac20SDavid S. Miller 	return compat_ip_setsockopt(sk, level, optname, optval, optlen);
1892db8dac20SDavid S. Miller }
1893db8dac20SDavid S. Miller #endif
1894db8dac20SDavid S. Miller 
18954c0a6cb0SGerrit Renker int udp_lib_getsockopt(struct sock *sk, int level, int optname,
18961da177e4SLinus Torvalds 		       char __user *optval, int __user *optlen)
18971da177e4SLinus Torvalds {
18981da177e4SLinus Torvalds 	struct udp_sock *up = udp_sk(sk);
18991da177e4SLinus Torvalds 	int val, len;
19001da177e4SLinus Torvalds 
19011da177e4SLinus Torvalds 	if (get_user(len, optlen))
19021da177e4SLinus Torvalds 		return -EFAULT;
19031da177e4SLinus Torvalds 
19041da177e4SLinus Torvalds 	len = min_t(unsigned int, len, sizeof(int));
19051da177e4SLinus Torvalds 
19061da177e4SLinus Torvalds 	if (len < 0)
19071da177e4SLinus Torvalds 		return -EINVAL;
19081da177e4SLinus Torvalds 
19091da177e4SLinus Torvalds 	switch (optname) {
19101da177e4SLinus Torvalds 	case UDP_CORK:
19111da177e4SLinus Torvalds 		val = up->corkflag;
19121da177e4SLinus Torvalds 		break;
19131da177e4SLinus Torvalds 
19141da177e4SLinus Torvalds 	case UDP_ENCAP:
19151da177e4SLinus Torvalds 		val = up->encap_type;
19161da177e4SLinus Torvalds 		break;
19171da177e4SLinus Torvalds 
1918ba4e58ecSGerrit Renker 	/* The following two cannot be changed on UDP sockets, the return is
1919ba4e58ecSGerrit Renker 	 * always 0 (which corresponds to the full checksum coverage of UDP). */
1920ba4e58ecSGerrit Renker 	case UDPLITE_SEND_CSCOV:
1921ba4e58ecSGerrit Renker 		val = up->pcslen;
1922ba4e58ecSGerrit Renker 		break;
1923ba4e58ecSGerrit Renker 
1924ba4e58ecSGerrit Renker 	case UDPLITE_RECV_CSCOV:
1925ba4e58ecSGerrit Renker 		val = up->pcrlen;
1926ba4e58ecSGerrit Renker 		break;
1927ba4e58ecSGerrit Renker 
19281da177e4SLinus Torvalds 	default:
19291da177e4SLinus Torvalds 		return -ENOPROTOOPT;
19306516c655SStephen Hemminger 	}
19311da177e4SLinus Torvalds 
19321da177e4SLinus Torvalds 	if (put_user(len, optlen))
19331da177e4SLinus Torvalds 		return -EFAULT;
19341da177e4SLinus Torvalds 	if (copy_to_user(optval, &val, len))
19351da177e4SLinus Torvalds 		return -EFAULT;
19361da177e4SLinus Torvalds 	return 0;
19371da177e4SLinus Torvalds }
1938c482c568SEric Dumazet EXPORT_SYMBOL(udp_lib_getsockopt);
19391da177e4SLinus Torvalds 
1940db8dac20SDavid S. Miller int udp_getsockopt(struct sock *sk, int level, int optname,
1941db8dac20SDavid S. Miller 		   char __user *optval, int __user *optlen)
1942db8dac20SDavid S. Miller {
1943db8dac20SDavid S. Miller 	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1944db8dac20SDavid S. Miller 		return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1945db8dac20SDavid S. Miller 	return ip_getsockopt(sk, level, optname, optval, optlen);
1946db8dac20SDavid S. Miller }
1947db8dac20SDavid S. Miller 
1948db8dac20SDavid S. Miller #ifdef CONFIG_COMPAT
1949db8dac20SDavid S. Miller int compat_udp_getsockopt(struct sock *sk, int level, int optname,
1950db8dac20SDavid S. Miller 				 char __user *optval, int __user *optlen)
1951db8dac20SDavid S. Miller {
1952db8dac20SDavid S. Miller 	if (level == SOL_UDP  ||  level == SOL_UDPLITE)
1953db8dac20SDavid S. Miller 		return udp_lib_getsockopt(sk, level, optname, optval, optlen);
1954db8dac20SDavid S. Miller 	return compat_ip_getsockopt(sk, level, optname, optval, optlen);
1955db8dac20SDavid S. Miller }
1956db8dac20SDavid S. Miller #endif
19571da177e4SLinus Torvalds /**
19581da177e4SLinus Torvalds  * 	udp_poll - wait for a UDP event.
19591da177e4SLinus Torvalds  *	@file - file struct
19601da177e4SLinus Torvalds  *	@sock - socket
19611da177e4SLinus Torvalds  *	@wait - poll table
19621da177e4SLinus Torvalds  *
19631da177e4SLinus Torvalds  *	This is same as datagram poll, except for the special case of
19641da177e4SLinus Torvalds  *	blocking sockets. If application is using a blocking fd
19651da177e4SLinus Torvalds  *	and a packet with checksum error is in the queue;
19661da177e4SLinus Torvalds  *	then it could get return from select indicating data available
19671da177e4SLinus Torvalds  *	but then block when reading it. Add special case code
19681da177e4SLinus Torvalds  *	to work around these arguably broken applications.
19691da177e4SLinus Torvalds  */
19701da177e4SLinus Torvalds unsigned int udp_poll(struct file *file, struct socket *sock, poll_table *wait)
19711da177e4SLinus Torvalds {
19721da177e4SLinus Torvalds 	unsigned int mask = datagram_poll(file, sock, wait);
19731da177e4SLinus Torvalds 	struct sock *sk = sock->sk;
19741da177e4SLinus Torvalds 
1975c3f1dbafSDavid Majnemer 	sock_rps_record_flow(sk);
1976c3f1dbafSDavid Majnemer 
19771da177e4SLinus Torvalds 	/* Check for false positives due to checksum errors */
197885584672SEric Dumazet 	if ((mask & POLLRDNORM) && !(file->f_flags & O_NONBLOCK) &&
197985584672SEric Dumazet 	    !(sk->sk_shutdown & RCV_SHUTDOWN) && !first_packet_length(sk))
19801da177e4SLinus Torvalds 		mask &= ~(POLLIN | POLLRDNORM);
19811da177e4SLinus Torvalds 
19821da177e4SLinus Torvalds 	return mask;
19831da177e4SLinus Torvalds 
19841da177e4SLinus Torvalds }
1985c482c568SEric Dumazet EXPORT_SYMBOL(udp_poll);
19861da177e4SLinus Torvalds 
1987db8dac20SDavid S. Miller struct proto udp_prot = {
1988db8dac20SDavid S. Miller 	.name		   = "UDP",
1989db8dac20SDavid S. Miller 	.owner		   = THIS_MODULE,
1990db8dac20SDavid S. Miller 	.close		   = udp_lib_close,
1991db8dac20SDavid S. Miller 	.connect	   = ip4_datagram_connect,
1992db8dac20SDavid S. Miller 	.disconnect	   = udp_disconnect,
1993db8dac20SDavid S. Miller 	.ioctl		   = udp_ioctl,
1994db8dac20SDavid S. Miller 	.destroy	   = udp_destroy_sock,
1995db8dac20SDavid S. Miller 	.setsockopt	   = udp_setsockopt,
1996db8dac20SDavid S. Miller 	.getsockopt	   = udp_getsockopt,
1997db8dac20SDavid S. Miller 	.sendmsg	   = udp_sendmsg,
1998db8dac20SDavid S. Miller 	.recvmsg	   = udp_recvmsg,
1999db8dac20SDavid S. Miller 	.sendpage	   = udp_sendpage,
200093821778SHerbert Xu 	.backlog_rcv	   = __udp_queue_rcv_skb,
20018141ed9fSSteffen Klassert 	.release_cb	   = ip4_datagram_release_cb,
2002db8dac20SDavid S. Miller 	.hash		   = udp_lib_hash,
2003db8dac20SDavid S. Miller 	.unhash		   = udp_lib_unhash,
2004719f8358SEric Dumazet 	.rehash		   = udp_v4_rehash,
2005db8dac20SDavid S. Miller 	.get_port	   = udp_v4_get_port,
2006db8dac20SDavid S. Miller 	.memory_allocated  = &udp_memory_allocated,
2007db8dac20SDavid S. Miller 	.sysctl_mem	   = sysctl_udp_mem,
2008db8dac20SDavid S. Miller 	.sysctl_wmem	   = &sysctl_udp_wmem_min,
2009db8dac20SDavid S. Miller 	.sysctl_rmem	   = &sysctl_udp_rmem_min,
2010db8dac20SDavid S. Miller 	.obj_size	   = sizeof(struct udp_sock),
2011271b72c7SEric Dumazet 	.slab_flags	   = SLAB_DESTROY_BY_RCU,
2012645ca708SEric Dumazet 	.h.udp_table	   = &udp_table,
2013db8dac20SDavid S. Miller #ifdef CONFIG_COMPAT
2014db8dac20SDavid S. Miller 	.compat_setsockopt = compat_udp_setsockopt,
2015db8dac20SDavid S. Miller 	.compat_getsockopt = compat_udp_getsockopt,
2016db8dac20SDavid S. Miller #endif
2017fcbdf09dSOctavian Purdila 	.clear_sk	   = sk_prot_clear_portaddr_nulls,
2018db8dac20SDavid S. Miller };
2019c482c568SEric Dumazet EXPORT_SYMBOL(udp_prot);
20201da177e4SLinus Torvalds 
20211da177e4SLinus Torvalds /* ------------------------------------------------------------------------ */
20221da177e4SLinus Torvalds #ifdef CONFIG_PROC_FS
20231da177e4SLinus Torvalds 
2024645ca708SEric Dumazet static struct sock *udp_get_first(struct seq_file *seq, int start)
20251da177e4SLinus Torvalds {
20261da177e4SLinus Torvalds 	struct sock *sk;
20271da177e4SLinus Torvalds 	struct udp_iter_state *state = seq->private;
20286f191efeSDenis V. Lunev 	struct net *net = seq_file_net(seq);
20291da177e4SLinus Torvalds 
2030f86dcc5aSEric Dumazet 	for (state->bucket = start; state->bucket <= state->udp_table->mask;
2031f86dcc5aSEric Dumazet 	     ++state->bucket) {
203288ab1932SEric Dumazet 		struct hlist_nulls_node *node;
2033645ca708SEric Dumazet 		struct udp_hslot *hslot = &state->udp_table->hash[state->bucket];
2034f86dcc5aSEric Dumazet 
2035f86dcc5aSEric Dumazet 		if (hlist_nulls_empty(&hslot->head))
2036f86dcc5aSEric Dumazet 			continue;
2037f86dcc5aSEric Dumazet 
2038645ca708SEric Dumazet 		spin_lock_bh(&hslot->lock);
203988ab1932SEric Dumazet 		sk_nulls_for_each(sk, node, &hslot->head) {
2040878628fbSYOSHIFUJI Hideaki 			if (!net_eq(sock_net(sk), net))
2041a91275efSDaniel Lezcano 				continue;
20421da177e4SLinus Torvalds 			if (sk->sk_family == state->family)
20431da177e4SLinus Torvalds 				goto found;
20441da177e4SLinus Torvalds 		}
2045645ca708SEric Dumazet 		spin_unlock_bh(&hslot->lock);
20461da177e4SLinus Torvalds 	}
20471da177e4SLinus Torvalds 	sk = NULL;
20481da177e4SLinus Torvalds found:
20491da177e4SLinus Torvalds 	return sk;
20501da177e4SLinus Torvalds }
20511da177e4SLinus Torvalds 
20521da177e4SLinus Torvalds static struct sock *udp_get_next(struct seq_file *seq, struct sock *sk)
20531da177e4SLinus Torvalds {
20541da177e4SLinus Torvalds 	struct udp_iter_state *state = seq->private;
20556f191efeSDenis V. Lunev 	struct net *net = seq_file_net(seq);
20561da177e4SLinus Torvalds 
20571da177e4SLinus Torvalds 	do {
205888ab1932SEric Dumazet 		sk = sk_nulls_next(sk);
2059878628fbSYOSHIFUJI Hideaki 	} while (sk && (!net_eq(sock_net(sk), net) || sk->sk_family != state->family));
20601da177e4SLinus Torvalds 
2061645ca708SEric Dumazet 	if (!sk) {
2062f86dcc5aSEric Dumazet 		if (state->bucket <= state->udp_table->mask)
2063f52b5054SEric Dumazet 			spin_unlock_bh(&state->udp_table->hash[state->bucket].lock);
2064645ca708SEric Dumazet 		return udp_get_first(seq, state->bucket + 1);
20651da177e4SLinus Torvalds 	}
20661da177e4SLinus Torvalds 	return sk;
20671da177e4SLinus Torvalds }
20681da177e4SLinus Torvalds 
20691da177e4SLinus Torvalds static struct sock *udp_get_idx(struct seq_file *seq, loff_t pos)
20701da177e4SLinus Torvalds {
2071645ca708SEric Dumazet 	struct sock *sk = udp_get_first(seq, 0);
20721da177e4SLinus Torvalds 
20731da177e4SLinus Torvalds 	if (sk)
20741da177e4SLinus Torvalds 		while (pos && (sk = udp_get_next(seq, sk)) != NULL)
20751da177e4SLinus Torvalds 			--pos;
20761da177e4SLinus Torvalds 	return pos ? NULL : sk;
20771da177e4SLinus Torvalds }
20781da177e4SLinus Torvalds 
20791da177e4SLinus Torvalds static void *udp_seq_start(struct seq_file *seq, loff_t *pos)
20801da177e4SLinus Torvalds {
208130842f29SVitaly Mayatskikh 	struct udp_iter_state *state = seq->private;
2082f86dcc5aSEric Dumazet 	state->bucket = MAX_UDP_PORTS;
208330842f29SVitaly Mayatskikh 
2084b50660f1SYOSHIFUJI Hideaki 	return *pos ? udp_get_idx(seq, *pos-1) : SEQ_START_TOKEN;
20851da177e4SLinus Torvalds }
20861da177e4SLinus Torvalds 
20871da177e4SLinus Torvalds static void *udp_seq_next(struct seq_file *seq, void *v, loff_t *pos)
20881da177e4SLinus Torvalds {
20891da177e4SLinus Torvalds 	struct sock *sk;
20901da177e4SLinus Torvalds 
2091b50660f1SYOSHIFUJI Hideaki 	if (v == SEQ_START_TOKEN)
20921da177e4SLinus Torvalds 		sk = udp_get_idx(seq, 0);
20931da177e4SLinus Torvalds 	else
20941da177e4SLinus Torvalds 		sk = udp_get_next(seq, v);
20951da177e4SLinus Torvalds 
20961da177e4SLinus Torvalds 	++*pos;
20971da177e4SLinus Torvalds 	return sk;
20981da177e4SLinus Torvalds }
20991da177e4SLinus Torvalds 
21001da177e4SLinus Torvalds static void udp_seq_stop(struct seq_file *seq, void *v)
21011da177e4SLinus Torvalds {
2102645ca708SEric Dumazet 	struct udp_iter_state *state = seq->private;
2103645ca708SEric Dumazet 
2104f86dcc5aSEric Dumazet 	if (state->bucket <= state->udp_table->mask)
2105645ca708SEric Dumazet 		spin_unlock_bh(&state->udp_table->hash[state->bucket].lock);
21061da177e4SLinus Torvalds }
21071da177e4SLinus Torvalds 
210873cb88ecSArjan van de Ven int udp_seq_open(struct inode *inode, struct file *file)
21091da177e4SLinus Torvalds {
2110d9dda78bSAl Viro 	struct udp_seq_afinfo *afinfo = PDE_DATA(inode);
2111a2be75c1SDenis V. Lunev 	struct udp_iter_state *s;
2112a2be75c1SDenis V. Lunev 	int err;
21131da177e4SLinus Torvalds 
2114a2be75c1SDenis V. Lunev 	err = seq_open_net(inode, file, &afinfo->seq_ops,
2115a2be75c1SDenis V. Lunev 			   sizeof(struct udp_iter_state));
2116a2be75c1SDenis V. Lunev 	if (err < 0)
2117a2be75c1SDenis V. Lunev 		return err;
2118a91275efSDaniel Lezcano 
2119a2be75c1SDenis V. Lunev 	s = ((struct seq_file *)file->private_data)->private;
21201da177e4SLinus Torvalds 	s->family		= afinfo->family;
2121645ca708SEric Dumazet 	s->udp_table		= afinfo->udp_table;
2122a2be75c1SDenis V. Lunev 	return err;
2123a91275efSDaniel Lezcano }
212473cb88ecSArjan van de Ven EXPORT_SYMBOL(udp_seq_open);
2125a91275efSDaniel Lezcano 
21261da177e4SLinus Torvalds /* ------------------------------------------------------------------------ */
21270c96d8c5SDaniel Lezcano int udp_proc_register(struct net *net, struct udp_seq_afinfo *afinfo)
21281da177e4SLinus Torvalds {
21291da177e4SLinus Torvalds 	struct proc_dir_entry *p;
21301da177e4SLinus Torvalds 	int rc = 0;
21311da177e4SLinus Torvalds 
2132dda61925SDenis V. Lunev 	afinfo->seq_ops.start		= udp_seq_start;
2133dda61925SDenis V. Lunev 	afinfo->seq_ops.next		= udp_seq_next;
2134dda61925SDenis V. Lunev 	afinfo->seq_ops.stop		= udp_seq_stop;
2135dda61925SDenis V. Lunev 
213684841c3cSDenis V. Lunev 	p = proc_create_data(afinfo->name, S_IRUGO, net->proc_net,
213773cb88ecSArjan van de Ven 			     afinfo->seq_fops, afinfo);
213884841c3cSDenis V. Lunev 	if (!p)
21391da177e4SLinus Torvalds 		rc = -ENOMEM;
21401da177e4SLinus Torvalds 	return rc;
21411da177e4SLinus Torvalds }
2142c482c568SEric Dumazet EXPORT_SYMBOL(udp_proc_register);
21431da177e4SLinus Torvalds 
21440c96d8c5SDaniel Lezcano void udp_proc_unregister(struct net *net, struct udp_seq_afinfo *afinfo)
21451da177e4SLinus Torvalds {
2146ece31ffdSGao feng 	remove_proc_entry(afinfo->name, net->proc_net);
21471da177e4SLinus Torvalds }
2148c482c568SEric Dumazet EXPORT_SYMBOL(udp_proc_unregister);
2149db8dac20SDavid S. Miller 
2150db8dac20SDavid S. Miller /* ------------------------------------------------------------------------ */
21515e659e4cSPavel Emelyanov static void udp4_format_sock(struct sock *sp, struct seq_file *f,
21525e659e4cSPavel Emelyanov 		int bucket, int *len)
2153db8dac20SDavid S. Miller {
2154db8dac20SDavid S. Miller 	struct inet_sock *inet = inet_sk(sp);
2155c720c7e8SEric Dumazet 	__be32 dest = inet->inet_daddr;
2156c720c7e8SEric Dumazet 	__be32 src  = inet->inet_rcv_saddr;
2157c720c7e8SEric Dumazet 	__u16 destp	  = ntohs(inet->inet_dport);
2158c720c7e8SEric Dumazet 	__u16 srcp	  = ntohs(inet->inet_sport);
2159db8dac20SDavid S. Miller 
2160f86dcc5aSEric Dumazet 	seq_printf(f, "%5d: %08X:%04X %08X:%04X"
216171338aa7SDan Rosenberg 		" %02X %08X:%08X %02X:%08lX %08X %5d %8d %lu %d %pK %d%n",
2162db8dac20SDavid S. Miller 		bucket, src, srcp, dest, destp, sp->sk_state,
216331e6d363SEric Dumazet 		sk_wmem_alloc_get(sp),
216431e6d363SEric Dumazet 		sk_rmem_alloc_get(sp),
2165a7cb5a49SEric W. Biederman 		0, 0L, 0,
2166a7cb5a49SEric W. Biederman 		from_kuid_munged(seq_user_ns(f), sock_i_uid(sp)),
2167a7cb5a49SEric W. Biederman 		0, sock_i_ino(sp),
2168cb61cb9bSEric Dumazet 		atomic_read(&sp->sk_refcnt), sp,
2169cb61cb9bSEric Dumazet 		atomic_read(&sp->sk_drops), len);
2170db8dac20SDavid S. Miller }
2171db8dac20SDavid S. Miller 
2172db8dac20SDavid S. Miller int udp4_seq_show(struct seq_file *seq, void *v)
2173db8dac20SDavid S. Miller {
2174db8dac20SDavid S. Miller 	if (v == SEQ_START_TOKEN)
2175db8dac20SDavid S. Miller 		seq_printf(seq, "%-127s\n",
2176db8dac20SDavid S. Miller 			   "  sl  local_address rem_address   st tx_queue "
2177db8dac20SDavid S. Miller 			   "rx_queue tr tm->when retrnsmt   uid  timeout "
2178cb61cb9bSEric Dumazet 			   "inode ref pointer drops");
2179db8dac20SDavid S. Miller 	else {
2180db8dac20SDavid S. Miller 		struct udp_iter_state *state = seq->private;
21815e659e4cSPavel Emelyanov 		int len;
2182db8dac20SDavid S. Miller 
21835e659e4cSPavel Emelyanov 		udp4_format_sock(v, seq, state->bucket, &len);
21845e659e4cSPavel Emelyanov 		seq_printf(seq, "%*s\n", 127 - len, "");
2185db8dac20SDavid S. Miller 	}
2186db8dac20SDavid S. Miller 	return 0;
2187db8dac20SDavid S. Miller }
2188db8dac20SDavid S. Miller 
218973cb88ecSArjan van de Ven static const struct file_operations udp_afinfo_seq_fops = {
219073cb88ecSArjan van de Ven 	.owner    = THIS_MODULE,
219173cb88ecSArjan van de Ven 	.open     = udp_seq_open,
219273cb88ecSArjan van de Ven 	.read     = seq_read,
219373cb88ecSArjan van de Ven 	.llseek   = seq_lseek,
219473cb88ecSArjan van de Ven 	.release  = seq_release_net
219573cb88ecSArjan van de Ven };
219673cb88ecSArjan van de Ven 
2197db8dac20SDavid S. Miller /* ------------------------------------------------------------------------ */
2198db8dac20SDavid S. Miller static struct udp_seq_afinfo udp4_seq_afinfo = {
2199db8dac20SDavid S. Miller 	.name		= "udp",
2200db8dac20SDavid S. Miller 	.family		= AF_INET,
2201645ca708SEric Dumazet 	.udp_table	= &udp_table,
220273cb88ecSArjan van de Ven 	.seq_fops	= &udp_afinfo_seq_fops,
2203dda61925SDenis V. Lunev 	.seq_ops	= {
2204dda61925SDenis V. Lunev 		.show		= udp4_seq_show,
2205dda61925SDenis V. Lunev 	},
2206db8dac20SDavid S. Miller };
2207db8dac20SDavid S. Miller 
22082c8c1e72SAlexey Dobriyan static int __net_init udp4_proc_init_net(struct net *net)
220915439febSPavel Emelyanov {
221015439febSPavel Emelyanov 	return udp_proc_register(net, &udp4_seq_afinfo);
221115439febSPavel Emelyanov }
221215439febSPavel Emelyanov 
22132c8c1e72SAlexey Dobriyan static void __net_exit udp4_proc_exit_net(struct net *net)
221415439febSPavel Emelyanov {
221515439febSPavel Emelyanov 	udp_proc_unregister(net, &udp4_seq_afinfo);
221615439febSPavel Emelyanov }
221715439febSPavel Emelyanov 
221815439febSPavel Emelyanov static struct pernet_operations udp4_net_ops = {
221915439febSPavel Emelyanov 	.init = udp4_proc_init_net,
222015439febSPavel Emelyanov 	.exit = udp4_proc_exit_net,
222115439febSPavel Emelyanov };
222215439febSPavel Emelyanov 
2223db8dac20SDavid S. Miller int __init udp4_proc_init(void)
2224db8dac20SDavid S. Miller {
222515439febSPavel Emelyanov 	return register_pernet_subsys(&udp4_net_ops);
2226db8dac20SDavid S. Miller }
2227db8dac20SDavid S. Miller 
2228db8dac20SDavid S. Miller void udp4_proc_exit(void)
2229db8dac20SDavid S. Miller {
223015439febSPavel Emelyanov 	unregister_pernet_subsys(&udp4_net_ops);
2231db8dac20SDavid S. Miller }
22321da177e4SLinus Torvalds #endif /* CONFIG_PROC_FS */
22331da177e4SLinus Torvalds 
2234f86dcc5aSEric Dumazet static __initdata unsigned long uhash_entries;
2235f86dcc5aSEric Dumazet static int __init set_uhash_entries(char *str)
2236645ca708SEric Dumazet {
2237413c27d8SEldad Zack 	ssize_t ret;
2238413c27d8SEldad Zack 
2239f86dcc5aSEric Dumazet 	if (!str)
2240f86dcc5aSEric Dumazet 		return 0;
2241413c27d8SEldad Zack 
2242413c27d8SEldad Zack 	ret = kstrtoul(str, 0, &uhash_entries);
2243413c27d8SEldad Zack 	if (ret)
2244413c27d8SEldad Zack 		return 0;
2245413c27d8SEldad Zack 
2246f86dcc5aSEric Dumazet 	if (uhash_entries && uhash_entries < UDP_HTABLE_SIZE_MIN)
2247f86dcc5aSEric Dumazet 		uhash_entries = UDP_HTABLE_SIZE_MIN;
2248f86dcc5aSEric Dumazet 	return 1;
2249f86dcc5aSEric Dumazet }
2250f86dcc5aSEric Dumazet __setup("uhash_entries=", set_uhash_entries);
2251645ca708SEric Dumazet 
2252f86dcc5aSEric Dumazet void __init udp_table_init(struct udp_table *table, const char *name)
2253f86dcc5aSEric Dumazet {
2254f86dcc5aSEric Dumazet 	unsigned int i;
2255f86dcc5aSEric Dumazet 
2256f86dcc5aSEric Dumazet 	table->hash = alloc_large_system_hash(name,
2257512615b6SEric Dumazet 					      2 * sizeof(struct udp_hslot),
2258f86dcc5aSEric Dumazet 					      uhash_entries,
2259f86dcc5aSEric Dumazet 					      21, /* one slot per 2 MB */
2260f86dcc5aSEric Dumazet 					      0,
2261f86dcc5aSEric Dumazet 					      &table->log,
2262f86dcc5aSEric Dumazet 					      &table->mask,
226331fe62b9STim Bird 					      UDP_HTABLE_SIZE_MIN,
2264f86dcc5aSEric Dumazet 					      64 * 1024);
226531fe62b9STim Bird 
2266512615b6SEric Dumazet 	table->hash2 = table->hash + (table->mask + 1);
2267f86dcc5aSEric Dumazet 	for (i = 0; i <= table->mask; i++) {
226888ab1932SEric Dumazet 		INIT_HLIST_NULLS_HEAD(&table->hash[i].head, i);
2269fdcc8aa9SEric Dumazet 		table->hash[i].count = 0;
2270645ca708SEric Dumazet 		spin_lock_init(&table->hash[i].lock);
2271645ca708SEric Dumazet 	}
2272512615b6SEric Dumazet 	for (i = 0; i <= table->mask; i++) {
2273512615b6SEric Dumazet 		INIT_HLIST_NULLS_HEAD(&table->hash2[i].head, i);
2274512615b6SEric Dumazet 		table->hash2[i].count = 0;
2275512615b6SEric Dumazet 		spin_lock_init(&table->hash2[i].lock);
2276512615b6SEric Dumazet 	}
2277645ca708SEric Dumazet }
2278645ca708SEric Dumazet 
227995766fffSHideo Aoki void __init udp_init(void)
228095766fffSHideo Aoki {
2281f03d78dbSEric Dumazet 	unsigned long limit;
228295766fffSHideo Aoki 
2283f86dcc5aSEric Dumazet 	udp_table_init(&udp_table, "UDP");
2284f03d78dbSEric Dumazet 	limit = nr_free_buffer_pages() / 8;
228595766fffSHideo Aoki 	limit = max(limit, 128UL);
228695766fffSHideo Aoki 	sysctl_udp_mem[0] = limit / 4 * 3;
228795766fffSHideo Aoki 	sysctl_udp_mem[1] = limit;
228895766fffSHideo Aoki 	sysctl_udp_mem[2] = sysctl_udp_mem[0] * 2;
228995766fffSHideo Aoki 
229095766fffSHideo Aoki 	sysctl_udp_rmem_min = SK_MEM_QUANTUM;
229195766fffSHideo Aoki 	sysctl_udp_wmem_min = SK_MEM_QUANTUM;
229295766fffSHideo Aoki }
229395766fffSHideo Aoki 
2294da5bab07SDaniel Borkmann struct sk_buff *skb_udp_tunnel_segment(struct sk_buff *skb,
229573136267SPravin B Shelar 				       netdev_features_t features)
229673136267SPravin B Shelar {
229773136267SPravin B Shelar 	struct sk_buff *segs = ERR_PTR(-EINVAL);
229873136267SPravin B Shelar 	int mac_len = skb->mac_len;
229973136267SPravin B Shelar 	int tnl_hlen = skb_inner_mac_header(skb) - skb_transport_header(skb);
23000d05535dSPravin B Shelar 	__be16 protocol = skb->protocol;
230173136267SPravin B Shelar 	netdev_features_t enc_features;
23020d05535dSPravin B Shelar 	int outer_hlen;
230373136267SPravin B Shelar 
230473136267SPravin B Shelar 	if (unlikely(!pskb_may_pull(skb, tnl_hlen)))
230573136267SPravin B Shelar 		goto out;
230673136267SPravin B Shelar 
230773136267SPravin B Shelar 	skb->encapsulation = 0;
230873136267SPravin B Shelar 	__skb_pull(skb, tnl_hlen);
230973136267SPravin B Shelar 	skb_reset_mac_header(skb);
231073136267SPravin B Shelar 	skb_set_network_header(skb, skb_inner_network_offset(skb));
231173136267SPravin B Shelar 	skb->mac_len = skb_inner_network_offset(skb);
231219acc327SPravin B Shelar 	skb->protocol = htons(ETH_P_TEB);
231373136267SPravin B Shelar 
231473136267SPravin B Shelar 	/* segment inner packet. */
231573136267SPravin B Shelar 	enc_features = skb->dev->hw_enc_features & netif_skb_features(skb);
231673136267SPravin B Shelar 	segs = skb_mac_gso_segment(skb, enc_features);
231773136267SPravin B Shelar 	if (!segs || IS_ERR(segs))
231873136267SPravin B Shelar 		goto out;
231973136267SPravin B Shelar 
232073136267SPravin B Shelar 	outer_hlen = skb_tnl_header_len(skb);
232173136267SPravin B Shelar 	skb = segs;
232273136267SPravin B Shelar 	do {
232373136267SPravin B Shelar 		struct udphdr *uh;
232473136267SPravin B Shelar 		int udp_offset = outer_hlen - tnl_hlen;
232573136267SPravin B Shelar 
232673136267SPravin B Shelar 		skb->mac_len = mac_len;
232773136267SPravin B Shelar 
232873136267SPravin B Shelar 		skb_push(skb, outer_hlen);
232973136267SPravin B Shelar 		skb_reset_mac_header(skb);
233073136267SPravin B Shelar 		skb_set_network_header(skb, mac_len);
233173136267SPravin B Shelar 		skb_set_transport_header(skb, udp_offset);
233273136267SPravin B Shelar 		uh = udp_hdr(skb);
233373136267SPravin B Shelar 		uh->len = htons(skb->len - udp_offset);
233473136267SPravin B Shelar 
233573136267SPravin B Shelar 		/* csum segment if tunnel sets skb with csum. */
233673136267SPravin B Shelar 		if (unlikely(uh->check)) {
233773136267SPravin B Shelar 			struct iphdr *iph = ip_hdr(skb);
233873136267SPravin B Shelar 
233973136267SPravin B Shelar 			uh->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr,
234073136267SPravin B Shelar 						       skb->len - udp_offset,
234173136267SPravin B Shelar 						       IPPROTO_UDP, 0);
234273136267SPravin B Shelar 			uh->check = csum_fold(skb_checksum(skb, udp_offset,
234373136267SPravin B Shelar 							   skb->len - udp_offset, 0));
234473136267SPravin B Shelar 			if (uh->check == 0)
234573136267SPravin B Shelar 				uh->check = CSUM_MANGLED_0;
234673136267SPravin B Shelar 
234773136267SPravin B Shelar 		}
234873136267SPravin B Shelar 		skb->ip_summed = CHECKSUM_NONE;
23490d05535dSPravin B Shelar 		skb->protocol = protocol;
235073136267SPravin B Shelar 	} while ((skb = skb->next));
235173136267SPravin B Shelar out:
235273136267SPravin B Shelar 	return segs;
235373136267SPravin B Shelar }
2354