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