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