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