version 1.107, 2003/08/22 21:53:06 |
version 1.132, 2005/03/09 05:07:19 |
Line 95 __KERNEL_RCSID(0, "$NetBSD$"); |
|
Line 95 __KERNEL_RCSID(0, "$NetBSD$"); |
|
#include <netinet/udp.h> |
#include <netinet/udp.h> |
#include <netinet/udp_var.h> |
#include <netinet/udp_var.h> |
|
|
|
#ifdef IPSEC_NAT_T |
|
#include <netinet6/ipsec.h> |
|
#include <netinet6/esp.h> |
|
#endif |
|
|
#ifdef INET6 |
#ifdef INET6 |
#include <netinet/ip6.h> |
#include <netinet/ip6.h> |
#include <netinet/icmp6.h> |
#include <netinet/icmp6.h> |
Line 117 __KERNEL_RCSID(0, "$NetBSD$"); |
|
Line 122 __KERNEL_RCSID(0, "$NetBSD$"); |
|
|
|
#ifdef FAST_IPSEC |
#ifdef FAST_IPSEC |
#include <netipsec/ipsec.h> |
#include <netipsec/ipsec.h> |
|
#include <netipsec/ipsec_var.h> /* XXX ipsecstat namespace */ |
#ifdef INET6 |
#ifdef INET6 |
#include <netipsec/ipsec6.h> |
#include <netipsec/ipsec6.h> |
#endif |
#endif |
Line 140 int udpcksum = 1; |
|
Line 146 int udpcksum = 1; |
|
#else |
#else |
int udpcksum = 0; /* XXX */ |
int udpcksum = 0; /* XXX */ |
#endif |
#endif |
|
int udp_do_loopback_cksum = 0; |
|
|
struct inpcbtable udbtable; |
struct inpcbtable udbtable; |
struct udpstat udpstat; |
struct udpstat udpstat; |
|
|
#ifdef INET |
#ifdef INET |
static void udp4_sendup __P((struct mbuf *, int, struct sockaddr *, |
#ifdef IPSEC_NAT_T |
struct socket *)); |
static int udp4_espinudp (struct mbuf *, int, struct sockaddr *, |
static int udp4_realinput __P((struct sockaddr_in *, struct sockaddr_in *, |
struct socket *); |
struct mbuf *, int)); |
#endif |
|
static void udp4_sendup (struct mbuf *, int, struct sockaddr *, |
|
struct socket *); |
|
static int udp4_realinput (struct sockaddr_in *, struct sockaddr_in *, |
|
struct mbuf *, int); |
|
static int udp4_input_checksum(struct mbuf *, const struct udphdr *, int, int); |
#endif |
#endif |
#ifdef INET6 |
#ifdef INET6 |
static void udp6_sendup __P((struct mbuf *, int, struct sockaddr *, |
static void udp6_sendup (struct mbuf *, int, struct sockaddr *, |
struct socket *)); |
struct socket *); |
static int udp6_realinput __P((int, struct sockaddr_in6 *, |
static int udp6_realinput (int, struct sockaddr_in6 *, |
struct sockaddr_in6 *, struct mbuf *, int)); |
struct sockaddr_in6 *, struct mbuf *, int); |
|
static int udp6_input_checksum(struct mbuf *, const struct udphdr *, int, int); |
#endif |
#endif |
#ifdef INET |
#ifdef INET |
static void udp_notify __P((struct inpcb *, int)); |
static void udp_notify (struct inpcb *, int); |
#endif |
#endif |
|
|
#ifndef UDBHASHSIZE |
#ifndef UDBHASHSIZE |
Line 185 struct evcnt udp_swcsum = EVCNT_INITIALI |
|
Line 198 struct evcnt udp_swcsum = EVCNT_INITIALI |
|
|
|
#define UDP_CSUM_COUNTER_INCR(ev) (ev)->ev_count++ |
#define UDP_CSUM_COUNTER_INCR(ev) (ev)->ev_count++ |
|
|
|
EVCNT_ATTACH_STATIC(udp_hwcsum_bad); |
|
EVCNT_ATTACH_STATIC(udp_hwcsum_ok); |
|
EVCNT_ATTACH_STATIC(udp_hwcsum_data); |
|
EVCNT_ATTACH_STATIC(udp_swcsum); |
|
|
#else |
#else |
|
|
#define UDP_CSUM_COUNTER_INCR(ev) /* nothing */ |
#define UDP_CSUM_COUNTER_INCR(ev) /* nothing */ |
Line 192 struct evcnt udp_swcsum = EVCNT_INITIALI |
|
Line 210 struct evcnt udp_swcsum = EVCNT_INITIALI |
|
#endif /* UDP_CSUM_COUNTERS */ |
#endif /* UDP_CSUM_COUNTERS */ |
|
|
void |
void |
udp_init() |
udp_init(void) |
{ |
{ |
|
|
#ifdef INET |
|
in_pcbinit(&udbtable, udbhashsize, udbhashsize); |
in_pcbinit(&udbtable, udbhashsize, udbhashsize); |
#endif |
|
|
|
#ifdef UDP_CSUM_COUNTERS |
|
evcnt_attach_static(&udp_hwcsum_bad); |
|
evcnt_attach_static(&udp_hwcsum_ok); |
|
evcnt_attach_static(&udp_hwcsum_data); |
|
evcnt_attach_static(&udp_swcsum); |
|
#endif /* UDP_CSUM_COUNTERS */ |
|
|
|
MOWNER_ATTACH(&udp_tx_mowner); |
MOWNER_ATTACH(&udp_tx_mowner); |
MOWNER_ATTACH(&udp_rx_mowner); |
MOWNER_ATTACH(&udp_rx_mowner); |
MOWNER_ATTACH(&udp_mowner); |
MOWNER_ATTACH(&udp_mowner); |
} |
} |
|
|
|
/* |
|
* Checksum extended UDP header and data. |
|
*/ |
|
|
|
int |
|
udp_input_checksum(int af, struct mbuf *m, const struct udphdr *uh, |
|
int iphlen, int len) |
|
{ |
|
|
|
switch (af) { |
#ifdef INET |
#ifdef INET |
|
case AF_INET: |
|
return udp4_input_checksum(m, uh, iphlen, len); |
|
#endif |
|
#ifdef INET6 |
|
case AF_INET6: |
|
return udp6_input_checksum(m, uh, iphlen, len); |
|
#endif |
|
} |
|
#ifdef DIAGNOSTIC |
|
panic("udp_input_checksum: unknown af %d", af); |
|
#endif |
|
/* NOTREACHED */ |
|
return -1; |
|
} |
|
|
|
#ifdef INET |
|
|
|
/* |
|
* Checksum extended UDP header and data. |
|
*/ |
|
|
|
static int |
|
udp4_input_checksum(struct mbuf *m, const struct udphdr *uh, |
|
int iphlen, int len) |
|
{ |
|
|
|
/* |
|
* XXX it's better to record and check if this mbuf is |
|
* already checked. |
|
*/ |
|
|
|
if (uh->uh_sum == 0) |
|
return 0; |
|
|
|
switch (m->m_pkthdr.csum_flags & |
|
((m->m_pkthdr.rcvif->if_csum_flags_rx & M_CSUM_UDPv4) | |
|
M_CSUM_TCP_UDP_BAD | M_CSUM_DATA)) { |
|
case M_CSUM_UDPv4|M_CSUM_TCP_UDP_BAD: |
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_bad); |
|
goto badcsum; |
|
|
|
case M_CSUM_UDPv4|M_CSUM_DATA: { |
|
u_int32_t hw_csum = m->m_pkthdr.csum_data; |
|
|
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_data); |
|
if (m->m_pkthdr.csum_flags & M_CSUM_NO_PSEUDOHDR) { |
|
const struct ip *ip = |
|
mtod(m, const struct ip *); |
|
|
|
hw_csum = in_cksum_phdr(ip->ip_src.s_addr, |
|
ip->ip_dst.s_addr, |
|
htons(hw_csum + len + IPPROTO_UDP)); |
|
} |
|
if ((hw_csum ^ 0xffff) != 0) |
|
goto badcsum; |
|
break; |
|
} |
|
|
|
case M_CSUM_UDPv4: |
|
/* Checksum was okay. */ |
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_ok); |
|
break; |
|
|
|
default: |
|
/* |
|
* Need to compute it ourselves. Maybe skip checksum |
|
* on loopback interfaces. |
|
*/ |
|
if (__predict_true(!(m->m_pkthdr.rcvif->if_flags & |
|
IFF_LOOPBACK) || |
|
udp_do_loopback_cksum)) { |
|
UDP_CSUM_COUNTER_INCR(&udp_swcsum); |
|
if (in4_cksum(m, IPPROTO_UDP, iphlen, len) != 0) |
|
goto badcsum; |
|
} |
|
break; |
|
} |
|
|
|
return 0; |
|
|
|
badcsum: |
|
udpstat.udps_badsum++; |
|
return -1; |
|
} |
|
|
void |
void |
#if __STDC__ |
|
udp_input(struct mbuf *m, ...) |
udp_input(struct mbuf *m, ...) |
#else |
|
udp_input(m, va_alist) |
|
struct mbuf *m; |
|
va_dcl |
|
#endif |
|
{ |
{ |
va_list ap; |
va_list ap; |
struct sockaddr_in src, dst; |
struct sockaddr_in src, dst; |
Line 270 udp_input(m, va_alist) |
|
Line 368 udp_input(m, va_alist) |
|
/* |
/* |
* Checksum extended UDP header and data. |
* Checksum extended UDP header and data. |
*/ |
*/ |
if (uh->uh_sum) { |
if (udp4_input_checksum(m, uh, iphlen, len)) |
switch (m->m_pkthdr.csum_flags & |
goto badcsum; |
((m->m_pkthdr.rcvif->if_csum_flags_rx & M_CSUM_UDPv4) | |
|
M_CSUM_TCP_UDP_BAD | M_CSUM_DATA)) { |
|
case M_CSUM_UDPv4|M_CSUM_TCP_UDP_BAD: |
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_bad); |
|
goto badcsum; |
|
|
|
case M_CSUM_UDPv4|M_CSUM_DATA: { |
|
u_int32_t hw_csum = m->m_pkthdr.csum_data; |
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_data); |
|
if (m->m_pkthdr.csum_flags & M_CSUM_NO_PSEUDOHDR) |
|
hw_csum = in_cksum_phdr(ip->ip_src.s_addr, ip->ip_dst.s_addr, |
|
htonl(hw_csum + ntohs(ip->ip_len) + IPPROTO_UDP)); |
|
if ((hw_csum ^ 0xffff) != 0) |
|
goto badcsum; |
|
break; |
|
} |
|
|
|
case M_CSUM_UDPv4: |
|
/* Checksum was okay. */ |
|
UDP_CSUM_COUNTER_INCR(&udp_hwcsum_ok); |
|
break; |
|
|
|
default: |
|
/* Need to compute it ourselves. */ |
|
UDP_CSUM_COUNTER_INCR(&udp_swcsum); |
|
if (in4_cksum(m, IPPROTO_UDP, iphlen, len) != 0) |
|
goto badcsum; |
|
break; |
|
} |
|
} |
|
|
|
/* construct source and dst sockaddrs. */ |
/* construct source and dst sockaddrs. */ |
bzero(&src, sizeof(src)); |
bzero(&src, sizeof(src)); |
|
|
|
|
badcsum: |
badcsum: |
m_freem(m); |
m_freem(m); |
udpstat.udps_badsum++; |
|
} |
} |
#endif |
#endif |
|
|
#ifdef INET6 |
#ifdef INET6 |
|
static int |
|
udp6_input_checksum(struct mbuf *m, const struct udphdr *uh, int off, int len) |
|
{ |
|
|
|
if (__predict_false((m->m_flags & M_LOOP) && !udp_do_loopback_cksum)) { |
|
goto good; |
|
} |
|
if (uh->uh_sum == 0) { |
|
udp6stat.udp6s_nosum++; |
|
goto bad; |
|
} |
|
if (in6_cksum(m, IPPROTO_UDP, off, len) != 0) { |
|
udp6stat.udp6s_badsum++; |
|
goto bad; |
|
} |
|
|
|
good: |
|
return 0; |
|
bad: |
|
return -1; |
|
} |
|
|
int |
int |
udp6_input(mp, offp, proto) |
udp6_input(struct mbuf **mp, int *offp, int proto) |
struct mbuf **mp; |
|
int *offp, proto; |
|
{ |
{ |
struct mbuf *m = *mp; |
struct mbuf *m = *mp; |
int off = *offp; |
int off = *offp; |
Line 429 udp6_input(mp, offp, proto) |
|
Line 516 udp6_input(mp, offp, proto) |
|
} |
} |
|
|
/* |
/* |
* Checksum extended UDP header and data. |
* Checksum extended UDP header and data. Maybe skip checksum |
|
* on loopback interfaces. |
*/ |
*/ |
if (uh->uh_sum == 0) |
if (udp6_input_checksum(m, uh, off, ulen)) |
udp6stat.udp6s_nosum++; |
|
else if (in6_cksum(m, IPPROTO_UDP, off, ulen) != 0) { |
|
udp6stat.udp6s_badsum++; |
|
goto bad; |
goto bad; |
} |
|
|
|
/* |
/* |
* Construct source and dst sockaddrs. |
* Construct source and dst sockaddrs. |
|
|
|
|
#ifdef INET |
#ifdef INET |
static void |
static void |
udp4_sendup(m, off, src, so) |
udp4_sendup(struct mbuf *m, int off /* offset of data portion */, |
struct mbuf *m; |
struct sockaddr *src, struct socket *so) |
int off; /* offset of data portion */ |
|
struct sockaddr *src; |
|
struct socket *so; |
|
{ |
{ |
struct mbuf *opts = NULL; |
struct mbuf *opts = NULL; |
struct mbuf *n; |
struct mbuf *n; |
Line 502 udp4_sendup(m, off, src, so) |
|
Line 583 udp4_sendup(m, off, src, so) |
|
/* check AH/ESP integrity. */ |
/* check AH/ESP integrity. */ |
if (so != NULL && ipsec4_in_reject_so(m, so)) { |
if (so != NULL && ipsec4_in_reject_so(m, so)) { |
ipsecstat.in_polvio++; |
ipsecstat.in_polvio++; |
|
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) |
|
icmp_error(n, ICMP_UNREACH, ICMP_UNREACH_ADMIN_PROHIBIT, |
|
0, 0); |
return; |
return; |
} |
} |
#endif /*IPSEC*/ |
#endif /*IPSEC*/ |
Line 519 udp4_sendup(m, off, src, so) |
|
Line 603 udp4_sendup(m, off, src, so) |
|
m_freem(n); |
m_freem(n); |
if (opts) |
if (opts) |
m_freem(opts); |
m_freem(opts); |
|
so->so_rcv.sb_overflowed++; |
udpstat.udps_fullsock++; |
udpstat.udps_fullsock++; |
} else |
} else |
sorwakeup(so); |
sorwakeup(so); |
Line 528 udp4_sendup(m, off, src, so) |
|
Line 613 udp4_sendup(m, off, src, so) |
|
|
|
#ifdef INET6 |
#ifdef INET6 |
static void |
static void |
udp6_sendup(m, off, src, so) |
udp6_sendup(struct mbuf *m, int off /* offset of data portion */, |
struct mbuf *m; |
struct sockaddr *src, struct socket *so) |
int off; /* offset of data portion */ |
|
struct sockaddr *src; |
|
struct socket *so; |
|
{ |
{ |
struct mbuf *opts = NULL; |
struct mbuf *opts = NULL; |
struct mbuf *n; |
struct mbuf *n; |
Line 548 udp6_sendup(m, off, src, so) |
|
Line 630 udp6_sendup(m, off, src, so) |
|
/* check AH/ESP integrity. */ |
/* check AH/ESP integrity. */ |
if (so != NULL && ipsec6_in_reject_so(m, so)) { |
if (so != NULL && ipsec6_in_reject_so(m, so)) { |
ipsec6stat.in_polvio++; |
ipsec6stat.in_polvio++; |
|
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) |
|
icmp6_error(n, ICMP6_DST_UNREACH, |
|
ICMP6_DST_UNREACH_ADMIN, 0); |
return; |
return; |
} |
} |
#endif /*IPSEC*/ |
#endif /*IPSEC*/ |
Line 564 udp6_sendup(m, off, src, so) |
|
Line 649 udp6_sendup(m, off, src, so) |
|
m_freem(n); |
m_freem(n); |
if (opts) |
if (opts) |
m_freem(opts); |
m_freem(opts); |
|
so->so_rcv.sb_overflowed++; |
udp6stat.udp6s_fullsock++; |
udp6stat.udp6s_fullsock++; |
} else |
} else |
sorwakeup(so); |
sorwakeup(so); |
Line 573 udp6_sendup(m, off, src, so) |
|
Line 659 udp6_sendup(m, off, src, so) |
|
|
|
#ifdef INET |
#ifdef INET |
static int |
static int |
udp4_realinput(src, dst, m, off) |
udp4_realinput(struct sockaddr_in *src, struct sockaddr_in *dst, |
struct sockaddr_in *src; |
struct mbuf *m, int off /* offset of udphdr */) |
struct sockaddr_in *dst; |
|
struct mbuf *m; |
|
int off; /* offset of udphdr */ |
|
{ |
{ |
u_int16_t *sport, *dport; |
u_int16_t *sport, *dport; |
int rcvcnt; |
int rcvcnt; |
struct in_addr *src4, *dst4; |
struct in_addr *src4, *dst4; |
|
struct inpcb_hdr *inph; |
struct inpcb *inp; |
struct inpcb *inp; |
|
|
rcvcnt = 0; |
rcvcnt = 0; |
Line 620 udp4_realinput(src, dst, m, off) |
|
Line 704 udp4_realinput(src, dst, m, off) |
|
/* |
/* |
* Locate pcb(s) for datagram. |
* Locate pcb(s) for datagram. |
*/ |
*/ |
CIRCLEQ_FOREACH(inp, &udbtable.inpt_queue, inp_queue) { |
CIRCLEQ_FOREACH(inph, &udbtable.inpt_queue, inph_queue) { |
|
inp = (struct inpcb *)inph; |
|
if (inp->inp_af != AF_INET) |
|
continue; |
|
|
if (inp->inp_lport != *dport) |
if (inp->inp_lport != *dport) |
continue; |
continue; |
if (!in_nullhost(inp->inp_laddr)) { |
if (!in_nullhost(inp->inp_laddr)) { |
Line 661 udp4_realinput(src, dst, m, off) |
|
Line 749 udp4_realinput(src, dst, m, off) |
|
return rcvcnt; |
return rcvcnt; |
} |
} |
|
|
|
#ifdef IPSEC_NAT_T |
|
/* Handle ESP over UDP */ |
|
if (inp->inp_flags & INP_ESPINUDP_ALL) { |
|
struct sockaddr *sa = (struct sockaddr *)src; |
|
|
|
if (udp4_espinudp(m, off, sa, inp->inp_socket) != 0) { |
|
rcvcnt++; |
|
goto bad; |
|
} |
|
|
|
/* Normal UDP processing will take place */ |
|
} |
|
#endif |
|
|
udp4_sendup(m, off, (struct sockaddr *)src, inp->inp_socket); |
udp4_sendup(m, off, (struct sockaddr *)src, inp->inp_socket); |
rcvcnt++; |
rcvcnt++; |
} |
} |
|
|
|
|
#ifdef INET6 |
#ifdef INET6 |
static int |
static int |
udp6_realinput(af, src, dst, m, off) |
udp6_realinput(int af, struct sockaddr_in6 *src, struct sockaddr_in6 *dst, |
int af; /* af on packet */ |
struct mbuf *m, int off) |
struct sockaddr_in6 *src; |
|
struct sockaddr_in6 *dst; |
|
struct mbuf *m; |
|
int off; /* offset of udphdr */ |
|
{ |
{ |
u_int16_t sport, dport; |
u_int16_t sport, dport; |
int rcvcnt; |
int rcvcnt; |
struct in6_addr src6, dst6; |
struct in6_addr src6, dst6; |
const struct in_addr *dst4; |
const struct in_addr *dst4; |
|
struct inpcb_hdr *inph; |
struct in6pcb *in6p; |
struct in6pcb *in6p; |
|
|
rcvcnt = 0; |
rcvcnt = 0; |
Line 724 udp6_realinput(af, src, dst, m, off) |
|
Line 823 udp6_realinput(af, src, dst, m, off) |
|
/* |
/* |
* Locate pcb(s) for datagram. |
* Locate pcb(s) for datagram. |
*/ |
*/ |
for (in6p = udb6.in6p_next; in6p != &udb6; |
CIRCLEQ_FOREACH(inph, &udbtable.inpt_queue, inph_queue) { |
in6p = in6p->in6p_next) { |
in6p = (struct in6pcb *)inph; |
|
if (in6p->in6p_af != AF_INET6) |
|
continue; |
|
|
if (in6p->in6p_lport != dport) |
if (in6p->in6p_lport != dport) |
continue; |
continue; |
if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) { |
if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) { |
Line 766 udp6_realinput(af, src, dst, m, off) |
|
Line 868 udp6_realinput(af, src, dst, m, off) |
|
/* |
/* |
* Locate pcb for datagram. |
* Locate pcb for datagram. |
*/ |
*/ |
in6p = in6_pcblookup_connect(&udb6, &src6, sport, |
in6p = in6_pcblookup_connect(&udbtable, &src6, sport, |
&dst6, dport, 0); |
&dst6, dport, 0); |
if (in6p == 0) { |
if (in6p == 0) { |
++udpstat.udps_pcbhashmiss; |
++udpstat.udps_pcbhashmiss; |
in6p = in6_pcblookup_bind(&udb6, &dst6, dport, 0); |
in6p = in6_pcblookup_bind(&udbtable, &dst6, dport, 0); |
if (in6p == 0) |
if (in6p == 0) |
return rcvcnt; |
return rcvcnt; |
} |
} |
|
|
* just wake up so that he can collect error status. |
* just wake up so that he can collect error status. |
*/ |
*/ |
static void |
static void |
udp_notify(inp, errno) |
udp_notify(struct inpcb *inp, int errno) |
struct inpcb *inp; |
|
int errno; |
|
{ |
{ |
|
|
inp->inp_socket->so_error = errno; |
inp->inp_socket->so_error = errno; |
sorwakeup(inp->inp_socket); |
sorwakeup(inp->inp_socket); |
sowwakeup(inp->inp_socket); |
sowwakeup(inp->inp_socket); |
} |
} |
|
|
void * |
void * |
udp_ctlinput(cmd, sa, v) |
udp_ctlinput(int cmd, struct sockaddr *sa, void *v) |
int cmd; |
|
struct sockaddr *sa; |
|
void *v; |
|
{ |
{ |
struct ip *ip = v; |
struct ip *ip = v; |
struct udphdr *uh; |
struct udphdr *uh; |
void (*notify) __P((struct inpcb *, int)) = udp_notify; |
void (*notify)(struct inpcb *, int) = udp_notify; |
int errno; |
int errno; |
|
|
if (sa->sa_family != AF_INET |
if (sa->sa_family != AF_INET |
Line 836 udp_ctlinput(cmd, sa, v) |
|
Line 932 udp_ctlinput(cmd, sa, v) |
|
} |
} |
|
|
int |
int |
#if __STDC__ |
udp_ctloutput(op, so, level, optname, mp) |
udp_output(struct mbuf *m, ...) |
int op; |
#else |
struct socket *so; |
udp_output(m, va_alist) |
int level, optname; |
|
struct mbuf **mp; |
|
{ |
|
int s; |
|
int error = 0; |
struct mbuf *m; |
struct mbuf *m; |
va_dcl |
struct inpcb *inp; |
|
int family; |
|
|
|
family = so->so_proto->pr_domain->dom_family; |
|
|
|
s = splsoftnet(); |
|
switch (family) { |
|
#ifdef INET |
|
case PF_INET: |
|
if (level != IPPROTO_UDP) { |
|
error = ip_ctloutput(op, so, level, optname, mp); |
|
goto end; |
|
} |
|
break; |
|
#endif |
|
#ifdef INET6 |
|
case PF_INET6: |
|
if (level != IPPROTO_UDP) { |
|
error = ip6_ctloutput(op, so, level, optname, mp); |
|
goto end; |
|
} |
|
break; |
#endif |
#endif |
|
default: |
|
error = EAFNOSUPPORT; |
|
goto end; |
|
break; |
|
} |
|
|
|
|
|
switch (op) { |
|
case PRCO_SETOPT: |
|
m = *mp; |
|
inp = sotoinpcb(so); |
|
|
|
switch (optname) { |
|
case UDP_ENCAP: |
|
if (m == NULL || m->m_len < sizeof (int)) { |
|
error = EINVAL; |
|
goto end; |
|
} |
|
|
|
switch(*mtod(m, int *)) { |
|
#ifdef IPSEC_NAT_T |
|
case 0: |
|
inp->inp_flags &= ~INP_ESPINUDP_ALL; |
|
break; |
|
|
|
case UDP_ENCAP_ESPINUDP: |
|
inp->inp_flags &= ~INP_ESPINUDP_ALL; |
|
inp->inp_flags |= INP_ESPINUDP; |
|
break; |
|
|
|
case UDP_ENCAP_ESPINUDP_NON_IKE: |
|
inp->inp_flags &= ~INP_ESPINUDP_ALL; |
|
inp->inp_flags |= INP_ESPINUDP_NON_IKE; |
|
break; |
|
#endif |
|
default: |
|
error = EINVAL; |
|
goto end; |
|
break; |
|
} |
|
break; |
|
|
|
default: |
|
error = ENOPROTOOPT; |
|
goto end; |
|
break; |
|
} |
|
break; |
|
|
|
default: |
|
error = EINVAL; |
|
goto end; |
|
break; |
|
} |
|
|
|
end: |
|
splx(s); |
|
return error; |
|
} |
|
|
|
|
|
int |
|
udp_output(struct mbuf *m, ...) |
{ |
{ |
struct inpcb *inp; |
struct inpcb *inp; |
struct udpiphdr *ui; |
struct udpiphdr *ui; |
|
struct route *ro; |
int len = m->m_pkthdr.len; |
int len = m->m_pkthdr.len; |
int error = 0; |
int error = 0; |
va_list ap; |
va_list ap; |
Line 886 udp_output(m, va_alist) |
|
Line 1071 udp_output(m, va_alist) |
|
ui->ui_dport = inp->inp_fport; |
ui->ui_dport = inp->inp_fport; |
ui->ui_ulen = htons((u_int16_t)len + sizeof(struct udphdr)); |
ui->ui_ulen = htons((u_int16_t)len + sizeof(struct udphdr)); |
|
|
|
ro = &inp->inp_route; |
|
|
/* |
/* |
* Set up checksum and output datagram. |
* Set up checksum and output datagram. |
*/ |
*/ |
Line 893 udp_output(m, va_alist) |
|
Line 1080 udp_output(m, va_alist) |
|
/* |
/* |
* XXX Cache pseudo-header checksum part for |
* XXX Cache pseudo-header checksum part for |
* XXX "connected" UDP sockets. |
* XXX "connected" UDP sockets. |
|
* Maybe skip checksums on loopback interfaces. |
*/ |
*/ |
ui->ui_sum = in_cksum_phdr(ui->ui_src.s_addr, |
ui->ui_sum = in_cksum_phdr(ui->ui_src.s_addr, |
ui->ui_dst.s_addr, htons((u_int16_t)len + |
ui->ui_dst.s_addr, htons((u_int16_t)len + |
sizeof(struct udphdr) + IPPROTO_UDP)); |
sizeof(struct udphdr) + IPPROTO_UDP)); |
m->m_pkthdr.csum_flags = M_CSUM_UDPv4; |
if (__predict_true(ro->ro_rt == NULL || |
|
!(ro->ro_rt->rt_ifp->if_flags & |
|
IFF_LOOPBACK) || |
|
udp_do_loopback_cksum)) |
|
m->m_pkthdr.csum_flags = M_CSUM_UDPv4; |
|
else |
|
m->m_pkthdr.csum_flags = 0; |
m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum); |
m->m_pkthdr.csum_data = offsetof(struct udphdr, uh_sum); |
} else |
} else |
ui->ui_sum = 0; |
ui->ui_sum = 0; |
Line 906 udp_output(m, va_alist) |
|
Line 1100 udp_output(m, va_alist) |
|
((struct ip *)ui)->ip_tos = inp->inp_ip.ip_tos; /* XXX */ |
((struct ip *)ui)->ip_tos = inp->inp_ip.ip_tos; /* XXX */ |
udpstat.udps_opackets++; |
udpstat.udps_opackets++; |
|
|
#ifdef IPSEC |
return (ip_output(m, inp->inp_options, ro, |
if (ipsec_setsocket(m, inp->inp_socket) != 0) { |
|
error = ENOBUFS; |
|
goto release; |
|
} |
|
#endif /*IPSEC*/ |
|
|
|
return (ip_output(m, inp->inp_options, &inp->inp_route, |
|
inp->inp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST), |
inp->inp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST), |
inp->inp_moptions, inp->inp_socket)); |
inp->inp_moptions, inp->inp_socket)); |
|
|
Line 928 int udp_recvspace = 40 * (1024 + sizeof( |
|
Line 1115 int udp_recvspace = 40 * (1024 + sizeof( |
|
|
|
/*ARGSUSED*/ |
/*ARGSUSED*/ |
int |
int |
udp_usrreq(so, req, m, nam, control, p) |
udp_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam, |
struct socket *so; |
struct mbuf *control, struct proc *p) |
int req; |
|
struct mbuf *m, *nam, *control; |
|
struct proc *p; |
|
{ |
{ |
struct inpcb *inp; |
struct inpcb *inp; |
int s; |
int s; |
Line 1016 udp_usrreq(so, req, m, nam, control, p) |
|
Line 1200 udp_usrreq(so, req, m, nam, control, p) |
|
so->so_state &= ~SS_ISCONNECTED; /* XXX */ |
so->so_state &= ~SS_ISCONNECTED; /* XXX */ |
in_pcbdisconnect(inp); |
in_pcbdisconnect(inp); |
inp->inp_laddr = zeroin_addr; /* XXX */ |
inp->inp_laddr = zeroin_addr; /* XXX */ |
if (inp->inp_ia != NULL) { |
|
LIST_REMOVE(inp, inp_ialink); |
|
IFAFREE(&inp->inp_ia->ia_ifa); |
|
inp->inp_ia = NULL; |
|
} |
|
in_pcbstate(inp, INP_BOUND); /* XXX */ |
in_pcbstate(inp, INP_BOUND); /* XXX */ |
break; |
break; |
|
|
Line 1065 udp_usrreq(so, req, m, nam, control, p) |
|
Line 1244 udp_usrreq(so, req, m, nam, control, p) |
|
in_pcbstate(inp, INP_BOUND); /* XXX */ |
in_pcbstate(inp, INP_BOUND); /* XXX */ |
} |
} |
die: |
die: |
if (inp->inp_ia != NULL && in_nullhost(inp->inp_laddr)) { |
|
LIST_REMOVE(inp, inp_ialink); |
|
IFAFREE(&inp->inp_ia->ia_ifa); |
|
inp->inp_ia = NULL; |
|
} |
|
if (m) |
if (m) |
m_freem(m); |
m_freem(m); |
} |
} |
|
|
/* |
/* |
* Sysctl for udp variables. |
* Sysctl for udp variables. |
*/ |
*/ |
int |
SYSCTL_SETUP(sysctl_net_inet_udp_setup, "sysctl net.inet.udp subtree setup") |
udp_sysctl(name, namelen, oldp, oldlenp, newp, newlen) |
|
int *name; |
|
u_int namelen; |
|
void *oldp; |
|
size_t *oldlenp; |
|
void *newp; |
|
size_t newlen; |
|
{ |
{ |
/* All sysctl names at this level are terminal. */ |
|
if (namelen != 1) |
sysctl_createv(clog, 0, NULL, NULL, |
return (ENOTDIR); |
CTLFLAG_PERMANENT, |
|
CTLTYPE_NODE, "net", NULL, |
switch (name[0]) { |
NULL, 0, NULL, 0, |
case UDPCTL_CHECKSUM: |
CTL_NET, CTL_EOL); |
return (sysctl_int(oldp, oldlenp, newp, newlen, &udpcksum)); |
sysctl_createv(clog, 0, NULL, NULL, |
case UDPCTL_SENDSPACE: |
CTLFLAG_PERMANENT, |
return (sysctl_int(oldp, oldlenp, newp, newlen, |
CTLTYPE_NODE, "inet", NULL, |
&udp_sendspace)); |
NULL, 0, NULL, 0, |
case UDPCTL_RECVSPACE: |
CTL_NET, PF_INET, CTL_EOL); |
return (sysctl_int(oldp, oldlenp, newp, newlen, |
sysctl_createv(clog, 0, NULL, NULL, |
&udp_recvspace)); |
CTLFLAG_PERMANENT, |
default: |
CTLTYPE_NODE, "udp", |
return (ENOPROTOOPT); |
SYSCTL_DESCR("UDPv4 related settings"), |
|
NULL, 0, NULL, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, CTL_EOL); |
|
|
|
sysctl_createv(clog, 0, NULL, NULL, |
|
CTLFLAG_PERMANENT|CTLFLAG_READWRITE, |
|
CTLTYPE_INT, "checksum", |
|
SYSCTL_DESCR("Compute UDP checksums"), |
|
NULL, 0, &udpcksum, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_CHECKSUM, |
|
CTL_EOL); |
|
sysctl_createv(clog, 0, NULL, NULL, |
|
CTLFLAG_PERMANENT|CTLFLAG_READWRITE, |
|
CTLTYPE_INT, "sendspace", |
|
SYSCTL_DESCR("Default UDP send buffer size"), |
|
NULL, 0, &udp_sendspace, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_SENDSPACE, |
|
CTL_EOL); |
|
sysctl_createv(clog, 0, NULL, NULL, |
|
CTLFLAG_PERMANENT|CTLFLAG_READWRITE, |
|
CTLTYPE_INT, "recvspace", |
|
SYSCTL_DESCR("Default UDP receive buffer size"), |
|
NULL, 0, &udp_recvspace, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_RECVSPACE, |
|
CTL_EOL); |
|
sysctl_createv(clog, 0, NULL, NULL, |
|
CTLFLAG_PERMANENT|CTLFLAG_READWRITE, |
|
CTLTYPE_INT, "do_loopback_cksum", |
|
SYSCTL_DESCR("Perform UDP checksum on loopback"), |
|
NULL, 0, &udp_do_loopback_cksum, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_LOOPBACKCKSUM, |
|
CTL_EOL); |
|
sysctl_createv(clog, 0, NULL, NULL, |
|
CTLFLAG_PERMANENT, |
|
CTLTYPE_STRUCT, "pcblist", |
|
SYSCTL_DESCR("UDP protocol control block list"), |
|
sysctl_inpcblist, 0, &udbtable, 0, |
|
CTL_NET, PF_INET, IPPROTO_UDP, CTL_CREATE, |
|
CTL_EOL); |
|
} |
|
#endif |
|
|
|
#if (defined INET && defined IPSEC_NAT_T) |
|
/* |
|
* Returns: |
|
* 1 if the packet was processed |
|
* 0 if normal UDP processing should take place |
|
*/ |
|
static int |
|
udp4_espinudp(m, off, src, so) |
|
struct mbuf *m; |
|
int off; |
|
struct sockaddr *src; |
|
struct socket *so; |
|
{ |
|
size_t len; |
|
caddr_t data; |
|
struct inpcb *inp; |
|
size_t skip = 0; |
|
size_t minlen; |
|
size_t iphdrlen; |
|
struct ip *ip; |
|
struct mbuf *n; |
|
|
|
/* |
|
* Collapse the mbuf chain if the first mbuf is too short |
|
* The longest case is: UDP + non ESP marker + ESP |
|
*/ |
|
minlen = off + sizeof(u_int64_t) + sizeof(struct esp); |
|
if (minlen > m->m_pkthdr.len) |
|
minlen = m->m_pkthdr.len; |
|
|
|
if (m->m_len < minlen) { |
|
if ((m = m_pullup(m, minlen)) == NULL) { |
|
printf("udp4_espinudp: m_pullup failed\n"); |
|
return 0; |
|
} |
} |
} |
/* NOTREACHED */ |
|
|
len = m->m_len - off; |
|
data = mtod(m, caddr_t) + off; |
|
inp = sotoinpcb(so); |
|
|
|
/* Ignore keepalive packets */ |
|
if ((len == 1) && (data[0] == '\xff')) { |
|
return 1; |
|
} |
|
|
|
/* |
|
* Check that the payload is long enough to hold |
|
* an ESP header and compute the length of encapsulation |
|
* header to remove |
|
*/ |
|
if (inp->inp_flags & INP_ESPINUDP) { |
|
u_int32_t *st = (u_int32_t *)data; |
|
|
|
if ((len <= sizeof(struct esp)) || (*st == 0)) |
|
return 0; /* Normal UDP processing */ |
|
|
|
skip = sizeof(struct udphdr); |
|
} |
|
|
|
if (inp->inp_flags & INP_ESPINUDP_NON_IKE) { |
|
u_int64_t *st = (u_int64_t *)data; |
|
|
|
if ((len <= sizeof(u_int64_t) + sizeof(struct esp)) |
|
|| (*st != 0)) |
|
return 0; /* Normal UDP processing */ |
|
|
|
skip = sizeof(struct udphdr) + sizeof(u_int64_t); |
|
} |
|
|
|
/* |
|
* Remove the UDP header (and possibly the non ESP marker) |
|
* IP header lendth is iphdrlen |
|
* Before: |
|
* <--- off ---> |
|
* +----+------+-----+ |
|
* | IP | UDP | ESP | |
|
* +----+------+-----+ |
|
* <-skip-> |
|
* After: |
|
* +----+-----+ |
|
* | IP | ESP | |
|
* +----+-----+ |
|
* <-skip-> |
|
*/ |
|
iphdrlen = off - sizeof(struct udphdr); |
|
memmove(mtod(m, caddr_t) + skip, mtod(m, caddr_t), iphdrlen); |
|
m_adj(m, skip); |
|
|
|
ip = mtod(m, struct ip *); |
|
ip->ip_len = htons(ntohs(ip->ip_len) - skip); |
|
ip->ip_p = IPPROTO_ESP; |
|
|
|
/* |
|
* Copy the mbuf to avoid multiple free, as both |
|
* esp4_input (which we call) and udp_input (which |
|
* called us) free the mbuf. |
|
*/ |
|
if ((n = m_dup(m, 0, M_COPYALL, M_DONTWAIT)) == NULL) { |
|
printf("udp4_espinudp: m_dup failed\n"); |
|
return 0; |
|
} |
|
|
|
esp4_input(n, iphdrlen); |
|
|
|
/* We handled it, it shoudln't be handled by UDP */ |
|
return 1; |
} |
} |
#endif |
#endif |