xref: /freebsd/sys/netinet/udp_usrreq.c (revision 816a3d836e7af6e199987eabb361386ebfcd739b)
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