1 /* 2 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the project nor the names of its contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 * 29 * $FreeBSD: src/sys/netinet6/raw_ip6.c,v 1.7.2.7 2003/01/24 05:11:35 sam Exp $ 30 */ 31 32 /* 33 * Copyright (c) 1982, 1986, 1988, 1993 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 * @(#)raw_ip.c 8.2 (Berkeley) 1/4/94 65 */ 66 67 #include "opt_ipsec.h" 68 #include "opt_inet6.h" 69 70 #include <sys/param.h> 71 #include <sys/malloc.h> 72 #include <sys/proc.h> 73 #include <sys/priv.h> 74 #include <sys/mbuf.h> 75 #include <sys/socket.h> 76 #include <sys/jail.h> 77 #include <sys/protosw.h> 78 #include <sys/socketvar.h> 79 #include <sys/errno.h> 80 #include <sys/systm.h> 81 82 #include <sys/thread2.h> 83 #include <sys/socketvar2.h> 84 #include <sys/msgport2.h> 85 86 #include <net/if.h> 87 #include <net/route.h> 88 #include <net/if_types.h> 89 90 #include <netinet/in.h> 91 #include <netinet/in_var.h> 92 #include <netinet/in_systm.h> 93 #include <netinet/ip6.h> 94 #include <netinet6/ip6_var.h> 95 #include <netinet6/ip6_mroute.h> 96 #include <netinet/icmp6.h> 97 #include <netinet/in_pcb.h> 98 #include <netinet6/in6_pcb.h> 99 #include <netinet6/nd6.h> 100 #include <netinet6/ip6protosw.h> 101 #ifdef ENABLE_DEFAULT_SCOPE 102 #include <netinet6/scope6_var.h> 103 #endif 104 #include <netinet6/raw_ip6.h> 105 106 #ifdef IPSEC 107 #include <netinet6/ipsec.h> 108 #include <netinet6/ipsec6.h> 109 #endif /*IPSEC*/ 110 111 #ifdef FAST_IPSEC 112 #include <netproto/ipsec/ipsec.h> 113 #include <netproto/ipsec/ipsec6.h> 114 #endif /* FAST_IPSEC */ 115 116 #include <machine/stdarg.h> 117 118 #define satosin6(sa) ((struct sockaddr_in6 *)(sa)) 119 #define ifatoia6(ifa) ((struct in6_ifaddr *)(ifa)) 120 121 /* 122 * Raw interface to IP6 protocol. 123 */ 124 125 extern struct inpcbinfo ripcbinfo; 126 extern u_long rip_sendspace; 127 extern u_long rip_recvspace; 128 129 struct rip6stat rip6stat; 130 131 /* 132 * Setup generic address and protocol structures 133 * for raw_input routine, then pass them along with 134 * mbuf chain. 135 */ 136 int 137 rip6_input(struct mbuf **mp, int *offp, int proto) 138 { 139 struct mbuf *m = *mp; 140 struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *); 141 struct inpcb *in6p; 142 struct inpcb *last = NULL; 143 struct mbuf *opts = NULL; 144 struct sockaddr_in6 rip6src; 145 146 rip6stat.rip6s_ipackets++; 147 148 if (faithprefix_p != NULL && (*faithprefix_p)(&ip6->ip6_dst)) { 149 /* XXX send icmp6 host/port unreach? */ 150 m_freem(m); 151 return IPPROTO_DONE; 152 } 153 154 init_sin6(&rip6src, m); /* general init */ 155 156 LIST_FOREACH(in6p, &ripcbinfo.pcblisthead, inp_list) { 157 if (in6p->in6p_flags & INP_PLACEMARKER) 158 continue; 159 if (!(in6p->in6p_vflag & INP_IPV6)) 160 continue; 161 if (in6p->in6p_ip6_nxt && 162 in6p->in6p_ip6_nxt != proto) 163 continue; 164 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) && 165 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst)) 166 continue; 167 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr) && 168 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src)) 169 continue; 170 if (in6p->in6p_cksum != -1) { 171 rip6stat.rip6s_isum++; 172 if (in6_cksum(m, ip6->ip6_nxt, *offp, 173 m->m_pkthdr.len - *offp)) { 174 rip6stat.rip6s_badsum++; 175 continue; 176 } 177 } 178 if (last) { 179 struct mbuf *n = m_copy(m, 0, (int)M_COPYALL); 180 181 #ifdef IPSEC 182 /* 183 * Check AH/ESP integrity. 184 */ 185 if (n && ipsec6_in_reject_so(n, last->inp_socket)) { 186 m_freem(n); 187 ipsec6stat.in_polvio++; 188 /* do not inject data into pcb */ 189 } else 190 #endif /*IPSEC*/ 191 #ifdef FAST_IPSEC 192 /* 193 * Check AH/ESP integrity. 194 */ 195 if (n && ipsec6_in_reject(n, last)) { 196 m_freem(n); 197 /* do not inject data into pcb */ 198 } else 199 #endif /*FAST_IPSEC*/ 200 if (n) { 201 struct socket *so; 202 203 so = last->in6p_socket; 204 if ((last->in6p_flags & IN6P_CONTROLOPTS) || 205 (so->so_options & SO_TIMESTAMP)) { 206 ip6_savecontrol(last, &opts, ip6, n); 207 } 208 /* strip intermediate headers */ 209 m_adj(n, *offp); 210 lwkt_gettoken(&so->so_rcv.ssb_token); 211 if (ssb_appendaddr(&so->so_rcv, 212 (struct sockaddr *)&rip6src, 213 n, opts) == 0) { 214 m_freem(n); 215 if (opts) 216 m_freem(opts); 217 rip6stat.rip6s_fullsock++; 218 } else { 219 sorwakeup(so); 220 } 221 lwkt_reltoken(&so->so_rcv.ssb_token); 222 opts = NULL; 223 } 224 } 225 last = in6p; 226 } 227 #ifdef IPSEC 228 /* 229 * Check AH/ESP integrity. 230 */ 231 if (last && ipsec6_in_reject_so(m, last->inp_socket)) { 232 m_freem(m); 233 ipsec6stat.in_polvio++; 234 ip6stat.ip6s_delivered--; 235 /* do not inject data into pcb */ 236 } else 237 #endif /*IPSEC*/ 238 #ifdef FAST_IPSEC 239 /* 240 * Check AH/ESP integrity. 241 */ 242 if (last && ipsec6_in_reject(m, last)) { 243 m_freem(m); 244 ip6stat.ip6s_delivered--; 245 /* do not inject data into pcb */ 246 } else 247 #endif /*FAST_IPSEC*/ 248 if (last) { 249 struct socket *so; 250 251 so = last->in6p_socket; 252 if ((last->in6p_flags & IN6P_CONTROLOPTS) || 253 (so->so_options & SO_TIMESTAMP)) { 254 ip6_savecontrol(last, &opts, ip6, m); 255 } 256 /* strip intermediate headers */ 257 m_adj(m, *offp); 258 lwkt_gettoken(&so->so_rcv.ssb_token); 259 if (ssb_appendaddr(&so->so_rcv, (struct sockaddr *)&rip6src, 260 m, opts) == 0) { 261 m_freem(m); 262 if (opts) 263 m_freem(opts); 264 rip6stat.rip6s_fullsock++; 265 } else { 266 sorwakeup(so); 267 } 268 lwkt_reltoken(&so->so_rcv.ssb_token); 269 } else { 270 rip6stat.rip6s_nosock++; 271 if (m->m_flags & M_MCAST) 272 rip6stat.rip6s_nosockmcast++; 273 if (proto == IPPROTO_NONE) 274 m_freem(m); 275 else { 276 char *prvnxtp = ip6_get_prevhdr(m, *offp); /* XXX */ 277 icmp6_error(m, ICMP6_PARAM_PROB, 278 ICMP6_PARAMPROB_NEXTHEADER, 279 prvnxtp - mtod(m, char *)); 280 } 281 ip6stat.ip6s_delivered--; 282 } 283 return IPPROTO_DONE; 284 } 285 286 void 287 rip6_ctlinput(netmsg_t msg) 288 { 289 int cmd = msg->ctlinput.nm_cmd; 290 struct sockaddr *sa = msg->ctlinput.nm_arg; 291 void *d = msg->ctlinput.nm_extra; 292 struct ip6_hdr *ip6; 293 struct mbuf *m; 294 int off = 0; 295 struct ip6ctlparam *ip6cp = NULL; 296 const struct sockaddr_in6 *sa6_src = NULL; 297 void (*notify) (struct inpcb *, int) = in6_rtchange; 298 299 if (sa->sa_family != AF_INET6 || 300 sa->sa_len != sizeof(struct sockaddr_in6)) 301 goto out; 302 303 if ((unsigned)cmd >= PRC_NCMDS) 304 goto out; 305 if (PRC_IS_REDIRECT(cmd)) 306 notify = in6_rtchange, d = NULL; 307 else if (cmd == PRC_HOSTDEAD) 308 d = NULL; 309 else if (inet6ctlerrmap[cmd] == 0) 310 goto out; 311 312 /* if the parameter is from icmp6, decode it. */ 313 if (d != NULL) { 314 ip6cp = (struct ip6ctlparam *)d; 315 m = ip6cp->ip6c_m; 316 ip6 = ip6cp->ip6c_ip6; 317 off = ip6cp->ip6c_off; 318 sa6_src = ip6cp->ip6c_src; 319 } else { 320 m = NULL; 321 ip6 = NULL; 322 sa6_src = &sa6_any; 323 } 324 325 in6_pcbnotify(&ripcbinfo.pcblisthead, sa, 0, 326 (const struct sockaddr *)sa6_src, 0, cmd, 0, notify); 327 out: 328 lwkt_replymsg(&msg->ctlinput.base.lmsg, 0); 329 } 330 331 /* 332 * Generate IPv6 header and pass packet to ip6_output. 333 * Tack on options user may have setup with control call. 334 */ 335 int 336 rip6_output(struct mbuf *m, struct socket *so, ...) 337 { 338 struct sockaddr_in6 *dstsock; 339 struct mbuf *control; 340 struct in6_addr *dst; 341 struct ip6_hdr *ip6; 342 struct inpcb *in6p; 343 u_int plen = m->m_pkthdr.len; 344 int error = 0; 345 struct ip6_pktopts opt, *optp = NULL; 346 struct ifnet *oifp = NULL; 347 int type = 0, code = 0; /* for ICMPv6 output statistics only */ 348 int priv = 0; 349 __va_list ap; 350 351 __va_start(ap, so); 352 dstsock = __va_arg(ap, struct sockaddr_in6 *); 353 control = __va_arg(ap, struct mbuf *); 354 __va_end(ap); 355 356 in6p = so->so_pcb; 357 358 priv = 0; 359 if (so->so_cred->cr_uid == 0) 360 priv = 1; 361 dst = &dstsock->sin6_addr; 362 if (control) { 363 if ((error = ip6_setpktoptions(control, &opt, 364 in6p->in6p_outputopts, 365 so->so_proto->pr_protocol, priv)) != 0) 366 goto bad; 367 optp = &opt; 368 } else 369 optp = in6p->in6p_outputopts; 370 371 /* 372 * For an ICMPv6 packet, we should know its type and code 373 * to update statistics. 374 */ 375 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) { 376 struct icmp6_hdr *icmp6; 377 if (m->m_len < sizeof(struct icmp6_hdr) && 378 (m = m_pullup(m, sizeof(struct icmp6_hdr))) == NULL) { 379 error = ENOBUFS; 380 goto bad; 381 } 382 icmp6 = mtod(m, struct icmp6_hdr *); 383 type = icmp6->icmp6_type; 384 code = icmp6->icmp6_code; 385 } 386 387 M_PREPEND(m, sizeof(*ip6), MB_WAIT); 388 ip6 = mtod(m, struct ip6_hdr *); 389 390 /* 391 * Next header might not be ICMP6 but use its pseudo header anyway. 392 */ 393 ip6->ip6_dst = *dst; 394 395 /* 396 * If the scope of the destination is link-local, embed the interface 397 * index in the address. 398 * 399 * XXX advanced-api value overrides sin6_scope_id 400 */ 401 if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) { 402 struct in6_pktinfo *pi; 403 404 /* 405 * XXX Boundary check is assumed to be already done in 406 * ip6_setpktoptions(). 407 */ 408 if (optp && (pi = optp->ip6po_pktinfo) && pi->ipi6_ifindex) { 409 ip6->ip6_dst.s6_addr16[1] = htons(pi->ipi6_ifindex); 410 oifp = ifindex2ifnet[pi->ipi6_ifindex]; 411 } else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) && 412 in6p->in6p_moptions && 413 in6p->in6p_moptions->im6o_multicast_ifp) { 414 oifp = in6p->in6p_moptions->im6o_multicast_ifp; 415 ip6->ip6_dst.s6_addr16[1] = htons(oifp->if_index); 416 } else if (dstsock->sin6_scope_id) { 417 /* boundary check */ 418 if (dstsock->sin6_scope_id < 0 419 || if_index < dstsock->sin6_scope_id) { 420 error = ENXIO; /* XXX EINVAL? */ 421 goto bad; 422 } 423 ip6->ip6_dst.s6_addr16[1] 424 = htons(dstsock->sin6_scope_id & 0xffff);/*XXX*/ 425 } 426 } 427 428 /* 429 * Source address selection. 430 */ 431 { 432 struct in6_addr *in6a; 433 434 if ((in6a = in6_selectsrc(dstsock, optp, 435 in6p->in6p_moptions, 436 &in6p->in6p_route, 437 &in6p->in6p_laddr, 438 &error, NULL)) == NULL) { 439 if (error == 0) 440 error = EADDRNOTAVAIL; 441 goto bad; 442 } 443 ip6->ip6_src = *in6a; 444 if (in6p->in6p_route.ro_rt) 445 oifp = ifindex2ifnet[in6p->in6p_route.ro_rt->rt_ifp->if_index]; 446 } 447 ip6->ip6_flow = (ip6->ip6_flow & ~IPV6_FLOWINFO_MASK) | 448 (in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK); 449 ip6->ip6_vfc = (ip6->ip6_vfc & ~IPV6_VERSION_MASK) | 450 (IPV6_VERSION & IPV6_VERSION_MASK); 451 /* ip6_plen will be filled in ip6_output, so not fill it here. */ 452 ip6->ip6_nxt = in6p->in6p_ip6_nxt; 453 ip6->ip6_hlim = in6_selecthlim(in6p, oifp); 454 455 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6 || 456 in6p->in6p_cksum != -1) { 457 struct mbuf *n; 458 int off; 459 u_int16_t *p; 460 461 /* compute checksum */ 462 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) 463 off = offsetof(struct icmp6_hdr, icmp6_cksum); 464 else 465 off = in6p->in6p_cksum; 466 if (plen < off + 1) { 467 error = EINVAL; 468 goto bad; 469 } 470 off += sizeof(struct ip6_hdr); 471 472 n = m; 473 while (n && n->m_len <= off) { 474 off -= n->m_len; 475 n = n->m_next; 476 } 477 if (!n) 478 goto bad; 479 p = (u_int16_t *)(mtod(n, caddr_t) + off); 480 *p = 0; 481 *p = in6_cksum(m, ip6->ip6_nxt, sizeof(*ip6), plen); 482 } 483 484 error = ip6_output(m, optp, &in6p->in6p_route, 0, 485 in6p->in6p_moptions, &oifp, in6p); 486 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) { 487 if (oifp) 488 icmp6_ifoutstat_inc(oifp, type, code); 489 icmp6stat.icp6s_outhist[type]++; 490 } else 491 rip6stat.rip6s_opackets++; 492 493 goto freectl; 494 495 bad: 496 if (m) 497 m_freem(m); 498 499 freectl: 500 if (optp == &opt && optp->ip6po_rthdr && optp->ip6po_route.ro_rt) 501 RTFREE(optp->ip6po_route.ro_rt); 502 if (control) { 503 if (optp == &opt) 504 ip6_clearpktopts(optp, -1); 505 m_freem(control); 506 } 507 return (error); 508 } 509 510 /* 511 * Raw IPv6 socket option processing. 512 */ 513 void 514 rip6_ctloutput(netmsg_t msg) 515 { 516 struct socket *so = msg->ctloutput.base.nm_so;; 517 struct sockopt *sopt = msg->ctloutput.nm_sopt; 518 int error; 519 520 if (sopt->sopt_level == IPPROTO_ICMPV6) { 521 /* 522 * XXX: is it better to call icmp6_ctloutput() directly 523 * from protosw? 524 */ 525 icmp6_ctloutput(msg); 526 /* msg invalid now */ 527 return; 528 } 529 if (sopt->sopt_level != IPPROTO_IPV6) { 530 error = EINVAL; 531 goto out; 532 } 533 534 error = 0; 535 536 switch (sopt->sopt_dir) { 537 case SOPT_GET: 538 switch (sopt->sopt_name) { 539 case MRT6_INIT: 540 case MRT6_DONE: 541 case MRT6_ADD_MIF: 542 case MRT6_DEL_MIF: 543 case MRT6_ADD_MFC: 544 case MRT6_DEL_MFC: 545 case MRT6_PIM: 546 error = ip6_mrouter_get(so, sopt); 547 break; 548 case IPV6_CHECKSUM: 549 error = ip6_raw_ctloutput(so, sopt); 550 break; 551 default: 552 error = ip6_ctloutput(so, sopt); 553 break; 554 } 555 break; 556 557 case SOPT_SET: 558 switch (sopt->sopt_name) { 559 case MRT6_INIT: 560 case MRT6_DONE: 561 case MRT6_ADD_MIF: 562 case MRT6_DEL_MIF: 563 case MRT6_ADD_MFC: 564 case MRT6_DEL_MFC: 565 case MRT6_PIM: 566 error = ip6_mrouter_set(so, sopt); 567 break; 568 case IPV6_CHECKSUM: 569 error = ip6_raw_ctloutput(so, sopt); 570 break; 571 default: 572 error = ip6_ctloutput(so, sopt); 573 break; 574 } 575 break; 576 } 577 out: 578 lwkt_replymsg(&msg->ctloutput.base.lmsg, error); 579 } 580 581 static void 582 rip6_attach(netmsg_t msg) 583 { 584 struct socket *so = msg->attach.base.nm_so; 585 int proto = msg->attach.nm_proto; 586 struct pru_attach_info *ai = msg->attach.nm_ai; 587 struct inpcb *inp; 588 int error; 589 590 inp = so->so_pcb; 591 if (inp) 592 panic("rip6_attach"); 593 error = priv_check_cred(ai->p_ucred, PRIV_NETINET_RAW, NULL_CRED_OKAY); 594 if (error) 595 goto out; 596 597 error = soreserve(so, rip_sendspace, rip_recvspace, ai->sb_rlimit); 598 if (error) 599 goto out; 600 crit_enter(); 601 error = in_pcballoc(so, &ripcbinfo); 602 crit_exit(); 603 if (error) 604 goto out; 605 inp = (struct inpcb *)so->so_pcb; 606 inp->inp_vflag |= INP_IPV6; 607 inp->in6p_ip6_nxt = (long)proto; 608 inp->in6p_hops = -1; /* use kernel default */ 609 inp->in6p_cksum = -1; 610 inp->in6p_icmp6filt = kmalloc(sizeof(struct icmp6_filter), M_PCB, 611 M_NOWAIT); 612 if (inp->in6p_icmp6filt != NULL) 613 ICMP6_FILTER_SETPASSALL(inp->in6p_icmp6filt); 614 error = 0; 615 out: 616 lwkt_replymsg(&msg->attach.base.lmsg, error); 617 } 618 619 static void 620 rip6_detach(netmsg_t msg) 621 { 622 struct socket *so = msg->detach.base.nm_so; 623 struct inpcb *inp; 624 625 inp = so->so_pcb; 626 if (inp == NULL) 627 panic("rip6_detach"); 628 /* xxx: RSVP */ 629 if (so == ip6_mrouter) 630 ip6_mrouter_done(); 631 if (inp->in6p_icmp6filt) { 632 kfree(inp->in6p_icmp6filt, M_PCB); 633 inp->in6p_icmp6filt = NULL; 634 } 635 in6_pcbdetach(inp); 636 lwkt_replymsg(&msg->detach.base.lmsg, 0); 637 } 638 639 /* 640 * NOTE: (so) is referenced from soabort*() and netmsg_pru_abort() 641 * will sofree() it when we return. 642 */ 643 static void 644 rip6_abort(netmsg_t msg) 645 { 646 soisdisconnected(msg->abort.base.nm_so); 647 rip6_detach(msg); 648 /* msg invalid now */ 649 } 650 651 static void 652 rip6_disconnect(netmsg_t msg) 653 { 654 struct socket *so = msg->disconnect.base.nm_so; 655 struct inpcb *inp = so->so_pcb; 656 657 if (so->so_state & SS_ISCONNECTED) { 658 inp->in6p_faddr = kin6addr_any; 659 soreference(so); 660 rip6_abort(msg); 661 /* msg invalid now */ 662 sofree(so); 663 return; 664 } 665 lwkt_replymsg(&msg->disconnect.base.lmsg, ENOTCONN); 666 } 667 668 static void 669 rip6_bind(netmsg_t msg) 670 { 671 struct socket *so = msg->bind.base.nm_so; 672 struct sockaddr *nam = msg->bind.nm_nam; 673 struct inpcb *inp = so->so_pcb; 674 struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam; 675 struct ifaddr *ia = NULL; 676 int error; 677 678 if (nam->sa_len != sizeof(*addr)) { 679 error = EINVAL; 680 goto out; 681 } 682 683 if (TAILQ_EMPTY(&ifnet) || addr->sin6_family != AF_INET6) { 684 error = EADDRNOTAVAIL; 685 goto out; 686 } 687 #ifdef ENABLE_DEFAULT_SCOPE 688 if (addr->sin6_scope_id == 0) { /* not change if specified */ 689 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr); 690 } 691 #endif 692 if (!IN6_IS_ADDR_UNSPECIFIED(&addr->sin6_addr) && 693 (ia = ifa_ifwithaddr((struct sockaddr *)addr)) == NULL) { 694 error = EADDRNOTAVAIL; 695 goto out; 696 } 697 if (ia && 698 ((struct in6_ifaddr *)ia)->ia6_flags & 699 (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY| 700 IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)) { 701 error = EADDRNOTAVAIL; 702 goto out; 703 } 704 inp->in6p_laddr = addr->sin6_addr; 705 error = 0; 706 out: 707 lwkt_replymsg(&msg->bind.base.lmsg, error); 708 } 709 710 static void 711 rip6_connect(netmsg_t msg) 712 { 713 struct socket *so = msg->connect.base.nm_so; 714 struct sockaddr *nam = msg->connect.nm_nam; 715 struct inpcb *inp = so->so_pcb; 716 struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam; 717 struct in6_addr *in6a = NULL; 718 int error = 0; 719 #ifdef ENABLE_DEFAULT_SCOPE 720 struct sockaddr_in6 tmp; 721 #endif 722 723 if (nam->sa_len != sizeof(*addr)) { 724 error = EINVAL; 725 goto out; 726 } 727 if (TAILQ_EMPTY(&ifnet)) { 728 error = EADDRNOTAVAIL; 729 goto out; 730 } 731 if (addr->sin6_family != AF_INET6) { 732 error = EAFNOSUPPORT; 733 goto out; 734 } 735 #ifdef ENABLE_DEFAULT_SCOPE 736 if (addr->sin6_scope_id == 0) { /* not change if specified */ 737 /* avoid overwrites */ 738 tmp = *addr; 739 addr = &tmp; 740 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr); 741 } 742 #endif 743 /* Source address selection. XXX: need pcblookup? */ 744 in6a = in6_selectsrc(addr, inp->in6p_outputopts, 745 inp->in6p_moptions, &inp->in6p_route, 746 &inp->in6p_laddr, &error, NULL); 747 if (in6a == NULL) { 748 if (error == 0) 749 error = EADDRNOTAVAIL; 750 } else { 751 inp->in6p_laddr = *in6a; 752 inp->in6p_faddr = addr->sin6_addr; 753 soisconnected(so); 754 error = 0; 755 } 756 out: 757 lwkt_replymsg(&msg->connect.base.lmsg, error); 758 } 759 760 static void 761 rip6_shutdown(netmsg_t msg) 762 { 763 socantsendmore(msg->shutdown.base.nm_so); 764 lwkt_replymsg(&msg->shutdown.base.lmsg, 0); 765 } 766 767 static void 768 rip6_send(netmsg_t msg) 769 { 770 struct socket *so = msg->send.base.nm_so; 771 struct mbuf *m = msg->send.nm_m; 772 struct sockaddr *nam = msg->send.nm_addr; 773 struct mbuf *control = msg->send.nm_control; 774 struct inpcb *inp = so->so_pcb; 775 struct sockaddr_in6 tmp; 776 struct sockaddr_in6 *dst; 777 int error; 778 779 /* always copy sockaddr to avoid overwrites */ 780 if (so->so_state & SS_ISCONNECTED) { 781 if (nam) { 782 m_freem(m); 783 error = EISCONN; 784 goto out; 785 } 786 /* XXX */ 787 bzero(&tmp, sizeof(tmp)); 788 tmp.sin6_family = AF_INET6; 789 tmp.sin6_len = sizeof(struct sockaddr_in6); 790 bcopy(&inp->in6p_faddr, &tmp.sin6_addr, 791 sizeof(struct in6_addr)); 792 dst = &tmp; 793 } else { 794 if (nam == NULL) { 795 m_freem(m); 796 error = ENOTCONN; 797 goto out; 798 } 799 tmp = *(struct sockaddr_in6 *)nam; 800 dst = &tmp; 801 } 802 #ifdef ENABLE_DEFAULT_SCOPE 803 if (dst->sin6_scope_id == 0) { /* not change if specified */ 804 dst->sin6_scope_id = scope6_addr2default(&dst->sin6_addr); 805 } 806 #endif 807 error = rip6_output(m, so, dst, control); 808 out: 809 lwkt_replymsg(&msg->send.base.lmsg, error); 810 } 811 812 struct pr_usrreqs rip6_usrreqs = { 813 .pru_abort = rip6_abort, 814 .pru_accept = pr_generic_notsupp, 815 .pru_attach = rip6_attach, 816 .pru_bind = rip6_bind, 817 .pru_connect = rip6_connect, 818 .pru_connect2 = pr_generic_notsupp, 819 .pru_control = in6_control_dispatch, 820 .pru_detach = rip6_detach, 821 .pru_disconnect = rip6_disconnect, 822 .pru_listen = pr_generic_notsupp, 823 .pru_peeraddr = in6_setpeeraddr_dispatch, 824 .pru_rcvd = pr_generic_notsupp, 825 .pru_rcvoob = pr_generic_notsupp, 826 .pru_send = rip6_send, 827 .pru_sense = pru_sense_null, 828 .pru_shutdown = rip6_shutdown, 829 .pru_sockaddr = in6_setsockaddr_dispatch, 830 .pru_sosend = sosend, 831 .pru_soreceive = soreceive 832 }; 833