Home | History | Annotate | Line # | Download | only in netinet
udp_usrreq.c revision 1.134.2.6
      1  1.134.2.6       riz /*	$NetBSD: udp_usrreq.c,v 1.134.2.6 2005/12/29 16:10:18 riz Exp $	*/
      2       1.48    itojun 
      3       1.48    itojun /*
      4       1.48    itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5       1.48    itojun  * All rights reserved.
      6       1.94    itojun  *
      7       1.48    itojun  * Redistribution and use in source and binary forms, with or without
      8       1.48    itojun  * modification, are permitted provided that the following conditions
      9       1.48    itojun  * are met:
     10       1.48    itojun  * 1. Redistributions of source code must retain the above copyright
     11       1.48    itojun  *    notice, this list of conditions and the following disclaimer.
     12       1.48    itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.48    itojun  *    notice, this list of conditions and the following disclaimer in the
     14       1.48    itojun  *    documentation and/or other materials provided with the distribution.
     15       1.48    itojun  * 3. Neither the name of the project nor the names of its contributors
     16       1.48    itojun  *    may be used to endorse or promote products derived from this software
     17       1.48    itojun  *    without specific prior written permission.
     18       1.94    itojun  *
     19       1.48    itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20       1.48    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21       1.48    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22       1.48    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23       1.48    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24       1.48    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25       1.48    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26       1.48    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27       1.48    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28       1.48    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29       1.48    itojun  * SUCH DAMAGE.
     30       1.48    itojun  */
     31       1.14       cgd 
     32        1.1       cgd /*
     33       1.44   thorpej  * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
     34       1.13   mycroft  *	The Regents of the University of California.  All rights reserved.
     35        1.1       cgd  *
     36        1.1       cgd  * Redistribution and use in source and binary forms, with or without
     37        1.1       cgd  * modification, are permitted provided that the following conditions
     38        1.1       cgd  * are met:
     39        1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     40        1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     41        1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     42        1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     43        1.1       cgd  *    documentation and/or other materials provided with the distribution.
     44      1.104       agc  * 3. Neither the name of the University nor the names of its contributors
     45        1.1       cgd  *    may be used to endorse or promote products derived from this software
     46        1.1       cgd  *    without specific prior written permission.
     47        1.1       cgd  *
     48        1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     49        1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     50        1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     51        1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     52        1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     53        1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     54        1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     55        1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     56        1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     57        1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     58        1.1       cgd  * SUCH DAMAGE.
     59        1.1       cgd  *
     60       1.44   thorpej  *	@(#)udp_usrreq.c	8.6 (Berkeley) 5/23/95
     61        1.1       cgd  */
     62       1.91     lukem 
     63       1.91     lukem #include <sys/cdefs.h>
     64  1.134.2.6       riz __KERNEL_RCSID(0, "$NetBSD: udp_usrreq.c,v 1.134.2.6 2005/12/29 16:10:18 riz Exp $");
     65       1.50   thorpej 
     66       1.77      soda #include "opt_inet.h"
     67       1.50   thorpej #include "opt_ipsec.h"
     68       1.78   thorpej #include "opt_inet_csum.h"
     69       1.64        ws #include "opt_ipkdb.h"
     70      1.101    martin #include "opt_mbuftrace.h"
     71        1.1       cgd 
     72        1.5   mycroft #include <sys/param.h>
     73        1.5   mycroft #include <sys/malloc.h>
     74        1.5   mycroft #include <sys/mbuf.h>
     75        1.5   mycroft #include <sys/protosw.h>
     76        1.5   mycroft #include <sys/socket.h>
     77        1.5   mycroft #include <sys/socketvar.h>
     78       1.13   mycroft #include <sys/errno.h>
     79        1.5   mycroft #include <sys/stat.h>
     80       1.27  christos #include <sys/systm.h>
     81       1.27  christos #include <sys/proc.h>
     82       1.53    itojun #include <sys/domain.h>
     83       1.27  christos #include <sys/sysctl.h>
     84        1.1       cgd 
     85        1.5   mycroft #include <net/if.h>
     86        1.5   mycroft #include <net/route.h>
     87        1.1       cgd 
     88        1.5   mycroft #include <netinet/in.h>
     89        1.5   mycroft #include <netinet/in_systm.h>
     90       1.15       cgd #include <netinet/in_var.h>
     91        1.5   mycroft #include <netinet/ip.h>
     92        1.5   mycroft #include <netinet/in_pcb.h>
     93        1.5   mycroft #include <netinet/ip_var.h>
     94        1.5   mycroft #include <netinet/ip_icmp.h>
     95        1.5   mycroft #include <netinet/udp.h>
     96        1.5   mycroft #include <netinet/udp_var.h>
     97        1.1       cgd 
     98      1.130      manu #ifdef IPSEC_NAT_T
     99      1.130      manu #include <netinet6/ipsec.h>
    100      1.130      manu #include <netinet6/esp.h>
    101      1.130      manu #endif
    102      1.130      manu 
    103       1.53    itojun #ifdef INET6
    104       1.53    itojun #include <netinet/ip6.h>
    105       1.53    itojun #include <netinet/icmp6.h>
    106       1.53    itojun #include <netinet6/ip6_var.h>
    107       1.53    itojun #include <netinet6/in6_pcb.h>
    108       1.53    itojun #include <netinet6/udp6_var.h>
    109       1.53    itojun #endif
    110       1.53    itojun 
    111       1.53    itojun #ifndef INET6
    112       1.53    itojun /* always need ip6.h for IP6_EXTHDR_GET */
    113       1.53    itojun #include <netinet/ip6.h>
    114       1.53    itojun #endif
    115       1.53    itojun 
    116       1.76    itojun #include "faith.h"
    117       1.76    itojun #if defined(NFAITH) && NFAITH > 0
    118       1.76    itojun #include <net/if_faith.h>
    119       1.76    itojun #endif
    120       1.76    itojun 
    121       1.27  christos #include <machine/stdarg.h>
    122       1.27  christos 
    123      1.105  jonathan #ifdef FAST_IPSEC
    124      1.105  jonathan #include <netipsec/ipsec.h>
    125      1.121  jonathan #include <netipsec/ipsec_var.h>			/* XXX ipsecstat namespace */
    126      1.105  jonathan #ifdef INET6
    127      1.105  jonathan #include <netipsec/ipsec6.h>
    128      1.105  jonathan #endif
    129      1.105  jonathan #endif	/* FAST_IPSEC*/
    130      1.105  jonathan 
    131       1.48    itojun #ifdef IPSEC
    132       1.48    itojun #include <netinet6/ipsec.h>
    133       1.48    itojun #include <netkey/key.h>
    134       1.48    itojun #endif /*IPSEC*/
    135       1.48    itojun 
    136       1.64        ws #ifdef IPKDB
    137       1.64        ws #include <ipkdb/ipkdb.h>
    138       1.64        ws #endif
    139       1.64        ws 
    140        1.8   mycroft /*
    141        1.8   mycroft  * UDP protocol implementation.
    142        1.8   mycroft  * Per RFC 768, August, 1980.
    143        1.8   mycroft  */
    144        1.8   mycroft #ifndef	COMPAT_42
    145        1.8   mycroft int	udpcksum = 1;
    146        1.8   mycroft #else
    147        1.8   mycroft int	udpcksum = 0;		/* XXX */
    148        1.8   mycroft #endif
    149       1.93      matt 
    150       1.93      matt struct	inpcbtable udbtable;
    151       1.93      matt struct	udpstat udpstat;
    152        1.8   mycroft 
    153       1.72    itojun #ifdef INET
    154      1.130      manu #ifdef IPSEC_NAT_T
    155  1.134.2.6       riz static int udp4_espinudp (struct mbuf **, int, struct sockaddr *,
    156      1.130      manu 	struct socket *);
    157      1.130      manu #endif
    158      1.119      matt static void udp4_sendup (struct mbuf *, int, struct sockaddr *,
    159      1.119      matt 	struct socket *);
    160      1.119      matt static int udp4_realinput (struct sockaddr_in *, struct sockaddr_in *,
    161  1.134.2.6       riz 	struct mbuf **, int);
    162      1.129      yamt static int udp4_input_checksum(struct mbuf *, const struct udphdr *, int, int);
    163       1.72    itojun #endif
    164       1.53    itojun #ifdef INET6
    165      1.119      matt static void udp6_sendup (struct mbuf *, int, struct sockaddr *,
    166      1.119      matt 	struct socket *);
    167      1.119      matt static int udp6_realinput (int, struct sockaddr_in6 *,
    168      1.119      matt 	struct sockaddr_in6 *, struct mbuf *, int);
    169      1.129      yamt static int udp6_input_checksum(struct mbuf *, const struct udphdr *, int, int);
    170       1.53    itojun #endif
    171       1.72    itojun #ifdef INET
    172      1.119      matt static	void udp_notify (struct inpcb *, int);
    173       1.72    itojun #endif
    174        1.7   mycroft 
    175       1.26   mycroft #ifndef UDBHASHSIZE
    176       1.26   mycroft #define	UDBHASHSIZE	128
    177       1.26   mycroft #endif
    178       1.26   mycroft int	udbhashsize = UDBHASHSIZE;
    179       1.26   mycroft 
    180       1.98      matt #ifdef MBUFTRACE
    181       1.98      matt struct mowner udp_mowner = { "udp" };
    182       1.98      matt struct mowner udp_rx_mowner = { "udp", "rx" };
    183       1.98      matt struct mowner udp_tx_mowner = { "udp", "tx" };
    184       1.98      matt #endif
    185       1.98      matt 
    186       1.78   thorpej #ifdef UDP_CSUM_COUNTERS
    187       1.78   thorpej #include <sys/device.h>
    188       1.78   thorpej 
    189       1.78   thorpej struct evcnt udp_hwcsum_bad = EVCNT_INITIALIZER(EVCNT_TYPE_MISC,
    190       1.78   thorpej     NULL, "udp", "hwcsum bad");
    191       1.78   thorpej struct evcnt udp_hwcsum_ok = EVCNT_INITIALIZER(EVCNT_TYPE_MISC,
    192       1.78   thorpej     NULL, "udp", "hwcsum ok");
    193       1.78   thorpej struct evcnt udp_hwcsum_data = EVCNT_INITIALIZER(EVCNT_TYPE_MISC,
    194       1.78   thorpej     NULL, "udp", "hwcsum data");
    195       1.78   thorpej struct evcnt udp_swcsum = EVCNT_INITIALIZER(EVCNT_TYPE_MISC,
    196       1.78   thorpej     NULL, "udp", "swcsum");
    197       1.78   thorpej 
    198       1.78   thorpej #define	UDP_CSUM_COUNTER_INCR(ev)	(ev)->ev_count++
    199       1.78   thorpej 
    200      1.120      matt EVCNT_ATTACH_STATIC(udp_hwcsum_bad);
    201      1.120      matt EVCNT_ATTACH_STATIC(udp_hwcsum_ok);
    202      1.120      matt EVCNT_ATTACH_STATIC(udp_hwcsum_data);
    203      1.120      matt EVCNT_ATTACH_STATIC(udp_swcsum);
    204      1.120      matt 
    205       1.78   thorpej #else
    206       1.78   thorpej 
    207       1.78   thorpej #define	UDP_CSUM_COUNTER_INCR(ev)	/* nothing */
    208       1.78   thorpej 
    209       1.78   thorpej #endif /* UDP_CSUM_COUNTERS */
    210       1.78   thorpej 
    211        1.7   mycroft void
    212      1.119      matt udp_init(void)
    213        1.1       cgd {
    214       1.18   mycroft 
    215       1.35   mycroft 	in_pcbinit(&udbtable, udbhashsize, udbhashsize);
    216       1.78   thorpej 
    217       1.98      matt 	MOWNER_ATTACH(&udp_tx_mowner);
    218       1.98      matt 	MOWNER_ATTACH(&udp_rx_mowner);
    219       1.98      matt 	MOWNER_ATTACH(&udp_mowner);
    220        1.1       cgd }
    221        1.1       cgd 
    222      1.129      yamt /*
    223      1.129      yamt  * Checksum extended UDP header and data.
    224      1.129      yamt  */
    225      1.129      yamt 
    226      1.129      yamt int
    227      1.129      yamt udp_input_checksum(int af, struct mbuf *m, const struct udphdr *uh,
    228      1.129      yamt     int iphlen, int len)
    229      1.129      yamt {
    230      1.129      yamt 
    231      1.129      yamt 	switch (af) {
    232       1.72    itojun #ifdef INET
    233      1.129      yamt 	case AF_INET:
    234      1.129      yamt 		return udp4_input_checksum(m, uh, iphlen, len);
    235      1.129      yamt #endif
    236      1.129      yamt #ifdef INET6
    237      1.129      yamt 	case AF_INET6:
    238      1.129      yamt 		return udp6_input_checksum(m, uh, iphlen, len);
    239      1.129      yamt #endif
    240      1.129      yamt 	}
    241      1.129      yamt #ifdef DIAGNOSTIC
    242      1.129      yamt 	panic("udp_input_checksum: unknown af %d", af);
    243      1.129      yamt #endif
    244      1.129      yamt 	/* NOTREACHED */
    245      1.129      yamt 	return -1;
    246      1.129      yamt }
    247      1.129      yamt 
    248      1.129      yamt #ifdef INET
    249      1.129      yamt 
    250      1.129      yamt /*
    251      1.129      yamt  * Checksum extended UDP header and data.
    252      1.129      yamt  */
    253      1.129      yamt 
    254      1.129      yamt static int
    255      1.129      yamt udp4_input_checksum(struct mbuf *m, const struct udphdr *uh,
    256      1.129      yamt     int iphlen, int len)
    257      1.129      yamt {
    258      1.129      yamt 
    259      1.129      yamt 	/*
    260      1.129      yamt 	 * XXX it's better to record and check if this mbuf is
    261      1.129      yamt 	 * already checked.
    262      1.129      yamt 	 */
    263      1.129      yamt 
    264      1.129      yamt 	if (uh->uh_sum == 0)
    265      1.129      yamt 		return 0;
    266      1.129      yamt 
    267      1.129      yamt 	switch (m->m_pkthdr.csum_flags &
    268      1.129      yamt 	    ((m->m_pkthdr.rcvif->if_csum_flags_rx & M_CSUM_UDPv4) |
    269      1.129      yamt 	    M_CSUM_TCP_UDP_BAD | M_CSUM_DATA)) {
    270      1.129      yamt 	case M_CSUM_UDPv4|M_CSUM_TCP_UDP_BAD:
    271      1.129      yamt 		UDP_CSUM_COUNTER_INCR(&udp_hwcsum_bad);
    272      1.129      yamt 		goto badcsum;
    273      1.129      yamt 
    274      1.129      yamt 	case M_CSUM_UDPv4|M_CSUM_DATA: {
    275      1.129      yamt 		u_int32_t hw_csum = m->m_pkthdr.csum_data;
    276      1.129      yamt 
    277      1.129      yamt 		UDP_CSUM_COUNTER_INCR(&udp_hwcsum_data);
    278      1.129      yamt 		if (m->m_pkthdr.csum_flags & M_CSUM_NO_PSEUDOHDR) {
    279      1.129      yamt 			const struct ip *ip =
    280      1.129      yamt 			    mtod(m, const struct ip *);
    281      1.129      yamt 
    282      1.129      yamt 			hw_csum = in_cksum_phdr(ip->ip_src.s_addr,
    283      1.129      yamt 			    ip->ip_dst.s_addr,
    284      1.129      yamt 			    htons(hw_csum + len + IPPROTO_UDP));
    285      1.129      yamt 		}
    286      1.129      yamt 		if ((hw_csum ^ 0xffff) != 0)
    287      1.129      yamt 			goto badcsum;
    288      1.129      yamt 		break;
    289      1.129      yamt 	}
    290      1.129      yamt 
    291      1.129      yamt 	case M_CSUM_UDPv4:
    292      1.129      yamt 		/* Checksum was okay. */
    293      1.129      yamt 		UDP_CSUM_COUNTER_INCR(&udp_hwcsum_ok);
    294      1.129      yamt 		break;
    295      1.129      yamt 
    296      1.129      yamt 	default:
    297      1.129      yamt 		/*
    298      1.129      yamt 		 * Need to compute it ourselves.  Maybe skip checksum
    299      1.129      yamt 		 * on loopback interfaces.
    300      1.129      yamt 		 */
    301      1.129      yamt 		if (__predict_true(!(m->m_pkthdr.rcvif->if_flags &
    302      1.129      yamt 				     IFF_LOOPBACK) ||
    303      1.129      yamt 				   udp_do_loopback_cksum)) {
    304      1.129      yamt 			UDP_CSUM_COUNTER_INCR(&udp_swcsum);
    305      1.129      yamt 			if (in4_cksum(m, IPPROTO_UDP, iphlen, len) != 0)
    306      1.129      yamt 				goto badcsum;
    307      1.129      yamt 		}
    308      1.129      yamt 		break;
    309      1.129      yamt 	}
    310      1.129      yamt 
    311      1.129      yamt 	return 0;
    312      1.129      yamt 
    313      1.129      yamt badcsum:
    314      1.129      yamt 	udpstat.udps_badsum++;
    315      1.129      yamt 	return -1;
    316      1.129      yamt }
    317      1.129      yamt 
    318        1.7   mycroft void
    319       1.27  christos udp_input(struct mbuf *m, ...)
    320        1.1       cgd {
    321       1.53    itojun 	va_list ap;
    322       1.53    itojun 	struct sockaddr_in src, dst;
    323       1.53    itojun 	struct ip *ip;
    324       1.53    itojun 	struct udphdr *uh;
    325       1.97    simonb 	int iphlen;
    326       1.53    itojun 	int len;
    327       1.53    itojun 	int n;
    328       1.96    itojun 	u_int16_t ip_len;
    329       1.53    itojun 
    330       1.53    itojun 	va_start(ap, m);
    331       1.53    itojun 	iphlen = va_arg(ap, int);
    332       1.97    simonb 	(void)va_arg(ap, int);		/* ignore value, advance ap */
    333       1.53    itojun 	va_end(ap);
    334       1.53    itojun 
    335       1.98      matt 	MCLAIM(m, &udp_rx_mowner);
    336       1.53    itojun 	udpstat.udps_ipackets++;
    337       1.53    itojun 
    338       1.53    itojun 	/*
    339       1.53    itojun 	 * Get IP and UDP header together in first mbuf.
    340       1.53    itojun 	 */
    341       1.53    itojun 	ip = mtod(m, struct ip *);
    342       1.53    itojun 	IP6_EXTHDR_GET(uh, struct udphdr *, m, iphlen, sizeof(struct udphdr));
    343       1.53    itojun 	if (uh == NULL) {
    344       1.53    itojun 		udpstat.udps_hdrops++;
    345       1.53    itojun 		return;
    346       1.53    itojun 	}
    347       1.95   thorpej 	KASSERT(UDP_HDR_ALIGNED_P(uh));
    348       1.53    itojun 
    349       1.57    itojun 	/* destination port of 0 is illegal, based on RFC768. */
    350       1.57    itojun 	if (uh->uh_dport == 0)
    351       1.57    itojun 		goto bad;
    352       1.57    itojun 
    353       1.53    itojun 	/*
    354       1.53    itojun 	 * Make mbuf data length reflect UDP length.
    355       1.53    itojun 	 * If not enough data to reflect UDP length, drop.
    356       1.53    itojun 	 */
    357       1.96    itojun 	ip_len = ntohs(ip->ip_len);
    358       1.53    itojun 	len = ntohs((u_int16_t)uh->uh_ulen);
    359       1.96    itojun 	if (ip_len != iphlen + len) {
    360       1.96    itojun 		if (ip_len < iphlen + len || len < sizeof(struct udphdr)) {
    361       1.53    itojun 			udpstat.udps_badlen++;
    362       1.53    itojun 			goto bad;
    363       1.53    itojun 		}
    364       1.96    itojun 		m_adj(m, iphlen + len - ip_len);
    365       1.53    itojun 	}
    366       1.53    itojun 
    367       1.53    itojun 	/*
    368       1.53    itojun 	 * Checksum extended UDP header and data.
    369       1.53    itojun 	 */
    370      1.129      yamt 	if (udp4_input_checksum(m, uh, iphlen, len))
    371      1.129      yamt 		goto badcsum;
    372       1.53    itojun 
    373       1.53    itojun 	/* construct source and dst sockaddrs. */
    374       1.53    itojun 	bzero(&src, sizeof(src));
    375       1.53    itojun 	src.sin_family = AF_INET;
    376       1.53    itojun 	src.sin_len = sizeof(struct sockaddr_in);
    377       1.53    itojun 	bcopy(&ip->ip_src, &src.sin_addr, sizeof(src.sin_addr));
    378       1.53    itojun 	src.sin_port = uh->uh_sport;
    379       1.53    itojun 	bzero(&dst, sizeof(dst));
    380       1.53    itojun 	dst.sin_family = AF_INET;
    381       1.53    itojun 	dst.sin_len = sizeof(struct sockaddr_in);
    382       1.53    itojun 	bcopy(&ip->ip_dst, &dst.sin_addr, sizeof(dst.sin_addr));
    383       1.53    itojun 	dst.sin_port = uh->uh_dport;
    384       1.53    itojun 
    385  1.134.2.6       riz 	if ((n = udp4_realinput(&src, &dst, &m, iphlen)) == -1) {
    386  1.134.2.6       riz 		udpstat.udps_hdrops++;
    387  1.134.2.6       riz 		return;
    388  1.134.2.6       riz 	}
    389       1.53    itojun #ifdef INET6
    390       1.53    itojun 	if (IN_MULTICAST(ip->ip_dst.s_addr) || n == 0) {
    391       1.53    itojun 		struct sockaddr_in6 src6, dst6;
    392       1.53    itojun 
    393       1.53    itojun 		bzero(&src6, sizeof(src6));
    394       1.53    itojun 		src6.sin6_family = AF_INET6;
    395       1.53    itojun 		src6.sin6_len = sizeof(struct sockaddr_in6);
    396       1.53    itojun 		src6.sin6_addr.s6_addr[10] = src6.sin6_addr.s6_addr[11] = 0xff;
    397       1.53    itojun 		bcopy(&ip->ip_src, &src6.sin6_addr.s6_addr[12],
    398       1.53    itojun 			sizeof(ip->ip_src));
    399       1.53    itojun 		src6.sin6_port = uh->uh_sport;
    400       1.53    itojun 		bzero(&dst6, sizeof(dst6));
    401       1.53    itojun 		dst6.sin6_family = AF_INET6;
    402       1.53    itojun 		dst6.sin6_len = sizeof(struct sockaddr_in6);
    403       1.53    itojun 		dst6.sin6_addr.s6_addr[10] = dst6.sin6_addr.s6_addr[11] = 0xff;
    404       1.53    itojun 		bcopy(&ip->ip_dst, &dst6.sin6_addr.s6_addr[12],
    405       1.53    itojun 			sizeof(ip->ip_dst));
    406       1.53    itojun 		dst6.sin6_port = uh->uh_dport;
    407       1.53    itojun 
    408       1.53    itojun 		n += udp6_realinput(AF_INET, &src6, &dst6, m, iphlen);
    409       1.53    itojun 	}
    410       1.53    itojun #endif
    411       1.53    itojun 
    412       1.53    itojun 	if (n == 0) {
    413       1.53    itojun 		if (m->m_flags & (M_BCAST | M_MCAST)) {
    414       1.53    itojun 			udpstat.udps_noportbcast++;
    415       1.53    itojun 			goto bad;
    416       1.53    itojun 		}
    417       1.61    itojun 		udpstat.udps_noport++;
    418       1.64        ws #ifdef IPKDB
    419       1.53    itojun 		if (checkipkdb(&ip->ip_src, uh->uh_sport, uh->uh_dport,
    420       1.53    itojun 				m, iphlen + sizeof(struct udphdr),
    421       1.53    itojun 				m->m_pkthdr.len - iphlen - sizeof(struct udphdr))) {
    422       1.53    itojun 			/*
    423       1.53    itojun 			 * It was a debugger connect packet,
    424       1.53    itojun 			 * just drop it now
    425       1.53    itojun 			 */
    426       1.53    itojun 			goto bad;
    427       1.53    itojun 		}
    428       1.53    itojun #endif
    429       1.53    itojun 		icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
    430       1.53    itojun 		m = NULL;
    431       1.53    itojun 	}
    432       1.53    itojun 
    433       1.53    itojun bad:
    434       1.53    itojun 	if (m)
    435       1.53    itojun 		m_freem(m);
    436       1.78   thorpej 	return;
    437       1.78   thorpej 
    438       1.78   thorpej badcsum:
    439       1.78   thorpej 	m_freem(m);
    440       1.53    itojun }
    441       1.72    itojun #endif
    442       1.53    itojun 
    443       1.53    itojun #ifdef INET6
    444      1.129      yamt static int
    445      1.129      yamt udp6_input_checksum(struct mbuf *m, const struct udphdr *uh, int off, int len)
    446      1.129      yamt {
    447      1.129      yamt 
    448      1.129      yamt 	if (__predict_false((m->m_flags & M_LOOP) && !udp_do_loopback_cksum)) {
    449      1.129      yamt 		goto good;
    450      1.129      yamt 	}
    451      1.129      yamt 	if (uh->uh_sum == 0) {
    452      1.129      yamt 		udp6stat.udp6s_nosum++;
    453      1.129      yamt 		goto bad;
    454      1.129      yamt 	}
    455      1.129      yamt 	if (in6_cksum(m, IPPROTO_UDP, off, len) != 0) {
    456      1.129      yamt 		udp6stat.udp6s_badsum++;
    457      1.129      yamt 		goto bad;
    458      1.129      yamt 	}
    459      1.129      yamt 
    460      1.129      yamt good:
    461      1.129      yamt 	return 0;
    462      1.129      yamt bad:
    463      1.129      yamt 	return -1;
    464      1.129      yamt }
    465      1.129      yamt 
    466       1.53    itojun int
    467      1.119      matt udp6_input(struct mbuf **mp, int *offp, int proto)
    468       1.53    itojun {
    469       1.53    itojun 	struct mbuf *m = *mp;
    470       1.53    itojun 	int off = *offp;
    471       1.53    itojun 	struct sockaddr_in6 src, dst;
    472       1.53    itojun 	struct ip6_hdr *ip6;
    473       1.53    itojun 	struct udphdr *uh;
    474       1.53    itojun 	u_int32_t plen, ulen;
    475       1.53    itojun 
    476       1.76    itojun 	ip6 = mtod(m, struct ip6_hdr *);
    477       1.76    itojun 
    478       1.53    itojun #if defined(NFAITH) && 0 < NFAITH
    479       1.76    itojun 	if (faithprefix(&ip6->ip6_dst)) {
    480       1.76    itojun 		/* send icmp6 host unreach? */
    481       1.76    itojun 		m_freem(m);
    482       1.76    itojun 		return IPPROTO_DONE;
    483       1.53    itojun 	}
    484       1.53    itojun #endif
    485       1.53    itojun 
    486       1.53    itojun 	udp6stat.udp6s_ipackets++;
    487       1.53    itojun 
    488       1.53    itojun 	/* check for jumbogram is done in ip6_input.  we can trust pkthdr.len */
    489       1.53    itojun 	plen = m->m_pkthdr.len - off;
    490       1.53    itojun 	IP6_EXTHDR_GET(uh, struct udphdr *, m, off, sizeof(struct udphdr));
    491       1.53    itojun 	if (uh == NULL) {
    492       1.53    itojun 		ip6stat.ip6s_tooshort++;
    493       1.53    itojun 		return IPPROTO_DONE;
    494       1.53    itojun 	}
    495       1.95   thorpej 	KASSERT(UDP_HDR_ALIGNED_P(uh));
    496       1.53    itojun 	ulen = ntohs((u_short)uh->uh_ulen);
    497       1.69    itojun 	/*
    498       1.69    itojun 	 * RFC2675 section 4: jumbograms will have 0 in the UDP header field,
    499       1.69    itojun 	 * iff payload length > 0xffff.
    500       1.69    itojun 	 */
    501       1.53    itojun 	if (ulen == 0 && plen > 0xffff)
    502       1.53    itojun 		ulen = plen;
    503       1.53    itojun 
    504       1.53    itojun 	if (plen != ulen) {
    505       1.53    itojun 		udp6stat.udp6s_badlen++;
    506       1.54    itojun 		goto bad;
    507       1.54    itojun 	}
    508       1.54    itojun 
    509       1.57    itojun 	/* destination port of 0 is illegal, based on RFC768. */
    510       1.57    itojun 	if (uh->uh_dport == 0)
    511       1.57    itojun 		goto bad;
    512       1.57    itojun 
    513       1.54    itojun 	/* Be proactive about malicious use of IPv4 mapped address */
    514       1.54    itojun 	if (IN6_IS_ADDR_V4MAPPED(&ip6->ip6_src) ||
    515       1.54    itojun 	    IN6_IS_ADDR_V4MAPPED(&ip6->ip6_dst)) {
    516       1.54    itojun 		/* XXX stat */
    517       1.53    itojun 		goto bad;
    518       1.53    itojun 	}
    519       1.53    itojun 
    520       1.53    itojun 	/*
    521      1.125   thorpej 	 * Checksum extended UDP header and data.  Maybe skip checksum
    522      1.125   thorpej 	 * on loopback interfaces.
    523       1.53    itojun 	 */
    524      1.129      yamt 	if (udp6_input_checksum(m, uh, off, ulen))
    525      1.129      yamt 		goto bad;
    526       1.53    itojun 
    527       1.53    itojun 	/*
    528       1.53    itojun 	 * Construct source and dst sockaddrs.
    529       1.53    itojun 	 * Note that ifindex (s6_addr16[1]) is already filled.
    530       1.53    itojun 	 */
    531       1.53    itojun 	bzero(&src, sizeof(src));
    532       1.53    itojun 	src.sin6_family = AF_INET6;
    533       1.53    itojun 	src.sin6_len = sizeof(struct sockaddr_in6);
    534       1.69    itojun 	/* KAME hack: recover scopeid */
    535       1.69    itojun 	(void)in6_recoverscope(&src, &ip6->ip6_src, m->m_pkthdr.rcvif);
    536       1.53    itojun 	src.sin6_port = uh->uh_sport;
    537       1.53    itojun 	bzero(&dst, sizeof(dst));
    538       1.53    itojun 	dst.sin6_family = AF_INET6;
    539       1.53    itojun 	dst.sin6_len = sizeof(struct sockaddr_in6);
    540       1.69    itojun 	/* KAME hack: recover scopeid */
    541       1.69    itojun 	(void)in6_recoverscope(&dst, &ip6->ip6_dst, m->m_pkthdr.rcvif);
    542       1.53    itojun 	dst.sin6_port = uh->uh_dport;
    543       1.53    itojun 
    544       1.53    itojun 	if (udp6_realinput(AF_INET6, &src, &dst, m, off) == 0) {
    545       1.53    itojun 		if (m->m_flags & M_MCAST) {
    546       1.53    itojun 			udp6stat.udp6s_noportmcast++;
    547       1.53    itojun 			goto bad;
    548       1.53    itojun 		}
    549       1.61    itojun 		udp6stat.udp6s_noport++;
    550       1.53    itojun 		icmp6_error(m, ICMP6_DST_UNREACH, ICMP6_DST_UNREACH_NOPORT, 0);
    551       1.53    itojun 		m = NULL;
    552       1.53    itojun 	}
    553       1.53    itojun 
    554       1.53    itojun bad:
    555       1.53    itojun 	if (m)
    556       1.53    itojun 		m_freem(m);
    557       1.53    itojun 	return IPPROTO_DONE;
    558       1.53    itojun }
    559       1.53    itojun #endif
    560       1.53    itojun 
    561       1.72    itojun #ifdef INET
    562       1.53    itojun static void
    563      1.119      matt udp4_sendup(struct mbuf *m, int off /* offset of data portion */,
    564      1.119      matt 	struct sockaddr *src, struct socket *so)
    565       1.53    itojun {
    566       1.53    itojun 	struct mbuf *opts = NULL;
    567       1.53    itojun 	struct mbuf *n;
    568       1.53    itojun 	struct inpcb *inp = NULL;
    569       1.53    itojun 
    570       1.53    itojun 	if (!so)
    571       1.53    itojun 		return;
    572       1.53    itojun 	switch (so->so_proto->pr_domain->dom_family) {
    573       1.53    itojun 	case AF_INET:
    574       1.53    itojun 		inp = sotoinpcb(so);
    575       1.53    itojun 		break;
    576       1.53    itojun #ifdef INET6
    577       1.53    itojun 	case AF_INET6:
    578       1.53    itojun 		break;
    579       1.53    itojun #endif
    580       1.53    itojun 	default:
    581       1.53    itojun 		return;
    582       1.53    itojun 	}
    583       1.53    itojun 
    584      1.105  jonathan #if defined(IPSEC) || defined(FAST_IPSEC)
    585       1.53    itojun 	/* check AH/ESP integrity. */
    586       1.53    itojun 	if (so != NULL && ipsec4_in_reject_so(m, so)) {
    587       1.53    itojun 		ipsecstat.in_polvio++;
    588      1.110    itojun 		if ((n = m_copy(m, 0, M_COPYALL)) != NULL)
    589      1.110    itojun 			icmp_error(n, ICMP_UNREACH, ICMP_UNREACH_ADMIN_PROHIBIT,
    590      1.110    itojun 			    0, 0);
    591       1.53    itojun 		return;
    592       1.53    itojun 	}
    593       1.53    itojun #endif /*IPSEC*/
    594       1.53    itojun 
    595       1.53    itojun 	if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
    596       1.53    itojun 		if (inp && (inp->inp_flags & INP_CONTROLOPTS
    597       1.53    itojun 			 || so->so_options & SO_TIMESTAMP)) {
    598       1.53    itojun 			struct ip *ip = mtod(n, struct ip *);
    599       1.53    itojun 			ip_savecontrol(inp, &opts, ip, n);
    600       1.53    itojun 		}
    601       1.53    itojun 
    602       1.53    itojun 		m_adj(n, off);
    603       1.53    itojun 		if (sbappendaddr(&so->so_rcv, src, n,
    604       1.53    itojun 				opts) == 0) {
    605       1.53    itojun 			m_freem(n);
    606       1.53    itojun 			if (opts)
    607       1.53    itojun 				m_freem(opts);
    608      1.124   darrenr 			so->so_rcv.sb_overflowed++;
    609       1.81     enami 			udpstat.udps_fullsock++;
    610       1.53    itojun 		} else
    611       1.53    itojun 			sorwakeup(so);
    612       1.53    itojun 	}
    613       1.53    itojun }
    614       1.72    itojun #endif
    615       1.53    itojun 
    616       1.53    itojun #ifdef INET6
    617       1.53    itojun static void
    618      1.119      matt udp6_sendup(struct mbuf *m, int off /* offset of data portion */,
    619      1.119      matt 	struct sockaddr *src, struct socket *so)
    620       1.53    itojun {
    621       1.53    itojun 	struct mbuf *opts = NULL;
    622       1.53    itojun 	struct mbuf *n;
    623       1.53    itojun 	struct in6pcb *in6p = NULL;
    624       1.53    itojun 
    625       1.53    itojun 	if (!so)
    626       1.53    itojun 		return;
    627       1.53    itojun 	if (so->so_proto->pr_domain->dom_family != AF_INET6)
    628       1.53    itojun 		return;
    629       1.53    itojun 	in6p = sotoin6pcb(so);
    630       1.53    itojun 
    631      1.105  jonathan #if defined(IPSEC) || defined(FAST_IPSEC)
    632       1.53    itojun 	/* check AH/ESP integrity. */
    633       1.53    itojun 	if (so != NULL && ipsec6_in_reject_so(m, so)) {
    634       1.53    itojun 		ipsec6stat.in_polvio++;
    635      1.111   mycroft 		if ((n = m_copy(m, 0, M_COPYALL)) != NULL)
    636      1.110    itojun 			icmp6_error(n, ICMP6_DST_UNREACH,
    637      1.110    itojun 			    ICMP6_DST_UNREACH_ADMIN, 0);
    638       1.53    itojun 		return;
    639       1.53    itojun 	}
    640       1.53    itojun #endif /*IPSEC*/
    641       1.53    itojun 
    642       1.53    itojun 	if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
    643       1.53    itojun 		if (in6p && (in6p->in6p_flags & IN6P_CONTROLOPTS
    644       1.53    itojun 			  || in6p->in6p_socket->so_options & SO_TIMESTAMP)) {
    645       1.53    itojun 			struct ip6_hdr *ip6 = mtod(n, struct ip6_hdr *);
    646       1.53    itojun 			ip6_savecontrol(in6p, &opts, ip6, n);
    647       1.53    itojun 		}
    648       1.53    itojun 
    649       1.53    itojun 		m_adj(n, off);
    650       1.53    itojun 		if (sbappendaddr(&so->so_rcv, src, n, opts) == 0) {
    651       1.53    itojun 			m_freem(n);
    652       1.53    itojun 			if (opts)
    653       1.53    itojun 				m_freem(opts);
    654      1.124   darrenr 			so->so_rcv.sb_overflowed++;
    655       1.53    itojun 			udp6stat.udp6s_fullsock++;
    656       1.53    itojun 		} else
    657       1.53    itojun 			sorwakeup(so);
    658       1.53    itojun 	}
    659       1.53    itojun }
    660       1.53    itojun #endif
    661       1.53    itojun 
    662       1.72    itojun #ifdef INET
    663       1.53    itojun static int
    664      1.119      matt udp4_realinput(struct sockaddr_in *src, struct sockaddr_in *dst,
    665  1.134.2.6       riz 	struct mbuf **mp, int off /* offset of udphdr */)
    666       1.53    itojun {
    667       1.53    itojun 	u_int16_t *sport, *dport;
    668       1.53    itojun 	int rcvcnt;
    669       1.53    itojun 	struct in_addr *src4, *dst4;
    670      1.109    itojun 	struct inpcb_hdr *inph;
    671       1.53    itojun 	struct inpcb *inp;
    672  1.134.2.6       riz 	struct mbuf *m = *mp;
    673       1.53    itojun 
    674       1.53    itojun 	rcvcnt = 0;
    675       1.53    itojun 	off += sizeof(struct udphdr);	/* now, offset of payload */
    676       1.53    itojun 
    677       1.53    itojun 	if (src->sin_family != AF_INET || dst->sin_family != AF_INET)
    678       1.53    itojun 		goto bad;
    679       1.53    itojun 
    680       1.53    itojun 	src4 = &src->sin_addr;
    681       1.53    itojun 	sport = &src->sin_port;
    682       1.53    itojun 	dst4 = &dst->sin_addr;
    683       1.53    itojun 	dport = &dst->sin_port;
    684       1.53    itojun 
    685       1.73    itojun 	if (IN_MULTICAST(dst4->s_addr) ||
    686       1.53    itojun 	    in_broadcast(*dst4, m->m_pkthdr.rcvif)) {
    687       1.53    itojun 		/*
    688       1.53    itojun 		 * Deliver a multicast or broadcast datagram to *all* sockets
    689       1.53    itojun 		 * for which the local and remote addresses and ports match
    690       1.53    itojun 		 * those of the incoming datagram.  This allows more than
    691       1.53    itojun 		 * one process to receive multi/broadcasts on the same port.
    692       1.53    itojun 		 * (This really ought to be done for unicast datagrams as
    693       1.53    itojun 		 * well, but that would cause problems with existing
    694       1.53    itojun 		 * applications that open both address-specific sockets and
    695       1.53    itojun 		 * a wildcard socket listening to the same port -- they would
    696       1.53    itojun 		 * end up receiving duplicates of every unicast datagram.
    697       1.53    itojun 		 * Those applications open the multiple sockets to overcome an
    698       1.53    itojun 		 * inadequacy of the UDP socket interface, but for backwards
    699       1.53    itojun 		 * compatibility we avoid the problem here rather than
    700       1.53    itojun 		 * fixing the interface.  Maybe 4.5BSD will remedy this?)
    701       1.53    itojun 		 */
    702       1.53    itojun 
    703       1.53    itojun 		/*
    704       1.92    itojun 		 * KAME note: traditionally we dropped udpiphdr from mbuf here.
    705       1.71    itojun 		 * we need udpiphdr for IPsec processing so we do that later.
    706       1.53    itojun 		 */
    707       1.53    itojun 		/*
    708       1.53    itojun 		 * Locate pcb(s) for datagram.
    709       1.53    itojun 		 */
    710      1.109    itojun 		CIRCLEQ_FOREACH(inph, &udbtable.inpt_queue, inph_queue) {
    711      1.109    itojun 			inp = (struct inpcb *)inph;
    712      1.109    itojun 			if (inp->inp_af != AF_INET)
    713      1.109    itojun 				continue;
    714      1.109    itojun 
    715       1.53    itojun 			if (inp->inp_lport != *dport)
    716       1.53    itojun 				continue;
    717       1.53    itojun 			if (!in_nullhost(inp->inp_laddr)) {
    718       1.53    itojun 				if (!in_hosteq(inp->inp_laddr, *dst4))
    719       1.53    itojun 					continue;
    720       1.53    itojun 			}
    721       1.53    itojun 			if (!in_nullhost(inp->inp_faddr)) {
    722       1.53    itojun 				if (!in_hosteq(inp->inp_faddr, *src4) ||
    723       1.53    itojun 				    inp->inp_fport != *sport)
    724       1.53    itojun 					continue;
    725       1.53    itojun 			}
    726       1.53    itojun 
    727       1.53    itojun 			udp4_sendup(m, off, (struct sockaddr *)src,
    728       1.53    itojun 				inp->inp_socket);
    729       1.53    itojun 			rcvcnt++;
    730       1.53    itojun 
    731       1.53    itojun 			/*
    732       1.53    itojun 			 * Don't look for additional matches if this one does
    733       1.53    itojun 			 * not have either the SO_REUSEPORT or SO_REUSEADDR
    734       1.53    itojun 			 * socket options set.  This heuristic avoids searching
    735       1.53    itojun 			 * through all pcbs in the common case of a non-shared
    736       1.53    itojun 			 * port.  It assumes that an application will never
    737       1.53    itojun 			 * clear these options after setting them.
    738       1.53    itojun 			 */
    739       1.53    itojun 			if ((inp->inp_socket->so_options &
    740       1.53    itojun 			    (SO_REUSEPORT|SO_REUSEADDR)) == 0)
    741       1.53    itojun 				break;
    742       1.53    itojun 		}
    743       1.53    itojun 	} else {
    744       1.53    itojun 		/*
    745       1.53    itojun 		 * Locate pcb for datagram.
    746       1.53    itojun 		 */
    747       1.53    itojun 		inp = in_pcblookup_connect(&udbtable, *src4, *sport, *dst4, *dport);
    748       1.53    itojun 		if (inp == 0) {
    749       1.53    itojun 			++udpstat.udps_pcbhashmiss;
    750       1.53    itojun 			inp = in_pcblookup_bind(&udbtable, *dst4, *dport);
    751       1.82    itojun 			if (inp == 0)
    752       1.53    itojun 				return rcvcnt;
    753       1.53    itojun 		}
    754       1.53    itojun 
    755      1.130      manu #ifdef IPSEC_NAT_T
    756      1.130      manu 		/* Handle ESP over UDP */
    757      1.130      manu 		if (inp->inp_flags & INP_ESPINUDP_ALL) {
    758      1.130      manu 			struct sockaddr *sa = (struct sockaddr *)src;
    759      1.130      manu 
    760  1.134.2.6       riz 			switch(udp4_espinudp(mp, off, sa, inp->inp_socket)) {
    761  1.134.2.6       riz 			case -1: 	/* Error, m was freeed */
    762  1.134.2.6       riz 				rcvcnt = -1;
    763  1.134.2.6       riz 				goto bad;
    764  1.134.2.6       riz 				break;
    765  1.134.2.6       riz 
    766  1.134.2.6       riz 			case 1:		/* ESP over UDP */
    767      1.130      manu 				rcvcnt++;
    768      1.130      manu 				goto bad;
    769  1.134.2.6       riz 				break;
    770      1.130      manu 
    771  1.134.2.6       riz 			case 0: 	/* plain UDP */
    772  1.134.2.6       riz 			default: 	/* Unexpected */
    773  1.134.2.6       riz 				/*
    774  1.134.2.6       riz 				 * Normal UDP processing will take place
    775  1.134.2.6       riz 				 * m may have changed.
    776  1.134.2.6       riz 				 */
    777  1.134.2.6       riz 				m = *mp;
    778  1.134.2.6       riz 				break;
    779  1.134.2.6       riz 			}
    780      1.130      manu 		}
    781      1.130      manu #endif
    782      1.130      manu 
    783       1.53    itojun 		udp4_sendup(m, off, (struct sockaddr *)src, inp->inp_socket);
    784       1.53    itojun 		rcvcnt++;
    785       1.53    itojun 	}
    786       1.53    itojun 
    787       1.53    itojun bad:
    788       1.53    itojun 	return rcvcnt;
    789       1.53    itojun }
    790       1.72    itojun #endif
    791       1.53    itojun 
    792       1.53    itojun #ifdef INET6
    793       1.53    itojun static int
    794      1.119      matt udp6_realinput(int af, struct sockaddr_in6 *src, struct sockaddr_in6 *dst,
    795      1.119      matt 	struct mbuf *m, int off)
    796       1.53    itojun {
    797       1.79    itojun 	u_int16_t sport, dport;
    798       1.53    itojun 	int rcvcnt;
    799       1.79    itojun 	struct in6_addr src6, dst6;
    800       1.79    itojun 	const struct in_addr *dst4;
    801      1.109    itojun 	struct inpcb_hdr *inph;
    802       1.53    itojun 	struct in6pcb *in6p;
    803       1.53    itojun 
    804       1.53    itojun 	rcvcnt = 0;
    805       1.53    itojun 	off += sizeof(struct udphdr);	/* now, offset of payload */
    806       1.53    itojun 
    807       1.53    itojun 	if (af != AF_INET && af != AF_INET6)
    808       1.53    itojun 		goto bad;
    809       1.53    itojun 	if (src->sin6_family != AF_INET6 || dst->sin6_family != AF_INET6)
    810       1.53    itojun 		goto bad;
    811       1.53    itojun 
    812       1.79    itojun 	in6_embedscope(&src6, src, NULL, NULL);
    813       1.79    itojun 	sport = src->sin6_port;
    814       1.79    itojun 	in6_embedscope(&dst6, dst, NULL, NULL);
    815       1.79    itojun 	dport = dst->sin6_port;
    816       1.88    itojun 	dst4 = (struct in_addr *)&dst->sin6_addr.s6_addr[12];
    817       1.53    itojun 
    818       1.79    itojun 	if (IN6_IS_ADDR_MULTICAST(&dst6) ||
    819       1.79    itojun 	    (af == AF_INET && IN_MULTICAST(dst4->s_addr))) {
    820       1.53    itojun 		/*
    821       1.53    itojun 		 * Deliver a multicast or broadcast datagram to *all* sockets
    822       1.53    itojun 		 * for which the local and remote addresses and ports match
    823       1.53    itojun 		 * those of the incoming datagram.  This allows more than
    824       1.53    itojun 		 * one process to receive multi/broadcasts on the same port.
    825       1.53    itojun 		 * (This really ought to be done for unicast datagrams as
    826       1.53    itojun 		 * well, but that would cause problems with existing
    827       1.53    itojun 		 * applications that open both address-specific sockets and
    828       1.53    itojun 		 * a wildcard socket listening to the same port -- they would
    829       1.53    itojun 		 * end up receiving duplicates of every unicast datagram.
    830       1.53    itojun 		 * Those applications open the multiple sockets to overcome an
    831       1.53    itojun 		 * inadequacy of the UDP socket interface, but for backwards
    832       1.53    itojun 		 * compatibility we avoid the problem here rather than
    833       1.53    itojun 		 * fixing the interface.  Maybe 4.5BSD will remedy this?)
    834       1.53    itojun 		 */
    835       1.53    itojun 
    836       1.53    itojun 		/*
    837       1.92    itojun 		 * KAME note: traditionally we dropped udpiphdr from mbuf here.
    838       1.71    itojun 		 * we need udpiphdr for IPsec processing so we do that later.
    839       1.53    itojun 		 */
    840       1.53    itojun 		/*
    841       1.53    itojun 		 * Locate pcb(s) for datagram.
    842       1.53    itojun 		 */
    843      1.109    itojun 		CIRCLEQ_FOREACH(inph, &udbtable.inpt_queue, inph_queue) {
    844      1.109    itojun 			in6p = (struct in6pcb *)inph;
    845      1.109    itojun 			if (in6p->in6p_af != AF_INET6)
    846      1.109    itojun 				continue;
    847      1.109    itojun 
    848       1.79    itojun 			if (in6p->in6p_lport != dport)
    849       1.53    itojun 				continue;
    850       1.53    itojun 			if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
    851       1.90    itojun 				if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &dst6))
    852       1.53    itojun 					continue;
    853       1.92    itojun 			} else {
    854       1.79    itojun 				if (IN6_IS_ADDR_V4MAPPED(&dst6) &&
    855       1.85    itojun 				    (in6p->in6p_flags & IN6P_IPV6_V6ONLY))
    856       1.55    itojun 					continue;
    857       1.55    itojun 			}
    858       1.53    itojun 			if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) {
    859       1.79    itojun 				if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr,
    860       1.79    itojun 				    &src6) || in6p->in6p_fport != sport)
    861       1.53    itojun 					continue;
    862       1.92    itojun 			} else {
    863       1.79    itojun 				if (IN6_IS_ADDR_V4MAPPED(&src6) &&
    864       1.85    itojun 				    (in6p->in6p_flags & IN6P_IPV6_V6ONLY))
    865       1.55    itojun 					continue;
    866       1.55    itojun 			}
    867       1.53    itojun 
    868       1.53    itojun 			udp6_sendup(m, off, (struct sockaddr *)src,
    869       1.53    itojun 				in6p->in6p_socket);
    870       1.53    itojun 			rcvcnt++;
    871       1.53    itojun 
    872       1.53    itojun 			/*
    873       1.53    itojun 			 * Don't look for additional matches if this one does
    874       1.53    itojun 			 * not have either the SO_REUSEPORT or SO_REUSEADDR
    875       1.53    itojun 			 * socket options set.  This heuristic avoids searching
    876       1.53    itojun 			 * through all pcbs in the common case of a non-shared
    877       1.53    itojun 			 * port.  It assumes that an application will never
    878       1.53    itojun 			 * clear these options after setting them.
    879       1.53    itojun 			 */
    880       1.53    itojun 			if ((in6p->in6p_socket->so_options &
    881       1.53    itojun 			    (SO_REUSEPORT|SO_REUSEADDR)) == 0)
    882       1.53    itojun 				break;
    883       1.53    itojun 		}
    884       1.53    itojun 	} else {
    885       1.53    itojun 		/*
    886       1.53    itojun 		 * Locate pcb for datagram.
    887       1.53    itojun 		 */
    888      1.109    itojun 		in6p = in6_pcblookup_connect(&udbtable, &src6, sport,
    889       1.79    itojun 		    &dst6, dport, 0);
    890       1.53    itojun 		if (in6p == 0) {
    891       1.53    itojun 			++udpstat.udps_pcbhashmiss;
    892      1.109    itojun 			in6p = in6_pcblookup_bind(&udbtable, &dst6, dport, 0);
    893       1.82    itojun 			if (in6p == 0)
    894       1.53    itojun 				return rcvcnt;
    895       1.53    itojun 		}
    896       1.53    itojun 
    897       1.53    itojun 		udp6_sendup(m, off, (struct sockaddr *)src, in6p->in6p_socket);
    898       1.53    itojun 		rcvcnt++;
    899       1.53    itojun 	}
    900       1.53    itojun 
    901       1.53    itojun bad:
    902       1.53    itojun 	return rcvcnt;
    903       1.53    itojun }
    904       1.53    itojun #endif
    905        1.1       cgd 
    906       1.72    itojun #ifdef INET
    907        1.1       cgd /*
    908        1.1       cgd  * Notify a udp user of an asynchronous error;
    909        1.1       cgd  * just wake up so that he can collect error status.
    910        1.1       cgd  */
    911        1.7   mycroft static void
    912      1.119      matt udp_notify(struct inpcb *inp, int errno)
    913        1.1       cgd {
    914        1.1       cgd 	inp->inp_socket->so_error = errno;
    915        1.1       cgd 	sorwakeup(inp->inp_socket);
    916        1.1       cgd 	sowwakeup(inp->inp_socket);
    917        1.1       cgd }
    918        1.1       cgd 
    919       1.27  christos void *
    920      1.119      matt udp_ctlinput(int cmd, struct sockaddr *sa, void *v)
    921        1.1       cgd {
    922       1.66  augustss 	struct ip *ip = v;
    923       1.66  augustss 	struct udphdr *uh;
    924      1.119      matt 	void (*notify)(struct inpcb *, int) = udp_notify;
    925       1.21   mycroft 	int errno;
    926        1.1       cgd 
    927       1.53    itojun 	if (sa->sa_family != AF_INET
    928       1.53    itojun 	 || sa->sa_len != sizeof(struct sockaddr_in))
    929       1.51    itojun 		return NULL;
    930       1.20   mycroft 	if ((unsigned)cmd >= PRC_NCMDS)
    931       1.27  christos 		return NULL;
    932       1.20   mycroft 	errno = inetctlerrmap[cmd];
    933       1.18   mycroft 	if (PRC_IS_REDIRECT(cmd))
    934       1.19   mycroft 		notify = in_rtchange, ip = 0;
    935       1.18   mycroft 	else if (cmd == PRC_HOSTDEAD)
    936       1.19   mycroft 		ip = 0;
    937       1.23       cgd 	else if (errno == 0)
    938       1.27  christos 		return NULL;
    939       1.19   mycroft 	if (ip) {
    940        1.1       cgd 		uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2));
    941       1.34   mycroft 		in_pcbnotify(&udbtable, satosin(sa)->sin_addr, uh->uh_dport,
    942       1.34   mycroft 		    ip->ip_src, uh->uh_sport, errno, notify);
    943       1.53    itojun 
    944       1.53    itojun 		/* XXX mapped address case */
    945       1.19   mycroft 	} else
    946       1.34   mycroft 		in_pcbnotifyall(&udbtable, satosin(sa)->sin_addr, errno,
    947       1.34   mycroft 		    notify);
    948       1.27  christos 	return NULL;
    949        1.1       cgd }
    950        1.1       cgd 
    951        1.7   mycroft int
    952      1.131     perry udp_ctloutput(op, so, level, optname, mp)
    953      1.130      manu 	int op;
    954      1.130      manu 	struct socket *so;
    955      1.130      manu 	int level, optname;
    956      1.130      manu 	struct mbuf **mp;
    957      1.130      manu {
    958      1.130      manu 	int s;
    959      1.130      manu 	int error = 0;
    960      1.130      manu 	struct mbuf *m;
    961      1.130      manu 	struct inpcb *inp;
    962      1.130      manu 	int family;
    963      1.130      manu 
    964      1.130      manu 	family = so->so_proto->pr_domain->dom_family;
    965      1.130      manu 
    966      1.130      manu 	s = splsoftnet();
    967      1.130      manu 	switch (family) {
    968      1.130      manu #ifdef INET
    969      1.130      manu 	case PF_INET:
    970      1.130      manu 		if (level != IPPROTO_UDP) {
    971      1.130      manu 			error = ip_ctloutput(op, so, level, optname, mp);
    972      1.130      manu 			goto end;
    973      1.130      manu 		}
    974      1.130      manu 		break;
    975      1.130      manu #endif
    976      1.130      manu #ifdef INET6
    977      1.130      manu 	case PF_INET6:
    978      1.130      manu 		if (level != IPPROTO_UDP) {
    979      1.130      manu 			error = ip6_ctloutput(op, so, level, optname, mp);
    980      1.130      manu 			goto end;
    981      1.130      manu 		}
    982      1.130      manu 		break;
    983      1.130      manu #endif
    984      1.130      manu 	default:
    985      1.130      manu 		error = EAFNOSUPPORT;
    986      1.130      manu 		goto end;
    987      1.130      manu 		break;
    988      1.130      manu 	}
    989      1.130      manu 
    990      1.130      manu 
    991      1.130      manu 	switch (op) {
    992      1.130      manu 	case PRCO_SETOPT:
    993      1.130      manu 		m = *mp;
    994      1.130      manu 		inp = sotoinpcb(so);
    995      1.130      manu 
    996      1.130      manu 		switch (optname) {
    997      1.130      manu 		case UDP_ENCAP:
    998      1.130      manu 			if (m == NULL || m->m_len < sizeof (int)) {
    999      1.130      manu 				error = EINVAL;
   1000      1.130      manu 				goto end;
   1001      1.130      manu 			}
   1002      1.131     perry 
   1003      1.130      manu 			switch(*mtod(m, int *)) {
   1004      1.130      manu #ifdef IPSEC_NAT_T
   1005      1.130      manu 			case 0:
   1006      1.130      manu 				inp->inp_flags &= ~INP_ESPINUDP_ALL;
   1007      1.130      manu 				break;
   1008      1.130      manu 
   1009      1.130      manu 			case UDP_ENCAP_ESPINUDP:
   1010      1.130      manu 				inp->inp_flags &= ~INP_ESPINUDP_ALL;
   1011      1.130      manu 				inp->inp_flags |= INP_ESPINUDP;
   1012      1.130      manu 				break;
   1013      1.131     perry 
   1014      1.130      manu 			case UDP_ENCAP_ESPINUDP_NON_IKE:
   1015      1.130      manu 				inp->inp_flags &= ~INP_ESPINUDP_ALL;
   1016      1.130      manu 				inp->inp_flags |= INP_ESPINUDP_NON_IKE;
   1017      1.130      manu 				break;
   1018      1.130      manu #endif
   1019      1.130      manu 			default:
   1020      1.130      manu 				error = EINVAL;
   1021      1.130      manu 				goto end;
   1022      1.130      manu 				break;
   1023      1.130      manu 			}
   1024      1.130      manu 			break;
   1025      1.130      manu 
   1026      1.130      manu 		default:
   1027      1.130      manu 			error = ENOPROTOOPT;
   1028      1.130      manu 			goto end;
   1029      1.130      manu 			break;
   1030      1.130      manu 		}
   1031      1.130      manu 		break;
   1032      1.130      manu 
   1033      1.130      manu 	default:
   1034      1.130      manu 		error = EINVAL;
   1035      1.130      manu 		goto end;
   1036      1.130      manu 		break;
   1037      1.131     perry 	}
   1038      1.131     perry 
   1039      1.130      manu end:
   1040      1.130      manu 	splx(s);
   1041      1.130      manu 	return error;
   1042      1.130      manu }
   1043      1.131     perry 
   1044      1.130      manu 
   1045      1.130      manu int
   1046       1.27  christos udp_output(struct mbuf *m, ...)
   1047       1.27  christos {
   1048       1.66  augustss 	struct inpcb *inp;
   1049       1.66  augustss 	struct udpiphdr *ui;
   1050      1.125   thorpej 	struct route *ro;
   1051       1.66  augustss 	int len = m->m_pkthdr.len;
   1052       1.31   mycroft 	int error = 0;
   1053       1.27  christos 	va_list ap;
   1054       1.27  christos 
   1055       1.98      matt 	MCLAIM(m, &udp_tx_mowner);
   1056       1.27  christos 	va_start(ap, m);
   1057       1.27  christos 	inp = va_arg(ap, struct inpcb *);
   1058       1.27  christos 	va_end(ap);
   1059        1.1       cgd 
   1060        1.1       cgd 	/*
   1061        1.1       cgd 	 * Calculate data length and get a mbuf
   1062        1.1       cgd 	 * for UDP and IP headers.
   1063        1.1       cgd 	 */
   1064       1.13   mycroft 	M_PREPEND(m, sizeof(struct udpiphdr), M_DONTWAIT);
   1065       1.13   mycroft 	if (m == 0) {
   1066       1.13   mycroft 		error = ENOBUFS;
   1067       1.39   thorpej 		goto release;
   1068       1.39   thorpej 	}
   1069       1.39   thorpej 
   1070       1.39   thorpej 	/*
   1071       1.39   thorpej 	 * Compute the packet length of the IP header, and
   1072       1.39   thorpej 	 * punt if the length looks bogus.
   1073       1.39   thorpej 	 */
   1074       1.96    itojun 	if (len + sizeof(struct udpiphdr) > IP_MAXPACKET) {
   1075       1.39   thorpej 		error = EMSGSIZE;
   1076       1.13   mycroft 		goto release;
   1077       1.13   mycroft 	}
   1078        1.1       cgd 
   1079        1.1       cgd 	/*
   1080        1.1       cgd 	 * Fill in mbuf with extended UDP header
   1081        1.1       cgd 	 * and addresses and length put into network format.
   1082        1.1       cgd 	 */
   1083        1.1       cgd 	ui = mtod(m, struct udpiphdr *);
   1084        1.1       cgd 	ui->ui_pr = IPPROTO_UDP;
   1085        1.1       cgd 	ui->ui_src = inp->inp_laddr;
   1086        1.1       cgd 	ui->ui_dst = inp->inp_faddr;
   1087        1.1       cgd 	ui->ui_sport = inp->inp_lport;
   1088        1.1       cgd 	ui->ui_dport = inp->inp_fport;
   1089       1.78   thorpej 	ui->ui_ulen = htons((u_int16_t)len + sizeof(struct udphdr));
   1090        1.1       cgd 
   1091      1.125   thorpej 	ro = &inp->inp_route;
   1092      1.125   thorpej 
   1093        1.1       cgd 	/*
   1094       1.78   thorpej 	 * Set up checksum and output datagram.
   1095        1.1       cgd 	 */
   1096        1.1       cgd 	if (udpcksum) {
   1097       1.78   thorpej 		/*
   1098       1.78   thorpej 		 * XXX Cache pseudo-header checksum part for
   1099       1.78   thorpej 		 * XXX "connected" UDP sockets.
   1100       1.78   thorpej 		 */
   1101       1.78   thorpej 		ui->ui_sum = in_cksum_phdr(ui->ui_src.s_addr,
   1102       1.78   thorpej 		    ui->ui_dst.s_addr, htons((u_int16_t)len +
   1103       1.78   thorpej 		    sizeof(struct udphdr) + IPPROTO_UDP));
   1104  1.134.2.4      tron 		m->m_pkthdr.csum_flags = M_CSUM_UDPv4;
   1105       1.78   thorpej 		m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum);
   1106       1.78   thorpej 	} else
   1107       1.78   thorpej 		ui->ui_sum = 0;
   1108       1.96    itojun 	((struct ip *)ui)->ip_len = htons(sizeof (struct udpiphdr) + len);
   1109        1.1       cgd 	((struct ip *)ui)->ip_ttl = inp->inp_ip.ip_ttl;	/* XXX */
   1110        1.1       cgd 	((struct ip *)ui)->ip_tos = inp->inp_ip.ip_tos;	/* XXX */
   1111        1.1       cgd 	udpstat.udps_opackets++;
   1112       1.48    itojun 
   1113      1.125   thorpej 	return (ip_output(m, inp->inp_options, ro,
   1114       1.12   mycroft 	    inp->inp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST),
   1115      1.107    itojun 	    inp->inp_moptions, inp->inp_socket));
   1116        1.1       cgd 
   1117        1.1       cgd release:
   1118        1.1       cgd 	m_freem(m);
   1119        1.1       cgd 	return (error);
   1120        1.1       cgd }
   1121        1.1       cgd 
   1122       1.42   thorpej int	udp_sendspace = 9216;		/* really max datagram size */
   1123       1.42   thorpej int	udp_recvspace = 40 * (1024 + sizeof(struct sockaddr_in));
   1124        1.1       cgd 					/* 40 1K datagrams */
   1125        1.1       cgd 
   1126        1.1       cgd /*ARGSUSED*/
   1127        1.7   mycroft int
   1128      1.119      matt udp_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
   1129      1.119      matt 	struct mbuf *control, struct proc *p)
   1130        1.1       cgd {
   1131       1.66  augustss 	struct inpcb *inp;
   1132        1.1       cgd 	int s;
   1133       1.66  augustss 	int error = 0;
   1134        1.1       cgd 
   1135        1.1       cgd 	if (req == PRU_CONTROL)
   1136       1.31   mycroft 		return (in_control(so, (long)m, (caddr_t)nam,
   1137       1.30   mycroft 		    (struct ifnet *)control, p));
   1138       1.59   thorpej 
   1139       1.60   thorpej 	if (req == PRU_PURGEIF) {
   1140       1.80    itojun 		in_pcbpurgeif0(&udbtable, (struct ifnet *)control);
   1141       1.60   thorpej 		in_purgeif((struct ifnet *)control);
   1142       1.60   thorpej 		in_pcbpurgeif(&udbtable, (struct ifnet *)control);
   1143       1.59   thorpej 		return (0);
   1144       1.59   thorpej 	}
   1145       1.31   mycroft 
   1146       1.31   mycroft 	s = splsoftnet();
   1147       1.31   mycroft 	inp = sotoinpcb(so);
   1148       1.32   mycroft #ifdef DIAGNOSTIC
   1149       1.32   mycroft 	if (req != PRU_SEND && req != PRU_SENDOOB && control)
   1150       1.32   mycroft 		panic("udp_usrreq: unexpected control mbuf");
   1151       1.32   mycroft #endif
   1152       1.31   mycroft 	if (inp == 0 && req != PRU_ATTACH) {
   1153       1.31   mycroft 		error = EINVAL;
   1154       1.31   mycroft 		goto release;
   1155       1.31   mycroft 	}
   1156       1.31   mycroft 
   1157        1.1       cgd 	/*
   1158        1.1       cgd 	 * Note: need to block udp_input while changing
   1159        1.1       cgd 	 * the udp pcb queue and/or pcb addresses.
   1160        1.1       cgd 	 */
   1161        1.1       cgd 	switch (req) {
   1162        1.1       cgd 
   1163        1.1       cgd 	case PRU_ATTACH:
   1164       1.31   mycroft 		if (inp != 0) {
   1165       1.31   mycroft 			error = EISCONN;
   1166        1.1       cgd 			break;
   1167        1.1       cgd 		}
   1168       1.98      matt #ifdef MBUFTRACE
   1169       1.98      matt 		so->so_mowner = &udp_mowner;
   1170       1.98      matt 		so->so_rcv.sb_mowner = &udp_rx_mowner;
   1171       1.98      matt 		so->so_snd.sb_mowner = &udp_tx_mowner;
   1172       1.98      matt #endif
   1173       1.31   mycroft 		if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
   1174       1.31   mycroft 			error = soreserve(so, udp_sendspace, udp_recvspace);
   1175       1.31   mycroft 			if (error)
   1176       1.31   mycroft 				break;
   1177       1.31   mycroft 		}
   1178       1.18   mycroft 		error = in_pcballoc(so, &udbtable);
   1179        1.1       cgd 		if (error)
   1180        1.1       cgd 			break;
   1181       1.31   mycroft 		inp = sotoinpcb(so);
   1182       1.31   mycroft 		inp->inp_ip.ip_ttl = ip_defttl;
   1183        1.1       cgd 		break;
   1184        1.1       cgd 
   1185        1.1       cgd 	case PRU_DETACH:
   1186       1.31   mycroft 		in_pcbdetach(inp);
   1187        1.1       cgd 		break;
   1188        1.1       cgd 
   1189        1.1       cgd 	case PRU_BIND:
   1190       1.31   mycroft 		error = in_pcbbind(inp, nam, p);
   1191        1.1       cgd 		break;
   1192        1.1       cgd 
   1193        1.1       cgd 	case PRU_LISTEN:
   1194        1.1       cgd 		error = EOPNOTSUPP;
   1195        1.1       cgd 		break;
   1196        1.1       cgd 
   1197        1.1       cgd 	case PRU_CONNECT:
   1198       1.31   mycroft 		error = in_pcbconnect(inp, nam);
   1199       1.31   mycroft 		if (error)
   1200        1.1       cgd 			break;
   1201       1.31   mycroft 		soisconnected(so);
   1202        1.1       cgd 		break;
   1203        1.1       cgd 
   1204        1.1       cgd 	case PRU_CONNECT2:
   1205        1.1       cgd 		error = EOPNOTSUPP;
   1206        1.1       cgd 		break;
   1207        1.1       cgd 
   1208        1.1       cgd 	case PRU_DISCONNECT:
   1209       1.31   mycroft 		/*soisdisconnected(so);*/
   1210       1.31   mycroft 		so->so_state &= ~SS_ISCONNECTED;	/* XXX */
   1211        1.1       cgd 		in_pcbdisconnect(inp);
   1212       1.34   mycroft 		inp->inp_laddr = zeroin_addr;		/* XXX */
   1213       1.35   mycroft 		in_pcbstate(inp, INP_BOUND);		/* XXX */
   1214        1.1       cgd 		break;
   1215        1.1       cgd 
   1216        1.1       cgd 	case PRU_SHUTDOWN:
   1217        1.1       cgd 		socantsendmore(so);
   1218        1.1       cgd 		break;
   1219        1.1       cgd 
   1220       1.31   mycroft 	case PRU_RCVD:
   1221       1.31   mycroft 		error = EOPNOTSUPP;
   1222        1.1       cgd 		break;
   1223        1.1       cgd 
   1224       1.31   mycroft 	case PRU_SEND:
   1225       1.32   mycroft 		if (control && control->m_len) {
   1226       1.32   mycroft 			m_freem(control);
   1227       1.32   mycroft 			m_freem(m);
   1228       1.32   mycroft 			error = EINVAL;
   1229       1.32   mycroft 			break;
   1230       1.32   mycroft 		}
   1231       1.31   mycroft 	{
   1232       1.35   mycroft 		struct in_addr laddr;			/* XXX */
   1233        1.1       cgd 
   1234       1.31   mycroft 		if (nam) {
   1235       1.35   mycroft 			laddr = inp->inp_laddr;		/* XXX */
   1236       1.31   mycroft 			if ((so->so_state & SS_ISCONNECTED) != 0) {
   1237       1.31   mycroft 				error = EISCONN;
   1238       1.32   mycroft 				goto die;
   1239       1.31   mycroft 			}
   1240       1.31   mycroft 			error = in_pcbconnect(inp, nam);
   1241      1.100      matt 			if (error)
   1242      1.100      matt 				goto die;
   1243       1.31   mycroft 		} else {
   1244       1.31   mycroft 			if ((so->so_state & SS_ISCONNECTED) == 0) {
   1245       1.31   mycroft 				error = ENOTCONN;
   1246       1.32   mycroft 				goto die;
   1247       1.31   mycroft 			}
   1248       1.31   mycroft 		}
   1249       1.33   mycroft 		error = udp_output(m, inp);
   1250      1.100      matt 		m = NULL;
   1251       1.31   mycroft 		if (nam) {
   1252       1.31   mycroft 			in_pcbdisconnect(inp);
   1253       1.35   mycroft 			inp->inp_laddr = laddr;		/* XXX */
   1254       1.35   mycroft 			in_pcbstate(inp, INP_BOUND);	/* XXX */
   1255       1.31   mycroft 		}
   1256      1.100      matt 	  die:
   1257      1.100      matt 		if (m)
   1258      1.100      matt 			m_freem(m);
   1259       1.31   mycroft 	}
   1260        1.1       cgd 		break;
   1261        1.1       cgd 
   1262        1.1       cgd 	case PRU_SENSE:
   1263        1.1       cgd 		/*
   1264        1.1       cgd 		 * stat: don't bother with a blocksize.
   1265        1.1       cgd 		 */
   1266       1.31   mycroft 		splx(s);
   1267        1.1       cgd 		return (0);
   1268        1.1       cgd 
   1269       1.31   mycroft 	case PRU_RCVOOB:
   1270       1.31   mycroft 		error =  EOPNOTSUPP;
   1271       1.31   mycroft 		break;
   1272       1.31   mycroft 
   1273        1.1       cgd 	case PRU_SENDOOB:
   1274       1.32   mycroft 		m_freem(control);
   1275       1.31   mycroft 		m_freem(m);
   1276        1.1       cgd 		error =  EOPNOTSUPP;
   1277        1.1       cgd 		break;
   1278        1.1       cgd 
   1279       1.31   mycroft 	case PRU_SOCKADDR:
   1280       1.31   mycroft 		in_setsockaddr(inp, nam);
   1281       1.31   mycroft 		break;
   1282       1.31   mycroft 
   1283       1.31   mycroft 	case PRU_PEERADDR:
   1284       1.31   mycroft 		in_setpeeraddr(inp, nam);
   1285       1.31   mycroft 		break;
   1286        1.1       cgd 
   1287        1.1       cgd 	default:
   1288        1.1       cgd 		panic("udp_usrreq");
   1289        1.1       cgd 	}
   1290        1.1       cgd 
   1291        1.1       cgd release:
   1292       1.31   mycroft 	splx(s);
   1293        1.1       cgd 	return (error);
   1294       1.13   mycroft }
   1295       1.13   mycroft 
   1296       1.13   mycroft /*
   1297       1.13   mycroft  * Sysctl for udp variables.
   1298       1.13   mycroft  */
   1299      1.114    atatat SYSCTL_SETUP(sysctl_net_inet_udp_setup, "sysctl net.inet.udp subtree setup")
   1300       1.13   mycroft {
   1301      1.114    atatat 
   1302      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1303      1.116    atatat 		       CTLFLAG_PERMANENT,
   1304      1.114    atatat 		       CTLTYPE_NODE, "net", NULL,
   1305      1.114    atatat 		       NULL, 0, NULL, 0,
   1306      1.114    atatat 		       CTL_NET, CTL_EOL);
   1307      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1308      1.116    atatat 		       CTLFLAG_PERMANENT,
   1309      1.114    atatat 		       CTLTYPE_NODE, "inet", NULL,
   1310      1.114    atatat 		       NULL, 0, NULL, 0,
   1311      1.114    atatat 		       CTL_NET, PF_INET, CTL_EOL);
   1312      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1313      1.116    atatat 		       CTLFLAG_PERMANENT,
   1314      1.122    atatat 		       CTLTYPE_NODE, "udp",
   1315      1.122    atatat 		       SYSCTL_DESCR("UDPv4 related settings"),
   1316      1.114    atatat 		       NULL, 0, NULL, 0,
   1317      1.114    atatat 		       CTL_NET, PF_INET, IPPROTO_UDP, CTL_EOL);
   1318      1.114    atatat 
   1319      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1320      1.116    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
   1321      1.122    atatat 		       CTLTYPE_INT, "checksum",
   1322      1.123      heas 		       SYSCTL_DESCR("Compute UDP checksums"),
   1323      1.114    atatat 		       NULL, 0, &udpcksum, 0,
   1324      1.114    atatat 		       CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_CHECKSUM,
   1325      1.114    atatat 		       CTL_EOL);
   1326      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1327      1.116    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
   1328      1.122    atatat 		       CTLTYPE_INT, "sendspace",
   1329      1.122    atatat 		       SYSCTL_DESCR("Default UDP send buffer size"),
   1330      1.114    atatat 		       NULL, 0, &udp_sendspace, 0,
   1331      1.114    atatat 		       CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_SENDSPACE,
   1332      1.114    atatat 		       CTL_EOL);
   1333      1.116    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1334      1.116    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
   1335      1.122    atatat 		       CTLTYPE_INT, "recvspace",
   1336      1.122    atatat 		       SYSCTL_DESCR("Default UDP receive buffer size"),
   1337      1.114    atatat 		       NULL, 0, &udp_recvspace, 0,
   1338      1.114    atatat 		       CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_RECVSPACE,
   1339      1.114    atatat 		       CTL_EOL);
   1340      1.125   thorpej 	sysctl_createv(clog, 0, NULL, NULL,
   1341      1.125   thorpej 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
   1342      1.125   thorpej 		       CTLTYPE_INT, "do_loopback_cksum",
   1343      1.125   thorpej 		       SYSCTL_DESCR("Perform UDP checksum on loopback"),
   1344      1.125   thorpej 		       NULL, 0, &udp_do_loopback_cksum, 0,
   1345      1.125   thorpej 		       CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_LOOPBACKCKSUM,
   1346      1.125   thorpej 		       CTL_EOL);
   1347      1.132    atatat 	sysctl_createv(clog, 0, NULL, NULL,
   1348      1.132    atatat 		       CTLFLAG_PERMANENT,
   1349      1.134    atatat 		       CTLTYPE_STRUCT, "pcblist",
   1350      1.132    atatat 		       SYSCTL_DESCR("UDP protocol control block list"),
   1351      1.132    atatat 		       sysctl_inpcblist, 0, &udbtable, 0,
   1352      1.132    atatat 		       CTL_NET, PF_INET, IPPROTO_UDP, CTL_CREATE,
   1353      1.132    atatat 		       CTL_EOL);
   1354        1.1       cgd }
   1355       1.72    itojun #endif
   1356      1.130      manu 
   1357      1.130      manu #if (defined INET && defined IPSEC_NAT_T)
   1358      1.130      manu /*
   1359      1.130      manu  * Returns:
   1360      1.130      manu  * 1 if the packet was processed
   1361      1.130      manu  * 0 if normal UDP processing should take place
   1362  1.134.2.6       riz  * -1 if an error occurent and m was freed
   1363      1.130      manu  */
   1364      1.130      manu static int
   1365  1.134.2.6       riz udp4_espinudp(mp, off, src, so)
   1366  1.134.2.6       riz 	struct mbuf **mp;
   1367      1.130      manu 	int off;
   1368      1.130      manu 	struct sockaddr *src;
   1369      1.130      manu 	struct socket *so;
   1370      1.130      manu {
   1371      1.130      manu 	size_t len;
   1372      1.130      manu 	caddr_t data;
   1373      1.130      manu 	struct inpcb *inp;
   1374      1.130      manu 	size_t skip = 0;
   1375      1.130      manu 	size_t minlen;
   1376      1.130      manu 	size_t iphdrlen;
   1377      1.130      manu 	struct ip *ip;
   1378      1.130      manu 	struct mbuf *n;
   1379  1.134.2.1      tron 	struct m_tag *tag;
   1380  1.134.2.1      tron 	struct udphdr *udphdr;
   1381  1.134.2.1      tron 	u_int16_t sport, dport;
   1382  1.134.2.6       riz 	struct mbuf *m = *mp;
   1383      1.130      manu 
   1384      1.131     perry 	/*
   1385      1.130      manu 	 * Collapse the mbuf chain if the first mbuf is too short
   1386      1.130      manu 	 * The longest case is: UDP + non ESP marker + ESP
   1387      1.130      manu 	 */
   1388      1.130      manu 	minlen = off + sizeof(u_int64_t) + sizeof(struct esp);
   1389      1.130      manu 	if (minlen > m->m_pkthdr.len)
   1390      1.130      manu 		minlen = m->m_pkthdr.len;
   1391      1.130      manu 
   1392      1.130      manu 	if (m->m_len < minlen) {
   1393  1.134.2.6       riz 		if ((*mp = m_pullup(m, minlen)) == NULL) {
   1394      1.130      manu 			printf("udp4_espinudp: m_pullup failed\n");
   1395  1.134.2.6       riz 			return -1;
   1396      1.130      manu 		}
   1397  1.134.2.6       riz 		m = *mp;
   1398      1.130      manu 	}
   1399      1.130      manu 
   1400      1.131     perry 	len = m->m_len - off;
   1401      1.130      manu 	data = mtod(m, caddr_t) + off;
   1402      1.130      manu 	inp = sotoinpcb(so);
   1403      1.130      manu 
   1404      1.130      manu 	/* Ignore keepalive packets */
   1405      1.130      manu 	if ((len == 1) && (data[0] == '\xff')) {
   1406      1.130      manu 		return 1;
   1407      1.130      manu 	}
   1408      1.130      manu 
   1409      1.131     perry 	/*
   1410      1.131     perry 	 * Check that the payload is long enough to hold
   1411      1.130      manu 	 * an ESP header and compute the length of encapsulation
   1412      1.131     perry 	 * header to remove
   1413      1.130      manu 	 */
   1414      1.130      manu 	if (inp->inp_flags & INP_ESPINUDP) {
   1415      1.130      manu 		u_int32_t *st = (u_int32_t *)data;
   1416      1.130      manu 
   1417      1.130      manu 		if ((len <= sizeof(struct esp)) || (*st == 0))
   1418      1.130      manu 			return 0; /* Normal UDP processing */
   1419      1.130      manu 
   1420      1.130      manu 		skip = sizeof(struct udphdr);
   1421      1.130      manu 	}
   1422      1.130      manu 
   1423      1.130      manu 	if (inp->inp_flags & INP_ESPINUDP_NON_IKE) {
   1424  1.134.2.5      tron 		u_int32_t *st = (u_int32_t *)data;
   1425      1.130      manu 
   1426      1.130      manu 		if ((len <= sizeof(u_int64_t) + sizeof(struct esp))
   1427  1.134.2.5      tron 		    || ((st[0] | st[1]) != 0))
   1428      1.130      manu 			return 0; /* Normal UDP processing */
   1429      1.131     perry 
   1430      1.130      manu 		skip = sizeof(struct udphdr) + sizeof(u_int64_t);
   1431      1.130      manu 	}
   1432      1.130      manu 
   1433      1.130      manu 	/*
   1434  1.134.2.1      tron 	 * Get the UDP ports. They are handled in network
   1435  1.134.2.1      tron 	 * order everywhere in IPSEC_NAT_T code.
   1436  1.134.2.1      tron 	 */
   1437  1.134.2.1      tron 	udphdr = (struct udphdr *)(data - skip);
   1438  1.134.2.1      tron 	sport = udphdr->uh_sport;
   1439  1.134.2.1      tron 	dport = udphdr->uh_dport;
   1440  1.134.2.1      tron 
   1441  1.134.2.1      tron 	/*
   1442      1.130      manu 	 * Remove the UDP header (and possibly the non ESP marker)
   1443      1.130      manu 	 * IP header lendth is iphdrlen
   1444      1.131     perry 	 * Before:
   1445      1.130      manu 	 *   <--- off --->
   1446      1.130      manu 	 *   +----+------+-----+
   1447      1.130      manu 	 *   | IP |  UDP | ESP |
   1448      1.130      manu 	 *   +----+------+-----+
   1449      1.130      manu 	 *        <-skip->
   1450      1.130      manu 	 * After:
   1451      1.130      manu 	 *          +----+-----+
   1452      1.130      manu 	 *          | IP | ESP |
   1453      1.130      manu 	 *          +----+-----+
   1454      1.130      manu 	 *   <-skip->
   1455      1.130      manu 	 */
   1456      1.130      manu 	iphdrlen = off - sizeof(struct udphdr);
   1457      1.130      manu 	memmove(mtod(m, caddr_t) + skip, mtod(m, caddr_t), iphdrlen);
   1458      1.130      manu 	m_adj(m, skip);
   1459      1.130      manu 
   1460      1.130      manu 	ip = mtod(m, struct ip *);
   1461      1.130      manu 	ip->ip_len = htons(ntohs(ip->ip_len) - skip);
   1462      1.130      manu 	ip->ip_p = IPPROTO_ESP;
   1463      1.130      manu 
   1464      1.130      manu 	/*
   1465      1.131     perry 	 * Copy the mbuf to avoid multiple free, as both
   1466      1.131     perry 	 * esp4_input (which we call) and udp_input (which
   1467      1.130      manu 	 * called us) free the mbuf.
   1468      1.130      manu 	 */
   1469      1.130      manu 	if ((n = m_dup(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) {
   1470      1.130      manu 		printf("udp4_espinudp: m_dup failed\n");
   1471      1.130      manu 		return 0;
   1472      1.130      manu 	}
   1473      1.130      manu 
   1474  1.134.2.1      tron 	/*
   1475  1.134.2.1      tron 	 * Add a PACKET_TAG_IPSEC_NAT_T_PORT tag to remember
   1476  1.134.2.1      tron 	 * the source UDP port. This is required if we want
   1477  1.134.2.1      tron 	 * to select the right SPD for multiple hosts behind
   1478  1.134.2.1      tron 	 * same NAT
   1479  1.134.2.1      tron 	 */
   1480  1.134.2.2      tron 	if ((tag = m_tag_get(PACKET_TAG_IPSEC_NAT_T_PORTS,
   1481  1.134.2.2      tron 	    sizeof(sport) + sizeof(dport), M_DONTWAIT)) == NULL) {
   1482  1.134.2.2      tron 		printf("udp4_espinudp: m_tag_get failed\n");
   1483  1.134.2.3      tron 		m_freem(n);
   1484  1.134.2.2      tron 		return 0;
   1485  1.134.2.2      tron 	}
   1486  1.134.2.1      tron 	((u_int16_t *)(tag + 1))[0] = sport;
   1487  1.134.2.1      tron 	((u_int16_t *)(tag + 1))[1] = dport;
   1488  1.134.2.1      tron 	m_tag_prepend(n, tag);
   1489  1.134.2.1      tron 
   1490      1.130      manu 	esp4_input(n, iphdrlen);
   1491      1.130      manu 
   1492      1.130      manu 	/* We handled it, it shoudln't be handled by UDP */
   1493      1.130      manu 	return 1;
   1494      1.130      manu }
   1495      1.130      manu #endif
   1496