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> 68*c1de64a4SAndrey V. Elsukov #include <net/pfil.h> 69df8bae1dSRodney W. Grimes #include <net/route.h> 70df8bae1dSRodney W. Grimes 71df8bae1dSRodney W. Grimes #include <netinet/in.h> 72960ed29cSSeigo Tanimura #include <netinet/in_pcb.h> 73f5514f08SRobert Watson #include <netinet/in_systm.h> 74960ed29cSSeigo Tanimura #include <netinet/in_var.h> 75df8bae1dSRodney W. Grimes #include <netinet/ip.h> 76cfa1ca9dSYoshinobu Inoue #ifdef INET6 77cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h> 78cfa1ca9dSYoshinobu Inoue #endif 79960ed29cSSeigo Tanimura #include <netinet/ip_icmp.h> 80960ed29cSSeigo Tanimura #include <netinet/icmp_var.h> 81df8bae1dSRodney W. Grimes #include <netinet/ip_var.h> 82ef39adf0SAndre Oppermann #include <netinet/ip_options.h> 83cfa1ca9dSYoshinobu Inoue #ifdef INET6 84cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h> 85cfa1ca9dSYoshinobu Inoue #endif 86df8bae1dSRodney W. Grimes #include <netinet/udp.h> 87df8bae1dSRodney W. Grimes #include <netinet/udp_var.h> 88df8bae1dSRodney W. Grimes 89b2630c29SGeorge V. Neville-Neil #ifdef IPSEC 90b9234fafSSam Leffler #include <netipsec/ipsec.h> 917b495c44SVANHULLEBUS Yvan #include <netipsec/esp.h> 923329b236SRobert Watson #endif 93b9234fafSSam Leffler 94db4f9cc7SJonathan Lemon #include <machine/in_cksum.h> 95db4f9cc7SJonathan Lemon 96aed55708SRobert Watson #include <security/mac/mac_framework.h> 97aed55708SRobert Watson 98df8bae1dSRodney W. Grimes /* 99df8bae1dSRodney W. Grimes * UDP protocol implementation. 100df8bae1dSRodney W. Grimes * Per RFC 768, August, 1980. 101df8bae1dSRodney W. Grimes */ 10274eb3236SWarner Losh 10374eb3236SWarner Losh /* 1043329b236SRobert Watson * BSD 4.2 defaulted the udp checksum to be off. Turning off udp checksums 1053329b236SRobert Watson * removes the only data integrity mechanism for packets and malformed 106f5514f08SRobert Watson * packets that would otherwise be discarded due to bad checksums, and may 107f5514f08SRobert Watson * cause problems (especially for NFS data blocks). 10874eb3236SWarner Losh */ 10940b676beSBjoern A. Zeeb VNET_DEFINE(int, udp_cksum) = 1; 11040b676beSBjoern A. Zeeb SYSCTL_VNET_INT(_net_inet_udp, UDPCTL_CHECKSUM, checksum, CTLFLAG_RW, 11140b676beSBjoern A. Zeeb &VNET_NAME(udp_cksum), 0, "compute udp checksum"); 112df8bae1dSRodney W. Grimes 113afdb4274SRobert Watson int udp_log_in_vain = 0; 114816a3d83SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, OID_AUTO, log_in_vain, CTLFLAG_RW, 115afdb4274SRobert Watson &udp_log_in_vain, 0, "Log all incoming UDP packets"); 116816a3d83SPoul-Henning Kamp 11782cea7e6SBjoern A. Zeeb VNET_DEFINE(int, udp_blackhole) = 0; 118eddfbb76SRobert Watson SYSCTL_VNET_INT(_net_inet_udp, OID_AUTO, blackhole, CTLFLAG_RW, 119eddfbb76SRobert Watson &VNET_NAME(udp_blackhole), 0, 1203329b236SRobert Watson "Do not send port unreachables for refused connects"); 12116f7f31fSGeoff Rehmet 12243bbb6aaSRobert Watson u_long udp_sendspace = 9216; /* really max datagram size */ 12343bbb6aaSRobert Watson /* 40 1K datagrams */ 12443bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_MAXDGRAM, maxdgram, CTLFLAG_RW, 12543bbb6aaSRobert Watson &udp_sendspace, 0, "Maximum outgoing UDP datagram size"); 12643bbb6aaSRobert Watson 12743bbb6aaSRobert Watson u_long udp_recvspace = 40 * (1024 + 12843bbb6aaSRobert Watson #ifdef INET6 12943bbb6aaSRobert Watson sizeof(struct sockaddr_in6) 13043bbb6aaSRobert Watson #else 13143bbb6aaSRobert Watson sizeof(struct sockaddr_in) 13243bbb6aaSRobert Watson #endif 13343bbb6aaSRobert Watson ); 13443bbb6aaSRobert Watson 13543bbb6aaSRobert Watson SYSCTL_ULONG(_net_inet_udp, UDPCTL_RECVSPACE, recvspace, CTLFLAG_RW, 13643bbb6aaSRobert Watson &udp_recvspace, 0, "Maximum space for incoming UDP datagrams"); 13743bbb6aaSRobert Watson 138eddfbb76SRobert Watson VNET_DEFINE(struct inpcbhead, udb); /* from udp_var.h */ 139eddfbb76SRobert Watson VNET_DEFINE(struct inpcbinfo, udbinfo); 1403e288e62SDimitry Andric static VNET_DEFINE(uma_zone_t, udpcb_zone); 1411e77c105SRobert Watson #define V_udpcb_zone VNET(udpcb_zone) 14215bd2b43SDavid Greenman 14315bd2b43SDavid Greenman #ifndef UDBHASHSIZE 144e2ed8f35SAlexander Motin #define UDBHASHSIZE 128 14515bd2b43SDavid Greenman #endif 14615bd2b43SDavid Greenman 14782cea7e6SBjoern A. Zeeb VNET_DEFINE(struct udpstat, udpstat); /* from udp_var.h */ 148eddfbb76SRobert Watson SYSCTL_VNET_STRUCT(_net_inet_udp, UDPCTL_STATS, stats, CTLFLAG_RW, 149eddfbb76SRobert Watson &VNET_NAME(udpstat), udpstat, 1508b615593SMarko Zec "UDP statistics (struct udpstat, netinet/udp_var.h)"); 151f2ea20e6SGarrett Wollman 15279288c11SBjoern A. Zeeb #ifdef INET 153bc725eafSRobert Watson static void udp_detach(struct socket *so); 1544d77a549SAlfred Perlstein static int udp_output(struct inpcb *, struct mbuf *, struct sockaddr *, 1554d77a549SAlfred Perlstein struct mbuf *, struct thread *); 15679288c11SBjoern A. Zeeb #endif 15779288c11SBjoern A. Zeeb 1587b495c44SVANHULLEBUS Yvan #ifdef IPSEC 1597b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T 1607b495c44SVANHULLEBUS Yvan #define UF_ESPINUDP_ALL (UF_ESPINUDP_NON_IKE|UF_ESPINUDP) 1617b495c44SVANHULLEBUS Yvan #ifdef INET 1627b495c44SVANHULLEBUS Yvan static struct mbuf *udp4_espdecap(struct inpcb *, struct mbuf *, int); 1637b495c44SVANHULLEBUS Yvan #endif 1647b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */ 1657b495c44SVANHULLEBUS Yvan #endif /* IPSEC */ 166df8bae1dSRodney W. Grimes 1674f590175SPaul Saab static void 1684f590175SPaul Saab udp_zone_change(void *tag) 1694f590175SPaul Saab { 1704f590175SPaul Saab 171603724d3SBjoern A. Zeeb uma_zone_set_max(V_udbinfo.ipi_zone, maxsockets); 1726a9148feSBjoern A. Zeeb uma_zone_set_max(V_udpcb_zone, maxsockets); 1734f590175SPaul Saab } 1744f590175SPaul Saab 175d915b280SStephan Uphoff static int 176d915b280SStephan Uphoff udp_inpcb_init(void *mem, int size, int flags) 177d915b280SStephan Uphoff { 178af1ee11dSRobert Watson struct inpcb *inp; 17908651e1fSJohn Baldwin 180af1ee11dSRobert Watson inp = mem; 181d915b280SStephan Uphoff INP_LOCK_INIT(inp, "inp", "udpinp"); 182d915b280SStephan Uphoff return (0); 183d915b280SStephan Uphoff } 184d915b280SStephan Uphoff 185df8bae1dSRodney W. Grimes void 186af1ee11dSRobert Watson udp_init(void) 187df8bae1dSRodney W. Grimes { 188af1ee11dSRobert Watson 1899bcd427bSRobert Watson in_pcbinfo_init(&V_udbinfo, "udp", &V_udb, UDBHASHSIZE, UDBHASHSIZE, 19052cd27cbSRobert Watson "udp_inpcb", udp_inpcb_init, NULL, UMA_ZONE_NOFREE, 19152cd27cbSRobert Watson IPI_HASHFIELDS_2TUPLE); 1926a9148feSBjoern A. Zeeb V_udpcb_zone = uma_zcreate("udpcb", sizeof(struct udpcb), 1936a9148feSBjoern A. Zeeb NULL, NULL, NULL, NULL, UMA_ALIGN_PTR, UMA_ZONE_NOFREE); 1946a9148feSBjoern A. Zeeb uma_zone_set_max(V_udpcb_zone, maxsockets); 1954f590175SPaul Saab EVENTHANDLER_REGISTER(maxsockets_change, udp_zone_change, NULL, 1964f590175SPaul Saab EVENTHANDLER_PRI_ANY); 197df8bae1dSRodney W. Grimes } 198df8bae1dSRodney W. Grimes 199315e3e38SRobert Watson /* 200315e3e38SRobert Watson * Kernel module interface for updating udpstat. The argument is an index 201315e3e38SRobert Watson * into udpstat treated as an array of u_long. While this encodes the 202315e3e38SRobert Watson * general layout of udpstat into the caller, it doesn't encode its location, 203315e3e38SRobert Watson * so that future changes to add, for example, per-CPU stats support won't 204315e3e38SRobert Watson * cause binary compatibility problems for kernel modules. 205315e3e38SRobert Watson */ 206315e3e38SRobert Watson void 207315e3e38SRobert Watson kmod_udpstat_inc(int statnum) 208315e3e38SRobert Watson { 209315e3e38SRobert Watson 210315e3e38SRobert Watson (*((u_long *)&V_udpstat + statnum))++; 211315e3e38SRobert Watson } 212315e3e38SRobert Watson 2136a9148feSBjoern A. Zeeb int 2146a9148feSBjoern A. Zeeb udp_newudpcb(struct inpcb *inp) 2156a9148feSBjoern A. Zeeb { 2166a9148feSBjoern A. Zeeb struct udpcb *up; 2176a9148feSBjoern A. Zeeb 2186a9148feSBjoern A. Zeeb up = uma_zalloc(V_udpcb_zone, M_NOWAIT | M_ZERO); 2196a9148feSBjoern A. Zeeb if (up == NULL) 2206a9148feSBjoern A. Zeeb return (ENOBUFS); 2216a9148feSBjoern A. Zeeb inp->inp_ppcb = up; 2226a9148feSBjoern A. Zeeb return (0); 2236a9148feSBjoern A. Zeeb } 2246a9148feSBjoern A. Zeeb 2256a9148feSBjoern A. Zeeb void 2266a9148feSBjoern A. Zeeb udp_discardcb(struct udpcb *up) 2276a9148feSBjoern A. Zeeb { 2286a9148feSBjoern A. Zeeb 2296a9148feSBjoern A. Zeeb uma_zfree(V_udpcb_zone, up); 2306a9148feSBjoern A. Zeeb } 2316a9148feSBjoern A. Zeeb 232bc29160dSMarko Zec #ifdef VIMAGE 233bc29160dSMarko Zec void 234bc29160dSMarko Zec udp_destroy(void) 235bc29160dSMarko Zec { 236bc29160dSMarko Zec 2379bcd427bSRobert Watson in_pcbinfo_destroy(&V_udbinfo); 238391dab1cSBjoern A. Zeeb uma_zdestroy(V_udpcb_zone); 239bc29160dSMarko Zec } 240bc29160dSMarko Zec #endif 241bc29160dSMarko Zec 24279288c11SBjoern A. Zeeb #ifdef INET 24343bbb6aaSRobert Watson /* 24443bbb6aaSRobert Watson * Subroutine of udp_input(), which appends the provided mbuf chain to the 24543bbb6aaSRobert Watson * passed pcb/socket. The caller must provide a sockaddr_in via udp_in that 24643bbb6aaSRobert Watson * contains the source address. If the socket ends up being an IPv6 socket, 24743bbb6aaSRobert Watson * udp_append() will convert to a sockaddr_in6 before passing the address 24843bbb6aaSRobert Watson * into the socket code. 24943bbb6aaSRobert Watson */ 25043bbb6aaSRobert Watson static void 25143bbb6aaSRobert Watson udp_append(struct inpcb *inp, struct ip *ip, struct mbuf *n, int off, 25243bbb6aaSRobert Watson struct sockaddr_in *udp_in) 25343bbb6aaSRobert Watson { 25443bbb6aaSRobert Watson struct sockaddr *append_sa; 25543bbb6aaSRobert Watson struct socket *so; 25643bbb6aaSRobert Watson struct mbuf *opts = 0; 25743bbb6aaSRobert Watson #ifdef INET6 25843bbb6aaSRobert Watson struct sockaddr_in6 udp_in6; 25943bbb6aaSRobert Watson #endif 2607b495c44SVANHULLEBUS Yvan struct udpcb *up; 26143bbb6aaSRobert Watson 262fa046d87SRobert Watson INP_LOCK_ASSERT(inp); 26343bbb6aaSRobert Watson 26479bb84fbSEdward Tomasz Napierala /* 26579bb84fbSEdward Tomasz Napierala * Engage the tunneling protocol. 26679bb84fbSEdward Tomasz Napierala */ 26779bb84fbSEdward Tomasz Napierala up = intoudpcb(inp); 26879bb84fbSEdward Tomasz Napierala if (up->u_tun_func != NULL) { 26979bb84fbSEdward Tomasz Napierala (*up->u_tun_func)(n, off, inp); 27079bb84fbSEdward Tomasz Napierala return; 27179bb84fbSEdward Tomasz Napierala } 27279bb84fbSEdward Tomasz Napierala 27379bb84fbSEdward Tomasz Napierala if (n == NULL) 27479bb84fbSEdward Tomasz Napierala return; 27579bb84fbSEdward Tomasz Napierala 27679bb84fbSEdward Tomasz Napierala off += sizeof(struct udphdr); 27779bb84fbSEdward Tomasz Napierala 27843bbb6aaSRobert Watson #ifdef IPSEC 27943bbb6aaSRobert Watson /* Check AH/ESP integrity. */ 28043bbb6aaSRobert Watson if (ipsec4_in_reject(n, inp)) { 28143bbb6aaSRobert Watson m_freem(n); 282603724d3SBjoern A. Zeeb V_ipsec4stat.in_polvio++; 28343bbb6aaSRobert Watson return; 28443bbb6aaSRobert Watson } 2857b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T 2867b495c44SVANHULLEBUS Yvan up = intoudpcb(inp); 2877b495c44SVANHULLEBUS Yvan KASSERT(up != NULL, ("%s: udpcb NULL", __func__)); 2887b495c44SVANHULLEBUS Yvan if (up->u_flags & UF_ESPINUDP_ALL) { /* IPSec UDP encaps. */ 2897b495c44SVANHULLEBUS Yvan n = udp4_espdecap(inp, n, off); 2907b495c44SVANHULLEBUS Yvan if (n == NULL) /* Consumed. */ 2917b495c44SVANHULLEBUS Yvan return; 2927b495c44SVANHULLEBUS Yvan } 2937b495c44SVANHULLEBUS Yvan #endif /* IPSEC_NAT_T */ 29443bbb6aaSRobert Watson #endif /* IPSEC */ 29543bbb6aaSRobert Watson #ifdef MAC 29630d239bcSRobert Watson if (mac_inpcb_check_deliver(inp, n) != 0) { 29743bbb6aaSRobert Watson m_freem(n); 29843bbb6aaSRobert Watson return; 29943bbb6aaSRobert Watson } 30079288c11SBjoern A. Zeeb #endif /* MAC */ 30143bbb6aaSRobert Watson if (inp->inp_flags & INP_CONTROLOPTS || 30243bbb6aaSRobert Watson inp->inp_socket->so_options & (SO_TIMESTAMP | SO_BINTIME)) { 30343bbb6aaSRobert Watson #ifdef INET6 3049a38ba81SBjoern A. Zeeb if (inp->inp_vflag & INP_IPV6) 30548d48eb9SBjoern A. Zeeb (void)ip6_savecontrol_v4(inp, n, &opts, NULL); 3069a38ba81SBjoern A. Zeeb else 30779288c11SBjoern A. Zeeb #endif /* INET6 */ 30843bbb6aaSRobert Watson ip_savecontrol(inp, &opts, ip, n); 30943bbb6aaSRobert Watson } 31043bbb6aaSRobert Watson #ifdef INET6 31143bbb6aaSRobert Watson if (inp->inp_vflag & INP_IPV6) { 31243bbb6aaSRobert Watson bzero(&udp_in6, sizeof(udp_in6)); 31343bbb6aaSRobert Watson udp_in6.sin6_len = sizeof(udp_in6); 31443bbb6aaSRobert Watson udp_in6.sin6_family = AF_INET6; 31543bbb6aaSRobert Watson in6_sin_2_v4mapsin6(udp_in, &udp_in6); 31643bbb6aaSRobert Watson append_sa = (struct sockaddr *)&udp_in6; 31743bbb6aaSRobert Watson } else 31879288c11SBjoern A. Zeeb #endif /* INET6 */ 31943bbb6aaSRobert Watson append_sa = (struct sockaddr *)udp_in; 32043bbb6aaSRobert Watson m_adj(n, off); 32143bbb6aaSRobert Watson 32243bbb6aaSRobert Watson so = inp->inp_socket; 32343bbb6aaSRobert Watson SOCKBUF_LOCK(&so->so_rcv); 32443bbb6aaSRobert Watson if (sbappendaddr_locked(&so->so_rcv, append_sa, n, opts) == 0) { 32543bbb6aaSRobert Watson SOCKBUF_UNLOCK(&so->so_rcv); 32643bbb6aaSRobert Watson m_freem(n); 32743bbb6aaSRobert Watson if (opts) 32843bbb6aaSRobert Watson m_freem(opts); 329026decb8SRobert Watson UDPSTAT_INC(udps_fullsock); 33043bbb6aaSRobert Watson } else 33143bbb6aaSRobert Watson sorwakeup_locked(so); 33243bbb6aaSRobert Watson } 33343bbb6aaSRobert Watson 334df8bae1dSRodney W. Grimes void 3353329b236SRobert Watson udp_input(struct mbuf *m, int off) 336df8bae1dSRodney W. Grimes { 337cfa1ca9dSYoshinobu Inoue int iphlen = off; 3383329b236SRobert Watson struct ip *ip; 3393329b236SRobert Watson struct udphdr *uh; 34071498f30SBruce M Simpson struct ifnet *ifp; 3413329b236SRobert Watson struct inpcb *inp; 3428f134647SGleb Smirnoff uint16_t len, ip_len; 343df8bae1dSRodney W. Grimes struct ip save_ip; 344d4b509bdSRobert Watson struct sockaddr_in udp_in; 3450b4ae859SGleb Smirnoff struct m_tag *fwd_tag; 346df8bae1dSRodney W. Grimes 34771498f30SBruce M Simpson ifp = m->m_pkthdr.rcvif; 348026decb8SRobert Watson UDPSTAT_INC(udps_ipackets); 349df8bae1dSRodney W. Grimes 350df8bae1dSRodney W. Grimes /* 3513329b236SRobert Watson * Strip IP options, if any; should skip this, make available to 3523329b236SRobert Watson * user, and use on returned packets, but we don't yet have a way to 3533329b236SRobert Watson * check the checksum with options still present. 354df8bae1dSRodney W. Grimes */ 355df8bae1dSRodney W. Grimes if (iphlen > sizeof (struct ip)) { 356105bd211SGleb Smirnoff ip_stripoptions(m); 357df8bae1dSRodney W. Grimes iphlen = sizeof(struct ip); 358df8bae1dSRodney W. Grimes } 359df8bae1dSRodney W. Grimes 360df8bae1dSRodney W. Grimes /* 361df8bae1dSRodney W. Grimes * Get IP and UDP header together in first mbuf. 362df8bae1dSRodney W. Grimes */ 363df8bae1dSRodney W. Grimes ip = mtod(m, struct ip *); 364df8bae1dSRodney W. Grimes if (m->m_len < iphlen + sizeof(struct udphdr)) { 365df8bae1dSRodney W. Grimes if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) { 366026decb8SRobert Watson UDPSTAT_INC(udps_hdrops); 367df8bae1dSRodney W. Grimes return; 368df8bae1dSRodney W. Grimes } 369df8bae1dSRodney W. Grimes ip = mtod(m, struct ip *); 370df8bae1dSRodney W. Grimes } 371df8bae1dSRodney W. Grimes uh = (struct udphdr *)((caddr_t)ip + iphlen); 372df8bae1dSRodney W. Grimes 3733329b236SRobert Watson /* 3743329b236SRobert Watson * Destination port of 0 is illegal, based on RFC768. 3753329b236SRobert Watson */ 376686cdd19SJun-ichiro itojun Hagino if (uh->uh_dport == 0) 377f76fcf6dSJeffrey Hsu goto badunlocked; 378686cdd19SJun-ichiro itojun Hagino 379df8bae1dSRodney W. Grimes /* 3803329b236SRobert Watson * Construct sockaddr format source address. Stuff source address 3813329b236SRobert Watson * and datagram in user buffer. 382b9234fafSSam Leffler */ 383d4b509bdSRobert Watson bzero(&udp_in, sizeof(udp_in)); 384d4b509bdSRobert Watson udp_in.sin_len = sizeof(udp_in); 385d4b509bdSRobert Watson udp_in.sin_family = AF_INET; 386b9234fafSSam Leffler udp_in.sin_port = uh->uh_sport; 387b9234fafSSam Leffler udp_in.sin_addr = ip->ip_src; 388b9234fafSSam Leffler 389b9234fafSSam Leffler /* 390af1ee11dSRobert Watson * Make mbuf data length reflect UDP length. If not enough data to 391af1ee11dSRobert Watson * reflect UDP length, drop. 392df8bae1dSRodney W. Grimes */ 393df8bae1dSRodney W. Grimes len = ntohs((u_short)uh->uh_ulen); 3948ad458a4SGleb Smirnoff ip_len = ntohs(ip->ip_len) - iphlen; 3958f134647SGleb Smirnoff if (ip_len != len) { 3968f134647SGleb Smirnoff if (len > ip_len || len < sizeof(struct udphdr)) { 397026decb8SRobert Watson UDPSTAT_INC(udps_badlen); 398f76fcf6dSJeffrey Hsu goto badunlocked; 399df8bae1dSRodney W. Grimes } 4008f134647SGleb Smirnoff m_adj(m, len - ip_len); 401df8bae1dSRodney W. Grimes } 4023329b236SRobert Watson 403df8bae1dSRodney W. Grimes /* 4043329b236SRobert Watson * Save a copy of the IP header in case we want restore it for 4053329b236SRobert Watson * sending an ICMP error message in response. 406df8bae1dSRodney W. Grimes */ 407603724d3SBjoern A. Zeeb if (!V_udp_blackhole) 408df8bae1dSRodney W. Grimes save_ip = *ip; 409cce418d3SMatt Jacob else 410cce418d3SMatt Jacob memset(&save_ip, 0, sizeof(save_ip)); 411df8bae1dSRodney W. Grimes 412df8bae1dSRodney W. Grimes /* 413df8bae1dSRodney W. Grimes * Checksum extended UDP header and data. 414df8bae1dSRodney W. Grimes */ 4156dfab5b1SGarrett Wollman if (uh->uh_sum) { 41639629c92SDavid Malone u_short uh_sum; 41739629c92SDavid Malone 418db4f9cc7SJonathan Lemon if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID) { 419db4f9cc7SJonathan Lemon if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR) 42039629c92SDavid Malone uh_sum = m->m_pkthdr.csum_data; 421db4f9cc7SJonathan Lemon else 42239629c92SDavid Malone uh_sum = in_pseudo(ip->ip_src.s_addr, 423506f4949SRuslan Ermilov ip->ip_dst.s_addr, htonl((u_short)len + 424db4f9cc7SJonathan Lemon m->m_pkthdr.csum_data + IPPROTO_UDP)); 42539629c92SDavid Malone uh_sum ^= 0xffff; 426db4f9cc7SJonathan Lemon } else { 427cb342100SHajimu UMEMOTO char b[9]; 428af1ee11dSRobert Watson 429cb342100SHajimu UMEMOTO bcopy(((struct ipovly *)ip)->ih_x1, b, 9); 4306effc713SDoug Rabson bzero(((struct ipovly *)ip)->ih_x1, 9); 431df8bae1dSRodney W. Grimes ((struct ipovly *)ip)->ih_len = uh->uh_ulen; 43239629c92SDavid Malone uh_sum = in_cksum(m, len + sizeof (struct ip)); 433cb342100SHajimu UMEMOTO bcopy(b, ((struct ipovly *)ip)->ih_x1, 9); 434db4f9cc7SJonathan Lemon } 43539629c92SDavid Malone if (uh_sum) { 436026decb8SRobert Watson UDPSTAT_INC(udps_badsum); 437df8bae1dSRodney W. Grimes m_freem(m); 438df8bae1dSRodney W. Grimes return; 439df8bae1dSRodney W. Grimes } 440fb9aaba0SRuslan Ermilov } else 441026decb8SRobert Watson UDPSTAT_INC(udps_nosum); 442df8bae1dSRodney W. Grimes 443df8bae1dSRodney W. Grimes if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) || 44471498f30SBruce M Simpson in_broadcast(ip->ip_dst, ifp)) { 44582c23ebaSBill Fenner struct inpcb *last; 44671498f30SBruce M Simpson struct ip_moptions *imo; 4473329b236SRobert Watson 448fa046d87SRobert Watson INP_INFO_RLOCK(&V_udbinfo); 449df8bae1dSRodney W. Grimes last = NULL; 450603724d3SBjoern A. Zeeb LIST_FOREACH(inp, &V_udb, inp_list) { 4519c1df695SRobert Watson if (inp->inp_lport != uh->uh_dport) 452f76fcf6dSJeffrey Hsu continue; 453cfa1ca9dSYoshinobu Inoue #ifdef INET6 454369dc8ceSEivind Eklund if ((inp->inp_vflag & INP_IPV4) == 0) 4559c1df695SRobert Watson continue; 456cfa1ca9dSYoshinobu Inoue #endif 45771498f30SBruce M Simpson if (inp->inp_laddr.s_addr != INADDR_ANY && 45871498f30SBruce M Simpson inp->inp_laddr.s_addr != ip->ip_dst.s_addr) 4599c1df695SRobert Watson continue; 46071498f30SBruce M Simpson if (inp->inp_faddr.s_addr != INADDR_ANY && 46171498f30SBruce M Simpson inp->inp_faddr.s_addr != ip->ip_src.s_addr) 46271498f30SBruce M Simpson continue; 46371498f30SBruce M Simpson if (inp->inp_fport != 0 && 464df8bae1dSRodney W. Grimes inp->inp_fport != uh->uh_sport) 4659c1df695SRobert Watson continue; 46671498f30SBruce M Simpson 467119d85f6SRobert Watson INP_RLOCK(inp); 468df8bae1dSRodney W. Grimes 46983453a06SBruce M Simpson /* 470fa046d87SRobert Watson * XXXRW: Because we weren't holding either the inpcb 471fa046d87SRobert Watson * or the hash lock when we checked for a match 472fa046d87SRobert Watson * before, we should probably recheck now that the 473fa046d87SRobert Watson * inpcb lock is held. 474fa046d87SRobert Watson */ 475fa046d87SRobert Watson 476fa046d87SRobert Watson /* 47771498f30SBruce M Simpson * Handle socket delivery policy for any-source 47871498f30SBruce M Simpson * and source-specific multicast. [RFC3678] 47983453a06SBruce M Simpson */ 48071498f30SBruce M Simpson imo = inp->inp_moptions; 481a38b1c8cSRandall Stewart if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr))) { 482d10910e6SBruce M Simpson struct sockaddr_in group; 483d10910e6SBruce M Simpson int blocked; 484a38b1c8cSRandall Stewart if (imo == NULL) { 485a38b1c8cSRandall Stewart INP_RUNLOCK(inp); 486a38b1c8cSRandall Stewart continue; 487a38b1c8cSRandall Stewart } 488d10910e6SBruce M Simpson bzero(&group, sizeof(struct sockaddr_in)); 489d10910e6SBruce M Simpson group.sin_len = sizeof(struct sockaddr_in); 490d10910e6SBruce M Simpson group.sin_family = AF_INET; 491d10910e6SBruce M Simpson group.sin_addr = ip->ip_dst; 49271498f30SBruce M Simpson 493d10910e6SBruce M Simpson blocked = imo_multi_filter(imo, ifp, 494d10910e6SBruce M Simpson (struct sockaddr *)&group, 49571498f30SBruce M Simpson (struct sockaddr *)&udp_in); 496d10910e6SBruce M Simpson if (blocked != MCAST_PASS) { 497d10910e6SBruce M Simpson if (blocked == MCAST_NOTGMEMBER) 49886425c62SRobert Watson IPSTAT_INC(ips_notmember); 499d10910e6SBruce M Simpson if (blocked == MCAST_NOTSMEMBER || 500d10910e6SBruce M Simpson blocked == MCAST_MUTED) 501026decb8SRobert Watson UDPSTAT_INC(udps_filtermcast); 502119d85f6SRobert Watson INP_RUNLOCK(inp); 5039c1df695SRobert Watson continue; 5049c1df695SRobert Watson } 50583453a06SBruce M Simpson } 506df8bae1dSRodney W. Grimes if (last != NULL) { 507df8bae1dSRodney W. Grimes struct mbuf *n; 508df8bae1dSRodney W. Grimes 509032dcc76SLuigi Rizzo n = m_copy(m, 0, M_COPYALL); 51079bb84fbSEdward Tomasz Napierala udp_append(last, ip, n, iphlen, &udp_in); 5116a9148feSBjoern A. Zeeb INP_RUNLOCK(last); 512df8bae1dSRodney W. Grimes } 51382c23ebaSBill Fenner last = inp; 514df8bae1dSRodney W. Grimes /* 515df8bae1dSRodney W. Grimes * Don't look for additional matches if this one does 516df8bae1dSRodney W. Grimes * not have either the SO_REUSEPORT or SO_REUSEADDR 5173329b236SRobert Watson * socket options set. This heuristic avoids 5183329b236SRobert Watson * searching through all pcbs in the common case of a 5193329b236SRobert Watson * non-shared port. It assumes that an application 5203329b236SRobert Watson * will never clear these options after setting them. 521df8bae1dSRodney W. Grimes */ 5223329b236SRobert Watson if ((last->inp_socket->so_options & 5233329b236SRobert Watson (SO_REUSEPORT|SO_REUSEADDR)) == 0) 524df8bae1dSRodney W. Grimes break; 525df8bae1dSRodney W. Grimes } 526df8bae1dSRodney W. Grimes 527df8bae1dSRodney W. Grimes if (last == NULL) { 528df8bae1dSRodney W. Grimes /* 5293329b236SRobert Watson * No matching pcb found; discard datagram. (No need 5303329b236SRobert Watson * to send an ICMP Port Unreachable for a broadcast 5313329b236SRobert Watson * or multicast datgram.) 532df8bae1dSRodney W. Grimes */ 533026decb8SRobert Watson UDPSTAT_INC(udps_noportbcast); 534fa046d87SRobert Watson if (inp) 535fa046d87SRobert Watson INP_RUNLOCK(inp); 536fa046d87SRobert Watson INP_INFO_RUNLOCK(&V_udbinfo); 537fa046d87SRobert Watson goto badunlocked; 538df8bae1dSRodney W. Grimes } 53979bb84fbSEdward Tomasz Napierala udp_append(last, ip, m, iphlen, &udp_in); 540c7c7ea4bSRandall Stewart INP_RUNLOCK(last); 541c7c7ea4bSRandall Stewart INP_INFO_RUNLOCK(&V_udbinfo); 542df8bae1dSRodney W. Grimes return; 543df8bae1dSRodney W. Grimes } 5443329b236SRobert Watson 545df8bae1dSRodney W. Grimes /* 5466d6a026bSDavid Greenman * Locate pcb for datagram. 547df8bae1dSRodney W. Grimes */ 548*c1de64a4SAndrey V. Elsukov 5498a006adbSBjoern A. Zeeb /* 5508a006adbSBjoern A. Zeeb * Grab info from PACKET_TAG_IPFORWARD tag prepended to the chain. 5518a006adbSBjoern A. Zeeb */ 552*c1de64a4SAndrey V. Elsukov if (V_pfilforward != 0 && 553*c1de64a4SAndrey V. Elsukov (fwd_tag = m_tag_find(m, PACKET_TAG_IPFORWARD, NULL)) != NULL) { 5548a006adbSBjoern A. Zeeb struct sockaddr_in *next_hop; 5558a006adbSBjoern A. Zeeb 5568a006adbSBjoern A. Zeeb next_hop = (struct sockaddr_in *)(fwd_tag + 1); 5578a006adbSBjoern A. Zeeb 5588a006adbSBjoern A. Zeeb /* 5598a006adbSBjoern A. Zeeb * Transparently forwarded. Pretend to be the destination. 5608a006adbSBjoern A. Zeeb * Already got one like this? 5618a006adbSBjoern A. Zeeb */ 562d3c1f003SRobert Watson inp = in_pcblookup_mbuf(&V_udbinfo, ip->ip_src, uh->uh_sport, 5638a006adbSBjoern A. Zeeb ip->ip_dst, uh->uh_dport, INPLOOKUP_RLOCKPCB, ifp, m); 5648a006adbSBjoern A. Zeeb if (!inp) { 5658a006adbSBjoern A. Zeeb /* 5668a006adbSBjoern A. Zeeb * It's new. Try to find the ambushing socket. 5678a006adbSBjoern A. Zeeb * Because we've rewritten the destination address, 5688a006adbSBjoern A. Zeeb * any hardware-generated hash is ignored. 5698a006adbSBjoern A. Zeeb */ 5708a006adbSBjoern A. Zeeb inp = in_pcblookup(&V_udbinfo, ip->ip_src, 5718a006adbSBjoern A. Zeeb uh->uh_sport, next_hop->sin_addr, 5728a006adbSBjoern A. Zeeb next_hop->sin_port ? htons(next_hop->sin_port) : 5738a006adbSBjoern A. Zeeb uh->uh_dport, INPLOOKUP_WILDCARD | 5748a006adbSBjoern A. Zeeb INPLOOKUP_RLOCKPCB, ifp); 5758a006adbSBjoern A. Zeeb } 5768a006adbSBjoern A. Zeeb /* Remove the tag from the packet. We don't need it anymore. */ 5778a006adbSBjoern A. Zeeb m_tag_delete(m, fwd_tag); 5788a006adbSBjoern A. Zeeb } else 5798a006adbSBjoern A. Zeeb inp = in_pcblookup_mbuf(&V_udbinfo, ip->ip_src, uh->uh_sport, 5808a006adbSBjoern A. Zeeb ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD | 5818a006adbSBjoern A. Zeeb INPLOOKUP_RLOCKPCB, ifp, m); 58215bd2b43SDavid Greenman if (inp == NULL) { 583afdb4274SRobert Watson if (udp_log_in_vain) { 584df5c0b8aSBill Fenner char buf[4*sizeof "123"]; 58575cfc95fSAndrey A. Chernov 58675cfc95fSAndrey A. Chernov strcpy(buf, inet_ntoa(ip->ip_dst)); 587592071e8SBruce Evans log(LOG_INFO, 588592071e8SBruce Evans "Connection attempt to UDP %s:%d from %s:%d\n", 589592071e8SBruce Evans buf, ntohs(uh->uh_dport), inet_ntoa(ip->ip_src), 590592071e8SBruce Evans ntohs(uh->uh_sport)); 59175cfc95fSAndrey A. Chernov } 592026decb8SRobert Watson UDPSTAT_INC(udps_noport); 593df8bae1dSRodney W. Grimes if (m->m_flags & (M_BCAST | M_MCAST)) { 594026decb8SRobert Watson UDPSTAT_INC(udps_noportbcast); 595fa046d87SRobert Watson goto badunlocked; 596df8bae1dSRodney W. Grimes } 597603724d3SBjoern A. Zeeb if (V_udp_blackhole) 598fa046d87SRobert Watson goto badunlocked; 5991cbd978eSLuigi Rizzo if (badport_bandlim(BANDLIM_ICMP_UNREACH) < 0) 600fa046d87SRobert Watson goto badunlocked; 60104287599SRuslan Ermilov *ip = save_ip; 602582a7760SBruce Evans icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0); 603df8bae1dSRodney W. Grimes return; 604df8bae1dSRodney W. Grimes } 6053329b236SRobert Watson 6063329b236SRobert Watson /* 6073329b236SRobert Watson * Check the minimum TTL for socket. 6083329b236SRobert Watson */ 609fa046d87SRobert Watson INP_RLOCK_ASSERT(inp); 61010cc62b7SRobert Watson if (inp->inp_ip_minttl && inp->inp_ip_minttl > ip->ip_ttl) { 61110cc62b7SRobert Watson INP_RUNLOCK(inp); 612fa046d87SRobert Watson m_freem(m); 613fa046d87SRobert Watson return; 61410cc62b7SRobert Watson } 61579bb84fbSEdward Tomasz Napierala udp_append(inp, ip, m, iphlen, &udp_in); 616119d85f6SRobert Watson INP_RUNLOCK(inp); 617df8bae1dSRodney W. Grimes return; 61861ffc0b1SJeffrey Hsu 619f76fcf6dSJeffrey Hsu badunlocked: 620df8bae1dSRodney W. Grimes m_freem(m); 621cfa1ca9dSYoshinobu Inoue } 62279288c11SBjoern A. Zeeb #endif /* INET */ 623cfa1ca9dSYoshinobu Inoue 624cfa1ca9dSYoshinobu Inoue /* 6253329b236SRobert Watson * Notify a udp user of an asynchronous error; just wake up so that they can 6263329b236SRobert Watson * collect error status. 627df8bae1dSRodney W. Grimes */ 6283ce144eaSJeffrey Hsu struct inpcb * 6293329b236SRobert Watson udp_notify(struct inpcb *inp, int errno) 630df8bae1dSRodney W. Grimes { 6313329b236SRobert Watson 632ac9ae279SRobert Watson /* 633ac9ae279SRobert Watson * While udp_ctlinput() always calls udp_notify() with a read lock 634ac9ae279SRobert Watson * when invoking it directly, in_pcbnotifyall() currently uses write 635ac9ae279SRobert Watson * locks due to sharing code with TCP. For now, accept either a read 636ac9ae279SRobert Watson * or a write lock, but a read lock is sufficient. 637ac9ae279SRobert Watson */ 638ac9ae279SRobert Watson INP_LOCK_ASSERT(inp); 6398501a69cSRobert Watson 640df8bae1dSRodney W. Grimes inp->inp_socket->so_error = errno; 641df8bae1dSRodney W. Grimes sorwakeup(inp->inp_socket); 642df8bae1dSRodney W. Grimes sowwakeup(inp->inp_socket); 6433329b236SRobert Watson return (inp); 644df8bae1dSRodney W. Grimes } 645df8bae1dSRodney W. Grimes 64679288c11SBjoern A. Zeeb #ifdef INET 647df8bae1dSRodney W. Grimes void 6483329b236SRobert Watson udp_ctlinput(int cmd, struct sockaddr *sa, void *vip) 649df8bae1dSRodney W. Grimes { 650c693a045SJonathan Lemon struct ip *ip = vip; 651c693a045SJonathan Lemon struct udphdr *uh; 652c693a045SJonathan Lemon struct in_addr faddr; 653c693a045SJonathan Lemon struct inpcb *inp; 654c693a045SJonathan Lemon 655c693a045SJonathan Lemon faddr = ((struct sockaddr_in *)sa)->sin_addr; 656c693a045SJonathan Lemon if (sa->sa_family != AF_INET || faddr.s_addr == INADDR_ANY) 657c693a045SJonathan Lemon return; 658df8bae1dSRodney W. Grimes 65997d8d152SAndre Oppermann /* 66097d8d152SAndre Oppermann * Redirects don't need to be handled up here. 66197d8d152SAndre Oppermann */ 66297d8d152SAndre Oppermann if (PRC_IS_REDIRECT(cmd)) 66397d8d152SAndre Oppermann return; 6643329b236SRobert Watson 66597d8d152SAndre Oppermann /* 66697d8d152SAndre Oppermann * Hostdead is ugly because it goes linearly through all PCBs. 6673329b236SRobert Watson * 6683329b236SRobert Watson * XXX: We never get this from ICMP, otherwise it makes an excellent 6693329b236SRobert Watson * DoS attack on machines with many connections. 67097d8d152SAndre Oppermann */ 67197d8d152SAndre Oppermann if (cmd == PRC_HOSTDEAD) 672af1ee11dSRobert Watson ip = NULL; 673d1c54148SJesper Skriver else if ((unsigned)cmd >= PRC_NCMDS || inetctlerrmap[cmd] == 0) 674df8bae1dSRodney W. Grimes return; 675af1ee11dSRobert Watson if (ip != NULL) { 676df8bae1dSRodney W. Grimes uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2)); 677fa046d87SRobert Watson inp = in_pcblookup(&V_udbinfo, faddr, uh->uh_dport, 678fa046d87SRobert Watson ip->ip_src, uh->uh_sport, INPLOOKUP_RLOCKPCB, NULL); 679f76fcf6dSJeffrey Hsu if (inp != NULL) { 680fa046d87SRobert Watson INP_RLOCK_ASSERT(inp); 681f76fcf6dSJeffrey Hsu if (inp->inp_socket != NULL) { 682f5514f08SRobert Watson udp_notify(inp, inetctlerrmap[cmd]); 683f76fcf6dSJeffrey Hsu } 684ac9ae279SRobert Watson INP_RUNLOCK(inp); 685f76fcf6dSJeffrey Hsu } 686df8bae1dSRodney W. Grimes } else 687603724d3SBjoern A. Zeeb in_pcbnotifyall(&V_udbinfo, faddr, inetctlerrmap[cmd], 688f5514f08SRobert Watson udp_notify); 689df8bae1dSRodney W. Grimes } 69079288c11SBjoern A. Zeeb #endif /* INET */ 691df8bae1dSRodney W. Grimes 6920312fbe9SPoul-Henning Kamp static int 69382d9ae4eSPoul-Henning Kamp udp_pcblist(SYSCTL_HANDLER_ARGS) 69498271db4SGarrett Wollman { 695277afaffSRobert Watson int error, i, n; 69698271db4SGarrett Wollman struct inpcb *inp, **inp_list; 69798271db4SGarrett Wollman inp_gen_t gencnt; 69898271db4SGarrett Wollman struct xinpgen xig; 69998271db4SGarrett Wollman 70098271db4SGarrett Wollman /* 701f5514f08SRobert Watson * The process of preparing the PCB list is too time-consuming and 70298271db4SGarrett Wollman * resource-intensive to repeat twice on every request. 70398271db4SGarrett Wollman */ 70498271db4SGarrett Wollman if (req->oldptr == 0) { 705603724d3SBjoern A. Zeeb n = V_udbinfo.ipi_count; 706c007b96aSJohn Baldwin n += imax(n / 8, 10); 707c007b96aSJohn Baldwin req->oldidx = 2 * (sizeof xig) + n * sizeof(struct xinpcb); 7083329b236SRobert Watson return (0); 70998271db4SGarrett Wollman } 71098271db4SGarrett Wollman 71198271db4SGarrett Wollman if (req->newptr != 0) 7123329b236SRobert Watson return (EPERM); 71398271db4SGarrett Wollman 71498271db4SGarrett Wollman /* 71598271db4SGarrett Wollman * OK, now we're committed to doing something. 71698271db4SGarrett Wollman */ 717603724d3SBjoern A. Zeeb INP_INFO_RLOCK(&V_udbinfo); 718603724d3SBjoern A. Zeeb gencnt = V_udbinfo.ipi_gencnt; 719603724d3SBjoern A. Zeeb n = V_udbinfo.ipi_count; 720603724d3SBjoern A. Zeeb INP_INFO_RUNLOCK(&V_udbinfo); 72198271db4SGarrett Wollman 72247934cefSDon Lewis error = sysctl_wire_old_buffer(req, 2 * (sizeof xig) 7235c38b6dbSDon Lewis + n * sizeof(struct xinpcb)); 72447934cefSDon Lewis if (error != 0) 72547934cefSDon Lewis return (error); 7265c38b6dbSDon Lewis 72798271db4SGarrett Wollman xig.xig_len = sizeof xig; 72898271db4SGarrett Wollman xig.xig_count = n; 72998271db4SGarrett Wollman xig.xig_gen = gencnt; 73098271db4SGarrett Wollman xig.xig_sogen = so_gencnt; 73198271db4SGarrett Wollman error = SYSCTL_OUT(req, &xig, sizeof xig); 73298271db4SGarrett Wollman if (error) 7333329b236SRobert Watson return (error); 73498271db4SGarrett Wollman 735a163d034SWarner Losh inp_list = malloc(n * sizeof *inp_list, M_TEMP, M_WAITOK); 73698271db4SGarrett Wollman if (inp_list == 0) 7373329b236SRobert Watson return (ENOMEM); 73898271db4SGarrett Wollman 739603724d3SBjoern A. Zeeb INP_INFO_RLOCK(&V_udbinfo); 740603724d3SBjoern A. Zeeb for (inp = LIST_FIRST(V_udbinfo.ipi_listhead), i = 0; inp && i < n; 741fc2ffbe6SPoul-Henning Kamp inp = LIST_NEXT(inp, inp_list)) { 742d0e157f6SBjoern A. Zeeb INP_WLOCK(inp); 7432ded288cSJeffrey Hsu if (inp->inp_gencnt <= gencnt && 744d0e157f6SBjoern A. Zeeb cr_canseeinpcb(req->td->td_ucred, inp) == 0) { 745d0e157f6SBjoern A. Zeeb in_pcbref(inp); 74698271db4SGarrett Wollman inp_list[i++] = inp; 747d0e157f6SBjoern A. Zeeb } 748d0e157f6SBjoern A. Zeeb INP_WUNLOCK(inp); 7494787fd37SPaul Saab } 750603724d3SBjoern A. Zeeb INP_INFO_RUNLOCK(&V_udbinfo); 75198271db4SGarrett Wollman n = i; 75298271db4SGarrett Wollman 75398271db4SGarrett Wollman error = 0; 75498271db4SGarrett Wollman for (i = 0; i < n; i++) { 75598271db4SGarrett Wollman inp = inp_list[i]; 7569622e84fSRobert Watson INP_RLOCK(inp); 75798271db4SGarrett Wollman if (inp->inp_gencnt <= gencnt) { 75898271db4SGarrett Wollman struct xinpcb xi; 759d0e157f6SBjoern A. Zeeb 760fd94099eSColin Percival bzero(&xi, sizeof(xi)); 76198271db4SGarrett Wollman xi.xi_len = sizeof xi; 76298271db4SGarrett Wollman /* XXX should avoid extra copy */ 76398271db4SGarrett Wollman bcopy(inp, &xi.xi_inp, sizeof *inp); 76498271db4SGarrett Wollman if (inp->inp_socket) 76598271db4SGarrett Wollman sotoxsocket(inp->inp_socket, &xi.xi_socket); 7664b40c56cSJeffrey Hsu xi.xi_inp.inp_gencnt = inp->inp_gencnt; 7679622e84fSRobert Watson INP_RUNLOCK(inp); 76898271db4SGarrett Wollman error = SYSCTL_OUT(req, &xi, sizeof xi); 769d915b280SStephan Uphoff } else 7709622e84fSRobert Watson INP_RUNLOCK(inp); 77198271db4SGarrett Wollman } 772d0e157f6SBjoern A. Zeeb INP_INFO_WLOCK(&V_udbinfo); 773d0e157f6SBjoern A. Zeeb for (i = 0; i < n; i++) { 774d0e157f6SBjoern A. Zeeb inp = inp_list[i]; 775fa046d87SRobert Watson INP_RLOCK(inp); 776fa046d87SRobert Watson if (!in_pcbrele_rlocked(inp)) 777fa046d87SRobert Watson INP_RUNLOCK(inp); 778d0e157f6SBjoern A. Zeeb } 779d0e157f6SBjoern A. Zeeb INP_INFO_WUNLOCK(&V_udbinfo); 780d0e157f6SBjoern A. Zeeb 78198271db4SGarrett Wollman if (!error) { 78298271db4SGarrett Wollman /* 7833329b236SRobert Watson * Give the user an updated idea of our state. If the 7843329b236SRobert Watson * generation differs from what we told her before, she knows 7853329b236SRobert Watson * that something happened while we were processing this 7863329b236SRobert Watson * request, and it might be necessary to retry. 78798271db4SGarrett Wollman */ 788603724d3SBjoern A. Zeeb INP_INFO_RLOCK(&V_udbinfo); 789603724d3SBjoern A. Zeeb xig.xig_gen = V_udbinfo.ipi_gencnt; 79098271db4SGarrett Wollman xig.xig_sogen = so_gencnt; 791603724d3SBjoern A. Zeeb xig.xig_count = V_udbinfo.ipi_count; 792603724d3SBjoern A. Zeeb INP_INFO_RUNLOCK(&V_udbinfo); 79398271db4SGarrett Wollman error = SYSCTL_OUT(req, &xig, sizeof xig); 79498271db4SGarrett Wollman } 79598271db4SGarrett Wollman free(inp_list, M_TEMP); 7963329b236SRobert Watson return (error); 79798271db4SGarrett Wollman } 79898271db4SGarrett Wollman 79979c3d51bSMatthew D Fleming SYSCTL_PROC(_net_inet_udp, UDPCTL_PCBLIST, pcblist, 80079c3d51bSMatthew D Fleming CTLTYPE_OPAQUE | CTLFLAG_RD, NULL, 0, 80198271db4SGarrett Wollman udp_pcblist, "S,xinpcb", "List of active UDP sockets"); 80298271db4SGarrett Wollman 80379288c11SBjoern A. Zeeb #ifdef INET 80498271db4SGarrett Wollman static int 80582d9ae4eSPoul-Henning Kamp udp_getcred(SYSCTL_HANDLER_ARGS) 806490d50b6SBrian Feldman { 807c0511d3bSBrian Feldman struct xucred xuc; 808490d50b6SBrian Feldman struct sockaddr_in addrs[2]; 809490d50b6SBrian Feldman struct inpcb *inp; 810277afaffSRobert Watson int error; 811490d50b6SBrian Feldman 81232f9753cSRobert Watson error = priv_check(req->td, PRIV_NETINET_GETCRED); 813490d50b6SBrian Feldman if (error) 814490d50b6SBrian Feldman return (error); 815490d50b6SBrian Feldman error = SYSCTL_IN(req, addrs, sizeof(addrs)); 816490d50b6SBrian Feldman if (error) 817490d50b6SBrian Feldman return (error); 818fa046d87SRobert Watson inp = in_pcblookup(&V_udbinfo, addrs[1].sin_addr, addrs[1].sin_port, 819fa046d87SRobert Watson addrs[0].sin_addr, addrs[0].sin_port, 820fa046d87SRobert Watson INPLOOKUP_WILDCARD | INPLOOKUP_RLOCKPCB, NULL); 8219622e84fSRobert Watson if (inp != NULL) { 822fa046d87SRobert Watson INP_RLOCK_ASSERT(inp); 8239622e84fSRobert Watson if (inp->inp_socket == NULL) 8249622e84fSRobert Watson error = ENOENT; 8259622e84fSRobert Watson if (error == 0) 826f08ef6c5SBjoern A. Zeeb error = cr_canseeinpcb(req->td->td_ucred, inp); 8279622e84fSRobert Watson if (error == 0) 82886d02c5cSBjoern A. Zeeb cru2x(inp->inp_cred, &xuc); 8299622e84fSRobert Watson INP_RUNLOCK(inp); 830fa046d87SRobert Watson } else 8319622e84fSRobert Watson error = ENOENT; 8320e1eebb8SDon Lewis if (error == 0) 8330e1eebb8SDon Lewis error = SYSCTL_OUT(req, &xuc, sizeof(struct xucred)); 834490d50b6SBrian Feldman return (error); 835490d50b6SBrian Feldman } 836490d50b6SBrian Feldman 8377ce87f12SDavid Malone SYSCTL_PROC(_net_inet_udp, OID_AUTO, getcred, 8387ce87f12SDavid Malone CTLTYPE_OPAQUE|CTLFLAG_RW|CTLFLAG_PRISON, 0, 0, 8397ce87f12SDavid Malone udp_getcred, "S,xucred", "Get the xucred of a UDP connection"); 84079288c11SBjoern A. Zeeb #endif /* INET */ 841490d50b6SBrian Feldman 8427b495c44SVANHULLEBUS Yvan int 8437b495c44SVANHULLEBUS Yvan udp_ctloutput(struct socket *so, struct sockopt *sopt) 8447b495c44SVANHULLEBUS Yvan { 8457b495c44SVANHULLEBUS Yvan int error = 0, optval; 8467b495c44SVANHULLEBUS Yvan struct inpcb *inp; 8477b495c44SVANHULLEBUS Yvan #ifdef IPSEC_NAT_T 8487b495c44SVANHULLEBUS Yvan struct udpcb *up; 8497b495c44SVANHULLEBUS Yvan #endif 8507b495c44SVANHULLEBUS Yvan 8517b495c44SVANHULLEBUS Yvan inp = sotoinpcb(so); 8527b495c44SVANHULLEBUS Yvan KASSERT(inp != NULL, ("%s: inp == NULL", __func__)); 8537b495c44SVANHULLEBUS Yvan INP_WLOCK(inp); 8547b495c44SVANHULLEBUS Yvan if (sopt->sopt_level != IPPROTO_UDP) { 8557b495c44SVANHULLEBUS Yvan #ifdef INET6 8567b495c44SVANHULLEBUS Yvan if (INP_CHECK_SOCKAF(so, AF_INET6)) { 8577b495c44SVANHULLEBUS Yvan INP_WUNLOCK(inp); 8587b495c44SVANHULLEBUS Yvan error = ip6_ctloutput(so, sopt); 85979288c11SBjoern A. Zeeb } 8607b495c44SVANHULLEBUS Yvan #endif 86179288c11SBjoern A. Zeeb #if defined(INET) && defined(INET6) 86279288c11SBjoern A. Zeeb else 86379288c11SBjoern A. Zeeb #endif 86479288c11SBjoern A. Zeeb #ifdef INET 86579288c11SBjoern A. Zeeb { 8667b495c44SVANHULLEBUS Yvan INP_WUNLOCK(inp); 8677b495c44SVANHULLEBUS Yvan error = ip_ctloutput(so, sopt); 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 93979288c11SBjoern A. Zeeb #ifdef INET 940fa046d87SRobert Watson #define UH_WLOCKED 2 941fa046d87SRobert Watson #define UH_RLOCKED 1 942fa046d87SRobert Watson #define UH_UNLOCKED 0 943490d50b6SBrian Feldman static int 9443329b236SRobert Watson udp_output(struct inpcb *inp, struct mbuf *m, struct sockaddr *addr, 9453329b236SRobert Watson struct mbuf *control, struct thread *td) 946df8bae1dSRodney W. Grimes { 9473329b236SRobert Watson struct udpiphdr *ui; 9483329b236SRobert Watson int len = m->m_pkthdr.len; 94990162a4eSIan Dowse struct in_addr faddr, laddr; 950c557ae16SIan Dowse struct cmsghdr *cm; 951c557ae16SIan Dowse struct sockaddr_in *sin, src; 95290162a4eSIan Dowse int error = 0; 9538afa2304SBruce M Simpson int ipflags; 95490162a4eSIan Dowse u_short fport, lport; 9555c32ea65SRobert Watson int unlock_udbinfo; 956f584d74bSMichael Tuexen u_char tos; 957df8bae1dSRodney W. Grimes 9585c32ea65SRobert Watson /* 9595c32ea65SRobert Watson * udp_output() may need to temporarily bind or connect the current 960f5514f08SRobert Watson * inpcb. As such, we don't know up front whether we will need the 961f5514f08SRobert Watson * pcbinfo lock or not. Do any work to decide what is needed up 962f5514f08SRobert Watson * front before acquiring any locks. 9635c32ea65SRobert Watson */ 964430d30d8SBill Fenner if (len + sizeof(struct udpiphdr) > IP_MAXPACKET) { 965c557ae16SIan Dowse if (control) 966c557ae16SIan Dowse m_freem(control); 9675c32ea65SRobert Watson m_freem(m); 9683329b236SRobert Watson return (EMSGSIZE); 969430d30d8SBill Fenner } 970430d30d8SBill Fenner 9711b7f0384SBruce M Simpson src.sin_family = 0; 9720cfdff24SBjoern A. Zeeb INP_RLOCK(inp); 973f584d74bSMichael Tuexen tos = inp->inp_ip_tos; 974c557ae16SIan Dowse if (control != NULL) { 975c557ae16SIan Dowse /* 9763329b236SRobert Watson * XXX: Currently, we assume all the optional information is 9773329b236SRobert Watson * stored in a single mbuf. 978c557ae16SIan Dowse */ 979c557ae16SIan Dowse if (control->m_next) { 9800cfdff24SBjoern A. Zeeb INP_RUNLOCK(inp); 981c557ae16SIan Dowse m_freem(control); 9825c32ea65SRobert Watson m_freem(m); 9833329b236SRobert Watson return (EINVAL); 984c557ae16SIan Dowse } 985c557ae16SIan Dowse for (; control->m_len > 0; 986c557ae16SIan Dowse control->m_data += CMSG_ALIGN(cm->cmsg_len), 987c557ae16SIan Dowse control->m_len -= CMSG_ALIGN(cm->cmsg_len)) { 988c557ae16SIan Dowse cm = mtod(control, struct cmsghdr *); 989af1ee11dSRobert Watson if (control->m_len < sizeof(*cm) || cm->cmsg_len == 0 990af1ee11dSRobert Watson || cm->cmsg_len > control->m_len) { 991c557ae16SIan Dowse error = EINVAL; 992c557ae16SIan Dowse break; 993c557ae16SIan Dowse } 994c557ae16SIan Dowse if (cm->cmsg_level != IPPROTO_IP) 995c557ae16SIan Dowse continue; 996c557ae16SIan Dowse 997c557ae16SIan Dowse switch (cm->cmsg_type) { 998c557ae16SIan Dowse case IP_SENDSRCADDR: 999c557ae16SIan Dowse if (cm->cmsg_len != 1000c557ae16SIan Dowse CMSG_LEN(sizeof(struct in_addr))) { 1001c557ae16SIan Dowse error = EINVAL; 1002c557ae16SIan Dowse break; 1003c557ae16SIan Dowse } 1004c557ae16SIan Dowse bzero(&src, sizeof(src)); 1005c557ae16SIan Dowse src.sin_family = AF_INET; 1006c557ae16SIan Dowse src.sin_len = sizeof(src); 1007c557ae16SIan Dowse src.sin_port = inp->inp_lport; 1008af1ee11dSRobert Watson src.sin_addr = 1009af1ee11dSRobert Watson *(struct in_addr *)CMSG_DATA(cm); 1010c557ae16SIan Dowse break; 1011af1ee11dSRobert Watson 1012f584d74bSMichael Tuexen case IP_TOS: 1013f584d74bSMichael Tuexen if (cm->cmsg_len != CMSG_LEN(sizeof(u_char))) { 1014f584d74bSMichael Tuexen error = EINVAL; 1015f584d74bSMichael Tuexen break; 1016f584d74bSMichael Tuexen } 1017f584d74bSMichael Tuexen tos = *(u_char *)CMSG_DATA(cm); 1018f584d74bSMichael Tuexen break; 1019f584d74bSMichael Tuexen 1020c557ae16SIan Dowse default: 1021c557ae16SIan Dowse error = ENOPROTOOPT; 1022c557ae16SIan Dowse break; 1023c557ae16SIan Dowse } 1024c557ae16SIan Dowse if (error) 1025c557ae16SIan Dowse break; 1026c557ae16SIan Dowse } 1027c557ae16SIan Dowse m_freem(control); 1028c557ae16SIan Dowse } 10295c32ea65SRobert Watson if (error) { 10300cfdff24SBjoern A. Zeeb INP_RUNLOCK(inp); 10315c32ea65SRobert Watson m_freem(m); 10323329b236SRobert Watson return (error); 10335c32ea65SRobert Watson } 10345c32ea65SRobert Watson 103543cc0bc1SRobert Watson /* 103643cc0bc1SRobert Watson * Depending on whether or not the application has bound or connected 1037ca528788SRobert Watson * the socket, we may have to do varying levels of work. The optimal 1038ca528788SRobert Watson * case is for a connected UDP socket, as a global lock isn't 1039ca528788SRobert Watson * required at all. 104043cc0bc1SRobert Watson * 104143cc0bc1SRobert Watson * In order to decide which we need, we require stability of the 104243cc0bc1SRobert Watson * inpcb binding, which we ensure by acquiring a read lock on the 104343cc0bc1SRobert Watson * inpcb. This doesn't strictly follow the lock order, so we play 104443cc0bc1SRobert Watson * the trylock and retry game; note that we may end up with more 104543cc0bc1SRobert Watson * conservative locks than required the second time around, so later 104643cc0bc1SRobert Watson * assertions have to accept that. Further analysis of the number of 104743cc0bc1SRobert Watson * misses under contention is required. 1048fa046d87SRobert Watson * 1049fa046d87SRobert Watson * XXXRW: Check that hash locking update here is correct. 105043cc0bc1SRobert Watson */ 105143cc0bc1SRobert Watson sin = (struct sockaddr_in *)addr; 105243cc0bc1SRobert Watson if (sin != NULL && 105343cc0bc1SRobert Watson (inp->inp_laddr.s_addr == INADDR_ANY && inp->inp_lport == 0)) { 105443cc0bc1SRobert Watson INP_RUNLOCK(inp); 10558501a69cSRobert Watson INP_WLOCK(inp); 1056fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1057fa046d87SRobert Watson unlock_udbinfo = UH_WLOCKED; 105843cc0bc1SRobert Watson } else if ((sin != NULL && ( 105943cc0bc1SRobert Watson (sin->sin_addr.s_addr == INADDR_ANY) || 106043cc0bc1SRobert Watson (sin->sin_addr.s_addr == INADDR_BROADCAST) || 106143cc0bc1SRobert Watson (inp->inp_laddr.s_addr == INADDR_ANY) || 106243cc0bc1SRobert Watson (inp->inp_lport == 0))) || 106343cc0bc1SRobert Watson (src.sin_family == AF_INET)) { 1064fa046d87SRobert Watson INP_HASH_RLOCK(&V_udbinfo); 1065fa046d87SRobert Watson unlock_udbinfo = UH_RLOCKED; 106643cc0bc1SRobert Watson } else 1067fa046d87SRobert Watson unlock_udbinfo = UH_UNLOCKED; 10685c32ea65SRobert Watson 10691b7f0384SBruce M Simpson /* 10701b7f0384SBruce M Simpson * If the IP_SENDSRCADDR control message was specified, override the 10711b7f0384SBruce M Simpson * source address for this datagram. Its use is invalidated if the 10721b7f0384SBruce M Simpson * address thus specified is incomplete or clobbers other inpcbs. 10731b7f0384SBruce M Simpson */ 107490162a4eSIan Dowse laddr = inp->inp_laddr; 107590162a4eSIan Dowse lport = inp->inp_lport; 10761b7f0384SBruce M Simpson if (src.sin_family == AF_INET) { 1077fa046d87SRobert Watson INP_HASH_LOCK_ASSERT(&V_udbinfo); 10781b7f0384SBruce M Simpson if ((lport == 0) || 10791b7f0384SBruce M Simpson (laddr.s_addr == INADDR_ANY && 10801b7f0384SBruce M Simpson src.sin_addr.s_addr == INADDR_ANY)) { 1081c557ae16SIan Dowse error = EINVAL; 1082c557ae16SIan Dowse goto release; 1083c557ae16SIan Dowse } 1084c557ae16SIan Dowse error = in_pcbbind_setup(inp, (struct sockaddr *)&src, 1085b0330ed9SPawel Jakub Dawidek &laddr.s_addr, &lport, td->td_ucred); 1086c557ae16SIan Dowse if (error) 1087c557ae16SIan Dowse goto release; 1088c557ae16SIan Dowse } 1089c557ae16SIan Dowse 10903144b7d3SRobert Watson /* 10913144b7d3SRobert Watson * If a UDP socket has been connected, then a local address/port will 10923144b7d3SRobert Watson * have been selected and bound. 10933144b7d3SRobert Watson * 109443cc0bc1SRobert Watson * If a UDP socket has not been connected to, then an explicit 10953144b7d3SRobert Watson * destination address must be used, in which case a local 10963144b7d3SRobert Watson * address/port may not have been selected and bound. 10973144b7d3SRobert Watson */ 109843cc0bc1SRobert Watson if (sin != NULL) { 1099c4d585aeSRobert Watson INP_LOCK_ASSERT(inp); 1100df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr != INADDR_ANY) { 1101df8bae1dSRodney W. Grimes error = EISCONN; 1102df8bae1dSRodney W. Grimes goto release; 1103df8bae1dSRodney W. Grimes } 11043144b7d3SRobert Watson 11053144b7d3SRobert Watson /* 11063144b7d3SRobert Watson * Jail may rewrite the destination address, so let it do 11073144b7d3SRobert Watson * that before we use it. 11083144b7d3SRobert Watson */ 1109b89e82ddSJamie Gritton error = prison_remote_ip4(td->td_ucred, &sin->sin_addr); 1110b89e82ddSJamie Gritton if (error) 1111413628a7SBjoern A. Zeeb goto release; 11123144b7d3SRobert Watson 11133144b7d3SRobert Watson /* 111443cc0bc1SRobert Watson * If a local address or port hasn't yet been selected, or if 111543cc0bc1SRobert Watson * the destination address needs to be rewritten due to using 111643cc0bc1SRobert Watson * a special INADDR_ constant, invoke in_pcbconnect_setup() 111743cc0bc1SRobert Watson * to do the heavy lifting. Once a port is selected, we 111843cc0bc1SRobert Watson * commit the binding back to the socket; we also commit the 111943cc0bc1SRobert Watson * binding of the address if in jail. 112043cc0bc1SRobert Watson * 112143cc0bc1SRobert Watson * If we already have a valid binding and we're not 112243cc0bc1SRobert Watson * requesting a destination address rewrite, use a fast path. 11233144b7d3SRobert Watson */ 112443cc0bc1SRobert Watson if (inp->inp_laddr.s_addr == INADDR_ANY || 112543cc0bc1SRobert Watson inp->inp_lport == 0 || 112643cc0bc1SRobert Watson sin->sin_addr.s_addr == INADDR_ANY || 112743cc0bc1SRobert Watson sin->sin_addr.s_addr == INADDR_BROADCAST) { 1128fa046d87SRobert Watson INP_HASH_LOCK_ASSERT(&V_udbinfo); 112943cc0bc1SRobert Watson error = in_pcbconnect_setup(inp, addr, &laddr.s_addr, 113043cc0bc1SRobert Watson &lport, &faddr.s_addr, &fport, NULL, 113143cc0bc1SRobert Watson td->td_ucred); 113290162a4eSIan Dowse if (error) 113390162a4eSIan Dowse goto release; 113490162a4eSIan Dowse 113543cc0bc1SRobert Watson /* 113643cc0bc1SRobert Watson * XXXRW: Why not commit the port if the address is 113743cc0bc1SRobert Watson * !INADDR_ANY? 113843cc0bc1SRobert Watson */ 113990162a4eSIan Dowse /* Commit the local port if newly assigned. */ 114090162a4eSIan Dowse if (inp->inp_laddr.s_addr == INADDR_ANY && 114190162a4eSIan Dowse inp->inp_lport == 0) { 1142c4d585aeSRobert Watson INP_WLOCK_ASSERT(inp); 1143fa046d87SRobert Watson INP_HASH_WLOCK_ASSERT(&V_udbinfo); 11443a1757b9SGleb Smirnoff /* 114543cc0bc1SRobert Watson * Remember addr if jailed, to prevent 114643cc0bc1SRobert Watson * rebinding. 11473a1757b9SGleb Smirnoff */ 11480304c731SJamie Gritton if (prison_flag(td->td_ucred, PR_IP4)) 11493a1757b9SGleb Smirnoff inp->inp_laddr = laddr; 115090162a4eSIan Dowse inp->inp_lport = lport; 115190162a4eSIan Dowse if (in_pcbinshash(inp) != 0) { 115290162a4eSIan Dowse inp->inp_lport = 0; 115390162a4eSIan Dowse error = EAGAIN; 1154df8bae1dSRodney W. Grimes goto release; 1155df8bae1dSRodney W. Grimes } 115690162a4eSIan Dowse inp->inp_flags |= INP_ANONPORT; 115790162a4eSIan Dowse } 1158df8bae1dSRodney W. Grimes } else { 115943cc0bc1SRobert Watson faddr = sin->sin_addr; 116043cc0bc1SRobert Watson fport = sin->sin_port; 116143cc0bc1SRobert Watson } 116243cc0bc1SRobert Watson } else { 1163c4d585aeSRobert Watson INP_LOCK_ASSERT(inp); 116490162a4eSIan Dowse faddr = inp->inp_faddr; 116590162a4eSIan Dowse fport = inp->inp_fport; 116690162a4eSIan Dowse if (faddr.s_addr == INADDR_ANY) { 1167df8bae1dSRodney W. Grimes error = ENOTCONN; 1168df8bae1dSRodney W. Grimes goto release; 1169df8bae1dSRodney W. Grimes } 1170df8bae1dSRodney W. Grimes } 1171e6ccd709SRobert Watson 1172df8bae1dSRodney W. Grimes /* 1173e6ccd709SRobert Watson * Calculate data length and get a mbuf for UDP, IP, and possible 1174392e8407SRobert Watson * link-layer headers. Immediate slide the data pointer back forward 1175392e8407SRobert Watson * since we won't use that space at this layer. 1176df8bae1dSRodney W. Grimes */ 1177e6ccd709SRobert Watson M_PREPEND(m, sizeof(struct udpiphdr) + max_linkhdr, M_DONTWAIT); 1178e6ccd709SRobert Watson if (m == NULL) { 1179df8bae1dSRodney W. Grimes error = ENOBUFS; 118049b19bfcSBruce M Simpson goto release; 1181df8bae1dSRodney W. Grimes } 1182e6ccd709SRobert Watson m->m_data += max_linkhdr; 1183e6ccd709SRobert Watson m->m_len -= max_linkhdr; 1184392e8407SRobert Watson m->m_pkthdr.len -= max_linkhdr; 1185df8bae1dSRodney W. Grimes 1186df8bae1dSRodney W. Grimes /* 11873329b236SRobert Watson * Fill in mbuf with extended UDP header and addresses and length put 11883329b236SRobert Watson * into network format. 1189df8bae1dSRodney W. Grimes */ 1190df8bae1dSRodney W. Grimes ui = mtod(m, struct udpiphdr *); 1191db4f9cc7SJonathan Lemon bzero(ui->ui_x1, sizeof(ui->ui_x1)); /* XXX still needed? */ 1192df8bae1dSRodney W. Grimes ui->ui_pr = IPPROTO_UDP; 119390162a4eSIan Dowse ui->ui_src = laddr; 119490162a4eSIan Dowse ui->ui_dst = faddr; 119590162a4eSIan Dowse ui->ui_sport = lport; 119690162a4eSIan Dowse ui->ui_dport = fport; 1197db4f9cc7SJonathan Lemon ui->ui_ulen = htons((u_short)len + sizeof(struct udphdr)); 1198df8bae1dSRodney W. Grimes 1199b2828ad2SAndre Oppermann /* 1200b2828ad2SAndre Oppermann * Set the Don't Fragment bit in the IP header. 1201b2828ad2SAndre Oppermann */ 1202b2828ad2SAndre Oppermann if (inp->inp_flags & INP_DONTFRAG) { 1203b2828ad2SAndre Oppermann struct ip *ip; 12043329b236SRobert Watson 1205b2828ad2SAndre Oppermann ip = (struct ip *)&ui->ui_i; 12068f134647SGleb Smirnoff ip->ip_off |= htons(IP_DF); 1207b2828ad2SAndre Oppermann } 1208b2828ad2SAndre Oppermann 1209b5d47ff5SJohn-Mark Gurney ipflags = 0; 1210b5d47ff5SJohn-Mark Gurney if (inp->inp_socket->so_options & SO_DONTROUTE) 1211b5d47ff5SJohn-Mark Gurney ipflags |= IP_ROUTETOIF; 1212b5d47ff5SJohn-Mark Gurney if (inp->inp_socket->so_options & SO_BROADCAST) 1213b5d47ff5SJohn-Mark Gurney ipflags |= IP_ALLOWBROADCAST; 12146fbfd582SAndre Oppermann if (inp->inp_flags & INP_ONESBCAST) 12158afa2304SBruce M Simpson ipflags |= IP_SENDONES; 12168afa2304SBruce M Simpson 12171175d9d5SRobert Watson #ifdef MAC 12181175d9d5SRobert Watson mac_inpcb_create_mbuf(inp, m); 12191175d9d5SRobert Watson #endif 12201175d9d5SRobert Watson 1221df8bae1dSRodney W. Grimes /* 1222db4f9cc7SJonathan Lemon * Set up checksum and output datagram. 1223df8bae1dSRodney W. Grimes */ 122440b676beSBjoern A. Zeeb if (V_udp_cksum) { 12256fbfd582SAndre Oppermann if (inp->inp_flags & INP_ONESBCAST) 12268a538743SBruce M Simpson faddr.s_addr = INADDR_BROADCAST; 12278a538743SBruce M Simpson ui->ui_sum = in_pseudo(ui->ui_src.s_addr, faddr.s_addr, 1228db4f9cc7SJonathan Lemon htons((u_short)len + sizeof(struct udphdr) + IPPROTO_UDP)); 1229db4f9cc7SJonathan Lemon m->m_pkthdr.csum_flags = CSUM_UDP; 1230db4f9cc7SJonathan Lemon m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum); 12313329b236SRobert Watson } else 1232db4f9cc7SJonathan Lemon ui->ui_sum = 0; 12338f134647SGleb Smirnoff ((struct ip *)ui)->ip_len = htons(sizeof(struct udpiphdr) + len); 1234ca98b82cSDavid Greenman ((struct ip *)ui)->ip_ttl = inp->inp_ip_ttl; /* XXX */ 1235f584d74bSMichael Tuexen ((struct ip *)ui)->ip_tos = tos; /* XXX */ 1236026decb8SRobert Watson UDPSTAT_INC(udps_opackets); 1237cfa1ca9dSYoshinobu Inoue 1238fa046d87SRobert Watson if (unlock_udbinfo == UH_WLOCKED) 1239fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 1240fa046d87SRobert Watson else if (unlock_udbinfo == UH_RLOCKED) 1241fa046d87SRobert Watson INP_HASH_RUNLOCK(&V_udbinfo); 124297d8d152SAndre Oppermann error = ip_output(m, inp->inp_options, NULL, ipflags, 12435d846453SSam Leffler inp->inp_moptions, inp); 1244fa046d87SRobert Watson if (unlock_udbinfo == UH_WLOCKED) 12458501a69cSRobert Watson INP_WUNLOCK(inp); 1246948d0fc9SRobert Watson else 1247948d0fc9SRobert Watson INP_RUNLOCK(inp); 1248df8bae1dSRodney W. Grimes return (error); 1249df8bae1dSRodney W. Grimes 1250df8bae1dSRodney W. Grimes release: 1251fa046d87SRobert Watson if (unlock_udbinfo == UH_WLOCKED) { 1252fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 1253948d0fc9SRobert Watson INP_WUNLOCK(inp); 1254fa046d87SRobert Watson } else if (unlock_udbinfo == UH_RLOCKED) { 1255fa046d87SRobert Watson INP_HASH_RUNLOCK(&V_udbinfo); 125643cc0bc1SRobert Watson INP_RUNLOCK(inp); 1257948d0fc9SRobert Watson } else 1258948d0fc9SRobert Watson INP_RUNLOCK(inp); 1259df8bae1dSRodney W. Grimes m_freem(m); 1260df8bae1dSRodney W. Grimes return (error); 1261df8bae1dSRodney W. Grimes } 1262df8bae1dSRodney W. Grimes 12637b495c44SVANHULLEBUS Yvan 12647b495c44SVANHULLEBUS Yvan #if defined(IPSEC) && defined(IPSEC_NAT_T) 12657b495c44SVANHULLEBUS Yvan /* 12667b495c44SVANHULLEBUS Yvan * Potentially decap ESP in UDP frame. Check for an ESP header 12677b495c44SVANHULLEBUS Yvan * and optional marker; if present, strip the UDP header and 12687b495c44SVANHULLEBUS Yvan * push the result through IPSec. 12697b495c44SVANHULLEBUS Yvan * 12707b495c44SVANHULLEBUS Yvan * Returns mbuf to be processed (potentially re-allocated) or 12717b495c44SVANHULLEBUS Yvan * NULL if consumed and/or processed. 12727b495c44SVANHULLEBUS Yvan */ 12737b495c44SVANHULLEBUS Yvan static struct mbuf * 12747b495c44SVANHULLEBUS Yvan udp4_espdecap(struct inpcb *inp, struct mbuf *m, int off) 12757b495c44SVANHULLEBUS Yvan { 12767b495c44SVANHULLEBUS Yvan size_t minlen, payload, skip, iphlen; 12777b495c44SVANHULLEBUS Yvan caddr_t data; 12787b495c44SVANHULLEBUS Yvan struct udpcb *up; 12797b495c44SVANHULLEBUS Yvan struct m_tag *tag; 12807b495c44SVANHULLEBUS Yvan struct udphdr *udphdr; 12817b495c44SVANHULLEBUS Yvan struct ip *ip; 12827b495c44SVANHULLEBUS Yvan 12837b495c44SVANHULLEBUS Yvan INP_RLOCK_ASSERT(inp); 12847b495c44SVANHULLEBUS Yvan 12857b495c44SVANHULLEBUS Yvan /* 12867b495c44SVANHULLEBUS Yvan * Pull up data so the longest case is contiguous: 12877b495c44SVANHULLEBUS Yvan * IP/UDP hdr + non ESP marker + ESP hdr. 12887b495c44SVANHULLEBUS Yvan */ 12897b495c44SVANHULLEBUS Yvan minlen = off + sizeof(uint64_t) + sizeof(struct esp); 12907b495c44SVANHULLEBUS Yvan if (minlen > m->m_pkthdr.len) 12917b495c44SVANHULLEBUS Yvan minlen = m->m_pkthdr.len; 12927b495c44SVANHULLEBUS Yvan if ((m = m_pullup(m, minlen)) == NULL) { 12937b495c44SVANHULLEBUS Yvan V_ipsec4stat.in_inval++; 12947b495c44SVANHULLEBUS Yvan return (NULL); /* Bypass caller processing. */ 12957b495c44SVANHULLEBUS Yvan } 12967b495c44SVANHULLEBUS Yvan data = mtod(m, caddr_t); /* Points to ip header. */ 12977b495c44SVANHULLEBUS Yvan payload = m->m_len - off; /* Size of payload. */ 12987b495c44SVANHULLEBUS Yvan 12997b495c44SVANHULLEBUS Yvan if (payload == 1 && data[off] == '\xff') 13007b495c44SVANHULLEBUS Yvan return (m); /* NB: keepalive packet, no decap. */ 13017b495c44SVANHULLEBUS Yvan 13027b495c44SVANHULLEBUS Yvan up = intoudpcb(inp); 13037b495c44SVANHULLEBUS Yvan KASSERT(up != NULL, ("%s: udpcb NULL", __func__)); 13047b495c44SVANHULLEBUS Yvan KASSERT((up->u_flags & UF_ESPINUDP_ALL) != 0, 13057b495c44SVANHULLEBUS Yvan ("u_flags 0x%x", up->u_flags)); 13067b495c44SVANHULLEBUS Yvan 13077b495c44SVANHULLEBUS Yvan /* 13087b495c44SVANHULLEBUS Yvan * Check that the payload is large enough to hold an 13097b495c44SVANHULLEBUS Yvan * ESP header and compute the amount of data to remove. 13107b495c44SVANHULLEBUS Yvan * 13117b495c44SVANHULLEBUS Yvan * NB: the caller has already done a pullup for us. 13127b495c44SVANHULLEBUS Yvan * XXX can we assume alignment and eliminate bcopys? 13137b495c44SVANHULLEBUS Yvan */ 13147b495c44SVANHULLEBUS Yvan if (up->u_flags & UF_ESPINUDP_NON_IKE) { 13157b495c44SVANHULLEBUS Yvan /* 13167b495c44SVANHULLEBUS Yvan * draft-ietf-ipsec-nat-t-ike-0[01].txt and 13177b495c44SVANHULLEBUS Yvan * draft-ietf-ipsec-udp-encaps-(00/)01.txt, ignoring 13187b495c44SVANHULLEBUS Yvan * possible AH mode non-IKE marker+non-ESP marker 13197b495c44SVANHULLEBUS Yvan * from draft-ietf-ipsec-udp-encaps-00.txt. 13207b495c44SVANHULLEBUS Yvan */ 13217b495c44SVANHULLEBUS Yvan uint64_t marker; 13227b495c44SVANHULLEBUS Yvan 13237b495c44SVANHULLEBUS Yvan if (payload <= sizeof(uint64_t) + sizeof(struct esp)) 13247b495c44SVANHULLEBUS Yvan return (m); /* NB: no decap. */ 13257b495c44SVANHULLEBUS Yvan bcopy(data + off, &marker, sizeof(uint64_t)); 13267b495c44SVANHULLEBUS Yvan if (marker != 0) /* Non-IKE marker. */ 13277b495c44SVANHULLEBUS Yvan return (m); /* NB: no decap. */ 13287b495c44SVANHULLEBUS Yvan skip = sizeof(uint64_t) + sizeof(struct udphdr); 13297b495c44SVANHULLEBUS Yvan } else { 13307b495c44SVANHULLEBUS Yvan uint32_t spi; 13317b495c44SVANHULLEBUS Yvan 13327b495c44SVANHULLEBUS Yvan if (payload <= sizeof(struct esp)) { 13337b495c44SVANHULLEBUS Yvan V_ipsec4stat.in_inval++; 13347b495c44SVANHULLEBUS Yvan m_freem(m); 13357b495c44SVANHULLEBUS Yvan return (NULL); /* Discard. */ 13367b495c44SVANHULLEBUS Yvan } 13377b495c44SVANHULLEBUS Yvan bcopy(data + off, &spi, sizeof(uint32_t)); 13387b495c44SVANHULLEBUS Yvan if (spi == 0) /* Non-ESP marker. */ 13397b495c44SVANHULLEBUS Yvan return (m); /* NB: no decap. */ 13407b495c44SVANHULLEBUS Yvan skip = sizeof(struct udphdr); 13417b495c44SVANHULLEBUS Yvan } 13427b495c44SVANHULLEBUS Yvan 13437b495c44SVANHULLEBUS Yvan /* 13447b495c44SVANHULLEBUS Yvan * Setup a PACKET_TAG_IPSEC_NAT_T_PORT tag to remember 13457b495c44SVANHULLEBUS Yvan * the UDP ports. This is required if we want to select 13467b495c44SVANHULLEBUS Yvan * the right SPD for multiple hosts behind same NAT. 13477b495c44SVANHULLEBUS Yvan * 13487b495c44SVANHULLEBUS Yvan * NB: ports are maintained in network byte order everywhere 13497b495c44SVANHULLEBUS Yvan * in the NAT-T code. 13507b495c44SVANHULLEBUS Yvan */ 13517b495c44SVANHULLEBUS Yvan tag = m_tag_get(PACKET_TAG_IPSEC_NAT_T_PORTS, 13527b495c44SVANHULLEBUS Yvan 2 * sizeof(uint16_t), M_NOWAIT); 13537b495c44SVANHULLEBUS Yvan if (tag == NULL) { 13547b495c44SVANHULLEBUS Yvan V_ipsec4stat.in_nomem++; 13557b495c44SVANHULLEBUS Yvan m_freem(m); 13567b495c44SVANHULLEBUS Yvan return (NULL); /* Discard. */ 13577b495c44SVANHULLEBUS Yvan } 13587b495c44SVANHULLEBUS Yvan iphlen = off - sizeof(struct udphdr); 13597b495c44SVANHULLEBUS Yvan udphdr = (struct udphdr *)(data + iphlen); 13607b495c44SVANHULLEBUS Yvan ((uint16_t *)(tag + 1))[0] = udphdr->uh_sport; 13617b495c44SVANHULLEBUS Yvan ((uint16_t *)(tag + 1))[1] = udphdr->uh_dport; 13627b495c44SVANHULLEBUS Yvan m_tag_prepend(m, tag); 13637b495c44SVANHULLEBUS Yvan 13647b495c44SVANHULLEBUS Yvan /* 13657b495c44SVANHULLEBUS Yvan * Remove the UDP header (and possibly the non ESP marker) 13667b495c44SVANHULLEBUS Yvan * IP header length is iphlen 13677b495c44SVANHULLEBUS Yvan * Before: 13687b495c44SVANHULLEBUS Yvan * <--- off ---> 13697b495c44SVANHULLEBUS Yvan * +----+------+-----+ 13707b495c44SVANHULLEBUS Yvan * | IP | UDP | ESP | 13717b495c44SVANHULLEBUS Yvan * +----+------+-----+ 13727b495c44SVANHULLEBUS Yvan * <-skip-> 13737b495c44SVANHULLEBUS Yvan * After: 13747b495c44SVANHULLEBUS Yvan * +----+-----+ 13757b495c44SVANHULLEBUS Yvan * | IP | ESP | 13767b495c44SVANHULLEBUS Yvan * +----+-----+ 13777b495c44SVANHULLEBUS Yvan * <-skip-> 13787b495c44SVANHULLEBUS Yvan */ 13797b495c44SVANHULLEBUS Yvan ovbcopy(data, data + skip, iphlen); 13807b495c44SVANHULLEBUS Yvan m_adj(m, skip); 13817b495c44SVANHULLEBUS Yvan 13827b495c44SVANHULLEBUS Yvan ip = mtod(m, struct ip *); 13838f134647SGleb Smirnoff ip->ip_len = htons(ntohs(ip->ip_len) - skip); 13847b495c44SVANHULLEBUS Yvan ip->ip_p = IPPROTO_ESP; 13857b495c44SVANHULLEBUS Yvan 13867b495c44SVANHULLEBUS Yvan /* 13877b495c44SVANHULLEBUS Yvan * We cannot yet update the cksums so clear any 13887b495c44SVANHULLEBUS Yvan * h/w cksum flags as they are no longer valid. 13897b495c44SVANHULLEBUS Yvan */ 13907b495c44SVANHULLEBUS Yvan if (m->m_pkthdr.csum_flags & CSUM_DATA_VALID) 13917b495c44SVANHULLEBUS Yvan m->m_pkthdr.csum_flags &= ~(CSUM_DATA_VALID|CSUM_PSEUDO_HDR); 13927b495c44SVANHULLEBUS Yvan 13937b495c44SVANHULLEBUS Yvan (void) ipsec4_common_input(m, iphlen, ip->ip_p); 13947b495c44SVANHULLEBUS Yvan return (NULL); /* NB: consumed, bypass processing. */ 13957b495c44SVANHULLEBUS Yvan } 13967b495c44SVANHULLEBUS Yvan #endif /* defined(IPSEC) && defined(IPSEC_NAT_T) */ 13977b495c44SVANHULLEBUS Yvan 1398ac45e92fSRobert Watson static void 1399d0390e05SGarrett Wollman udp_abort(struct socket *so) 1400df8bae1dSRodney W. Grimes { 1401d0390e05SGarrett Wollman struct inpcb *inp; 1402df8bae1dSRodney W. Grimes 1403d0390e05SGarrett Wollman inp = sotoinpcb(so); 140414ba8addSRobert Watson KASSERT(inp != NULL, ("udp_abort: inp == NULL")); 14058501a69cSRobert Watson INP_WLOCK(inp); 1406a152f8a3SRobert Watson if (inp->inp_faddr.s_addr != INADDR_ANY) { 1407fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1408a152f8a3SRobert Watson in_pcbdisconnect(inp); 1409a152f8a3SRobert Watson inp->inp_laddr.s_addr = INADDR_ANY; 1410fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 1411d0390e05SGarrett Wollman soisdisconnected(so); 1412a152f8a3SRobert Watson } 14138501a69cSRobert Watson INP_WUNLOCK(inp); 1414df8bae1dSRodney W. Grimes } 1415df8bae1dSRodney W. Grimes 1416d0390e05SGarrett Wollman static int 1417b40ce416SJulian Elischer udp_attach(struct socket *so, int proto, struct thread *td) 1418d0390e05SGarrett Wollman { 1419d0390e05SGarrett Wollman struct inpcb *inp; 1420277afaffSRobert Watson int error; 1421d0390e05SGarrett Wollman 1422d0390e05SGarrett Wollman inp = sotoinpcb(so); 142314ba8addSRobert Watson KASSERT(inp == NULL, ("udp_attach: inp != NULL")); 1424cfa1ca9dSYoshinobu Inoue error = soreserve(so, udp_sendspace, udp_recvspace); 1425f24618aaSRobert Watson if (error) 14263329b236SRobert Watson return (error); 1427603724d3SBjoern A. Zeeb INP_INFO_WLOCK(&V_udbinfo); 1428603724d3SBjoern A. Zeeb error = in_pcballoc(so, &V_udbinfo); 142953b57cd1SSam Leffler if (error) { 1430603724d3SBjoern A. Zeeb INP_INFO_WUNLOCK(&V_udbinfo); 14313329b236SRobert Watson return (error); 143253b57cd1SSam Leffler } 1433cfa1ca9dSYoshinobu Inoue 143468b5629bSRobert Watson inp = sotoinpcb(so); 1435cfa1ca9dSYoshinobu Inoue inp->inp_vflag |= INP_IPV4; 1436603724d3SBjoern A. Zeeb inp->inp_ip_ttl = V_ip_defttl; 14376a9148feSBjoern A. Zeeb 14386a9148feSBjoern A. Zeeb error = udp_newudpcb(inp); 14396a9148feSBjoern A. Zeeb if (error) { 14406a9148feSBjoern A. Zeeb in_pcbdetach(inp); 14416a9148feSBjoern A. Zeeb in_pcbfree(inp); 14426a9148feSBjoern A. Zeeb INP_INFO_WUNLOCK(&V_udbinfo); 14436a9148feSBjoern A. Zeeb return (error); 14446a9148feSBjoern A. Zeeb } 14456a9148feSBjoern A. Zeeb 1446c7c7ea4bSRandall Stewart INP_WUNLOCK(inp); 14476a9148feSBjoern A. Zeeb INP_INFO_WUNLOCK(&V_udbinfo); 1448c7c7ea4bSRandall Stewart return (0); 1449c7c7ea4bSRandall Stewart } 145079288c11SBjoern A. Zeeb #endif /* INET */ 1451c7c7ea4bSRandall Stewart 1452c7c7ea4bSRandall Stewart int 1453c7c7ea4bSRandall Stewart udp_set_kernel_tunneling(struct socket *so, udp_tun_func_t f) 1454c7c7ea4bSRandall Stewart { 1455c7c7ea4bSRandall Stewart struct inpcb *inp; 14566a9148feSBjoern A. Zeeb struct udpcb *up; 1457c7c7ea4bSRandall Stewart 145868b5629bSRobert Watson KASSERT(so->so_type == SOCK_DGRAM, 145968b5629bSRobert Watson ("udp_set_kernel_tunneling: !dgram")); 146068b5629bSRobert Watson inp = sotoinpcb(so); 146168b5629bSRobert Watson KASSERT(inp != NULL, ("udp_set_kernel_tunneling: inp == NULL")); 1462c7c7ea4bSRandall Stewart INP_WLOCK(inp); 14636a9148feSBjoern A. Zeeb up = intoudpcb(inp); 14646a9148feSBjoern A. Zeeb if (up->u_tun_func != NULL) { 1465bbb0e3d9SRandall Stewart INP_WUNLOCK(inp); 1466bbb0e3d9SRandall Stewart return (EBUSY); 1467bbb0e3d9SRandall Stewart } 14686a9148feSBjoern A. Zeeb up->u_tun_func = f; 14698501a69cSRobert Watson INP_WUNLOCK(inp); 14703329b236SRobert Watson return (0); 1471df8bae1dSRodney W. Grimes } 1472d0390e05SGarrett Wollman 147379288c11SBjoern A. Zeeb #ifdef INET 1474d0390e05SGarrett Wollman static int 1475b40ce416SJulian Elischer udp_bind(struct socket *so, struct sockaddr *nam, struct thread *td) 1476d0390e05SGarrett Wollman { 1477d0390e05SGarrett Wollman struct inpcb *inp; 1478277afaffSRobert Watson int error; 1479d0390e05SGarrett Wollman 1480d0390e05SGarrett Wollman inp = sotoinpcb(so); 148114ba8addSRobert Watson KASSERT(inp != NULL, ("udp_bind: inp == NULL")); 14828501a69cSRobert Watson INP_WLOCK(inp); 1483fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1484b0330ed9SPawel Jakub Dawidek error = in_pcbbind(inp, nam, td->td_ucred); 1485fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 14868501a69cSRobert Watson INP_WUNLOCK(inp); 14873329b236SRobert Watson return (error); 1488d0390e05SGarrett Wollman } 1489d0390e05SGarrett Wollman 1490a152f8a3SRobert Watson static void 1491a152f8a3SRobert Watson udp_close(struct socket *so) 1492a152f8a3SRobert Watson { 1493a152f8a3SRobert Watson struct inpcb *inp; 1494a152f8a3SRobert Watson 1495a152f8a3SRobert Watson inp = sotoinpcb(so); 1496a152f8a3SRobert Watson KASSERT(inp != NULL, ("udp_close: inp == NULL")); 14978501a69cSRobert Watson INP_WLOCK(inp); 1498a152f8a3SRobert Watson if (inp->inp_faddr.s_addr != INADDR_ANY) { 1499fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1500a152f8a3SRobert Watson in_pcbdisconnect(inp); 1501a152f8a3SRobert Watson inp->inp_laddr.s_addr = INADDR_ANY; 1502fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 1503a152f8a3SRobert Watson soisdisconnected(so); 1504a152f8a3SRobert Watson } 15058501a69cSRobert Watson INP_WUNLOCK(inp); 1506a152f8a3SRobert Watson } 1507a152f8a3SRobert Watson 1508d0390e05SGarrett Wollman static int 1509b40ce416SJulian Elischer udp_connect(struct socket *so, struct sockaddr *nam, struct thread *td) 1510d0390e05SGarrett Wollman { 1511d0390e05SGarrett Wollman struct inpcb *inp; 1512277afaffSRobert Watson int error; 151375c13541SPoul-Henning Kamp struct sockaddr_in *sin; 1514d0390e05SGarrett Wollman 1515d0390e05SGarrett Wollman inp = sotoinpcb(so); 151614ba8addSRobert Watson KASSERT(inp != NULL, ("udp_connect: inp == NULL")); 15178501a69cSRobert Watson INP_WLOCK(inp); 1518f76fcf6dSJeffrey Hsu if (inp->inp_faddr.s_addr != INADDR_ANY) { 15198501a69cSRobert Watson INP_WUNLOCK(inp); 15203329b236SRobert Watson return (EISCONN); 1521f76fcf6dSJeffrey Hsu } 152275c13541SPoul-Henning Kamp sin = (struct sockaddr_in *)nam; 1523b89e82ddSJamie Gritton error = prison_remote_ip4(td->td_ucred, &sin->sin_addr); 1524b89e82ddSJamie Gritton if (error != 0) { 1525413628a7SBjoern A. Zeeb INP_WUNLOCK(inp); 1526b89e82ddSJamie Gritton return (error); 1527413628a7SBjoern A. Zeeb } 1528fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1529b0330ed9SPawel Jakub Dawidek error = in_pcbconnect(inp, nam, td->td_ucred); 1530fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 15314cc20ab1SSeigo Tanimura if (error == 0) 1532df8bae1dSRodney W. Grimes soisconnected(so); 15338501a69cSRobert Watson INP_WUNLOCK(inp); 15343329b236SRobert Watson return (error); 1535df8bae1dSRodney W. Grimes } 1536d0390e05SGarrett Wollman 1537bc725eafSRobert Watson static void 1538d0390e05SGarrett Wollman udp_detach(struct socket *so) 1539d0390e05SGarrett Wollman { 1540d0390e05SGarrett Wollman struct inpcb *inp; 15416a9148feSBjoern A. Zeeb struct udpcb *up; 1542d0390e05SGarrett Wollman 1543d0390e05SGarrett Wollman inp = sotoinpcb(so); 154414ba8addSRobert Watson KASSERT(inp != NULL, ("udp_detach: inp == NULL")); 1545a152f8a3SRobert Watson KASSERT(inp->inp_faddr.s_addr == INADDR_ANY, 1546a152f8a3SRobert Watson ("udp_detach: not disconnected")); 1547603724d3SBjoern A. Zeeb INP_INFO_WLOCK(&V_udbinfo); 15488501a69cSRobert Watson INP_WLOCK(inp); 15496a9148feSBjoern A. Zeeb up = intoudpcb(inp); 15506a9148feSBjoern A. Zeeb KASSERT(up != NULL, ("%s: up == NULL", __func__)); 15516a9148feSBjoern A. Zeeb inp->inp_ppcb = NULL; 1552d0390e05SGarrett Wollman in_pcbdetach(inp); 155314ba8addSRobert Watson in_pcbfree(inp); 1554603724d3SBjoern A. Zeeb INP_INFO_WUNLOCK(&V_udbinfo); 15556a9148feSBjoern A. Zeeb udp_discardcb(up); 1556d0390e05SGarrett Wollman } 1557d0390e05SGarrett Wollman 1558d0390e05SGarrett Wollman static int 1559d0390e05SGarrett Wollman udp_disconnect(struct socket *so) 1560d0390e05SGarrett Wollman { 1561d0390e05SGarrett Wollman struct inpcb *inp; 1562d0390e05SGarrett Wollman 1563d0390e05SGarrett Wollman inp = sotoinpcb(so); 156414ba8addSRobert Watson KASSERT(inp != NULL, ("udp_disconnect: inp == NULL")); 15658501a69cSRobert Watson INP_WLOCK(inp); 1566f76fcf6dSJeffrey Hsu if (inp->inp_faddr.s_addr == INADDR_ANY) { 15678501a69cSRobert Watson INP_WUNLOCK(inp); 15683329b236SRobert Watson return (ENOTCONN); 1569f76fcf6dSJeffrey Hsu } 1570fa046d87SRobert Watson INP_HASH_WLOCK(&V_udbinfo); 1571df8bae1dSRodney W. Grimes in_pcbdisconnect(inp); 1572df8bae1dSRodney W. Grimes inp->inp_laddr.s_addr = INADDR_ANY; 1573fa046d87SRobert Watson INP_HASH_WUNLOCK(&V_udbinfo); 1574d45e4f99SMaxim Konovalov SOCK_LOCK(so); 1575d45e4f99SMaxim Konovalov so->so_state &= ~SS_ISCONNECTED; /* XXX */ 1576d45e4f99SMaxim Konovalov SOCK_UNLOCK(so); 15778501a69cSRobert Watson INP_WUNLOCK(inp); 15783329b236SRobert Watson return (0); 1579df8bae1dSRodney W. Grimes } 1580df8bae1dSRodney W. Grimes 1581d0390e05SGarrett Wollman static int 158257bf258eSGarrett Wollman udp_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *addr, 1583b40ce416SJulian Elischer struct mbuf *control, struct thread *td) 1584d0390e05SGarrett Wollman { 1585d0390e05SGarrett Wollman struct inpcb *inp; 1586d0390e05SGarrett Wollman 1587d0390e05SGarrett Wollman inp = sotoinpcb(so); 158814ba8addSRobert Watson KASSERT(inp != NULL, ("udp_send: inp == NULL")); 15893329b236SRobert Watson return (udp_output(inp, m, addr, control, td)); 1590d0390e05SGarrett Wollman } 159179288c11SBjoern A. Zeeb #endif /* INET */ 1592d0390e05SGarrett Wollman 159376429de4SYoshinobu Inoue int 1594d0390e05SGarrett Wollman udp_shutdown(struct socket *so) 1595d0390e05SGarrett Wollman { 1596d0390e05SGarrett Wollman struct inpcb *inp; 1597d0390e05SGarrett Wollman 1598d0390e05SGarrett Wollman inp = sotoinpcb(so); 159914ba8addSRobert Watson KASSERT(inp != NULL, ("udp_shutdown: inp == NULL")); 16008501a69cSRobert Watson INP_WLOCK(inp); 1601d0390e05SGarrett Wollman socantsendmore(so); 16028501a69cSRobert Watson INP_WUNLOCK(inp); 16033329b236SRobert Watson return (0); 1604d0390e05SGarrett Wollman } 1605d0390e05SGarrett Wollman 160679288c11SBjoern A. Zeeb #ifdef INET 1607d0390e05SGarrett Wollman struct pr_usrreqs udp_usrreqs = { 1608756d52a1SPoul-Henning Kamp .pru_abort = udp_abort, 1609756d52a1SPoul-Henning Kamp .pru_attach = udp_attach, 1610756d52a1SPoul-Henning Kamp .pru_bind = udp_bind, 1611756d52a1SPoul-Henning Kamp .pru_connect = udp_connect, 1612756d52a1SPoul-Henning Kamp .pru_control = in_control, 1613756d52a1SPoul-Henning Kamp .pru_detach = udp_detach, 1614756d52a1SPoul-Henning Kamp .pru_disconnect = udp_disconnect, 161554d642bbSRobert Watson .pru_peeraddr = in_getpeeraddr, 1616756d52a1SPoul-Henning Kamp .pru_send = udp_send, 16175df3e839SRobert Watson .pru_soreceive = soreceive_dgram, 161859b8854eSRobert Watson .pru_sosend = sosend_dgram, 1619756d52a1SPoul-Henning Kamp .pru_shutdown = udp_shutdown, 162054d642bbSRobert Watson .pru_sockaddr = in_getsockaddr, 1621a152f8a3SRobert Watson .pru_sosetlabel = in_pcbsosetlabel, 1622a152f8a3SRobert Watson .pru_close = udp_close, 1623d0390e05SGarrett Wollman }; 162479288c11SBjoern A. Zeeb #endif /* INET */ 1625