sys/netinet6/raw_ip6.c

   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  * $DragonFly: src/sys/netinet6/raw_ip6.c,v 1.16 2004/10/15 22:59:10 hsu Exp $
  31  */
  32
  33 /*
  34  * Copyright (c) 1982, 1986, 1988, 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  *      @(#)raw_ip.c    8.2 (Berkeley) 1/4/94
  66  */
  67
  68 #include "opt_ipsec.h"
  69 #include "opt_inet6.h"
  70
  71 #include <sys/param.h>
  72 #include <sys/malloc.h>
  73 #include <sys/proc.h>
  74 #include <sys/mbuf.h>
  75 #include <sys/socket.h>
  76 #include <sys/protosw.h>
  77 #include <sys/socketvar.h>
  78 #include <sys/errno.h>
  79 #include <sys/systm.h>
  80
  81 #include <net/if.h>
  82 #include <net/route.h>
  83 #include <net/if_types.h>
  84
  85 #include <netinet/in.h>
  86 #include <netinet/in_var.h>
  87 #include <netinet/in_systm.h>
  88 #include <netinet/ip6.h>
  89 #include <netinet6/ip6_var.h>
  90 #include <netinet6/ip6_mroute.h>
  91 #include <netinet/icmp6.h>
  92 #include <netinet/in_pcb.h>
  93 #include <netinet6/in6_pcb.h>
  94 #include <netinet6/nd6.h>
  95 #include <netinet6/ip6protosw.h>
  96 #ifdef ENABLE_DEFAULT_SCOPE
  97 #include <netinet6/scope6_var.h>
  98 #endif
  99 #include <netinet6/raw_ip6.h>
 100
 101 #ifdef IPSEC
 102 #include <netinet6/ipsec.h>
 103 #include <netinet6/ipsec6.h>
 104 #endif /*IPSEC*/
 105
 106 #ifdef FAST_IPSEC
 107 #include <netproto/ipsec/ipsec.h>
 108 #include <netproto/ipsec/ipsec6.h>
 109 #endif /* FAST_IPSEC */
 110
 111 #include <machine/stdarg.h>
 112
 113 #define satosin6(sa)    ((struct sockaddr_in6 *)(sa))
 114 #define ifatoia6(ifa)   ((struct in6_ifaddr *)(ifa))
 115
 116 /*
 117  * Raw interface to IP6 protocol.
 118  */
 119
 120 extern struct   inpcbinfo ripcbinfo;
 121 extern u_long   rip_sendspace;
 122 extern u_long   rip_recvspace;
 123
 124 struct rip6stat rip6stat;
 125
 126 /*
 127  * Setup generic address and protocol structures
 128  * for raw_input routine, then pass them along with
 129  * mbuf chain.
 130  */
 131 int
 132 rip6_input(struct mbuf **mp, int *offp, int proto)
 133 {
 134         struct mbuf *m = *mp;
 135         struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
 136         struct inpcb *in6p;
 137         struct inpcb *last = 0;
 138         struct mbuf *opts = NULL;
 139         struct sockaddr_in6 rip6src;
 140
 141         rip6stat.rip6s_ipackets++;
 142
 143         if (faithprefix_p != NULL && (*faithprefix_p)(&ip6->ip6_dst)) {
 144                 /* XXX send icmp6 host/port unreach? */
 145                 m_freem(m);
 146                 return IPPROTO_DONE;
 147         }
 148
 149         init_sin6(&rip6src, m); /* general init */
 150
 151         LIST_FOREACH(in6p, &ripcbinfo.pcblisthead, inp_list) {
 152                 if (in6p->in6p_flags & INP_PLACEMARKER)
 153                         continue;
 154                 if ((in6p->in6p_vflag & INP_IPV6) == 0)
 155                         continue;
 156                 if (in6p->in6p_ip6_nxt &&
 157                     in6p->in6p_ip6_nxt != proto)
 158                         continue;
 159                 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) &&
 160                     !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst))
 161                         continue;
 162                 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr) &&
 163                     !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src))
 164                         continue;
 165                 if (in6p->in6p_cksum != -1) {
 166                         rip6stat.rip6s_isum++;
 167                         if (in6_cksum(m, ip6->ip6_nxt, *offp,
 168                             m->m_pkthdr.len - *offp)) {
 169                                 rip6stat.rip6s_badsum++;
 170                                 continue;
 171                         }
 172                 }
 173                 if (last) {
 174                         struct mbuf *n = m_copy(m, 0, (int)M_COPYALL);
 175
 176 #ifdef IPSEC
 177                         /*
 178                          * Check AH/ESP integrity.
 179                          */
 180                         if (n && ipsec6_in_reject_so(n, last->inp_socket)) {
 181                                 m_freem(n);
 182                                 ipsec6stat.in_polvio++;
 183                                 /* do not inject data into pcb */
 184                         } else
 185 #endif /*IPSEC*/
 186 #ifdef FAST_IPSEC
 187                         /*
 188                          * Check AH/ESP integrity.
 189                          */
 190                         if (n && ipsec6_in_reject(n, last)) {
 191                                 m_freem(n);
 192                                 /* do not inject data into pcb */
 193                         } else
 194 #endif /*FAST_IPSEC*/
 195                         if (n) {
 196                                 if (last->in6p_flags & IN6P_CONTROLOPTS ||
 197                                     last->in6p_socket->so_options & SO_TIMESTAMP)
 198                                         ip6_savecontrol(last, &opts, ip6, n);
 199                                 /* strip intermediate headers */
 200                                 m_adj(n, *offp);
 201                                 if (sbappendaddr(&last->in6p_socket->so_rcv,
 202                                                 (struct sockaddr *)&rip6src,
 203                                                  n, opts) == 0) {
 204                                         m_freem(n);
 205                                         if (opts)
 206                                                 m_freem(opts);
 207                                         rip6stat.rip6s_fullsock++;
 208                                 } else
 209                                         sorwakeup(last->in6p_socket);
 210                                 opts = NULL;
 211                         }
 212                 }
 213                 last = in6p;
 214         }
 215 #ifdef IPSEC
 216         /*
 217          * Check AH/ESP integrity.
 218          */
 219         if (last && ipsec6_in_reject_so(m, last->inp_socket)) {
 220                 m_freem(m);
 221                 ipsec6stat.in_polvio++;
 222                 ip6stat.ip6s_delivered--;
 223                 /* do not inject data into pcb */
 224         } else
 225 #endif /*IPSEC*/
 226 #ifdef FAST_IPSEC
 227         /*
 228          * Check AH/ESP integrity.
 229          */
 230         if (last && ipsec6_in_reject(m, last)) {
 231                 m_freem(m);
 232                 ip6stat.ip6s_delivered--;
 233                 /* do not inject data into pcb */
 234         } else
 235 #endif /*FAST_IPSEC*/
 236         if (last) {
 237                 if (last->in6p_flags & IN6P_CONTROLOPTS ||
 238                     last->in6p_socket->so_options & SO_TIMESTAMP)
 239                         ip6_savecontrol(last, &opts, ip6, m);
 240                 /* strip intermediate headers */
 241                 m_adj(m, *offp);
 242                 if (sbappendaddr(&last->in6p_socket->so_rcv,
 243                                 (struct sockaddr *)&rip6src, m, opts) == 0) {
 244                         m_freem(m);
 245                         if (opts)
 246                                 m_freem(opts);
 247                         rip6stat.rip6s_fullsock++;
 248                 } else
 249                         sorwakeup(last->in6p_socket);
 250         } else {
 251                 rip6stat.rip6s_nosock++;
 252                 if (m->m_flags & M_MCAST)
 253                         rip6stat.rip6s_nosockmcast++;
 254                 if (proto == IPPROTO_NONE)
 255                         m_freem(m);
 256                 else {
 257                         char *prvnxtp = ip6_get_prevhdr(m, *offp); /* XXX */
 258                         icmp6_error(m, ICMP6_PARAM_PROB,
 259                                     ICMP6_PARAMPROB_NEXTHEADER,
 260                                     prvnxtp - mtod(m, char *));
 261                 }
 262                 ip6stat.ip6s_delivered--;
 263         }
 264         return IPPROTO_DONE;
 265 }
 266
 267 void
 268 rip6_ctlinput(int cmd, struct sockaddr *sa, void *d)
 269 {
 270         struct ip6_hdr *ip6;
 271         struct mbuf *m;
 272         int off = 0;
 273         struct ip6ctlparam *ip6cp = NULL;
 274         const struct sockaddr_in6 *sa6_src = NULL;
 275         void (*notify) (struct inpcb *, int) = in6_rtchange;
 276
 277         if (sa->sa_family != AF_INET6 ||
 278             sa->sa_len != sizeof(struct sockaddr_in6))
 279                 return;
 280
 281         if ((unsigned)cmd >= PRC_NCMDS)
 282                 return;
 283         if (PRC_IS_REDIRECT(cmd))
 284                 notify = in6_rtchange, d = NULL;
 285         else if (cmd == PRC_HOSTDEAD)
 286                 d = NULL;
 287         else if (inet6ctlerrmap[cmd] == 0)
 288                 return;
 289
 290         /* if the parameter is from icmp6, decode it. */
 291         if (d != NULL) {
 292                 ip6cp = (struct ip6ctlparam *)d;
 293                 m = ip6cp->ip6c_m;
 294                 ip6 = ip6cp->ip6c_ip6;
 295                 off = ip6cp->ip6c_off;
 296                 sa6_src = ip6cp->ip6c_src;
 297         } else {
 298                 m = NULL;
 299                 ip6 = NULL;
 300                 sa6_src = &sa6_any;
 301         }
 302
 303         (void) in6_pcbnotify(&ripcbinfo.pcblisthead, sa, 0,
 304                              (const struct sockaddr *)sa6_src,
 305                              0, cmd, notify);
 306 }
 307
 308 /*
 309  * Generate IPv6 header and pass packet to ip6_output.
 310  * Tack on options user may have setup with control call.
 311  */
 312 int
 313 rip6_output(struct mbuf *m, struct socket *so, ...)
 314 {
 315         struct sockaddr_in6 *dstsock;
 316         struct mbuf *control;
 317         struct in6_addr *dst;
 318         struct ip6_hdr *ip6;
 319         struct inpcb *in6p;
 320         u_int   plen = m->m_pkthdr.len;
 321         int error = 0;
 322         struct ip6_pktopts opt, *optp = 0;
 323         struct ifnet *oifp = NULL;
 324         int type = 0, code = 0;         /* for ICMPv6 output statistics only */
 325         int priv = 0;
 326         __va_list ap;
 327
 328         __va_start(ap, so);
 329         dstsock = __va_arg(ap, struct sockaddr_in6 *);
 330         control = __va_arg(ap, struct mbuf *);
 331         __va_end(ap);
 332
 333         in6p = sotoin6pcb(so);
 334
 335         priv = 0;
 336         if (so->so_cred->cr_uid == 0)
 337                 priv = 1;
 338         dst = &dstsock->sin6_addr;
 339         if (control) {
 340                 if ((error = ip6_setpktoptions(control, &opt, priv, 0)) != 0)
 341                         goto bad;
 342                 optp = &opt;
 343         } else
 344                 optp = in6p->in6p_outputopts;
 345
 346         /*
 347          * For an ICMPv6 packet, we should know its type and code
 348          * to update statistics.
 349          */
 350         if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
 351                 struct icmp6_hdr *icmp6;
 352                 if (m->m_len < sizeof(struct icmp6_hdr) &&
 353                     (m = m_pullup(m, sizeof(struct icmp6_hdr))) == NULL) {
 354                         error = ENOBUFS;
 355                         goto bad;
 356                 }
 357                 icmp6 = mtod(m, struct icmp6_hdr *);
 358                 type = icmp6->icmp6_type;
 359                 code = icmp6->icmp6_code;
 360         }
 361
 362         M_PREPEND(m, sizeof(*ip6), MB_WAIT);
 363         ip6 = mtod(m, struct ip6_hdr *);
 364
 365         /*
 366          * Next header might not be ICMP6 but use its pseudo header anyway.
 367          */
 368         ip6->ip6_dst = *dst;
 369
 370         /*
 371          * If the scope of the destination is link-local, embed the interface
 372          * index in the address.
 373          *
 374          * XXX advanced-api value overrides sin6_scope_id
 375          */
 376         if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) {
 377                 struct in6_pktinfo *pi;
 378
 379                 /*
 380                  * XXX Boundary check is assumed to be already done in
 381                  * ip6_setpktoptions().
 382                  */
 383                 if (optp && (pi = optp->ip6po_pktinfo) && pi->ipi6_ifindex) {
 384                         ip6->ip6_dst.s6_addr16[1] = htons(pi->ipi6_ifindex);
 385                         oifp = ifindex2ifnet[pi->ipi6_ifindex];
 386                 } else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) &&
 387                          in6p->in6p_moptions &&
 388                          in6p->in6p_moptions->im6o_multicast_ifp) {
 389                         oifp = in6p->in6p_moptions->im6o_multicast_ifp;
 390                         ip6->ip6_dst.s6_addr16[1] = htons(oifp->if_index);
 391                 } else if (dstsock->sin6_scope_id) {
 392                         /* boundary check */
 393                         if (dstsock->sin6_scope_id < 0
 394                          || if_index < dstsock->sin6_scope_id) {
 395                                 error = ENXIO;  /* XXX EINVAL? */
 396                                 goto bad;
 397                         }
 398                         ip6->ip6_dst.s6_addr16[1]
 399                                 = htons(dstsock->sin6_scope_id & 0xffff);/*XXX*/
 400                 }
 401         }
 402
 403         /*
 404          * Source address selection.
 405          */
 406         {
 407                 struct in6_addr *in6a;
 408
 409                 if ((in6a = in6_selectsrc(dstsock, optp,
 410                                           in6p->in6p_moptions,
 411                                           &in6p->in6p_route,
 412                                           &in6p->in6p_laddr,
 413                                           &error)) == 0) {
 414                         if (error == 0)
 415                                 error = EADDRNOTAVAIL;
 416                         goto bad;
 417                 }
 418                 ip6->ip6_src = *in6a;
 419                 if (in6p->in6p_route.ro_rt)
 420                         oifp = ifindex2ifnet[in6p->in6p_route.ro_rt->rt_ifp->if_index];
 421         }
 422         ip6->ip6_flow = (ip6->ip6_flow & ~IPV6_FLOWINFO_MASK) |
 423                 (in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK);
 424         ip6->ip6_vfc = (ip6->ip6_vfc & ~IPV6_VERSION_MASK) |
 425                 (IPV6_VERSION & IPV6_VERSION_MASK);
 426         /* ip6_plen will be filled in ip6_output, so not fill it here. */
 427         ip6->ip6_nxt = in6p->in6p_ip6_nxt;
 428         ip6->ip6_hlim = in6_selecthlim(in6p, oifp);
 429
 430         if (so->so_proto->pr_protocol == IPPROTO_ICMPV6 ||
 431             in6p->in6p_cksum != -1) {
 432                 struct mbuf *n;
 433                 int off;
 434                 u_int16_t *p;
 435
 436                 /* compute checksum */
 437                 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
 438                         off = offsetof(struct icmp6_hdr, icmp6_cksum);
 439                 else
 440                         off = in6p->in6p_cksum;
 441                 if (plen < off + 1) {
 442                         error = EINVAL;
 443                         goto bad;
 444                 }
 445                 off += sizeof(struct ip6_hdr);
 446
 447                 n = m;
 448                 while (n && n->m_len <= off) {
 449                         off -= n->m_len;
 450                         n = n->m_next;
 451                 }
 452                 if (!n)
 453                         goto bad;
 454                 p = (u_int16_t *)(mtod(n, caddr_t) + off);
 455                 *p = 0;
 456                 *p = in6_cksum(m, ip6->ip6_nxt, sizeof(*ip6), plen);
 457         }
 458
 459         error = ip6_output(m, optp, &in6p->in6p_route, 0,
 460                            in6p->in6p_moptions, &oifp, in6p);
 461         if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
 462                 if (oifp)
 463                         icmp6_ifoutstat_inc(oifp, type, code);
 464                 icmp6stat.icp6s_outhist[type]++;
 465         } else
 466                 rip6stat.rip6s_opackets++;
 467
 468         goto freectl;
 469
 470  bad:
 471         if (m)
 472                 m_freem(m);
 473
 474  freectl:
 475         if (optp == &opt && optp->ip6po_rthdr && optp->ip6po_route.ro_rt)
 476                 RTFREE(optp->ip6po_route.ro_rt);
 477         if (control) {
 478                 if (optp == &opt)
 479                         ip6_clearpktopts(optp, 0, -1);
 480                 m_freem(control);
 481         }
 482         return(error);
 483 }
 484
 485 /*
 486  * Raw IPv6 socket option processing.
 487  */
 488 int
 489 rip6_ctloutput(struct socket *so, struct sockopt *sopt)
 490 {
 491         int error;
 492
 493         if (sopt->sopt_level == IPPROTO_ICMPV6)
 494                 /*
 495                  * XXX: is it better to call icmp6_ctloutput() directly
 496                  * from protosw?
 497                  */
 498                 return(icmp6_ctloutput(so, sopt));
 499         else if (sopt->sopt_level != IPPROTO_IPV6)
 500                 return (EINVAL);
 501
 502         error = 0;
 503
 504         switch (sopt->sopt_dir) {
 505         case SOPT_GET:
 506                 switch (sopt->sopt_name) {
 507                 case MRT6_INIT:
 508                 case MRT6_DONE:
 509                 case MRT6_ADD_MIF:
 510                 case MRT6_DEL_MIF:
 511                 case MRT6_ADD_MFC:
 512                 case MRT6_DEL_MFC:
 513                 case MRT6_PIM:
 514                         error = ip6_mrouter_get(so, sopt);
 515                         break;
 516                 default:
 517                         error = ip6_ctloutput(so, sopt);
 518                         break;
 519                 }
 520                 break;
 521
 522         case SOPT_SET:
 523                 switch (sopt->sopt_name) {
 524                 case MRT6_INIT:
 525                 case MRT6_DONE:
 526                 case MRT6_ADD_MIF:
 527                 case MRT6_DEL_MIF:
 528                 case MRT6_ADD_MFC:
 529                 case MRT6_DEL_MFC:
 530                 case MRT6_PIM:
 531                         error = ip6_mrouter_set(so, sopt);
 532                         break;
 533                 default:
 534                         error = ip6_ctloutput(so, sopt);
 535                         break;
 536                 }
 537                 break;
 538         }
 539
 540         return (error);
 541 }
 542
 543 static int
 544 rip6_attach(struct socket *so, int proto, struct pru_attach_info *ai)
 545 {
 546         struct inpcb *inp;
 547         int error, s;
 548
 549         inp = sotoinpcb(so);
 550         if (inp)
 551                 panic("rip6_attach");
 552         if ((error = suser_cred(ai->p_ucred, NULL_CRED_OKAY)) != 0)
 553                 return error;
 554
 555         error = soreserve(so, rip_sendspace, rip_recvspace, ai->sb_rlimit);
 556         if (error)
 557                 return error;
 558         s = splnet();
 559         error = in_pcballoc(so, &ripcbinfo);
 560         splx(s);
 561         if (error)
 562                 return error;
 563         inp = (struct inpcb *)so->so_pcb;
 564         inp->inp_vflag |= INP_IPV6;
 565         inp->in6p_ip6_nxt = (long)proto;
 566         inp->in6p_hops = -1;    /* use kernel default */
 567         inp->in6p_cksum = -1;
 568         MALLOC(inp->in6p_icmp6filt, struct icmp6_filter *,
 569                sizeof(struct icmp6_filter), M_PCB, M_NOWAIT);
 570         ICMP6_FILTER_SETPASSALL(inp->in6p_icmp6filt);
 571         return 0;
 572 }
 573
 574 static int
 575 rip6_detach(struct socket *so)
 576 {
 577         struct inpcb *inp;
 578
 579         inp = sotoinpcb(so);
 580         if (inp == 0)
 581                 panic("rip6_detach");
 582         /* xxx: RSVP */
 583         if (so == ip6_mrouter)
 584                 ip6_mrouter_done();
 585         if (inp->in6p_icmp6filt) {
 586                 FREE(inp->in6p_icmp6filt, M_PCB);
 587                 inp->in6p_icmp6filt = NULL;
 588         }
 589         in6_pcbdetach(inp);
 590         return 0;
 591 }
 592
 593 static int
 594 rip6_abort(struct socket *so)
 595 {
 596         soisdisconnected(so);
 597         return rip6_detach(so);
 598 }
 599
 600 static int
 601 rip6_disconnect(struct socket *so)
 602 {
 603         struct inpcb *inp = sotoinpcb(so);
 604
 605         if ((so->so_state & SS_ISCONNECTED) == 0)
 606                 return ENOTCONN;
 607         inp->in6p_faddr = in6addr_any;
 608         return rip6_abort(so);
 609 }
 610
 611 static int
 612 rip6_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
 613 {
 614         struct inpcb *inp = sotoinpcb(so);
 615         struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
 616         struct ifaddr *ia = NULL;
 617
 618         if (nam->sa_len != sizeof(*addr))
 619                 return EINVAL;
 620
 621         if (TAILQ_EMPTY(&ifnet) || addr->sin6_family != AF_INET6)
 622                 return EADDRNOTAVAIL;
 623 #ifdef ENABLE_DEFAULT_SCOPE
 624         if (addr->sin6_scope_id == 0) { /* not change if specified  */
 625                 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr);
 626         }
 627 #endif
 628         if (!IN6_IS_ADDR_UNSPECIFIED(&addr->sin6_addr) &&
 629             (ia = ifa_ifwithaddr((struct sockaddr *)addr)) == 0)
 630                 return EADDRNOTAVAIL;
 631         if (ia &&
 632             ((struct in6_ifaddr *)ia)->ia6_flags &
 633             (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|
 634              IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)) {
 635                 return(EADDRNOTAVAIL);
 636         }
 637         inp->in6p_laddr = addr->sin6_addr;
 638         return 0;
 639 }
 640
 641 static int
 642 rip6_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
 643 {
 644         struct inpcb *inp = sotoinpcb(so);
 645         struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
 646         struct in6_addr *in6a = NULL;
 647         int error = 0;
 648 #ifdef ENABLE_DEFAULT_SCOPE
 649         struct sockaddr_in6 tmp;
 650 #endif
 651
 652         if (nam->sa_len != sizeof(*addr))
 653                 return EINVAL;
 654         if (TAILQ_EMPTY(&ifnet))
 655                 return EADDRNOTAVAIL;
 656         if (addr->sin6_family != AF_INET6)
 657                 return EAFNOSUPPORT;
 658 #ifdef ENABLE_DEFAULT_SCOPE
 659         if (addr->sin6_scope_id == 0) { /* not change if specified  */
 660                 /* avoid overwrites */
 661                 tmp = *addr;
 662                 addr = &tmp;
 663                 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr);
 664         }
 665 #endif
 666         /* Source address selection. XXX: need pcblookup? */
 667         in6a = in6_selectsrc(addr, inp->in6p_outputopts,
 668                              inp->in6p_moptions, &inp->in6p_route,
 669                              &inp->in6p_laddr, &error);
 670         if (in6a == NULL)
 671                 return (error ? error : EADDRNOTAVAIL);
 672         inp->in6p_laddr = *in6a;
 673         inp->in6p_faddr = addr->sin6_addr;
 674         soisconnected(so);
 675         return 0;
 676 }
 677
 678 static int
 679 rip6_shutdown(struct socket *so)
 680 {
 681         socantsendmore(so);
 682         return 0;
 683 }
 684
 685 static int
 686 rip6_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *nam,
 687           struct mbuf *control, struct thread *td)
 688 {
 689         struct inpcb *inp = sotoinpcb(so);
 690         struct sockaddr_in6 tmp;
 691         struct sockaddr_in6 *dst;
 692
 693         /* always copy sockaddr to avoid overwrites */
 694         if (so->so_state & SS_ISCONNECTED) {
 695                 if (nam) {
 696                         m_freem(m);
 697                         return EISCONN;
 698                 }
 699                 /* XXX */
 700                 bzero(&tmp, sizeof(tmp));
 701                 tmp.sin6_family = AF_INET6;
 702                 tmp.sin6_len = sizeof(struct sockaddr_in6);
 703                 bcopy(&inp->in6p_faddr, &tmp.sin6_addr,
 704                       sizeof(struct in6_addr));
 705                 dst = &tmp;
 706         } else {
 707                 if (nam == NULL) {
 708                         m_freem(m);
 709                         return ENOTCONN;
 710                 }
 711                 tmp = *(struct sockaddr_in6 *)nam;
 712                 dst = &tmp;
 713         }
 714 #ifdef ENABLE_DEFAULT_SCOPE
 715         if (dst->sin6_scope_id == 0) {  /* not change if specified  */
 716                 dst->sin6_scope_id = scope6_addr2default(&dst->sin6_addr);
 717         }
 718 #endif
 719         return rip6_output(m, so, dst, control);
 720 }
 721
 722 struct pr_usrreqs rip6_usrreqs = {
 723         rip6_abort, pru_accept_notsupp, rip6_attach, rip6_bind, rip6_connect,
 724         pru_connect2_notsupp, in6_control, rip6_detach, rip6_disconnect,
 725         pru_listen_notsupp, in6_setpeeraddr, pru_rcvd_notsupp,
 726         pru_rcvoob_notsupp, rip6_send, pru_sense_null, rip6_shutdown,
 727         in6_setsockaddr, sosend, soreceive, sopoll
 728 };