1df8bae1dSRodney W. Grimes /* 26dfab5b1SGarrett Wollman * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995 3df8bae1dSRodney W. Grimes * The Regents of the University of California. All rights reserved. 4df8bae1dSRodney W. Grimes * 5df8bae1dSRodney W. Grimes * Redistribution and use in source and binary forms, with or without 6df8bae1dSRodney W. Grimes * modification, are permitted provided that the following conditions 7df8bae1dSRodney W. Grimes * are met: 8df8bae1dSRodney W. Grimes * 1. Redistributions of source code must retain the above copyright 9df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer. 10df8bae1dSRodney W. Grimes * 2. Redistributions in binary form must reproduce the above copyright 11df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer in the 12df8bae1dSRodney W. Grimes * documentation and/or other materials provided with the distribution. 13df8bae1dSRodney W. Grimes * 3. All advertising materials mentioning features or use of this software 14df8bae1dSRodney W. Grimes * must display the following acknowledgement: 15df8bae1dSRodney W. Grimes * This product includes software developed by the University of 16df8bae1dSRodney W. Grimes * California, Berkeley and its contributors. 17df8bae1dSRodney W. Grimes * 4. Neither the name of the University nor the names of its contributors 18df8bae1dSRodney W. Grimes * may be used to endorse or promote products derived from this software 19df8bae1dSRodney W. Grimes * without specific prior written permission. 20df8bae1dSRodney W. Grimes * 21df8bae1dSRodney W. Grimes * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 22df8bae1dSRodney W. Grimes * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23df8bae1dSRodney W. Grimes * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24df8bae1dSRodney W. Grimes * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 25df8bae1dSRodney W. Grimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26df8bae1dSRodney W. Grimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27df8bae1dSRodney W. Grimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28df8bae1dSRodney W. Grimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29df8bae1dSRodney W. Grimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30df8bae1dSRodney W. Grimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31df8bae1dSRodney W. Grimes * SUCH DAMAGE. 32df8bae1dSRodney W. Grimes * 336dfab5b1SGarrett Wollman * @(#)udp_usrreq.c 8.6 (Berkeley) 5/23/95 34816a3d83SPoul-Henning Kamp * $Id: udp_usrreq.c,v 1.20 1996/03/11 15:13:38 davidg Exp $ 35df8bae1dSRodney W. Grimes */ 36df8bae1dSRodney W. Grimes 37df8bae1dSRodney W. Grimes #include <sys/param.h> 382ee45d7dSDavid Greenman #include <sys/queue.h> 3926f9a767SRodney W. Grimes #include <sys/systm.h> 40df8bae1dSRodney W. Grimes #include <sys/malloc.h> 41df8bae1dSRodney W. Grimes #include <sys/mbuf.h> 42df8bae1dSRodney W. Grimes #include <sys/protosw.h> 43df8bae1dSRodney W. Grimes #include <sys/socket.h> 44df8bae1dSRodney W. Grimes #include <sys/socketvar.h> 45df8bae1dSRodney W. Grimes #include <sys/errno.h> 46df8bae1dSRodney W. Grimes #include <sys/stat.h> 470312fbe9SPoul-Henning Kamp #include <sys/kernel.h> 48b5e8ce9fSBruce Evans #include <sys/sysctl.h> 49816a3d83SPoul-Henning Kamp #include <sys/syslog.h> 50df8bae1dSRodney W. Grimes 51df8bae1dSRodney W. Grimes #include <net/if.h> 52df8bae1dSRodney W. Grimes #include <net/route.h> 53df8bae1dSRodney W. Grimes 54df8bae1dSRodney W. Grimes #include <netinet/in.h> 55df8bae1dSRodney W. Grimes #include <netinet/in_systm.h> 56df8bae1dSRodney W. Grimes #include <netinet/ip.h> 57df8bae1dSRodney W. Grimes #include <netinet/in_pcb.h> 58b5e8ce9fSBruce Evans #include <netinet/in_var.h> 59df8bae1dSRodney W. Grimes #include <netinet/ip_var.h> 60df8bae1dSRodney W. Grimes #include <netinet/ip_icmp.h> 61df8bae1dSRodney W. Grimes #include <netinet/udp.h> 62df8bae1dSRodney W. Grimes #include <netinet/udp_var.h> 63df8bae1dSRodney W. Grimes 64df8bae1dSRodney W. Grimes /* 65df8bae1dSRodney W. Grimes * UDP protocol implementation. 66df8bae1dSRodney W. Grimes * Per RFC 768, August, 1980. 67df8bae1dSRodney W. Grimes */ 68df8bae1dSRodney W. Grimes #ifndef COMPAT_42 690312fbe9SPoul-Henning Kamp static int udpcksum = 1; 70df8bae1dSRodney W. Grimes #else 710312fbe9SPoul-Henning Kamp static int udpcksum = 0; /* XXX */ 72df8bae1dSRodney W. Grimes #endif 730312fbe9SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, UDPCTL_CHECKSUM, checksum, CTLFLAG_RW, 740312fbe9SPoul-Henning Kamp &udpcksum, 0, ""); 75df8bae1dSRodney W. Grimes 76816a3d83SPoul-Henning Kamp static int log_in_vain = 1; 77816a3d83SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, OID_AUTO, log_in_vain, CTLFLAG_RW, 78816a3d83SPoul-Henning Kamp &log_in_vain, 0, ""); 79816a3d83SPoul-Henning Kamp 80f708ef1bSPoul-Henning Kamp static struct inpcbhead udb; /* from udp_var.h */ 81f708ef1bSPoul-Henning Kamp static struct inpcbinfo udbinfo; 8215bd2b43SDavid Greenman 8315bd2b43SDavid Greenman #ifndef UDBHASHSIZE 8415bd2b43SDavid Greenman #define UDBHASHSIZE 64 8515bd2b43SDavid Greenman #endif 8615bd2b43SDavid Greenman 87f708ef1bSPoul-Henning Kamp static struct udpstat udpstat; /* from udp_var.h */ 880312fbe9SPoul-Henning Kamp SYSCTL_STRUCT(_net_inet_udp, UDPCTL_STATS, stats, CTLFLAG_RD, 890312fbe9SPoul-Henning Kamp &udpstat, udpstat, ""); 90f2ea20e6SGarrett Wollman 910312fbe9SPoul-Henning Kamp static struct sockaddr_in udp_in = { sizeof(udp_in), AF_INET }; 92df8bae1dSRodney W. Grimes 93df8bae1dSRodney W. Grimes static void udp_detach __P((struct inpcb *)); 94ff98689dSBruce Evans static int udp_output __P((struct inpcb *, struct mbuf *, struct mbuf *, 95ff98689dSBruce Evans struct mbuf *)); 96df8bae1dSRodney W. Grimes static void udp_notify __P((struct inpcb *, int)); 97df8bae1dSRodney W. Grimes static struct mbuf *udp_saveopt __P((caddr_t, int, int)); 98df8bae1dSRodney W. Grimes 99df8bae1dSRodney W. Grimes void 100df8bae1dSRodney W. Grimes udp_init() 101df8bae1dSRodney W. Grimes { 10215bd2b43SDavid Greenman LIST_INIT(&udb); 10315bd2b43SDavid Greenman udbinfo.listhead = &udb; 10415bd2b43SDavid Greenman udbinfo.hashbase = phashinit(UDBHASHSIZE, M_PCB, &udbinfo.hashsize); 105df8bae1dSRodney W. Grimes } 106df8bae1dSRodney W. Grimes 107df8bae1dSRodney W. Grimes void 108df8bae1dSRodney W. Grimes udp_input(m, iphlen) 109df8bae1dSRodney W. Grimes register struct mbuf *m; 110df8bae1dSRodney W. Grimes int iphlen; 111df8bae1dSRodney W. Grimes { 112df8bae1dSRodney W. Grimes register struct ip *ip; 113df8bae1dSRodney W. Grimes register struct udphdr *uh; 114df8bae1dSRodney W. Grimes register struct inpcb *inp; 115df8bae1dSRodney W. Grimes struct mbuf *opts = 0; 116df8bae1dSRodney W. Grimes int len; 117df8bae1dSRodney W. Grimes struct ip save_ip; 118df8bae1dSRodney W. Grimes 119df8bae1dSRodney W. Grimes udpstat.udps_ipackets++; 120df8bae1dSRodney W. Grimes 121df8bae1dSRodney W. Grimes /* 122df8bae1dSRodney W. Grimes * Strip IP options, if any; should skip this, 123df8bae1dSRodney W. Grimes * make available to user, and use on returned packets, 124df8bae1dSRodney W. Grimes * but we don't yet have a way to check the checksum 125df8bae1dSRodney W. Grimes * with options still present. 126df8bae1dSRodney W. Grimes */ 127df8bae1dSRodney W. Grimes if (iphlen > sizeof (struct ip)) { 128df8bae1dSRodney W. Grimes ip_stripoptions(m, (struct mbuf *)0); 129df8bae1dSRodney W. Grimes iphlen = sizeof(struct ip); 130df8bae1dSRodney W. Grimes } 131df8bae1dSRodney W. Grimes 132df8bae1dSRodney W. Grimes /* 133df8bae1dSRodney W. Grimes * Get IP and UDP header together in first mbuf. 134df8bae1dSRodney W. Grimes */ 135df8bae1dSRodney W. Grimes ip = mtod(m, struct ip *); 136df8bae1dSRodney W. Grimes if (m->m_len < iphlen + sizeof(struct udphdr)) { 137df8bae1dSRodney W. Grimes if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) { 138df8bae1dSRodney W. Grimes udpstat.udps_hdrops++; 139df8bae1dSRodney W. Grimes return; 140df8bae1dSRodney W. Grimes } 141df8bae1dSRodney W. Grimes ip = mtod(m, struct ip *); 142df8bae1dSRodney W. Grimes } 143df8bae1dSRodney W. Grimes uh = (struct udphdr *)((caddr_t)ip + iphlen); 144df8bae1dSRodney W. Grimes 145df8bae1dSRodney W. Grimes /* 146df8bae1dSRodney W. Grimes * Make mbuf data length reflect UDP length. 147df8bae1dSRodney W. Grimes * If not enough data to reflect UDP length, drop. 148df8bae1dSRodney W. Grimes */ 149df8bae1dSRodney W. Grimes len = ntohs((u_short)uh->uh_ulen); 150df8bae1dSRodney W. Grimes if (ip->ip_len != len) { 1517eb7a449SAndras Olah if (len > ip->ip_len || len < sizeof(struct udphdr)) { 152df8bae1dSRodney W. Grimes udpstat.udps_badlen++; 153df8bae1dSRodney W. Grimes goto bad; 154df8bae1dSRodney W. Grimes } 155df8bae1dSRodney W. Grimes m_adj(m, len - ip->ip_len); 156df8bae1dSRodney W. Grimes /* ip->ip_len = len; */ 157df8bae1dSRodney W. Grimes } 158df8bae1dSRodney W. Grimes /* 159df8bae1dSRodney W. Grimes * Save a copy of the IP header in case we want restore it 160df8bae1dSRodney W. Grimes * for sending an ICMP error message in response. 161df8bae1dSRodney W. Grimes */ 162df8bae1dSRodney W. Grimes save_ip = *ip; 163df8bae1dSRodney W. Grimes 164df8bae1dSRodney W. Grimes /* 165df8bae1dSRodney W. Grimes * Checksum extended UDP header and data. 166df8bae1dSRodney W. Grimes */ 1676dfab5b1SGarrett Wollman if (uh->uh_sum) { 168df8bae1dSRodney W. Grimes ((struct ipovly *)ip)->ih_next = 0; 169df8bae1dSRodney W. Grimes ((struct ipovly *)ip)->ih_prev = 0; 170df8bae1dSRodney W. Grimes ((struct ipovly *)ip)->ih_x1 = 0; 171df8bae1dSRodney W. Grimes ((struct ipovly *)ip)->ih_len = uh->uh_ulen; 172623ae52eSPoul-Henning Kamp uh->uh_sum = in_cksum(m, len + sizeof (struct ip)); 173623ae52eSPoul-Henning Kamp if (uh->uh_sum) { 174df8bae1dSRodney W. Grimes udpstat.udps_badsum++; 175df8bae1dSRodney W. Grimes m_freem(m); 176df8bae1dSRodney W. Grimes return; 177df8bae1dSRodney W. Grimes } 178df8bae1dSRodney W. Grimes } 179df8bae1dSRodney W. Grimes 180df8bae1dSRodney W. Grimes if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) || 181df8bae1dSRodney W. Grimes in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) { 182df8bae1dSRodney W. Grimes struct socket *last; 183df8bae1dSRodney W. Grimes /* 184df8bae1dSRodney W. Grimes * Deliver a multicast or broadcast datagram to *all* sockets 185df8bae1dSRodney W. Grimes * for which the local and remote addresses and ports match 186df8bae1dSRodney W. Grimes * those of the incoming datagram. This allows more than 187df8bae1dSRodney W. Grimes * one process to receive multi/broadcasts on the same port. 188df8bae1dSRodney W. Grimes * (This really ought to be done for unicast datagrams as 189df8bae1dSRodney W. Grimes * well, but that would cause problems with existing 190df8bae1dSRodney W. Grimes * applications that open both address-specific sockets and 191df8bae1dSRodney W. Grimes * a wildcard socket listening to the same port -- they would 192df8bae1dSRodney W. Grimes * end up receiving duplicates of every unicast datagram. 193df8bae1dSRodney W. Grimes * Those applications open the multiple sockets to overcome an 194df8bae1dSRodney W. Grimes * inadequacy of the UDP socket interface, but for backwards 195df8bae1dSRodney W. Grimes * compatibility we avoid the problem here rather than 196df8bae1dSRodney W. Grimes * fixing the interface. Maybe 4.5BSD will remedy this?) 197df8bae1dSRodney W. Grimes */ 198df8bae1dSRodney W. Grimes 199df8bae1dSRodney W. Grimes /* 200df8bae1dSRodney W. Grimes * Construct sockaddr format source address. 201df8bae1dSRodney W. Grimes */ 202df8bae1dSRodney W. Grimes udp_in.sin_port = uh->uh_sport; 203df8bae1dSRodney W. Grimes udp_in.sin_addr = ip->ip_src; 204df8bae1dSRodney W. Grimes m->m_len -= sizeof (struct udpiphdr); 205df8bae1dSRodney W. Grimes m->m_data += sizeof (struct udpiphdr); 206df8bae1dSRodney W. Grimes /* 207df8bae1dSRodney W. Grimes * Locate pcb(s) for datagram. 208df8bae1dSRodney W. Grimes * (Algorithm copied from raw_intr().) 209df8bae1dSRodney W. Grimes */ 210df8bae1dSRodney W. Grimes last = NULL; 21115bd2b43SDavid Greenman for (inp = udb.lh_first; inp != NULL; inp = inp->inp_list.le_next) { 212df8bae1dSRodney W. Grimes if (inp->inp_lport != uh->uh_dport) 213df8bae1dSRodney W. Grimes continue; 214df8bae1dSRodney W. Grimes if (inp->inp_laddr.s_addr != INADDR_ANY) { 215df8bae1dSRodney W. Grimes if (inp->inp_laddr.s_addr != 216df8bae1dSRodney W. Grimes ip->ip_dst.s_addr) 217df8bae1dSRodney W. Grimes continue; 218df8bae1dSRodney W. Grimes } 219df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr != INADDR_ANY) { 220df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr != 221df8bae1dSRodney W. Grimes ip->ip_src.s_addr || 222df8bae1dSRodney W. Grimes inp->inp_fport != uh->uh_sport) 223df8bae1dSRodney W. Grimes continue; 224df8bae1dSRodney W. Grimes } 225df8bae1dSRodney W. Grimes 226df8bae1dSRodney W. Grimes if (last != NULL) { 227df8bae1dSRodney W. Grimes struct mbuf *n; 228df8bae1dSRodney W. Grimes 229df8bae1dSRodney W. Grimes if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { 230df8bae1dSRodney W. Grimes if (sbappendaddr(&last->so_rcv, 231df8bae1dSRodney W. Grimes (struct sockaddr *)&udp_in, 232df8bae1dSRodney W. Grimes n, (struct mbuf *)0) == 0) { 233df8bae1dSRodney W. Grimes m_freem(n); 234df8bae1dSRodney W. Grimes udpstat.udps_fullsock++; 235df8bae1dSRodney W. Grimes } else 236df8bae1dSRodney W. Grimes sorwakeup(last); 237df8bae1dSRodney W. Grimes } 238df8bae1dSRodney W. Grimes } 239df8bae1dSRodney W. Grimes last = inp->inp_socket; 240df8bae1dSRodney W. Grimes /* 241df8bae1dSRodney W. Grimes * Don't look for additional matches if this one does 242df8bae1dSRodney W. Grimes * not have either the SO_REUSEPORT or SO_REUSEADDR 243df8bae1dSRodney W. Grimes * socket options set. This heuristic avoids searching 244df8bae1dSRodney W. Grimes * through all pcbs in the common case of a non-shared 245df8bae1dSRodney W. Grimes * port. It * assumes that an application will never 246df8bae1dSRodney W. Grimes * clear these options after setting them. 247df8bae1dSRodney W. Grimes */ 248df8bae1dSRodney W. Grimes if ((last->so_options&(SO_REUSEPORT|SO_REUSEADDR) == 0)) 249df8bae1dSRodney W. Grimes break; 250df8bae1dSRodney W. Grimes } 251df8bae1dSRodney W. Grimes 252df8bae1dSRodney W. Grimes if (last == NULL) { 253df8bae1dSRodney W. Grimes /* 254df8bae1dSRodney W. Grimes * No matching pcb found; discard datagram. 255df8bae1dSRodney W. Grimes * (No need to send an ICMP Port Unreachable 256df8bae1dSRodney W. Grimes * for a broadcast or multicast datgram.) 257df8bae1dSRodney W. Grimes */ 258df8bae1dSRodney W. Grimes udpstat.udps_noportbcast++; 259df8bae1dSRodney W. Grimes goto bad; 260df8bae1dSRodney W. Grimes } 261df8bae1dSRodney W. Grimes if (sbappendaddr(&last->so_rcv, (struct sockaddr *)&udp_in, 262df8bae1dSRodney W. Grimes m, (struct mbuf *)0) == 0) { 263df8bae1dSRodney W. Grimes udpstat.udps_fullsock++; 264df8bae1dSRodney W. Grimes goto bad; 265df8bae1dSRodney W. Grimes } 266df8bae1dSRodney W. Grimes sorwakeup(last); 267df8bae1dSRodney W. Grimes return; 268df8bae1dSRodney W. Grimes } 269df8bae1dSRodney W. Grimes /* 2700d7b7d3eSDavid Greenman * Locate pcb for datagram. First look for an exact match. 271df8bae1dSRodney W. Grimes */ 27215bd2b43SDavid Greenman inp = in_pcblookuphash(&udbinfo, ip->ip_src, uh->uh_sport, 27315bd2b43SDavid Greenman ip->ip_dst, uh->uh_dport); 2740d7b7d3eSDavid Greenman /* 2750d7b7d3eSDavid Greenman * ...and if that fails, do a wildcard search. 2760d7b7d3eSDavid Greenman */ 2770d7b7d3eSDavid Greenman if (inp == NULL) { 2780d7b7d3eSDavid Greenman inp = in_pcblookup(&udb, ip->ip_src, uh->uh_sport, ip->ip_dst, 2790d7b7d3eSDavid Greenman uh->uh_dport, INPLOOKUP_WILDCARD); 2800d7b7d3eSDavid Greenman } 28115bd2b43SDavid Greenman if (inp == NULL) { 282816a3d83SPoul-Henning Kamp if (log_in_vain) 283816a3d83SPoul-Henning Kamp log(LOG_INFO, "Connection attempt to UDP %s:%d" 284816a3d83SPoul-Henning Kamp " from %s:%d\n", 285816a3d83SPoul-Henning Kamp inet_ntoa(ip->ip_dst), ntohs(uh->uh_dport), 286816a3d83SPoul-Henning Kamp inet_ntoa(ip->ip_src), ntohs(uh->uh_sport)); 287df8bae1dSRodney W. Grimes udpstat.udps_noport++; 288df8bae1dSRodney W. Grimes if (m->m_flags & (M_BCAST | M_MCAST)) { 289df8bae1dSRodney W. Grimes udpstat.udps_noportbcast++; 290df8bae1dSRodney W. Grimes goto bad; 291df8bae1dSRodney W. Grimes } 292df8bae1dSRodney W. Grimes *ip = save_ip; 293df8bae1dSRodney W. Grimes icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0); 294df8bae1dSRodney W. Grimes return; 295df8bae1dSRodney W. Grimes } 296df8bae1dSRodney W. Grimes 297df8bae1dSRodney W. Grimes /* 298df8bae1dSRodney W. Grimes * Construct sockaddr format source address. 299df8bae1dSRodney W. Grimes * Stuff source address and datagram in user buffer. 300df8bae1dSRodney W. Grimes */ 301df8bae1dSRodney W. Grimes udp_in.sin_port = uh->uh_sport; 302df8bae1dSRodney W. Grimes udp_in.sin_addr = ip->ip_src; 303df8bae1dSRodney W. Grimes if (inp->inp_flags & INP_CONTROLOPTS) { 304df8bae1dSRodney W. Grimes struct mbuf **mp = &opts; 305df8bae1dSRodney W. Grimes 306df8bae1dSRodney W. Grimes if (inp->inp_flags & INP_RECVDSTADDR) { 307df8bae1dSRodney W. Grimes *mp = udp_saveopt((caddr_t) &ip->ip_dst, 308df8bae1dSRodney W. Grimes sizeof(struct in_addr), IP_RECVDSTADDR); 309df8bae1dSRodney W. Grimes if (*mp) 310df8bae1dSRodney W. Grimes mp = &(*mp)->m_next; 311df8bae1dSRodney W. Grimes } 312df8bae1dSRodney W. Grimes #ifdef notyet 313df8bae1dSRodney W. Grimes /* options were tossed above */ 314df8bae1dSRodney W. Grimes if (inp->inp_flags & INP_RECVOPTS) { 315df8bae1dSRodney W. Grimes *mp = udp_saveopt((caddr_t) opts_deleted_above, 316df8bae1dSRodney W. Grimes sizeof(struct in_addr), IP_RECVOPTS); 317df8bae1dSRodney W. Grimes if (*mp) 318df8bae1dSRodney W. Grimes mp = &(*mp)->m_next; 319df8bae1dSRodney W. Grimes } 320df8bae1dSRodney W. Grimes /* ip_srcroute doesn't do what we want here, need to fix */ 321df8bae1dSRodney W. Grimes if (inp->inp_flags & INP_RECVRETOPTS) { 322df8bae1dSRodney W. Grimes *mp = udp_saveopt((caddr_t) ip_srcroute(), 323df8bae1dSRodney W. Grimes sizeof(struct in_addr), IP_RECVRETOPTS); 324df8bae1dSRodney W. Grimes if (*mp) 325df8bae1dSRodney W. Grimes mp = &(*mp)->m_next; 326df8bae1dSRodney W. Grimes } 327df8bae1dSRodney W. Grimes #endif 328df8bae1dSRodney W. Grimes } 329df8bae1dSRodney W. Grimes iphlen += sizeof(struct udphdr); 330df8bae1dSRodney W. Grimes m->m_len -= iphlen; 331df8bae1dSRodney W. Grimes m->m_pkthdr.len -= iphlen; 332df8bae1dSRodney W. Grimes m->m_data += iphlen; 333df8bae1dSRodney W. Grimes if (sbappendaddr(&inp->inp_socket->so_rcv, (struct sockaddr *)&udp_in, 334df8bae1dSRodney W. Grimes m, opts) == 0) { 335df8bae1dSRodney W. Grimes udpstat.udps_fullsock++; 336df8bae1dSRodney W. Grimes goto bad; 337df8bae1dSRodney W. Grimes } 338df8bae1dSRodney W. Grimes sorwakeup(inp->inp_socket); 339df8bae1dSRodney W. Grimes return; 340df8bae1dSRodney W. Grimes bad: 341df8bae1dSRodney W. Grimes m_freem(m); 342df8bae1dSRodney W. Grimes if (opts) 343df8bae1dSRodney W. Grimes m_freem(opts); 344df8bae1dSRodney W. Grimes } 345df8bae1dSRodney W. Grimes 346df8bae1dSRodney W. Grimes /* 347df8bae1dSRodney W. Grimes * Create a "control" mbuf containing the specified data 348df8bae1dSRodney W. Grimes * with the specified type for presentation with a datagram. 349df8bae1dSRodney W. Grimes */ 350df8bae1dSRodney W. Grimes struct mbuf * 351df8bae1dSRodney W. Grimes udp_saveopt(p, size, type) 352df8bae1dSRodney W. Grimes caddr_t p; 353df8bae1dSRodney W. Grimes register int size; 354df8bae1dSRodney W. Grimes int type; 355df8bae1dSRodney W. Grimes { 356df8bae1dSRodney W. Grimes register struct cmsghdr *cp; 357df8bae1dSRodney W. Grimes struct mbuf *m; 358df8bae1dSRodney W. Grimes 359df8bae1dSRodney W. Grimes if ((m = m_get(M_DONTWAIT, MT_CONTROL)) == NULL) 360df8bae1dSRodney W. Grimes return ((struct mbuf *) NULL); 361df8bae1dSRodney W. Grimes cp = (struct cmsghdr *) mtod(m, struct cmsghdr *); 36294a5d9b6SDavid Greenman (void)memcpy(CMSG_DATA(cp), p, size); 363df8bae1dSRodney W. Grimes size += sizeof(*cp); 364df8bae1dSRodney W. Grimes m->m_len = size; 365df8bae1dSRodney W. Grimes cp->cmsg_len = size; 366df8bae1dSRodney W. Grimes cp->cmsg_level = IPPROTO_IP; 367df8bae1dSRodney W. Grimes cp->cmsg_type = type; 368df8bae1dSRodney W. Grimes return (m); 369df8bae1dSRodney W. Grimes } 370df8bae1dSRodney W. Grimes 371df8bae1dSRodney W. Grimes /* 372df8bae1dSRodney W. Grimes * Notify a udp user of an asynchronous error; 373df8bae1dSRodney W. Grimes * just wake up so that he can collect error status. 374df8bae1dSRodney W. Grimes */ 375df8bae1dSRodney W. Grimes static void 376df8bae1dSRodney W. Grimes udp_notify(inp, errno) 377df8bae1dSRodney W. Grimes register struct inpcb *inp; 378df8bae1dSRodney W. Grimes int errno; 379df8bae1dSRodney W. Grimes { 380df8bae1dSRodney W. Grimes inp->inp_socket->so_error = errno; 381df8bae1dSRodney W. Grimes sorwakeup(inp->inp_socket); 382df8bae1dSRodney W. Grimes sowwakeup(inp->inp_socket); 383df8bae1dSRodney W. Grimes } 384df8bae1dSRodney W. Grimes 385df8bae1dSRodney W. Grimes void 386b62d102cSBruce Evans udp_ctlinput(cmd, sa, vip) 387df8bae1dSRodney W. Grimes int cmd; 388df8bae1dSRodney W. Grimes struct sockaddr *sa; 389b62d102cSBruce Evans void *vip; 390df8bae1dSRodney W. Grimes { 391b62d102cSBruce Evans register struct ip *ip = vip; 392df8bae1dSRodney W. Grimes register struct udphdr *uh; 393df8bae1dSRodney W. Grimes 394df8bae1dSRodney W. Grimes if (!PRC_IS_REDIRECT(cmd) && 395df8bae1dSRodney W. Grimes ((unsigned)cmd >= PRC_NCMDS || inetctlerrmap[cmd] == 0)) 396df8bae1dSRodney W. Grimes return; 397df8bae1dSRodney W. Grimes if (ip) { 398df8bae1dSRodney W. Grimes uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2)); 399df8bae1dSRodney W. Grimes in_pcbnotify(&udb, sa, uh->uh_dport, ip->ip_src, uh->uh_sport, 400df8bae1dSRodney W. Grimes cmd, udp_notify); 401df8bae1dSRodney W. Grimes } else 402df8bae1dSRodney W. Grimes in_pcbnotify(&udb, sa, 0, zeroin_addr, 0, cmd, udp_notify); 403df8bae1dSRodney W. Grimes } 404df8bae1dSRodney W. Grimes 4050312fbe9SPoul-Henning Kamp static int 406df8bae1dSRodney W. Grimes udp_output(inp, m, addr, control) 407df8bae1dSRodney W. Grimes register struct inpcb *inp; 408df8bae1dSRodney W. Grimes register struct mbuf *m; 409df8bae1dSRodney W. Grimes struct mbuf *addr, *control; 410df8bae1dSRodney W. Grimes { 411df8bae1dSRodney W. Grimes register struct udpiphdr *ui; 412df8bae1dSRodney W. Grimes register int len = m->m_pkthdr.len; 413df8bae1dSRodney W. Grimes struct in_addr laddr; 41426f9a767SRodney W. Grimes int s = 0, error = 0; 415df8bae1dSRodney W. Grimes 416df8bae1dSRodney W. Grimes if (control) 417df8bae1dSRodney W. Grimes m_freem(control); /* XXX */ 418df8bae1dSRodney W. Grimes 419df8bae1dSRodney W. Grimes if (addr) { 420df8bae1dSRodney W. Grimes laddr = inp->inp_laddr; 421df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr != INADDR_ANY) { 422df8bae1dSRodney W. Grimes error = EISCONN; 423df8bae1dSRodney W. Grimes goto release; 424df8bae1dSRodney W. Grimes } 425df8bae1dSRodney W. Grimes /* 426df8bae1dSRodney W. Grimes * Must block input while temporarily connected. 427df8bae1dSRodney W. Grimes */ 428df8bae1dSRodney W. Grimes s = splnet(); 429df8bae1dSRodney W. Grimes error = in_pcbconnect(inp, addr); 430df8bae1dSRodney W. Grimes if (error) { 431df8bae1dSRodney W. Grimes splx(s); 432df8bae1dSRodney W. Grimes goto release; 433df8bae1dSRodney W. Grimes } 434df8bae1dSRodney W. Grimes } else { 435df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr == INADDR_ANY) { 436df8bae1dSRodney W. Grimes error = ENOTCONN; 437df8bae1dSRodney W. Grimes goto release; 438df8bae1dSRodney W. Grimes } 439df8bae1dSRodney W. Grimes } 440df8bae1dSRodney W. Grimes /* 441df8bae1dSRodney W. Grimes * Calculate data length and get a mbuf 442df8bae1dSRodney W. Grimes * for UDP and IP headers. 443df8bae1dSRodney W. Grimes */ 444df8bae1dSRodney W. Grimes M_PREPEND(m, sizeof(struct udpiphdr), M_DONTWAIT); 445df8bae1dSRodney W. Grimes if (m == 0) { 446df8bae1dSRodney W. Grimes error = ENOBUFS; 4471c09f774SGarrett Wollman if (addr) 4481c09f774SGarrett Wollman splx(s); 449df8bae1dSRodney W. Grimes goto release; 450df8bae1dSRodney W. Grimes } 451df8bae1dSRodney W. Grimes 452df8bae1dSRodney W. Grimes /* 453df8bae1dSRodney W. Grimes * Fill in mbuf with extended UDP header 454df8bae1dSRodney W. Grimes * and addresses and length put into network format. 455df8bae1dSRodney W. Grimes */ 456df8bae1dSRodney W. Grimes ui = mtod(m, struct udpiphdr *); 457df8bae1dSRodney W. Grimes ui->ui_next = ui->ui_prev = 0; 458df8bae1dSRodney W. Grimes ui->ui_x1 = 0; 459df8bae1dSRodney W. Grimes ui->ui_pr = IPPROTO_UDP; 460df8bae1dSRodney W. Grimes ui->ui_len = htons((u_short)len + sizeof (struct udphdr)); 461df8bae1dSRodney W. Grimes ui->ui_src = inp->inp_laddr; 462df8bae1dSRodney W. Grimes ui->ui_dst = inp->inp_faddr; 463df8bae1dSRodney W. Grimes ui->ui_sport = inp->inp_lport; 464df8bae1dSRodney W. Grimes ui->ui_dport = inp->inp_fport; 465df8bae1dSRodney W. Grimes ui->ui_ulen = ui->ui_len; 466df8bae1dSRodney W. Grimes 467df8bae1dSRodney W. Grimes /* 468df8bae1dSRodney W. Grimes * Stuff checksum and output datagram. 469df8bae1dSRodney W. Grimes */ 470df8bae1dSRodney W. Grimes ui->ui_sum = 0; 471df8bae1dSRodney W. Grimes if (udpcksum) { 472df8bae1dSRodney W. Grimes if ((ui->ui_sum = in_cksum(m, sizeof (struct udpiphdr) + len)) == 0) 473df8bae1dSRodney W. Grimes ui->ui_sum = 0xffff; 474df8bae1dSRodney W. Grimes } 475df8bae1dSRodney W. Grimes ((struct ip *)ui)->ip_len = sizeof (struct udpiphdr) + len; 476df8bae1dSRodney W. Grimes ((struct ip *)ui)->ip_ttl = inp->inp_ip.ip_ttl; /* XXX */ 477df8bae1dSRodney W. Grimes ((struct ip *)ui)->ip_tos = inp->inp_ip.ip_tos; /* XXX */ 478df8bae1dSRodney W. Grimes udpstat.udps_opackets++; 479df8bae1dSRodney W. Grimes error = ip_output(m, inp->inp_options, &inp->inp_route, 480df8bae1dSRodney W. Grimes inp->inp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST), 481df8bae1dSRodney W. Grimes inp->inp_moptions); 482df8bae1dSRodney W. Grimes 483df8bae1dSRodney W. Grimes if (addr) { 484df8bae1dSRodney W. Grimes in_pcbdisconnect(inp); 485df8bae1dSRodney W. Grimes inp->inp_laddr = laddr; 486df8bae1dSRodney W. Grimes splx(s); 487df8bae1dSRodney W. Grimes } 488df8bae1dSRodney W. Grimes return (error); 489df8bae1dSRodney W. Grimes 490df8bae1dSRodney W. Grimes release: 491df8bae1dSRodney W. Grimes m_freem(m); 492df8bae1dSRodney W. Grimes return (error); 493df8bae1dSRodney W. Grimes } 494df8bae1dSRodney W. Grimes 4950312fbe9SPoul-Henning Kamp static u_long udp_sendspace = 9216; /* really max datagram size */ 496df8bae1dSRodney W. Grimes /* 40 1K datagrams */ 4970312fbe9SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, UDPCTL_MAXDGRAM, maxdgram, CTLFLAG_RW, 4980312fbe9SPoul-Henning Kamp &udp_sendspace, 0, ""); 4990312fbe9SPoul-Henning Kamp 5000312fbe9SPoul-Henning Kamp static u_long udp_recvspace = 40 * (1024 + sizeof(struct sockaddr_in)); 5010312fbe9SPoul-Henning Kamp SYSCTL_INT(_net_inet_udp, UDPCTL_RECVSPACE, recvspace, CTLFLAG_RW, 5020312fbe9SPoul-Henning Kamp &udp_recvspace, 0, ""); 503df8bae1dSRodney W. Grimes 504df8bae1dSRodney W. Grimes /*ARGSUSED*/ 505df8bae1dSRodney W. Grimes int 506df8bae1dSRodney W. Grimes udp_usrreq(so, req, m, addr, control) 507df8bae1dSRodney W. Grimes struct socket *so; 508df8bae1dSRodney W. Grimes int req; 509df8bae1dSRodney W. Grimes struct mbuf *m, *addr, *control; 510df8bae1dSRodney W. Grimes { 511df8bae1dSRodney W. Grimes struct inpcb *inp = sotoinpcb(so); 512df8bae1dSRodney W. Grimes int error = 0; 513df8bae1dSRodney W. Grimes int s; 514df8bae1dSRodney W. Grimes 515df8bae1dSRodney W. Grimes if (req == PRU_CONTROL) 5166dfab5b1SGarrett Wollman return (in_control(so, (u_long)m, (caddr_t)addr, 517df8bae1dSRodney W. Grimes (struct ifnet *)control)); 518df8bae1dSRodney W. Grimes if (inp == NULL && req != PRU_ATTACH) { 519df8bae1dSRodney W. Grimes error = EINVAL; 520df8bae1dSRodney W. Grimes goto release; 521df8bae1dSRodney W. Grimes } 522df8bae1dSRodney W. Grimes /* 523df8bae1dSRodney W. Grimes * Note: need to block udp_input while changing 524df8bae1dSRodney W. Grimes * the udp pcb queue and/or pcb addresses. 525df8bae1dSRodney W. Grimes */ 526df8bae1dSRodney W. Grimes switch (req) { 527df8bae1dSRodney W. Grimes 528df8bae1dSRodney W. Grimes case PRU_ATTACH: 529df8bae1dSRodney W. Grimes if (inp != NULL) { 530df8bae1dSRodney W. Grimes error = EINVAL; 531df8bae1dSRodney W. Grimes break; 532df8bae1dSRodney W. Grimes } 533df8bae1dSRodney W. Grimes s = splnet(); 53415bd2b43SDavid Greenman error = in_pcballoc(so, &udbinfo); 535df8bae1dSRodney W. Grimes splx(s); 536df8bae1dSRodney W. Grimes if (error) 537df8bae1dSRodney W. Grimes break; 538df8bae1dSRodney W. Grimes error = soreserve(so, udp_sendspace, udp_recvspace); 539df8bae1dSRodney W. Grimes if (error) 540df8bae1dSRodney W. Grimes break; 541df8bae1dSRodney W. Grimes ((struct inpcb *) so->so_pcb)->inp_ip.ip_ttl = ip_defttl; 542df8bae1dSRodney W. Grimes break; 543df8bae1dSRodney W. Grimes 544df8bae1dSRodney W. Grimes case PRU_DETACH: 545df8bae1dSRodney W. Grimes udp_detach(inp); 546df8bae1dSRodney W. Grimes break; 547df8bae1dSRodney W. Grimes 548df8bae1dSRodney W. Grimes case PRU_BIND: 549df8bae1dSRodney W. Grimes s = splnet(); 550df8bae1dSRodney W. Grimes error = in_pcbbind(inp, addr); 551df8bae1dSRodney W. Grimes splx(s); 552df8bae1dSRodney W. Grimes break; 553df8bae1dSRodney W. Grimes 554df8bae1dSRodney W. Grimes case PRU_LISTEN: 555df8bae1dSRodney W. Grimes error = EOPNOTSUPP; 556df8bae1dSRodney W. Grimes break; 557df8bae1dSRodney W. Grimes 558df8bae1dSRodney W. Grimes case PRU_CONNECT: 559df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr != INADDR_ANY) { 560df8bae1dSRodney W. Grimes error = EISCONN; 561df8bae1dSRodney W. Grimes break; 562df8bae1dSRodney W. Grimes } 563df8bae1dSRodney W. Grimes s = splnet(); 564df8bae1dSRodney W. Grimes error = in_pcbconnect(inp, addr); 565df8bae1dSRodney W. Grimes splx(s); 566df8bae1dSRodney W. Grimes if (error == 0) 567df8bae1dSRodney W. Grimes soisconnected(so); 568df8bae1dSRodney W. Grimes break; 569df8bae1dSRodney W. Grimes 570df8bae1dSRodney W. Grimes case PRU_CONNECT2: 571df8bae1dSRodney W. Grimes error = EOPNOTSUPP; 572df8bae1dSRodney W. Grimes break; 573df8bae1dSRodney W. Grimes 574df8bae1dSRodney W. Grimes case PRU_ACCEPT: 575df8bae1dSRodney W. Grimes error = EOPNOTSUPP; 576df8bae1dSRodney W. Grimes break; 577df8bae1dSRodney W. Grimes 578df8bae1dSRodney W. Grimes case PRU_DISCONNECT: 579df8bae1dSRodney W. Grimes if (inp->inp_faddr.s_addr == INADDR_ANY) { 580df8bae1dSRodney W. Grimes error = ENOTCONN; 581df8bae1dSRodney W. Grimes break; 582df8bae1dSRodney W. Grimes } 583df8bae1dSRodney W. Grimes s = splnet(); 584df8bae1dSRodney W. Grimes in_pcbdisconnect(inp); 585df8bae1dSRodney W. Grimes inp->inp_laddr.s_addr = INADDR_ANY; 586df8bae1dSRodney W. Grimes splx(s); 587df8bae1dSRodney W. Grimes so->so_state &= ~SS_ISCONNECTED; /* XXX */ 588df8bae1dSRodney W. Grimes break; 589df8bae1dSRodney W. Grimes 590df8bae1dSRodney W. Grimes case PRU_SHUTDOWN: 591df8bae1dSRodney W. Grimes socantsendmore(so); 592df8bae1dSRodney W. Grimes break; 593df8bae1dSRodney W. Grimes 594df8bae1dSRodney W. Grimes case PRU_SEND: 595df8bae1dSRodney W. Grimes return (udp_output(inp, m, addr, control)); 596df8bae1dSRodney W. Grimes 597df8bae1dSRodney W. Grimes case PRU_ABORT: 598df8bae1dSRodney W. Grimes soisdisconnected(so); 599df8bae1dSRodney W. Grimes udp_detach(inp); 600df8bae1dSRodney W. Grimes break; 601df8bae1dSRodney W. Grimes 602df8bae1dSRodney W. Grimes case PRU_SOCKADDR: 603df8bae1dSRodney W. Grimes in_setsockaddr(inp, addr); 604df8bae1dSRodney W. Grimes break; 605df8bae1dSRodney W. Grimes 606df8bae1dSRodney W. Grimes case PRU_PEERADDR: 607df8bae1dSRodney W. Grimes in_setpeeraddr(inp, addr); 608df8bae1dSRodney W. Grimes break; 609df8bae1dSRodney W. Grimes 610df8bae1dSRodney W. Grimes case PRU_SENSE: 611df8bae1dSRodney W. Grimes /* 612df8bae1dSRodney W. Grimes * stat: don't bother with a blocksize. 613df8bae1dSRodney W. Grimes */ 614df8bae1dSRodney W. Grimes return (0); 615df8bae1dSRodney W. Grimes 616df8bae1dSRodney W. Grimes case PRU_SENDOOB: 617df8bae1dSRodney W. Grimes case PRU_FASTTIMO: 618df8bae1dSRodney W. Grimes case PRU_SLOWTIMO: 619df8bae1dSRodney W. Grimes case PRU_PROTORCV: 620df8bae1dSRodney W. Grimes case PRU_PROTOSEND: 621df8bae1dSRodney W. Grimes error = EOPNOTSUPP; 622df8bae1dSRodney W. Grimes break; 623df8bae1dSRodney W. Grimes 624df8bae1dSRodney W. Grimes case PRU_RCVD: 625df8bae1dSRodney W. Grimes case PRU_RCVOOB: 626df8bae1dSRodney W. Grimes return (EOPNOTSUPP); /* do not free mbuf's */ 627df8bae1dSRodney W. Grimes 628df8bae1dSRodney W. Grimes default: 629df8bae1dSRodney W. Grimes panic("udp_usrreq"); 630df8bae1dSRodney W. Grimes } 631df8bae1dSRodney W. Grimes 632df8bae1dSRodney W. Grimes release: 633df8bae1dSRodney W. Grimes if (control) { 634df8bae1dSRodney W. Grimes printf("udp control data unexpectedly retained\n"); 635df8bae1dSRodney W. Grimes m_freem(control); 636df8bae1dSRodney W. Grimes } 637df8bae1dSRodney W. Grimes if (m) 638df8bae1dSRodney W. Grimes m_freem(m); 639df8bae1dSRodney W. Grimes return (error); 640df8bae1dSRodney W. Grimes } 641df8bae1dSRodney W. Grimes 642df8bae1dSRodney W. Grimes static void 643df8bae1dSRodney W. Grimes udp_detach(inp) 644df8bae1dSRodney W. Grimes struct inpcb *inp; 645df8bae1dSRodney W. Grimes { 646df8bae1dSRodney W. Grimes int s = splnet(); 647df8bae1dSRodney W. Grimes 648df8bae1dSRodney W. Grimes in_pcbdetach(inp); 649df8bae1dSRodney W. Grimes splx(s); 650df8bae1dSRodney W. Grimes } 651