xref: /freebsd/sys/netinet/udp_usrreq.c (revision 0cfdff24d2233737e08da656cafe02798a6aece4)
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.
63329b236SRobert Watson  * All rights reserved.
7df8bae1dSRodney W. Grimes  *
8fa046d87SRobert Watson  * Portions of this software were developed by Robert N. M. Watson under
9fa046d87SRobert Watson  * contract to Juniper Networks, Inc.
10fa046d87SRobert Watson  *
11df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
12df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
13df8bae1dSRodney W. Grimes  * are met:
14df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
15df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
16df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
17df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
18df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
19df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
20df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
21df8bae1dSRodney W. Grimes  *    without specific prior written permission.
22df8bae1dSRodney W. Grimes  *
23df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
34df8bae1dSRodney W. Grimes  *
356dfab5b1SGarrett Wollman  *	@(#)udp_usrreq.c	8.6 (Berkeley) 5/23/95
36df8bae1dSRodney W. Grimes  */
37df8bae1dSRodney W. Grimes 
384b421e2dSMike Silbersack #include <sys/cdefs.h>
394b421e2dSMike Silbersack __FBSDID("$FreeBSD$");
404b421e2dSMike Silbersack 
410b4ae859SGleb Smirnoff #include "opt_ipfw.h"
4279288c11SBjoern A. Zeeb #include "opt_inet.h"
43cfa1ca9dSYoshinobu Inoue #include "opt_inet6.h"
44f5514f08SRobert Watson #include "opt_ipsec.h"
45cfa1ca9dSYoshinobu Inoue 
46df8bae1dSRodney W. Grimes #include <sys/param.h>
47960ed29cSSeigo Tanimura #include <sys/domain.h>
484f590175SPaul Saab #include <sys/eventhandler.h>
49960ed29cSSeigo Tanimura #include <sys/jail.h>
50b110a8a2SGarrett Wollman #include <sys/kernel.h>
51960ed29cSSeigo Tanimura #include <sys/lock.h>
52df8bae1dSRodney W. Grimes #include <sys/malloc.h>
53df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
54acd3428bSRobert Watson #include <sys/priv.h>
55490d50b6SBrian Feldman #include <sys/proc.h>
56df8bae1dSRodney W. Grimes #include <sys/protosw.h>
57960ed29cSSeigo Tanimura #include <sys/signalvar.h>
58df8bae1dSRodney W. Grimes #include <sys/socket.h>
59df8bae1dSRodney W. Grimes #include <sys/socketvar.h>
60960ed29cSSeigo Tanimura #include <sys/sx.h>
61b5e8ce9fSBruce Evans #include <sys/sysctl.h>
62816a3d83SPoul-Henning Kamp #include <sys/syslog.h>
63f5514f08SRobert Watson #include <sys/systm.h>
648781d8e9SBruce Evans 
6569c2d429SJeff Roberson #include <vm/uma.h>
66df8bae1dSRodney W. Grimes 
67df8bae1dSRodney W. Grimes #include <net/if.h>
68df8bae1dSRodney W. Grimes #include <net/route.h>
69df8bae1dSRodney W. Grimes 
70df8bae1dSRodney W. Grimes #include <netinet/in.h>
71960ed29cSSeigo Tanimura #include <netinet/in_pcb.h>
72f5514f08SRobert Watson #include <netinet/in_systm.h>
73960ed29cSSeigo Tanimura #include <netinet/in_var.h>
74df8bae1dSRodney W. Grimes #include <netinet/ip.h>
75cfa1ca9dSYoshinobu Inoue #ifdef INET6
76cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h>
77cfa1ca9dSYoshinobu Inoue #endif
78960ed29cSSeigo Tanimura #include <netinet/ip_icmp.h>
79960ed29cSSeigo Tanimura #include <netinet/icmp_var.h>
80df8bae1dSRodney W. Grimes #include <netinet/ip_var.h>
81ef39adf0SAndre Oppermann #include <netinet/ip_options.h>
82cfa1ca9dSYoshinobu Inoue #ifdef INET6
83cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h>
84cfa1ca9dSYoshinobu Inoue #endif
85df8bae1dSRodney W. Grimes #include <netinet/udp.h>
86df8bae1dSRodney W. Grimes #include <netinet/udp_var.h>
87df8bae1dSRodney W. Grimes 
88b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
89b9234fafSSam Leffler #include <netipsec/ipsec.h>
907b495c44SVANHULLEBUS Yvan #include <netipsec/esp.h>
913329b236SRobert Watson #endif
92b9234fafSSam Leffler 
93db4f9cc7SJonathan Lemon #include <machine/in_cksum.h>
94db4f9cc7SJonathan Lemon 
95aed55708SRobert Watson #include <security/mac/mac_framework.h>
96aed55708SRobert Watson 
97df8bae1dSRodney W. Grimes /*
98df8bae1dSRodney W. Grimes  * UDP protocol implementation.
99df8bae1dSRodney W. Grimes  * Per RFC 768, August, 1980.
100df8bae1dSRodney W. Grimes  */
10174eb3236SWarner Losh 
10274eb3236SWarner Losh /*
1033329b236SRobert Watson  * BSD 4.2 defaulted the udp checksum to be off.  Turning off udp checksums
1043329b236SRobert Watson  * removes the only data integrity mechanism for packets and malformed
105f5514f08SRobert Watson  * packets that would otherwise be discarded due to bad checksums, and may
106f5514f08SRobert Watson  * cause problems (especially for NFS data blocks).
10774eb3236SWarner Losh  */
10840b676beSBjoern A. Zeeb VNET_DEFINE(int, udp_cksum) = 1;
10940b676beSBjoern A. Zeeb SYSCTL_VNET_INT(_net_inet_udp, UDPCTL_CHECKSUM, checksum, CTLFLAG_RW,
11040b676beSBjoern A. Zeeb     &VNET_NAME(udp_cksum), 0, "compute udp checksum");
111df8bae1dSRodney W. Grimes 
112afdb4274SRobert Watson int	udp_log_in_vain = 0;
113816a3d83SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, OID_AUTO, log_in_vain, CTLFLAG_RW,
114afdb4274SRobert Watson     &udp_log_in_vain, 0, "Log all incoming UDP packets");
115816a3d83SPoul-Henning Kamp 
11682cea7e6SBjoern A. Zeeb VNET_DEFINE(int, udp_blackhole) = 0;
117eddfbb76SRobert Watson SYSCTL_VNET_INT(_net_inet_udp, OID_AUTO, blackhole, CTLFLAG_RW,
118eddfbb76SRobert Watson     &VNET_NAME(udp_blackhole), 0,
1193329b236SRobert Watson     "Do not send port unreachables for refused connects");
12016f7f31fSGeoff Rehmet 
12143bbb6aaSRobert Watson u_long	udp_sendspace = 9216;		/* really max datagram size */
12243bbb6aaSRobert Watson 					/* 40 1K datagrams */
12343bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_MAXDGRAM, maxdgram, CTLFLAG_RW,
12443bbb6aaSRobert Watson     &udp_sendspace, 0, "Maximum outgoing UDP datagram size");
12543bbb6aaSRobert Watson 
12643bbb6aaSRobert Watson u_long	udp_recvspace = 40 * (1024 +
12743bbb6aaSRobert Watson #ifdef INET6
12843bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in6)
12943bbb6aaSRobert Watson #else
13043bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in)
13143bbb6aaSRobert Watson #endif
13243bbb6aaSRobert Watson 				      );
13343bbb6aaSRobert Watson 
13443bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_RECVSPACE, recvspace, CTLFLAG_RW,
13543bbb6aaSRobert Watson     &udp_recvspace, 0, "Maximum space for incoming UDP datagrams");
13643bbb6aaSRobert Watson 
137eddfbb76SRobert Watson VNET_DEFINE(struct inpcbhead, udb);		/* from udp_var.h */
138eddfbb76SRobert Watson VNET_DEFINE(struct inpcbinfo, udbinfo);
1393e288e62SDimitry Andric static VNET_DEFINE(uma_zone_t, udpcb_zone);
1401e77c105SRobert Watson #define	V_udpcb_zone			VNET(udpcb_zone)
14115bd2b43SDavid Greenman 
14215bd2b43SDavid Greenman #ifndef UDBHASHSIZE
143e2ed8f35SAlexander Motin #define	UDBHASHSIZE	128
14415bd2b43SDavid Greenman #endif
14515bd2b43SDavid Greenman 
14682cea7e6SBjoern A. Zeeb VNET_DEFINE(struct udpstat, udpstat);		/* from udp_var.h */
147eddfbb76SRobert Watson SYSCTL_VNET_STRUCT(_net_inet_udp, UDPCTL_STATS, stats, CTLFLAG_RW,
148eddfbb76SRobert Watson     &VNET_NAME(udpstat), udpstat,
1498b615593SMarko Zec     "UDP statistics (struct udpstat, netinet/udp_var.h)");
150f2ea20e6SGarrett Wollman 
15179288c11SBjoern A. Zeeb #ifdef INET
152bc725eafSRobert Watson static void	udp_detach(struct socket *so);
1534d77a549SAlfred Perlstein static int	udp_output(struct inpcb *, struct mbuf *, struct sockaddr *,
1544d77a549SAlfred Perlstein 		    struct mbuf *, struct thread *);
15579288c11SBjoern A. Zeeb #endif
15679288c11SBjoern A. Zeeb 
1577b495c44SVANHULLEBUS Yvan #ifdef IPSEC
1587b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
1597b495c44SVANHULLEBUS Yvan #define	UF_ESPINUDP_ALL	(UF_ESPINUDP_NON_IKE|UF_ESPINUDP)
1607b495c44SVANHULLEBUS Yvan #ifdef INET
1617b495c44SVANHULLEBUS Yvan static struct mbuf *udp4_espdecap(struct inpcb *, struct mbuf *, int);
1627b495c44SVANHULLEBUS Yvan #endif
1637b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
1647b495c44SVANHULLEBUS Yvan #endif /* IPSEC */
165df8bae1dSRodney W. Grimes 
1664f590175SPaul Saab static void
1674f590175SPaul Saab udp_zone_change(void *tag)
1684f590175SPaul Saab {
1694f590175SPaul Saab 
170603724d3SBjoern A. Zeeb 	uma_zone_set_max(V_udbinfo.ipi_zone, maxsockets);
1716a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
1724f590175SPaul Saab }
1734f590175SPaul Saab 
174d915b280SStephan Uphoff static int
175d915b280SStephan Uphoff udp_inpcb_init(void *mem, int size, int flags)
176d915b280SStephan Uphoff {
177af1ee11dSRobert Watson 	struct inpcb *inp;
17808651e1fSJohn Baldwin 
179af1ee11dSRobert Watson 	inp = mem;
180d915b280SStephan Uphoff 	INP_LOCK_INIT(inp, "inp", "udpinp");
181d915b280SStephan Uphoff 	return (0);
182d915b280SStephan Uphoff }
183d915b280SStephan Uphoff 
184df8bae1dSRodney W. Grimes void
185af1ee11dSRobert Watson udp_init(void)
186df8bae1dSRodney W. Grimes {
187af1ee11dSRobert Watson 
1889bcd427bSRobert Watson 	in_pcbinfo_init(&V_udbinfo, "udp", &V_udb, UDBHASHSIZE, UDBHASHSIZE,
18952cd27cbSRobert Watson 	    "udp_inpcb", udp_inpcb_init, NULL, UMA_ZONE_NOFREE,
19052cd27cbSRobert Watson 	    IPI_HASHFIELDS_2TUPLE);
1916a9148feSBjoern A. Zeeb 	V_udpcb_zone = uma_zcreate("udpcb", sizeof(struct udpcb),
1926a9148feSBjoern A. Zeeb 	    NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, UMA_ZONE_NOFREE);
1936a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
1944f590175SPaul Saab 	EVENTHANDLER_REGISTER(maxsockets_change, udp_zone_change, NULL,
1954f590175SPaul Saab 	    EVENTHANDLER_PRI_ANY);
196df8bae1dSRodney W. Grimes }
197df8bae1dSRodney W. Grimes 
198315e3e38SRobert Watson /*
199315e3e38SRobert Watson  * Kernel module interface for updating udpstat.  The argument is an index
200315e3e38SRobert Watson  * into udpstat treated as an array of u_long.  While this encodes the
201315e3e38SRobert Watson  * general layout of udpstat into the caller, it doesn't encode its location,
202315e3e38SRobert Watson  * so that future changes to add, for example, per-CPU stats support won't
203315e3e38SRobert Watson  * cause binary compatibility problems for kernel modules.
204315e3e38SRobert Watson  */
205315e3e38SRobert Watson void
206315e3e38SRobert Watson kmod_udpstat_inc(int statnum)
207315e3e38SRobert Watson {
208315e3e38SRobert Watson 
209315e3e38SRobert Watson 	(*((u_long *)&V_udpstat + statnum))++;
210315e3e38SRobert Watson }
211315e3e38SRobert Watson 
2126a9148feSBjoern A. Zeeb int
2136a9148feSBjoern A. Zeeb udp_newudpcb(struct inpcb *inp)
2146a9148feSBjoern A. Zeeb {
2156a9148feSBjoern A. Zeeb 	struct udpcb *up;
2166a9148feSBjoern A. Zeeb 
2176a9148feSBjoern A. Zeeb 	up = uma_zalloc(V_udpcb_zone, M_NOWAIT | M_ZERO);
2186a9148feSBjoern A. Zeeb 	if (up == NULL)
2196a9148feSBjoern A. Zeeb 		return (ENOBUFS);
2206a9148feSBjoern A. Zeeb 	inp->inp_ppcb = up;
2216a9148feSBjoern A. Zeeb 	return (0);
2226a9148feSBjoern A. Zeeb }
2236a9148feSBjoern A. Zeeb 
2246a9148feSBjoern A. Zeeb void
2256a9148feSBjoern A. Zeeb udp_discardcb(struct udpcb *up)
2266a9148feSBjoern A. Zeeb {
2276a9148feSBjoern A. Zeeb 
2286a9148feSBjoern A. Zeeb 	uma_zfree(V_udpcb_zone, up);
2296a9148feSBjoern A. Zeeb }
2306a9148feSBjoern A. Zeeb 
231bc29160dSMarko Zec #ifdef VIMAGE
232bc29160dSMarko Zec void
233bc29160dSMarko Zec udp_destroy(void)
234bc29160dSMarko Zec {
235bc29160dSMarko Zec 
2369bcd427bSRobert Watson 	in_pcbinfo_destroy(&V_udbinfo);
237391dab1cSBjoern A. Zeeb 	uma_zdestroy(V_udpcb_zone);
238bc29160dSMarko Zec }
239bc29160dSMarko Zec #endif
240bc29160dSMarko Zec 
24179288c11SBjoern A. Zeeb #ifdef INET
24243bbb6aaSRobert Watson /*
24343bbb6aaSRobert Watson  * Subroutine of udp_input(), which appends the provided mbuf chain to the
24443bbb6aaSRobert Watson  * passed pcb/socket.  The caller must provide a sockaddr_in via udp_in that
24543bbb6aaSRobert Watson  * contains the source address.  If the socket ends up being an IPv6 socket,
24643bbb6aaSRobert Watson  * udp_append() will convert to a sockaddr_in6 before passing the address
24743bbb6aaSRobert Watson  * into the socket code.
24843bbb6aaSRobert Watson  */
24943bbb6aaSRobert Watson static void
25043bbb6aaSRobert Watson udp_append(struct inpcb *inp, struct ip *ip, struct mbuf *n, int off,
25143bbb6aaSRobert Watson     struct sockaddr_in *udp_in)
25243bbb6aaSRobert Watson {
25343bbb6aaSRobert Watson 	struct sockaddr *append_sa;
25443bbb6aaSRobert Watson 	struct socket *so;
25543bbb6aaSRobert Watson 	struct mbuf *opts = 0;
25643bbb6aaSRobert Watson #ifdef INET6
25743bbb6aaSRobert Watson 	struct sockaddr_in6 udp_in6;
25843bbb6aaSRobert Watson #endif
2597b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
26043bbb6aaSRobert Watson 
261fa046d87SRobert Watson 	INP_LOCK_ASSERT(inp);
26243bbb6aaSRobert Watson 
26379bb84fbSEdward Tomasz Napierala 	/*
26479bb84fbSEdward Tomasz Napierala 	 * Engage the tunneling protocol.
26579bb84fbSEdward Tomasz Napierala 	 */
26679bb84fbSEdward Tomasz Napierala 	up = intoudpcb(inp);
26779bb84fbSEdward Tomasz Napierala 	if (up->u_tun_func != NULL) {
26879bb84fbSEdward Tomasz Napierala 		(*up->u_tun_func)(n, off, inp);
26979bb84fbSEdward Tomasz Napierala 		return;
27079bb84fbSEdward Tomasz Napierala 	}
27179bb84fbSEdward Tomasz Napierala 
27279bb84fbSEdward Tomasz Napierala 	if (n == NULL)
27379bb84fbSEdward Tomasz Napierala 		return;
27479bb84fbSEdward Tomasz Napierala 
27579bb84fbSEdward Tomasz Napierala 	off += sizeof(struct udphdr);
27679bb84fbSEdward Tomasz Napierala 
27743bbb6aaSRobert Watson #ifdef IPSEC
27843bbb6aaSRobert Watson 	/* Check AH/ESP integrity. */
27943bbb6aaSRobert Watson 	if (ipsec4_in_reject(n, inp)) {
28043bbb6aaSRobert Watson 		m_freem(n);
281603724d3SBjoern A. Zeeb 		V_ipsec4stat.in_polvio++;
28243bbb6aaSRobert Watson 		return;
28343bbb6aaSRobert Watson 	}
2847b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
2857b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
2867b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
2877b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_ALL) {	/* IPSec UDP encaps. */
2887b495c44SVANHULLEBUS Yvan 		n = udp4_espdecap(inp, n, off);
2897b495c44SVANHULLEBUS Yvan 		if (n == NULL)				/* Consumed. */
2907b495c44SVANHULLEBUS Yvan 			return;
2917b495c44SVANHULLEBUS Yvan 	}
2927b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
29343bbb6aaSRobert Watson #endif /* IPSEC */
29443bbb6aaSRobert Watson #ifdef MAC
29530d239bcSRobert Watson 	if (mac_inpcb_check_deliver(inp, n) != 0) {
29643bbb6aaSRobert Watson 		m_freem(n);
29743bbb6aaSRobert Watson 		return;
29843bbb6aaSRobert Watson 	}
29979288c11SBjoern A. Zeeb #endif /* MAC */
30043bbb6aaSRobert Watson 	if (inp->inp_flags & INP_CONTROLOPTS ||
30143bbb6aaSRobert Watson 	    inp->inp_socket->so_options & (SO_TIMESTAMP | SO_BINTIME)) {
30243bbb6aaSRobert Watson #ifdef INET6
3039a38ba81SBjoern A. Zeeb 		if (inp->inp_vflag & INP_IPV6)
30448d48eb9SBjoern A. Zeeb 			(void)ip6_savecontrol_v4(inp, n, &opts, NULL);
3059a38ba81SBjoern A. Zeeb 		else
30679288c11SBjoern A. Zeeb #endif /* INET6 */
30743bbb6aaSRobert Watson 			ip_savecontrol(inp, &opts, ip, n);
30843bbb6aaSRobert Watson 	}
30943bbb6aaSRobert Watson #ifdef INET6
31043bbb6aaSRobert Watson 	if (inp->inp_vflag & INP_IPV6) {
31143bbb6aaSRobert Watson 		bzero(&udp_in6, sizeof(udp_in6));
31243bbb6aaSRobert Watson 		udp_in6.sin6_len = sizeof(udp_in6);
31343bbb6aaSRobert Watson 		udp_in6.sin6_family = AF_INET6;
31443bbb6aaSRobert Watson 		in6_sin_2_v4mapsin6(udp_in, &udp_in6);
31543bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)&udp_in6;
31643bbb6aaSRobert Watson 	} else
31779288c11SBjoern A. Zeeb #endif /* INET6 */
31843bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)udp_in;
31943bbb6aaSRobert Watson 	m_adj(n, off);
32043bbb6aaSRobert Watson 
32143bbb6aaSRobert Watson 	so = inp->inp_socket;
32243bbb6aaSRobert Watson 	SOCKBUF_LOCK(&so->so_rcv);
32343bbb6aaSRobert Watson 	if (sbappendaddr_locked(&so->so_rcv, append_sa, n, opts) == 0) {
32443bbb6aaSRobert Watson 		SOCKBUF_UNLOCK(&so->so_rcv);
32543bbb6aaSRobert Watson 		m_freem(n);
32643bbb6aaSRobert Watson 		if (opts)
32743bbb6aaSRobert Watson 			m_freem(opts);
328026decb8SRobert Watson 		UDPSTAT_INC(udps_fullsock);
32943bbb6aaSRobert Watson 	} else
33043bbb6aaSRobert Watson 		sorwakeup_locked(so);
33143bbb6aaSRobert Watson }
33243bbb6aaSRobert Watson 
333df8bae1dSRodney W. Grimes void
3343329b236SRobert Watson udp_input(struct mbuf *m, int off)
335df8bae1dSRodney W. Grimes {
336cfa1ca9dSYoshinobu Inoue 	int iphlen = off;
3373329b236SRobert Watson 	struct ip *ip;
3383329b236SRobert Watson 	struct udphdr *uh;
33971498f30SBruce M Simpson 	struct ifnet *ifp;
3403329b236SRobert Watson 	struct inpcb *inp;
341df8bae1dSRodney W. Grimes 	int len;
342df8bae1dSRodney W. Grimes 	struct ip save_ip;
343d4b509bdSRobert Watson 	struct sockaddr_in udp_in;
3440b4ae859SGleb Smirnoff #ifdef IPFIREWALL_FORWARD
3450b4ae859SGleb Smirnoff 	struct m_tag *fwd_tag;
3460b4ae859SGleb Smirnoff #endif
347df8bae1dSRodney W. Grimes 
34871498f30SBruce M Simpson 	ifp = m->m_pkthdr.rcvif;
349026decb8SRobert Watson 	UDPSTAT_INC(udps_ipackets);
350df8bae1dSRodney W. Grimes 
351df8bae1dSRodney W. Grimes 	/*
3523329b236SRobert Watson 	 * Strip IP options, if any; should skip this, make available to
3533329b236SRobert Watson 	 * user, and use on returned packets, but we don't yet have a way to
3543329b236SRobert Watson 	 * check the checksum with options still present.
355df8bae1dSRodney W. Grimes 	 */
356df8bae1dSRodney W. Grimes 	if (iphlen > sizeof (struct ip)) {
357df8bae1dSRodney W. Grimes 		ip_stripoptions(m, (struct mbuf *)0);
358df8bae1dSRodney W. Grimes 		iphlen = sizeof(struct ip);
359df8bae1dSRodney W. Grimes 	}
360df8bae1dSRodney W. Grimes 
361df8bae1dSRodney W. Grimes 	/*
362df8bae1dSRodney W. Grimes 	 * Get IP and UDP header together in first mbuf.
363df8bae1dSRodney W. Grimes 	 */
364df8bae1dSRodney W. Grimes 	ip = mtod(m, struct ip *);
365df8bae1dSRodney W. Grimes 	if (m->m_len < iphlen + sizeof(struct udphdr)) {
366df8bae1dSRodney W. Grimes 		if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) {
367026decb8SRobert Watson 			UDPSTAT_INC(udps_hdrops);
368df8bae1dSRodney W. Grimes 			return;
369df8bae1dSRodney W. Grimes 		}
370df8bae1dSRodney W. Grimes 		ip = mtod(m, struct ip *);
371df8bae1dSRodney W. Grimes 	}
372df8bae1dSRodney W. Grimes 	uh = (struct udphdr *)((caddr_t)ip + iphlen);
373df8bae1dSRodney W. Grimes 
3743329b236SRobert Watson 	/*
3753329b236SRobert Watson 	 * Destination port of 0 is illegal, based on RFC768.
3763329b236SRobert Watson 	 */
377686cdd19SJun-ichiro itojun Hagino 	if (uh->uh_dport == 0)
378f76fcf6dSJeffrey Hsu 		goto badunlocked;
379686cdd19SJun-ichiro itojun Hagino 
380df8bae1dSRodney W. Grimes 	/*
3813329b236SRobert Watson 	 * Construct sockaddr format source address.  Stuff source address
3823329b236SRobert Watson 	 * and datagram in user buffer.
383b9234fafSSam Leffler 	 */
384d4b509bdSRobert Watson 	bzero(&udp_in, sizeof(udp_in));
385d4b509bdSRobert Watson 	udp_in.sin_len = sizeof(udp_in);
386d4b509bdSRobert Watson 	udp_in.sin_family = AF_INET;
387b9234fafSSam Leffler 	udp_in.sin_port = uh->uh_sport;
388b9234fafSSam Leffler 	udp_in.sin_addr = ip->ip_src;
389b9234fafSSam Leffler 
390b9234fafSSam Leffler 	/*
391af1ee11dSRobert Watson 	 * Make mbuf data length reflect UDP length.  If not enough data to
392af1ee11dSRobert Watson 	 * reflect UDP length, drop.
393df8bae1dSRodney W. Grimes 	 */
394df8bae1dSRodney W. Grimes 	len = ntohs((u_short)uh->uh_ulen);
395df8bae1dSRodney W. Grimes 	if (ip->ip_len != len) {
3967eb7a449SAndras Olah 		if (len > ip->ip_len || len < sizeof(struct udphdr)) {
397026decb8SRobert Watson 			UDPSTAT_INC(udps_badlen);
398f76fcf6dSJeffrey Hsu 			goto badunlocked;
399df8bae1dSRodney W. Grimes 		}
400df8bae1dSRodney W. Grimes 		m_adj(m, len - ip->ip_len);
401df8bae1dSRodney W. Grimes 		/* ip->ip_len = len; */
402df8bae1dSRodney W. Grimes 	}
4033329b236SRobert Watson 
404df8bae1dSRodney W. Grimes 	/*
4053329b236SRobert Watson 	 * Save a copy of the IP header in case we want restore it for
4063329b236SRobert Watson 	 * sending an ICMP error message in response.
407df8bae1dSRodney W. Grimes 	 */
408603724d3SBjoern A. Zeeb 	if (!V_udp_blackhole)
409df8bae1dSRodney W. Grimes 		save_ip = *ip;
410cce418d3SMatt Jacob 	else
411cce418d3SMatt Jacob 		memset(&save_ip, 0, sizeof(save_ip));
412df8bae1dSRodney W. Grimes 
413df8bae1dSRodney W. Grimes 	/*
414df8bae1dSRodney W. Grimes 	 * Checksum extended UDP header and data.
415df8bae1dSRodney W. Grimes 	 */
4166dfab5b1SGarrett Wollman 	if (uh->uh_sum) {
41739629c92SDavid Malone 		u_short uh_sum;
41839629c92SDavid Malone 
419db4f9cc7SJonathan Lemon 		if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID) {
420db4f9cc7SJonathan Lemon 			if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR)
42139629c92SDavid Malone 				uh_sum = m->m_pkthdr.csum_data;
422db4f9cc7SJonathan Lemon 			else
42339629c92SDavid Malone 				uh_sum = in_pseudo(ip->ip_src.s_addr,
424506f4949SRuslan Ermilov 				    ip->ip_dst.s_addr, htonl((u_short)len +
425db4f9cc7SJonathan Lemon 				    m->m_pkthdr.csum_data + IPPROTO_UDP));
42639629c92SDavid Malone 			uh_sum ^= 0xffff;
427db4f9cc7SJonathan Lemon 		} else {
428cb342100SHajimu UMEMOTO 			char b[9];
429af1ee11dSRobert Watson 
430cb342100SHajimu UMEMOTO 			bcopy(((struct ipovly *)ip)->ih_x1, b, 9);
4316effc713SDoug Rabson 			bzero(((struct ipovly *)ip)->ih_x1, 9);
432df8bae1dSRodney W. Grimes 			((struct ipovly *)ip)->ih_len = uh->uh_ulen;
43339629c92SDavid Malone 			uh_sum = in_cksum(m, len + sizeof (struct ip));
434cb342100SHajimu UMEMOTO 			bcopy(b, ((struct ipovly *)ip)->ih_x1, 9);
435db4f9cc7SJonathan Lemon 		}
43639629c92SDavid Malone 		if (uh_sum) {
437026decb8SRobert Watson 			UDPSTAT_INC(udps_badsum);
438df8bae1dSRodney W. Grimes 			m_freem(m);
439df8bae1dSRodney W. Grimes 			return;
440df8bae1dSRodney W. Grimes 		}
441fb9aaba0SRuslan Ermilov 	} else
442026decb8SRobert Watson 		UDPSTAT_INC(udps_nosum);
443df8bae1dSRodney W. Grimes 
444df8bae1dSRodney W. Grimes 	if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) ||
44571498f30SBruce M Simpson 	    in_broadcast(ip->ip_dst, ifp)) {
44682c23ebaSBill Fenner 		struct inpcb *last;
44771498f30SBruce M Simpson 		struct ip_moptions *imo;
4483329b236SRobert Watson 
449fa046d87SRobert Watson 		INP_INFO_RLOCK(&V_udbinfo);
450df8bae1dSRodney W. Grimes 		last = NULL;
451603724d3SBjoern A. Zeeb 		LIST_FOREACH(inp, &V_udb, inp_list) {
4529c1df695SRobert Watson 			if (inp->inp_lport != uh->uh_dport)
453f76fcf6dSJeffrey Hsu 				continue;
454cfa1ca9dSYoshinobu Inoue #ifdef INET6
455369dc8ceSEivind Eklund 			if ((inp->inp_vflag & INP_IPV4) == 0)
4569c1df695SRobert Watson 				continue;
457cfa1ca9dSYoshinobu Inoue #endif
45871498f30SBruce M Simpson 			if (inp->inp_laddr.s_addr != INADDR_ANY &&
45971498f30SBruce M Simpson 			    inp->inp_laddr.s_addr != ip->ip_dst.s_addr)
4609c1df695SRobert Watson 				continue;
46171498f30SBruce M Simpson 			if (inp->inp_faddr.s_addr != INADDR_ANY &&
46271498f30SBruce M Simpson 			    inp->inp_faddr.s_addr != ip->ip_src.s_addr)
46371498f30SBruce M Simpson 				continue;
46471498f30SBruce M Simpson 			if (inp->inp_fport != 0 &&
465df8bae1dSRodney W. Grimes 			    inp->inp_fport != uh->uh_sport)
4669c1df695SRobert Watson 				continue;
46771498f30SBruce M Simpson 
468119d85f6SRobert Watson 			INP_RLOCK(inp);
469df8bae1dSRodney W. Grimes 
47083453a06SBruce M Simpson 			/*
471fa046d87SRobert Watson 			 * XXXRW: Because we weren't holding either the inpcb
472fa046d87SRobert Watson 			 * or the hash lock when we checked for a match
473fa046d87SRobert Watson 			 * before, we should probably recheck now that the
474fa046d87SRobert Watson 			 * inpcb lock is held.
475fa046d87SRobert Watson 			 */
476fa046d87SRobert Watson 
477fa046d87SRobert Watson 			/*
47871498f30SBruce M Simpson 			 * Handle socket delivery policy for any-source
47971498f30SBruce M Simpson 			 * and source-specific multicast. [RFC3678]
48083453a06SBruce M Simpson 			 */
48171498f30SBruce M Simpson 			imo = inp->inp_moptions;
482a38b1c8cSRandall Stewart 			if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr))) {
483d10910e6SBruce M Simpson 				struct sockaddr_in	 group;
484d10910e6SBruce M Simpson 				int			 blocked;
485a38b1c8cSRandall Stewart 				if (imo == NULL) {
486a38b1c8cSRandall Stewart 					INP_RUNLOCK(inp);
487a38b1c8cSRandall Stewart 					continue;
488a38b1c8cSRandall Stewart 				}
489d10910e6SBruce M Simpson 				bzero(&group, sizeof(struct sockaddr_in));
490d10910e6SBruce M Simpson 				group.sin_len = sizeof(struct sockaddr_in);
491d10910e6SBruce M Simpson 				group.sin_family = AF_INET;
492d10910e6SBruce M Simpson 				group.sin_addr = ip->ip_dst;
49371498f30SBruce M Simpson 
494d10910e6SBruce M Simpson 				blocked = imo_multi_filter(imo, ifp,
495d10910e6SBruce M Simpson 					(struct sockaddr *)&group,
49671498f30SBruce M Simpson 					(struct sockaddr *)&udp_in);
497d10910e6SBruce M Simpson 				if (blocked != MCAST_PASS) {
498d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTGMEMBER)
49986425c62SRobert Watson 						IPSTAT_INC(ips_notmember);
500d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTSMEMBER ||
501d10910e6SBruce M Simpson 					    blocked == MCAST_MUTED)
502026decb8SRobert Watson 						UDPSTAT_INC(udps_filtermcast);
503119d85f6SRobert Watson 					INP_RUNLOCK(inp);
5049c1df695SRobert Watson 					continue;
5059c1df695SRobert Watson 				}
50683453a06SBruce M Simpson 			}
507df8bae1dSRodney W. Grimes 			if (last != NULL) {
508df8bae1dSRodney W. Grimes 				struct mbuf *n;
509df8bae1dSRodney W. Grimes 
510032dcc76SLuigi Rizzo 				n = m_copy(m, 0, M_COPYALL);
51179bb84fbSEdward Tomasz Napierala 				udp_append(last, ip, n, iphlen, &udp_in);
5126a9148feSBjoern A. Zeeb 				INP_RUNLOCK(last);
513df8bae1dSRodney W. Grimes 			}
51482c23ebaSBill Fenner 			last = inp;
515df8bae1dSRodney W. Grimes 			/*
516df8bae1dSRodney W. Grimes 			 * Don't look for additional matches if this one does
517df8bae1dSRodney W. Grimes 			 * not have either the SO_REUSEPORT or SO_REUSEADDR
5183329b236SRobert Watson 			 * socket options set.  This heuristic avoids
5193329b236SRobert Watson 			 * searching through all pcbs in the common case of a
5203329b236SRobert Watson 			 * non-shared port.  It assumes that an application
5213329b236SRobert Watson 			 * will never clear these options after setting them.
522df8bae1dSRodney W. Grimes 			 */
5233329b236SRobert Watson 			if ((last->inp_socket->so_options &
5243329b236SRobert Watson 			    (SO_REUSEPORT|SO_REUSEADDR)) == 0)
525df8bae1dSRodney W. Grimes 				break;
526df8bae1dSRodney W. Grimes 		}
527df8bae1dSRodney W. Grimes 
528df8bae1dSRodney W. Grimes 		if (last == NULL) {
529df8bae1dSRodney W. Grimes 			/*
5303329b236SRobert Watson 			 * No matching pcb found; discard datagram.  (No need
5313329b236SRobert Watson 			 * to send an ICMP Port Unreachable for a broadcast
5323329b236SRobert Watson 			 * or multicast datgram.)
533df8bae1dSRodney W. Grimes 			 */
534026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
535fa046d87SRobert Watson 			if (inp)
536fa046d87SRobert Watson 				INP_RUNLOCK(inp);
537fa046d87SRobert Watson 			INP_INFO_RUNLOCK(&V_udbinfo);
538fa046d87SRobert Watson 			goto badunlocked;
539df8bae1dSRodney W. Grimes 		}
54079bb84fbSEdward Tomasz Napierala 		udp_append(last, ip, m, iphlen, &udp_in);
541c7c7ea4bSRandall Stewart 		INP_RUNLOCK(last);
542c7c7ea4bSRandall Stewart 		INP_INFO_RUNLOCK(&V_udbinfo);
543df8bae1dSRodney W. Grimes 		return;
544df8bae1dSRodney W. Grimes 	}
5453329b236SRobert Watson 
546df8bae1dSRodney W. Grimes 	/*
5476d6a026bSDavid Greenman 	 * Locate pcb for datagram.
548df8bae1dSRodney W. Grimes 	 */
5498a006adbSBjoern A. Zeeb #ifdef IPFIREWALL_FORWARD
5508a006adbSBjoern A. Zeeb 	/*
5518a006adbSBjoern A. Zeeb 	 * Grab info from PACKET_TAG_IPFORWARD tag prepended to the chain.
5528a006adbSBjoern A. Zeeb 	 */
5538a006adbSBjoern A. Zeeb 	fwd_tag = m_tag_find(m, PACKET_TAG_IPFORWARD, NULL);
5548a006adbSBjoern A. Zeeb 	if (fwd_tag != NULL) {
5558a006adbSBjoern A. Zeeb 		struct sockaddr_in *next_hop;
5568a006adbSBjoern A. Zeeb 
5578a006adbSBjoern A. Zeeb 		next_hop = (struct sockaddr_in *)(fwd_tag + 1);
5588a006adbSBjoern A. Zeeb 
5598a006adbSBjoern A. Zeeb 		/*
5608a006adbSBjoern A. Zeeb 		 * Transparently forwarded. Pretend to be the destination.
5618a006adbSBjoern A. Zeeb 		 * Already got one like this?
5628a006adbSBjoern A. Zeeb 		 */
563d3c1f003SRobert Watson 		inp = in_pcblookup_mbuf(&V_udbinfo, ip->ip_src, uh->uh_sport,
5648a006adbSBjoern A. Zeeb 		    ip->ip_dst, uh->uh_dport, INPLOOKUP_RLOCKPCB, ifp, m);
5658a006adbSBjoern A. Zeeb 		if (!inp) {
5668a006adbSBjoern A. Zeeb 			/*
5678a006adbSBjoern A. Zeeb 			 * It's new.  Try to find the ambushing socket.
5688a006adbSBjoern A. Zeeb 			 * Because we've rewritten the destination address,
5698a006adbSBjoern A. Zeeb 			 * any hardware-generated hash is ignored.
5708a006adbSBjoern A. Zeeb 			 */
5718a006adbSBjoern A. Zeeb 			inp = in_pcblookup(&V_udbinfo, ip->ip_src,
5728a006adbSBjoern A. Zeeb 			    uh->uh_sport, next_hop->sin_addr,
5738a006adbSBjoern A. Zeeb 			    next_hop->sin_port ? htons(next_hop->sin_port) :
5748a006adbSBjoern A. Zeeb 			    uh->uh_dport, INPLOOKUP_WILDCARD |
5758a006adbSBjoern A. Zeeb 			    INPLOOKUP_RLOCKPCB, ifp);
5768a006adbSBjoern A. Zeeb 		}
5778a006adbSBjoern A. Zeeb 		/* Remove the tag from the packet. We don't need it anymore. */
5788a006adbSBjoern A. Zeeb 		m_tag_delete(m, fwd_tag);
5798a006adbSBjoern A. Zeeb 	} else
5808a006adbSBjoern A. Zeeb #endif /* IPFIREWALL_FORWARD */
5818a006adbSBjoern A. Zeeb 		inp = in_pcblookup_mbuf(&V_udbinfo, ip->ip_src, uh->uh_sport,
5828a006adbSBjoern A. Zeeb 		    ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD |
5838a006adbSBjoern A. Zeeb 		    INPLOOKUP_RLOCKPCB, ifp, m);
58415bd2b43SDavid Greenman 	if (inp == NULL) {
585afdb4274SRobert Watson 		if (udp_log_in_vain) {
586df5c0b8aSBill Fenner 			char buf[4*sizeof "123"];
58775cfc95fSAndrey A. Chernov 
58875cfc95fSAndrey A. Chernov 			strcpy(buf, inet_ntoa(ip->ip_dst));
589592071e8SBruce Evans 			log(LOG_INFO,
590592071e8SBruce Evans 			    "Connection attempt to UDP %s:%d from %s:%d\n",
591592071e8SBruce Evans 			    buf, ntohs(uh->uh_dport), inet_ntoa(ip->ip_src),
592592071e8SBruce Evans 			    ntohs(uh->uh_sport));
59375cfc95fSAndrey A. Chernov 		}
594026decb8SRobert Watson 		UDPSTAT_INC(udps_noport);
595df8bae1dSRodney W. Grimes 		if (m->m_flags & (M_BCAST | M_MCAST)) {
596026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
597fa046d87SRobert Watson 			goto badunlocked;
598df8bae1dSRodney W. Grimes 		}
599603724d3SBjoern A. Zeeb 		if (V_udp_blackhole)
600fa046d87SRobert Watson 			goto badunlocked;
6011cbd978eSLuigi Rizzo 		if (badport_bandlim(BANDLIM_ICMP_UNREACH) < 0)
602fa046d87SRobert Watson 			goto badunlocked;
60304287599SRuslan Ermilov 		*ip = save_ip;
60404287599SRuslan Ermilov 		ip->ip_len += iphlen;
605582a7760SBruce Evans 		icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
606df8bae1dSRodney W. Grimes 		return;
607df8bae1dSRodney W. Grimes 	}
6083329b236SRobert Watson 
6093329b236SRobert Watson 	/*
6103329b236SRobert Watson 	 * Check the minimum TTL for socket.
6113329b236SRobert Watson 	 */
612fa046d87SRobert Watson 	INP_RLOCK_ASSERT(inp);
61310cc62b7SRobert Watson 	if (inp->inp_ip_minttl && inp->inp_ip_minttl > ip->ip_ttl) {
61410cc62b7SRobert Watson 		INP_RUNLOCK(inp);
615fa046d87SRobert Watson 		m_freem(m);
616fa046d87SRobert Watson 		return;
61710cc62b7SRobert Watson 	}
61879bb84fbSEdward Tomasz Napierala 	udp_append(inp, ip, m, iphlen, &udp_in);
619119d85f6SRobert Watson 	INP_RUNLOCK(inp);
620df8bae1dSRodney W. Grimes 	return;
62161ffc0b1SJeffrey Hsu 
622f76fcf6dSJeffrey Hsu badunlocked:
623df8bae1dSRodney W. Grimes 	m_freem(m);
624cfa1ca9dSYoshinobu Inoue }
62579288c11SBjoern A. Zeeb #endif /* INET */
626cfa1ca9dSYoshinobu Inoue 
627cfa1ca9dSYoshinobu Inoue /*
6283329b236SRobert Watson  * Notify a udp user of an asynchronous error; just wake up so that they can
6293329b236SRobert Watson  * collect error status.
630df8bae1dSRodney W. Grimes  */
6313ce144eaSJeffrey Hsu struct inpcb *
6323329b236SRobert Watson udp_notify(struct inpcb *inp, int errno)
633df8bae1dSRodney W. Grimes {
6343329b236SRobert Watson 
635ac9ae279SRobert Watson 	/*
636ac9ae279SRobert Watson 	 * While udp_ctlinput() always calls udp_notify() with a read lock
637ac9ae279SRobert Watson 	 * when invoking it directly, in_pcbnotifyall() currently uses write
638ac9ae279SRobert Watson 	 * locks due to sharing code with TCP.  For now, accept either a read
639ac9ae279SRobert Watson 	 * or a write lock, but a read lock is sufficient.
640ac9ae279SRobert Watson 	 */
641ac9ae279SRobert Watson 	INP_LOCK_ASSERT(inp);
6428501a69cSRobert Watson 
643df8bae1dSRodney W. Grimes 	inp->inp_socket->so_error = errno;
644df8bae1dSRodney W. Grimes 	sorwakeup(inp->inp_socket);
645df8bae1dSRodney W. Grimes 	sowwakeup(inp->inp_socket);
6463329b236SRobert Watson 	return (inp);
647df8bae1dSRodney W. Grimes }
648df8bae1dSRodney W. Grimes 
64979288c11SBjoern A. Zeeb #ifdef INET
650df8bae1dSRodney W. Grimes void
6513329b236SRobert Watson udp_ctlinput(int cmd, struct sockaddr *sa, void *vip)
652df8bae1dSRodney W. Grimes {
653c693a045SJonathan Lemon 	struct ip *ip = vip;
654c693a045SJonathan Lemon 	struct udphdr *uh;
655c693a045SJonathan Lemon 	struct in_addr faddr;
656c693a045SJonathan Lemon 	struct inpcb *inp;
657c693a045SJonathan Lemon 
658c693a045SJonathan Lemon 	faddr = ((struct sockaddr_in *)sa)->sin_addr;
659c693a045SJonathan Lemon 	if (sa->sa_family != AF_INET || faddr.s_addr == INADDR_ANY)
660c693a045SJonathan Lemon 		return;
661df8bae1dSRodney W. Grimes 
66297d8d152SAndre Oppermann 	/*
66397d8d152SAndre Oppermann 	 * Redirects don't need to be handled up here.
66497d8d152SAndre Oppermann 	 */
66597d8d152SAndre Oppermann 	if (PRC_IS_REDIRECT(cmd))
66697d8d152SAndre Oppermann 		return;
6673329b236SRobert Watson 
66897d8d152SAndre Oppermann 	/*
66997d8d152SAndre Oppermann 	 * Hostdead is ugly because it goes linearly through all PCBs.
6703329b236SRobert Watson 	 *
6713329b236SRobert Watson 	 * XXX: We never get this from ICMP, otherwise it makes an excellent
6723329b236SRobert Watson 	 * DoS attack on machines with many connections.
67397d8d152SAndre Oppermann 	 */
67497d8d152SAndre Oppermann 	if (cmd == PRC_HOSTDEAD)
675af1ee11dSRobert Watson 		ip = NULL;
676d1c54148SJesper Skriver 	else if ((unsigned)cmd >= PRC_NCMDS || inetctlerrmap[cmd] == 0)
677df8bae1dSRodney W. Grimes 		return;
678af1ee11dSRobert Watson 	if (ip != NULL) {
679df8bae1dSRodney W. Grimes 		uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2));
680fa046d87SRobert Watson 		inp = in_pcblookup(&V_udbinfo, faddr, uh->uh_dport,
681fa046d87SRobert Watson 		    ip->ip_src, uh->uh_sport, INPLOOKUP_RLOCKPCB, NULL);
682f76fcf6dSJeffrey Hsu 		if (inp != NULL) {
683fa046d87SRobert Watson 			INP_RLOCK_ASSERT(inp);
684f76fcf6dSJeffrey Hsu 			if (inp->inp_socket != NULL) {
685f5514f08SRobert Watson 				udp_notify(inp, inetctlerrmap[cmd]);
686f76fcf6dSJeffrey Hsu 			}
687ac9ae279SRobert Watson 			INP_RUNLOCK(inp);
688f76fcf6dSJeffrey Hsu 		}
689df8bae1dSRodney W. Grimes 	} else
690603724d3SBjoern A. Zeeb 		in_pcbnotifyall(&V_udbinfo, faddr, inetctlerrmap[cmd],
691f5514f08SRobert Watson 		    udp_notify);
692df8bae1dSRodney W. Grimes }
69379288c11SBjoern A. Zeeb #endif /* INET */
694df8bae1dSRodney W. Grimes 
6950312fbe9SPoul-Henning Kamp static int
69682d9ae4eSPoul-Henning Kamp udp_pcblist(SYSCTL_HANDLER_ARGS)
69798271db4SGarrett Wollman {
698277afaffSRobert Watson 	int error, i, n;
69998271db4SGarrett Wollman 	struct inpcb *inp, **inp_list;
70098271db4SGarrett Wollman 	inp_gen_t gencnt;
70198271db4SGarrett Wollman 	struct xinpgen xig;
70298271db4SGarrett Wollman 
70398271db4SGarrett Wollman 	/*
704f5514f08SRobert Watson 	 * The process of preparing the PCB list is too time-consuming and
70598271db4SGarrett Wollman 	 * resource-intensive to repeat twice on every request.
70698271db4SGarrett Wollman 	 */
70798271db4SGarrett Wollman 	if (req->oldptr == 0) {
708603724d3SBjoern A. Zeeb 		n = V_udbinfo.ipi_count;
709c007b96aSJohn Baldwin 		n += imax(n / 8, 10);
710c007b96aSJohn Baldwin 		req->oldidx = 2 * (sizeof xig) + n * sizeof(struct xinpcb);
7113329b236SRobert Watson 		return (0);
71298271db4SGarrett Wollman 	}
71398271db4SGarrett Wollman 
71498271db4SGarrett Wollman 	if (req->newptr != 0)
7153329b236SRobert Watson 		return (EPERM);
71698271db4SGarrett Wollman 
71798271db4SGarrett Wollman 	/*
71898271db4SGarrett Wollman 	 * OK, now we're committed to doing something.
71998271db4SGarrett Wollman 	 */
720603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
721603724d3SBjoern A. Zeeb 	gencnt = V_udbinfo.ipi_gencnt;
722603724d3SBjoern A. Zeeb 	n = V_udbinfo.ipi_count;
723603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
72498271db4SGarrett Wollman 
72547934cefSDon Lewis 	error = sysctl_wire_old_buffer(req, 2 * (sizeof xig)
7265c38b6dbSDon Lewis 		+ n * sizeof(struct xinpcb));
72747934cefSDon Lewis 	if (error != 0)
72847934cefSDon Lewis 		return (error);
7295c38b6dbSDon Lewis 
73098271db4SGarrett Wollman 	xig.xig_len = sizeof xig;
73198271db4SGarrett Wollman 	xig.xig_count = n;
73298271db4SGarrett Wollman 	xig.xig_gen = gencnt;
73398271db4SGarrett Wollman 	xig.xig_sogen = so_gencnt;
73498271db4SGarrett Wollman 	error = SYSCTL_OUT(req, &xig, sizeof xig);
73598271db4SGarrett Wollman 	if (error)
7363329b236SRobert Watson 		return (error);
73798271db4SGarrett Wollman 
738a163d034SWarner Losh 	inp_list = malloc(n * sizeof *inp_list, M_TEMP, M_WAITOK);
73998271db4SGarrett Wollman 	if (inp_list == 0)
7403329b236SRobert Watson 		return (ENOMEM);
74198271db4SGarrett Wollman 
742603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
743603724d3SBjoern A. Zeeb 	for (inp = LIST_FIRST(V_udbinfo.ipi_listhead), i = 0; inp && i < n;
744fc2ffbe6SPoul-Henning Kamp 	     inp = LIST_NEXT(inp, inp_list)) {
745d0e157f6SBjoern A. Zeeb 		INP_WLOCK(inp);
7462ded288cSJeffrey Hsu 		if (inp->inp_gencnt <= gencnt &&
747d0e157f6SBjoern A. Zeeb 		    cr_canseeinpcb(req->td->td_ucred, inp) == 0) {
748d0e157f6SBjoern A. Zeeb 			in_pcbref(inp);
74998271db4SGarrett Wollman 			inp_list[i++] = inp;
750d0e157f6SBjoern A. Zeeb 		}
751d0e157f6SBjoern A. Zeeb 		INP_WUNLOCK(inp);
7524787fd37SPaul Saab 	}
753603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
75498271db4SGarrett Wollman 	n = i;
75598271db4SGarrett Wollman 
75698271db4SGarrett Wollman 	error = 0;
75798271db4SGarrett Wollman 	for (i = 0; i < n; i++) {
75898271db4SGarrett Wollman 		inp = inp_list[i];
7599622e84fSRobert Watson 		INP_RLOCK(inp);
76098271db4SGarrett Wollman 		if (inp->inp_gencnt <= gencnt) {
76198271db4SGarrett Wollman 			struct xinpcb xi;
762d0e157f6SBjoern A. Zeeb 
763fd94099eSColin Percival 			bzero(&xi, sizeof(xi));
76498271db4SGarrett Wollman 			xi.xi_len = sizeof xi;
76598271db4SGarrett Wollman 			/* XXX should avoid extra copy */
76698271db4SGarrett Wollman 			bcopy(inp, &xi.xi_inp, sizeof *inp);
76798271db4SGarrett Wollman 			if (inp->inp_socket)
76898271db4SGarrett Wollman 				sotoxsocket(inp->inp_socket, &xi.xi_socket);
7694b40c56cSJeffrey Hsu 			xi.xi_inp.inp_gencnt = inp->inp_gencnt;
7709622e84fSRobert Watson 			INP_RUNLOCK(inp);
77198271db4SGarrett Wollman 			error = SYSCTL_OUT(req, &xi, sizeof xi);
772d915b280SStephan Uphoff 		} else
7739622e84fSRobert Watson 			INP_RUNLOCK(inp);
77498271db4SGarrett Wollman 	}
775d0e157f6SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
776d0e157f6SBjoern A. Zeeb 	for (i = 0; i < n; i++) {
777d0e157f6SBjoern A. Zeeb 		inp = inp_list[i];
778fa046d87SRobert Watson 		INP_RLOCK(inp);
779fa046d87SRobert Watson 		if (!in_pcbrele_rlocked(inp))
780fa046d87SRobert Watson 			INP_RUNLOCK(inp);
781d0e157f6SBjoern A. Zeeb 	}
782d0e157f6SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
783d0e157f6SBjoern A. Zeeb 
78498271db4SGarrett Wollman 	if (!error) {
78598271db4SGarrett Wollman 		/*
7863329b236SRobert Watson 		 * Give the user an updated idea of our state.  If the
7873329b236SRobert Watson 		 * generation differs from what we told her before, she knows
7883329b236SRobert Watson 		 * that something happened while we were processing this
7893329b236SRobert Watson 		 * request, and it might be necessary to retry.
79098271db4SGarrett Wollman 		 */
791603724d3SBjoern A. Zeeb 		INP_INFO_RLOCK(&V_udbinfo);
792603724d3SBjoern A. Zeeb 		xig.xig_gen = V_udbinfo.ipi_gencnt;
79398271db4SGarrett Wollman 		xig.xig_sogen = so_gencnt;
794603724d3SBjoern A. Zeeb 		xig.xig_count = V_udbinfo.ipi_count;
795603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
79698271db4SGarrett Wollman 		error = SYSCTL_OUT(req, &xig, sizeof xig);
79798271db4SGarrett Wollman 	}
79898271db4SGarrett Wollman 	free(inp_list, M_TEMP);
7993329b236SRobert Watson 	return (error);
80098271db4SGarrett Wollman }
80198271db4SGarrett Wollman 
80279c3d51bSMatthew D Fleming SYSCTL_PROC(_net_inet_udp, UDPCTL_PCBLIST, pcblist,
80379c3d51bSMatthew D Fleming     CTLTYPE_OPAQUE | CTLFLAG_RD, NULL, 0,
80498271db4SGarrett Wollman     udp_pcblist, "S,xinpcb", "List of active UDP sockets");
80598271db4SGarrett Wollman 
80679288c11SBjoern A. Zeeb #ifdef INET
80798271db4SGarrett Wollman static int
80882d9ae4eSPoul-Henning Kamp udp_getcred(SYSCTL_HANDLER_ARGS)
809490d50b6SBrian Feldman {
810c0511d3bSBrian Feldman 	struct xucred xuc;
811490d50b6SBrian Feldman 	struct sockaddr_in addrs[2];
812490d50b6SBrian Feldman 	struct inpcb *inp;
813277afaffSRobert Watson 	int error;
814490d50b6SBrian Feldman 
81532f9753cSRobert Watson 	error = priv_check(req->td, PRIV_NETINET_GETCRED);
816490d50b6SBrian Feldman 	if (error)
817490d50b6SBrian Feldman 		return (error);
818490d50b6SBrian Feldman 	error = SYSCTL_IN(req, addrs, sizeof(addrs));
819490d50b6SBrian Feldman 	if (error)
820490d50b6SBrian Feldman 		return (error);
821fa046d87SRobert Watson 	inp = in_pcblookup(&V_udbinfo, addrs[1].sin_addr, addrs[1].sin_port,
822fa046d87SRobert Watson 	    addrs[0].sin_addr, addrs[0].sin_port,
823fa046d87SRobert Watson 	    INPLOOKUP_WILDCARD | INPLOOKUP_RLOCKPCB, NULL);
8249622e84fSRobert Watson 	if (inp != NULL) {
825fa046d87SRobert Watson 		INP_RLOCK_ASSERT(inp);
8269622e84fSRobert Watson 		if (inp->inp_socket == NULL)
8279622e84fSRobert Watson 			error = ENOENT;
8289622e84fSRobert Watson 		if (error == 0)
829f08ef6c5SBjoern A. Zeeb 			error = cr_canseeinpcb(req->td->td_ucred, inp);
8309622e84fSRobert Watson 		if (error == 0)
83186d02c5cSBjoern A. Zeeb 			cru2x(inp->inp_cred, &xuc);
8329622e84fSRobert Watson 		INP_RUNLOCK(inp);
833fa046d87SRobert Watson 	} else
8349622e84fSRobert Watson 		error = ENOENT;
8350e1eebb8SDon Lewis 	if (error == 0)
8360e1eebb8SDon Lewis 		error = SYSCTL_OUT(req, &xuc, sizeof(struct xucred));
837490d50b6SBrian Feldman 	return (error);
838490d50b6SBrian Feldman }
839490d50b6SBrian Feldman 
8407ce87f12SDavid Malone SYSCTL_PROC(_net_inet_udp, OID_AUTO, getcred,
8417ce87f12SDavid Malone     CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_PRISON, 0, 0,
8427ce87f12SDavid Malone     udp_getcred, "S,xucred", "Get the xucred of a UDP connection");
84379288c11SBjoern A. Zeeb #endif /* INET */
844490d50b6SBrian Feldman 
8457b495c44SVANHULLEBUS Yvan int
8467b495c44SVANHULLEBUS Yvan udp_ctloutput(struct socket *so, struct sockopt *sopt)
8477b495c44SVANHULLEBUS Yvan {
8487b495c44SVANHULLEBUS Yvan 	int error = 0, optval;
8497b495c44SVANHULLEBUS Yvan 	struct inpcb *inp;
8507b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8517b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
8527b495c44SVANHULLEBUS Yvan #endif
8537b495c44SVANHULLEBUS Yvan 
8547b495c44SVANHULLEBUS Yvan 	inp = sotoinpcb(so);
8557b495c44SVANHULLEBUS Yvan 	KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
8567b495c44SVANHULLEBUS Yvan 	INP_WLOCK(inp);
8577b495c44SVANHULLEBUS Yvan 	if (sopt->sopt_level != IPPROTO_UDP) {
8587b495c44SVANHULLEBUS Yvan #ifdef INET6
8597b495c44SVANHULLEBUS Yvan 		if (INP_CHECK_SOCKAF(so, AF_INET6)) {
8607b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8617b495c44SVANHULLEBUS Yvan 			error = ip6_ctloutput(so, sopt);
86279288c11SBjoern A. Zeeb 		}
8637b495c44SVANHULLEBUS Yvan #endif
86479288c11SBjoern A. Zeeb #if defined(INET) && defined(INET6)
86579288c11SBjoern A. Zeeb 		else
86679288c11SBjoern A. Zeeb #endif
86779288c11SBjoern A. Zeeb #ifdef INET
86879288c11SBjoern A. Zeeb 		{
8697b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8707b495c44SVANHULLEBUS Yvan 			error = ip_ctloutput(so, sopt);
8717b495c44SVANHULLEBUS Yvan 		}
8727b495c44SVANHULLEBUS Yvan #endif
8737b495c44SVANHULLEBUS Yvan 		return (error);
8747b495c44SVANHULLEBUS Yvan 	}
8757b495c44SVANHULLEBUS Yvan 
8767b495c44SVANHULLEBUS Yvan 	switch (sopt->sopt_dir) {
8777b495c44SVANHULLEBUS Yvan 	case SOPT_SET:
8787b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
8797b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
8807b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8817b495c44SVANHULLEBUS Yvan 			error = sooptcopyin(sopt, &optval, sizeof optval,
8827b495c44SVANHULLEBUS Yvan 					    sizeof optval);
8837b495c44SVANHULLEBUS Yvan 			if (error)
8847b495c44SVANHULLEBUS Yvan 				break;
8857b495c44SVANHULLEBUS Yvan 			inp = sotoinpcb(so);
8867b495c44SVANHULLEBUS Yvan 			KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
8877b495c44SVANHULLEBUS Yvan 			INP_WLOCK(inp);
8887b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8897b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
8907b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
8917b495c44SVANHULLEBUS Yvan #endif
8927b495c44SVANHULLEBUS Yvan 			switch (optval) {
8937b495c44SVANHULLEBUS Yvan 			case 0:
8947b495c44SVANHULLEBUS Yvan 				/* Clear all UDP encap. */
8957b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8967b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
8977b495c44SVANHULLEBUS Yvan #endif
8987b495c44SVANHULLEBUS Yvan 				break;
8997b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
9007b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP:
9017b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP_NON_IKE:
9027b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
9037b495c44SVANHULLEBUS Yvan 				if (optval == UDP_ENCAP_ESPINUDP)
9047b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP;
9057b495c44SVANHULLEBUS Yvan 				else if (optval == UDP_ENCAP_ESPINUDP_NON_IKE)
9067b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP_NON_IKE;
9077b495c44SVANHULLEBUS Yvan 				break;
9087b495c44SVANHULLEBUS Yvan #endif
9097b495c44SVANHULLEBUS Yvan 			default:
9107b495c44SVANHULLEBUS Yvan 				error = EINVAL;
9117b495c44SVANHULLEBUS Yvan 				break;
9127b495c44SVANHULLEBUS Yvan 			}
9137b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9147b495c44SVANHULLEBUS Yvan 			break;
9157b495c44SVANHULLEBUS Yvan 		default:
9167b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9177b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
9187b495c44SVANHULLEBUS Yvan 			break;
9197b495c44SVANHULLEBUS Yvan 		}
9207b495c44SVANHULLEBUS Yvan 		break;
9217b495c44SVANHULLEBUS Yvan 	case SOPT_GET:
9227b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
9237b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
9247b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
9257b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
9267b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
9277b495c44SVANHULLEBUS Yvan 			optval = up->u_flags & UF_ESPINUDP_ALL;
9287b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9297b495c44SVANHULLEBUS Yvan 			error = sooptcopyout(sopt, &optval, sizeof optval);
9307b495c44SVANHULLEBUS Yvan 			break;
9317b495c44SVANHULLEBUS Yvan #endif
9327b495c44SVANHULLEBUS Yvan 		default:
9337b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9347b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
9357b495c44SVANHULLEBUS Yvan 			break;
9367b495c44SVANHULLEBUS Yvan 		}
9377b495c44SVANHULLEBUS Yvan 		break;
9387b495c44SVANHULLEBUS Yvan 	}
9397b495c44SVANHULLEBUS Yvan 	return (error);
9407b495c44SVANHULLEBUS Yvan }
9417b495c44SVANHULLEBUS Yvan 
94279288c11SBjoern A. Zeeb #ifdef INET
943fa046d87SRobert Watson #define	UH_WLOCKED	2
944fa046d87SRobert Watson #define	UH_RLOCKED	1
945fa046d87SRobert Watson #define	UH_UNLOCKED	0
946490d50b6SBrian Feldman static int
9473329b236SRobert Watson udp_output(struct inpcb *inp, struct mbuf *m, struct sockaddr *addr,
9483329b236SRobert Watson     struct mbuf *control, struct thread *td)
949df8bae1dSRodney W. Grimes {
9503329b236SRobert Watson 	struct udpiphdr *ui;
9513329b236SRobert Watson 	int len = m->m_pkthdr.len;
95290162a4eSIan Dowse 	struct in_addr faddr, laddr;
953c557ae16SIan Dowse 	struct cmsghdr *cm;
954c557ae16SIan Dowse 	struct sockaddr_in *sin, src;
95590162a4eSIan Dowse 	int error = 0;
9568afa2304SBruce M Simpson 	int ipflags;
95790162a4eSIan Dowse 	u_short fport, lport;
9585c32ea65SRobert Watson 	int unlock_udbinfo;
959df8bae1dSRodney W. Grimes 
9605c32ea65SRobert Watson 	/*
9615c32ea65SRobert Watson 	 * udp_output() may need to temporarily bind or connect the current
962f5514f08SRobert Watson 	 * inpcb.  As such, we don't know up front whether we will need the
963f5514f08SRobert Watson 	 * pcbinfo lock or not.  Do any work to decide what is needed up
964f5514f08SRobert Watson 	 * front before acquiring any locks.
9655c32ea65SRobert Watson 	 */
966430d30d8SBill Fenner 	if (len + sizeof(struct udpiphdr) > IP_MAXPACKET) {
967c557ae16SIan Dowse 		if (control)
968c557ae16SIan Dowse 			m_freem(control);
9695c32ea65SRobert Watson 		m_freem(m);
9703329b236SRobert Watson 		return (EMSGSIZE);
971430d30d8SBill Fenner 	}
972430d30d8SBill Fenner 
9731b7f0384SBruce M Simpson 	src.sin_family = 0;
974*0cfdff24SBjoern A. Zeeb 	INP_RLOCK(inp);
975c557ae16SIan Dowse 	if (control != NULL) {
976c557ae16SIan Dowse 		/*
9773329b236SRobert Watson 		 * XXX: Currently, we assume all the optional information is
9783329b236SRobert Watson 		 * stored in a single mbuf.
979c557ae16SIan Dowse 		 */
980c557ae16SIan Dowse 		if (control->m_next) {
981*0cfdff24SBjoern A. Zeeb 			INP_RUNLOCK(inp);
982c557ae16SIan Dowse 			m_freem(control);
9835c32ea65SRobert Watson 			m_freem(m);
9843329b236SRobert Watson 			return (EINVAL);
985c557ae16SIan Dowse 		}
986c557ae16SIan Dowse 		for (; control->m_len > 0;
987c557ae16SIan Dowse 		    control->m_data += CMSG_ALIGN(cm->cmsg_len),
988c557ae16SIan Dowse 		    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
989c557ae16SIan Dowse 			cm = mtod(control, struct cmsghdr *);
990af1ee11dSRobert Watson 			if (control->m_len < sizeof(*cm) || cm->cmsg_len == 0
991af1ee11dSRobert Watson 			    || cm->cmsg_len > control->m_len) {
992c557ae16SIan Dowse 				error = EINVAL;
993c557ae16SIan Dowse 				break;
994c557ae16SIan Dowse 			}
995c557ae16SIan Dowse 			if (cm->cmsg_level != IPPROTO_IP)
996c557ae16SIan Dowse 				continue;
997c557ae16SIan Dowse 
998c557ae16SIan Dowse 			switch (cm->cmsg_type) {
999c557ae16SIan Dowse 			case IP_SENDSRCADDR:
1000c557ae16SIan Dowse 				if (cm->cmsg_len !=
1001c557ae16SIan Dowse 				    CMSG_LEN(sizeof(struct in_addr))) {
1002c557ae16SIan Dowse 					error = EINVAL;
1003c557ae16SIan Dowse 					break;
1004c557ae16SIan Dowse 				}
1005c557ae16SIan Dowse 				bzero(&src, sizeof(src));
1006c557ae16SIan Dowse 				src.sin_family = AF_INET;
1007c557ae16SIan Dowse 				src.sin_len = sizeof(src);
1008c557ae16SIan Dowse 				src.sin_port = inp->inp_lport;
1009af1ee11dSRobert Watson 				src.sin_addr =
1010af1ee11dSRobert Watson 				    *(struct in_addr *)CMSG_DATA(cm);
1011c557ae16SIan Dowse 				break;
1012af1ee11dSRobert Watson 
1013c557ae16SIan Dowse 			default:
1014c557ae16SIan Dowse 				error = ENOPROTOOPT;
1015c557ae16SIan Dowse 				break;
1016c557ae16SIan Dowse 			}
1017c557ae16SIan Dowse 			if (error)
1018c557ae16SIan Dowse 				break;
1019c557ae16SIan Dowse 		}
1020c557ae16SIan Dowse 		m_freem(control);
1021c557ae16SIan Dowse 	}
10225c32ea65SRobert Watson 	if (error) {
1023*0cfdff24SBjoern A. Zeeb 		INP_RUNLOCK(inp);
10245c32ea65SRobert Watson 		m_freem(m);
10253329b236SRobert Watson 		return (error);
10265c32ea65SRobert Watson 	}
10275c32ea65SRobert Watson 
102843cc0bc1SRobert Watson 	/*
102943cc0bc1SRobert Watson 	 * Depending on whether or not the application has bound or connected
1030ca528788SRobert Watson 	 * the socket, we may have to do varying levels of work.  The optimal
1031ca528788SRobert Watson 	 * case is for a connected UDP socket, as a global lock isn't
1032ca528788SRobert Watson 	 * required at all.
103343cc0bc1SRobert Watson 	 *
103443cc0bc1SRobert Watson 	 * In order to decide which we need, we require stability of the
103543cc0bc1SRobert Watson 	 * inpcb binding, which we ensure by acquiring a read lock on the
103643cc0bc1SRobert Watson 	 * inpcb.  This doesn't strictly follow the lock order, so we play
103743cc0bc1SRobert Watson 	 * the trylock and retry game; note that we may end up with more
103843cc0bc1SRobert Watson 	 * conservative locks than required the second time around, so later
103943cc0bc1SRobert Watson 	 * assertions have to accept that.  Further analysis of the number of
104043cc0bc1SRobert Watson 	 * misses under contention is required.
1041fa046d87SRobert Watson 	 *
1042fa046d87SRobert Watson 	 * XXXRW: Check that hash locking update here is correct.
104343cc0bc1SRobert Watson 	 */
104443cc0bc1SRobert Watson 	sin = (struct sockaddr_in *)addr;
104543cc0bc1SRobert Watson 	if (sin != NULL &&
104643cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY && inp->inp_lport == 0)) {
104743cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
10488501a69cSRobert Watson 		INP_WLOCK(inp);
1049fa046d87SRobert Watson 		INP_HASH_WLOCK(&V_udbinfo);
1050fa046d87SRobert Watson 		unlock_udbinfo = UH_WLOCKED;
105143cc0bc1SRobert Watson 	} else if ((sin != NULL && (
105243cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_ANY) ||
105343cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_BROADCAST) ||
105443cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY) ||
105543cc0bc1SRobert Watson 	    (inp->inp_lport == 0))) ||
105643cc0bc1SRobert Watson 	    (src.sin_family == AF_INET)) {
1057fa046d87SRobert Watson 		INP_HASH_RLOCK(&V_udbinfo);
1058fa046d87SRobert Watson 		unlock_udbinfo = UH_RLOCKED;
105943cc0bc1SRobert Watson 	} else
1060fa046d87SRobert Watson 		unlock_udbinfo = UH_UNLOCKED;
10615c32ea65SRobert Watson 
10621b7f0384SBruce M Simpson 	/*
10631b7f0384SBruce M Simpson 	 * If the IP_SENDSRCADDR control message was specified, override the
10641b7f0384SBruce M Simpson 	 * source address for this datagram.  Its use is invalidated if the
10651b7f0384SBruce M Simpson 	 * address thus specified is incomplete or clobbers other inpcbs.
10661b7f0384SBruce M Simpson 	 */
106790162a4eSIan Dowse 	laddr = inp->inp_laddr;
106890162a4eSIan Dowse 	lport = inp->inp_lport;
10691b7f0384SBruce M Simpson 	if (src.sin_family == AF_INET) {
1070fa046d87SRobert Watson 		INP_HASH_LOCK_ASSERT(&V_udbinfo);
10711b7f0384SBruce M Simpson 		if ((lport == 0) ||
10721b7f0384SBruce M Simpson 		    (laddr.s_addr == INADDR_ANY &&
10731b7f0384SBruce M Simpson 		     src.sin_addr.s_addr == INADDR_ANY)) {
1074c557ae16SIan Dowse 			error = EINVAL;
1075c557ae16SIan Dowse 			goto release;
1076c557ae16SIan Dowse 		}
1077c557ae16SIan Dowse 		error = in_pcbbind_setup(inp, (struct sockaddr *)&src,
1078b0330ed9SPawel Jakub Dawidek 		    &laddr.s_addr, &lport, td->td_ucred);
1079c557ae16SIan Dowse 		if (error)
1080c557ae16SIan Dowse 			goto release;
1081c557ae16SIan Dowse 	}
1082c557ae16SIan Dowse 
10833144b7d3SRobert Watson 	/*
10843144b7d3SRobert Watson 	 * If a UDP socket has been connected, then a local address/port will
10853144b7d3SRobert Watson 	 * have been selected and bound.
10863144b7d3SRobert Watson 	 *
108743cc0bc1SRobert Watson 	 * If a UDP socket has not been connected to, then an explicit
10883144b7d3SRobert Watson 	 * destination address must be used, in which case a local
10893144b7d3SRobert Watson 	 * address/port may not have been selected and bound.
10903144b7d3SRobert Watson 	 */
109143cc0bc1SRobert Watson 	if (sin != NULL) {
1092c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
1093df8bae1dSRodney W. Grimes 		if (inp->inp_faddr.s_addr != INADDR_ANY) {
1094df8bae1dSRodney W. Grimes 			error = EISCONN;
1095df8bae1dSRodney W. Grimes 			goto release;
1096df8bae1dSRodney W. Grimes 		}
10973144b7d3SRobert Watson 
10983144b7d3SRobert Watson 		/*
10993144b7d3SRobert Watson 		 * Jail may rewrite the destination address, so let it do
11003144b7d3SRobert Watson 		 * that before we use it.
11013144b7d3SRobert Watson 		 */
1102b89e82ddSJamie Gritton 		error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1103b89e82ddSJamie Gritton 		if (error)
1104413628a7SBjoern A. Zeeb 			goto release;
11053144b7d3SRobert Watson 
11063144b7d3SRobert Watson 		/*
110743cc0bc1SRobert Watson 		 * If a local address or port hasn't yet been selected, or if
110843cc0bc1SRobert Watson 		 * the destination address needs to be rewritten due to using
110943cc0bc1SRobert Watson 		 * a special INADDR_ constant, invoke in_pcbconnect_setup()
111043cc0bc1SRobert Watson 		 * to do the heavy lifting.  Once a port is selected, we
111143cc0bc1SRobert Watson 		 * commit the binding back to the socket; we also commit the
111243cc0bc1SRobert Watson 		 * binding of the address if in jail.
111343cc0bc1SRobert Watson 		 *
111443cc0bc1SRobert Watson 		 * If we already have a valid binding and we're not
111543cc0bc1SRobert Watson 		 * requesting a destination address rewrite, use a fast path.
11163144b7d3SRobert Watson 		 */
111743cc0bc1SRobert Watson 		if (inp->inp_laddr.s_addr == INADDR_ANY ||
111843cc0bc1SRobert Watson 		    inp->inp_lport == 0 ||
111943cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_ANY ||
112043cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_BROADCAST) {
1121fa046d87SRobert Watson 			INP_HASH_LOCK_ASSERT(&V_udbinfo);
112243cc0bc1SRobert Watson 			error = in_pcbconnect_setup(inp, addr, &laddr.s_addr,
112343cc0bc1SRobert Watson 			    &lport, &faddr.s_addr, &fport, NULL,
112443cc0bc1SRobert Watson 			    td->td_ucred);
112590162a4eSIan Dowse 			if (error)
112690162a4eSIan Dowse 				goto release;
112790162a4eSIan Dowse 
112843cc0bc1SRobert Watson 			/*
112943cc0bc1SRobert Watson 			 * XXXRW: Why not commit the port if the address is
113043cc0bc1SRobert Watson 			 * !INADDR_ANY?
113143cc0bc1SRobert Watson 			 */
113290162a4eSIan Dowse 			/* Commit the local port if newly assigned. */
113390162a4eSIan Dowse 			if (inp->inp_laddr.s_addr == INADDR_ANY &&
113490162a4eSIan Dowse 			    inp->inp_lport == 0) {
1135c4d585aeSRobert Watson 				INP_WLOCK_ASSERT(inp);
1136fa046d87SRobert Watson 				INP_HASH_WLOCK_ASSERT(&V_udbinfo);
11373a1757b9SGleb Smirnoff 				/*
113843cc0bc1SRobert Watson 				 * Remember addr if jailed, to prevent
113943cc0bc1SRobert Watson 				 * rebinding.
11403a1757b9SGleb Smirnoff 				 */
11410304c731SJamie Gritton 				if (prison_flag(td->td_ucred, PR_IP4))
11423a1757b9SGleb Smirnoff 					inp->inp_laddr = laddr;
114390162a4eSIan Dowse 				inp->inp_lport = lport;
114490162a4eSIan Dowse 				if (in_pcbinshash(inp) != 0) {
114590162a4eSIan Dowse 					inp->inp_lport = 0;
114690162a4eSIan Dowse 					error = EAGAIN;
1147df8bae1dSRodney W. Grimes 					goto release;
1148df8bae1dSRodney W. Grimes 				}
114990162a4eSIan Dowse 				inp->inp_flags |= INP_ANONPORT;
115090162a4eSIan Dowse 			}
1151df8bae1dSRodney W. Grimes 		} else {
115243cc0bc1SRobert Watson 			faddr = sin->sin_addr;
115343cc0bc1SRobert Watson 			fport = sin->sin_port;
115443cc0bc1SRobert Watson 		}
115543cc0bc1SRobert Watson 	} else {
1156c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
115790162a4eSIan Dowse 		faddr = inp->inp_faddr;
115890162a4eSIan Dowse 		fport = inp->inp_fport;
115990162a4eSIan Dowse 		if (faddr.s_addr == INADDR_ANY) {
1160df8bae1dSRodney W. Grimes 			error = ENOTCONN;
1161df8bae1dSRodney W. Grimes 			goto release;
1162df8bae1dSRodney W. Grimes 		}
1163df8bae1dSRodney W. Grimes 	}
1164e6ccd709SRobert Watson 
1165df8bae1dSRodney W. Grimes 	/*
1166e6ccd709SRobert Watson 	 * Calculate data length and get a mbuf for UDP, IP, and possible
1167392e8407SRobert Watson 	 * link-layer headers.  Immediate slide the data pointer back forward
1168392e8407SRobert Watson 	 * since we won't use that space at this layer.
1169df8bae1dSRodney W. Grimes 	 */
1170e6ccd709SRobert Watson 	M_PREPEND(m, sizeof(struct udpiphdr) + max_linkhdr, M_DONTWAIT);
1171e6ccd709SRobert Watson 	if (m == NULL) {
1172df8bae1dSRodney W. Grimes 		error = ENOBUFS;
117349b19bfcSBruce M Simpson 		goto release;
1174df8bae1dSRodney W. Grimes 	}
1175e6ccd709SRobert Watson 	m->m_data += max_linkhdr;
1176e6ccd709SRobert Watson 	m->m_len -= max_linkhdr;
1177392e8407SRobert Watson 	m->m_pkthdr.len -= max_linkhdr;
1178df8bae1dSRodney W. Grimes 
1179df8bae1dSRodney W. Grimes 	/*
11803329b236SRobert Watson 	 * Fill in mbuf with extended UDP header and addresses and length put
11813329b236SRobert Watson 	 * into network format.
1182df8bae1dSRodney W. Grimes 	 */
1183df8bae1dSRodney W. Grimes 	ui = mtod(m, struct udpiphdr *);
1184db4f9cc7SJonathan Lemon 	bzero(ui->ui_x1, sizeof(ui->ui_x1));	/* XXX still needed? */
1185df8bae1dSRodney W. Grimes 	ui->ui_pr = IPPROTO_UDP;
118690162a4eSIan Dowse 	ui->ui_src = laddr;
118790162a4eSIan Dowse 	ui->ui_dst = faddr;
118890162a4eSIan Dowse 	ui->ui_sport = lport;
118990162a4eSIan Dowse 	ui->ui_dport = fport;
1190db4f9cc7SJonathan Lemon 	ui->ui_ulen = htons((u_short)len + sizeof(struct udphdr));
1191df8bae1dSRodney W. Grimes 
1192b2828ad2SAndre Oppermann 	/*
1193b2828ad2SAndre Oppermann 	 * Set the Don't Fragment bit in the IP header.
1194b2828ad2SAndre Oppermann 	 */
1195b2828ad2SAndre Oppermann 	if (inp->inp_flags & INP_DONTFRAG) {
1196b2828ad2SAndre Oppermann 		struct ip *ip;
11973329b236SRobert Watson 
1198b2828ad2SAndre Oppermann 		ip = (struct ip *)&ui->ui_i;
1199b2828ad2SAndre Oppermann 		ip->ip_off |= IP_DF;
1200b2828ad2SAndre Oppermann 	}
1201b2828ad2SAndre Oppermann 
1202b5d47ff5SJohn-Mark Gurney 	ipflags = 0;
1203b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_DONTROUTE)
1204b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ROUTETOIF;
1205b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_BROADCAST)
1206b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ALLOWBROADCAST;
12076fbfd582SAndre Oppermann 	if (inp->inp_flags & INP_ONESBCAST)
12088afa2304SBruce M Simpson 		ipflags |= IP_SENDONES;
12098afa2304SBruce M Simpson 
12101175d9d5SRobert Watson #ifdef MAC
12111175d9d5SRobert Watson 	mac_inpcb_create_mbuf(inp, m);
12121175d9d5SRobert Watson #endif
12131175d9d5SRobert Watson 
1214df8bae1dSRodney W. Grimes 	/*
1215db4f9cc7SJonathan Lemon 	 * Set up checksum and output datagram.
1216df8bae1dSRodney W. Grimes 	 */
121740b676beSBjoern A. Zeeb 	if (V_udp_cksum) {
12186fbfd582SAndre Oppermann 		if (inp->inp_flags & INP_ONESBCAST)
12198a538743SBruce M Simpson 			faddr.s_addr = INADDR_BROADCAST;
12208a538743SBruce M Simpson 		ui->ui_sum = in_pseudo(ui->ui_src.s_addr, faddr.s_addr,
1221db4f9cc7SJonathan Lemon 		    htons((u_short)len + sizeof(struct udphdr) + IPPROTO_UDP));
1222db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_flags = CSUM_UDP;
1223db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum);
12243329b236SRobert Watson 	} else
1225db4f9cc7SJonathan Lemon 		ui->ui_sum = 0;
1226df8bae1dSRodney W. Grimes 	((struct ip *)ui)->ip_len = sizeof (struct udpiphdr) + len;
1227ca98b82cSDavid Greenman 	((struct ip *)ui)->ip_ttl = inp->inp_ip_ttl;	/* XXX */
1228ca98b82cSDavid Greenman 	((struct ip *)ui)->ip_tos = inp->inp_ip_tos;	/* XXX */
1229026decb8SRobert Watson 	UDPSTAT_INC(udps_opackets);
1230cfa1ca9dSYoshinobu Inoue 
1231fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED)
1232fa046d87SRobert Watson 		INP_HASH_WUNLOCK(&V_udbinfo);
1233fa046d87SRobert Watson 	else if (unlock_udbinfo == UH_RLOCKED)
1234fa046d87SRobert Watson 		INP_HASH_RUNLOCK(&V_udbinfo);
123597d8d152SAndre Oppermann 	error = ip_output(m, inp->inp_options, NULL, ipflags,
12365d846453SSam Leffler 	    inp->inp_moptions, inp);
1237fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED)
12388501a69cSRobert Watson 		INP_WUNLOCK(inp);
1239948d0fc9SRobert Watson 	else
1240948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1241df8bae1dSRodney W. Grimes 	return (error);
1242df8bae1dSRodney W. Grimes 
1243df8bae1dSRodney W. Grimes release:
1244fa046d87SRobert Watson 	if (unlock_udbinfo == UH_WLOCKED) {
1245fa046d87SRobert Watson 		INP_HASH_WUNLOCK(&V_udbinfo);
1246948d0fc9SRobert Watson 		INP_WUNLOCK(inp);
1247fa046d87SRobert Watson 	} else if (unlock_udbinfo == UH_RLOCKED) {
1248fa046d87SRobert Watson 		INP_HASH_RUNLOCK(&V_udbinfo);
124943cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
1250948d0fc9SRobert Watson 	} else
1251948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1252df8bae1dSRodney W. Grimes 	m_freem(m);
1253df8bae1dSRodney W. Grimes 	return (error);
1254df8bae1dSRodney W. Grimes }
1255df8bae1dSRodney W. Grimes 
12567b495c44SVANHULLEBUS Yvan 
12577b495c44SVANHULLEBUS Yvan #if defined(IPSEC) && defined(IPSEC_NAT_T)
12587b495c44SVANHULLEBUS Yvan /*
12597b495c44SVANHULLEBUS Yvan  * Potentially decap ESP in UDP frame.  Check for an ESP header
12607b495c44SVANHULLEBUS Yvan  * and optional marker; if present, strip the UDP header and
12617b495c44SVANHULLEBUS Yvan  * push the result through IPSec.
12627b495c44SVANHULLEBUS Yvan  *
12637b495c44SVANHULLEBUS Yvan  * Returns mbuf to be processed (potentially re-allocated) or
12647b495c44SVANHULLEBUS Yvan  * NULL if consumed and/or processed.
12657b495c44SVANHULLEBUS Yvan  */
12667b495c44SVANHULLEBUS Yvan static struct mbuf *
12677b495c44SVANHULLEBUS Yvan udp4_espdecap(struct inpcb *inp, struct mbuf *m, int off)
12687b495c44SVANHULLEBUS Yvan {
12697b495c44SVANHULLEBUS Yvan 	size_t minlen, payload, skip, iphlen;
12707b495c44SVANHULLEBUS Yvan 	caddr_t data;
12717b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
12727b495c44SVANHULLEBUS Yvan 	struct m_tag *tag;
12737b495c44SVANHULLEBUS Yvan 	struct udphdr *udphdr;
12747b495c44SVANHULLEBUS Yvan 	struct ip *ip;
12757b495c44SVANHULLEBUS Yvan 
12767b495c44SVANHULLEBUS Yvan 	INP_RLOCK_ASSERT(inp);
12777b495c44SVANHULLEBUS Yvan 
12787b495c44SVANHULLEBUS Yvan 	/*
12797b495c44SVANHULLEBUS Yvan 	 * Pull up data so the longest case is contiguous:
12807b495c44SVANHULLEBUS Yvan 	 *    IP/UDP hdr + non ESP marker + ESP hdr.
12817b495c44SVANHULLEBUS Yvan 	 */
12827b495c44SVANHULLEBUS Yvan 	minlen = off + sizeof(uint64_t) + sizeof(struct esp);
12837b495c44SVANHULLEBUS Yvan 	if (minlen > m->m_pkthdr.len)
12847b495c44SVANHULLEBUS Yvan 		minlen = m->m_pkthdr.len;
12857b495c44SVANHULLEBUS Yvan 	if ((m = m_pullup(m, minlen)) == NULL) {
12867b495c44SVANHULLEBUS Yvan 		V_ipsec4stat.in_inval++;
12877b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Bypass caller processing. */
12887b495c44SVANHULLEBUS Yvan 	}
12897b495c44SVANHULLEBUS Yvan 	data = mtod(m, caddr_t);	/* Points to ip header. */
12907b495c44SVANHULLEBUS Yvan 	payload = m->m_len - off;	/* Size of payload. */
12917b495c44SVANHULLEBUS Yvan 
12927b495c44SVANHULLEBUS Yvan 	if (payload == 1 && data[off] == '\xff')
12937b495c44SVANHULLEBUS Yvan 		return (m);		/* NB: keepalive packet, no decap. */
12947b495c44SVANHULLEBUS Yvan 
12957b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
12967b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
12977b495c44SVANHULLEBUS Yvan 	KASSERT((up->u_flags & UF_ESPINUDP_ALL) != 0,
12987b495c44SVANHULLEBUS Yvan 	    ("u_flags 0x%x", up->u_flags));
12997b495c44SVANHULLEBUS Yvan 
13007b495c44SVANHULLEBUS Yvan 	/*
13017b495c44SVANHULLEBUS Yvan 	 * Check that the payload is large enough to hold an
13027b495c44SVANHULLEBUS Yvan 	 * ESP header and compute the amount of data to remove.
13037b495c44SVANHULLEBUS Yvan 	 *
13047b495c44SVANHULLEBUS Yvan 	 * NB: the caller has already done a pullup for us.
13057b495c44SVANHULLEBUS Yvan 	 * XXX can we assume alignment and eliminate bcopys?
13067b495c44SVANHULLEBUS Yvan 	 */
13077b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_NON_IKE) {
13087b495c44SVANHULLEBUS Yvan 		/*
13097b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-nat-t-ike-0[01].txt and
13107b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-udp-encaps-(00/)01.txt, ignoring
13117b495c44SVANHULLEBUS Yvan 		 * possible AH mode non-IKE marker+non-ESP marker
13127b495c44SVANHULLEBUS Yvan 		 * from draft-ietf-ipsec-udp-encaps-00.txt.
13137b495c44SVANHULLEBUS Yvan 		 */
13147b495c44SVANHULLEBUS Yvan 		uint64_t marker;
13157b495c44SVANHULLEBUS Yvan 
13167b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(uint64_t) + sizeof(struct esp))
13177b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13187b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &marker, sizeof(uint64_t));
13197b495c44SVANHULLEBUS Yvan 		if (marker != 0)	/* Non-IKE marker. */
13207b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13217b495c44SVANHULLEBUS Yvan 		skip = sizeof(uint64_t) + sizeof(struct udphdr);
13227b495c44SVANHULLEBUS Yvan 	} else {
13237b495c44SVANHULLEBUS Yvan 		uint32_t spi;
13247b495c44SVANHULLEBUS Yvan 
13257b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(struct esp)) {
13267b495c44SVANHULLEBUS Yvan 			V_ipsec4stat.in_inval++;
13277b495c44SVANHULLEBUS Yvan 			m_freem(m);
13287b495c44SVANHULLEBUS Yvan 			return (NULL);	/* Discard. */
13297b495c44SVANHULLEBUS Yvan 		}
13307b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &spi, sizeof(uint32_t));
13317b495c44SVANHULLEBUS Yvan 		if (spi == 0)		/* Non-ESP marker. */
13327b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13337b495c44SVANHULLEBUS Yvan 		skip = sizeof(struct udphdr);
13347b495c44SVANHULLEBUS Yvan 	}
13357b495c44SVANHULLEBUS Yvan 
13367b495c44SVANHULLEBUS Yvan 	/*
13377b495c44SVANHULLEBUS Yvan 	 * Setup a PACKET_TAG_IPSEC_NAT_T_PORT tag to remember
13387b495c44SVANHULLEBUS Yvan 	 * the UDP ports. This is required if we want to select
13397b495c44SVANHULLEBUS Yvan 	 * the right SPD for multiple hosts behind same NAT.
13407b495c44SVANHULLEBUS Yvan 	 *
13417b495c44SVANHULLEBUS Yvan 	 * NB: ports are maintained in network byte order everywhere
13427b495c44SVANHULLEBUS Yvan 	 *     in the NAT-T code.
13437b495c44SVANHULLEBUS Yvan 	 */
13447b495c44SVANHULLEBUS Yvan 	tag = m_tag_get(PACKET_TAG_IPSEC_NAT_T_PORTS,
13457b495c44SVANHULLEBUS Yvan 		2 * sizeof(uint16_t), M_NOWAIT);
13467b495c44SVANHULLEBUS Yvan 	if (tag == NULL) {
13477b495c44SVANHULLEBUS Yvan 		V_ipsec4stat.in_nomem++;
13487b495c44SVANHULLEBUS Yvan 		m_freem(m);
13497b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Discard. */
13507b495c44SVANHULLEBUS Yvan 	}
13517b495c44SVANHULLEBUS Yvan 	iphlen = off - sizeof(struct udphdr);
13527b495c44SVANHULLEBUS Yvan 	udphdr = (struct udphdr *)(data + iphlen);
13537b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[0] = udphdr->uh_sport;
13547b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[1] = udphdr->uh_dport;
13557b495c44SVANHULLEBUS Yvan 	m_tag_prepend(m, tag);
13567b495c44SVANHULLEBUS Yvan 
13577b495c44SVANHULLEBUS Yvan 	/*
13587b495c44SVANHULLEBUS Yvan 	 * Remove the UDP header (and possibly the non ESP marker)
13597b495c44SVANHULLEBUS Yvan 	 * IP header length is iphlen
13607b495c44SVANHULLEBUS Yvan 	 * Before:
13617b495c44SVANHULLEBUS Yvan 	 *   <--- off --->
13627b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
13637b495c44SVANHULLEBUS Yvan 	 *   | IP |  UDP | ESP |
13647b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
13657b495c44SVANHULLEBUS Yvan 	 *        <-skip->
13667b495c44SVANHULLEBUS Yvan 	 * After:
13677b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
13687b495c44SVANHULLEBUS Yvan 	 *          | IP | ESP |
13697b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
13707b495c44SVANHULLEBUS Yvan 	 *   <-skip->
13717b495c44SVANHULLEBUS Yvan 	 */
13727b495c44SVANHULLEBUS Yvan 	ovbcopy(data, data + skip, iphlen);
13737b495c44SVANHULLEBUS Yvan 	m_adj(m, skip);
13747b495c44SVANHULLEBUS Yvan 
13757b495c44SVANHULLEBUS Yvan 	ip = mtod(m, struct ip *);
13767b495c44SVANHULLEBUS Yvan 	ip->ip_len -= skip;
13777b495c44SVANHULLEBUS Yvan 	ip->ip_p = IPPROTO_ESP;
13787b495c44SVANHULLEBUS Yvan 
13797b495c44SVANHULLEBUS Yvan 	/*
13807b495c44SVANHULLEBUS Yvan 	 * We cannot yet update the cksums so clear any
13817b495c44SVANHULLEBUS Yvan 	 * h/w cksum flags as they are no longer valid.
13827b495c44SVANHULLEBUS Yvan 	 */
13837b495c44SVANHULLEBUS Yvan 	if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID)
13847b495c44SVANHULLEBUS Yvan 		m->m_pkthdr.csum_flags &= ~(CSUM_DATA_VALID|CSUM_PSEUDO_HDR);
13857b495c44SVANHULLEBUS Yvan 
13867b495c44SVANHULLEBUS Yvan 	(void) ipsec4_common_input(m, iphlen, ip->ip_p);
13877b495c44SVANHULLEBUS Yvan 	return (NULL);			/* NB: consumed, bypass processing. */
13887b495c44SVANHULLEBUS Yvan }
13897b495c44SVANHULLEBUS Yvan #endif /* defined(IPSEC) && defined(IPSEC_NAT_T) */
13907b495c44SVANHULLEBUS Yvan 
1391ac45e92fSRobert Watson static void
1392d0390e05SGarrett Wollman udp_abort(struct socket *so)
1393df8bae1dSRodney W. Grimes {
1394d0390e05SGarrett Wollman 	struct inpcb *inp;
1395df8bae1dSRodney W. Grimes 
1396d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
139714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_abort: inp == NULL"));
13988501a69cSRobert Watson 	INP_WLOCK(inp);
1399a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1400fa046d87SRobert Watson 		INP_HASH_WLOCK(&V_udbinfo);
1401a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1402a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1403fa046d87SRobert Watson 		INP_HASH_WUNLOCK(&V_udbinfo);
1404d0390e05SGarrett Wollman 		soisdisconnected(so);
1405a152f8a3SRobert Watson 	}
14068501a69cSRobert Watson 	INP_WUNLOCK(inp);
1407df8bae1dSRodney W. Grimes }
1408df8bae1dSRodney W. Grimes 
1409d0390e05SGarrett Wollman static int
1410b40ce416SJulian Elischer udp_attach(struct socket *so, int proto, struct thread *td)
1411d0390e05SGarrett Wollman {
1412d0390e05SGarrett Wollman 	struct inpcb *inp;
1413277afaffSRobert Watson 	int error;
1414d0390e05SGarrett Wollman 
1415d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
141614ba8addSRobert Watson 	KASSERT(inp == NULL, ("udp_attach: inp != NULL"));
1417cfa1ca9dSYoshinobu Inoue 	error = soreserve(so, udp_sendspace, udp_recvspace);
1418f24618aaSRobert Watson 	if (error)
14193329b236SRobert Watson 		return (error);
1420603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
1421603724d3SBjoern A. Zeeb 	error = in_pcballoc(so, &V_udbinfo);
142253b57cd1SSam Leffler 	if (error) {
1423603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
14243329b236SRobert Watson 		return (error);
142553b57cd1SSam Leffler 	}
1426cfa1ca9dSYoshinobu Inoue 
142768b5629bSRobert Watson 	inp = sotoinpcb(so);
1428cfa1ca9dSYoshinobu Inoue 	inp->inp_vflag |= INP_IPV4;
1429603724d3SBjoern A. Zeeb 	inp->inp_ip_ttl = V_ip_defttl;
14306a9148feSBjoern A. Zeeb 
14316a9148feSBjoern A. Zeeb 	error = udp_newudpcb(inp);
14326a9148feSBjoern A. Zeeb 	if (error) {
14336a9148feSBjoern A. Zeeb 		in_pcbdetach(inp);
14346a9148feSBjoern A. Zeeb 		in_pcbfree(inp);
14356a9148feSBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
14366a9148feSBjoern A. Zeeb 		return (error);
14376a9148feSBjoern A. Zeeb 	}
14386a9148feSBjoern A. Zeeb 
1439c7c7ea4bSRandall Stewart 	INP_WUNLOCK(inp);
14406a9148feSBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
1441c7c7ea4bSRandall Stewart 	return (0);
1442c7c7ea4bSRandall Stewart }
144379288c11SBjoern A. Zeeb #endif /* INET */
1444c7c7ea4bSRandall Stewart 
1445c7c7ea4bSRandall Stewart int
1446c7c7ea4bSRandall Stewart udp_set_kernel_tunneling(struct socket *so, udp_tun_func_t f)
1447c7c7ea4bSRandall Stewart {
1448c7c7ea4bSRandall Stewart 	struct inpcb *inp;
14496a9148feSBjoern A. Zeeb 	struct udpcb *up;
1450c7c7ea4bSRandall Stewart 
145168b5629bSRobert Watson 	KASSERT(so->so_type == SOCK_DGRAM,
145268b5629bSRobert Watson 	    ("udp_set_kernel_tunneling: !dgram"));
145368b5629bSRobert Watson 	inp = sotoinpcb(so);
145468b5629bSRobert Watson 	KASSERT(inp != NULL, ("udp_set_kernel_tunneling: inp == NULL"));
1455c7c7ea4bSRandall Stewart 	INP_WLOCK(inp);
14566a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
14576a9148feSBjoern A. Zeeb 	if (up->u_tun_func != NULL) {
1458bbb0e3d9SRandall Stewart 		INP_WUNLOCK(inp);
1459bbb0e3d9SRandall Stewart 		return (EBUSY);
1460bbb0e3d9SRandall Stewart 	}
14616a9148feSBjoern A. Zeeb 	up->u_tun_func = f;
14628501a69cSRobert Watson 	INP_WUNLOCK(inp);
14633329b236SRobert Watson 	return (0);
1464df8bae1dSRodney W. Grimes }
1465d0390e05SGarrett Wollman 
146679288c11SBjoern A. Zeeb #ifdef INET
1467d0390e05SGarrett Wollman static int
1468b40ce416SJulian Elischer udp_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
1469d0390e05SGarrett Wollman {
1470d0390e05SGarrett Wollman 	struct inpcb *inp;
1471277afaffSRobert Watson 	int error;
1472d0390e05SGarrett Wollman 
1473d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
147414ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_bind: inp == NULL"));
14758501a69cSRobert Watson 	INP_WLOCK(inp);
1476fa046d87SRobert Watson 	INP_HASH_WLOCK(&V_udbinfo);
1477b0330ed9SPawel Jakub Dawidek 	error = in_pcbbind(inp, nam, td->td_ucred);
1478fa046d87SRobert Watson 	INP_HASH_WUNLOCK(&V_udbinfo);
14798501a69cSRobert Watson 	INP_WUNLOCK(inp);
14803329b236SRobert Watson 	return (error);
1481d0390e05SGarrett Wollman }
1482d0390e05SGarrett Wollman 
1483a152f8a3SRobert Watson static void
1484a152f8a3SRobert Watson udp_close(struct socket *so)
1485a152f8a3SRobert Watson {
1486a152f8a3SRobert Watson 	struct inpcb *inp;
1487a152f8a3SRobert Watson 
1488a152f8a3SRobert Watson 	inp = sotoinpcb(so);
1489a152f8a3SRobert Watson 	KASSERT(inp != NULL, ("udp_close: inp == NULL"));
14908501a69cSRobert Watson 	INP_WLOCK(inp);
1491a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1492fa046d87SRobert Watson 		INP_HASH_WLOCK(&V_udbinfo);
1493a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1494a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1495fa046d87SRobert Watson 		INP_HASH_WUNLOCK(&V_udbinfo);
1496a152f8a3SRobert Watson 		soisdisconnected(so);
1497a152f8a3SRobert Watson 	}
14988501a69cSRobert Watson 	INP_WUNLOCK(inp);
1499a152f8a3SRobert Watson }
1500a152f8a3SRobert Watson 
1501d0390e05SGarrett Wollman static int
1502b40ce416SJulian Elischer udp_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
1503d0390e05SGarrett Wollman {
1504d0390e05SGarrett Wollman 	struct inpcb *inp;
1505277afaffSRobert Watson 	int error;
150675c13541SPoul-Henning Kamp 	struct sockaddr_in *sin;
1507d0390e05SGarrett Wollman 
1508d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
150914ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_connect: inp == NULL"));
15108501a69cSRobert Watson 	INP_WLOCK(inp);
1511f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
15128501a69cSRobert Watson 		INP_WUNLOCK(inp);
15133329b236SRobert Watson 		return (EISCONN);
1514f76fcf6dSJeffrey Hsu 	}
151575c13541SPoul-Henning Kamp 	sin = (struct sockaddr_in *)nam;
1516b89e82ddSJamie Gritton 	error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1517b89e82ddSJamie Gritton 	if (error != 0) {
1518413628a7SBjoern A. Zeeb 		INP_WUNLOCK(inp);
1519b89e82ddSJamie Gritton 		return (error);
1520413628a7SBjoern A. Zeeb 	}
1521fa046d87SRobert Watson 	INP_HASH_WLOCK(&V_udbinfo);
1522b0330ed9SPawel Jakub Dawidek 	error = in_pcbconnect(inp, nam, td->td_ucred);
1523fa046d87SRobert Watson 	INP_HASH_WUNLOCK(&V_udbinfo);
15244cc20ab1SSeigo Tanimura 	if (error == 0)
1525df8bae1dSRodney W. Grimes 		soisconnected(so);
15268501a69cSRobert Watson 	INP_WUNLOCK(inp);
15273329b236SRobert Watson 	return (error);
1528df8bae1dSRodney W. Grimes }
1529d0390e05SGarrett Wollman 
1530bc725eafSRobert Watson static void
1531d0390e05SGarrett Wollman udp_detach(struct socket *so)
1532d0390e05SGarrett Wollman {
1533d0390e05SGarrett Wollman 	struct inpcb *inp;
15346a9148feSBjoern A. Zeeb 	struct udpcb *up;
1535d0390e05SGarrett Wollman 
1536d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
153714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_detach: inp == NULL"));
1538a152f8a3SRobert Watson 	KASSERT(inp->inp_faddr.s_addr == INADDR_ANY,
1539a152f8a3SRobert Watson 	    ("udp_detach: not disconnected"));
1540603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
15418501a69cSRobert Watson 	INP_WLOCK(inp);
15426a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
15436a9148feSBjoern A. Zeeb 	KASSERT(up != NULL, ("%s: up == NULL", __func__));
15446a9148feSBjoern A. Zeeb 	inp->inp_ppcb = NULL;
1545d0390e05SGarrett Wollman 	in_pcbdetach(inp);
154614ba8addSRobert Watson 	in_pcbfree(inp);
1547603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
15486a9148feSBjoern A. Zeeb 	udp_discardcb(up);
1549d0390e05SGarrett Wollman }
1550d0390e05SGarrett Wollman 
1551d0390e05SGarrett Wollman static int
1552d0390e05SGarrett Wollman udp_disconnect(struct socket *so)
1553d0390e05SGarrett Wollman {
1554d0390e05SGarrett Wollman 	struct inpcb *inp;
1555d0390e05SGarrett Wollman 
1556d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
155714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_disconnect: inp == NULL"));
15588501a69cSRobert Watson 	INP_WLOCK(inp);
1559f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr == INADDR_ANY) {
15608501a69cSRobert Watson 		INP_WUNLOCK(inp);
15613329b236SRobert Watson 		return (ENOTCONN);
1562f76fcf6dSJeffrey Hsu 	}
1563fa046d87SRobert Watson 	INP_HASH_WLOCK(&V_udbinfo);
1564df8bae1dSRodney W. Grimes 	in_pcbdisconnect(inp);
1565df8bae1dSRodney W. Grimes 	inp->inp_laddr.s_addr = INADDR_ANY;
1566fa046d87SRobert Watson 	INP_HASH_WUNLOCK(&V_udbinfo);
1567d45e4f99SMaxim Konovalov 	SOCK_LOCK(so);
1568d45e4f99SMaxim Konovalov 	so->so_state &= ~SS_ISCONNECTED;		/* XXX */
1569d45e4f99SMaxim Konovalov 	SOCK_UNLOCK(so);
15708501a69cSRobert Watson 	INP_WUNLOCK(inp);
15713329b236SRobert Watson 	return (0);
1572df8bae1dSRodney W. Grimes }
1573df8bae1dSRodney W. Grimes 
1574d0390e05SGarrett Wollman static int
157557bf258eSGarrett Wollman udp_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
1576b40ce416SJulian Elischer     struct mbuf *control, struct thread *td)
1577d0390e05SGarrett Wollman {
1578d0390e05SGarrett Wollman 	struct inpcb *inp;
1579d0390e05SGarrett Wollman 
1580d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
158114ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_send: inp == NULL"));
15823329b236SRobert Watson 	return (udp_output(inp, m, addr, control, td));
1583d0390e05SGarrett Wollman }
158479288c11SBjoern A. Zeeb #endif /* INET */
1585d0390e05SGarrett Wollman 
158676429de4SYoshinobu Inoue int
1587d0390e05SGarrett Wollman udp_shutdown(struct socket *so)
1588d0390e05SGarrett Wollman {
1589d0390e05SGarrett Wollman 	struct inpcb *inp;
1590d0390e05SGarrett Wollman 
1591d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
159214ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_shutdown: inp == NULL"));
15938501a69cSRobert Watson 	INP_WLOCK(inp);
1594d0390e05SGarrett Wollman 	socantsendmore(so);
15958501a69cSRobert Watson 	INP_WUNLOCK(inp);
15963329b236SRobert Watson 	return (0);
1597d0390e05SGarrett Wollman }
1598d0390e05SGarrett Wollman 
159979288c11SBjoern A. Zeeb #ifdef INET
1600d0390e05SGarrett Wollman struct pr_usrreqs udp_usrreqs = {
1601756d52a1SPoul-Henning Kamp 	.pru_abort =		udp_abort,
1602756d52a1SPoul-Henning Kamp 	.pru_attach =		udp_attach,
1603756d52a1SPoul-Henning Kamp 	.pru_bind =		udp_bind,
1604756d52a1SPoul-Henning Kamp 	.pru_connect =		udp_connect,
1605756d52a1SPoul-Henning Kamp 	.pru_control =		in_control,
1606756d52a1SPoul-Henning Kamp 	.pru_detach =		udp_detach,
1607756d52a1SPoul-Henning Kamp 	.pru_disconnect =	udp_disconnect,
160854d642bbSRobert Watson 	.pru_peeraddr =		in_getpeeraddr,
1609756d52a1SPoul-Henning Kamp 	.pru_send =		udp_send,
16105df3e839SRobert Watson 	.pru_soreceive =	soreceive_dgram,
161159b8854eSRobert Watson 	.pru_sosend =		sosend_dgram,
1612756d52a1SPoul-Henning Kamp 	.pru_shutdown =		udp_shutdown,
161354d642bbSRobert Watson 	.pru_sockaddr =		in_getsockaddr,
1614a152f8a3SRobert Watson 	.pru_sosetlabel =	in_pcbsosetlabel,
1615a152f8a3SRobert Watson 	.pru_close =		udp_close,
1616d0390e05SGarrett Wollman };
161779288c11SBjoern A. Zeeb #endif /* INET */
1618