xref: /freebsd/sys/netinet/udp_usrreq.c (revision b2bdc62a95a0241981d79c46eb79e3208eeec5f8)
1c398230bSWarner Losh /*-
26dfab5b1SGarrett Wollman  * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
33329b236SRobert Watson  *	The Regents of the University of California.
43144b7d3SRobert Watson  * Copyright (c) 2008 Robert N. M. Watson
5fa046d87SRobert Watson  * Copyright (c) 2010-2011 Juniper Networks, Inc.
6e06e816fSKevin Lo  * Copyright (c) 2014 Kevin Lo
73329b236SRobert Watson  * All rights reserved.
8df8bae1dSRodney W. Grimes  *
9fa046d87SRobert Watson  * Portions of this software were developed by Robert N. M. Watson under
10fa046d87SRobert Watson  * contract to Juniper Networks, Inc.
11fa046d87SRobert Watson  *
12df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
13df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
14df8bae1dSRodney W. Grimes  * are met:
15df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
16df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
17df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
18df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
19df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
20df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
21df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
22df8bae1dSRodney W. Grimes  *    without specific prior written permission.
23df8bae1dSRodney W. Grimes  *
24df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
25df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
28df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
35df8bae1dSRodney W. Grimes  *
366dfab5b1SGarrett Wollman  *	@(#)udp_usrreq.c	8.6 (Berkeley) 5/23/95
37df8bae1dSRodney W. Grimes  */
38df8bae1dSRodney W. Grimes 
394b421e2dSMike Silbersack #include <sys/cdefs.h>
404b421e2dSMike Silbersack __FBSDID("$FreeBSD$");
414b421e2dSMike Silbersack 
420b4ae859SGleb Smirnoff #include "opt_ipfw.h"
4379288c11SBjoern A. Zeeb #include "opt_inet.h"
44cfa1ca9dSYoshinobu Inoue #include "opt_inet6.h"
45f5514f08SRobert Watson #include "opt_ipsec.h"
469d3ddf43SAdrian Chadd #include "opt_rss.h"
47cfa1ca9dSYoshinobu Inoue 
48df8bae1dSRodney W. Grimes #include <sys/param.h>
49960ed29cSSeigo Tanimura #include <sys/domain.h>
504f590175SPaul Saab #include <sys/eventhandler.h>
51960ed29cSSeigo Tanimura #include <sys/jail.h>
52b110a8a2SGarrett Wollman #include <sys/kernel.h>
53960ed29cSSeigo Tanimura #include <sys/lock.h>
54df8bae1dSRodney W. Grimes #include <sys/malloc.h>
55df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
56acd3428bSRobert Watson #include <sys/priv.h>
57490d50b6SBrian Feldman #include <sys/proc.h>
58df8bae1dSRodney W. Grimes #include <sys/protosw.h>
5957f60867SMark Johnston #include <sys/sdt.h>
60960ed29cSSeigo Tanimura #include <sys/signalvar.h>
61df8bae1dSRodney W. Grimes #include <sys/socket.h>
62df8bae1dSRodney W. Grimes #include <sys/socketvar.h>
63960ed29cSSeigo Tanimura #include <sys/sx.h>
64b5e8ce9fSBruce Evans #include <sys/sysctl.h>
65816a3d83SPoul-Henning Kamp #include <sys/syslog.h>
66f5514f08SRobert Watson #include <sys/systm.h>
678781d8e9SBruce Evans 
6869c2d429SJeff Roberson #include <vm/uma.h>
69df8bae1dSRodney W. Grimes 
70df8bae1dSRodney W. Grimes #include <net/if.h>
7176039bc8SGleb Smirnoff #include <net/if_var.h>
72df8bae1dSRodney W. Grimes #include <net/route.h>
73*b2bdc62aSAdrian Chadd #include <net/rss_config.h>
74df8bae1dSRodney W. Grimes 
75df8bae1dSRodney W. Grimes #include <netinet/in.h>
7657f60867SMark Johnston #include <netinet/in_kdtrace.h>
77960ed29cSSeigo Tanimura #include <netinet/in_pcb.h>
78f5514f08SRobert Watson #include <netinet/in_systm.h>
79960ed29cSSeigo Tanimura #include <netinet/in_var.h>
80df8bae1dSRodney W. Grimes #include <netinet/ip.h>
81cfa1ca9dSYoshinobu Inoue #ifdef INET6
82cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h>
83cfa1ca9dSYoshinobu Inoue #endif
84960ed29cSSeigo Tanimura #include <netinet/ip_icmp.h>
85960ed29cSSeigo Tanimura #include <netinet/icmp_var.h>
86df8bae1dSRodney W. Grimes #include <netinet/ip_var.h>
87ef39adf0SAndre Oppermann #include <netinet/ip_options.h>
88cfa1ca9dSYoshinobu Inoue #ifdef INET6
89cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h>
90cfa1ca9dSYoshinobu Inoue #endif
91df8bae1dSRodney W. Grimes #include <netinet/udp.h>
92df8bae1dSRodney W. Grimes #include <netinet/udp_var.h>
93e06e816fSKevin Lo #include <netinet/udplite.h>
948ad1a83bSAdrian Chadd #include <netinet/in_rss.h>
95df8bae1dSRodney W. Grimes 
96b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
97b9234fafSSam Leffler #include <netipsec/ipsec.h>
987b495c44SVANHULLEBUS Yvan #include <netipsec/esp.h>
993329b236SRobert Watson #endif
100b9234fafSSam Leffler 
101db4f9cc7SJonathan Lemon #include <machine/in_cksum.h>
102db4f9cc7SJonathan Lemon 
103aed55708SRobert Watson #include <security/mac/mac_framework.h>
104aed55708SRobert Watson 
105df8bae1dSRodney W. Grimes /*
106e06e816fSKevin Lo  * UDP and UDP-Lite protocols implementation.
107df8bae1dSRodney W. Grimes  * Per RFC 768, August, 1980.
108e06e816fSKevin Lo  * Per RFC 3828, July, 2004.
109df8bae1dSRodney W. Grimes  */
11074eb3236SWarner Losh 
11174eb3236SWarner Losh /*
1123329b236SRobert Watson  * BSD 4.2 defaulted the udp checksum to be off.  Turning off udp checksums
1133329b236SRobert Watson  * removes the only data integrity mechanism for packets and malformed
114f5514f08SRobert Watson  * packets that would otherwise be discarded due to bad checksums, and may
115f5514f08SRobert Watson  * cause problems (especially for NFS data blocks).
11674eb3236SWarner Losh  */
11740b676beSBjoern A. Zeeb VNET_DEFINE(int, udp_cksum) = 1;
1186df8a710SGleb Smirnoff SYSCTL_INT(_net_inet_udp, UDPCTL_CHECKSUM, checksum, CTLFLAG_VNET | CTLFLAG_RW,
11940b676beSBjoern A. Zeeb     &VNET_NAME(udp_cksum), 0, "compute udp checksum");
120df8bae1dSRodney W. Grimes 
121afdb4274SRobert Watson int	udp_log_in_vain = 0;
122816a3d83SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, OID_AUTO, log_in_vain, CTLFLAG_RW,
123afdb4274SRobert Watson     &udp_log_in_vain, 0, "Log all incoming UDP packets");
124816a3d83SPoul-Henning Kamp 
12582cea7e6SBjoern A. Zeeb VNET_DEFINE(int, udp_blackhole) = 0;
1266df8a710SGleb Smirnoff SYSCTL_INT(_net_inet_udp, OID_AUTO, blackhole, CTLFLAG_VNET | CTLFLAG_RW,
127eddfbb76SRobert Watson     &VNET_NAME(udp_blackhole), 0,
1283329b236SRobert Watson     "Do not send port unreachables for refused connects");
12916f7f31fSGeoff Rehmet 
13043bbb6aaSRobert Watson u_long	udp_sendspace = 9216;		/* really max datagram size */
13143bbb6aaSRobert Watson 					/* 40 1K datagrams */
13243bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_MAXDGRAM, maxdgram, CTLFLAG_RW,
13343bbb6aaSRobert Watson     &udp_sendspace, 0, "Maximum outgoing UDP datagram size");
13443bbb6aaSRobert Watson 
13543bbb6aaSRobert Watson u_long	udp_recvspace = 40 * (1024 +
13643bbb6aaSRobert Watson #ifdef INET6
13743bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in6)
13843bbb6aaSRobert Watson #else
13943bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in)
14043bbb6aaSRobert Watson #endif
14143bbb6aaSRobert Watson 				      );
14243bbb6aaSRobert Watson 
14343bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_RECVSPACE, recvspace, CTLFLAG_RW,
14443bbb6aaSRobert Watson     &udp_recvspace, 0, "Maximum space for incoming UDP datagrams");
14543bbb6aaSRobert Watson 
146eddfbb76SRobert Watson VNET_DEFINE(struct inpcbhead, udb);		/* from udp_var.h */
147eddfbb76SRobert Watson VNET_DEFINE(struct inpcbinfo, udbinfo);
148e06e816fSKevin Lo VNET_DEFINE(struct inpcbhead, ulitecb);
149e06e816fSKevin Lo VNET_DEFINE(struct inpcbinfo, ulitecbinfo);
1503e288e62SDimitry Andric static VNET_DEFINE(uma_zone_t, udpcb_zone);
1511e77c105SRobert Watson #define	V_udpcb_zone			VNET(udpcb_zone)
15215bd2b43SDavid Greenman 
15315bd2b43SDavid Greenman #ifndef UDBHASHSIZE
154e2ed8f35SAlexander Motin #define	UDBHASHSIZE	128
15515bd2b43SDavid Greenman #endif
15615bd2b43SDavid Greenman 
1575b7cb97cSAndrey V. Elsukov VNET_PCPUSTAT_DEFINE(struct udpstat, udpstat);		/* from udp_var.h */
1585b7cb97cSAndrey V. Elsukov VNET_PCPUSTAT_SYSINIT(udpstat);
1595b7cb97cSAndrey V. Elsukov SYSCTL_VNET_PCPUSTAT(_net_inet_udp, UDPCTL_STATS, stats, struct udpstat,
1605b7cb97cSAndrey V. Elsukov     udpstat, "UDP statistics (struct udpstat, netinet/udp_var.h)");
161f2ea20e6SGarrett Wollman 
1625b7cb97cSAndrey V. Elsukov #ifdef VIMAGE
1635b7cb97cSAndrey V. Elsukov VNET_PCPUSTAT_SYSUNINIT(udpstat);
1645b7cb97cSAndrey V. Elsukov #endif /* VIMAGE */
16579288c11SBjoern A. Zeeb #ifdef INET
166bc725eafSRobert Watson static void	udp_detach(struct socket *so);
1674d77a549SAlfred Perlstein static int	udp_output(struct inpcb *, struct mbuf *, struct sockaddr *,
1684d77a549SAlfred Perlstein 		    struct mbuf *, struct thread *);
16979288c11SBjoern A. Zeeb #endif
17079288c11SBjoern A. Zeeb 
1717b495c44SVANHULLEBUS Yvan #ifdef IPSEC
1727b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
1737b495c44SVANHULLEBUS Yvan #define	UF_ESPINUDP_ALL	(UF_ESPINUDP_NON_IKE|UF_ESPINUDP)
1747b495c44SVANHULLEBUS Yvan #ifdef INET
1757b495c44SVANHULLEBUS Yvan static struct mbuf *udp4_espdecap(struct inpcb *, struct mbuf *, int);
1767b495c44SVANHULLEBUS Yvan #endif
1777b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
1787b495c44SVANHULLEBUS Yvan #endif /* IPSEC */
179df8bae1dSRodney W. Grimes 
1804f590175SPaul Saab static void
1814f590175SPaul Saab udp_zone_change(void *tag)
1824f590175SPaul Saab {
1834f590175SPaul Saab 
184603724d3SBjoern A. Zeeb 	uma_zone_set_max(V_udbinfo.ipi_zone, maxsockets);
1856a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
1864f590175SPaul Saab }
1874f590175SPaul Saab 
188d915b280SStephan Uphoff static int
189d915b280SStephan Uphoff udp_inpcb_init(void *mem, int size, int flags)
190d915b280SStephan Uphoff {
191af1ee11dSRobert Watson 	struct inpcb *inp;
19208651e1fSJohn Baldwin 
193af1ee11dSRobert Watson 	inp = mem;
194d915b280SStephan Uphoff 	INP_LOCK_INIT(inp, "inp", "udpinp");
195d915b280SStephan Uphoff 	return (0);
196d915b280SStephan Uphoff }
197d915b280SStephan Uphoff 
198e06e816fSKevin Lo static int
199e06e816fSKevin Lo udplite_inpcb_init(void *mem, int size, int flags)
200e06e816fSKevin Lo {
201e06e816fSKevin Lo 	struct inpcb *inp;
202e06e816fSKevin Lo 
203e06e816fSKevin Lo 	inp = mem;
204e06e816fSKevin Lo 	INP_LOCK_INIT(inp, "inp", "udpliteinp");
205e06e816fSKevin Lo 	return (0);
206e06e816fSKevin Lo }
207e06e816fSKevin Lo 
208df8bae1dSRodney W. Grimes void
209af1ee11dSRobert Watson udp_init(void)
210df8bae1dSRodney W. Grimes {
211af1ee11dSRobert Watson 
2128ad1a83bSAdrian Chadd 	/*
2138ad1a83bSAdrian Chadd 	 * For now default to 2-tuple UDP hashing - until the fragment
2148ad1a83bSAdrian Chadd 	 * reassembly code can also update the flowid.
2158ad1a83bSAdrian Chadd 	 *
2168ad1a83bSAdrian Chadd 	 * Once we can calculate the flowid that way and re-establish
2178ad1a83bSAdrian Chadd 	 * a 4-tuple, flip this to 4-tuple.
2188ad1a83bSAdrian Chadd 	 */
2199bcd427bSRobert Watson 	in_pcbinfo_init(&V_udbinfo, "udp", &V_udb, UDBHASHSIZE, UDBHASHSIZE,
220a8da5dd6SCraig Rodrigues 	    "udp_inpcb", udp_inpcb_init, NULL, 0,
22152cd27cbSRobert Watson 	    IPI_HASHFIELDS_2TUPLE);
2226a9148feSBjoern A. Zeeb 	V_udpcb_zone = uma_zcreate("udpcb", sizeof(struct udpcb),
223a8da5dd6SCraig Rodrigues 	    NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, 0);
2246a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
2256acd596eSPawel Jakub Dawidek 	uma_zone_set_warning(V_udpcb_zone, "kern.ipc.maxsockets limit reached");
2264f590175SPaul Saab 	EVENTHANDLER_REGISTER(maxsockets_change, udp_zone_change, NULL,
2274f590175SPaul Saab 	    EVENTHANDLER_PRI_ANY);
228df8bae1dSRodney W. Grimes }
229df8bae1dSRodney W. Grimes 
230e06e816fSKevin Lo void
231e06e816fSKevin Lo udplite_init(void)
232e06e816fSKevin Lo {
233e06e816fSKevin Lo 
234e06e816fSKevin Lo 	in_pcbinfo_init(&V_ulitecbinfo, "udplite", &V_ulitecb, UDBHASHSIZE,
235e06e816fSKevin Lo 	    UDBHASHSIZE, "udplite_inpcb", udplite_inpcb_init, NULL,
236a8da5dd6SCraig Rodrigues 	    0, IPI_HASHFIELDS_2TUPLE);
237e06e816fSKevin Lo }
238e06e816fSKevin Lo 
239315e3e38SRobert Watson /*
240315e3e38SRobert Watson  * Kernel module interface for updating udpstat.  The argument is an index
241315e3e38SRobert Watson  * into udpstat treated as an array of u_long.  While this encodes the
242315e3e38SRobert Watson  * general layout of udpstat into the caller, it doesn't encode its location,
243315e3e38SRobert Watson  * so that future changes to add, for example, per-CPU stats support won't
244315e3e38SRobert Watson  * cause binary compatibility problems for kernel modules.
245315e3e38SRobert Watson  */
246315e3e38SRobert Watson void
247315e3e38SRobert Watson kmod_udpstat_inc(int statnum)
248315e3e38SRobert Watson {
249315e3e38SRobert Watson 
2505b7cb97cSAndrey V. Elsukov 	counter_u64_add(VNET(udpstat)[statnum], 1);
251315e3e38SRobert Watson }
252315e3e38SRobert Watson 
2536a9148feSBjoern A. Zeeb int
2546a9148feSBjoern A. Zeeb udp_newudpcb(struct inpcb *inp)
2556a9148feSBjoern A. Zeeb {
2566a9148feSBjoern A. Zeeb 	struct udpcb *up;
2576a9148feSBjoern A. Zeeb 
2586a9148feSBjoern A. Zeeb 	up = uma_zalloc(V_udpcb_zone, M_NOWAIT | M_ZERO);
2596a9148feSBjoern A. Zeeb 	if (up == NULL)
2606a9148feSBjoern A. Zeeb 		return (ENOBUFS);
2616a9148feSBjoern A. Zeeb 	inp->inp_ppcb = up;
2626a9148feSBjoern A. Zeeb 	return (0);
2636a9148feSBjoern A. Zeeb }
2646a9148feSBjoern A. Zeeb 
2656a9148feSBjoern A. Zeeb void
2666a9148feSBjoern A. Zeeb udp_discardcb(struct udpcb *up)
2676a9148feSBjoern A. Zeeb {
2686a9148feSBjoern A. Zeeb 
2696a9148feSBjoern A. Zeeb 	uma_zfree(V_udpcb_zone, up);
2706a9148feSBjoern A. Zeeb }
2716a9148feSBjoern A. Zeeb 
272bc29160dSMarko Zec #ifdef VIMAGE
273bc29160dSMarko Zec void
274bc29160dSMarko Zec udp_destroy(void)
275bc29160dSMarko Zec {
276bc29160dSMarko Zec 
2779bcd427bSRobert Watson 	in_pcbinfo_destroy(&V_udbinfo);
278391dab1cSBjoern A. Zeeb 	uma_zdestroy(V_udpcb_zone);
279bc29160dSMarko Zec }
280e06e816fSKevin Lo 
281e06e816fSKevin Lo void
282e06e816fSKevin Lo udplite_destroy(void)
283e06e816fSKevin Lo {
284e06e816fSKevin Lo 
285e06e816fSKevin Lo 	in_pcbinfo_destroy(&V_ulitecbinfo);
286e06e816fSKevin Lo }
287bc29160dSMarko Zec #endif
288bc29160dSMarko Zec 
28979288c11SBjoern A. Zeeb #ifdef INET
29043bbb6aaSRobert Watson /*
29143bbb6aaSRobert Watson  * Subroutine of udp_input(), which appends the provided mbuf chain to the
29243bbb6aaSRobert Watson  * passed pcb/socket.  The caller must provide a sockaddr_in via udp_in that
29343bbb6aaSRobert Watson  * contains the source address.  If the socket ends up being an IPv6 socket,
29443bbb6aaSRobert Watson  * udp_append() will convert to a sockaddr_in6 before passing the address
29543bbb6aaSRobert Watson  * into the socket code.
29643bbb6aaSRobert Watson  */
29743bbb6aaSRobert Watson static void
29843bbb6aaSRobert Watson udp_append(struct inpcb *inp, struct ip *ip, struct mbuf *n, int off,
29943bbb6aaSRobert Watson     struct sockaddr_in *udp_in)
30043bbb6aaSRobert Watson {
30143bbb6aaSRobert Watson 	struct sockaddr *append_sa;
30243bbb6aaSRobert Watson 	struct socket *so;
30343bbb6aaSRobert Watson 	struct mbuf *opts = 0;
30443bbb6aaSRobert Watson #ifdef INET6
30543bbb6aaSRobert Watson 	struct sockaddr_in6 udp_in6;
30643bbb6aaSRobert Watson #endif
3077b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
30843bbb6aaSRobert Watson 
309fa046d87SRobert Watson 	INP_LOCK_ASSERT(inp);
31043bbb6aaSRobert Watson 
31179bb84fbSEdward Tomasz Napierala 	/*
31279bb84fbSEdward Tomasz Napierala 	 * Engage the tunneling protocol.
31379bb84fbSEdward Tomasz Napierala 	 */
31479bb84fbSEdward Tomasz Napierala 	up = intoudpcb(inp);
31579bb84fbSEdward Tomasz Napierala 	if (up->u_tun_func != NULL) {
31681d3ec17SBryan Venteicher 		(*up->u_tun_func)(n, off, inp, (struct sockaddr *)udp_in,
31781d3ec17SBryan Venteicher 		    up->u_tun_ctx);
31879bb84fbSEdward Tomasz Napierala 		return;
31979bb84fbSEdward Tomasz Napierala 	}
32079bb84fbSEdward Tomasz Napierala 
32179bb84fbSEdward Tomasz Napierala 	off += sizeof(struct udphdr);
32279bb84fbSEdward Tomasz Napierala 
32343bbb6aaSRobert Watson #ifdef IPSEC
32443bbb6aaSRobert Watson 	/* Check AH/ESP integrity. */
32543bbb6aaSRobert Watson 	if (ipsec4_in_reject(n, inp)) {
32643bbb6aaSRobert Watson 		m_freem(n);
32743bbb6aaSRobert Watson 		return;
32843bbb6aaSRobert Watson 	}
3297b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
3307b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
3317b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
3327b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_ALL) {	/* IPSec UDP encaps. */
3337b495c44SVANHULLEBUS Yvan 		n = udp4_espdecap(inp, n, off);
3347b495c44SVANHULLEBUS Yvan 		if (n == NULL)				/* Consumed. */
3357b495c44SVANHULLEBUS Yvan 			return;
3367b495c44SVANHULLEBUS Yvan 	}
3377b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
33843bbb6aaSRobert Watson #endif /* IPSEC */
33943bbb6aaSRobert Watson #ifdef MAC
34030d239bcSRobert Watson 	if (mac_inpcb_check_deliver(inp, n) != 0) {
34143bbb6aaSRobert Watson 		m_freem(n);
34243bbb6aaSRobert Watson 		return;
34343bbb6aaSRobert Watson 	}
34479288c11SBjoern A. Zeeb #endif /* MAC */
34543bbb6aaSRobert Watson 	if (inp->inp_flags & INP_CONTROLOPTS ||
34643bbb6aaSRobert Watson 	    inp->inp_socket->so_options & (SO_TIMESTAMP | SO_BINTIME)) {
34743bbb6aaSRobert Watson #ifdef INET6
3489a38ba81SBjoern A. Zeeb 		if (inp->inp_vflag & INP_IPV6)
34948d48eb9SBjoern A. Zeeb 			(void)ip6_savecontrol_v4(inp, n, &opts, NULL);
3509a38ba81SBjoern A. Zeeb 		else
35179288c11SBjoern A. Zeeb #endif /* INET6 */
35243bbb6aaSRobert Watson 			ip_savecontrol(inp, &opts, ip, n);
35343bbb6aaSRobert Watson 	}
35443bbb6aaSRobert Watson #ifdef INET6
35543bbb6aaSRobert Watson 	if (inp->inp_vflag & INP_IPV6) {
35643bbb6aaSRobert Watson 		bzero(&udp_in6, sizeof(udp_in6));
35743bbb6aaSRobert Watson 		udp_in6.sin6_len = sizeof(udp_in6);
35843bbb6aaSRobert Watson 		udp_in6.sin6_family = AF_INET6;
35943bbb6aaSRobert Watson 		in6_sin_2_v4mapsin6(udp_in, &udp_in6);
36043bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)&udp_in6;
36143bbb6aaSRobert Watson 	} else
36279288c11SBjoern A. Zeeb #endif /* INET6 */
36343bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)udp_in;
36443bbb6aaSRobert Watson 	m_adj(n, off);
36543bbb6aaSRobert Watson 
36643bbb6aaSRobert Watson 	so = inp->inp_socket;
36743bbb6aaSRobert Watson 	SOCKBUF_LOCK(&so->so_rcv);
36843bbb6aaSRobert Watson 	if (sbappendaddr_locked(&so->so_rcv, append_sa, n, opts) == 0) {
36943bbb6aaSRobert Watson 		SOCKBUF_UNLOCK(&so->so_rcv);
37043bbb6aaSRobert Watson 		m_freem(n);
37143bbb6aaSRobert Watson 		if (opts)
37243bbb6aaSRobert Watson 			m_freem(opts);
373026decb8SRobert Watson 		UDPSTAT_INC(udps_fullsock);
37443bbb6aaSRobert Watson 	} else
37543bbb6aaSRobert Watson 		sorwakeup_locked(so);
37643bbb6aaSRobert Watson }
37743bbb6aaSRobert Watson 
3788f5a8818SKevin Lo int
3798f5a8818SKevin Lo udp_input(struct mbuf **mp, int *offp, int proto)
380df8bae1dSRodney W. Grimes {
3813329b236SRobert Watson 	struct ip *ip;
3823329b236SRobert Watson 	struct udphdr *uh;
38371498f30SBruce M Simpson 	struct ifnet *ifp;
3843329b236SRobert Watson 	struct inpcb *inp;
3858f134647SGleb Smirnoff 	uint16_t len, ip_len;
386e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
387df8bae1dSRodney W. Grimes 	struct ip save_ip;
388d4b509bdSRobert Watson 	struct sockaddr_in udp_in;
3898f5a8818SKevin Lo 	struct mbuf *m;
3900b4ae859SGleb Smirnoff 	struct m_tag *fwd_tag;
3918f5a8818SKevin Lo 	int cscov_partial, iphlen;
392df8bae1dSRodney W. Grimes 
3938f5a8818SKevin Lo 	m = *mp;
3948f5a8818SKevin Lo 	iphlen = *offp;
39571498f30SBruce M Simpson 	ifp = m->m_pkthdr.rcvif;
3968f5a8818SKevin Lo 	*mp = NULL;
397026decb8SRobert Watson 	UDPSTAT_INC(udps_ipackets);
398df8bae1dSRodney W. Grimes 
399df8bae1dSRodney W. Grimes 	/*
4003329b236SRobert Watson 	 * Strip IP options, if any; should skip this, make available to
4013329b236SRobert Watson 	 * user, and use on returned packets, but we don't yet have a way to
4023329b236SRobert Watson 	 * check the checksum with options still present.
403df8bae1dSRodney W. Grimes 	 */
404df8bae1dSRodney W. Grimes 	if (iphlen > sizeof (struct ip)) {
405105bd211SGleb Smirnoff 		ip_stripoptions(m);
406df8bae1dSRodney W. Grimes 		iphlen = sizeof(struct ip);
407df8bae1dSRodney W. Grimes 	}
408df8bae1dSRodney W. Grimes 
409df8bae1dSRodney W. Grimes 	/*
410df8bae1dSRodney W. Grimes 	 * Get IP and UDP header together in first mbuf.
411df8bae1dSRodney W. Grimes 	 */
412df8bae1dSRodney W. Grimes 	ip = mtod(m, struct ip *);
413df8bae1dSRodney W. Grimes 	if (m->m_len < iphlen + sizeof(struct udphdr)) {
414d1b18731SKevin Lo 		if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == NULL) {
415026decb8SRobert Watson 			UDPSTAT_INC(udps_hdrops);
4168f5a8818SKevin Lo 			return (IPPROTO_DONE);
417df8bae1dSRodney W. Grimes 		}
418df8bae1dSRodney W. Grimes 		ip = mtod(m, struct ip *);
419df8bae1dSRodney W. Grimes 	}
420df8bae1dSRodney W. Grimes 	uh = (struct udphdr *)((caddr_t)ip + iphlen);
4218f5a8818SKevin Lo 	cscov_partial = (proto == IPPROTO_UDPLITE) ? 1 : 0;
422df8bae1dSRodney W. Grimes 
4233329b236SRobert Watson 	/*
4243329b236SRobert Watson 	 * Destination port of 0 is illegal, based on RFC768.
4253329b236SRobert Watson 	 */
426686cdd19SJun-ichiro itojun Hagino 	if (uh->uh_dport == 0)
427f76fcf6dSJeffrey Hsu 		goto badunlocked;
428686cdd19SJun-ichiro itojun Hagino 
429df8bae1dSRodney W. Grimes 	/*
4303329b236SRobert Watson 	 * Construct sockaddr format source address.  Stuff source address
4313329b236SRobert Watson 	 * and datagram in user buffer.
432b9234fafSSam Leffler 	 */
433d4b509bdSRobert Watson 	bzero(&udp_in, sizeof(udp_in));
434d4b509bdSRobert Watson 	udp_in.sin_len = sizeof(udp_in);
435d4b509bdSRobert Watson 	udp_in.sin_family = AF_INET;
436b9234fafSSam Leffler 	udp_in.sin_port = uh->uh_sport;
437b9234fafSSam Leffler 	udp_in.sin_addr = ip->ip_src;
438b9234fafSSam Leffler 
439b9234fafSSam Leffler 	/*
440af1ee11dSRobert Watson 	 * Make mbuf data length reflect UDP length.  If not enough data to
441af1ee11dSRobert Watson 	 * reflect UDP length, drop.
442df8bae1dSRodney W. Grimes 	 */
443df8bae1dSRodney W. Grimes 	len = ntohs((u_short)uh->uh_ulen);
4448ad458a4SGleb Smirnoff 	ip_len = ntohs(ip->ip_len) - iphlen;
4450f4a0366SMichael Tuexen 	if (proto == IPPROTO_UDPLITE && (len == 0 || len == ip_len)) {
446e06e816fSKevin Lo 		/* Zero means checksum over the complete packet. */
4470f4a0366SMichael Tuexen 		if (len == 0)
448e06e816fSKevin Lo 			len = ip_len;
449e06e816fSKevin Lo 		cscov_partial = 0;
450e06e816fSKevin Lo 	}
4518f134647SGleb Smirnoff 	if (ip_len != len) {
4528f134647SGleb Smirnoff 		if (len > ip_len || len < sizeof(struct udphdr)) {
453026decb8SRobert Watson 			UDPSTAT_INC(udps_badlen);
454f76fcf6dSJeffrey Hsu 			goto badunlocked;
455df8bae1dSRodney W. Grimes 		}
4568f5a8818SKevin Lo 		if (proto == IPPROTO_UDP)
4578f134647SGleb Smirnoff 			m_adj(m, len - ip_len);
458df8bae1dSRodney W. Grimes 	}
4593329b236SRobert Watson 
460df8bae1dSRodney W. Grimes 	/*
4613329b236SRobert Watson 	 * Save a copy of the IP header in case we want restore it for
4623329b236SRobert Watson 	 * sending an ICMP error message in response.
463df8bae1dSRodney W. Grimes 	 */
464603724d3SBjoern A. Zeeb 	if (!V_udp_blackhole)
465df8bae1dSRodney W. Grimes 		save_ip = *ip;
466cce418d3SMatt Jacob 	else
467cce418d3SMatt Jacob 		memset(&save_ip, 0, sizeof(save_ip));
468df8bae1dSRodney W. Grimes 
469df8bae1dSRodney W. Grimes 	/*
470df8bae1dSRodney W. Grimes 	 * Checksum extended UDP header and data.
471df8bae1dSRodney W. Grimes 	 */
4726dfab5b1SGarrett Wollman 	if (uh->uh_sum) {
47339629c92SDavid Malone 		u_short uh_sum;
47439629c92SDavid Malone 
475e06e816fSKevin Lo 		if ((m->m_pkthdr.csum_flags & CSUM_DATA_VALID) &&
476e06e816fSKevin Lo 		    !cscov_partial) {
477db4f9cc7SJonathan Lemon 			if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR)
47839629c92SDavid Malone 				uh_sum = m->m_pkthdr.csum_data;
479db4f9cc7SJonathan Lemon 			else
48039629c92SDavid Malone 				uh_sum = in_pseudo(ip->ip_src.s_addr,
481506f4949SRuslan Ermilov 				    ip->ip_dst.s_addr, htonl((u_short)len +
4828f5a8818SKevin Lo 				    m->m_pkthdr.csum_data + proto));
48339629c92SDavid Malone 			uh_sum ^= 0xffff;
484db4f9cc7SJonathan Lemon 		} else {
485cb342100SHajimu UMEMOTO 			char b[9];
486af1ee11dSRobert Watson 
487cb342100SHajimu UMEMOTO 			bcopy(((struct ipovly *)ip)->ih_x1, b, 9);
4886effc713SDoug Rabson 			bzero(((struct ipovly *)ip)->ih_x1, 9);
4898f5a8818SKevin Lo 			((struct ipovly *)ip)->ih_len = (proto == IPPROTO_UDP) ?
490e06e816fSKevin Lo 			    uh->uh_ulen : htons(ip_len);
49139629c92SDavid Malone 			uh_sum = in_cksum(m, len + sizeof (struct ip));
492cb342100SHajimu UMEMOTO 			bcopy(b, ((struct ipovly *)ip)->ih_x1, 9);
493db4f9cc7SJonathan Lemon 		}
49439629c92SDavid Malone 		if (uh_sum) {
495026decb8SRobert Watson 			UDPSTAT_INC(udps_badsum);
496df8bae1dSRodney W. Grimes 			m_freem(m);
4978f5a8818SKevin Lo 			return (IPPROTO_DONE);
498df8bae1dSRodney W. Grimes 		}
499c6d81a34SMichael Tuexen 	} else {
500c6d81a34SMichael Tuexen 		if (proto == IPPROTO_UDP) {
501026decb8SRobert Watson 			UDPSTAT_INC(udps_nosum);
502c6d81a34SMichael Tuexen 		} else {
503c6d81a34SMichael Tuexen 			/* UDPLite requires a checksum */
504c6d81a34SMichael Tuexen 			/* XXX: What is the right UDPLite MIB counter here? */
505c6d81a34SMichael Tuexen 			m_freem(m);
506c6d81a34SMichael Tuexen 			return (IPPROTO_DONE);
507c6d81a34SMichael Tuexen 		}
508c6d81a34SMichael Tuexen 	}
509df8bae1dSRodney W. Grimes 
5108f5a8818SKevin Lo 	pcbinfo = get_inpcbinfo(proto);
511df8bae1dSRodney W. Grimes 	if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) ||
51271498f30SBruce M Simpson 	    in_broadcast(ip->ip_dst, ifp)) {
51382c23ebaSBill Fenner 		struct inpcb *last;
514e06e816fSKevin Lo 		struct inpcbhead *pcblist;
51571498f30SBruce M Simpson 		struct ip_moptions *imo;
5163329b236SRobert Watson 
517e06e816fSKevin Lo 		INP_INFO_RLOCK(pcbinfo);
5188f5a8818SKevin Lo 		pcblist = get_pcblist(proto);
519df8bae1dSRodney W. Grimes 		last = NULL;
520e06e816fSKevin Lo 		LIST_FOREACH(inp, pcblist, inp_list) {
5219c1df695SRobert Watson 			if (inp->inp_lport != uh->uh_dport)
522f76fcf6dSJeffrey Hsu 				continue;
523cfa1ca9dSYoshinobu Inoue #ifdef INET6
524369dc8ceSEivind Eklund 			if ((inp->inp_vflag & INP_IPV4) == 0)
5259c1df695SRobert Watson 				continue;
526cfa1ca9dSYoshinobu Inoue #endif
52771498f30SBruce M Simpson 			if (inp->inp_laddr.s_addr != INADDR_ANY &&
52871498f30SBruce M Simpson 			    inp->inp_laddr.s_addr != ip->ip_dst.s_addr)
5299c1df695SRobert Watson 				continue;
53071498f30SBruce M Simpson 			if (inp->inp_faddr.s_addr != INADDR_ANY &&
53171498f30SBruce M Simpson 			    inp->inp_faddr.s_addr != ip->ip_src.s_addr)
53271498f30SBruce M Simpson 				continue;
53371498f30SBruce M Simpson 			if (inp->inp_fport != 0 &&
534df8bae1dSRodney W. Grimes 			    inp->inp_fport != uh->uh_sport)
5359c1df695SRobert Watson 				continue;
53671498f30SBruce M Simpson 
537119d85f6SRobert Watson 			INP_RLOCK(inp);
538df8bae1dSRodney W. Grimes 
53983453a06SBruce M Simpson 			/*
540fa046d87SRobert Watson 			 * XXXRW: Because we weren't holding either the inpcb
541fa046d87SRobert Watson 			 * or the hash lock when we checked for a match
542fa046d87SRobert Watson 			 * before, we should probably recheck now that the
543fa046d87SRobert Watson 			 * inpcb lock is held.
544fa046d87SRobert Watson 			 */
545fa046d87SRobert Watson 
546fa046d87SRobert Watson 			/*
54771498f30SBruce M Simpson 			 * Handle socket delivery policy for any-source
54871498f30SBruce M Simpson 			 * and source-specific multicast. [RFC3678]
54983453a06SBruce M Simpson 			 */
55071498f30SBruce M Simpson 			imo = inp->inp_moptions;
551a38b1c8cSRandall Stewart 			if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr))) {
552d10910e6SBruce M Simpson 				struct sockaddr_in	 group;
553d10910e6SBruce M Simpson 				int			 blocked;
554a38b1c8cSRandall Stewart 				if (imo == NULL) {
555a38b1c8cSRandall Stewart 					INP_RUNLOCK(inp);
556a38b1c8cSRandall Stewart 					continue;
557a38b1c8cSRandall Stewart 				}
558d10910e6SBruce M Simpson 				bzero(&group, sizeof(struct sockaddr_in));
559d10910e6SBruce M Simpson 				group.sin_len = sizeof(struct sockaddr_in);
560d10910e6SBruce M Simpson 				group.sin_family = AF_INET;
561d10910e6SBruce M Simpson 				group.sin_addr = ip->ip_dst;
56271498f30SBruce M Simpson 
563d10910e6SBruce M Simpson 				blocked = imo_multi_filter(imo, ifp,
564d10910e6SBruce M Simpson 					(struct sockaddr *)&group,
56571498f30SBruce M Simpson 					(struct sockaddr *)&udp_in);
566d10910e6SBruce M Simpson 				if (blocked != MCAST_PASS) {
567d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTGMEMBER)
56886425c62SRobert Watson 						IPSTAT_INC(ips_notmember);
569d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTSMEMBER ||
570d10910e6SBruce M Simpson 					    blocked == MCAST_MUTED)
571026decb8SRobert Watson 						UDPSTAT_INC(udps_filtermcast);
572119d85f6SRobert Watson 					INP_RUNLOCK(inp);
5739c1df695SRobert Watson 					continue;
5749c1df695SRobert Watson 				}
57583453a06SBruce M Simpson 			}
576df8bae1dSRodney W. Grimes 			if (last != NULL) {
577df8bae1dSRodney W. Grimes 				struct mbuf *n;
578df8bae1dSRodney W. Grimes 
579c19f98ebSBryan Venteicher 				if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
580a0a9e1b5SBryan Venteicher 					UDP_PROBE(receive, NULL, last, ip,
581a0a9e1b5SBryan Venteicher 					    last, uh);
582c19f98ebSBryan Venteicher 					udp_append(last, ip, n, iphlen,
583c19f98ebSBryan Venteicher 					    &udp_in);
584c19f98ebSBryan Venteicher 				}
5856a9148feSBjoern A. Zeeb 				INP_RUNLOCK(last);
586df8bae1dSRodney W. Grimes 			}
58782c23ebaSBill Fenner 			last = inp;
588df8bae1dSRodney W. Grimes 			/*
589df8bae1dSRodney W. Grimes 			 * Don't look for additional matches if this one does
590df8bae1dSRodney W. Grimes 			 * not have either the SO_REUSEPORT or SO_REUSEADDR
5913329b236SRobert Watson 			 * socket options set.  This heuristic avoids
5923329b236SRobert Watson 			 * searching through all pcbs in the common case of a
5933329b236SRobert Watson 			 * non-shared port.  It assumes that an application
5943329b236SRobert Watson 			 * will never clear these options after setting them.
595df8bae1dSRodney W. Grimes 			 */
5963329b236SRobert Watson 			if ((last->inp_socket->so_options &
5973329b236SRobert Watson 			    (SO_REUSEPORT|SO_REUSEADDR)) == 0)
598df8bae1dSRodney W. Grimes 				break;
599df8bae1dSRodney W. Grimes 		}
600df8bae1dSRodney W. Grimes 
601df8bae1dSRodney W. Grimes 		if (last == NULL) {
602df8bae1dSRodney W. Grimes 			/*
6033329b236SRobert Watson 			 * No matching pcb found; discard datagram.  (No need
6043329b236SRobert Watson 			 * to send an ICMP Port Unreachable for a broadcast
6053329b236SRobert Watson 			 * or multicast datgram.)
606df8bae1dSRodney W. Grimes 			 */
607026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
608fa046d87SRobert Watson 			if (inp)
609fa046d87SRobert Watson 				INP_RUNLOCK(inp);
610e06e816fSKevin Lo 			INP_INFO_RUNLOCK(pcbinfo);
611fa046d87SRobert Watson 			goto badunlocked;
612df8bae1dSRodney W. Grimes 		}
613a0a9e1b5SBryan Venteicher 		UDP_PROBE(receive, NULL, last, ip, last, uh);
61479bb84fbSEdward Tomasz Napierala 		udp_append(last, ip, m, iphlen, &udp_in);
615c7c7ea4bSRandall Stewart 		INP_RUNLOCK(last);
616e06e816fSKevin Lo 		INP_INFO_RUNLOCK(pcbinfo);
6178f5a8818SKevin Lo 		return (IPPROTO_DONE);
618df8bae1dSRodney W. Grimes 	}
6193329b236SRobert Watson 
620df8bae1dSRodney W. Grimes 	/*
6216d6a026bSDavid Greenman 	 * Locate pcb for datagram.
622df8bae1dSRodney W. Grimes 	 */
623c1de64a4SAndrey V. Elsukov 
6248a006adbSBjoern A. Zeeb 	/*
6258a006adbSBjoern A. Zeeb 	 * Grab info from PACKET_TAG_IPFORWARD tag prepended to the chain.
6268a006adbSBjoern A. Zeeb 	 */
627ffdbf9daSAndrey V. Elsukov 	if ((m->m_flags & M_IP_NEXTHOP) &&
628c1de64a4SAndrey V. Elsukov 	    (fwd_tag = m_tag_find(m, PACKET_TAG_IPFORWARD, NULL)) != NULL) {
6298a006adbSBjoern A. Zeeb 		struct sockaddr_in *next_hop;
6308a006adbSBjoern A. Zeeb 
6318a006adbSBjoern A. Zeeb 		next_hop = (struct sockaddr_in *)(fwd_tag + 1);
6328a006adbSBjoern A. Zeeb 
6338a006adbSBjoern A. Zeeb 		/*
6348a006adbSBjoern A. Zeeb 		 * Transparently forwarded. Pretend to be the destination.
6358a006adbSBjoern A. Zeeb 		 * Already got one like this?
6368a006adbSBjoern A. Zeeb 		 */
637e06e816fSKevin Lo 		inp = in_pcblookup_mbuf(pcbinfo, ip->ip_src, uh->uh_sport,
6388a006adbSBjoern A. Zeeb 		    ip->ip_dst, uh->uh_dport, INPLOOKUP_RLOCKPCB, ifp, m);
6398a006adbSBjoern A. Zeeb 		if (!inp) {
6408a006adbSBjoern A. Zeeb 			/*
6418a006adbSBjoern A. Zeeb 			 * It's new.  Try to find the ambushing socket.
6428a006adbSBjoern A. Zeeb 			 * Because we've rewritten the destination address,
6438a006adbSBjoern A. Zeeb 			 * any hardware-generated hash is ignored.
6448a006adbSBjoern A. Zeeb 			 */
645e06e816fSKevin Lo 			inp = in_pcblookup(pcbinfo, ip->ip_src,
6468a006adbSBjoern A. Zeeb 			    uh->uh_sport, next_hop->sin_addr,
6478a006adbSBjoern A. Zeeb 			    next_hop->sin_port ? htons(next_hop->sin_port) :
6488a006adbSBjoern A. Zeeb 			    uh->uh_dport, INPLOOKUP_WILDCARD |
6498a006adbSBjoern A. Zeeb 			    INPLOOKUP_RLOCKPCB, ifp);
6508a006adbSBjoern A. Zeeb 		}
6518a006adbSBjoern A. Zeeb 		/* Remove the tag from the packet. We don't need it anymore. */
6528a006adbSBjoern A. Zeeb 		m_tag_delete(m, fwd_tag);
653ffdbf9daSAndrey V. Elsukov 		m->m_flags &= ~M_IP_NEXTHOP;
6548a006adbSBjoern A. Zeeb 	} else
655e06e816fSKevin Lo 		inp = in_pcblookup_mbuf(pcbinfo, ip->ip_src, uh->uh_sport,
6568a006adbSBjoern A. Zeeb 		    ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD |
6578a006adbSBjoern A. Zeeb 		    INPLOOKUP_RLOCKPCB, ifp, m);
65815bd2b43SDavid Greenman 	if (inp == NULL) {
659afdb4274SRobert Watson 		if (udp_log_in_vain) {
660df5c0b8aSBill Fenner 			char buf[4*sizeof "123"];
66175cfc95fSAndrey A. Chernov 
66275cfc95fSAndrey A. Chernov 			strcpy(buf, inet_ntoa(ip->ip_dst));
663592071e8SBruce Evans 			log(LOG_INFO,
664592071e8SBruce Evans 			    "Connection attempt to UDP %s:%d from %s:%d\n",
665592071e8SBruce Evans 			    buf, ntohs(uh->uh_dport), inet_ntoa(ip->ip_src),
666592071e8SBruce Evans 			    ntohs(uh->uh_sport));
66775cfc95fSAndrey A. Chernov 		}
668026decb8SRobert Watson 		UDPSTAT_INC(udps_noport);
669df8bae1dSRodney W. Grimes 		if (m->m_flags & (M_BCAST | M_MCAST)) {
670026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
671fa046d87SRobert Watson 			goto badunlocked;
672df8bae1dSRodney W. Grimes 		}
673603724d3SBjoern A. Zeeb 		if (V_udp_blackhole)
674fa046d87SRobert Watson 			goto badunlocked;
6751cbd978eSLuigi Rizzo 		if (badport_bandlim(BANDLIM_ICMP_UNREACH) < 0)
676fa046d87SRobert Watson 			goto badunlocked;
67704287599SRuslan Ermilov 		*ip = save_ip;
678582a7760SBruce Evans 		icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
6798f5a8818SKevin Lo 		return (IPPROTO_DONE);
680df8bae1dSRodney W. Grimes 	}
6813329b236SRobert Watson 
6823329b236SRobert Watson 	/*
6833329b236SRobert Watson 	 * Check the minimum TTL for socket.
6843329b236SRobert Watson 	 */
685fa046d87SRobert Watson 	INP_RLOCK_ASSERT(inp);
68610cc62b7SRobert Watson 	if (inp->inp_ip_minttl && inp->inp_ip_minttl > ip->ip_ttl) {
68710cc62b7SRobert Watson 		INP_RUNLOCK(inp);
688fa046d87SRobert Watson 		m_freem(m);
6898f5a8818SKevin Lo 		return (IPPROTO_DONE);
69010cc62b7SRobert Watson 	}
691e06e816fSKevin Lo 	if (cscov_partial) {
692e06e816fSKevin Lo 		struct udpcb *up;
693e06e816fSKevin Lo 
694e06e816fSKevin Lo 		up = intoudpcb(inp);
69583e95fb3SMichael Tuexen 		if (up->u_rxcslen == 0 || up->u_rxcslen > len) {
696e06e816fSKevin Lo 			INP_RUNLOCK(inp);
697e06e816fSKevin Lo 			m_freem(m);
6988f5a8818SKevin Lo 			return (IPPROTO_DONE);
699e06e816fSKevin Lo 		}
700e06e816fSKevin Lo 	}
70157f60867SMark Johnston 
7021ad19fb6SMark Johnston 	UDP_PROBE(receive, NULL, inp, ip, inp, uh);
70379bb84fbSEdward Tomasz Napierala 	udp_append(inp, ip, m, iphlen, &udp_in);
704119d85f6SRobert Watson 	INP_RUNLOCK(inp);
7058f5a8818SKevin Lo 	return (IPPROTO_DONE);
70661ffc0b1SJeffrey Hsu 
707f76fcf6dSJeffrey Hsu badunlocked:
708df8bae1dSRodney W. Grimes 	m_freem(m);
7098f5a8818SKevin Lo 	return (IPPROTO_DONE);
710cfa1ca9dSYoshinobu Inoue }
71179288c11SBjoern A. Zeeb #endif /* INET */
712cfa1ca9dSYoshinobu Inoue 
713cfa1ca9dSYoshinobu Inoue /*
7143329b236SRobert Watson  * Notify a udp user of an asynchronous error; just wake up so that they can
7153329b236SRobert Watson  * collect error status.
716df8bae1dSRodney W. Grimes  */
7173ce144eaSJeffrey Hsu struct inpcb *
7183329b236SRobert Watson udp_notify(struct inpcb *inp, int errno)
719df8bae1dSRodney W. Grimes {
7203329b236SRobert Watson 
721ac9ae279SRobert Watson 	/*
722ac9ae279SRobert Watson 	 * While udp_ctlinput() always calls udp_notify() with a read lock
723ac9ae279SRobert Watson 	 * when invoking it directly, in_pcbnotifyall() currently uses write
724ac9ae279SRobert Watson 	 * locks due to sharing code with TCP.  For now, accept either a read
725ac9ae279SRobert Watson 	 * or a write lock, but a read lock is sufficient.
726ac9ae279SRobert Watson 	 */
727ac9ae279SRobert Watson 	INP_LOCK_ASSERT(inp);
7288501a69cSRobert Watson 
729df8bae1dSRodney W. Grimes 	inp->inp_socket->so_error = errno;
730df8bae1dSRodney W. Grimes 	sorwakeup(inp->inp_socket);
731df8bae1dSRodney W. Grimes 	sowwakeup(inp->inp_socket);
7323329b236SRobert Watson 	return (inp);
733df8bae1dSRodney W. Grimes }
734df8bae1dSRodney W. Grimes 
73579288c11SBjoern A. Zeeb #ifdef INET
736e06e816fSKevin Lo static void
737e06e816fSKevin Lo udp_common_ctlinput(int cmd, struct sockaddr *sa, void *vip,
738e06e816fSKevin Lo     struct inpcbinfo *pcbinfo)
739df8bae1dSRodney W. Grimes {
740c693a045SJonathan Lemon 	struct ip *ip = vip;
741c693a045SJonathan Lemon 	struct udphdr *uh;
742c693a045SJonathan Lemon 	struct in_addr faddr;
743c693a045SJonathan Lemon 	struct inpcb *inp;
744c693a045SJonathan Lemon 
745c693a045SJonathan Lemon 	faddr = ((struct sockaddr_in *)sa)->sin_addr;
746c693a045SJonathan Lemon 	if (sa->sa_family != AF_INET || faddr.s_addr == INADDR_ANY)
747c693a045SJonathan Lemon 		return;
748df8bae1dSRodney W. Grimes 
74997d8d152SAndre Oppermann 	/*
75097d8d152SAndre Oppermann 	 * Redirects don't need to be handled up here.
75197d8d152SAndre Oppermann 	 */
75297d8d152SAndre Oppermann 	if (PRC_IS_REDIRECT(cmd))
75397d8d152SAndre Oppermann 		return;
7543329b236SRobert Watson 
75597d8d152SAndre Oppermann 	/*
75697d8d152SAndre Oppermann 	 * Hostdead is ugly because it goes linearly through all PCBs.
7573329b236SRobert Watson 	 *
7583329b236SRobert Watson 	 * XXX: We never get this from ICMP, otherwise it makes an excellent
7593329b236SRobert Watson 	 * DoS attack on machines with many connections.
76097d8d152SAndre Oppermann 	 */
76197d8d152SAndre Oppermann 	if (cmd == PRC_HOSTDEAD)
762af1ee11dSRobert Watson 		ip = NULL;
763d1c54148SJesper Skriver 	else if ((unsigned)cmd >= PRC_NCMDS || inetctlerrmap[cmd] == 0)
764df8bae1dSRodney W. Grimes 		return;
765af1ee11dSRobert Watson 	if (ip != NULL) {
766df8bae1dSRodney W. Grimes 		uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2));
767e06e816fSKevin Lo 		inp = in_pcblookup(pcbinfo, faddr, uh->uh_dport,
768fa046d87SRobert Watson 		    ip->ip_src, uh->uh_sport, INPLOOKUP_RLOCKPCB, NULL);
769f76fcf6dSJeffrey Hsu 		if (inp != NULL) {
770fa046d87SRobert Watson 			INP_RLOCK_ASSERT(inp);
771f76fcf6dSJeffrey Hsu 			if (inp->inp_socket != NULL) {
772f5514f08SRobert Watson 				udp_notify(inp, inetctlerrmap[cmd]);
773f76fcf6dSJeffrey Hsu 			}
774ac9ae279SRobert Watson 			INP_RUNLOCK(inp);
775f76fcf6dSJeffrey Hsu 		}
776df8bae1dSRodney W. Grimes 	} else
777e06e816fSKevin Lo 		in_pcbnotifyall(pcbinfo, faddr, inetctlerrmap[cmd],
778f5514f08SRobert Watson 		    udp_notify);
779df8bae1dSRodney W. Grimes }
780e06e816fSKevin Lo void
781e06e816fSKevin Lo udp_ctlinput(int cmd, struct sockaddr *sa, void *vip)
782e06e816fSKevin Lo {
783e06e816fSKevin Lo 
784e06e816fSKevin Lo 	return (udp_common_ctlinput(cmd, sa, vip, &V_udbinfo));
785e06e816fSKevin Lo }
786e06e816fSKevin Lo 
787e06e816fSKevin Lo void
788e06e816fSKevin Lo udplite_ctlinput(int cmd, struct sockaddr *sa, void *vip)
789e06e816fSKevin Lo {
790e06e816fSKevin Lo 
791e06e816fSKevin Lo 	return (udp_common_ctlinput(cmd, sa, vip, &V_ulitecbinfo));
792e06e816fSKevin Lo }
79379288c11SBjoern A. Zeeb #endif /* INET */
794df8bae1dSRodney W. Grimes 
7950312fbe9SPoul-Henning Kamp static int
79682d9ae4eSPoul-Henning Kamp udp_pcblist(SYSCTL_HANDLER_ARGS)
79798271db4SGarrett Wollman {
798277afaffSRobert Watson 	int error, i, n;
79998271db4SGarrett Wollman 	struct inpcb *inp, **inp_list;
80098271db4SGarrett Wollman 	inp_gen_t gencnt;
80198271db4SGarrett Wollman 	struct xinpgen xig;
80298271db4SGarrett Wollman 
80398271db4SGarrett Wollman 	/*
804f5514f08SRobert Watson 	 * The process of preparing the PCB list is too time-consuming and
80598271db4SGarrett Wollman 	 * resource-intensive to repeat twice on every request.
80698271db4SGarrett Wollman 	 */
80798271db4SGarrett Wollman 	if (req->oldptr == 0) {
808603724d3SBjoern A. Zeeb 		n = V_udbinfo.ipi_count;
809c007b96aSJohn Baldwin 		n += imax(n / 8, 10);
810c007b96aSJohn Baldwin 		req->oldidx = 2 * (sizeof xig) + n * sizeof(struct xinpcb);
8113329b236SRobert Watson 		return (0);
81298271db4SGarrett Wollman 	}
81398271db4SGarrett Wollman 
81498271db4SGarrett Wollman 	if (req->newptr != 0)
8153329b236SRobert Watson 		return (EPERM);
81698271db4SGarrett Wollman 
81798271db4SGarrett Wollman 	/*
81898271db4SGarrett Wollman 	 * OK, now we're committed to doing something.
81998271db4SGarrett Wollman 	 */
820603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
821603724d3SBjoern A. Zeeb 	gencnt = V_udbinfo.ipi_gencnt;
822603724d3SBjoern A. Zeeb 	n = V_udbinfo.ipi_count;
823603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
82498271db4SGarrett Wollman 
82547934cefSDon Lewis 	error = sysctl_wire_old_buffer(req, 2 * (sizeof xig)
8265c38b6dbSDon Lewis 		+ n * sizeof(struct xinpcb));
82747934cefSDon Lewis 	if (error != 0)
82847934cefSDon Lewis 		return (error);
8295c38b6dbSDon Lewis 
83098271db4SGarrett Wollman 	xig.xig_len = sizeof xig;
83198271db4SGarrett Wollman 	xig.xig_count = n;
83298271db4SGarrett Wollman 	xig.xig_gen = gencnt;
83398271db4SGarrett Wollman 	xig.xig_sogen = so_gencnt;
83498271db4SGarrett Wollman 	error = SYSCTL_OUT(req, &xig, sizeof xig);
83598271db4SGarrett Wollman 	if (error)
8363329b236SRobert Watson 		return (error);
83798271db4SGarrett Wollman 
838a163d034SWarner Losh 	inp_list = malloc(n * sizeof *inp_list, M_TEMP, M_WAITOK);
83998271db4SGarrett Wollman 	if (inp_list == 0)
8403329b236SRobert Watson 		return (ENOMEM);
84198271db4SGarrett Wollman 
842603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
843603724d3SBjoern A. Zeeb 	for (inp = LIST_FIRST(V_udbinfo.ipi_listhead), i = 0; inp && i < n;
844fc2ffbe6SPoul-Henning Kamp 	     inp = LIST_NEXT(inp, inp_list)) {
845d0e157f6SBjoern A. Zeeb 		INP_WLOCK(inp);
8462ded288cSJeffrey Hsu 		if (inp->inp_gencnt <= gencnt &&
847d0e157f6SBjoern A. Zeeb 		    cr_canseeinpcb(req->td->td_ucred, inp) == 0) {
848d0e157f6SBjoern A. Zeeb 			in_pcbref(inp);
84998271db4SGarrett Wollman 			inp_list[i++] = inp;
850d0e157f6SBjoern A. Zeeb 		}
851d0e157f6SBjoern A. Zeeb 		INP_WUNLOCK(inp);
8524787fd37SPaul Saab 	}
853603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
85498271db4SGarrett Wollman 	n = i;
85598271db4SGarrett Wollman 
85698271db4SGarrett Wollman 	error = 0;
85798271db4SGarrett Wollman 	for (i = 0; i < n; i++) {
85898271db4SGarrett Wollman 		inp = inp_list[i];
8599622e84fSRobert Watson 		INP_RLOCK(inp);
86098271db4SGarrett Wollman 		if (inp->inp_gencnt <= gencnt) {
86198271db4SGarrett Wollman 			struct xinpcb xi;
862d0e157f6SBjoern A. Zeeb 
863fd94099eSColin Percival 			bzero(&xi, sizeof(xi));
86498271db4SGarrett Wollman 			xi.xi_len = sizeof xi;
86598271db4SGarrett Wollman 			/* XXX should avoid extra copy */
86698271db4SGarrett Wollman 			bcopy(inp, &xi.xi_inp, sizeof *inp);
86798271db4SGarrett Wollman 			if (inp->inp_socket)
86898271db4SGarrett Wollman 				sotoxsocket(inp->inp_socket, &xi.xi_socket);
8694b40c56cSJeffrey Hsu 			xi.xi_inp.inp_gencnt = inp->inp_gencnt;
8709622e84fSRobert Watson 			INP_RUNLOCK(inp);
87198271db4SGarrett Wollman 			error = SYSCTL_OUT(req, &xi, sizeof xi);
872d915b280SStephan Uphoff 		} else
8739622e84fSRobert Watson 			INP_RUNLOCK(inp);
87498271db4SGarrett Wollman 	}
875d0e157f6SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
876d0e157f6SBjoern A. Zeeb 	for (i = 0; i < n; i++) {
877d0e157f6SBjoern A. Zeeb 		inp = inp_list[i];
878fa046d87SRobert Watson 		INP_RLOCK(inp);
879fa046d87SRobert Watson 		if (!in_pcbrele_rlocked(inp))
880fa046d87SRobert Watson 			INP_RUNLOCK(inp);
881d0e157f6SBjoern A. Zeeb 	}
882d0e157f6SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
883d0e157f6SBjoern A. Zeeb 
88498271db4SGarrett Wollman 	if (!error) {
88598271db4SGarrett Wollman 		/*
8863329b236SRobert Watson 		 * Give the user an updated idea of our state.  If the
8873329b236SRobert Watson 		 * generation differs from what we told her before, she knows
8883329b236SRobert Watson 		 * that something happened while we were processing this
8893329b236SRobert Watson 		 * request, and it might be necessary to retry.
89098271db4SGarrett Wollman 		 */
891603724d3SBjoern A. Zeeb 		INP_INFO_RLOCK(&V_udbinfo);
892603724d3SBjoern A. Zeeb 		xig.xig_gen = V_udbinfo.ipi_gencnt;
89398271db4SGarrett Wollman 		xig.xig_sogen = so_gencnt;
894603724d3SBjoern A. Zeeb 		xig.xig_count = V_udbinfo.ipi_count;
895603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
89698271db4SGarrett Wollman 		error = SYSCTL_OUT(req, &xig, sizeof xig);
89798271db4SGarrett Wollman 	}
89898271db4SGarrett Wollman 	free(inp_list, M_TEMP);
8993329b236SRobert Watson 	return (error);
90098271db4SGarrett Wollman }
90198271db4SGarrett Wollman 
90279c3d51bSMatthew D Fleming SYSCTL_PROC(_net_inet_udp, UDPCTL_PCBLIST, pcblist,
90379c3d51bSMatthew D Fleming     CTLTYPE_OPAQUE | CTLFLAG_RD, NULL, 0,
90498271db4SGarrett Wollman     udp_pcblist, "S,xinpcb", "List of active UDP sockets");
90598271db4SGarrett Wollman 
90679288c11SBjoern A. Zeeb #ifdef INET
90798271db4SGarrett Wollman static int
90882d9ae4eSPoul-Henning Kamp udp_getcred(SYSCTL_HANDLER_ARGS)
909490d50b6SBrian Feldman {
910c0511d3bSBrian Feldman 	struct xucred xuc;
911490d50b6SBrian Feldman 	struct sockaddr_in addrs[2];
912490d50b6SBrian Feldman 	struct inpcb *inp;
913277afaffSRobert Watson 	int error;
914490d50b6SBrian Feldman 
91532f9753cSRobert Watson 	error = priv_check(req->td, PRIV_NETINET_GETCRED);
916490d50b6SBrian Feldman 	if (error)
917490d50b6SBrian Feldman 		return (error);
918490d50b6SBrian Feldman 	error = SYSCTL_IN(req, addrs, sizeof(addrs));
919490d50b6SBrian Feldman 	if (error)
920490d50b6SBrian Feldman 		return (error);
921fa046d87SRobert Watson 	inp = in_pcblookup(&V_udbinfo, addrs[1].sin_addr, addrs[1].sin_port,
922fa046d87SRobert Watson 	    addrs[0].sin_addr, addrs[0].sin_port,
923fa046d87SRobert Watson 	    INPLOOKUP_WILDCARD | INPLOOKUP_RLOCKPCB, NULL);
9249622e84fSRobert Watson 	if (inp != NULL) {
925fa046d87SRobert Watson 		INP_RLOCK_ASSERT(inp);
9269622e84fSRobert Watson 		if (inp->inp_socket == NULL)
9279622e84fSRobert Watson 			error = ENOENT;
9289622e84fSRobert Watson 		if (error == 0)
929f08ef6c5SBjoern A. Zeeb 			error = cr_canseeinpcb(req->td->td_ucred, inp);
9309622e84fSRobert Watson 		if (error == 0)
93186d02c5cSBjoern A. Zeeb 			cru2x(inp->inp_cred, &xuc);
9329622e84fSRobert Watson 		INP_RUNLOCK(inp);
933fa046d87SRobert Watson 	} else
9349622e84fSRobert Watson 		error = ENOENT;
9350e1eebb8SDon Lewis 	if (error == 0)
9360e1eebb8SDon Lewis 		error = SYSCTL_OUT(req, &xuc, sizeof(struct xucred));
937490d50b6SBrian Feldman 	return (error);
938490d50b6SBrian Feldman }
939490d50b6SBrian Feldman 
9407ce87f12SDavid Malone SYSCTL_PROC(_net_inet_udp, OID_AUTO, getcred,
9417ce87f12SDavid Malone     CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_PRISON, 0, 0,
9427ce87f12SDavid Malone     udp_getcred, "S,xucred", "Get the xucred of a UDP connection");
94379288c11SBjoern A. Zeeb #endif /* INET */
944490d50b6SBrian Feldman 
9457b495c44SVANHULLEBUS Yvan int
9467b495c44SVANHULLEBUS Yvan udp_ctloutput(struct socket *so, struct sockopt *sopt)
9477b495c44SVANHULLEBUS Yvan {
9487b495c44SVANHULLEBUS Yvan 	struct inpcb *inp;
9497b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
950e06e816fSKevin Lo 	int isudplite, error, optval;
9517b495c44SVANHULLEBUS Yvan 
952e06e816fSKevin Lo 	error = 0;
953e06e816fSKevin Lo 	isudplite = (so->so_proto->pr_protocol == IPPROTO_UDPLITE) ? 1 : 0;
9547b495c44SVANHULLEBUS Yvan 	inp = sotoinpcb(so);
9557b495c44SVANHULLEBUS Yvan 	KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
9567b495c44SVANHULLEBUS Yvan 	INP_WLOCK(inp);
957e06e816fSKevin Lo 	if (sopt->sopt_level != so->so_proto->pr_protocol) {
9587b495c44SVANHULLEBUS Yvan #ifdef INET6
9597b495c44SVANHULLEBUS Yvan 		if (INP_CHECK_SOCKAF(so, AF_INET6)) {
9607b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9617b495c44SVANHULLEBUS Yvan 			error = ip6_ctloutput(so, sopt);
96279288c11SBjoern A. Zeeb 		}
9637b495c44SVANHULLEBUS Yvan #endif
96479288c11SBjoern A. Zeeb #if defined(INET) && defined(INET6)
96579288c11SBjoern A. Zeeb 		else
96679288c11SBjoern A. Zeeb #endif
96779288c11SBjoern A. Zeeb #ifdef INET
96879288c11SBjoern A. Zeeb 		{
9697b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9707b495c44SVANHULLEBUS Yvan 			error = ip_ctloutput(so, sopt);
9717b495c44SVANHULLEBUS Yvan 		}
9727b495c44SVANHULLEBUS Yvan #endif
9737b495c44SVANHULLEBUS Yvan 		return (error);
9747b495c44SVANHULLEBUS Yvan 	}
9757b495c44SVANHULLEBUS Yvan 
9767b495c44SVANHULLEBUS Yvan 	switch (sopt->sopt_dir) {
9777b495c44SVANHULLEBUS Yvan 	case SOPT_SET:
9787b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
9797b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
9807b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9817b495c44SVANHULLEBUS Yvan 			error = sooptcopyin(sopt, &optval, sizeof optval,
9827b495c44SVANHULLEBUS Yvan 					    sizeof optval);
9837b495c44SVANHULLEBUS Yvan 			if (error)
9847b495c44SVANHULLEBUS Yvan 				break;
9857b495c44SVANHULLEBUS Yvan 			inp = sotoinpcb(so);
9867b495c44SVANHULLEBUS Yvan 			KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
9877b495c44SVANHULLEBUS Yvan 			INP_WLOCK(inp);
9887b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
9897b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
9907b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
9917b495c44SVANHULLEBUS Yvan #endif
9927b495c44SVANHULLEBUS Yvan 			switch (optval) {
9937b495c44SVANHULLEBUS Yvan 			case 0:
9947b495c44SVANHULLEBUS Yvan 				/* Clear all UDP encap. */
9957b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
9967b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
9977b495c44SVANHULLEBUS Yvan #endif
9987b495c44SVANHULLEBUS Yvan 				break;
9997b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
10007b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP:
10017b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP_NON_IKE:
10027b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
10037b495c44SVANHULLEBUS Yvan 				if (optval == UDP_ENCAP_ESPINUDP)
10047b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP;
10057b495c44SVANHULLEBUS Yvan 				else if (optval == UDP_ENCAP_ESPINUDP_NON_IKE)
10067b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP_NON_IKE;
10077b495c44SVANHULLEBUS Yvan 				break;
10087b495c44SVANHULLEBUS Yvan #endif
10097b495c44SVANHULLEBUS Yvan 			default:
10107b495c44SVANHULLEBUS Yvan 				error = EINVAL;
10117b495c44SVANHULLEBUS Yvan 				break;
10127b495c44SVANHULLEBUS Yvan 			}
10137b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
10147b495c44SVANHULLEBUS Yvan 			break;
1015e06e816fSKevin Lo 		case UDPLITE_SEND_CSCOV:
1016e06e816fSKevin Lo 		case UDPLITE_RECV_CSCOV:
1017e06e816fSKevin Lo 			if (!isudplite) {
1018e06e816fSKevin Lo 				INP_WUNLOCK(inp);
1019e06e816fSKevin Lo 				error = ENOPROTOOPT;
1020e06e816fSKevin Lo 				break;
1021e06e816fSKevin Lo 			}
1022e06e816fSKevin Lo 			INP_WUNLOCK(inp);
1023e06e816fSKevin Lo 			error = sooptcopyin(sopt, &optval, sizeof(optval),
1024e06e816fSKevin Lo 			    sizeof(optval));
1025e06e816fSKevin Lo 			if (error != 0)
1026e06e816fSKevin Lo 				break;
1027e06e816fSKevin Lo 			inp = sotoinpcb(so);
1028e06e816fSKevin Lo 			KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
1029e06e816fSKevin Lo 			INP_WLOCK(inp);
1030e06e816fSKevin Lo 			up = intoudpcb(inp);
1031e06e816fSKevin Lo 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
103203f90784SMichael Tuexen 			if ((optval != 0 && optval < 8) || (optval > 65535)) {
1033e06e816fSKevin Lo 				INP_WUNLOCK(inp);
1034e06e816fSKevin Lo 				error = EINVAL;
1035e06e816fSKevin Lo 				break;
1036e06e816fSKevin Lo 			}
1037e06e816fSKevin Lo 			if (sopt->sopt_name == UDPLITE_SEND_CSCOV)
1038e06e816fSKevin Lo 				up->u_txcslen = optval;
1039e06e816fSKevin Lo 			else
1040e06e816fSKevin Lo 				up->u_rxcslen = optval;
1041e06e816fSKevin Lo 			INP_WUNLOCK(inp);
1042e06e816fSKevin Lo 			break;
10437b495c44SVANHULLEBUS Yvan 		default:
10447b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
10457b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
10467b495c44SVANHULLEBUS Yvan 			break;
10477b495c44SVANHULLEBUS Yvan 		}
10487b495c44SVANHULLEBUS Yvan 		break;
10497b495c44SVANHULLEBUS Yvan 	case SOPT_GET:
10507b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
10517b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
10527b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
10537b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
10547b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
10557b495c44SVANHULLEBUS Yvan 			optval = up->u_flags & UF_ESPINUDP_ALL;
10567b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
10577b495c44SVANHULLEBUS Yvan 			error = sooptcopyout(sopt, &optval, sizeof optval);
10587b495c44SVANHULLEBUS Yvan 			break;
10597b495c44SVANHULLEBUS Yvan #endif
1060e06e816fSKevin Lo 		case UDPLITE_SEND_CSCOV:
1061e06e816fSKevin Lo 		case UDPLITE_RECV_CSCOV:
1062e06e816fSKevin Lo 			if (!isudplite) {
1063e06e816fSKevin Lo 				INP_WUNLOCK(inp);
1064e06e816fSKevin Lo 				error = ENOPROTOOPT;
1065e06e816fSKevin Lo 				break;
1066e06e816fSKevin Lo 			}
1067e06e816fSKevin Lo 			up = intoudpcb(inp);
1068e06e816fSKevin Lo 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
1069e06e816fSKevin Lo 			if (sopt->sopt_name == UDPLITE_SEND_CSCOV)
1070e06e816fSKevin Lo 				optval = up->u_txcslen;
1071e06e816fSKevin Lo 			else
1072e06e816fSKevin Lo 				optval = up->u_rxcslen;
1073e06e816fSKevin Lo 			INP_WUNLOCK(inp);
1074e06e816fSKevin Lo 			error = sooptcopyout(sopt, &optval, sizeof(optval));
1075e06e816fSKevin Lo 			break;
10767b495c44SVANHULLEBUS Yvan 		default:
10777b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
10787b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
10797b495c44SVANHULLEBUS Yvan 			break;
10807b495c44SVANHULLEBUS Yvan 		}
10817b495c44SVANHULLEBUS Yvan 		break;
10827b495c44SVANHULLEBUS Yvan 	}
10837b495c44SVANHULLEBUS Yvan 	return (error);
10847b495c44SVANHULLEBUS Yvan }
10857b495c44SVANHULLEBUS Yvan 
108679288c11SBjoern A. Zeeb #ifdef INET
1087fa046d87SRobert Watson #define	UH_WLOCKED	2
1088fa046d87SRobert Watson #define	UH_RLOCKED	1
1089fa046d87SRobert Watson #define	UH_UNLOCKED	0
1090490d50b6SBrian Feldman static int
10913329b236SRobert Watson udp_output(struct inpcb *inp, struct mbuf *m, struct sockaddr *addr,
10923329b236SRobert Watson     struct mbuf *control, struct thread *td)
1093df8bae1dSRodney W. Grimes {
10943329b236SRobert Watson 	struct udpiphdr *ui;
10953329b236SRobert Watson 	int len = m->m_pkthdr.len;
109690162a4eSIan Dowse 	struct in_addr faddr, laddr;
1097c557ae16SIan Dowse 	struct cmsghdr *cm;
1098e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1099c557ae16SIan Dowse 	struct sockaddr_in *sin, src;
1100e06e816fSKevin Lo 	int cscov_partial = 0;
110190162a4eSIan Dowse 	int error = 0;
11028afa2304SBruce M Simpson 	int ipflags;
110390162a4eSIan Dowse 	u_short fport, lport;
11045c32ea65SRobert Watson 	int unlock_udbinfo;
1105f584d74bSMichael Tuexen 	u_char tos;
1106e06e816fSKevin Lo 	uint8_t pr;
1107e06e816fSKevin Lo 	uint16_t cscov = 0;
11089d3ddf43SAdrian Chadd 	uint32_t flowid = 0;
1109c2529042SHans Petter Selasky 	uint8_t flowtype = M_HASHTYPE_NONE;
1110df8bae1dSRodney W. Grimes 
11115c32ea65SRobert Watson 	/*
11125c32ea65SRobert Watson 	 * udp_output() may need to temporarily bind or connect the current
1113f5514f08SRobert Watson 	 * inpcb.  As such, we don't know up front whether we will need the
1114f5514f08SRobert Watson 	 * pcbinfo lock or not.  Do any work to decide what is needed up
1115f5514f08SRobert Watson 	 * front before acquiring any locks.
11165c32ea65SRobert Watson 	 */
1117430d30d8SBill Fenner 	if (len + sizeof(struct udpiphdr) > IP_MAXPACKET) {
1118c557ae16SIan Dowse 		if (control)
1119c557ae16SIan Dowse 			m_freem(control);
11205c32ea65SRobert Watson 		m_freem(m);
11213329b236SRobert Watson 		return (EMSGSIZE);
1122430d30d8SBill Fenner 	}
1123430d30d8SBill Fenner 
11241b7f0384SBruce M Simpson 	src.sin_family = 0;
11250cfdff24SBjoern A. Zeeb 	INP_RLOCK(inp);
1126f584d74bSMichael Tuexen 	tos = inp->inp_ip_tos;
1127c557ae16SIan Dowse 	if (control != NULL) {
1128c557ae16SIan Dowse 		/*
11293329b236SRobert Watson 		 * XXX: Currently, we assume all the optional information is
11303329b236SRobert Watson 		 * stored in a single mbuf.
1131c557ae16SIan Dowse 		 */
1132c557ae16SIan Dowse 		if (control->m_next) {
11330cfdff24SBjoern A. Zeeb 			INP_RUNLOCK(inp);
1134c557ae16SIan Dowse 			m_freem(control);
11355c32ea65SRobert Watson 			m_freem(m);
11363329b236SRobert Watson 			return (EINVAL);
1137c557ae16SIan Dowse 		}
1138c557ae16SIan Dowse 		for (; control->m_len > 0;
1139c557ae16SIan Dowse 		    control->m_data += CMSG_ALIGN(cm->cmsg_len),
1140c557ae16SIan Dowse 		    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
1141c557ae16SIan Dowse 			cm = mtod(control, struct cmsghdr *);
1142af1ee11dSRobert Watson 			if (control->m_len < sizeof(*cm) || cm->cmsg_len == 0
1143af1ee11dSRobert Watson 			    || cm->cmsg_len > control->m_len) {
1144c557ae16SIan Dowse 				error = EINVAL;
1145c557ae16SIan Dowse 				break;
1146c557ae16SIan Dowse 			}
1147c557ae16SIan Dowse 			if (cm->cmsg_level != IPPROTO_IP)
1148c557ae16SIan Dowse 				continue;
1149c557ae16SIan Dowse 
1150c557ae16SIan Dowse 			switch (cm->cmsg_type) {
1151c557ae16SIan Dowse 			case IP_SENDSRCADDR:
1152c557ae16SIan Dowse 				if (cm->cmsg_len !=
1153c557ae16SIan Dowse 				    CMSG_LEN(sizeof(struct in_addr))) {
1154c557ae16SIan Dowse 					error = EINVAL;
1155c557ae16SIan Dowse 					break;
1156c557ae16SIan Dowse 				}
1157c557ae16SIan Dowse 				bzero(&src, sizeof(src));
1158c557ae16SIan Dowse 				src.sin_family = AF_INET;
1159c557ae16SIan Dowse 				src.sin_len = sizeof(src);
1160c557ae16SIan Dowse 				src.sin_port = inp->inp_lport;
1161af1ee11dSRobert Watson 				src.sin_addr =
1162af1ee11dSRobert Watson 				    *(struct in_addr *)CMSG_DATA(cm);
1163c557ae16SIan Dowse 				break;
1164af1ee11dSRobert Watson 
1165f584d74bSMichael Tuexen 			case IP_TOS:
1166f584d74bSMichael Tuexen 				if (cm->cmsg_len != CMSG_LEN(sizeof(u_char))) {
1167f584d74bSMichael Tuexen 					error = EINVAL;
1168f584d74bSMichael Tuexen 					break;
1169f584d74bSMichael Tuexen 				}
1170f584d74bSMichael Tuexen 				tos = *(u_char *)CMSG_DATA(cm);
1171f584d74bSMichael Tuexen 				break;
1172f584d74bSMichael Tuexen 
11739d3ddf43SAdrian Chadd 			case IP_FLOWID:
11749d3ddf43SAdrian Chadd 				if (cm->cmsg_len != CMSG_LEN(sizeof(uint32_t))) {
11759d3ddf43SAdrian Chadd 					error = EINVAL;
11769d3ddf43SAdrian Chadd 					break;
11779d3ddf43SAdrian Chadd 				}
11789d3ddf43SAdrian Chadd 				flowid = *(uint32_t *) CMSG_DATA(cm);
11799d3ddf43SAdrian Chadd 				break;
11809d3ddf43SAdrian Chadd 
11819d3ddf43SAdrian Chadd 			case IP_FLOWTYPE:
11829d3ddf43SAdrian Chadd 				if (cm->cmsg_len != CMSG_LEN(sizeof(uint32_t))) {
11839d3ddf43SAdrian Chadd 					error = EINVAL;
11849d3ddf43SAdrian Chadd 					break;
11859d3ddf43SAdrian Chadd 				}
1186c2529042SHans Petter Selasky 				flowtype = *(uint32_t *) CMSG_DATA(cm);
11879d3ddf43SAdrian Chadd 				break;
11889d3ddf43SAdrian Chadd 
11899d3ddf43SAdrian Chadd #ifdef	RSS
11909d3ddf43SAdrian Chadd 			case IP_RSSBUCKETID:
11919d3ddf43SAdrian Chadd 				if (cm->cmsg_len != CMSG_LEN(sizeof(uint32_t))) {
11929d3ddf43SAdrian Chadd 					error = EINVAL;
11939d3ddf43SAdrian Chadd 					break;
11949d3ddf43SAdrian Chadd 				}
11959d3ddf43SAdrian Chadd 				/* This is just a placeholder for now */
11969d3ddf43SAdrian Chadd 				break;
11979d3ddf43SAdrian Chadd #endif	/* RSS */
1198c557ae16SIan Dowse 			default:
1199c557ae16SIan Dowse 				error = ENOPROTOOPT;
1200c557ae16SIan Dowse 				break;
1201c557ae16SIan Dowse 			}
1202c557ae16SIan Dowse 			if (error)
1203c557ae16SIan Dowse 				break;
1204c557ae16SIan Dowse 		}
1205c557ae16SIan Dowse 		m_freem(control);
1206c557ae16SIan Dowse 	}
12075c32ea65SRobert Watson 	if (error) {
12080cfdff24SBjoern A. Zeeb 		INP_RUNLOCK(inp);
12095c32ea65SRobert Watson 		m_freem(m);
12103329b236SRobert Watson 		return (error);
12115c32ea65SRobert Watson 	}
12125c32ea65SRobert Watson 
121343cc0bc1SRobert Watson 	/*
121443cc0bc1SRobert Watson 	 * Depending on whether or not the application has bound or connected
1215ca528788SRobert Watson 	 * the socket, we may have to do varying levels of work.  The optimal
1216ca528788SRobert Watson 	 * case is for a connected UDP socket, as a global lock isn't
1217ca528788SRobert Watson 	 * required at all.
121843cc0bc1SRobert Watson 	 *
121943cc0bc1SRobert Watson 	 * In order to decide which we need, we require stability of the
122043cc0bc1SRobert Watson 	 * inpcb binding, which we ensure by acquiring a read lock on the
122143cc0bc1SRobert Watson 	 * inpcb.  This doesn't strictly follow the lock order, so we play
122243cc0bc1SRobert Watson 	 * the trylock and retry game; note that we may end up with more
122343cc0bc1SRobert Watson 	 * conservative locks than required the second time around, so later
122443cc0bc1SRobert Watson 	 * assertions have to accept that.  Further analysis of the number of
122543cc0bc1SRobert Watson 	 * misses under contention is required.
1226fa046d87SRobert Watson 	 *
1227fa046d87SRobert Watson 	 * XXXRW: Check that hash locking update here is correct.
122843cc0bc1SRobert Watson 	 */
1229e06e816fSKevin Lo 	pr = inp->inp_socket->so_proto->pr_protocol;
1230e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(pr);
123143cc0bc1SRobert Watson 	sin = (struct sockaddr_in *)addr;
123243cc0bc1SRobert Watson 	if (sin != NULL &&
123343cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY && inp->inp_lport == 0)) {
123443cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
12358501a69cSRobert Watson 		INP_WLOCK(inp);
1236e06e816fSKevin Lo 		INP_HASH_WLOCK(pcbinfo);
1237fa046d87SRobert Watson 		unlock_udbinfo = UH_WLOCKED;
123843cc0bc1SRobert Watson 	} else if ((sin != NULL && (
123943cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_ANY) ||
124043cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_BROADCAST) ||
124143cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY) ||
124243cc0bc1SRobert Watson 	    (inp->inp_lport == 0))) ||
124343cc0bc1SRobert Watson 	    (src.sin_family == AF_INET)) {
1244e06e816fSKevin Lo 		INP_HASH_RLOCK(pcbinfo);
1245fa046d87SRobert Watson 		unlock_udbinfo = UH_RLOCKED;
124643cc0bc1SRobert Watson 	} else
1247fa046d87SRobert Watson 		unlock_udbinfo = UH_UNLOCKED;
12485c32ea65SRobert Watson 
12491b7f0384SBruce M Simpson 	/*
12501b7f0384SBruce M Simpson 	 * If the IP_SENDSRCADDR control message was specified, override the
12511b7f0384SBruce M Simpson 	 * source address for this datagram.  Its use is invalidated if the
12521b7f0384SBruce M Simpson 	 * address thus specified is incomplete or clobbers other inpcbs.
12531b7f0384SBruce M Simpson 	 */
125490162a4eSIan Dowse 	laddr = inp->inp_laddr;
125590162a4eSIan Dowse 	lport = inp->inp_lport;
12561b7f0384SBruce M Simpson 	if (src.sin_family == AF_INET) {
1257e06e816fSKevin Lo 		INP_HASH_LOCK_ASSERT(pcbinfo);
12581b7f0384SBruce M Simpson 		if ((lport == 0) ||
12591b7f0384SBruce M Simpson 		    (laddr.s_addr == INADDR_ANY &&
12601b7f0384SBruce M Simpson 		     src.sin_addr.s_addr == INADDR_ANY)) {
1261c557ae16SIan Dowse 			error = EINVAL;
1262c557ae16SIan Dowse 			goto release;
1263c557ae16SIan Dowse 		}
1264c557ae16SIan Dowse 		error = in_pcbbind_setup(inp, (struct sockaddr *)&src,
1265b0330ed9SPawel Jakub Dawidek 		    &laddr.s_addr, &lport, td->td_ucred);
1266c557ae16SIan Dowse 		if (error)
1267c557ae16SIan Dowse 			goto release;
1268c557ae16SIan Dowse 	}
1269c557ae16SIan Dowse 
12703144b7d3SRobert Watson 	/*
12713144b7d3SRobert Watson 	 * If a UDP socket has been connected, then a local address/port will
12723144b7d3SRobert Watson 	 * have been selected and bound.
12733144b7d3SRobert Watson 	 *
127443cc0bc1SRobert Watson 	 * If a UDP socket has not been connected to, then an explicit
12753144b7d3SRobert Watson 	 * destination address must be used, in which case a local
12763144b7d3SRobert Watson 	 * address/port may not have been selected and bound.
12773144b7d3SRobert Watson 	 */
127843cc0bc1SRobert Watson 	if (sin != NULL) {
1279c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
1280df8bae1dSRodney W. Grimes 		if (inp->inp_faddr.s_addr != INADDR_ANY) {
1281df8bae1dSRodney W. Grimes 			error = EISCONN;
1282df8bae1dSRodney W. Grimes 			goto release;
1283df8bae1dSRodney W. Grimes 		}
12843144b7d3SRobert Watson 
12853144b7d3SRobert Watson 		/*
12863144b7d3SRobert Watson 		 * Jail may rewrite the destination address, so let it do
12873144b7d3SRobert Watson 		 * that before we use it.
12883144b7d3SRobert Watson 		 */
1289b89e82ddSJamie Gritton 		error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1290b89e82ddSJamie Gritton 		if (error)
1291413628a7SBjoern A. Zeeb 			goto release;
12923144b7d3SRobert Watson 
12933144b7d3SRobert Watson 		/*
129443cc0bc1SRobert Watson 		 * If a local address or port hasn't yet been selected, or if
129543cc0bc1SRobert Watson 		 * the destination address needs to be rewritten due to using
129643cc0bc1SRobert Watson 		 * a special INADDR_ constant, invoke in_pcbconnect_setup()
129743cc0bc1SRobert Watson 		 * to do the heavy lifting.  Once a port is selected, we
129843cc0bc1SRobert Watson 		 * commit the binding back to the socket; we also commit the
129943cc0bc1SRobert Watson 		 * binding of the address if in jail.
130043cc0bc1SRobert Watson 		 *
130143cc0bc1SRobert Watson 		 * If we already have a valid binding and we're not
130243cc0bc1SRobert Watson 		 * requesting a destination address rewrite, use a fast path.
13033144b7d3SRobert Watson 		 */
130443cc0bc1SRobert Watson 		if (inp->inp_laddr.s_addr == INADDR_ANY ||
130543cc0bc1SRobert Watson 		    inp->inp_lport == 0 ||
130643cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_ANY ||
130743cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_BROADCAST) {
1308e06e816fSKevin Lo 			INP_HASH_LOCK_ASSERT(pcbinfo);
130943cc0bc1SRobert Watson 			error = in_pcbconnect_setup(inp, addr, &laddr.s_addr,
131043cc0bc1SRobert Watson 			    &lport, &faddr.s_addr, &fport, NULL,
131143cc0bc1SRobert Watson 			    td->td_ucred);
131290162a4eSIan Dowse 			if (error)
131390162a4eSIan Dowse 				goto release;
131490162a4eSIan Dowse 
131543cc0bc1SRobert Watson 			/*
131643cc0bc1SRobert Watson 			 * XXXRW: Why not commit the port if the address is
131743cc0bc1SRobert Watson 			 * !INADDR_ANY?
131843cc0bc1SRobert Watson 			 */
131990162a4eSIan Dowse 			/* Commit the local port if newly assigned. */
132090162a4eSIan Dowse 			if (inp->inp_laddr.s_addr == INADDR_ANY &&
132190162a4eSIan Dowse 			    inp->inp_lport == 0) {
1322c4d585aeSRobert Watson 				INP_WLOCK_ASSERT(inp);
1323e06e816fSKevin Lo 				INP_HASH_WLOCK_ASSERT(pcbinfo);
13243a1757b9SGleb Smirnoff 				/*
132543cc0bc1SRobert Watson 				 * Remember addr if jailed, to prevent
132643cc0bc1SRobert Watson 				 * rebinding.
13273a1757b9SGleb Smirnoff 				 */
13280304c731SJamie Gritton 				if (prison_flag(td->td_ucred, PR_IP4))
13293a1757b9SGleb Smirnoff 					inp->inp_laddr = laddr;
133090162a4eSIan Dowse 				inp->inp_lport = lport;
133190162a4eSIan Dowse 				if (in_pcbinshash(inp) != 0) {
133290162a4eSIan Dowse 					inp->inp_lport = 0;
133390162a4eSIan Dowse 					error = EAGAIN;
1334df8bae1dSRodney W. Grimes 					goto release;
1335df8bae1dSRodney W. Grimes 				}
133690162a4eSIan Dowse 				inp->inp_flags |= INP_ANONPORT;
133790162a4eSIan Dowse 			}
1338df8bae1dSRodney W. Grimes 		} else {
133943cc0bc1SRobert Watson 			faddr = sin->sin_addr;
134043cc0bc1SRobert Watson 			fport = sin->sin_port;
134143cc0bc1SRobert Watson 		}
134243cc0bc1SRobert Watson 	} else {
1343c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
134490162a4eSIan Dowse 		faddr = inp->inp_faddr;
134590162a4eSIan Dowse 		fport = inp->inp_fport;
134690162a4eSIan Dowse 		if (faddr.s_addr == INADDR_ANY) {
1347df8bae1dSRodney W. Grimes 			error = ENOTCONN;
1348df8bae1dSRodney W. Grimes 			goto release;
1349df8bae1dSRodney W. Grimes 		}
1350df8bae1dSRodney W. Grimes 	}
1351e6ccd709SRobert Watson 
1352df8bae1dSRodney W. Grimes 	/*
1353e6ccd709SRobert Watson 	 * Calculate data length and get a mbuf for UDP, IP, and possible
1354392e8407SRobert Watson 	 * link-layer headers.  Immediate slide the data pointer back forward
1355392e8407SRobert Watson 	 * since we won't use that space at this layer.
1356df8bae1dSRodney W. Grimes 	 */
1357eb1b1807SGleb Smirnoff 	M_PREPEND(m, sizeof(struct udpiphdr) + max_linkhdr, M_NOWAIT);
1358e6ccd709SRobert Watson 	if (m == NULL) {
1359df8bae1dSRodney W. Grimes 		error = ENOBUFS;
136049b19bfcSBruce M Simpson 		goto release;
1361df8bae1dSRodney W. Grimes 	}
1362e6ccd709SRobert Watson 	m->m_data += max_linkhdr;
1363e6ccd709SRobert Watson 	m->m_len -= max_linkhdr;
1364392e8407SRobert Watson 	m->m_pkthdr.len -= max_linkhdr;
1365df8bae1dSRodney W. Grimes 
1366df8bae1dSRodney W. Grimes 	/*
13673329b236SRobert Watson 	 * Fill in mbuf with extended UDP header and addresses and length put
13683329b236SRobert Watson 	 * into network format.
1369df8bae1dSRodney W. Grimes 	 */
1370df8bae1dSRodney W. Grimes 	ui = mtod(m, struct udpiphdr *);
1371db4f9cc7SJonathan Lemon 	bzero(ui->ui_x1, sizeof(ui->ui_x1));	/* XXX still needed? */
1372e06e816fSKevin Lo 	ui->ui_pr = pr;
137390162a4eSIan Dowse 	ui->ui_src = laddr;
137490162a4eSIan Dowse 	ui->ui_dst = faddr;
137590162a4eSIan Dowse 	ui->ui_sport = lport;
137690162a4eSIan Dowse 	ui->ui_dport = fport;
1377db4f9cc7SJonathan Lemon 	ui->ui_ulen = htons((u_short)len + sizeof(struct udphdr));
1378e06e816fSKevin Lo 	if (pr == IPPROTO_UDPLITE) {
1379e06e816fSKevin Lo 		struct udpcb *up;
1380e06e816fSKevin Lo 		uint16_t plen;
1381e06e816fSKevin Lo 
1382e06e816fSKevin Lo 		up = intoudpcb(inp);
1383e06e816fSKevin Lo 		cscov = up->u_txcslen;
1384e06e816fSKevin Lo 		plen = (u_short)len + sizeof(struct udphdr);
1385e06e816fSKevin Lo 		if (cscov >= plen)
1386e06e816fSKevin Lo 			cscov = 0;
1387e06e816fSKevin Lo 		ui->ui_len = htons(plen);
1388e06e816fSKevin Lo 		ui->ui_ulen = htons(cscov);
1389e06e816fSKevin Lo 		/*
1390e06e816fSKevin Lo 		 * For UDP-Lite, checksum coverage length of zero means
1391e06e816fSKevin Lo 		 * the entire UDPLite packet is covered by the checksum.
1392e06e816fSKevin Lo 		 */
1393e06e816fSKevin Lo 		cscov_partial = (cscov == 0) ? 0 : 1;
1394e06e816fSKevin Lo 	} else
1395e06e816fSKevin Lo 		ui->ui_v = IPVERSION << 4;
1396df8bae1dSRodney W. Grimes 
1397b2828ad2SAndre Oppermann 	/*
1398b2828ad2SAndre Oppermann 	 * Set the Don't Fragment bit in the IP header.
1399b2828ad2SAndre Oppermann 	 */
1400b2828ad2SAndre Oppermann 	if (inp->inp_flags & INP_DONTFRAG) {
1401b2828ad2SAndre Oppermann 		struct ip *ip;
14023329b236SRobert Watson 
1403b2828ad2SAndre Oppermann 		ip = (struct ip *)&ui->ui_i;
14048f134647SGleb Smirnoff 		ip->ip_off |= htons(IP_DF);
1405b2828ad2SAndre Oppermann 	}
1406b2828ad2SAndre Oppermann 
1407b5d47ff5SJohn-Mark Gurney 	ipflags = 0;
1408b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_DONTROUTE)
1409b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ROUTETOIF;
1410b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_BROADCAST)
1411b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ALLOWBROADCAST;
14126fbfd582SAndre Oppermann 	if (inp->inp_flags & INP_ONESBCAST)
14138afa2304SBruce M Simpson 		ipflags |= IP_SENDONES;
14148afa2304SBruce M Simpson 
14151175d9d5SRobert Watson #ifdef MAC
14161175d9d5SRobert Watson 	mac_inpcb_create_mbuf(inp, m);
14171175d9d5SRobert Watson #endif
14181175d9d5SRobert Watson 
1419df8bae1dSRodney W. Grimes 	/*
1420db4f9cc7SJonathan Lemon 	 * Set up checksum and output datagram.
1421df8bae1dSRodney W. Grimes 	 */
1422e06e816fSKevin Lo 	ui->ui_sum = 0;
1423a485f139SMichael Tuexen 	if (pr == IPPROTO_UDPLITE) {
1424e06e816fSKevin Lo 		if (inp->inp_flags & INP_ONESBCAST)
1425e06e816fSKevin Lo 			faddr.s_addr = INADDR_BROADCAST;
1426a485f139SMichael Tuexen 		if (cscov_partial) {
1427e06e816fSKevin Lo 			if ((ui->ui_sum = in_cksum(m, sizeof(struct ip) + cscov)) == 0)
1428e06e816fSKevin Lo 				ui->ui_sum = 0xffff;
1429a485f139SMichael Tuexen 		} else {
1430a485f139SMichael Tuexen 			if ((ui->ui_sum = in_cksum(m, sizeof(struct udpiphdr) + len)) == 0)
1431a485f139SMichael Tuexen 				ui->ui_sum = 0xffff;
1432a485f139SMichael Tuexen 		}
1433a485f139SMichael Tuexen 	} else if (V_udp_cksum) {
14346fbfd582SAndre Oppermann 		if (inp->inp_flags & INP_ONESBCAST)
14358a538743SBruce M Simpson 			faddr.s_addr = INADDR_BROADCAST;
14368a538743SBruce M Simpson 		ui->ui_sum = in_pseudo(ui->ui_src.s_addr, faddr.s_addr,
1437e06e816fSKevin Lo 		    htons((u_short)len + sizeof(struct udphdr) + pr));
1438db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_flags = CSUM_UDP;
1439db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum);
1440e06e816fSKevin Lo 	}
14418f134647SGleb Smirnoff 	((struct ip *)ui)->ip_len = htons(sizeof(struct udpiphdr) + len);
1442ca98b82cSDavid Greenman 	((struct ip *)ui)->ip_ttl = inp->inp_ip_ttl;	/* XXX */
1443f584d74bSMichael Tuexen 	((struct ip *)ui)->ip_tos = tos;		/* XXX */
1444026decb8SRobert Watson 	UDPSTAT_INC(udps_opackets);
1445cfa1ca9dSYoshinobu Inoue 
14469d3ddf43SAdrian Chadd 	/*
14479d3ddf43SAdrian Chadd 	 * Setup flowid / RSS information for outbound socket.
14489d3ddf43SAdrian Chadd 	 *
14499d3ddf43SAdrian Chadd 	 * Once the UDP code decides to set a flowid some other way,
14509d3ddf43SAdrian Chadd 	 * this allows the flowid to be overridden by userland.
14519d3ddf43SAdrian Chadd 	 */
1452c2529042SHans Petter Selasky 	if (flowtype != M_HASHTYPE_NONE) {
14539d3ddf43SAdrian Chadd 		m->m_pkthdr.flowid = flowid;
1454c2529042SHans Petter Selasky 		M_HASHTYPE_SET(m, flowtype);
14558ad1a83bSAdrian Chadd #ifdef	RSS
14568ad1a83bSAdrian Chadd 	} else {
14578ad1a83bSAdrian Chadd 		uint32_t hash_val, hash_type;
14588ad1a83bSAdrian Chadd 		/*
14598ad1a83bSAdrian Chadd 		 * Calculate an appropriate RSS hash for UDP and
14608ad1a83bSAdrian Chadd 		 * UDP Lite.
14618ad1a83bSAdrian Chadd 		 *
14628ad1a83bSAdrian Chadd 		 * The called function will take care of figuring out
14638ad1a83bSAdrian Chadd 		 * whether a 2-tuple or 4-tuple hash is required based
14648ad1a83bSAdrian Chadd 		 * on the currently configured scheme.
14658ad1a83bSAdrian Chadd 		 *
14668ad1a83bSAdrian Chadd 		 * Later later on connected socket values should be
14678ad1a83bSAdrian Chadd 		 * cached in the inpcb and reused, rather than constantly
14688ad1a83bSAdrian Chadd 		 * re-calculating it.
14698ad1a83bSAdrian Chadd 		 *
14708ad1a83bSAdrian Chadd 		 * UDP Lite is a different protocol number and will
14718ad1a83bSAdrian Chadd 		 * likely end up being hashed as a 2-tuple until
14728ad1a83bSAdrian Chadd 		 * RSS / NICs grow UDP Lite protocol awareness.
14738ad1a83bSAdrian Chadd 		 */
14748ad1a83bSAdrian Chadd 		if (rss_proto_software_hash_v4(faddr, laddr, fport, lport,
14758ad1a83bSAdrian Chadd 		    pr, &hash_val, &hash_type) == 0) {
14768ad1a83bSAdrian Chadd 			m->m_pkthdr.flowid = hash_val;
14778ad1a83bSAdrian Chadd 			M_HASHTYPE_SET(m, hash_type);
14788ad1a83bSAdrian Chadd 		}
14798ad1a83bSAdrian Chadd #endif
14809d3ddf43SAdrian Chadd 	}
14819d3ddf43SAdrian Chadd 
14829d3ddf43SAdrian Chadd #ifdef	RSS
14838ad1a83bSAdrian Chadd 	/*
14848ad1a83bSAdrian Chadd 	 * Don't override with the inp cached flowid value.
14858ad1a83bSAdrian Chadd 	 *
14868ad1a83bSAdrian Chadd 	 * Depending upon the kind of send being done, the inp
14878ad1a83bSAdrian Chadd 	 * flowid/flowtype values may actually not be appropriate
14888ad1a83bSAdrian Chadd 	 * for this particular socket send.
14898ad1a83bSAdrian Chadd 	 *
14908ad1a83bSAdrian Chadd 	 * We should either leave the flowid at zero (which is what is
14918ad1a83bSAdrian Chadd 	 * currently done) or set it to some software generated
14928ad1a83bSAdrian Chadd 	 * hash value based on the packet contents.
14938ad1a83bSAdrian Chadd 	 */
14949d3ddf43SAdrian Chadd 	ipflags |= IP_NODEFAULTFLOWID;
14959d3ddf43SAdrian Chadd #endif	/* RSS */
14969d3ddf43SAdrian Chadd 
1497fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED)
1498e06e816fSKevin Lo 		INP_HASH_WUNLOCK(pcbinfo);
1499fa046d87SRobert Watson 	else if (unlock_udbinfo == UH_RLOCKED)
1500e06e816fSKevin Lo 		INP_HASH_RUNLOCK(pcbinfo);
150157f60867SMark Johnston 	UDP_PROBE(send, NULL, inp, &ui->ui_i, inp, &ui->ui_u);
150297d8d152SAndre Oppermann 	error = ip_output(m, inp->inp_options, NULL, ipflags,
15035d846453SSam Leffler 	    inp->inp_moptions, inp);
1504fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED)
15058501a69cSRobert Watson 		INP_WUNLOCK(inp);
1506948d0fc9SRobert Watson 	else
1507948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1508df8bae1dSRodney W. Grimes 	return (error);
1509df8bae1dSRodney W. Grimes 
1510df8bae1dSRodney W. Grimes release:
1511fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED) {
1512e06e816fSKevin Lo 		INP_HASH_WUNLOCK(pcbinfo);
1513948d0fc9SRobert Watson 		INP_WUNLOCK(inp);
1514fa046d87SRobert Watson 	} else if (unlock_udbinfo == UH_RLOCKED) {
1515e06e816fSKevin Lo 		INP_HASH_RUNLOCK(pcbinfo);
151643cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
1517948d0fc9SRobert Watson 	} else
1518948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1519df8bae1dSRodney W. Grimes 	m_freem(m);
1520df8bae1dSRodney W. Grimes 	return (error);
1521df8bae1dSRodney W. Grimes }
1522df8bae1dSRodney W. Grimes 
15237b495c44SVANHULLEBUS Yvan 
15247b495c44SVANHULLEBUS Yvan #if defined(IPSEC) && defined(IPSEC_NAT_T)
15257b495c44SVANHULLEBUS Yvan /*
15267b495c44SVANHULLEBUS Yvan  * Potentially decap ESP in UDP frame.  Check for an ESP header
15277b495c44SVANHULLEBUS Yvan  * and optional marker; if present, strip the UDP header and
15287b495c44SVANHULLEBUS Yvan  * push the result through IPSec.
15297b495c44SVANHULLEBUS Yvan  *
15307b495c44SVANHULLEBUS Yvan  * Returns mbuf to be processed (potentially re-allocated) or
15317b495c44SVANHULLEBUS Yvan  * NULL if consumed and/or processed.
15327b495c44SVANHULLEBUS Yvan  */
15337b495c44SVANHULLEBUS Yvan static struct mbuf *
15347b495c44SVANHULLEBUS Yvan udp4_espdecap(struct inpcb *inp, struct mbuf *m, int off)
15357b495c44SVANHULLEBUS Yvan {
15367b495c44SVANHULLEBUS Yvan 	size_t minlen, payload, skip, iphlen;
15377b495c44SVANHULLEBUS Yvan 	caddr_t data;
15387b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
15397b495c44SVANHULLEBUS Yvan 	struct m_tag *tag;
15407b495c44SVANHULLEBUS Yvan 	struct udphdr *udphdr;
15417b495c44SVANHULLEBUS Yvan 	struct ip *ip;
15427b495c44SVANHULLEBUS Yvan 
15437b495c44SVANHULLEBUS Yvan 	INP_RLOCK_ASSERT(inp);
15447b495c44SVANHULLEBUS Yvan 
15457b495c44SVANHULLEBUS Yvan 	/*
15467b495c44SVANHULLEBUS Yvan 	 * Pull up data so the longest case is contiguous:
15477b495c44SVANHULLEBUS Yvan 	 *    IP/UDP hdr + non ESP marker + ESP hdr.
15487b495c44SVANHULLEBUS Yvan 	 */
15497b495c44SVANHULLEBUS Yvan 	minlen = off + sizeof(uint64_t) + sizeof(struct esp);
15507b495c44SVANHULLEBUS Yvan 	if (minlen > m->m_pkthdr.len)
15517b495c44SVANHULLEBUS Yvan 		minlen = m->m_pkthdr.len;
15527b495c44SVANHULLEBUS Yvan 	if ((m = m_pullup(m, minlen)) == NULL) {
15536794f460SAndrey V. Elsukov 		IPSECSTAT_INC(ips_in_inval);
15547b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Bypass caller processing. */
15557b495c44SVANHULLEBUS Yvan 	}
15567b495c44SVANHULLEBUS Yvan 	data = mtod(m, caddr_t);	/* Points to ip header. */
15577b495c44SVANHULLEBUS Yvan 	payload = m->m_len - off;	/* Size of payload. */
15587b495c44SVANHULLEBUS Yvan 
15597b495c44SVANHULLEBUS Yvan 	if (payload == 1 && data[off] == '\xff')
15607b495c44SVANHULLEBUS Yvan 		return (m);		/* NB: keepalive packet, no decap. */
15617b495c44SVANHULLEBUS Yvan 
15627b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
15637b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
15647b495c44SVANHULLEBUS Yvan 	KASSERT((up->u_flags & UF_ESPINUDP_ALL) != 0,
15657b495c44SVANHULLEBUS Yvan 	    ("u_flags 0x%x", up->u_flags));
15667b495c44SVANHULLEBUS Yvan 
15677b495c44SVANHULLEBUS Yvan 	/*
15687b495c44SVANHULLEBUS Yvan 	 * Check that the payload is large enough to hold an
15697b495c44SVANHULLEBUS Yvan 	 * ESP header and compute the amount of data to remove.
15707b495c44SVANHULLEBUS Yvan 	 *
15717b495c44SVANHULLEBUS Yvan 	 * NB: the caller has already done a pullup for us.
15727b495c44SVANHULLEBUS Yvan 	 * XXX can we assume alignment and eliminate bcopys?
15737b495c44SVANHULLEBUS Yvan 	 */
15747b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_NON_IKE) {
15757b495c44SVANHULLEBUS Yvan 		/*
15767b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-nat-t-ike-0[01].txt and
15777b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-udp-encaps-(00/)01.txt, ignoring
15787b495c44SVANHULLEBUS Yvan 		 * possible AH mode non-IKE marker+non-ESP marker
15797b495c44SVANHULLEBUS Yvan 		 * from draft-ietf-ipsec-udp-encaps-00.txt.
15807b495c44SVANHULLEBUS Yvan 		 */
15817b495c44SVANHULLEBUS Yvan 		uint64_t marker;
15827b495c44SVANHULLEBUS Yvan 
15837b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(uint64_t) + sizeof(struct esp))
15847b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
15857b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &marker, sizeof(uint64_t));
15867b495c44SVANHULLEBUS Yvan 		if (marker != 0)	/* Non-IKE marker. */
15877b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
15887b495c44SVANHULLEBUS Yvan 		skip = sizeof(uint64_t) + sizeof(struct udphdr);
15897b495c44SVANHULLEBUS Yvan 	} else {
15907b495c44SVANHULLEBUS Yvan 		uint32_t spi;
15917b495c44SVANHULLEBUS Yvan 
15927b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(struct esp)) {
15936794f460SAndrey V. Elsukov 			IPSECSTAT_INC(ips_in_inval);
15947b495c44SVANHULLEBUS Yvan 			m_freem(m);
15957b495c44SVANHULLEBUS Yvan 			return (NULL);	/* Discard. */
15967b495c44SVANHULLEBUS Yvan 		}
15977b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &spi, sizeof(uint32_t));
15987b495c44SVANHULLEBUS Yvan 		if (spi == 0)		/* Non-ESP marker. */
15997b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
16007b495c44SVANHULLEBUS Yvan 		skip = sizeof(struct udphdr);
16017b495c44SVANHULLEBUS Yvan 	}
16027b495c44SVANHULLEBUS Yvan 
16037b495c44SVANHULLEBUS Yvan 	/*
16047b495c44SVANHULLEBUS Yvan 	 * Setup a PACKET_TAG_IPSEC_NAT_T_PORT tag to remember
16057b495c44SVANHULLEBUS Yvan 	 * the UDP ports. This is required if we want to select
16067b495c44SVANHULLEBUS Yvan 	 * the right SPD for multiple hosts behind same NAT.
16077b495c44SVANHULLEBUS Yvan 	 *
16087b495c44SVANHULLEBUS Yvan 	 * NB: ports are maintained in network byte order everywhere
16097b495c44SVANHULLEBUS Yvan 	 *     in the NAT-T code.
16107b495c44SVANHULLEBUS Yvan 	 */
16117b495c44SVANHULLEBUS Yvan 	tag = m_tag_get(PACKET_TAG_IPSEC_NAT_T_PORTS,
16127b495c44SVANHULLEBUS Yvan 		2 * sizeof(uint16_t), M_NOWAIT);
16137b495c44SVANHULLEBUS Yvan 	if (tag == NULL) {
16146794f460SAndrey V. Elsukov 		IPSECSTAT_INC(ips_in_nomem);
16157b495c44SVANHULLEBUS Yvan 		m_freem(m);
16167b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Discard. */
16177b495c44SVANHULLEBUS Yvan 	}
16187b495c44SVANHULLEBUS Yvan 	iphlen = off - sizeof(struct udphdr);
16197b495c44SVANHULLEBUS Yvan 	udphdr = (struct udphdr *)(data + iphlen);
16207b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[0] = udphdr->uh_sport;
16217b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[1] = udphdr->uh_dport;
16227b495c44SVANHULLEBUS Yvan 	m_tag_prepend(m, tag);
16237b495c44SVANHULLEBUS Yvan 
16247b495c44SVANHULLEBUS Yvan 	/*
16257b495c44SVANHULLEBUS Yvan 	 * Remove the UDP header (and possibly the non ESP marker)
16267b495c44SVANHULLEBUS Yvan 	 * IP header length is iphlen
16277b495c44SVANHULLEBUS Yvan 	 * Before:
16287b495c44SVANHULLEBUS Yvan 	 *   <--- off --->
16297b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
16307b495c44SVANHULLEBUS Yvan 	 *   | IP |  UDP | ESP |
16317b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
16327b495c44SVANHULLEBUS Yvan 	 *        <-skip->
16337b495c44SVANHULLEBUS Yvan 	 * After:
16347b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
16357b495c44SVANHULLEBUS Yvan 	 *          | IP | ESP |
16367b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
16377b495c44SVANHULLEBUS Yvan 	 *   <-skip->
16387b495c44SVANHULLEBUS Yvan 	 */
16397b495c44SVANHULLEBUS Yvan 	ovbcopy(data, data + skip, iphlen);
16407b495c44SVANHULLEBUS Yvan 	m_adj(m, skip);
16417b495c44SVANHULLEBUS Yvan 
16427b495c44SVANHULLEBUS Yvan 	ip = mtod(m, struct ip *);
16438f134647SGleb Smirnoff 	ip->ip_len = htons(ntohs(ip->ip_len) - skip);
16447b495c44SVANHULLEBUS Yvan 	ip->ip_p = IPPROTO_ESP;
16457b495c44SVANHULLEBUS Yvan 
16467b495c44SVANHULLEBUS Yvan 	/*
16477b495c44SVANHULLEBUS Yvan 	 * We cannot yet update the cksums so clear any
16487b495c44SVANHULLEBUS Yvan 	 * h/w cksum flags as they are no longer valid.
16497b495c44SVANHULLEBUS Yvan 	 */
16507b495c44SVANHULLEBUS Yvan 	if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID)
16517b495c44SVANHULLEBUS Yvan 		m->m_pkthdr.csum_flags &= ~(CSUM_DATA_VALID|CSUM_PSEUDO_HDR);
16527b495c44SVANHULLEBUS Yvan 
16537b495c44SVANHULLEBUS Yvan 	(void) ipsec4_common_input(m, iphlen, ip->ip_p);
16547b495c44SVANHULLEBUS Yvan 	return (NULL);			/* NB: consumed, bypass processing. */
16557b495c44SVANHULLEBUS Yvan }
16567b495c44SVANHULLEBUS Yvan #endif /* defined(IPSEC) && defined(IPSEC_NAT_T) */
16577b495c44SVANHULLEBUS Yvan 
1658ac45e92fSRobert Watson static void
1659d0390e05SGarrett Wollman udp_abort(struct socket *so)
1660df8bae1dSRodney W. Grimes {
1661d0390e05SGarrett Wollman 	struct inpcb *inp;
1662e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1663df8bae1dSRodney W. Grimes 
1664e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1665d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
166614ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_abort: inp == NULL"));
16678501a69cSRobert Watson 	INP_WLOCK(inp);
1668a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1669e06e816fSKevin Lo 		INP_HASH_WLOCK(pcbinfo);
1670a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1671a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1672e06e816fSKevin Lo 		INP_HASH_WUNLOCK(pcbinfo);
1673d0390e05SGarrett Wollman 		soisdisconnected(so);
1674a152f8a3SRobert Watson 	}
16758501a69cSRobert Watson 	INP_WUNLOCK(inp);
1676df8bae1dSRodney W. Grimes }
1677df8bae1dSRodney W. Grimes 
1678d0390e05SGarrett Wollman static int
1679b40ce416SJulian Elischer udp_attach(struct socket *so, int proto, struct thread *td)
1680d0390e05SGarrett Wollman {
1681d0390e05SGarrett Wollman 	struct inpcb *inp;
1682e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1683277afaffSRobert Watson 	int error;
1684d0390e05SGarrett Wollman 
1685e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1686d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
168714ba8addSRobert Watson 	KASSERT(inp == NULL, ("udp_attach: inp != NULL"));
1688cfa1ca9dSYoshinobu Inoue 	error = soreserve(so, udp_sendspace, udp_recvspace);
1689f24618aaSRobert Watson 	if (error)
16903329b236SRobert Watson 		return (error);
1691e06e816fSKevin Lo 	INP_INFO_WLOCK(pcbinfo);
1692e06e816fSKevin Lo 	error = in_pcballoc(so, pcbinfo);
169353b57cd1SSam Leffler 	if (error) {
1694e06e816fSKevin Lo 		INP_INFO_WUNLOCK(pcbinfo);
16953329b236SRobert Watson 		return (error);
169653b57cd1SSam Leffler 	}
1697cfa1ca9dSYoshinobu Inoue 
169868b5629bSRobert Watson 	inp = sotoinpcb(so);
1699cfa1ca9dSYoshinobu Inoue 	inp->inp_vflag |= INP_IPV4;
1700603724d3SBjoern A. Zeeb 	inp->inp_ip_ttl = V_ip_defttl;
17016a9148feSBjoern A. Zeeb 
17026a9148feSBjoern A. Zeeb 	error = udp_newudpcb(inp);
17036a9148feSBjoern A. Zeeb 	if (error) {
17046a9148feSBjoern A. Zeeb 		in_pcbdetach(inp);
17056a9148feSBjoern A. Zeeb 		in_pcbfree(inp);
1706e06e816fSKevin Lo 		INP_INFO_WUNLOCK(pcbinfo);
17076a9148feSBjoern A. Zeeb 		return (error);
17086a9148feSBjoern A. Zeeb 	}
17096a9148feSBjoern A. Zeeb 
1710c7c7ea4bSRandall Stewart 	INP_WUNLOCK(inp);
1711e06e816fSKevin Lo 	INP_INFO_WUNLOCK(pcbinfo);
1712c7c7ea4bSRandall Stewart 	return (0);
1713c7c7ea4bSRandall Stewart }
171479288c11SBjoern A. Zeeb #endif /* INET */
1715c7c7ea4bSRandall Stewart 
1716c7c7ea4bSRandall Stewart int
171781d3ec17SBryan Venteicher udp_set_kernel_tunneling(struct socket *so, udp_tun_func_t f, void *ctx)
1718c7c7ea4bSRandall Stewart {
1719c7c7ea4bSRandall Stewart 	struct inpcb *inp;
17206a9148feSBjoern A. Zeeb 	struct udpcb *up;
1721c7c7ea4bSRandall Stewart 
172268b5629bSRobert Watson 	KASSERT(so->so_type == SOCK_DGRAM,
172368b5629bSRobert Watson 	    ("udp_set_kernel_tunneling: !dgram"));
172468b5629bSRobert Watson 	inp = sotoinpcb(so);
172568b5629bSRobert Watson 	KASSERT(inp != NULL, ("udp_set_kernel_tunneling: inp == NULL"));
1726c7c7ea4bSRandall Stewart 	INP_WLOCK(inp);
17276a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
17286a9148feSBjoern A. Zeeb 	if (up->u_tun_func != NULL) {
1729bbb0e3d9SRandall Stewart 		INP_WUNLOCK(inp);
1730bbb0e3d9SRandall Stewart 		return (EBUSY);
1731bbb0e3d9SRandall Stewart 	}
17326a9148feSBjoern A. Zeeb 	up->u_tun_func = f;
173381d3ec17SBryan Venteicher 	up->u_tun_ctx = ctx;
17348501a69cSRobert Watson 	INP_WUNLOCK(inp);
17353329b236SRobert Watson 	return (0);
1736df8bae1dSRodney W. Grimes }
1737d0390e05SGarrett Wollman 
173879288c11SBjoern A. Zeeb #ifdef INET
1739d0390e05SGarrett Wollman static int
1740b40ce416SJulian Elischer udp_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
1741d0390e05SGarrett Wollman {
1742d0390e05SGarrett Wollman 	struct inpcb *inp;
1743e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1744277afaffSRobert Watson 	int error;
1745d0390e05SGarrett Wollman 
1746e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1747d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
174814ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_bind: inp == NULL"));
17498501a69cSRobert Watson 	INP_WLOCK(inp);
1750e06e816fSKevin Lo 	INP_HASH_WLOCK(pcbinfo);
1751b0330ed9SPawel Jakub Dawidek 	error = in_pcbbind(inp, nam, td->td_ucred);
1752e06e816fSKevin Lo 	INP_HASH_WUNLOCK(pcbinfo);
17538501a69cSRobert Watson 	INP_WUNLOCK(inp);
17543329b236SRobert Watson 	return (error);
1755d0390e05SGarrett Wollman }
1756d0390e05SGarrett Wollman 
1757a152f8a3SRobert Watson static void
1758a152f8a3SRobert Watson udp_close(struct socket *so)
1759a152f8a3SRobert Watson {
1760a152f8a3SRobert Watson 	struct inpcb *inp;
1761e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1762a152f8a3SRobert Watson 
1763e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1764a152f8a3SRobert Watson 	inp = sotoinpcb(so);
1765a152f8a3SRobert Watson 	KASSERT(inp != NULL, ("udp_close: inp == NULL"));
17668501a69cSRobert Watson 	INP_WLOCK(inp);
1767a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1768e06e816fSKevin Lo 		INP_HASH_WLOCK(pcbinfo);
1769a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1770a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1771e06e816fSKevin Lo 		INP_HASH_WUNLOCK(pcbinfo);
1772a152f8a3SRobert Watson 		soisdisconnected(so);
1773a152f8a3SRobert Watson 	}
17748501a69cSRobert Watson 	INP_WUNLOCK(inp);
1775a152f8a3SRobert Watson }
1776a152f8a3SRobert Watson 
1777d0390e05SGarrett Wollman static int
1778b40ce416SJulian Elischer udp_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
1779d0390e05SGarrett Wollman {
1780d0390e05SGarrett Wollman 	struct inpcb *inp;
1781e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
178275c13541SPoul-Henning Kamp 	struct sockaddr_in *sin;
1783e06e816fSKevin Lo 	int error;
1784d0390e05SGarrett Wollman 
1785e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1786d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
178714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_connect: inp == NULL"));
17888501a69cSRobert Watson 	INP_WLOCK(inp);
1789f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
17908501a69cSRobert Watson 		INP_WUNLOCK(inp);
17913329b236SRobert Watson 		return (EISCONN);
1792f76fcf6dSJeffrey Hsu 	}
179375c13541SPoul-Henning Kamp 	sin = (struct sockaddr_in *)nam;
1794b89e82ddSJamie Gritton 	error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1795b89e82ddSJamie Gritton 	if (error != 0) {
1796413628a7SBjoern A. Zeeb 		INP_WUNLOCK(inp);
1797b89e82ddSJamie Gritton 		return (error);
1798413628a7SBjoern A. Zeeb 	}
1799e06e816fSKevin Lo 	INP_HASH_WLOCK(pcbinfo);
1800b0330ed9SPawel Jakub Dawidek 	error = in_pcbconnect(inp, nam, td->td_ucred);
1801e06e816fSKevin Lo 	INP_HASH_WUNLOCK(pcbinfo);
18024cc20ab1SSeigo Tanimura 	if (error == 0)
1803df8bae1dSRodney W. Grimes 		soisconnected(so);
18048501a69cSRobert Watson 	INP_WUNLOCK(inp);
18053329b236SRobert Watson 	return (error);
1806df8bae1dSRodney W. Grimes }
1807d0390e05SGarrett Wollman 
1808bc725eafSRobert Watson static void
1809d0390e05SGarrett Wollman udp_detach(struct socket *so)
1810d0390e05SGarrett Wollman {
1811d0390e05SGarrett Wollman 	struct inpcb *inp;
1812e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
18136a9148feSBjoern A. Zeeb 	struct udpcb *up;
1814d0390e05SGarrett Wollman 
1815e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1816d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
181714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_detach: inp == NULL"));
1818a152f8a3SRobert Watson 	KASSERT(inp->inp_faddr.s_addr == INADDR_ANY,
1819a152f8a3SRobert Watson 	    ("udp_detach: not disconnected"));
1820e06e816fSKevin Lo 	INP_INFO_WLOCK(pcbinfo);
18218501a69cSRobert Watson 	INP_WLOCK(inp);
18226a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
18236a9148feSBjoern A. Zeeb 	KASSERT(up != NULL, ("%s: up == NULL", __func__));
18246a9148feSBjoern A. Zeeb 	inp->inp_ppcb = NULL;
1825d0390e05SGarrett Wollman 	in_pcbdetach(inp);
182614ba8addSRobert Watson 	in_pcbfree(inp);
1827e06e816fSKevin Lo 	INP_INFO_WUNLOCK(pcbinfo);
18286a9148feSBjoern A. Zeeb 	udp_discardcb(up);
1829d0390e05SGarrett Wollman }
1830d0390e05SGarrett Wollman 
1831d0390e05SGarrett Wollman static int
1832d0390e05SGarrett Wollman udp_disconnect(struct socket *so)
1833d0390e05SGarrett Wollman {
1834d0390e05SGarrett Wollman 	struct inpcb *inp;
1835e06e816fSKevin Lo 	struct inpcbinfo *pcbinfo;
1836d0390e05SGarrett Wollman 
1837e06e816fSKevin Lo 	pcbinfo = get_inpcbinfo(so->so_proto->pr_protocol);
1838d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
183914ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_disconnect: inp == NULL"));
18408501a69cSRobert Watson 	INP_WLOCK(inp);
1841f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr == INADDR_ANY) {
18428501a69cSRobert Watson 		INP_WUNLOCK(inp);
18433329b236SRobert Watson 		return (ENOTCONN);
1844f76fcf6dSJeffrey Hsu 	}
1845e06e816fSKevin Lo 	INP_HASH_WLOCK(pcbinfo);
1846df8bae1dSRodney W. Grimes 	in_pcbdisconnect(inp);
1847df8bae1dSRodney W. Grimes 	inp->inp_laddr.s_addr = INADDR_ANY;
1848e06e816fSKevin Lo 	INP_HASH_WUNLOCK(pcbinfo);
1849d45e4f99SMaxim Konovalov 	SOCK_LOCK(so);
1850d45e4f99SMaxim Konovalov 	so->so_state &= ~SS_ISCONNECTED;		/* XXX */
1851d45e4f99SMaxim Konovalov 	SOCK_UNLOCK(so);
18528501a69cSRobert Watson 	INP_WUNLOCK(inp);
18533329b236SRobert Watson 	return (0);
1854df8bae1dSRodney W. Grimes }
1855df8bae1dSRodney W. Grimes 
1856d0390e05SGarrett Wollman static int
185757bf258eSGarrett Wollman udp_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
1858b40ce416SJulian Elischer     struct mbuf *control, struct thread *td)
1859d0390e05SGarrett Wollman {
1860d0390e05SGarrett Wollman 	struct inpcb *inp;
1861d0390e05SGarrett Wollman 
1862d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
186314ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_send: inp == NULL"));
18643329b236SRobert Watson 	return (udp_output(inp, m, addr, control, td));
1865d0390e05SGarrett Wollman }
186679288c11SBjoern A. Zeeb #endif /* INET */
1867d0390e05SGarrett Wollman 
186876429de4SYoshinobu Inoue int
1869d0390e05SGarrett Wollman udp_shutdown(struct socket *so)
1870d0390e05SGarrett Wollman {
1871d0390e05SGarrett Wollman 	struct inpcb *inp;
1872d0390e05SGarrett Wollman 
1873d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
187414ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_shutdown: inp == NULL"));
18758501a69cSRobert Watson 	INP_WLOCK(inp);
1876d0390e05SGarrett Wollman 	socantsendmore(so);
18778501a69cSRobert Watson 	INP_WUNLOCK(inp);
18783329b236SRobert Watson 	return (0);
1879d0390e05SGarrett Wollman }
1880d0390e05SGarrett Wollman 
188179288c11SBjoern A. Zeeb #ifdef INET
1882d0390e05SGarrett Wollman struct pr_usrreqs udp_usrreqs = {
1883756d52a1SPoul-Henning Kamp 	.pru_abort =		udp_abort,
1884756d52a1SPoul-Henning Kamp 	.pru_attach =		udp_attach,
1885756d52a1SPoul-Henning Kamp 	.pru_bind =		udp_bind,
1886756d52a1SPoul-Henning Kamp 	.pru_connect =		udp_connect,
1887756d52a1SPoul-Henning Kamp 	.pru_control =		in_control,
1888756d52a1SPoul-Henning Kamp 	.pru_detach =		udp_detach,
1889756d52a1SPoul-Henning Kamp 	.pru_disconnect =	udp_disconnect,
189054d642bbSRobert Watson 	.pru_peeraddr =		in_getpeeraddr,
1891756d52a1SPoul-Henning Kamp 	.pru_send =		udp_send,
18925df3e839SRobert Watson 	.pru_soreceive =	soreceive_dgram,
189359b8854eSRobert Watson 	.pru_sosend =		sosend_dgram,
1894756d52a1SPoul-Henning Kamp 	.pru_shutdown =		udp_shutdown,
189554d642bbSRobert Watson 	.pru_sockaddr =		in_getsockaddr,
1896a152f8a3SRobert Watson 	.pru_sosetlabel =	in_pcbsosetlabel,
1897a152f8a3SRobert Watson 	.pru_close =		udp_close,
1898d0390e05SGarrett Wollman };
189979288c11SBjoern A. Zeeb #endif /* INET */
1900