version 1.32, 1996/05/23 17:03:31 |
version 1.40, 1997/01/11 05:21:14 |
|
|
* |
* |
* @(#)udp_usrreq.c 8.4 (Berkeley) 1/21/94 |
* @(#)udp_usrreq.c 8.4 (Berkeley) 1/21/94 |
*/ |
*/ |
|
#include "ipkdb.h" |
|
|
#include <sys/param.h> |
#include <sys/param.h> |
#include <sys/malloc.h> |
#include <sys/malloc.h> |
Line 74 int udpcksum = 1; |
|
Line 75 int udpcksum = 1; |
|
int udpcksum = 0; /* XXX */ |
int udpcksum = 0; /* XXX */ |
#endif |
#endif |
|
|
struct sockaddr_in udp_in = { sizeof(udp_in), AF_INET }; |
|
|
|
static void udp_notify __P((struct inpcb *, int)); |
static void udp_notify __P((struct inpcb *, int)); |
static struct mbuf *udp_saveopt __P((caddr_t, int, int)); |
|
|
|
#ifndef UDBHASHSIZE |
#ifndef UDBHASHSIZE |
#define UDBHASHSIZE 128 |
#define UDBHASHSIZE 128 |
|
|
udp_init() |
udp_init() |
{ |
{ |
|
|
in_pcbinit(&udbtable, udbhashsize); |
in_pcbinit(&udbtable, udbhashsize, udbhashsize); |
} |
} |
|
|
void |
void |
Line 108 udp_input(m, va_alist) |
|
Line 106 udp_input(m, va_alist) |
|
struct ip save_ip; |
struct ip save_ip; |
int iphlen; |
int iphlen; |
va_list ap; |
va_list ap; |
|
struct sockaddr_in udpsrc; |
|
|
va_start(ap, m); |
va_start(ap, m); |
iphlen = va_arg(ap, int); |
iphlen = va_arg(ap, int); |
Line 174 udp_input(m, va_alist) |
|
Line 173 udp_input(m, va_alist) |
|
|
|
if (IN_MULTICAST(ip->ip_dst.s_addr) || |
if (IN_MULTICAST(ip->ip_dst.s_addr) || |
in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) { |
in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) { |
struct socket *last; |
struct inpcb *last; |
/* |
/* |
* Deliver a multicast or broadcast datagram to *all* sockets |
* Deliver a multicast or broadcast datagram to *all* sockets |
* for which the local and remote addresses and ports match |
* for which the local and remote addresses and ports match |
Line 194 udp_input(m, va_alist) |
|
Line 193 udp_input(m, va_alist) |
|
/* |
/* |
* Construct sockaddr format source address. |
* Construct sockaddr format source address. |
*/ |
*/ |
udp_in.sin_port = uh->uh_sport; |
udpsrc.sin_family = AF_INET; |
udp_in.sin_addr = ip->ip_src; |
udpsrc.sin_len = sizeof(struct sockaddr_in); |
|
udpsrc.sin_addr = ip->ip_src; |
|
udpsrc.sin_port = uh->uh_sport; |
|
bzero((caddr_t)udpsrc.sin_zero, sizeof(udpsrc.sin_zero)); |
|
|
m->m_len -= sizeof (struct udpiphdr); |
m->m_len -= sizeof (struct udpiphdr); |
m->m_data += sizeof (struct udpiphdr); |
m->m_data += sizeof (struct udpiphdr); |
/* |
/* |
Line 208 udp_input(m, va_alist) |
|
Line 211 udp_input(m, va_alist) |
|
inp = inp->inp_queue.cqe_next) { |
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 (!in_nullhost(inp->inp_laddr)) { |
if (inp->inp_laddr.s_addr != |
if (!in_hosteq(inp->inp_laddr, ip->ip_dst)) |
ip->ip_dst.s_addr) |
|
continue; |
continue; |
} |
} |
if (inp->inp_faddr.s_addr != INADDR_ANY) { |
if (!in_nullhost(inp->inp_faddr)) { |
if (inp->inp_faddr.s_addr != |
if (!in_hosteq(inp->inp_faddr, ip->ip_src) || |
ip->ip_src.s_addr || |
|
inp->inp_fport != uh->uh_sport) |
inp->inp_fport != uh->uh_sport) |
continue; |
continue; |
} |
} |
Line 224 udp_input(m, va_alist) |
|
Line 225 udp_input(m, va_alist) |
|
struct mbuf *n; |
struct mbuf *n; |
|
|
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { |
if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { |
if (sbappendaddr(&last->so_rcv, |
if (last->inp_flags & INP_CONTROLOPTS |
sintosa(&udp_in), n, |
|| last->inp_socket->so_options & |
(struct mbuf *)0) == 0) { |
SO_TIMESTAMP) { |
|
ip_savecontrol(last, &opts, |
|
ip, n); |
|
} |
|
if (sbappendaddr( |
|
&last->inp_socket->so_rcv, |
|
sintosa(&udpsrc), n, opts) == 0) { |
m_freem(n); |
m_freem(n); |
udpstat.udps_fullsock++; |
if (opts) |
|
m_freem(opts); |
} else |
} else |
sorwakeup(last); |
sorwakeup(last->inp_socket); |
|
opts = 0; |
} |
} |
} |
} |
last = inp->inp_socket; |
last = inp; |
/* |
/* |
* Don't look for additional matches if this one does |
* Don't look for additional matches if this one does |
* not have either the SO_REUSEPORT or SO_REUSEADDR |
* not have either the SO_REUSEPORT or SO_REUSEADDR |
Line 242 udp_input(m, va_alist) |
|
Line 251 udp_input(m, va_alist) |
|
* port. It * assumes that an application will never |
* port. It * assumes that an application will never |
* clear these options after setting them. |
* clear these options after setting them. |
*/ |
*/ |
if ((last->so_options&(SO_REUSEPORT|SO_REUSEADDR)) == 0) |
if ((last->inp_socket->so_options & |
|
(SO_REUSEPORT|SO_REUSEADDR)) == 0) |
break; |
break; |
} |
} |
|
|
Line 255 udp_input(m, va_alist) |
|
Line 265 udp_input(m, va_alist) |
|
udpstat.udps_noportbcast++; |
udpstat.udps_noportbcast++; |
goto bad; |
goto bad; |
} |
} |
if (sbappendaddr(&last->so_rcv, sintosa(&udp_in), m, |
if (last->inp_flags & INP_CONTROLOPTS || |
(struct mbuf *)0) == 0) { |
last->inp_socket->so_options & SO_TIMESTAMP) |
|
ip_savecontrol(last, &opts, ip, m); |
|
if (sbappendaddr(&last->inp_socket->so_rcv, |
|
sintosa(&udpsrc), m, opts) == 0) { |
udpstat.udps_fullsock++; |
udpstat.udps_fullsock++; |
goto bad; |
goto bad; |
} |
} |
sorwakeup(last); |
sorwakeup(last->inp_socket); |
return; |
return; |
} |
} |
/* |
/* |
* Locate pcb for datagram. |
* Locate pcb for datagram. |
*/ |
*/ |
inp = in_pcbhashlookup(&udbtable, ip->ip_src, uh->uh_sport, |
inp = in_pcblookup_connect(&udbtable, ip->ip_src, uh->uh_sport, |
ip->ip_dst, uh->uh_dport); |
ip->ip_dst, uh->uh_dport); |
if (inp == 0) { |
if (inp == 0) { |
++udpstat.udps_pcbhashmiss; |
++udpstat.udps_pcbhashmiss; |
inp = in_pcblookup(&udbtable, ip->ip_src, uh->uh_sport, |
inp = in_pcblookup_bind(&udbtable, ip->ip_dst, uh->uh_dport); |
ip->ip_dst, uh->uh_dport, INPLOOKUP_WILDCARD); |
|
if (inp == 0) { |
if (inp == 0) { |
udpstat.udps_noport++; |
udpstat.udps_noport++; |
if (m->m_flags & (M_BCAST | M_MCAST)) { |
if (m->m_flags & (M_BCAST | M_MCAST)) { |
Line 280 udp_input(m, va_alist) |
|
Line 292 udp_input(m, va_alist) |
|
} |
} |
*ip = save_ip; |
*ip = save_ip; |
ip->ip_len += iphlen; |
ip->ip_len += iphlen; |
|
#if NIPKDB > 0 |
|
if (checkipkdb(&ip->ip_src, |
|
uh->uh_sport, |
|
uh->uh_dport, |
|
m, |
|
iphlen + sizeof(struct udphdr), |
|
len - sizeof(struct udphdr))) |
|
/* It was a debugger connect packet, just drop it now */ |
|
goto bad; |
|
#endif |
icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0); |
icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0); |
return; |
return; |
} |
} |
Line 289 udp_input(m, va_alist) |
|
Line 311 udp_input(m, va_alist) |
|
* Construct sockaddr format source address. |
* Construct sockaddr format source address. |
* Stuff source address and datagram in user buffer. |
* Stuff source address and datagram in user buffer. |
*/ |
*/ |
udp_in.sin_port = uh->uh_sport; |
udpsrc.sin_family = AF_INET; |
udp_in.sin_addr = ip->ip_src; |
udpsrc.sin_len = sizeof(struct sockaddr_in); |
if (inp->inp_flags & INP_CONTROLOPTS) { |
udpsrc.sin_addr = ip->ip_src; |
struct mbuf **mp = &opts; |
udpsrc.sin_port = uh->uh_sport; |
|
bzero((caddr_t)udpsrc.sin_zero, sizeof(udpsrc.sin_zero)); |
if (inp->inp_flags & INP_RECVDSTADDR) { |
|
*mp = udp_saveopt((caddr_t) &ip->ip_dst, |
if (inp->inp_flags & INP_CONTROLOPTS || |
sizeof(struct in_addr), IP_RECVDSTADDR); |
inp->inp_socket->so_options & SO_TIMESTAMP) |
if (*mp) |
ip_savecontrol(inp, &opts, ip, m); |
mp = &(*mp)->m_next; |
|
} |
|
#ifdef notyet |
|
/* options were tossed above */ |
|
if (inp->inp_flags & INP_RECVOPTS) { |
|
*mp = udp_saveopt((caddr_t) opts_deleted_above, |
|
sizeof(struct in_addr), IP_RECVOPTS); |
|
if (*mp) |
|
mp = &(*mp)->m_next; |
|
} |
|
/* ip_srcroute doesn't do what we want here, need to fix */ |
|
if (inp->inp_flags & INP_RECVRETOPTS) { |
|
*mp = udp_saveopt((caddr_t) ip_srcroute(), |
|
sizeof(struct in_addr), IP_RECVRETOPTS); |
|
if (*mp) |
|
mp = &(*mp)->m_next; |
|
} |
|
#endif |
|
} |
|
iphlen += sizeof(struct udphdr); |
iphlen += sizeof(struct udphdr); |
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, sintosa(&udp_in), m, |
if (sbappendaddr(&inp->inp_socket->so_rcv, sintosa(&udpsrc), m, |
opts) == 0) { |
opts) == 0) { |
udpstat.udps_fullsock++; |
udpstat.udps_fullsock++; |
goto bad; |
goto bad; |
|
|
} |
} |
|
|
/* |
/* |
* Create a "control" mbuf containing the specified data |
|
* with the specified type for presentation with a datagram. |
|
*/ |
|
struct mbuf * |
|
udp_saveopt(p, size, type) |
|
caddr_t p; |
|
register int size; |
|
int type; |
|
{ |
|
register struct cmsghdr *cp; |
|
struct mbuf *m; |
|
|
|
if ((m = m_get(M_DONTWAIT, MT_CONTROL)) == NULL) |
|
return ((struct mbuf *) NULL); |
|
cp = (struct cmsghdr *) mtod(m, struct cmsghdr *); |
|
bcopy(p, CMSG_DATA(cp), size); |
|
size += sizeof(*cp); |
|
m->m_len = size; |
|
cp->cmsg_len = size; |
|
cp->cmsg_level = IPPROTO_IP; |
|
cp->cmsg_type = type; |
|
return (m); |
|
} |
|
|
|
/* |
|
* Notify a udp user of an asynchronous error; |
* Notify a udp user of an asynchronous error; |
* just wake up so that he can collect error status. |
* just wake up so that he can collect error status. |
*/ |
*/ |
Line 368 udp_notify(inp, errno) |
|
Line 346 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 396 udp_ctlinput(cmd, sa, v) |
|
Line 375 udp_ctlinput(cmd, sa, v) |
|
return NULL; |
return NULL; |
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(&udbtable, sa, uh->uh_dport, ip->ip_src, |
in_pcbnotify(&udbtable, satosin(sa)->sin_addr, uh->uh_dport, |
uh->uh_sport, errno, notify); |
ip->ip_src, uh->uh_sport, errno, notify); |
} else |
} else |
in_pcbnotifyall(&udbtable, sa, errno, notify); |
in_pcbnotifyall(&udbtable, satosin(sa)->sin_addr, errno, |
|
notify); |
return NULL; |
return NULL; |
} |
} |
|
|
Line 412 udp_output(m, va_alist) |
|
Line 392 udp_output(m, va_alist) |
|
va_dcl |
va_dcl |
#endif |
#endif |
{ |
{ |
struct mbuf *control; |
|
register struct inpcb *inp; |
register struct inpcb *inp; |
register struct udpiphdr *ui; |
register struct udpiphdr *ui; |
register int len = m->m_pkthdr.len; |
register int len = m->m_pkthdr.len; |
Line 420 udp_output(m, va_alist) |
|
Line 399 udp_output(m, va_alist) |
|
va_list ap; |
va_list ap; |
|
|
va_start(ap, m); |
va_start(ap, m); |
control = va_arg(ap, struct mbuf *); |
|
inp = va_arg(ap, struct inpcb *); |
inp = va_arg(ap, struct inpcb *); |
va_end(ap); |
va_end(ap); |
|
|
if (control) |
|
m_freem(control); /* XXX */ |
|
|
|
/* |
/* |
* Calculate data length and get a mbuf |
* Calculate data length and get a mbuf |
* for UDP and IP headers. |
* for UDP and IP headers. |
Line 438 udp_output(m, va_alist) |
|
Line 413 udp_output(m, va_alist) |
|
} |
} |
|
|
/* |
/* |
|
* Compute the packet length of the IP header, and |
|
* punt if the length looks bogus. |
|
*/ |
|
if ((len + sizeof(struct udpiphdr)) > IP_MAXPACKET) { |
|
error = EMSGSIZE; |
|
goto release; |
|
} |
|
|
|
/* |
* Fill in mbuf with extended UDP header |
* Fill in mbuf with extended UDP header |
* and addresses and length put into network format. |
* and addresses and length put into network format. |
*/ |
*/ |
Line 553 udp_usrreq(so, req, m, nam, control, p) |
|
Line 537 udp_usrreq(so, req, m, nam, control, p) |
|
/*soisdisconnected(so);*/ |
/*soisdisconnected(so);*/ |
so->so_state &= ~SS_ISCONNECTED; /* XXX */ |
so->so_state &= ~SS_ISCONNECTED; /* XXX */ |
in_pcbdisconnect(inp); |
in_pcbdisconnect(inp); |
inp->inp_laddr.s_addr = INADDR_ANY; /* XXX */ |
inp->inp_laddr = zeroin_addr; /* XXX */ |
|
in_pcbstate(inp, INP_BOUND); /* XXX */ |
break; |
break; |
|
|
case PRU_SHUTDOWN: |
case PRU_SHUTDOWN: |
Line 572 udp_usrreq(so, req, m, nam, control, p) |
|
Line 557 udp_usrreq(so, req, m, nam, control, p) |
|
break; |
break; |
} |
} |
{ |
{ |
struct in_addr laddr; |
struct in_addr laddr; /* XXX */ |
|
|
if (nam) { |
if (nam) { |
laddr = inp->inp_laddr; |
laddr = inp->inp_laddr; /* XXX */ |
if ((so->so_state & SS_ISCONNECTED) != 0) { |
if ((so->so_state & SS_ISCONNECTED) != 0) { |
error = EISCONN; |
error = EISCONN; |
goto die; |
goto die; |
Line 592 udp_usrreq(so, req, m, nam, control, p) |
|
Line 577 udp_usrreq(so, req, m, nam, control, p) |
|
goto die; |
goto die; |
} |
} |
} |
} |
error = udp_output(m, control, inp); |
error = udp_output(m, inp); |
if (nam) { |
if (nam) { |
in_pcbdisconnect(inp); |
in_pcbdisconnect(inp); |
inp->inp_laddr = laddr; |
inp->inp_laddr = laddr; /* XXX */ |
|
in_pcbstate(inp, INP_BOUND); /* XXX */ |
} |
} |
} |
} |
break; |
break; |