xref: /freebsd/sys/netinet/udp_usrreq.c (revision 82cea7e6f3da448dfadd071ac81f4a0b1e41a356)
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
53329b236SRobert Watson  * All rights reserved.
6df8bae1dSRodney W. Grimes  *
7df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
8df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
9df8bae1dSRodney W. Grimes  * are met:
10df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
11df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
12df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
13df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
14df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
15df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
16df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
17df8bae1dSRodney W. Grimes  *    without specific prior written permission.
18df8bae1dSRodney W. Grimes  *
19df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
20df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
23df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
30df8bae1dSRodney W. Grimes  *
316dfab5b1SGarrett Wollman  *	@(#)udp_usrreq.c	8.6 (Berkeley) 5/23/95
32df8bae1dSRodney W. Grimes  */
33df8bae1dSRodney W. Grimes 
344b421e2dSMike Silbersack #include <sys/cdefs.h>
354b421e2dSMike Silbersack __FBSDID("$FreeBSD$");
364b421e2dSMike Silbersack 
370b4ae859SGleb Smirnoff #include "opt_ipfw.h"
38cfa1ca9dSYoshinobu Inoue #include "opt_inet6.h"
39f5514f08SRobert Watson #include "opt_ipsec.h"
40cfa1ca9dSYoshinobu Inoue 
41df8bae1dSRodney W. Grimes #include <sys/param.h>
42960ed29cSSeigo Tanimura #include <sys/domain.h>
434f590175SPaul Saab #include <sys/eventhandler.h>
44960ed29cSSeigo Tanimura #include <sys/jail.h>
45b110a8a2SGarrett Wollman #include <sys/kernel.h>
46960ed29cSSeigo Tanimura #include <sys/lock.h>
47df8bae1dSRodney W. Grimes #include <sys/malloc.h>
48df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
49acd3428bSRobert Watson #include <sys/priv.h>
50490d50b6SBrian Feldman #include <sys/proc.h>
51df8bae1dSRodney W. Grimes #include <sys/protosw.h>
52960ed29cSSeigo Tanimura #include <sys/signalvar.h>
53df8bae1dSRodney W. Grimes #include <sys/socket.h>
54df8bae1dSRodney W. Grimes #include <sys/socketvar.h>
55960ed29cSSeigo Tanimura #include <sys/sx.h>
56b5e8ce9fSBruce Evans #include <sys/sysctl.h>
57816a3d83SPoul-Henning Kamp #include <sys/syslog.h>
58f5514f08SRobert Watson #include <sys/systm.h>
598781d8e9SBruce Evans 
6069c2d429SJeff Roberson #include <vm/uma.h>
61df8bae1dSRodney W. Grimes 
62df8bae1dSRodney W. Grimes #include <net/if.h>
63df8bae1dSRodney W. Grimes #include <net/route.h>
64df8bae1dSRodney W. Grimes 
65df8bae1dSRodney W. Grimes #include <netinet/in.h>
66960ed29cSSeigo Tanimura #include <netinet/in_pcb.h>
67f5514f08SRobert Watson #include <netinet/in_systm.h>
68960ed29cSSeigo Tanimura #include <netinet/in_var.h>
69df8bae1dSRodney W. Grimes #include <netinet/ip.h>
70cfa1ca9dSYoshinobu Inoue #ifdef INET6
71cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h>
72cfa1ca9dSYoshinobu Inoue #endif
73960ed29cSSeigo Tanimura #include <netinet/ip_icmp.h>
74960ed29cSSeigo Tanimura #include <netinet/icmp_var.h>
75df8bae1dSRodney W. Grimes #include <netinet/ip_var.h>
76ef39adf0SAndre Oppermann #include <netinet/ip_options.h>
77cfa1ca9dSYoshinobu Inoue #ifdef INET6
78cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h>
79cfa1ca9dSYoshinobu Inoue #endif
80df8bae1dSRodney W. Grimes #include <netinet/udp.h>
81df8bae1dSRodney W. Grimes #include <netinet/udp_var.h>
82df8bae1dSRodney W. Grimes 
83b2630c29SGeorge V. Neville-Neil #ifdef IPSEC
84b9234fafSSam Leffler #include <netipsec/ipsec.h>
857b495c44SVANHULLEBUS Yvan #include <netipsec/esp.h>
863329b236SRobert Watson #endif
87b9234fafSSam Leffler 
88db4f9cc7SJonathan Lemon #include <machine/in_cksum.h>
89db4f9cc7SJonathan Lemon 
90aed55708SRobert Watson #include <security/mac/mac_framework.h>
91aed55708SRobert Watson 
92df8bae1dSRodney W. Grimes /*
93df8bae1dSRodney W. Grimes  * UDP protocol implementation.
94df8bae1dSRodney W. Grimes  * Per RFC 768, August, 1980.
95df8bae1dSRodney W. Grimes  */
9674eb3236SWarner Losh 
9774eb3236SWarner Losh /*
983329b236SRobert Watson  * BSD 4.2 defaulted the udp checksum to be off.  Turning off udp checksums
993329b236SRobert Watson  * removes the only data integrity mechanism for packets and malformed
100f5514f08SRobert Watson  * packets that would otherwise be discarded due to bad checksums, and may
101f5514f08SRobert Watson  * cause problems (especially for NFS data blocks).
10274eb3236SWarner Losh  */
103f5514f08SRobert Watson static int	udp_cksum = 1;
104f5514f08SRobert Watson SYSCTL_INT(_net_inet_udp, UDPCTL_CHECKSUM, checksum, CTLFLAG_RW, &udp_cksum,
10541698ebfSTom Rhodes     0, "compute udp checksum");
106df8bae1dSRodney W. Grimes 
107afdb4274SRobert Watson int	udp_log_in_vain = 0;
108816a3d83SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, OID_AUTO, log_in_vain, CTLFLAG_RW,
109afdb4274SRobert Watson     &udp_log_in_vain, 0, "Log all incoming UDP packets");
110816a3d83SPoul-Henning Kamp 
111*82cea7e6SBjoern A. Zeeb VNET_DEFINE(int, udp_blackhole) = 0;
112eddfbb76SRobert Watson SYSCTL_VNET_INT(_net_inet_udp, OID_AUTO, blackhole, CTLFLAG_RW,
113eddfbb76SRobert Watson     &VNET_NAME(udp_blackhole), 0,
1143329b236SRobert Watson     "Do not send port unreachables for refused connects");
11516f7f31fSGeoff Rehmet 
11643bbb6aaSRobert Watson u_long	udp_sendspace = 9216;		/* really max datagram size */
11743bbb6aaSRobert Watson 					/* 40 1K datagrams */
11843bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_MAXDGRAM, maxdgram, CTLFLAG_RW,
11943bbb6aaSRobert Watson     &udp_sendspace, 0, "Maximum outgoing UDP datagram size");
12043bbb6aaSRobert Watson 
12143bbb6aaSRobert Watson u_long	udp_recvspace = 40 * (1024 +
12243bbb6aaSRobert Watson #ifdef INET6
12343bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in6)
12443bbb6aaSRobert Watson #else
12543bbb6aaSRobert Watson 				      sizeof(struct sockaddr_in)
12643bbb6aaSRobert Watson #endif
12743bbb6aaSRobert Watson 				      );
12843bbb6aaSRobert Watson 
12943bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_RECVSPACE, recvspace, CTLFLAG_RW,
13043bbb6aaSRobert Watson     &udp_recvspace, 0, "Maximum space for incoming UDP datagrams");
13143bbb6aaSRobert Watson 
132eddfbb76SRobert Watson VNET_DEFINE(struct inpcbhead, udb);		/* from udp_var.h */
133eddfbb76SRobert Watson VNET_DEFINE(struct inpcbinfo, udbinfo);
134eddfbb76SRobert Watson static VNET_DEFINE(uma_zone_t, udpcb_zone);
1351e77c105SRobert Watson #define	V_udpcb_zone			VNET(udpcb_zone)
13615bd2b43SDavid Greenman 
13715bd2b43SDavid Greenman #ifndef UDBHASHSIZE
138e2ed8f35SAlexander Motin #define	UDBHASHSIZE	128
13915bd2b43SDavid Greenman #endif
14015bd2b43SDavid Greenman 
141*82cea7e6SBjoern A. Zeeb VNET_DEFINE(struct udpstat, udpstat);		/* from udp_var.h */
142eddfbb76SRobert Watson SYSCTL_VNET_STRUCT(_net_inet_udp, UDPCTL_STATS, stats, CTLFLAG_RW,
143eddfbb76SRobert Watson     &VNET_NAME(udpstat), udpstat,
1448b615593SMarko Zec     "UDP statistics (struct udpstat, netinet/udp_var.h)");
145f2ea20e6SGarrett Wollman 
146bc725eafSRobert Watson static void	udp_detach(struct socket *so);
1474d77a549SAlfred Perlstein static int	udp_output(struct inpcb *, struct mbuf *, struct sockaddr *,
1484d77a549SAlfred Perlstein 		    struct mbuf *, struct thread *);
1497b495c44SVANHULLEBUS Yvan #ifdef IPSEC
1507b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
1517b495c44SVANHULLEBUS Yvan #define	UF_ESPINUDP_ALL	(UF_ESPINUDP_NON_IKE|UF_ESPINUDP)
1527b495c44SVANHULLEBUS Yvan #ifdef INET
1537b495c44SVANHULLEBUS Yvan static struct mbuf *udp4_espdecap(struct inpcb *, struct mbuf *, int);
1547b495c44SVANHULLEBUS Yvan #endif
1557b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
1567b495c44SVANHULLEBUS Yvan #endif /* IPSEC */
157df8bae1dSRodney W. Grimes 
1584f590175SPaul Saab static void
1594f590175SPaul Saab udp_zone_change(void *tag)
1604f590175SPaul Saab {
1614f590175SPaul Saab 
162603724d3SBjoern A. Zeeb 	uma_zone_set_max(V_udbinfo.ipi_zone, maxsockets);
1636a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
1644f590175SPaul Saab }
1654f590175SPaul Saab 
166d915b280SStephan Uphoff static int
167d915b280SStephan Uphoff udp_inpcb_init(void *mem, int size, int flags)
168d915b280SStephan Uphoff {
169af1ee11dSRobert Watson 	struct inpcb *inp;
17008651e1fSJohn Baldwin 
171af1ee11dSRobert Watson 	inp = mem;
172d915b280SStephan Uphoff 	INP_LOCK_INIT(inp, "inp", "udpinp");
173d915b280SStephan Uphoff 	return (0);
174d915b280SStephan Uphoff }
175d915b280SStephan Uphoff 
176df8bae1dSRodney W. Grimes void
177af1ee11dSRobert Watson udp_init(void)
178df8bae1dSRodney W. Grimes {
179af1ee11dSRobert Watson 
1809bcd427bSRobert Watson 	in_pcbinfo_init(&V_udbinfo, "udp", &V_udb, UDBHASHSIZE, UDBHASHSIZE,
1819bcd427bSRobert Watson 	    "udp_inpcb", udp_inpcb_init, NULL, UMA_ZONE_NOFREE);
1826a9148feSBjoern A. Zeeb 	V_udpcb_zone = uma_zcreate("udpcb", sizeof(struct udpcb),
1836a9148feSBjoern A. Zeeb 	    NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, UMA_ZONE_NOFREE);
1846a9148feSBjoern A. Zeeb 	uma_zone_set_max(V_udpcb_zone, maxsockets);
1854f590175SPaul Saab 	EVENTHANDLER_REGISTER(maxsockets_change, udp_zone_change, NULL,
1864f590175SPaul Saab 	    EVENTHANDLER_PRI_ANY);
187df8bae1dSRodney W. Grimes }
188df8bae1dSRodney W. Grimes 
189315e3e38SRobert Watson /*
190315e3e38SRobert Watson  * Kernel module interface for updating udpstat.  The argument is an index
191315e3e38SRobert Watson  * into udpstat treated as an array of u_long.  While this encodes the
192315e3e38SRobert Watson  * general layout of udpstat into the caller, it doesn't encode its location,
193315e3e38SRobert Watson  * so that future changes to add, for example, per-CPU stats support won't
194315e3e38SRobert Watson  * cause binary compatibility problems for kernel modules.
195315e3e38SRobert Watson  */
196315e3e38SRobert Watson void
197315e3e38SRobert Watson kmod_udpstat_inc(int statnum)
198315e3e38SRobert Watson {
199315e3e38SRobert Watson 
200315e3e38SRobert Watson 	(*((u_long *)&V_udpstat + statnum))++;
201315e3e38SRobert Watson }
202315e3e38SRobert Watson 
2036a9148feSBjoern A. Zeeb int
2046a9148feSBjoern A. Zeeb udp_newudpcb(struct inpcb *inp)
2056a9148feSBjoern A. Zeeb {
2066a9148feSBjoern A. Zeeb 	struct udpcb *up;
2076a9148feSBjoern A. Zeeb 
2086a9148feSBjoern A. Zeeb 	up = uma_zalloc(V_udpcb_zone, M_NOWAIT | M_ZERO);
2096a9148feSBjoern A. Zeeb 	if (up == NULL)
2106a9148feSBjoern A. Zeeb 		return (ENOBUFS);
2116a9148feSBjoern A. Zeeb 	inp->inp_ppcb = up;
2126a9148feSBjoern A. Zeeb 	return (0);
2136a9148feSBjoern A. Zeeb }
2146a9148feSBjoern A. Zeeb 
2156a9148feSBjoern A. Zeeb void
2166a9148feSBjoern A. Zeeb udp_discardcb(struct udpcb *up)
2176a9148feSBjoern A. Zeeb {
2186a9148feSBjoern A. Zeeb 
2196a9148feSBjoern A. Zeeb 	uma_zfree(V_udpcb_zone, up);
2206a9148feSBjoern A. Zeeb }
2216a9148feSBjoern A. Zeeb 
222bc29160dSMarko Zec #ifdef VIMAGE
223bc29160dSMarko Zec void
224bc29160dSMarko Zec udp_destroy(void)
225bc29160dSMarko Zec {
226bc29160dSMarko Zec 
2279bcd427bSRobert Watson 	in_pcbinfo_destroy(&V_udbinfo);
228391dab1cSBjoern A. Zeeb 	uma_zdestroy(V_udpcb_zone);
229bc29160dSMarko Zec }
230bc29160dSMarko Zec #endif
231bc29160dSMarko Zec 
23243bbb6aaSRobert Watson /*
23343bbb6aaSRobert Watson  * Subroutine of udp_input(), which appends the provided mbuf chain to the
23443bbb6aaSRobert Watson  * passed pcb/socket.  The caller must provide a sockaddr_in via udp_in that
23543bbb6aaSRobert Watson  * contains the source address.  If the socket ends up being an IPv6 socket,
23643bbb6aaSRobert Watson  * udp_append() will convert to a sockaddr_in6 before passing the address
23743bbb6aaSRobert Watson  * into the socket code.
23843bbb6aaSRobert Watson  */
23943bbb6aaSRobert Watson static void
24043bbb6aaSRobert Watson udp_append(struct inpcb *inp, struct ip *ip, struct mbuf *n, int off,
24143bbb6aaSRobert Watson     struct sockaddr_in *udp_in)
24243bbb6aaSRobert Watson {
24343bbb6aaSRobert Watson 	struct sockaddr *append_sa;
24443bbb6aaSRobert Watson 	struct socket *so;
24543bbb6aaSRobert Watson 	struct mbuf *opts = 0;
24643bbb6aaSRobert Watson #ifdef INET6
24743bbb6aaSRobert Watson 	struct sockaddr_in6 udp_in6;
24843bbb6aaSRobert Watson #endif
2497b495c44SVANHULLEBUS Yvan #ifdef IPSEC
2507b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
2517b495c44SVANHULLEBUS Yvan #ifdef INET
2527b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
2537b495c44SVANHULLEBUS Yvan #endif
2547b495c44SVANHULLEBUS Yvan #endif
2557b495c44SVANHULLEBUS Yvan #endif
25643bbb6aaSRobert Watson 
257119d85f6SRobert Watson 	INP_RLOCK_ASSERT(inp);
25843bbb6aaSRobert Watson 
25943bbb6aaSRobert Watson #ifdef IPSEC
26043bbb6aaSRobert Watson 	/* Check AH/ESP integrity. */
26143bbb6aaSRobert Watson 	if (ipsec4_in_reject(n, inp)) {
26243bbb6aaSRobert Watson 		m_freem(n);
263603724d3SBjoern A. Zeeb 		V_ipsec4stat.in_polvio++;
26443bbb6aaSRobert Watson 		return;
26543bbb6aaSRobert Watson 	}
2667b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
2677b495c44SVANHULLEBUS Yvan #ifdef INET
2687b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
2697b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
2707b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_ALL) {	/* IPSec UDP encaps. */
2717b495c44SVANHULLEBUS Yvan 		n = udp4_espdecap(inp, n, off);
2727b495c44SVANHULLEBUS Yvan 		if (n == NULL)				/* Consumed. */
2737b495c44SVANHULLEBUS Yvan 			return;
2747b495c44SVANHULLEBUS Yvan 	}
2757b495c44SVANHULLEBUS Yvan #endif /* INET */
2767b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */
27743bbb6aaSRobert Watson #endif /* IPSEC */
27843bbb6aaSRobert Watson #ifdef MAC
27930d239bcSRobert Watson 	if (mac_inpcb_check_deliver(inp, n) != 0) {
28043bbb6aaSRobert Watson 		m_freem(n);
28143bbb6aaSRobert Watson 		return;
28243bbb6aaSRobert Watson 	}
28343bbb6aaSRobert Watson #endif
28443bbb6aaSRobert Watson 	if (inp->inp_flags & INP_CONTROLOPTS ||
28543bbb6aaSRobert Watson 	    inp->inp_socket->so_options & (SO_TIMESTAMP | SO_BINTIME)) {
28643bbb6aaSRobert Watson #ifdef INET6
2879a38ba81SBjoern A. Zeeb 		if (inp->inp_vflag & INP_IPV6)
28848d48eb9SBjoern A. Zeeb 			(void)ip6_savecontrol_v4(inp, n, &opts, NULL);
2899a38ba81SBjoern A. Zeeb 		else
29043bbb6aaSRobert Watson #endif
29143bbb6aaSRobert Watson 			ip_savecontrol(inp, &opts, ip, n);
29243bbb6aaSRobert Watson 	}
29343bbb6aaSRobert Watson #ifdef INET6
29443bbb6aaSRobert Watson 	if (inp->inp_vflag & INP_IPV6) {
29543bbb6aaSRobert Watson 		bzero(&udp_in6, sizeof(udp_in6));
29643bbb6aaSRobert Watson 		udp_in6.sin6_len = sizeof(udp_in6);
29743bbb6aaSRobert Watson 		udp_in6.sin6_family = AF_INET6;
29843bbb6aaSRobert Watson 		in6_sin_2_v4mapsin6(udp_in, &udp_in6);
29943bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)&udp_in6;
30043bbb6aaSRobert Watson 	} else
30143bbb6aaSRobert Watson #endif
30243bbb6aaSRobert Watson 		append_sa = (struct sockaddr *)udp_in;
30343bbb6aaSRobert Watson 	m_adj(n, off);
30443bbb6aaSRobert Watson 
30543bbb6aaSRobert Watson 	so = inp->inp_socket;
30643bbb6aaSRobert Watson 	SOCKBUF_LOCK(&so->so_rcv);
30743bbb6aaSRobert Watson 	if (sbappendaddr_locked(&so->so_rcv, append_sa, n, opts) == 0) {
30843bbb6aaSRobert Watson 		SOCKBUF_UNLOCK(&so->so_rcv);
30943bbb6aaSRobert Watson 		m_freem(n);
31043bbb6aaSRobert Watson 		if (opts)
31143bbb6aaSRobert Watson 			m_freem(opts);
312026decb8SRobert Watson 		UDPSTAT_INC(udps_fullsock);
31343bbb6aaSRobert Watson 	} else
31443bbb6aaSRobert Watson 		sorwakeup_locked(so);
31543bbb6aaSRobert Watson }
31643bbb6aaSRobert Watson 
317df8bae1dSRodney W. Grimes void
3183329b236SRobert Watson udp_input(struct mbuf *m, int off)
319df8bae1dSRodney W. Grimes {
320cfa1ca9dSYoshinobu Inoue 	int iphlen = off;
3213329b236SRobert Watson 	struct ip *ip;
3223329b236SRobert Watson 	struct udphdr *uh;
32371498f30SBruce M Simpson 	struct ifnet *ifp;
3243329b236SRobert Watson 	struct inpcb *inp;
3256a9148feSBjoern A. Zeeb 	struct udpcb *up;
326df8bae1dSRodney W. Grimes 	int len;
327df8bae1dSRodney W. Grimes 	struct ip save_ip;
328d4b509bdSRobert Watson 	struct sockaddr_in udp_in;
3290b4ae859SGleb Smirnoff #ifdef IPFIREWALL_FORWARD
3300b4ae859SGleb Smirnoff 	struct m_tag *fwd_tag;
3310b4ae859SGleb Smirnoff #endif
332df8bae1dSRodney W. Grimes 
33371498f30SBruce M Simpson 	ifp = m->m_pkthdr.rcvif;
334026decb8SRobert Watson 	UDPSTAT_INC(udps_ipackets);
335df8bae1dSRodney W. Grimes 
336df8bae1dSRodney W. Grimes 	/*
3373329b236SRobert Watson 	 * Strip IP options, if any; should skip this, make available to
3383329b236SRobert Watson 	 * user, and use on returned packets, but we don't yet have a way to
3393329b236SRobert Watson 	 * check the checksum with options still present.
340df8bae1dSRodney W. Grimes 	 */
341df8bae1dSRodney W. Grimes 	if (iphlen > sizeof (struct ip)) {
342df8bae1dSRodney W. Grimes 		ip_stripoptions(m, (struct mbuf *)0);
343df8bae1dSRodney W. Grimes 		iphlen = sizeof(struct ip);
344df8bae1dSRodney W. Grimes 	}
345df8bae1dSRodney W. Grimes 
346df8bae1dSRodney W. Grimes 	/*
347df8bae1dSRodney W. Grimes 	 * Get IP and UDP header together in first mbuf.
348df8bae1dSRodney W. Grimes 	 */
349df8bae1dSRodney W. Grimes 	ip = mtod(m, struct ip *);
350df8bae1dSRodney W. Grimes 	if (m->m_len < iphlen + sizeof(struct udphdr)) {
351df8bae1dSRodney W. Grimes 		if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) {
352026decb8SRobert Watson 			UDPSTAT_INC(udps_hdrops);
353df8bae1dSRodney W. Grimes 			return;
354df8bae1dSRodney W. Grimes 		}
355df8bae1dSRodney W. Grimes 		ip = mtod(m, struct ip *);
356df8bae1dSRodney W. Grimes 	}
357df8bae1dSRodney W. Grimes 	uh = (struct udphdr *)((caddr_t)ip + iphlen);
358df8bae1dSRodney W. Grimes 
3593329b236SRobert Watson 	/*
3603329b236SRobert Watson 	 * Destination port of 0 is illegal, based on RFC768.
3613329b236SRobert Watson 	 */
362686cdd19SJun-ichiro itojun Hagino 	if (uh->uh_dport == 0)
363f76fcf6dSJeffrey Hsu 		goto badunlocked;
364686cdd19SJun-ichiro itojun Hagino 
365df8bae1dSRodney W. Grimes 	/*
3663329b236SRobert Watson 	 * Construct sockaddr format source address.  Stuff source address
3673329b236SRobert Watson 	 * and datagram in user buffer.
368b9234fafSSam Leffler 	 */
369d4b509bdSRobert Watson 	bzero(&udp_in, sizeof(udp_in));
370d4b509bdSRobert Watson 	udp_in.sin_len = sizeof(udp_in);
371d4b509bdSRobert Watson 	udp_in.sin_family = AF_INET;
372b9234fafSSam Leffler 	udp_in.sin_port = uh->uh_sport;
373b9234fafSSam Leffler 	udp_in.sin_addr = ip->ip_src;
374b9234fafSSam Leffler 
375b9234fafSSam Leffler 	/*
376af1ee11dSRobert Watson 	 * Make mbuf data length reflect UDP length.  If not enough data to
377af1ee11dSRobert Watson 	 * reflect UDP length, drop.
378df8bae1dSRodney W. Grimes 	 */
379df8bae1dSRodney W. Grimes 	len = ntohs((u_short)uh->uh_ulen);
380df8bae1dSRodney W. Grimes 	if (ip->ip_len != len) {
3817eb7a449SAndras Olah 		if (len > ip->ip_len || len < sizeof(struct udphdr)) {
382026decb8SRobert Watson 			UDPSTAT_INC(udps_badlen);
383f76fcf6dSJeffrey Hsu 			goto badunlocked;
384df8bae1dSRodney W. Grimes 		}
385df8bae1dSRodney W. Grimes 		m_adj(m, len - ip->ip_len);
386df8bae1dSRodney W. Grimes 		/* ip->ip_len = len; */
387df8bae1dSRodney W. Grimes 	}
3883329b236SRobert Watson 
389df8bae1dSRodney W. Grimes 	/*
3903329b236SRobert Watson 	 * Save a copy of the IP header in case we want restore it for
3913329b236SRobert Watson 	 * sending an ICMP error message in response.
392df8bae1dSRodney W. Grimes 	 */
393603724d3SBjoern A. Zeeb 	if (!V_udp_blackhole)
394df8bae1dSRodney W. Grimes 		save_ip = *ip;
395cce418d3SMatt Jacob 	else
396cce418d3SMatt Jacob 		memset(&save_ip, 0, sizeof(save_ip));
397df8bae1dSRodney W. Grimes 
398df8bae1dSRodney W. Grimes 	/*
399df8bae1dSRodney W. Grimes 	 * Checksum extended UDP header and data.
400df8bae1dSRodney W. Grimes 	 */
4016dfab5b1SGarrett Wollman 	if (uh->uh_sum) {
40239629c92SDavid Malone 		u_short uh_sum;
40339629c92SDavid Malone 
404db4f9cc7SJonathan Lemon 		if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID) {
405db4f9cc7SJonathan Lemon 			if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR)
40639629c92SDavid Malone 				uh_sum = m->m_pkthdr.csum_data;
407db4f9cc7SJonathan Lemon 			else
40839629c92SDavid Malone 				uh_sum = in_pseudo(ip->ip_src.s_addr,
409506f4949SRuslan Ermilov 				    ip->ip_dst.s_addr, htonl((u_short)len +
410db4f9cc7SJonathan Lemon 				    m->m_pkthdr.csum_data + IPPROTO_UDP));
41139629c92SDavid Malone 			uh_sum ^= 0xffff;
412db4f9cc7SJonathan Lemon 		} else {
413cb342100SHajimu UMEMOTO 			char b[9];
414af1ee11dSRobert Watson 
415cb342100SHajimu UMEMOTO 			bcopy(((struct ipovly *)ip)->ih_x1, b, 9);
4166effc713SDoug Rabson 			bzero(((struct ipovly *)ip)->ih_x1, 9);
417df8bae1dSRodney W. Grimes 			((struct ipovly *)ip)->ih_len = uh->uh_ulen;
41839629c92SDavid Malone 			uh_sum = in_cksum(m, len + sizeof (struct ip));
419cb342100SHajimu UMEMOTO 			bcopy(b, ((struct ipovly *)ip)->ih_x1, 9);
420db4f9cc7SJonathan Lemon 		}
42139629c92SDavid Malone 		if (uh_sum) {
422026decb8SRobert Watson 			UDPSTAT_INC(udps_badsum);
423df8bae1dSRodney W. Grimes 			m_freem(m);
424df8bae1dSRodney W. Grimes 			return;
425df8bae1dSRodney W. Grimes 		}
426fb9aaba0SRuslan Ermilov 	} else
427026decb8SRobert Watson 		UDPSTAT_INC(udps_nosum);
428df8bae1dSRodney W. Grimes 
4290b4ae859SGleb Smirnoff #ifdef IPFIREWALL_FORWARD
4303329b236SRobert Watson 	/*
4313329b236SRobert Watson 	 * Grab info from PACKET_TAG_IPFORWARD tag prepended to the chain.
4323329b236SRobert Watson 	 */
4330b4ae859SGleb Smirnoff 	fwd_tag = m_tag_find(m, PACKET_TAG_IPFORWARD, NULL);
4340b4ae859SGleb Smirnoff 	if (fwd_tag != NULL) {
4350b4ae859SGleb Smirnoff 		struct sockaddr_in *next_hop;
4360b4ae859SGleb Smirnoff 
4373329b236SRobert Watson 		/*
4383329b236SRobert Watson 		 * Do the hack.
4393329b236SRobert Watson 		 */
4400b4ae859SGleb Smirnoff 		next_hop = (struct sockaddr_in *)(fwd_tag + 1);
4410b4ae859SGleb Smirnoff 		ip->ip_dst = next_hop->sin_addr;
4420b4ae859SGleb Smirnoff 		uh->uh_dport = ntohs(next_hop->sin_port);
4433329b236SRobert Watson 
4443329b236SRobert Watson 		/*
4453329b236SRobert Watson 		 * Remove the tag from the packet.  We don't need it anymore.
4463329b236SRobert Watson 		 */
4470b4ae859SGleb Smirnoff 		m_tag_delete(m, fwd_tag);
4480b4ae859SGleb Smirnoff 	}
4490b4ae859SGleb Smirnoff #endif
4500b4ae859SGleb Smirnoff 
451603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
452df8bae1dSRodney W. Grimes 	if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) ||
45371498f30SBruce M Simpson 	    in_broadcast(ip->ip_dst, ifp)) {
45482c23ebaSBill Fenner 		struct inpcb *last;
45571498f30SBruce M Simpson 		struct ip_moptions *imo;
4563329b236SRobert Watson 
457df8bae1dSRodney W. Grimes 		last = NULL;
458603724d3SBjoern A. Zeeb 		LIST_FOREACH(inp, &V_udb, inp_list) {
4599c1df695SRobert Watson 			if (inp->inp_lport != uh->uh_dport)
460f76fcf6dSJeffrey Hsu 				continue;
461cfa1ca9dSYoshinobu Inoue #ifdef INET6
462369dc8ceSEivind Eklund 			if ((inp->inp_vflag & INP_IPV4) == 0)
4639c1df695SRobert Watson 				continue;
464cfa1ca9dSYoshinobu Inoue #endif
46571498f30SBruce M Simpson 			if (inp->inp_laddr.s_addr != INADDR_ANY &&
46671498f30SBruce M Simpson 			    inp->inp_laddr.s_addr != ip->ip_dst.s_addr)
4679c1df695SRobert Watson 				continue;
46871498f30SBruce M Simpson 			if (inp->inp_faddr.s_addr != INADDR_ANY &&
46971498f30SBruce M Simpson 			    inp->inp_faddr.s_addr != ip->ip_src.s_addr)
47071498f30SBruce M Simpson 				continue;
47171498f30SBruce M Simpson 			if (inp->inp_fport != 0 &&
472df8bae1dSRodney W. Grimes 			    inp->inp_fport != uh->uh_sport)
4739c1df695SRobert Watson 				continue;
47471498f30SBruce M Simpson 
475119d85f6SRobert Watson 			INP_RLOCK(inp);
476df8bae1dSRodney W. Grimes 
47783453a06SBruce M Simpson 			/*
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;
48271498f30SBruce M Simpson 			if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) &&
48371498f30SBruce M Simpson 			    imo != NULL) {
484d10910e6SBruce M Simpson 				struct sockaddr_in	 group;
485d10910e6SBruce M Simpson 				int			 blocked;
48683453a06SBruce M Simpson 
487d10910e6SBruce M Simpson 				bzero(&group, sizeof(struct sockaddr_in));
488d10910e6SBruce M Simpson 				group.sin_len = sizeof(struct sockaddr_in);
489d10910e6SBruce M Simpson 				group.sin_family = AF_INET;
490d10910e6SBruce M Simpson 				group.sin_addr = ip->ip_dst;
49171498f30SBruce M Simpson 
492d10910e6SBruce M Simpson 				blocked = imo_multi_filter(imo, ifp,
493d10910e6SBruce M Simpson 					(struct sockaddr *)&group,
49471498f30SBruce M Simpson 					(struct sockaddr *)&udp_in);
495d10910e6SBruce M Simpson 				if (blocked != MCAST_PASS) {
496d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTGMEMBER)
49786425c62SRobert Watson 						IPSTAT_INC(ips_notmember);
498d10910e6SBruce M Simpson 					if (blocked == MCAST_NOTSMEMBER ||
499d10910e6SBruce M Simpson 					    blocked == MCAST_MUTED)
500026decb8SRobert Watson 						UDPSTAT_INC(udps_filtermcast);
501119d85f6SRobert Watson 					INP_RUNLOCK(inp);
5029c1df695SRobert Watson 					continue;
5039c1df695SRobert Watson 				}
50483453a06SBruce M Simpson 			}
505df8bae1dSRodney W. Grimes 			if (last != NULL) {
506df8bae1dSRodney W. Grimes 				struct mbuf *n;
507df8bae1dSRodney W. Grimes 
508032dcc76SLuigi Rizzo 				n = m_copy(m, 0, M_COPYALL);
5096a9148feSBjoern A. Zeeb 				up = intoudpcb(last);
5106a9148feSBjoern A. Zeeb 				if (up->u_tun_func == NULL) {
511365433d9SRobert Watson 					if (n != NULL)
512c7c7ea4bSRandall Stewart 						udp_append(last,
513c7c7ea4bSRandall Stewart 						    ip, n,
514c7c7ea4bSRandall Stewart 						    iphlen +
515c7c7ea4bSRandall Stewart 						    sizeof(struct udphdr),
516c7c7ea4bSRandall Stewart 						    &udp_in);
517c7c7ea4bSRandall Stewart 				} else {
518c7c7ea4bSRandall Stewart 					/*
519c7c7ea4bSRandall Stewart 					 * Engage the tunneling protocol we
520c7c7ea4bSRandall Stewart 					 * will have to leave the info_lock
521c7c7ea4bSRandall Stewart 					 * up, since we are hunting through
522bbb0e3d9SRandall Stewart 					 * multiple UDP's.
523c7c7ea4bSRandall Stewart 					 */
524c7c7ea4bSRandall Stewart 
5256a9148feSBjoern A. Zeeb 					(*up->u_tun_func)(n, iphlen, last);
526c7c7ea4bSRandall Stewart 				}
5276a9148feSBjoern A. Zeeb 				INP_RUNLOCK(last);
528df8bae1dSRodney W. Grimes 			}
52982c23ebaSBill Fenner 			last = inp;
530df8bae1dSRodney W. Grimes 			/*
531df8bae1dSRodney W. Grimes 			 * Don't look for additional matches if this one does
532df8bae1dSRodney W. Grimes 			 * not have either the SO_REUSEPORT or SO_REUSEADDR
5333329b236SRobert Watson 			 * socket options set.  This heuristic avoids
5343329b236SRobert Watson 			 * searching through all pcbs in the common case of a
5353329b236SRobert Watson 			 * non-shared port.  It assumes that an application
5363329b236SRobert Watson 			 * will never clear these options after setting them.
537df8bae1dSRodney W. Grimes 			 */
5383329b236SRobert Watson 			if ((last->inp_socket->so_options &
5393329b236SRobert Watson 			    (SO_REUSEPORT|SO_REUSEADDR)) == 0)
540df8bae1dSRodney W. Grimes 				break;
541df8bae1dSRodney W. Grimes 		}
542df8bae1dSRodney W. Grimes 
543df8bae1dSRodney W. Grimes 		if (last == NULL) {
544df8bae1dSRodney W. Grimes 			/*
5453329b236SRobert Watson 			 * No matching pcb found; discard datagram.  (No need
5463329b236SRobert Watson 			 * to send an ICMP Port Unreachable for a broadcast
5473329b236SRobert Watson 			 * or multicast datgram.)
548df8bae1dSRodney W. Grimes 			 */
549026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
55061ffc0b1SJeffrey Hsu 			goto badheadlocked;
551df8bae1dSRodney W. Grimes 		}
5526a9148feSBjoern A. Zeeb 		up = intoudpcb(last);
5536a9148feSBjoern A. Zeeb 		if (up->u_tun_func == NULL) {
554d4b509bdSRobert Watson 			udp_append(last, ip, m, iphlen + sizeof(struct udphdr),
555d4b509bdSRobert Watson 			    &udp_in);
556c7c7ea4bSRandall Stewart 		} else {
557c7c7ea4bSRandall Stewart 			/*
558bbb0e3d9SRandall Stewart 			 * Engage the tunneling protocol.
559c7c7ea4bSRandall Stewart 			 */
5606a9148feSBjoern A. Zeeb 			(*up->u_tun_func)(m, iphlen, last);
5616a9148feSBjoern A. Zeeb 		}
562c7c7ea4bSRandall Stewart 		INP_RUNLOCK(last);
563c7c7ea4bSRandall Stewart 		INP_INFO_RUNLOCK(&V_udbinfo);
564df8bae1dSRodney W. Grimes 		return;
565df8bae1dSRodney W. Grimes 	}
5663329b236SRobert Watson 
567df8bae1dSRodney W. Grimes 	/*
5686d6a026bSDavid Greenman 	 * Locate pcb for datagram.
569df8bae1dSRodney W. Grimes 	 */
570603724d3SBjoern A. Zeeb 	inp = in_pcblookup_hash(&V_udbinfo, ip->ip_src, uh->uh_sport,
57171498f30SBruce M Simpson 	    ip->ip_dst, uh->uh_dport, 1, ifp);
57215bd2b43SDavid Greenman 	if (inp == NULL) {
573afdb4274SRobert Watson 		if (udp_log_in_vain) {
574df5c0b8aSBill Fenner 			char buf[4*sizeof "123"];
57575cfc95fSAndrey A. Chernov 
57675cfc95fSAndrey A. Chernov 			strcpy(buf, inet_ntoa(ip->ip_dst));
577592071e8SBruce Evans 			log(LOG_INFO,
578592071e8SBruce Evans 			    "Connection attempt to UDP %s:%d from %s:%d\n",
579592071e8SBruce Evans 			    buf, ntohs(uh->uh_dport), inet_ntoa(ip->ip_src),
580592071e8SBruce Evans 			    ntohs(uh->uh_sport));
58175cfc95fSAndrey A. Chernov 		}
582026decb8SRobert Watson 		UDPSTAT_INC(udps_noport);
583df8bae1dSRodney W. Grimes 		if (m->m_flags & (M_BCAST | M_MCAST)) {
584026decb8SRobert Watson 			UDPSTAT_INC(udps_noportbcast);
58561ffc0b1SJeffrey Hsu 			goto badheadlocked;
586df8bae1dSRodney W. Grimes 		}
587603724d3SBjoern A. Zeeb 		if (V_udp_blackhole)
58861ffc0b1SJeffrey Hsu 			goto badheadlocked;
5891cbd978eSLuigi Rizzo 		if (badport_bandlim(BANDLIM_ICMP_UNREACH) < 0)
5901cbd978eSLuigi Rizzo 			goto badheadlocked;
59104287599SRuslan Ermilov 		*ip = save_ip;
59204287599SRuslan Ermilov 		ip->ip_len += iphlen;
593582a7760SBruce Evans 		icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
594603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
595df8bae1dSRodney W. Grimes 		return;
596df8bae1dSRodney W. Grimes 	}
5973329b236SRobert Watson 
5983329b236SRobert Watson 	/*
5993329b236SRobert Watson 	 * Check the minimum TTL for socket.
6003329b236SRobert Watson 	 */
601119d85f6SRobert Watson 	INP_RLOCK(inp);
602603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
60310cc62b7SRobert Watson 	if (inp->inp_ip_minttl && inp->inp_ip_minttl > ip->ip_ttl) {
60410cc62b7SRobert Watson 		INP_RUNLOCK(inp);
60510cc62b7SRobert Watson 		goto badunlocked;
60610cc62b7SRobert Watson 	}
6076a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
6086a9148feSBjoern A. Zeeb 	if (up->u_tun_func == NULL) {
6096a9148feSBjoern A. Zeeb 		udp_append(inp, ip, m, iphlen + sizeof(struct udphdr), &udp_in);
6106a9148feSBjoern A. Zeeb 	} else {
611c7c7ea4bSRandall Stewart 		/*
612bbb0e3d9SRandall Stewart 		 * Engage the tunneling protocol.
613c7c7ea4bSRandall Stewart 		 */
614c7c7ea4bSRandall Stewart 
6156a9148feSBjoern A. Zeeb 		(*up->u_tun_func)(m, iphlen, inp);
616c7c7ea4bSRandall Stewart 	}
617119d85f6SRobert Watson 	INP_RUNLOCK(inp);
618df8bae1dSRodney W. Grimes 	return;
61961ffc0b1SJeffrey Hsu 
62061ffc0b1SJeffrey Hsu badheadlocked:
621f76fcf6dSJeffrey Hsu 	if (inp)
622119d85f6SRobert Watson 		INP_RUNLOCK(inp);
623603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
624f76fcf6dSJeffrey Hsu badunlocked:
625df8bae1dSRodney W. Grimes 	m_freem(m);
626cfa1ca9dSYoshinobu Inoue }
627cfa1ca9dSYoshinobu Inoue 
628cfa1ca9dSYoshinobu Inoue /*
6293329b236SRobert Watson  * Notify a udp user of an asynchronous error; just wake up so that they can
6303329b236SRobert Watson  * collect error status.
631df8bae1dSRodney W. Grimes  */
6323ce144eaSJeffrey Hsu struct inpcb *
6333329b236SRobert Watson udp_notify(struct inpcb *inp, int errno)
634df8bae1dSRodney W. Grimes {
6353329b236SRobert Watson 
636ac9ae279SRobert Watson 	/*
637ac9ae279SRobert Watson 	 * While udp_ctlinput() always calls udp_notify() with a read lock
638ac9ae279SRobert Watson 	 * when invoking it directly, in_pcbnotifyall() currently uses write
639ac9ae279SRobert Watson 	 * locks due to sharing code with TCP.  For now, accept either a read
640ac9ae279SRobert Watson 	 * or a write lock, but a read lock is sufficient.
641ac9ae279SRobert Watson 	 */
642ac9ae279SRobert Watson 	INP_LOCK_ASSERT(inp);
6438501a69cSRobert Watson 
644df8bae1dSRodney W. Grimes 	inp->inp_socket->so_error = errno;
645df8bae1dSRodney W. Grimes 	sorwakeup(inp->inp_socket);
646df8bae1dSRodney W. Grimes 	sowwakeup(inp->inp_socket);
6473329b236SRobert Watson 	return (inp);
648df8bae1dSRodney W. Grimes }
649df8bae1dSRodney W. Grimes 
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));
680603724d3SBjoern A. Zeeb 		INP_INFO_RLOCK(&V_udbinfo);
681603724d3SBjoern A. Zeeb 		inp = in_pcblookup_hash(&V_udbinfo, faddr, uh->uh_dport,
682c693a045SJonathan Lemon 		    ip->ip_src, uh->uh_sport, 0, NULL);
683f76fcf6dSJeffrey Hsu 		if (inp != NULL) {
684ac9ae279SRobert Watson 			INP_RLOCK(inp);
685f76fcf6dSJeffrey Hsu 			if (inp->inp_socket != NULL) {
686f5514f08SRobert Watson 				udp_notify(inp, inetctlerrmap[cmd]);
687f76fcf6dSJeffrey Hsu 			}
688ac9ae279SRobert Watson 			INP_RUNLOCK(inp);
689f76fcf6dSJeffrey Hsu 		}
690603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
691df8bae1dSRodney W. Grimes 	} else
692603724d3SBjoern A. Zeeb 		in_pcbnotifyall(&V_udbinfo, faddr, inetctlerrmap[cmd],
693f5514f08SRobert Watson 		    udp_notify);
694df8bae1dSRodney W. Grimes }
695df8bae1dSRodney W. Grimes 
6960312fbe9SPoul-Henning Kamp static int
69782d9ae4eSPoul-Henning Kamp udp_pcblist(SYSCTL_HANDLER_ARGS)
69898271db4SGarrett Wollman {
699277afaffSRobert Watson 	int error, i, n;
70098271db4SGarrett Wollman 	struct inpcb *inp, **inp_list;
70198271db4SGarrett Wollman 	inp_gen_t gencnt;
70298271db4SGarrett Wollman 	struct xinpgen xig;
70398271db4SGarrett Wollman 
70498271db4SGarrett Wollman 	/*
705f5514f08SRobert Watson 	 * The process of preparing the PCB list is too time-consuming and
70698271db4SGarrett Wollman 	 * resource-intensive to repeat twice on every request.
70798271db4SGarrett Wollman 	 */
70898271db4SGarrett Wollman 	if (req->oldptr == 0) {
709603724d3SBjoern A. Zeeb 		n = V_udbinfo.ipi_count;
71098271db4SGarrett Wollman 		req->oldidx = 2 * (sizeof xig)
71198271db4SGarrett Wollman 			+ (n + n/8) * sizeof(struct xinpcb);
7123329b236SRobert Watson 		return (0);
71398271db4SGarrett Wollman 	}
71498271db4SGarrett Wollman 
71598271db4SGarrett Wollman 	if (req->newptr != 0)
7163329b236SRobert Watson 		return (EPERM);
71798271db4SGarrett Wollman 
71898271db4SGarrett Wollman 	/*
71998271db4SGarrett Wollman 	 * OK, now we're committed to doing something.
72098271db4SGarrett Wollman 	 */
721603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
722603724d3SBjoern A. Zeeb 	gencnt = V_udbinfo.ipi_gencnt;
723603724d3SBjoern A. Zeeb 	n = V_udbinfo.ipi_count;
724603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
72598271db4SGarrett Wollman 
72647934cefSDon Lewis 	error = sysctl_wire_old_buffer(req, 2 * (sizeof xig)
7275c38b6dbSDon Lewis 		+ n * sizeof(struct xinpcb));
72847934cefSDon Lewis 	if (error != 0)
72947934cefSDon Lewis 		return (error);
7305c38b6dbSDon Lewis 
73198271db4SGarrett Wollman 	xig.xig_len = sizeof xig;
73298271db4SGarrett Wollman 	xig.xig_count = n;
73398271db4SGarrett Wollman 	xig.xig_gen = gencnt;
73498271db4SGarrett Wollman 	xig.xig_sogen = so_gencnt;
73598271db4SGarrett Wollman 	error = SYSCTL_OUT(req, &xig, sizeof xig);
73698271db4SGarrett Wollman 	if (error)
7373329b236SRobert Watson 		return (error);
73898271db4SGarrett Wollman 
739a163d034SWarner Losh 	inp_list = malloc(n * sizeof *inp_list, M_TEMP, M_WAITOK);
74098271db4SGarrett Wollman 	if (inp_list == 0)
7413329b236SRobert Watson 		return (ENOMEM);
74298271db4SGarrett Wollman 
743603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
744603724d3SBjoern A. Zeeb 	for (inp = LIST_FIRST(V_udbinfo.ipi_listhead), i = 0; inp && i < n;
745fc2ffbe6SPoul-Henning Kamp 	     inp = LIST_NEXT(inp, inp_list)) {
746d0e157f6SBjoern A. Zeeb 		INP_WLOCK(inp);
7472ded288cSJeffrey Hsu 		if (inp->inp_gencnt <= gencnt &&
748d0e157f6SBjoern A. Zeeb 		    cr_canseeinpcb(req->td->td_ucred, inp) == 0) {
749d0e157f6SBjoern A. Zeeb 			in_pcbref(inp);
75098271db4SGarrett Wollman 			inp_list[i++] = inp;
751d0e157f6SBjoern A. Zeeb 		}
752d0e157f6SBjoern A. Zeeb 		INP_WUNLOCK(inp);
7534787fd37SPaul Saab 	}
754603724d3SBjoern A. Zeeb 	INP_INFO_RUNLOCK(&V_udbinfo);
75598271db4SGarrett Wollman 	n = i;
75698271db4SGarrett Wollman 
75798271db4SGarrett Wollman 	error = 0;
75898271db4SGarrett Wollman 	for (i = 0; i < n; i++) {
75998271db4SGarrett Wollman 		inp = inp_list[i];
7609622e84fSRobert Watson 		INP_RLOCK(inp);
76198271db4SGarrett Wollman 		if (inp->inp_gencnt <= gencnt) {
76298271db4SGarrett Wollman 			struct xinpcb xi;
763d0e157f6SBjoern A. Zeeb 
764fd94099eSColin Percival 			bzero(&xi, sizeof(xi));
76598271db4SGarrett Wollman 			xi.xi_len = sizeof xi;
76698271db4SGarrett Wollman 			/* XXX should avoid extra copy */
76798271db4SGarrett Wollman 			bcopy(inp, &xi.xi_inp, sizeof *inp);
76898271db4SGarrett Wollman 			if (inp->inp_socket)
76998271db4SGarrett Wollman 				sotoxsocket(inp->inp_socket, &xi.xi_socket);
7704b40c56cSJeffrey Hsu 			xi.xi_inp.inp_gencnt = inp->inp_gencnt;
7719622e84fSRobert Watson 			INP_RUNLOCK(inp);
77298271db4SGarrett Wollman 			error = SYSCTL_OUT(req, &xi, sizeof xi);
773d915b280SStephan Uphoff 		} else
7749622e84fSRobert Watson 			INP_RUNLOCK(inp);
77598271db4SGarrett Wollman 	}
776d0e157f6SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
777d0e157f6SBjoern A. Zeeb 	for (i = 0; i < n; i++) {
778d0e157f6SBjoern A. Zeeb 		inp = inp_list[i];
779d0e157f6SBjoern A. Zeeb 		INP_WLOCK(inp);
780d0e157f6SBjoern A. Zeeb 		if (!in_pcbrele(inp))
781d0e157f6SBjoern A. Zeeb 			INP_WUNLOCK(inp);
782d0e157f6SBjoern A. Zeeb 	}
783d0e157f6SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
784d0e157f6SBjoern A. Zeeb 
78598271db4SGarrett Wollman 	if (!error) {
78698271db4SGarrett Wollman 		/*
7873329b236SRobert Watson 		 * Give the user an updated idea of our state.  If the
7883329b236SRobert Watson 		 * generation differs from what we told her before, she knows
7893329b236SRobert Watson 		 * that something happened while we were processing this
7903329b236SRobert Watson 		 * request, and it might be necessary to retry.
79198271db4SGarrett Wollman 		 */
792603724d3SBjoern A. Zeeb 		INP_INFO_RLOCK(&V_udbinfo);
793603724d3SBjoern A. Zeeb 		xig.xig_gen = V_udbinfo.ipi_gencnt;
79498271db4SGarrett Wollman 		xig.xig_sogen = so_gencnt;
795603724d3SBjoern A. Zeeb 		xig.xig_count = V_udbinfo.ipi_count;
796603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
79798271db4SGarrett Wollman 		error = SYSCTL_OUT(req, &xig, sizeof xig);
79898271db4SGarrett Wollman 	}
79998271db4SGarrett Wollman 	free(inp_list, M_TEMP);
8003329b236SRobert Watson 	return (error);
80198271db4SGarrett Wollman }
80298271db4SGarrett Wollman 
80398271db4SGarrett Wollman SYSCTL_PROC(_net_inet_udp, UDPCTL_PCBLIST, pcblist, CTLFLAG_RD, 0, 0,
80498271db4SGarrett Wollman     udp_pcblist, "S,xinpcb", "List of active UDP sockets");
80598271db4SGarrett Wollman 
80698271db4SGarrett Wollman static int
80782d9ae4eSPoul-Henning Kamp udp_getcred(SYSCTL_HANDLER_ARGS)
808490d50b6SBrian Feldman {
809c0511d3bSBrian Feldman 	struct xucred xuc;
810490d50b6SBrian Feldman 	struct sockaddr_in addrs[2];
811490d50b6SBrian Feldman 	struct inpcb *inp;
812277afaffSRobert Watson 	int error;
813490d50b6SBrian Feldman 
81432f9753cSRobert Watson 	error = priv_check(req->td, PRIV_NETINET_GETCRED);
815490d50b6SBrian Feldman 	if (error)
816490d50b6SBrian Feldman 		return (error);
817490d50b6SBrian Feldman 	error = SYSCTL_IN(req, addrs, sizeof(addrs));
818490d50b6SBrian Feldman 	if (error)
819490d50b6SBrian Feldman 		return (error);
820603724d3SBjoern A. Zeeb 	INP_INFO_RLOCK(&V_udbinfo);
821603724d3SBjoern A. Zeeb 	inp = in_pcblookup_hash(&V_udbinfo, addrs[1].sin_addr, addrs[1].sin_port,
822cfa1ca9dSYoshinobu Inoue 				addrs[0].sin_addr, addrs[0].sin_port, 1, NULL);
8239622e84fSRobert Watson 	if (inp != NULL) {
8249622e84fSRobert Watson 		INP_RLOCK(inp);
825603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
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);
8339622e84fSRobert Watson 	} else {
834603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
8359622e84fSRobert Watson 		error = ENOENT;
8369622e84fSRobert Watson 	}
8370e1eebb8SDon Lewis 	if (error == 0)
8380e1eebb8SDon Lewis 		error = SYSCTL_OUT(req, &xuc, sizeof(struct xucred));
839490d50b6SBrian Feldman 	return (error);
840490d50b6SBrian Feldman }
841490d50b6SBrian Feldman 
8427ce87f12SDavid Malone SYSCTL_PROC(_net_inet_udp, OID_AUTO, getcred,
8437ce87f12SDavid Malone     CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_PRISON, 0, 0,
8447ce87f12SDavid Malone     udp_getcred, "S,xucred", "Get the xucred of a UDP connection");
845490d50b6SBrian Feldman 
8467b495c44SVANHULLEBUS Yvan int
8477b495c44SVANHULLEBUS Yvan udp_ctloutput(struct socket *so, struct sockopt *sopt)
8487b495c44SVANHULLEBUS Yvan {
8497b495c44SVANHULLEBUS Yvan 	int error = 0, optval;
8507b495c44SVANHULLEBUS Yvan 	struct inpcb *inp;
8517b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8527b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
8537b495c44SVANHULLEBUS Yvan #endif
8547b495c44SVANHULLEBUS Yvan 
8557b495c44SVANHULLEBUS Yvan 	inp = sotoinpcb(so);
8567b495c44SVANHULLEBUS Yvan 	KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
8577b495c44SVANHULLEBUS Yvan 	INP_WLOCK(inp);
8587b495c44SVANHULLEBUS Yvan 	if (sopt->sopt_level != IPPROTO_UDP) {
8597b495c44SVANHULLEBUS Yvan #ifdef INET6
8607b495c44SVANHULLEBUS Yvan 		if (INP_CHECK_SOCKAF(so, AF_INET6)) {
8617b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8627b495c44SVANHULLEBUS Yvan 			error = ip6_ctloutput(so, sopt);
8637b495c44SVANHULLEBUS Yvan 		} else {
8647b495c44SVANHULLEBUS Yvan #endif
8657b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8667b495c44SVANHULLEBUS Yvan 			error = ip_ctloutput(so, sopt);
8677b495c44SVANHULLEBUS Yvan #ifdef INET6
8687b495c44SVANHULLEBUS Yvan 		}
8697b495c44SVANHULLEBUS Yvan #endif
8707b495c44SVANHULLEBUS Yvan 		return (error);
8717b495c44SVANHULLEBUS Yvan 	}
8727b495c44SVANHULLEBUS Yvan 
8737b495c44SVANHULLEBUS Yvan 	switch (sopt->sopt_dir) {
8747b495c44SVANHULLEBUS Yvan 	case SOPT_SET:
8757b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
8767b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
8777b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
8787b495c44SVANHULLEBUS Yvan 			error = sooptcopyin(sopt, &optval, sizeof optval,
8797b495c44SVANHULLEBUS Yvan 					    sizeof optval);
8807b495c44SVANHULLEBUS Yvan 			if (error)
8817b495c44SVANHULLEBUS Yvan 				break;
8827b495c44SVANHULLEBUS Yvan 			inp = sotoinpcb(so);
8837b495c44SVANHULLEBUS Yvan 			KASSERT(inp != NULL, ("%s: inp == NULL", __func__));
8847b495c44SVANHULLEBUS Yvan 			INP_WLOCK(inp);
8857b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8867b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
8877b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
8887b495c44SVANHULLEBUS Yvan #endif
8897b495c44SVANHULLEBUS Yvan 			switch (optval) {
8907b495c44SVANHULLEBUS Yvan 			case 0:
8917b495c44SVANHULLEBUS Yvan 				/* Clear all UDP encap. */
8927b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8937b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
8947b495c44SVANHULLEBUS Yvan #endif
8957b495c44SVANHULLEBUS Yvan 				break;
8967b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
8977b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP:
8987b495c44SVANHULLEBUS Yvan 			case UDP_ENCAP_ESPINUDP_NON_IKE:
8997b495c44SVANHULLEBUS Yvan 				up->u_flags &= ~UF_ESPINUDP_ALL;
9007b495c44SVANHULLEBUS Yvan 				if (optval == UDP_ENCAP_ESPINUDP)
9017b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP;
9027b495c44SVANHULLEBUS Yvan 				else if (optval == UDP_ENCAP_ESPINUDP_NON_IKE)
9037b495c44SVANHULLEBUS Yvan 					up->u_flags |= UF_ESPINUDP_NON_IKE;
9047b495c44SVANHULLEBUS Yvan 				break;
9057b495c44SVANHULLEBUS Yvan #endif
9067b495c44SVANHULLEBUS Yvan 			default:
9077b495c44SVANHULLEBUS Yvan 				error = EINVAL;
9087b495c44SVANHULLEBUS Yvan 				break;
9097b495c44SVANHULLEBUS Yvan 			}
9107b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9117b495c44SVANHULLEBUS Yvan 			break;
9127b495c44SVANHULLEBUS Yvan 		default:
9137b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9147b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
9157b495c44SVANHULLEBUS Yvan 			break;
9167b495c44SVANHULLEBUS Yvan 		}
9177b495c44SVANHULLEBUS Yvan 		break;
9187b495c44SVANHULLEBUS Yvan 	case SOPT_GET:
9197b495c44SVANHULLEBUS Yvan 		switch (sopt->sopt_name) {
9207b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T
9217b495c44SVANHULLEBUS Yvan 		case UDP_ENCAP:
9227b495c44SVANHULLEBUS Yvan 			up = intoudpcb(inp);
9237b495c44SVANHULLEBUS Yvan 			KASSERT(up != NULL, ("%s: up == NULL", __func__));
9247b495c44SVANHULLEBUS Yvan 			optval = up->u_flags & UF_ESPINUDP_ALL;
9257b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9267b495c44SVANHULLEBUS Yvan 			error = sooptcopyout(sopt, &optval, sizeof optval);
9277b495c44SVANHULLEBUS Yvan 			break;
9287b495c44SVANHULLEBUS Yvan #endif
9297b495c44SVANHULLEBUS Yvan 		default:
9307b495c44SVANHULLEBUS Yvan 			INP_WUNLOCK(inp);
9317b495c44SVANHULLEBUS Yvan 			error = ENOPROTOOPT;
9327b495c44SVANHULLEBUS Yvan 			break;
9337b495c44SVANHULLEBUS Yvan 		}
9347b495c44SVANHULLEBUS Yvan 		break;
9357b495c44SVANHULLEBUS Yvan 	}
9367b495c44SVANHULLEBUS Yvan 	return (error);
9377b495c44SVANHULLEBUS Yvan }
9387b495c44SVANHULLEBUS Yvan 
939490d50b6SBrian Feldman static int
9403329b236SRobert Watson udp_output(struct inpcb *inp, struct mbuf *m, struct sockaddr *addr,
9413329b236SRobert Watson     struct mbuf *control, struct thread *td)
942df8bae1dSRodney W. Grimes {
9433329b236SRobert Watson 	struct udpiphdr *ui;
9443329b236SRobert Watson 	int len = m->m_pkthdr.len;
94590162a4eSIan Dowse 	struct in_addr faddr, laddr;
946c557ae16SIan Dowse 	struct cmsghdr *cm;
947c557ae16SIan Dowse 	struct sockaddr_in *sin, src;
94890162a4eSIan Dowse 	int error = 0;
9498afa2304SBruce M Simpson 	int ipflags;
95090162a4eSIan Dowse 	u_short fport, lport;
9515c32ea65SRobert Watson 	int unlock_udbinfo;
952df8bae1dSRodney W. Grimes 
9535c32ea65SRobert Watson 	/*
9545c32ea65SRobert Watson 	 * udp_output() may need to temporarily bind or connect the current
955f5514f08SRobert Watson 	 * inpcb.  As such, we don't know up front whether we will need the
956f5514f08SRobert Watson 	 * pcbinfo lock or not.  Do any work to decide what is needed up
957f5514f08SRobert Watson 	 * front before acquiring any locks.
9585c32ea65SRobert Watson 	 */
959430d30d8SBill Fenner 	if (len + sizeof(struct udpiphdr) > IP_MAXPACKET) {
960c557ae16SIan Dowse 		if (control)
961c557ae16SIan Dowse 			m_freem(control);
9625c32ea65SRobert Watson 		m_freem(m);
9633329b236SRobert Watson 		return (EMSGSIZE);
964430d30d8SBill Fenner 	}
965430d30d8SBill Fenner 
9661b7f0384SBruce M Simpson 	src.sin_family = 0;
967c557ae16SIan Dowse 	if (control != NULL) {
968c557ae16SIan Dowse 		/*
9693329b236SRobert Watson 		 * XXX: Currently, we assume all the optional information is
9703329b236SRobert Watson 		 * stored in a single mbuf.
971c557ae16SIan Dowse 		 */
972c557ae16SIan Dowse 		if (control->m_next) {
973c557ae16SIan Dowse 			m_freem(control);
9745c32ea65SRobert Watson 			m_freem(m);
9753329b236SRobert Watson 			return (EINVAL);
976c557ae16SIan Dowse 		}
977c557ae16SIan Dowse 		for (; control->m_len > 0;
978c557ae16SIan Dowse 		    control->m_data += CMSG_ALIGN(cm->cmsg_len),
979c557ae16SIan Dowse 		    control->m_len -= CMSG_ALIGN(cm->cmsg_len)) {
980c557ae16SIan Dowse 			cm = mtod(control, struct cmsghdr *);
981af1ee11dSRobert Watson 			if (control->m_len < sizeof(*cm) || cm->cmsg_len == 0
982af1ee11dSRobert Watson 			    || cm->cmsg_len > control->m_len) {
983c557ae16SIan Dowse 				error = EINVAL;
984c557ae16SIan Dowse 				break;
985c557ae16SIan Dowse 			}
986c557ae16SIan Dowse 			if (cm->cmsg_level != IPPROTO_IP)
987c557ae16SIan Dowse 				continue;
988c557ae16SIan Dowse 
989c557ae16SIan Dowse 			switch (cm->cmsg_type) {
990c557ae16SIan Dowse 			case IP_SENDSRCADDR:
991c557ae16SIan Dowse 				if (cm->cmsg_len !=
992c557ae16SIan Dowse 				    CMSG_LEN(sizeof(struct in_addr))) {
993c557ae16SIan Dowse 					error = EINVAL;
994c557ae16SIan Dowse 					break;
995c557ae16SIan Dowse 				}
996c557ae16SIan Dowse 				bzero(&src, sizeof(src));
997c557ae16SIan Dowse 				src.sin_family = AF_INET;
998c557ae16SIan Dowse 				src.sin_len = sizeof(src);
999c557ae16SIan Dowse 				src.sin_port = inp->inp_lport;
1000af1ee11dSRobert Watson 				src.sin_addr =
1001af1ee11dSRobert Watson 				    *(struct in_addr *)CMSG_DATA(cm);
1002c557ae16SIan Dowse 				break;
1003af1ee11dSRobert Watson 
1004c557ae16SIan Dowse 			default:
1005c557ae16SIan Dowse 				error = ENOPROTOOPT;
1006c557ae16SIan Dowse 				break;
1007c557ae16SIan Dowse 			}
1008c557ae16SIan Dowse 			if (error)
1009c557ae16SIan Dowse 				break;
1010c557ae16SIan Dowse 		}
1011c557ae16SIan Dowse 		m_freem(control);
1012c557ae16SIan Dowse 	}
10135c32ea65SRobert Watson 	if (error) {
10145c32ea65SRobert Watson 		m_freem(m);
10153329b236SRobert Watson 		return (error);
10165c32ea65SRobert Watson 	}
10175c32ea65SRobert Watson 
101843cc0bc1SRobert Watson 	/*
101943cc0bc1SRobert Watson 	 * Depending on whether or not the application has bound or connected
1020ca528788SRobert Watson 	 * the socket, we may have to do varying levels of work.  The optimal
1021ca528788SRobert Watson 	 * case is for a connected UDP socket, as a global lock isn't
1022ca528788SRobert Watson 	 * required at all.
102343cc0bc1SRobert Watson 	 *
102443cc0bc1SRobert Watson 	 * In order to decide which we need, we require stability of the
102543cc0bc1SRobert Watson 	 * inpcb binding, which we ensure by acquiring a read lock on the
102643cc0bc1SRobert Watson 	 * inpcb.  This doesn't strictly follow the lock order, so we play
102743cc0bc1SRobert Watson 	 * the trylock and retry game; note that we may end up with more
102843cc0bc1SRobert Watson 	 * conservative locks than required the second time around, so later
102943cc0bc1SRobert Watson 	 * assertions have to accept that.  Further analysis of the number of
103043cc0bc1SRobert Watson 	 * misses under contention is required.
103143cc0bc1SRobert Watson 	 */
103243cc0bc1SRobert Watson 	sin = (struct sockaddr_in *)addr;
103343cc0bc1SRobert Watson 	INP_RLOCK(inp);
103443cc0bc1SRobert Watson 	if (sin != NULL &&
103543cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY && inp->inp_lport == 0)) {
103643cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
1037603724d3SBjoern A. Zeeb 		INP_INFO_WLOCK(&V_udbinfo);
10388501a69cSRobert Watson 		INP_WLOCK(inp);
103943cc0bc1SRobert Watson 		unlock_udbinfo = 2;
104043cc0bc1SRobert Watson 	} else if ((sin != NULL && (
104143cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_ANY) ||
104243cc0bc1SRobert Watson 	    (sin->sin_addr.s_addr == INADDR_BROADCAST) ||
104343cc0bc1SRobert Watson 	    (inp->inp_laddr.s_addr == INADDR_ANY) ||
104443cc0bc1SRobert Watson 	    (inp->inp_lport == 0))) ||
104543cc0bc1SRobert Watson 	    (src.sin_family == AF_INET)) {
1046603724d3SBjoern A. Zeeb 		if (!INP_INFO_TRY_RLOCK(&V_udbinfo)) {
104743cc0bc1SRobert Watson 			INP_RUNLOCK(inp);
1048603724d3SBjoern A. Zeeb 			INP_INFO_RLOCK(&V_udbinfo);
1049948d0fc9SRobert Watson 			INP_RLOCK(inp);
1050948d0fc9SRobert Watson 		}
105143cc0bc1SRobert Watson 		unlock_udbinfo = 1;
105243cc0bc1SRobert Watson 	} else
105343cc0bc1SRobert Watson 		unlock_udbinfo = 0;
10545c32ea65SRobert Watson 
10551b7f0384SBruce M Simpson 	/*
10561b7f0384SBruce M Simpson 	 * If the IP_SENDSRCADDR control message was specified, override the
10571b7f0384SBruce M Simpson 	 * source address for this datagram.  Its use is invalidated if the
10581b7f0384SBruce M Simpson 	 * address thus specified is incomplete or clobbers other inpcbs.
10591b7f0384SBruce M Simpson 	 */
106090162a4eSIan Dowse 	laddr = inp->inp_laddr;
106190162a4eSIan Dowse 	lport = inp->inp_lport;
10621b7f0384SBruce M Simpson 	if (src.sin_family == AF_INET) {
1063603724d3SBjoern A. Zeeb 		INP_INFO_LOCK_ASSERT(&V_udbinfo);
10641b7f0384SBruce M Simpson 		if ((lport == 0) ||
10651b7f0384SBruce M Simpson 		    (laddr.s_addr == INADDR_ANY &&
10661b7f0384SBruce M Simpson 		     src.sin_addr.s_addr == INADDR_ANY)) {
1067c557ae16SIan Dowse 			error = EINVAL;
1068c557ae16SIan Dowse 			goto release;
1069c557ae16SIan Dowse 		}
1070c557ae16SIan Dowse 		error = in_pcbbind_setup(inp, (struct sockaddr *)&src,
1071b0330ed9SPawel Jakub Dawidek 		    &laddr.s_addr, &lport, td->td_ucred);
1072c557ae16SIan Dowse 		if (error)
1073c557ae16SIan Dowse 			goto release;
1074c557ae16SIan Dowse 	}
1075c557ae16SIan Dowse 
10763144b7d3SRobert Watson 	/*
10773144b7d3SRobert Watson 	 * If a UDP socket has been connected, then a local address/port will
10783144b7d3SRobert Watson 	 * have been selected and bound.
10793144b7d3SRobert Watson 	 *
108043cc0bc1SRobert Watson 	 * If a UDP socket has not been connected to, then an explicit
10813144b7d3SRobert Watson 	 * destination address must be used, in which case a local
10823144b7d3SRobert Watson 	 * address/port may not have been selected and bound.
10833144b7d3SRobert Watson 	 */
108443cc0bc1SRobert Watson 	if (sin != NULL) {
1085c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
1086df8bae1dSRodney W. Grimes 		if (inp->inp_faddr.s_addr != INADDR_ANY) {
1087df8bae1dSRodney W. Grimes 			error = EISCONN;
1088df8bae1dSRodney W. Grimes 			goto release;
1089df8bae1dSRodney W. Grimes 		}
10903144b7d3SRobert Watson 
10913144b7d3SRobert Watson 		/*
10923144b7d3SRobert Watson 		 * Jail may rewrite the destination address, so let it do
10933144b7d3SRobert Watson 		 * that before we use it.
10943144b7d3SRobert Watson 		 */
1095b89e82ddSJamie Gritton 		error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1096b89e82ddSJamie Gritton 		if (error)
1097413628a7SBjoern A. Zeeb 			goto release;
10983144b7d3SRobert Watson 
10993144b7d3SRobert Watson 		/*
110043cc0bc1SRobert Watson 		 * If a local address or port hasn't yet been selected, or if
110143cc0bc1SRobert Watson 		 * the destination address needs to be rewritten due to using
110243cc0bc1SRobert Watson 		 * a special INADDR_ constant, invoke in_pcbconnect_setup()
110343cc0bc1SRobert Watson 		 * to do the heavy lifting.  Once a port is selected, we
110443cc0bc1SRobert Watson 		 * commit the binding back to the socket; we also commit the
110543cc0bc1SRobert Watson 		 * binding of the address if in jail.
110643cc0bc1SRobert Watson 		 *
110743cc0bc1SRobert Watson 		 * If we already have a valid binding and we're not
110843cc0bc1SRobert Watson 		 * requesting a destination address rewrite, use a fast path.
11093144b7d3SRobert Watson 		 */
111043cc0bc1SRobert Watson 		if (inp->inp_laddr.s_addr == INADDR_ANY ||
111143cc0bc1SRobert Watson 		    inp->inp_lport == 0 ||
111243cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_ANY ||
111343cc0bc1SRobert Watson 		    sin->sin_addr.s_addr == INADDR_BROADCAST) {
1114603724d3SBjoern A. Zeeb 			INP_INFO_LOCK_ASSERT(&V_udbinfo);
111543cc0bc1SRobert Watson 			error = in_pcbconnect_setup(inp, addr, &laddr.s_addr,
111643cc0bc1SRobert Watson 			    &lport, &faddr.s_addr, &fport, NULL,
111743cc0bc1SRobert Watson 			    td->td_ucred);
111890162a4eSIan Dowse 			if (error)
111990162a4eSIan Dowse 				goto release;
112090162a4eSIan Dowse 
112143cc0bc1SRobert Watson 			/*
112243cc0bc1SRobert Watson 			 * XXXRW: Why not commit the port if the address is
112343cc0bc1SRobert Watson 			 * !INADDR_ANY?
112443cc0bc1SRobert Watson 			 */
112590162a4eSIan Dowse 			/* Commit the local port if newly assigned. */
112690162a4eSIan Dowse 			if (inp->inp_laddr.s_addr == INADDR_ANY &&
112790162a4eSIan Dowse 			    inp->inp_lport == 0) {
1128603724d3SBjoern A. Zeeb 				INP_INFO_WLOCK_ASSERT(&V_udbinfo);
1129c4d585aeSRobert Watson 				INP_WLOCK_ASSERT(inp);
11303a1757b9SGleb Smirnoff 				/*
113143cc0bc1SRobert Watson 				 * Remember addr if jailed, to prevent
113243cc0bc1SRobert Watson 				 * rebinding.
11333a1757b9SGleb Smirnoff 				 */
11340304c731SJamie Gritton 				if (prison_flag(td->td_ucred, PR_IP4))
11353a1757b9SGleb Smirnoff 					inp->inp_laddr = laddr;
113690162a4eSIan Dowse 				inp->inp_lport = lport;
113790162a4eSIan Dowse 				if (in_pcbinshash(inp) != 0) {
113890162a4eSIan Dowse 					inp->inp_lport = 0;
113990162a4eSIan Dowse 					error = EAGAIN;
1140df8bae1dSRodney W. Grimes 					goto release;
1141df8bae1dSRodney W. Grimes 				}
114290162a4eSIan Dowse 				inp->inp_flags |= INP_ANONPORT;
114390162a4eSIan Dowse 			}
1144df8bae1dSRodney W. Grimes 		} else {
114543cc0bc1SRobert Watson 			faddr = sin->sin_addr;
114643cc0bc1SRobert Watson 			fport = sin->sin_port;
114743cc0bc1SRobert Watson 		}
114843cc0bc1SRobert Watson 	} else {
1149c4d585aeSRobert Watson 		INP_LOCK_ASSERT(inp);
115090162a4eSIan Dowse 		faddr = inp->inp_faddr;
115190162a4eSIan Dowse 		fport = inp->inp_fport;
115290162a4eSIan Dowse 		if (faddr.s_addr == INADDR_ANY) {
1153df8bae1dSRodney W. Grimes 			error = ENOTCONN;
1154df8bae1dSRodney W. Grimes 			goto release;
1155df8bae1dSRodney W. Grimes 		}
1156df8bae1dSRodney W. Grimes 	}
1157e6ccd709SRobert Watson 
1158df8bae1dSRodney W. Grimes 	/*
1159e6ccd709SRobert Watson 	 * Calculate data length and get a mbuf for UDP, IP, and possible
1160392e8407SRobert Watson 	 * link-layer headers.  Immediate slide the data pointer back forward
1161392e8407SRobert Watson 	 * since we won't use that space at this layer.
1162df8bae1dSRodney W. Grimes 	 */
1163e6ccd709SRobert Watson 	M_PREPEND(m, sizeof(struct udpiphdr) + max_linkhdr, M_DONTWAIT);
1164e6ccd709SRobert Watson 	if (m == NULL) {
1165df8bae1dSRodney W. Grimes 		error = ENOBUFS;
116649b19bfcSBruce M Simpson 		goto release;
1167df8bae1dSRodney W. Grimes 	}
1168e6ccd709SRobert Watson 	m->m_data += max_linkhdr;
1169e6ccd709SRobert Watson 	m->m_len -= max_linkhdr;
1170392e8407SRobert Watson 	m->m_pkthdr.len -= max_linkhdr;
1171df8bae1dSRodney W. Grimes 
1172df8bae1dSRodney W. Grimes 	/*
11733329b236SRobert Watson 	 * Fill in mbuf with extended UDP header and addresses and length put
11743329b236SRobert Watson 	 * into network format.
1175df8bae1dSRodney W. Grimes 	 */
1176df8bae1dSRodney W. Grimes 	ui = mtod(m, struct udpiphdr *);
1177db4f9cc7SJonathan Lemon 	bzero(ui->ui_x1, sizeof(ui->ui_x1));	/* XXX still needed? */
1178df8bae1dSRodney W. Grimes 	ui->ui_pr = IPPROTO_UDP;
117990162a4eSIan Dowse 	ui->ui_src = laddr;
118090162a4eSIan Dowse 	ui->ui_dst = faddr;
118190162a4eSIan Dowse 	ui->ui_sport = lport;
118290162a4eSIan Dowse 	ui->ui_dport = fport;
1183db4f9cc7SJonathan Lemon 	ui->ui_ulen = htons((u_short)len + sizeof(struct udphdr));
1184df8bae1dSRodney W. Grimes 
1185b2828ad2SAndre Oppermann 	/*
1186b2828ad2SAndre Oppermann 	 * Set the Don't Fragment bit in the IP header.
1187b2828ad2SAndre Oppermann 	 */
1188b2828ad2SAndre Oppermann 	if (inp->inp_flags & INP_DONTFRAG) {
1189b2828ad2SAndre Oppermann 		struct ip *ip;
11903329b236SRobert Watson 
1191b2828ad2SAndre Oppermann 		ip = (struct ip *)&ui->ui_i;
1192b2828ad2SAndre Oppermann 		ip->ip_off |= IP_DF;
1193b2828ad2SAndre Oppermann 	}
1194b2828ad2SAndre Oppermann 
1195b5d47ff5SJohn-Mark Gurney 	ipflags = 0;
1196b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_DONTROUTE)
1197b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ROUTETOIF;
1198b5d47ff5SJohn-Mark Gurney 	if (inp->inp_socket->so_options & SO_BROADCAST)
1199b5d47ff5SJohn-Mark Gurney 		ipflags |= IP_ALLOWBROADCAST;
12006fbfd582SAndre Oppermann 	if (inp->inp_flags & INP_ONESBCAST)
12018afa2304SBruce M Simpson 		ipflags |= IP_SENDONES;
12028afa2304SBruce M Simpson 
12031175d9d5SRobert Watson #ifdef MAC
12041175d9d5SRobert Watson 	mac_inpcb_create_mbuf(inp, m);
12051175d9d5SRobert Watson #endif
12061175d9d5SRobert Watson 
1207df8bae1dSRodney W. Grimes 	/*
1208db4f9cc7SJonathan Lemon 	 * Set up checksum and output datagram.
1209df8bae1dSRodney W. Grimes 	 */
1210f5514f08SRobert Watson 	if (udp_cksum) {
12116fbfd582SAndre Oppermann 		if (inp->inp_flags & INP_ONESBCAST)
12128a538743SBruce M Simpson 			faddr.s_addr = INADDR_BROADCAST;
12138a538743SBruce M Simpson 		ui->ui_sum = in_pseudo(ui->ui_src.s_addr, faddr.s_addr,
1214db4f9cc7SJonathan Lemon 		    htons((u_short)len + sizeof(struct udphdr) + IPPROTO_UDP));
1215db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_flags = CSUM_UDP;
1216db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum);
12173329b236SRobert Watson 	} else
1218db4f9cc7SJonathan Lemon 		ui->ui_sum = 0;
1219df8bae1dSRodney W. Grimes 	((struct ip *)ui)->ip_len = sizeof (struct udpiphdr) + len;
1220ca98b82cSDavid Greenman 	((struct ip *)ui)->ip_ttl = inp->inp_ip_ttl;	/* XXX */
1221ca98b82cSDavid Greenman 	((struct ip *)ui)->ip_tos = inp->inp_ip_tos;	/* XXX */
1222026decb8SRobert Watson 	UDPSTAT_INC(udps_opackets);
1223cfa1ca9dSYoshinobu Inoue 
122443cc0bc1SRobert Watson 	if (unlock_udbinfo == 2)
1225603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
122643cc0bc1SRobert Watson 	else if (unlock_udbinfo == 1)
1227603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
122897d8d152SAndre Oppermann 	error = ip_output(m, inp->inp_options, NULL, ipflags,
12295d846453SSam Leffler 	    inp->inp_moptions, inp);
123043cc0bc1SRobert Watson 	if (unlock_udbinfo == 2)
12318501a69cSRobert Watson 		INP_WUNLOCK(inp);
1232948d0fc9SRobert Watson 	else
1233948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1234df8bae1dSRodney W. Grimes 	return (error);
1235df8bae1dSRodney W. Grimes 
1236df8bae1dSRodney W. Grimes release:
123743cc0bc1SRobert Watson 	if (unlock_udbinfo == 2) {
1238948d0fc9SRobert Watson 		INP_WUNLOCK(inp);
1239603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
124043cc0bc1SRobert Watson 	} else if (unlock_udbinfo == 1) {
124143cc0bc1SRobert Watson 		INP_RUNLOCK(inp);
1242603724d3SBjoern A. Zeeb 		INP_INFO_RUNLOCK(&V_udbinfo);
1243948d0fc9SRobert Watson 	} else
1244948d0fc9SRobert Watson 		INP_RUNLOCK(inp);
1245df8bae1dSRodney W. Grimes 	m_freem(m);
1246df8bae1dSRodney W. Grimes 	return (error);
1247df8bae1dSRodney W. Grimes }
1248df8bae1dSRodney W. Grimes 
12497b495c44SVANHULLEBUS Yvan 
12507b495c44SVANHULLEBUS Yvan #if defined(IPSEC) && defined(IPSEC_NAT_T)
12517b495c44SVANHULLEBUS Yvan #ifdef INET
12527b495c44SVANHULLEBUS Yvan /*
12537b495c44SVANHULLEBUS Yvan  * Potentially decap ESP in UDP frame.  Check for an ESP header
12547b495c44SVANHULLEBUS Yvan  * and optional marker; if present, strip the UDP header and
12557b495c44SVANHULLEBUS Yvan  * push the result through IPSec.
12567b495c44SVANHULLEBUS Yvan  *
12577b495c44SVANHULLEBUS Yvan  * Returns mbuf to be processed (potentially re-allocated) or
12587b495c44SVANHULLEBUS Yvan  * NULL if consumed and/or processed.
12597b495c44SVANHULLEBUS Yvan  */
12607b495c44SVANHULLEBUS Yvan static struct mbuf *
12617b495c44SVANHULLEBUS Yvan udp4_espdecap(struct inpcb *inp, struct mbuf *m, int off)
12627b495c44SVANHULLEBUS Yvan {
12637b495c44SVANHULLEBUS Yvan 	size_t minlen, payload, skip, iphlen;
12647b495c44SVANHULLEBUS Yvan 	caddr_t data;
12657b495c44SVANHULLEBUS Yvan 	struct udpcb *up;
12667b495c44SVANHULLEBUS Yvan 	struct m_tag *tag;
12677b495c44SVANHULLEBUS Yvan 	struct udphdr *udphdr;
12687b495c44SVANHULLEBUS Yvan 	struct ip *ip;
12697b495c44SVANHULLEBUS Yvan 
12707b495c44SVANHULLEBUS Yvan 	INP_RLOCK_ASSERT(inp);
12717b495c44SVANHULLEBUS Yvan 
12727b495c44SVANHULLEBUS Yvan 	/*
12737b495c44SVANHULLEBUS Yvan 	 * Pull up data so the longest case is contiguous:
12747b495c44SVANHULLEBUS Yvan 	 *    IP/UDP hdr + non ESP marker + ESP hdr.
12757b495c44SVANHULLEBUS Yvan 	 */
12767b495c44SVANHULLEBUS Yvan 	minlen = off + sizeof(uint64_t) + sizeof(struct esp);
12777b495c44SVANHULLEBUS Yvan 	if (minlen > m->m_pkthdr.len)
12787b495c44SVANHULLEBUS Yvan 		minlen = m->m_pkthdr.len;
12797b495c44SVANHULLEBUS Yvan 	if ((m = m_pullup(m, minlen)) == NULL) {
12807b495c44SVANHULLEBUS Yvan 		V_ipsec4stat.in_inval++;
12817b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Bypass caller processing. */
12827b495c44SVANHULLEBUS Yvan 	}
12837b495c44SVANHULLEBUS Yvan 	data = mtod(m, caddr_t);	/* Points to ip header. */
12847b495c44SVANHULLEBUS Yvan 	payload = m->m_len - off;	/* Size of payload. */
12857b495c44SVANHULLEBUS Yvan 
12867b495c44SVANHULLEBUS Yvan 	if (payload == 1 && data[off] == '\xff')
12877b495c44SVANHULLEBUS Yvan 		return (m);		/* NB: keepalive packet, no decap. */
12887b495c44SVANHULLEBUS Yvan 
12897b495c44SVANHULLEBUS Yvan 	up = intoudpcb(inp);
12907b495c44SVANHULLEBUS Yvan 	KASSERT(up != NULL, ("%s: udpcb NULL", __func__));
12917b495c44SVANHULLEBUS Yvan 	KASSERT((up->u_flags & UF_ESPINUDP_ALL) != 0,
12927b495c44SVANHULLEBUS Yvan 	    ("u_flags 0x%x", up->u_flags));
12937b495c44SVANHULLEBUS Yvan 
12947b495c44SVANHULLEBUS Yvan 	/*
12957b495c44SVANHULLEBUS Yvan 	 * Check that the payload is large enough to hold an
12967b495c44SVANHULLEBUS Yvan 	 * ESP header and compute the amount of data to remove.
12977b495c44SVANHULLEBUS Yvan 	 *
12987b495c44SVANHULLEBUS Yvan 	 * NB: the caller has already done a pullup for us.
12997b495c44SVANHULLEBUS Yvan 	 * XXX can we assume alignment and eliminate bcopys?
13007b495c44SVANHULLEBUS Yvan 	 */
13017b495c44SVANHULLEBUS Yvan 	if (up->u_flags & UF_ESPINUDP_NON_IKE) {
13027b495c44SVANHULLEBUS Yvan 		/*
13037b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-nat-t-ike-0[01].txt and
13047b495c44SVANHULLEBUS Yvan 		 * draft-ietf-ipsec-udp-encaps-(00/)01.txt, ignoring
13057b495c44SVANHULLEBUS Yvan 		 * possible AH mode non-IKE marker+non-ESP marker
13067b495c44SVANHULLEBUS Yvan 		 * from draft-ietf-ipsec-udp-encaps-00.txt.
13077b495c44SVANHULLEBUS Yvan 		 */
13087b495c44SVANHULLEBUS Yvan 		uint64_t marker;
13097b495c44SVANHULLEBUS Yvan 
13107b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(uint64_t) + sizeof(struct esp))
13117b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13127b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &marker, sizeof(uint64_t));
13137b495c44SVANHULLEBUS Yvan 		if (marker != 0)	/* Non-IKE marker. */
13147b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13157b495c44SVANHULLEBUS Yvan 		skip = sizeof(uint64_t) + sizeof(struct udphdr);
13167b495c44SVANHULLEBUS Yvan 	} else {
13177b495c44SVANHULLEBUS Yvan 		uint32_t spi;
13187b495c44SVANHULLEBUS Yvan 
13197b495c44SVANHULLEBUS Yvan 		if (payload <= sizeof(struct esp)) {
13207b495c44SVANHULLEBUS Yvan 			V_ipsec4stat.in_inval++;
13217b495c44SVANHULLEBUS Yvan 			m_freem(m);
13227b495c44SVANHULLEBUS Yvan 			return (NULL);	/* Discard. */
13237b495c44SVANHULLEBUS Yvan 		}
13247b495c44SVANHULLEBUS Yvan 		bcopy(data + off, &spi, sizeof(uint32_t));
13257b495c44SVANHULLEBUS Yvan 		if (spi == 0)		/* Non-ESP marker. */
13267b495c44SVANHULLEBUS Yvan 			return (m);	/* NB: no decap. */
13277b495c44SVANHULLEBUS Yvan 		skip = sizeof(struct udphdr);
13287b495c44SVANHULLEBUS Yvan 	}
13297b495c44SVANHULLEBUS Yvan 
13307b495c44SVANHULLEBUS Yvan 	/*
13317b495c44SVANHULLEBUS Yvan 	 * Setup a PACKET_TAG_IPSEC_NAT_T_PORT tag to remember
13327b495c44SVANHULLEBUS Yvan 	 * the UDP ports. This is required if we want to select
13337b495c44SVANHULLEBUS Yvan 	 * the right SPD for multiple hosts behind same NAT.
13347b495c44SVANHULLEBUS Yvan 	 *
13357b495c44SVANHULLEBUS Yvan 	 * NB: ports are maintained in network byte order everywhere
13367b495c44SVANHULLEBUS Yvan 	 *     in the NAT-T code.
13377b495c44SVANHULLEBUS Yvan 	 */
13387b495c44SVANHULLEBUS Yvan 	tag = m_tag_get(PACKET_TAG_IPSEC_NAT_T_PORTS,
13397b495c44SVANHULLEBUS Yvan 		2 * sizeof(uint16_t), M_NOWAIT);
13407b495c44SVANHULLEBUS Yvan 	if (tag == NULL) {
13417b495c44SVANHULLEBUS Yvan 		V_ipsec4stat.in_nomem++;
13427b495c44SVANHULLEBUS Yvan 		m_freem(m);
13437b495c44SVANHULLEBUS Yvan 		return (NULL);		/* Discard. */
13447b495c44SVANHULLEBUS Yvan 	}
13457b495c44SVANHULLEBUS Yvan 	iphlen = off - sizeof(struct udphdr);
13467b495c44SVANHULLEBUS Yvan 	udphdr = (struct udphdr *)(data + iphlen);
13477b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[0] = udphdr->uh_sport;
13487b495c44SVANHULLEBUS Yvan 	((uint16_t *)(tag + 1))[1] = udphdr->uh_dport;
13497b495c44SVANHULLEBUS Yvan 	m_tag_prepend(m, tag);
13507b495c44SVANHULLEBUS Yvan 
13517b495c44SVANHULLEBUS Yvan 	/*
13527b495c44SVANHULLEBUS Yvan 	 * Remove the UDP header (and possibly the non ESP marker)
13537b495c44SVANHULLEBUS Yvan 	 * IP header length is iphlen
13547b495c44SVANHULLEBUS Yvan 	 * Before:
13557b495c44SVANHULLEBUS Yvan 	 *   <--- off --->
13567b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
13577b495c44SVANHULLEBUS Yvan 	 *   | IP |  UDP | ESP |
13587b495c44SVANHULLEBUS Yvan 	 *   +----+------+-----+
13597b495c44SVANHULLEBUS Yvan 	 *        <-skip->
13607b495c44SVANHULLEBUS Yvan 	 * After:
13617b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
13627b495c44SVANHULLEBUS Yvan 	 *          | IP | ESP |
13637b495c44SVANHULLEBUS Yvan 	 *          +----+-----+
13647b495c44SVANHULLEBUS Yvan 	 *   <-skip->
13657b495c44SVANHULLEBUS Yvan 	 */
13667b495c44SVANHULLEBUS Yvan 	ovbcopy(data, data + skip, iphlen);
13677b495c44SVANHULLEBUS Yvan 	m_adj(m, skip);
13687b495c44SVANHULLEBUS Yvan 
13697b495c44SVANHULLEBUS Yvan 	ip = mtod(m, struct ip *);
13707b495c44SVANHULLEBUS Yvan 	ip->ip_len -= skip;
13717b495c44SVANHULLEBUS Yvan 	ip->ip_p = IPPROTO_ESP;
13727b495c44SVANHULLEBUS Yvan 
13737b495c44SVANHULLEBUS Yvan 	/*
13747b495c44SVANHULLEBUS Yvan 	 * We cannot yet update the cksums so clear any
13757b495c44SVANHULLEBUS Yvan 	 * h/w cksum flags as they are no longer valid.
13767b495c44SVANHULLEBUS Yvan 	 */
13777b495c44SVANHULLEBUS Yvan 	if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID)
13787b495c44SVANHULLEBUS Yvan 		m->m_pkthdr.csum_flags &= ~(CSUM_DATA_VALID|CSUM_PSEUDO_HDR);
13797b495c44SVANHULLEBUS Yvan 
13807b495c44SVANHULLEBUS Yvan 	(void) ipsec4_common_input(m, iphlen, ip->ip_p);
13817b495c44SVANHULLEBUS Yvan 	return (NULL);			/* NB: consumed, bypass processing. */
13827b495c44SVANHULLEBUS Yvan }
13837b495c44SVANHULLEBUS Yvan #endif /* INET */
13847b495c44SVANHULLEBUS Yvan #endif /* defined(IPSEC) && defined(IPSEC_NAT_T) */
13857b495c44SVANHULLEBUS Yvan 
1386ac45e92fSRobert Watson static void
1387d0390e05SGarrett Wollman udp_abort(struct socket *so)
1388df8bae1dSRodney W. Grimes {
1389d0390e05SGarrett Wollman 	struct inpcb *inp;
1390df8bae1dSRodney W. Grimes 
1391d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
139214ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_abort: inp == NULL"));
1393603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
13948501a69cSRobert Watson 	INP_WLOCK(inp);
1395a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1396a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1397a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1398d0390e05SGarrett Wollman 		soisdisconnected(so);
1399a152f8a3SRobert Watson 	}
14008501a69cSRobert Watson 	INP_WUNLOCK(inp);
1401603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
1402df8bae1dSRodney W. Grimes }
1403df8bae1dSRodney W. Grimes 
1404d0390e05SGarrett Wollman static int
1405b40ce416SJulian Elischer udp_attach(struct socket *so, int proto, struct thread *td)
1406d0390e05SGarrett Wollman {
1407d0390e05SGarrett Wollman 	struct inpcb *inp;
1408277afaffSRobert Watson 	int error;
1409d0390e05SGarrett Wollman 
1410d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
141114ba8addSRobert Watson 	KASSERT(inp == NULL, ("udp_attach: inp != NULL"));
1412cfa1ca9dSYoshinobu Inoue 	error = soreserve(so, udp_sendspace, udp_recvspace);
1413f24618aaSRobert Watson 	if (error)
14143329b236SRobert Watson 		return (error);
1415603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
1416603724d3SBjoern A. Zeeb 	error = in_pcballoc(so, &V_udbinfo);
141753b57cd1SSam Leffler 	if (error) {
1418603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
14193329b236SRobert Watson 		return (error);
142053b57cd1SSam Leffler 	}
1421cfa1ca9dSYoshinobu Inoue 
142268b5629bSRobert Watson 	inp = sotoinpcb(so);
1423cfa1ca9dSYoshinobu Inoue 	inp->inp_vflag |= INP_IPV4;
1424603724d3SBjoern A. Zeeb 	inp->inp_ip_ttl = V_ip_defttl;
14256a9148feSBjoern A. Zeeb 
14266a9148feSBjoern A. Zeeb 	error = udp_newudpcb(inp);
14276a9148feSBjoern A. Zeeb 	if (error) {
14286a9148feSBjoern A. Zeeb 		in_pcbdetach(inp);
14296a9148feSBjoern A. Zeeb 		in_pcbfree(inp);
14306a9148feSBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
14316a9148feSBjoern A. Zeeb 		return (error);
14326a9148feSBjoern A. Zeeb 	}
14336a9148feSBjoern A. Zeeb 
1434c7c7ea4bSRandall Stewart 	INP_WUNLOCK(inp);
14356a9148feSBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
1436c7c7ea4bSRandall Stewart 	return (0);
1437c7c7ea4bSRandall Stewart }
1438c7c7ea4bSRandall Stewart 
1439c7c7ea4bSRandall Stewart int
1440c7c7ea4bSRandall Stewart udp_set_kernel_tunneling(struct socket *so, udp_tun_func_t f)
1441c7c7ea4bSRandall Stewart {
1442c7c7ea4bSRandall Stewart 	struct inpcb *inp;
14436a9148feSBjoern A. Zeeb 	struct udpcb *up;
1444c7c7ea4bSRandall Stewart 
144568b5629bSRobert Watson 	KASSERT(so->so_type == SOCK_DGRAM,
144668b5629bSRobert Watson 	    ("udp_set_kernel_tunneling: !dgram"));
144768b5629bSRobert Watson 	inp = sotoinpcb(so);
144868b5629bSRobert Watson 	KASSERT(inp != NULL, ("udp_set_kernel_tunneling: inp == NULL"));
1449c7c7ea4bSRandall Stewart 	INP_WLOCK(inp);
14506a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
14516a9148feSBjoern A. Zeeb 	if (up->u_tun_func != NULL) {
1452bbb0e3d9SRandall Stewart 		INP_WUNLOCK(inp);
1453bbb0e3d9SRandall Stewart 		return (EBUSY);
1454bbb0e3d9SRandall Stewart 	}
14556a9148feSBjoern A. Zeeb 	up->u_tun_func = f;
14568501a69cSRobert Watson 	INP_WUNLOCK(inp);
14573329b236SRobert Watson 	return (0);
1458df8bae1dSRodney W. Grimes }
1459d0390e05SGarrett Wollman 
1460d0390e05SGarrett Wollman static int
1461b40ce416SJulian Elischer udp_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
1462d0390e05SGarrett Wollman {
1463d0390e05SGarrett Wollman 	struct inpcb *inp;
1464277afaffSRobert Watson 	int error;
1465d0390e05SGarrett Wollman 
1466d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
146714ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_bind: inp == NULL"));
1468603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
14698501a69cSRobert Watson 	INP_WLOCK(inp);
1470b0330ed9SPawel Jakub Dawidek 	error = in_pcbbind(inp, nam, td->td_ucred);
14718501a69cSRobert Watson 	INP_WUNLOCK(inp);
1472603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
14733329b236SRobert Watson 	return (error);
1474d0390e05SGarrett Wollman }
1475d0390e05SGarrett Wollman 
1476a152f8a3SRobert Watson static void
1477a152f8a3SRobert Watson udp_close(struct socket *so)
1478a152f8a3SRobert Watson {
1479a152f8a3SRobert Watson 	struct inpcb *inp;
1480a152f8a3SRobert Watson 
1481a152f8a3SRobert Watson 	inp = sotoinpcb(so);
1482a152f8a3SRobert Watson 	KASSERT(inp != NULL, ("udp_close: inp == NULL"));
1483603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
14848501a69cSRobert Watson 	INP_WLOCK(inp);
1485a152f8a3SRobert Watson 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
1486a152f8a3SRobert Watson 		in_pcbdisconnect(inp);
1487a152f8a3SRobert Watson 		inp->inp_laddr.s_addr = INADDR_ANY;
1488a152f8a3SRobert Watson 		soisdisconnected(so);
1489a152f8a3SRobert Watson 	}
14908501a69cSRobert Watson 	INP_WUNLOCK(inp);
1491603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
1492a152f8a3SRobert Watson }
1493a152f8a3SRobert Watson 
1494d0390e05SGarrett Wollman static int
1495b40ce416SJulian Elischer udp_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
1496d0390e05SGarrett Wollman {
1497d0390e05SGarrett Wollman 	struct inpcb *inp;
1498277afaffSRobert Watson 	int error;
149975c13541SPoul-Henning Kamp 	struct sockaddr_in *sin;
1500d0390e05SGarrett Wollman 
1501d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
150214ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_connect: inp == NULL"));
1503603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
15048501a69cSRobert Watson 	INP_WLOCK(inp);
1505f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr != INADDR_ANY) {
15068501a69cSRobert Watson 		INP_WUNLOCK(inp);
1507603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
15083329b236SRobert Watson 		return (EISCONN);
1509f76fcf6dSJeffrey Hsu 	}
151075c13541SPoul-Henning Kamp 	sin = (struct sockaddr_in *)nam;
1511b89e82ddSJamie Gritton 	error = prison_remote_ip4(td->td_ucred, &sin->sin_addr);
1512b89e82ddSJamie Gritton 	if (error != 0) {
1513413628a7SBjoern A. Zeeb 		INP_WUNLOCK(inp);
1514385195c0SMarko Zec 		INP_INFO_WUNLOCK(&V_udbinfo);
1515b89e82ddSJamie Gritton 		return (error);
1516413628a7SBjoern A. Zeeb 	}
1517b0330ed9SPawel Jakub Dawidek 	error = in_pcbconnect(inp, nam, td->td_ucred);
15184cc20ab1SSeigo Tanimura 	if (error == 0)
1519df8bae1dSRodney W. Grimes 		soisconnected(so);
15208501a69cSRobert Watson 	INP_WUNLOCK(inp);
1521603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
15223329b236SRobert Watson 	return (error);
1523df8bae1dSRodney W. Grimes }
1524d0390e05SGarrett Wollman 
1525bc725eafSRobert Watson static void
1526d0390e05SGarrett Wollman udp_detach(struct socket *so)
1527d0390e05SGarrett Wollman {
1528d0390e05SGarrett Wollman 	struct inpcb *inp;
15296a9148feSBjoern A. Zeeb 	struct udpcb *up;
1530d0390e05SGarrett Wollman 
1531d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
153214ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_detach: inp == NULL"));
1533a152f8a3SRobert Watson 	KASSERT(inp->inp_faddr.s_addr == INADDR_ANY,
1534a152f8a3SRobert Watson 	    ("udp_detach: not disconnected"));
1535603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
15368501a69cSRobert Watson 	INP_WLOCK(inp);
15376a9148feSBjoern A. Zeeb 	up = intoudpcb(inp);
15386a9148feSBjoern A. Zeeb 	KASSERT(up != NULL, ("%s: up == NULL", __func__));
15396a9148feSBjoern A. Zeeb 	inp->inp_ppcb = NULL;
1540d0390e05SGarrett Wollman 	in_pcbdetach(inp);
154114ba8addSRobert Watson 	in_pcbfree(inp);
1542603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
15436a9148feSBjoern A. Zeeb 	udp_discardcb(up);
1544d0390e05SGarrett Wollman }
1545d0390e05SGarrett Wollman 
1546d0390e05SGarrett Wollman static int
1547d0390e05SGarrett Wollman udp_disconnect(struct socket *so)
1548d0390e05SGarrett Wollman {
1549d0390e05SGarrett Wollman 	struct inpcb *inp;
1550d0390e05SGarrett Wollman 
1551d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
155214ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_disconnect: inp == NULL"));
1553603724d3SBjoern A. Zeeb 	INP_INFO_WLOCK(&V_udbinfo);
15548501a69cSRobert Watson 	INP_WLOCK(inp);
1555f76fcf6dSJeffrey Hsu 	if (inp->inp_faddr.s_addr == INADDR_ANY) {
15568501a69cSRobert Watson 		INP_WUNLOCK(inp);
1557603724d3SBjoern A. Zeeb 		INP_INFO_WUNLOCK(&V_udbinfo);
15583329b236SRobert Watson 		return (ENOTCONN);
1559f76fcf6dSJeffrey Hsu 	}
1560d0390e05SGarrett Wollman 
1561df8bae1dSRodney W. Grimes 	in_pcbdisconnect(inp);
1562df8bae1dSRodney W. Grimes 	inp->inp_laddr.s_addr = INADDR_ANY;
1563d45e4f99SMaxim Konovalov 	SOCK_LOCK(so);
1564d45e4f99SMaxim Konovalov 	so->so_state &= ~SS_ISCONNECTED;		/* XXX */
1565d45e4f99SMaxim Konovalov 	SOCK_UNLOCK(so);
15668501a69cSRobert Watson 	INP_WUNLOCK(inp);
1567603724d3SBjoern A. Zeeb 	INP_INFO_WUNLOCK(&V_udbinfo);
15683329b236SRobert Watson 	return (0);
1569df8bae1dSRodney W. Grimes }
1570df8bae1dSRodney W. Grimes 
1571d0390e05SGarrett Wollman static int
157257bf258eSGarrett Wollman udp_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr,
1573b40ce416SJulian Elischer     struct mbuf *control, struct thread *td)
1574d0390e05SGarrett Wollman {
1575d0390e05SGarrett Wollman 	struct inpcb *inp;
1576d0390e05SGarrett Wollman 
1577d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
157814ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_send: inp == NULL"));
15793329b236SRobert Watson 	return (udp_output(inp, m, addr, control, td));
1580d0390e05SGarrett Wollman }
1581d0390e05SGarrett Wollman 
158276429de4SYoshinobu Inoue int
1583d0390e05SGarrett Wollman udp_shutdown(struct socket *so)
1584d0390e05SGarrett Wollman {
1585d0390e05SGarrett Wollman 	struct inpcb *inp;
1586d0390e05SGarrett Wollman 
1587d0390e05SGarrett Wollman 	inp = sotoinpcb(so);
158814ba8addSRobert Watson 	KASSERT(inp != NULL, ("udp_shutdown: inp == NULL"));
15898501a69cSRobert Watson 	INP_WLOCK(inp);
1590d0390e05SGarrett Wollman 	socantsendmore(so);
15918501a69cSRobert Watson 	INP_WUNLOCK(inp);
15923329b236SRobert Watson 	return (0);
1593d0390e05SGarrett Wollman }
1594d0390e05SGarrett Wollman 
1595d0390e05SGarrett Wollman struct pr_usrreqs udp_usrreqs = {
1596756d52a1SPoul-Henning Kamp 	.pru_abort =		udp_abort,
1597756d52a1SPoul-Henning Kamp 	.pru_attach =		udp_attach,
1598756d52a1SPoul-Henning Kamp 	.pru_bind =		udp_bind,
1599756d52a1SPoul-Henning Kamp 	.pru_connect =		udp_connect,
1600756d52a1SPoul-Henning Kamp 	.pru_control =		in_control,
1601756d52a1SPoul-Henning Kamp 	.pru_detach =		udp_detach,
1602756d52a1SPoul-Henning Kamp 	.pru_disconnect =	udp_disconnect,
160354d642bbSRobert Watson 	.pru_peeraddr =		in_getpeeraddr,
1604756d52a1SPoul-Henning Kamp 	.pru_send =		udp_send,
16055df3e839SRobert Watson 	.pru_soreceive =	soreceive_dgram,
160659b8854eSRobert Watson 	.pru_sosend =		sosend_dgram,
1607756d52a1SPoul-Henning Kamp 	.pru_shutdown =		udp_shutdown,
160854d642bbSRobert Watson 	.pru_sockaddr =		in_getsockaddr,
1609a152f8a3SRobert Watson 	.pru_sosetlabel =	in_pcbsosetlabel,
1610a152f8a3SRobert Watson 	.pru_close =		udp_close,
1611d0390e05SGarrett Wollman };
1612