udp6_usrreq.c revision 1.24
1 /* $NetBSD: udp6_usrreq.c,v 1.24 2000/02/25 00:29:00 itojun Exp $ */ 2 /* $KAME: udp6_usrreq.c,v 1.39 2000/02/23 08:54:23 jinmei Exp $ */ 3 4 /* 5 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. Neither the name of the project nor the names of its contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 /* 34 * Copyright (c) 1982, 1986, 1989, 1993 35 * The Regents of the University of California. All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 1. Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * 2. Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in the 44 * documentation and/or other materials provided with the distribution. 45 * 3. All advertising materials mentioning features or use of this software 46 * must display the following acknowledgement: 47 * This product includes software developed by the University of 48 * California, Berkeley and its contributors. 49 * 4. Neither the name of the University nor the names of its contributors 50 * may be used to endorse or promote products derived from this software 51 * without specific prior written permission. 52 * 53 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 54 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 55 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 56 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 57 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 58 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 59 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 60 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 61 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 62 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 63 * SUCH DAMAGE. 64 * 65 * @(#)udp_var.h 8.1 (Berkeley) 6/10/93 66 */ 67 68 #include "opt_ipsec.h" 69 70 #include <sys/param.h> 71 #include <sys/malloc.h> 72 #include <sys/mbuf.h> 73 #include <sys/protosw.h> 74 #include <sys/socket.h> 75 #include <sys/socketvar.h> 76 #include <sys/errno.h> 77 #include <sys/stat.h> 78 #include <sys/systm.h> 79 #include <sys/proc.h> 80 #include <sys/syslog.h> 81 82 #include <net/if.h> 83 #include <net/route.h> 84 #include <net/if_types.h> 85 86 #include <netinet/in.h> 87 #include <netinet/in_var.h> 88 #include <netinet/in_systm.h> 89 #include <netinet/ip.h> 90 #include <netinet/ip_var.h> 91 #include <netinet/in_pcb.h> 92 #include <netinet/udp.h> 93 #include <netinet/udp_var.h> 94 #include <netinet/ip6.h> 95 #include <netinet6/in6_pcb.h> 96 #include <netinet6/ip6_var.h> 97 #include <netinet/icmp6.h> 98 #include <netinet6/udp6_var.h> 99 #include <netinet6/ip6protosw.h> 100 101 #ifdef IPSEC 102 #include <netinet6/ipsec.h> 103 #endif /*IPSEC*/ 104 105 #include "faith.h" 106 107 /* 108 * UDP protocol inplementation. 109 * Per RFC 768, August, 1980. 110 */ 111 112 struct in6pcb *udp6_last_in6pcb = &udb6; 113 114 #ifdef UDP6 115 static int in6_mcmatch __P((struct in6pcb *, struct in6_addr *, struct ifnet *)); 116 #endif 117 static void udp6_detach __P((struct in6pcb *)); 118 static void udp6_notify __P((struct in6pcb *, int)); 119 120 void 121 udp6_init() 122 { 123 udb6.in6p_next = udb6.in6p_prev = &udb6; 124 } 125 126 #ifdef UDP6 127 static int 128 in6_mcmatch(in6p, ia6, ifp) 129 struct in6pcb *in6p; 130 register struct in6_addr *ia6; 131 struct ifnet *ifp; 132 { 133 struct ip6_moptions *im6o = in6p->in6p_moptions; 134 struct in6_multi_mship *imm; 135 136 if (im6o == NULL) 137 return 0; 138 139 for (imm = im6o->im6o_memberships.lh_first; imm != NULL; 140 imm = imm->i6mm_chain.le_next) { 141 if ((ifp == NULL || 142 imm->i6mm_maddr->in6m_ifp == ifp) && 143 IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr, 144 ia6)) 145 return 1; 146 } 147 return 0; 148 } 149 150 int 151 udp6_input(mp, offp, proto) 152 struct mbuf **mp; 153 int *offp, proto; 154 { 155 struct mbuf *m = *mp; 156 register struct ip6_hdr *ip6; 157 register struct udphdr *uh; 158 register struct in6pcb *in6p; 159 struct mbuf *opts = 0; 160 int off = *offp; 161 u_int32_t plen, ulen; 162 struct sockaddr_in6 udp_in6; 163 164 #if defined(NFAITH) && 0 < NFAITH 165 if (m->m_pkthdr.rcvif) { 166 if (m->m_pkthdr.rcvif->if_type == IFT_FAITH) { 167 /* send icmp6 host unreach? */ 168 m_freem(m); 169 return IPPROTO_DONE; 170 } 171 } 172 #endif 173 udp6stat.udp6s_ipackets++; 174 175 ip6 = mtod(m, struct ip6_hdr *); 176 /* check for jumbogram is done in ip6_input. we can trust pkthdr.len */ 177 plen = m->m_pkthdr.len - off; 178 #ifndef PULLDOWN_TEST 179 IP6_EXTHDR_CHECK(m, off, sizeof(struct udphdr), IPPROTO_DONE); 180 uh = (struct udphdr *)((caddr_t)ip6 + off); 181 #else 182 IP6_EXTHDR_GET(uh, struct udphdr *, m, off, sizeof(struct udphdr)); 183 if (uh == NULL) { 184 udp6stat.udp6s_hdrops++; 185 return IPPROTO_DONE; 186 } 187 #endif 188 ulen = ntohs((u_short)uh->uh_ulen); 189 if (ulen == 0 && plen > 0xffff) /* jumbogram */ 190 ulen = plen; 191 192 if (plen != ulen) { 193 udp6stat.udp6s_badlen++; 194 goto bad; 195 } 196 197 /* destination port of 0 is illegal, based on RFC768. */ 198 if (uh->uh_dport == 0) 199 goto bad; 200 201 /* Be proactive about malicious use of IPv4 mapped address */ 202 if (IN6_IS_ADDR_V4MAPPED(&ip6->ip6_src) || 203 IN6_IS_ADDR_V4MAPPED(&ip6->ip6_dst)) { 204 /* XXX stat */ 205 goto bad; 206 } 207 208 /* 209 * Checksum extended UDP header and data. 210 */ 211 if (uh->uh_sum == 0) 212 udp6stat.udp6s_nosum++; 213 else if (in6_cksum(m, IPPROTO_UDP, off, ulen) != 0) { 214 udp6stat.udp6s_badsum++; 215 goto bad; 216 } 217 218 if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 219 struct in6pcb *last; 220 221 /* 222 * Deliver a multicast datagram to all sockets 223 * for which the local and remote addresses and ports match 224 * those of the incoming datagram. This allows more than 225 * one process to receive multicasts on the same port. 226 * (This really ought to be done for unicast datagrams as 227 * well, but that would cause problems with existing 228 * applications that open both address-specific sockets and 229 * a wildcard socket listening to the same port -- they would 230 * end up receiving duplicates of every unicast datagram. 231 * Those applications open the multiple sockets to overcome an 232 * inadequacy of the UDP socket interface, but for backwards 233 * compatibility we avoid the problem here rather than 234 * fixing the interface. Maybe 4.5BSD will remedy this?) 235 */ 236 237 /* 238 * In a case that laddr should be set to the link-local 239 * address (this happens in RIPng), the multicast address 240 * specified in the received packet does not match with 241 * laddr. To cure this situation, the matching is relaxed 242 * if the receiving interface is the same as one specified 243 * in the socket and if the destination multicast address 244 * matches one of the multicast groups specified in the socket. 245 */ 246 247 /* 248 * Construct sockaddr format source address. 249 */ 250 bzero(&udp_in6, sizeof(udp_in6)); 251 udp_in6.sin6_len = sizeof(struct sockaddr_in6); 252 udp_in6.sin6_family = AF_INET6; 253 udp_in6.sin6_port = uh->uh_sport; 254 udp_in6.sin6_addr = ip6->ip6_src; 255 if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr)) 256 udp_in6.sin6_addr.s6_addr16[1] = 0; 257 if (m->m_pkthdr.rcvif) { 258 if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr)) { 259 udp_in6.sin6_scope_id = 260 m->m_pkthdr.rcvif->if_index; 261 } else 262 udp_in6.sin6_scope_id = 0; 263 } else 264 udp_in6.sin6_scope_id = 0; 265 /* 266 * KAME note: usually we drop udphdr from mbuf here. 267 * We need udphdr for IPsec processing so we do that later. 268 */ 269 270 /* 271 * Locate pcb(s) for datagram. 272 * (Algorithm copied from raw_intr().) 273 */ 274 last = NULL; 275 for (in6p = udb6.in6p_next; 276 in6p != &udb6; 277 in6p = in6p->in6p_next) { 278 if (in6p->in6p_lport != uh->uh_dport) 279 continue; 280 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) { 281 if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, 282 &ip6->ip6_dst) && 283 !in6_mcmatch(in6p, &ip6->ip6_dst, 284 m->m_pkthdr.rcvif)) 285 continue; 286 } 287 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 288 if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, 289 &ip6->ip6_src) || 290 in6p->in6p_fport != uh->uh_sport) 291 continue; 292 } 293 294 if (last != NULL) { 295 struct mbuf *n; 296 297 #ifdef IPSEC 298 /* 299 * Check AH/ESP integrity. 300 */ 301 if (ipsec6_in_reject(m, last)) { 302 ipsec6stat.in_polvio++; 303 /* do not inject data into pcb */ 304 } else 305 #endif /*IPSEC*/ 306 if ((n = m_copy(m, 0, M_COPYALL)) != NULL) { 307 /* 308 * KAME NOTE: do not 309 * m_copy(m, offset, ...) above. 310 * sbappendaddr() expects M_PKTHDR, 311 * and m_copy() will copy M_PKTHDR 312 * only if offset is 0. 313 */ 314 if (last->in6p_flags & IN6P_CONTROLOPTS 315 || last->in6p_socket->so_options & SO_TIMESTAMP) { 316 ip6_savecontrol(last, &opts, 317 ip6, n); 318 } 319 320 m_adj(n, off + sizeof(struct udphdr)); 321 if (sbappendaddr(&last->in6p_socket->so_rcv, 322 (struct sockaddr *)&udp_in6, 323 n, opts) == 0) { 324 m_freem(n); 325 if (opts) 326 m_freem(opts); 327 udp6stat.udp6s_fullsock++; 328 } else 329 sorwakeup(last->in6p_socket); 330 opts = 0; 331 } 332 } 333 last = in6p; 334 /* 335 * Don't look for additional matches if this one does 336 * not have either the SO_REUSEPORT or SO_REUSEADDR 337 * socket options set. This heuristic avoids searching 338 * through all pcbs in the common case of a non-shared 339 * port. It assumes that an application will never 340 * clear these options after setting them. 341 */ 342 if ((last->in6p_socket->so_options & 343 (SO_REUSEPORT|SO_REUSEADDR)) == 0) 344 break; 345 } 346 347 if (last == NULL) { 348 /* 349 * No matching pcb found; discard datagram. 350 * (No need to send an ICMP Port Unreachable 351 * for a broadcast or multicast datgram.) 352 */ 353 udp6stat.udp6s_noport++; 354 udp6stat.udp6s_noportmcast++; 355 goto bad; 356 } 357 #ifdef IPSEC 358 /* 359 * Check AH/ESP integrity. 360 */ 361 if (last != NULL && ipsec6_in_reject(m, last)) { 362 ipsec6stat.in_polvio++; 363 goto bad; 364 } 365 #endif /*IPSEC*/ 366 if (last->in6p_flags & IN6P_CONTROLOPTS 367 || last->in6p_socket->so_options & SO_TIMESTAMP) { 368 ip6_savecontrol(last, &opts, ip6, m); 369 } 370 371 m_adj(m, off + sizeof(struct udphdr)); 372 if (sbappendaddr(&last->in6p_socket->so_rcv, 373 (struct sockaddr *)&udp_in6, 374 m, opts) == 0) { 375 udp6stat.udp6s_fullsock++; 376 goto bad; 377 } 378 sorwakeup(last->in6p_socket); 379 return IPPROTO_DONE; 380 } 381 /* 382 * Locate pcb for datagram. 383 */ 384 in6p = udp6_last_in6pcb; 385 if (in6p->in6p_lport != uh->uh_dport || 386 in6p->in6p_fport != uh->uh_sport || 387 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src) || 388 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst)) { 389 in6p = in6_pcblookup(&udb6, 390 &ip6->ip6_src, uh->uh_sport, 391 &ip6->ip6_dst, uh->uh_dport, 392 IN6PLOOKUP_WILDCARD); 393 if (in6p) 394 udp6_last_in6pcb = in6p; 395 udp6stat.udp6ps_pcbcachemiss++; 396 } 397 if (in6p == 0) { 398 udp6stat.udp6s_noport++; 399 if (m->m_flags & M_MCAST) { 400 printf("UDP6: M_MCAST is set in a unicast packet.\n"); 401 udp6stat.udp6s_noportmcast++; 402 goto bad; 403 } 404 icmp6_error(m, ICMP6_DST_UNREACH, ICMP6_DST_UNREACH_NOPORT, 0); 405 return IPPROTO_DONE; 406 } 407 #ifdef IPSEC 408 /* 409 * Check AH/ESP integrity. 410 */ 411 if (in6p != NULL && ipsec6_in_reject(m, in6p)) { 412 ipsec6stat.in_polvio++; 413 goto bad; 414 } 415 #endif /*IPSEC*/ 416 417 /* 418 * Construct sockaddr format source address. 419 * Stuff source address and datagram in user buffer. 420 */ 421 bzero(&udp_in6, sizeof(udp_in6)); 422 udp_in6.sin6_len = sizeof(struct sockaddr_in6); 423 udp_in6.sin6_family = AF_INET6; 424 udp_in6.sin6_port = uh->uh_sport; 425 udp_in6.sin6_addr = ip6->ip6_src; 426 if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr)) 427 udp_in6.sin6_addr.s6_addr16[1] = 0; 428 if (m->m_pkthdr.rcvif) { 429 if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr)) 430 udp_in6.sin6_scope_id = m->m_pkthdr.rcvif->if_index; 431 else 432 udp_in6.sin6_scope_id = 0; 433 } else 434 udp_in6.sin6_scope_id = 0; 435 if (in6p->in6p_flags & IN6P_CONTROLOPTS 436 || in6p->in6p_socket->so_options & SO_TIMESTAMP) { 437 ip6_savecontrol(in6p, &opts, ip6, m); 438 } 439 440 m_adj(m, off + sizeof(struct udphdr)); 441 if (sbappendaddr(&in6p->in6p_socket->so_rcv, 442 (struct sockaddr *)&udp_in6, 443 m, opts) == 0) { 444 udp6stat.udp6s_fullsock++; 445 goto bad; 446 } 447 sorwakeup(in6p->in6p_socket); 448 return IPPROTO_DONE; 449 bad: 450 if (m) 451 m_freem(m); 452 if (opts) 453 m_freem(opts); 454 return IPPROTO_DONE; 455 } 456 #endif 457 458 /* 459 * Notify a udp user of an asynchronous error; 460 * just wake up so tat he can collect error status. 461 */ 462 static void 463 udp6_notify(in6p, errno) 464 register struct in6pcb *in6p; 465 int errno; 466 { 467 in6p->in6p_socket->so_error = errno; 468 sorwakeup(in6p->in6p_socket); 469 sowwakeup(in6p->in6p_socket); 470 } 471 472 void 473 udp6_ctlinput(cmd, sa, d) 474 int cmd; 475 struct sockaddr *sa; 476 void *d; 477 { 478 register struct udphdr *uhp; 479 struct udphdr uh; 480 struct sockaddr_in6 sa6; 481 register struct ip6_hdr *ip6; 482 struct mbuf *m; 483 int off; 484 485 if (sa->sa_family != AF_INET6 || 486 sa->sa_len != sizeof(struct sockaddr_in6)) 487 return; 488 489 #if 0 490 if (cmd == PRC_IFNEWADDR) 491 in6_mrejoin(&udb6); 492 else 493 #endif 494 if (!PRC_IS_REDIRECT(cmd) && 495 ((unsigned)cmd >= PRC_NCMDS || inet6ctlerrmap[cmd] == 0)) 496 return; 497 498 /* if the parameter is from icmp6, decode it. */ 499 if (d != NULL) { 500 struct ip6ctlparam *ip6cp = (struct ip6ctlparam *)d; 501 m = ip6cp->ip6c_m; 502 ip6 = ip6cp->ip6c_ip6; 503 off = ip6cp->ip6c_off; 504 } else { 505 m = NULL; 506 ip6 = NULL; 507 } 508 509 /* translate addresses into internal form */ 510 sa6 = *(struct sockaddr_in6 *)sa; 511 if (IN6_IS_ADDR_LINKLOCAL(&sa6.sin6_addr) && m && m->m_pkthdr.rcvif) 512 sa6.sin6_addr.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index); 513 514 if (ip6) { 515 /* 516 * XXX: We assume that when IPV6 is non NULL, 517 * M and OFF are valid. 518 */ 519 struct in6_addr s; 520 521 /* translate addresses into internal form */ 522 memcpy(&s, &ip6->ip6_src, sizeof(s)); 523 if (IN6_IS_ADDR_LINKLOCAL(&s)) 524 s.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index); 525 526 if (m->m_len < off + sizeof(uh)) { 527 /* 528 * this should be rare case, 529 * so we compromise on this copy... 530 */ 531 m_copydata(m, off, sizeof(uh), (caddr_t)&uh); 532 uhp = &uh; 533 } else 534 uhp = (struct udphdr *)(mtod(m, caddr_t) + off); 535 (void) in6_pcbnotify(&udb6, (struct sockaddr *)&sa6, 536 uhp->uh_dport, &s, 537 uhp->uh_sport, cmd, udp6_notify); 538 } else { 539 (void) in6_pcbnotify(&udb6, (struct sockaddr *)&sa6, 0, 540 &zeroin6_addr, 0, cmd, udp6_notify); 541 } 542 } 543 544 int 545 udp6_output(in6p, m, addr6, control) 546 register struct in6pcb *in6p; 547 register struct mbuf *m; 548 struct mbuf *addr6, *control; 549 { 550 register u_int32_t ulen = m->m_pkthdr.len; 551 u_int32_t plen = sizeof(struct udphdr) + ulen; 552 struct ip6_hdr *ip6; 553 struct udphdr *udp6; 554 struct in6_addr *laddr, *faddr; 555 u_short fport; 556 int error = 0; 557 struct ip6_pktopts opt, *stickyopt = in6p->in6p_outputopts; 558 int priv; 559 struct proc *p = curproc; /* XXX */ 560 int af, hlen; 561 #ifdef INET 562 struct ip *ip; 563 #endif 564 565 priv = 0; 566 if (p && !suser(p->p_ucred, &p->p_acflag)) 567 priv = 1; 568 if (control) { 569 if ((error = ip6_setpktoptions(control, &opt, priv)) != 0) 570 goto release; 571 in6p->in6p_outputopts = &opt; 572 } 573 574 if (addr6) { 575 /* 576 * IPv4 version of udp_output calls in_pcbconnect in this case, 577 * which needs splnet and affects performance. 578 * Since we saw no essential reason for calling in_pcbconnect, 579 * we get rid of such kind of logic, and call in6_selectsrc 580 * and In6_pcbsetport in order to fill in the local address 581 * and the local port. 582 */ 583 struct sockaddr_in6 *sin6 = mtod(addr6, struct sockaddr_in6 *); 584 585 if (addr6->m_len != sizeof(*sin6)) { 586 error = EINVAL; 587 goto release; 588 } 589 if (sin6->sin6_family != AF_INET6) { 590 error = EAFNOSUPPORT; 591 goto release; 592 } 593 if (sin6->sin6_port == 0) { 594 error = EADDRNOTAVAIL; 595 goto release; 596 } 597 598 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 599 error = EISCONN; 600 goto release; 601 } 602 603 faddr = &sin6->sin6_addr; 604 fport = sin6->sin6_port; /* allow 0 port */ 605 /* 606 * If the scope of the destination is link-local, 607 * embed the interface 608 * index in the address. 609 * 610 * XXX advanced-api value overrides sin6_scope_id 611 */ 612 if (IN6_IS_ADDR_LINKLOCAL(faddr) || 613 IN6_IS_ADDR_MC_LINKLOCAL(faddr)) { 614 struct ip6_pktopts *optp = in6p->in6p_outputopts; 615 struct in6_pktinfo *pi = NULL; 616 struct ifnet *oifp = NULL; 617 struct ip6_moptions *mopt = NULL; 618 619 /* 620 * XXX Boundary check is assumed to be already done in 621 * ip6_setpktoptions(). 622 */ 623 if (optp && (pi = optp->ip6po_pktinfo) && 624 pi->ipi6_ifindex) { 625 faddr->s6_addr16[1] = htons(pi->ipi6_ifindex); 626 oifp = ifindex2ifnet[pi->ipi6_ifindex]; 627 } 628 else if (IN6_IS_ADDR_MULTICAST(faddr) && 629 (mopt = in6p->in6p_moptions) && 630 mopt->im6o_multicast_ifp) { 631 oifp = mopt->im6o_multicast_ifp; 632 faddr->s6_addr16[1] = oifp->if_index; 633 } else if (sin6->sin6_scope_id) { 634 /* boundary check */ 635 if (sin6->sin6_scope_id < 0 636 || if_index < sin6->sin6_scope_id) { 637 error = ENXIO; /* XXX EINVAL? */ 638 goto release; 639 } 640 /* XXX */ 641 faddr->s6_addr16[1] = 642 htons(sin6->sin6_scope_id & 0xffff); 643 } 644 } 645 646 if (!IN6_IS_ADDR_V4MAPPED(faddr)) { 647 laddr = in6_selectsrc(sin6, in6p->in6p_outputopts, 648 in6p->in6p_moptions, 649 &in6p->in6p_route, 650 &in6p->in6p_laddr, &error); 651 } else 652 laddr = &in6p->in6p_laddr; /*XXX*/ 653 if (laddr == NULL) { 654 if (error == 0) 655 error = EADDRNOTAVAIL; 656 goto release; 657 } 658 if (in6p->in6p_lport == 0 && 659 (error = in6_pcbsetport(laddr, in6p)) != 0) 660 goto release; 661 } else { 662 if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 663 error = ENOTCONN; 664 goto release; 665 } 666 laddr = &in6p->in6p_laddr; 667 faddr = &in6p->in6p_faddr; 668 fport = in6p->in6p_fport; 669 } 670 671 if (!IN6_IS_ADDR_V4MAPPED(faddr)) { 672 af = AF_INET6; 673 hlen = sizeof(struct ip6_hdr); 674 } else { 675 af = AF_INET; 676 hlen = sizeof(struct ip); 677 } 678 679 /* 680 * Calculate data length and get a mbuf 681 * for UDP and IP6 headers. 682 */ 683 M_PREPEND(m, hlen + sizeof(struct udphdr), M_DONTWAIT); 684 if (m == 0) { 685 error = ENOBUFS; 686 goto release; 687 } 688 689 /* 690 * Stuff checksum and output datagram. 691 */ 692 udp6 = (struct udphdr *)(mtod(m, caddr_t) + hlen); 693 udp6->uh_sport = in6p->in6p_lport; /* lport is always set in the PCB */ 694 udp6->uh_dport = fport; 695 if (plen <= 0xffff) 696 udp6->uh_ulen = htons((u_short)plen); 697 else 698 udp6->uh_ulen = 0; 699 udp6->uh_sum = 0; 700 701 switch (af) { 702 case AF_INET6: 703 ip6 = mtod(m, struct ip6_hdr *); 704 ip6->ip6_flow = in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK; 705 ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 706 ip6->ip6_vfc |= IPV6_VERSION; 707 #if 0 /* ip6_plen will be filled in ip6_output. */ 708 ip6->ip6_plen = htons((u_short)plen); 709 #endif 710 ip6->ip6_nxt = IPPROTO_UDP; 711 ip6->ip6_hlim = in6_selecthlim(in6p, 712 in6p->in6p_route.ro_rt ? 713 in6p->in6p_route.ro_rt->rt_ifp : NULL); 714 ip6->ip6_src = *laddr; 715 ip6->ip6_dst = *faddr; 716 717 if ((udp6->uh_sum = in6_cksum(m, IPPROTO_UDP, 718 sizeof(struct ip6_hdr), plen)) == 0) { 719 udp6->uh_sum = 0xffff; 720 } 721 722 udp6stat.udp6s_opackets++; 723 #ifdef IPSEC 724 m->m_pkthdr.rcvif = (struct ifnet *)in6p->in6p_socket; 725 #endif /*IPSEC*/ 726 error = ip6_output(m, in6p->in6p_outputopts, &in6p->in6p_route, 727 0, in6p->in6p_moptions, NULL); 728 break; 729 case AF_INET: 730 #ifdef INET 731 /* can't transmit jumbogram over IPv4 */ 732 if (plen > 0xffff) { 733 error = EMSGSIZE; 734 goto release; 735 } 736 737 ip = mtod(m, struct ip *); 738 739 ip->ip_len = plen; 740 ip->ip_p = IPPROTO_UDP; 741 ip->ip_ttl = in6p->in6p_hops; /*XXX*/ 742 ip->ip_tos = 0; /*XXX*/ 743 bcopy(&laddr->s6_addr[12], &ip->ip_src, sizeof(ip->ip_src)); 744 bcopy(&faddr->s6_addr[12], &ip->ip_dst, sizeof(ip->ip_dst)); 745 746 udp6->uh_sum = 0; 747 if ((udp6->uh_sum = in_cksum(m, ulen)) == 0) 748 udp6->uh_sum = 0xffff; 749 750 udpstat.udps_opackets++; 751 #ifdef IPSEC 752 m->m_pkthdr.rcvif = NULL; /*XXX*/ 753 #endif /*IPSEC*/ 754 error = ip_output(m, NULL, &in6p->in6p_route, 0 /*XXX*/); 755 break; 756 #else 757 error = EAFNOSUPPORT; 758 goto release; 759 #endif 760 } 761 goto releaseopt; 762 763 release: 764 m_freem(m); 765 766 releaseopt: 767 if (control) { 768 in6p->in6p_outputopts = stickyopt; 769 m_freem(control); 770 } 771 return(error); 772 } 773 774 extern int udp6_sendspace; 775 extern int udp6_recvspace; 776 777 int 778 udp6_usrreq(so, req, m, addr6, control, p) 779 struct socket *so; 780 int req; 781 struct mbuf *m, *addr6, *control; 782 struct proc *p; 783 { 784 struct in6pcb *in6p = sotoin6pcb(so); 785 int error = 0; 786 int s; 787 788 /* 789 * MAPPED_ADDR implementation info: 790 * Mapped addr support for PRU_CONTROL is not necessary. 791 * Because typical user of PRU_CONTROL is such as ifconfig, 792 * and they don't associate any addr to their socket. Then 793 * socket family is only hint about the PRU_CONTROL'ed address 794 * family, especially when getting addrs from kernel. 795 * So AF_INET socket need to be used to control AF_INET addrs, 796 * and AF_INET6 socket for AF_INET6 addrs. 797 */ 798 if (req == PRU_CONTROL) 799 return(in6_control(so, (u_long)m, (caddr_t)addr6, 800 (struct ifnet *)control, p)); 801 802 if (req == PRU_PURGEIF) { 803 in6_purgeif((struct ifnet *)control); 804 in6_pcbpurgeif(&udb6, (struct ifnet *)control); 805 return (0); 806 } 807 808 if (in6p == NULL && req != PRU_ATTACH) { 809 error = EINVAL; 810 goto release; 811 } 812 813 switch (req) { 814 case PRU_ATTACH: 815 /* 816 * MAPPED_ADDR implementation spec: 817 * Always attach for IPv6, 818 * and only when necessary for IPv4. 819 */ 820 if (in6p != NULL) { 821 error = EINVAL; 822 break; 823 } 824 s = splsoftnet(); 825 error = in6_pcballoc(so, &udb6); 826 splx(s); 827 if (error) 828 break; 829 error = soreserve(so, udp6_sendspace, udp6_recvspace); 830 if (error) 831 break; 832 in6p = sotoin6pcb(so); 833 in6p->in6p_cksum = -1; /* just to be sure */ 834 #ifdef IPSEC 835 error = ipsec_init_policy(so, &in6p->in6p_sp); 836 if (error != 0) { 837 in6_pcbdetach(in6p); 838 break; 839 } 840 #endif /*IPSEC*/ 841 break; 842 843 case PRU_DETACH: 844 udp6_detach(in6p); 845 break; 846 847 case PRU_BIND: 848 s = splsoftnet(); 849 error = in6_pcbbind(in6p, addr6); 850 splx(s); 851 break; 852 853 case PRU_LISTEN: 854 error = EOPNOTSUPP; 855 break; 856 857 case PRU_CONNECT: 858 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 859 error = EISCONN; 860 break; 861 } 862 s = splsoftnet(); 863 error = in6_pcbconnect(in6p, addr6); 864 if (ip6_auto_flowlabel) { 865 in6p->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK; 866 in6p->in6p_flowinfo |= 867 (htonl(ip6_flow_seq++) & IPV6_FLOWLABEL_MASK); 868 } 869 splx(s); 870 if (error == 0) 871 soisconnected(so); 872 break; 873 874 case PRU_CONNECT2: 875 error = EOPNOTSUPP; 876 break; 877 878 case PRU_ACCEPT: 879 error = EOPNOTSUPP; 880 break; 881 882 case PRU_DISCONNECT: 883 if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 884 error = ENOTCONN; 885 break; 886 } 887 s = splsoftnet(); 888 in6_pcbdisconnect(in6p); 889 bzero((caddr_t)&in6p->in6p_laddr, sizeof(in6p->in6p_laddr)); 890 splx(s); 891 so->so_state &= ~SS_ISCONNECTED; /* XXX */ 892 break; 893 894 case PRU_SHUTDOWN: 895 socantsendmore(so); 896 break; 897 898 case PRU_SEND: 899 return(udp6_output(in6p, m, addr6, control)); 900 901 case PRU_ABORT: 902 soisdisconnected(so); 903 udp6_detach(in6p); 904 break; 905 906 case PRU_SOCKADDR: 907 in6_setsockaddr(in6p, addr6); 908 break; 909 910 case PRU_PEERADDR: 911 in6_setpeeraddr(in6p, addr6); 912 break; 913 914 case PRU_SENSE: 915 /* 916 * stat: don't bother with a blocksize 917 */ 918 return(0); 919 920 case PRU_SENDOOB: 921 case PRU_FASTTIMO: 922 case PRU_SLOWTIMO: 923 case PRU_PROTORCV: 924 case PRU_PROTOSEND: 925 error = EOPNOTSUPP; 926 break; 927 928 case PRU_RCVD: 929 case PRU_RCVOOB: 930 return(EOPNOTSUPP); /* do not free mbuf's */ 931 932 default: 933 panic("udp6_usrreq"); 934 } 935 936 release: 937 if (control) { 938 printf("udp control data unexpectedly retained\n"); 939 m_freem(control); 940 } 941 if (m) 942 m_freem(m); 943 return(error); 944 } 945 946 static void 947 udp6_detach(in6p) 948 struct in6pcb *in6p; 949 { 950 int s = splsoftnet(); 951 952 if (in6p == udp6_last_in6pcb) 953 udp6_last_in6pcb = &udb6; 954 in6_pcbdetach(in6p); 955 splx(s); 956 } 957 958 #include <vm/vm.h> 959 #include <sys/sysctl.h> 960 961 int 962 udp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen) 963 int *name; 964 u_int namelen; 965 void *oldp; 966 size_t *oldlenp; 967 void *newp; 968 size_t newlen; 969 { 970 /* All sysctl names at this level are terminal. */ 971 if (namelen != 1) 972 return ENOTDIR; 973 974 switch (name[0]) { 975 976 case UDP6CTL_SENDMAX: 977 return sysctl_int(oldp, oldlenp, newp, newlen, 978 &udp6_sendspace); 979 case UDP6CTL_RECVSPACE: 980 return sysctl_int(oldp, oldlenp, newp, newlen, 981 &udp6_recvspace); 982 default: 983 return ENOPROTOOPT; 984 } 985 /* NOTREACHED */ 986 } 987
Indexes created Mon Sep 22 13:09:51 GMT 2025