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