version 1.10, 1994/01/10 20:14:34 |
version 1.22, 1995/06/18 20:01:19 |
|
|
|
/* $NetBSD$ */ |
|
|
/* |
/* |
* Copyright (c) 1982, 1986, 1988, 1990 Regents of the University of California. |
* Copyright (c) 1982, 1986, 1988, 1990, 1993 |
* All rights reserved. |
* The Regents of the University of California. All rights reserved. |
* |
* |
* Redistribution and use in source and binary forms, with or without |
* Redistribution and use in source and binary forms, with or without |
* modification, are permitted provided that the following conditions |
* modification, are permitted provided that the following conditions |
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
* SUCH DAMAGE. |
* SUCH DAMAGE. |
* |
* |
* from: @(#)udp_usrreq.c 7.20 (Berkeley) 4/20/91 |
* @(#)udp_usrreq.c 8.4 (Berkeley) 1/21/94 |
* $Id$ |
|
*/ |
*/ |
|
|
#include <sys/param.h> |
#include <sys/param.h> |
|
|
#include <sys/protosw.h> |
#include <sys/protosw.h> |
#include <sys/socket.h> |
#include <sys/socket.h> |
#include <sys/socketvar.h> |
#include <sys/socketvar.h> |
|
#include <sys/errno.h> |
#include <sys/stat.h> |
#include <sys/stat.h> |
|
|
#include <net/if.h> |
#include <net/if.h> |
|
|
|
|
#include <netinet/in.h> |
#include <netinet/in.h> |
#include <netinet/in_systm.h> |
#include <netinet/in_systm.h> |
|
#include <netinet/in_var.h> |
#include <netinet/ip.h> |
#include <netinet/ip.h> |
#include <netinet/in_pcb.h> |
#include <netinet/in_pcb.h> |
#include <netinet/ip_var.h> |
#include <netinet/ip_var.h> |
Line 63 int udpcksum = 1; |
|
Line 66 int udpcksum = 1; |
|
#else |
#else |
int udpcksum = 0; /* XXX */ |
int udpcksum = 0; /* XXX */ |
#endif |
#endif |
int udp_ttl = UDP_TTL; |
|
|
|
struct sockaddr_in udp_in = { sizeof(udp_in), AF_INET }; |
struct sockaddr_in udp_in = { sizeof(udp_in), AF_INET }; |
struct inpcb *udp_last_inpcb = &udb; |
struct inpcb *udp_last_inpcb = 0; |
|
|
static void udp_detach __P((struct inpcb *)); |
static void udp_detach __P((struct inpcb *)); |
static void udp_notify __P((struct inpcb *, int)); |
static void udp_notify __P((struct inpcb *, int)); |
static struct mbuf * |
static struct mbuf *udp_saveopt __P((caddr_t, int, int)); |
udp_saveopt __P((caddr_t, int, int)); |
|
|
|
void |
void |
udp_init() |
udp_init() |
{ |
{ |
|
|
udb.inp_next = udb.inp_prev = &udb; |
in_pcbinit(&udbtable); |
} |
} |
|
|
void |
void |
Line 122 udp_input(m, iphlen) |
|
Line 123 udp_input(m, iphlen) |
|
* Make mbuf data length reflect UDP length. |
* Make mbuf data length reflect UDP length. |
* If not enough data to reflect UDP length, drop. |
* If not enough data to reflect UDP length, drop. |
*/ |
*/ |
len = ntohs((u_short)uh->uh_ulen); |
len = ntohs((u_int16_t)uh->uh_ulen); |
if (ip->ip_len != len) { |
if (ip->ip_len != len) { |
if (len > ip->ip_len) { |
if (len > ip->ip_len) { |
udpstat.udps_badlen++; |
udpstat.udps_badlen++; |
Line 151 udp_input(m, iphlen) |
|
Line 152 udp_input(m, iphlen) |
|
return; |
return; |
} |
} |
} |
} |
#ifdef MULTICAST |
|
if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) || |
if (IN_MULTICAST(ip->ip_dst.s_addr) || |
in_broadcast(ip->ip_dst)) { |
in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) { |
struct socket *last; |
struct socket *last; |
/* |
/* |
* Deliver a multicast or broadcast datagram to *all* sockets |
* Deliver a multicast or broadcast datagram to *all* sockets |
Line 168 udp_input(m, iphlen) |
|
Line 169 udp_input(m, iphlen) |
|
* Those applications open the multiple sockets to overcome an |
* Those applications open the multiple sockets to overcome an |
* inadequacy of the UDP socket interface, but for backwards |
* inadequacy of the UDP socket interface, but for backwards |
* compatibility we avoid the problem here rather than |
* compatibility we avoid the problem here rather than |
* fixing the interface. Maybe 4.4BSD will remedy this?) |
* fixing the interface. Maybe 4.5BSD will remedy this?) |
*/ |
*/ |
|
|
/* |
/* |
* Construct sockaddr format source address. |
* Construct sockaddr format source address. |
*/ |
*/ |
Line 182 udp_input(m, iphlen) |
|
Line 184 udp_input(m, iphlen) |
|
* (Algorithm copied from raw_intr().) |
* (Algorithm copied from raw_intr().) |
*/ |
*/ |
last = NULL; |
last = NULL; |
for (inp = udb.inp_next; inp != &udb; inp = inp->inp_next) { |
for (inp = udbtable.inpt_queue.cqh_first; |
|
inp != (struct inpcb *)&udbtable.inpt_queue; |
|
inp = inp->inp_queue.cqe_next) { |
if (inp->inp_lport != uh->uh_dport) |
if (inp->inp_lport != uh->uh_dport) |
continue; |
continue; |
if (inp->inp_laddr.s_addr != INADDR_ANY) { |
if (inp->inp_laddr.s_addr != INADDR_ANY) { |
Line 202 udp_input(m, iphlen) |
|
Line 206 udp_input(m, iphlen) |
|
|
|
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { |
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { |
if (sbappendaddr(&last->so_rcv, |
if (sbappendaddr(&last->so_rcv, |
(struct sockaddr *)&udp_in, |
sintosa(&udp_in), n, |
n, (struct mbuf *)0) == 0) |
(struct mbuf *)0) == 0) { |
m_freem(n); |
m_freem(n); |
else |
udpstat.udps_fullsock++; |
|
} else |
sorwakeup(last); |
sorwakeup(last); |
} |
} |
} |
} |
last = inp->inp_socket; |
last = inp->inp_socket; |
/* |
/* |
* Don't look for additional matches if this one |
* Don't look for additional matches if this one does |
* does not have the SO_REUSEADDR socket option set. |
* not have either the SO_REUSEPORT or SO_REUSEADDR |
* This heuristic avoids searching through all pcbs |
* socket options set. This heuristic avoids searching |
* in the common case of a non-shared port. It |
* through all pcbs in the common case of a non-shared |
* assumes that an application will never clear |
* port. It * assumes that an application will never |
* the SO_REUSEADDR option after setting it. |
* clear these options after setting them. |
*/ |
*/ |
if ((last->so_options & SO_REUSEADDR) == 0) |
if ((last->so_options&(SO_REUSEPORT|SO_REUSEADDR) == 0)) |
break; |
break; |
} |
} |
|
|
Line 228 udp_input(m, iphlen) |
|
Line 233 udp_input(m, iphlen) |
|
* (No need to send an ICMP Port Unreachable |
* (No need to send an ICMP Port Unreachable |
* for a broadcast or multicast datgram.) |
* for a broadcast or multicast datgram.) |
*/ |
*/ |
|
udpstat.udps_noportbcast++; |
goto bad; |
goto bad; |
} |
} |
if (sbappendaddr(&last->so_rcv, (struct sockaddr *)&udp_in, |
if (sbappendaddr(&last->so_rcv, sintosa(&udp_in), m, |
m, (struct mbuf *)0) == 0) |
(struct mbuf *)0) == 0) { |
|
udpstat.udps_fullsock++; |
goto bad; |
goto bad; |
|
} |
sorwakeup(last); |
sorwakeup(last); |
return; |
return; |
} |
} |
#endif |
|
/* |
/* |
* Locate pcb for datagram. |
* Locate pcb for datagram. |
*/ |
*/ |
inp = udp_last_inpcb; |
inp = udp_last_inpcb; |
if (inp->inp_lport != uh->uh_dport || |
if (inp == 0 || |
|
inp->inp_lport != uh->uh_dport || |
inp->inp_fport != uh->uh_sport || |
inp->inp_fport != uh->uh_sport || |
inp->inp_faddr.s_addr != ip->ip_src.s_addr || |
inp->inp_faddr.s_addr != ip->ip_src.s_addr || |
inp->inp_laddr.s_addr != ip->ip_dst.s_addr) { |
inp->inp_laddr.s_addr != ip->ip_dst.s_addr) { |
inp = in_pcblookup(&udb, ip->ip_src, uh->uh_sport, |
|
ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD); |
|
if (inp) |
|
udp_last_inpcb = inp; |
|
udpstat.udpps_pcbcachemiss++; |
udpstat.udpps_pcbcachemiss++; |
} |
inp = in_pcblookup(&udbtable, ip->ip_src, uh->uh_sport, |
if (inp == 0) { |
ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD); |
/* don't send ICMP response for broadcast packet */ |
if (inp == 0) { |
udpstat.udps_noport++; |
udpstat.udps_noport++; |
#ifndef MULTICAST |
if (m->m_flags & (M_BCAST | M_MCAST)) { |
/* XXX why don't we do this with MULTICAST? */ |
udpstat.udps_noportbcast++; |
if (m->m_flags & (M_BCAST | M_MCAST)) { |
goto bad; |
udpstat.udps_noportbcast++; |
} |
goto bad; |
*ip = save_ip; |
|
ip->ip_len += iphlen; |
|
icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0); |
|
return; |
} |
} |
#endif |
udp_last_inpcb = inp; |
*ip = save_ip; |
|
ip->ip_len += iphlen; |
|
{ |
|
register struct in_addr foo = {}; |
|
icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, foo); |
|
} |
|
return; |
|
} |
} |
|
|
/* |
/* |
Line 306 udp_input(m, iphlen) |
|
Line 306 udp_input(m, iphlen) |
|
m->m_len -= iphlen; |
m->m_len -= iphlen; |
m->m_pkthdr.len -= iphlen; |
m->m_pkthdr.len -= iphlen; |
m->m_data += iphlen; |
m->m_data += iphlen; |
if (sbappendaddr(&inp->inp_socket->so_rcv, (struct sockaddr *)&udp_in, |
if (sbappendaddr(&inp->inp_socket->so_rcv, sintosa(&udp_in), m, |
m, opts) == 0) { |
opts) == 0) { |
udpstat.udps_fullsock++; |
udpstat.udps_fullsock++; |
goto bad; |
goto bad; |
} |
} |
|
|
* Create a "control" mbuf containing the specified data |
* Create a "control" mbuf containing the specified data |
* with the specified type for presentation with a datagram. |
* with the specified type for presentation with a datagram. |
*/ |
*/ |
static struct mbuf * |
struct mbuf * |
udp_saveopt(p, size, type) |
udp_saveopt(p, size, type) |
caddr_t p; |
caddr_t p; |
register int size; |
register int size; |
Line 335 udp_saveopt(p, size, type) |
|
Line 335 udp_saveopt(p, size, type) |
|
if ((m = m_get(M_DONTWAIT, MT_CONTROL)) == NULL) |
if ((m = m_get(M_DONTWAIT, MT_CONTROL)) == NULL) |
return ((struct mbuf *) NULL); |
return ((struct mbuf *) NULL); |
cp = (struct cmsghdr *) mtod(m, struct cmsghdr *); |
cp = (struct cmsghdr *) mtod(m, struct cmsghdr *); |
bcopy(p, (caddr_t)(cp + 1), size); |
bcopy(p, CMSG_DATA(cp), size); |
size += sizeof(*cp); |
size += sizeof(*cp); |
m->m_len = size; |
m->m_len = size; |
cp->cmsg_len = size; |
cp->cmsg_len = size; |
Line 353 udp_notify(inp, errno) |
|
Line 353 udp_notify(inp, errno) |
|
register struct inpcb *inp; |
register struct inpcb *inp; |
int errno; |
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); |
Line 367 udp_ctlinput(cmd, sa, ip) |
|
Line 366 udp_ctlinput(cmd, sa, ip) |
|
{ |
{ |
register struct udphdr *uh; |
register struct udphdr *uh; |
extern struct in_addr zeroin_addr; |
extern struct in_addr zeroin_addr; |
extern u_char inetctlerrmap[]; |
extern int inetctlerrmap[]; |
|
void (*notify) __P((struct inpcb *, int)) = udp_notify; |
|
int errno; |
|
|
if ((unsigned)cmd > PRC_NCMDS || inetctlerrmap[cmd] == 0) |
if ((unsigned)cmd >= PRC_NCMDS) |
|
return; |
|
errno = inetctlerrmap[cmd]; |
|
if (PRC_IS_REDIRECT(cmd)) |
|
notify = in_rtchange, ip = 0; |
|
else if (cmd == PRC_HOSTDEAD) |
|
ip = 0; |
|
else if (errno = 0) |
return; |
return; |
if (ip) { |
if (ip) { |
uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2)); |
uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2)); |
in_pcbnotify(&udb, sa, uh->uh_dport, ip->ip_src, uh->uh_sport, |
in_pcbnotify(&udbtable, sa, uh->uh_dport, ip->ip_src, |
cmd, udp_notify); |
uh->uh_sport, errno, notify); |
} else |
} else |
in_pcbnotify(&udb, sa, 0, zeroin_addr, 0, cmd, udp_notify); |
in_pcbnotifyall(&udbtable, sa, errno, notify); |
} |
} |
|
|
int |
int |
Line 418 udp_output(inp, m, addr, control) |
|
Line 426 udp_output(inp, m, addr, control) |
|
* Calculate data length and get a mbuf |
* Calculate data length and get a mbuf |
* for UDP and IP headers. |
* for UDP and IP headers. |
*/ |
*/ |
M_PREPEND(m, sizeof(struct udpiphdr), M_WAIT); |
M_PREPEND(m, sizeof(struct udpiphdr), M_DONTWAIT); |
|
if (m == 0) { |
|
error = ENOBUFS; |
|
goto release; |
|
} |
|
|
/* |
/* |
* Fill in mbuf with extended UDP header |
* Fill in mbuf with extended UDP header |
Line 428 udp_output(inp, m, addr, control) |
|
Line 440 udp_output(inp, m, addr, control) |
|
ui->ui_next = ui->ui_prev = 0; |
ui->ui_next = ui->ui_prev = 0; |
ui->ui_x1 = 0; |
ui->ui_x1 = 0; |
ui->ui_pr = IPPROTO_UDP; |
ui->ui_pr = IPPROTO_UDP; |
ui->ui_len = htons((u_short)len + sizeof (struct udphdr)); |
ui->ui_len = htons((u_int16_t)len + sizeof (struct udphdr)); |
ui->ui_src = inp->inp_laddr; |
ui->ui_src = inp->inp_laddr; |
ui->ui_dst = inp->inp_faddr; |
ui->ui_dst = inp->inp_faddr; |
ui->ui_sport = inp->inp_lport; |
ui->ui_sport = inp->inp_lport; |
Line 448 udp_output(inp, m, addr, control) |
|
Line 460 udp_output(inp, m, addr, control) |
|
((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++; |
error = ip_output(m, inp->inp_options, &inp->inp_route, |
error = 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), |
#ifdef MULTICAST |
inp->inp_moptions); |
, inp->inp_moptions |
|
#else |
|
, NULL |
|
#endif |
|
); |
|
|
|
if (addr) { |
if (addr) { |
in_pcbdisconnect(inp); |
in_pcbdisconnect(inp); |
Line 484 udp_usrreq(so, req, m, addr, control) |
|
Line 491 udp_usrreq(so, req, m, addr, control) |
|
int s; |
int s; |
|
|
if (req == PRU_CONTROL) |
if (req == PRU_CONTROL) |
return (in_control(so, (int)m, (caddr_t)addr, |
return (in_control(so, (long)m, (caddr_t)addr, |
(struct ifnet *)control)); |
(struct ifnet *)control)); |
if (inp == NULL && req != PRU_ATTACH) { |
if (inp == NULL && req != PRU_ATTACH) { |
error = EINVAL; |
error = EINVAL; |
Line 502 udp_usrreq(so, req, m, addr, control) |
|
Line 509 udp_usrreq(so, req, m, addr, control) |
|
break; |
break; |
} |
} |
s = splnet(); |
s = splnet(); |
error = in_pcballoc(so, &udb); |
error = in_pcballoc(so, &udbtable); |
splx(s); |
splx(s); |
if (error) |
if (error) |
break; |
break; |
error = soreserve(so, udp_sendspace, udp_recvspace); |
error = soreserve(so, udp_sendspace, udp_recvspace); |
if (error) |
if (error) |
break; |
break; |
((struct inpcb *) so->so_pcb)->inp_ip.ip_ttl = udp_ttl; |
((struct inpcb *) so->so_pcb)->inp_ip.ip_ttl = ip_defttl; |
break; |
break; |
|
|
case PRU_DETACH: |
case PRU_DETACH: |
|
|
int s = splnet(); |
int s = splnet(); |
|
|
if (inp == udp_last_inpcb) |
if (inp == udp_last_inpcb) |
udp_last_inpcb = &udb; |
udp_last_inpcb = 0; |
in_pcbdetach(inp); |
in_pcbdetach(inp); |
splx(s); |
splx(s); |
} |
} |
|
|
|
/* |
|
* Sysctl for udp variables. |
|
*/ |
|
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) |
|
return (ENOTDIR); |
|
|
|
switch (name[0]) { |
|
case UDPCTL_CHECKSUM: |
|
return (sysctl_int(oldp, oldlenp, newp, newlen, &udpcksum)); |
|
default: |
|
return (ENOPROTOOPT); |
|
} |
|
/* NOTREACHED */ |
|
} |