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