2 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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.
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
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.8 2003/08/23 11:02:46 rob Exp $
34 * Copyright (c) 1982, 1986, 1988, 1993
35 * The Regents of the University of California. All rights reserved.
37 * Redistribution and use in source and binary forms, with or without
38 * modification, are permitted provided that the following conditions
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.
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
65 * @(#)raw_ip.c 8.2 (Berkeley) 1/4/94
68 #include "opt_ipsec.h"
69 #include "opt_inet6.h"
71 #include <sys/param.h>
72 #include <sys/malloc.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>
82 #include <net/route.h>
83 #include <net/if_types.h>
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>
99 #include <netinet6/raw_ip6.h>
102 #include <netinet6/ipsec.h>
103 #include <netinet6/ipsec6.h>
109 #endif /* FAST_IPSEC */
111 #include <machine/stdarg.h>
113 #define satosin6(sa) ((struct sockaddr_in6 *)(sa))
114 #define ifatoia6(ifa) ((struct in6_ifaddr *)(ifa))
117 * Raw interface to IP6 protocol.
120 extern struct inpcbhead ripcb;
121 extern struct inpcbinfo ripcbinfo;
122 extern u_long rip_sendspace;
123 extern u_long rip_recvspace;
125 struct rip6stat rip6stat;
128 * Setup generic address and protocol structures
129 * for raw_input routine, then pass them along with
133 rip6_input(mp, offp, proto)
137 struct mbuf *m = *mp;
138 struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
140 struct inpcb *last = 0;
141 struct mbuf *opts = NULL;
142 struct sockaddr_in6 rip6src;
144 rip6stat.rip6s_ipackets++;
146 if (faithprefix_p != NULL && (*faithprefix_p)(&ip6->ip6_dst)) {
147 /* XXX send icmp6 host/port unreach? */
152 init_sin6(&rip6src, m); /* general init */
154 LIST_FOREACH(in6p, &ripcb, inp_list) {
155 if ((in6p->in6p_vflag & INP_IPV6) == 0)
157 if (in6p->in6p_ip6_nxt &&
158 in6p->in6p_ip6_nxt != proto)
160 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr) &&
161 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst))
163 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr) &&
164 !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src))
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++;
175 struct mbuf *n = m_copy(m, 0, (int)M_COPYALL);
179 * Check AH/ESP integrity.
181 if (n && ipsec6_in_reject_so(n, last->inp_socket)) {
183 ipsec6stat.in_polvio++;
184 /* do not inject data into pcb */
189 * Check AH/ESP integrity.
191 if (n && ipsec6_in_reject(n, last)) {
193 /* do not inject data into pcb */
195 #endif /*FAST_IPSEC*/
197 if (last->in6p_flags & IN6P_CONTROLOPTS ||
198 last->in6p_socket->so_options & SO_TIMESTAMP)
199 ip6_savecontrol(last, &opts, ip6, n);
200 /* strip intermediate headers */
202 if (sbappendaddr(&last->in6p_socket->so_rcv,
203 (struct sockaddr *)&rip6src,
208 rip6stat.rip6s_fullsock++;
210 sorwakeup(last->in6p_socket);
218 * Check AH/ESP integrity.
220 if (last && ipsec6_in_reject_so(m, last->inp_socket)) {
222 ipsec6stat.in_polvio++;
223 ip6stat.ip6s_delivered--;
224 /* do not inject data into pcb */
229 * Check AH/ESP integrity.
231 if (last && ipsec6_in_reject(m, last)) {
233 ip6stat.ip6s_delivered--;
234 /* do not inject data into pcb */
236 #endif /*FAST_IPSEC*/
238 if (last->in6p_flags & IN6P_CONTROLOPTS ||
239 last->in6p_socket->so_options & SO_TIMESTAMP)
240 ip6_savecontrol(last, &opts, ip6, m);
241 /* strip intermediate headers */
243 if (sbappendaddr(&last->in6p_socket->so_rcv,
244 (struct sockaddr *)&rip6src, m, opts) == 0) {
248 rip6stat.rip6s_fullsock++;
250 sorwakeup(last->in6p_socket);
252 rip6stat.rip6s_nosock++;
253 if (m->m_flags & M_MCAST)
254 rip6stat.rip6s_nosockmcast++;
255 if (proto == IPPROTO_NONE)
258 char *prvnxtp = ip6_get_prevhdr(m, *offp); /* XXX */
259 icmp6_error(m, ICMP6_PARAM_PROB,
260 ICMP6_PARAMPROB_NEXTHEADER,
261 prvnxtp - mtod(m, char *));
263 ip6stat.ip6s_delivered--;
269 rip6_ctlinput(cmd, sa, d)
277 struct ip6ctlparam *ip6cp = NULL;
278 const struct sockaddr_in6 *sa6_src = NULL;
279 void (*notify) (struct inpcb *, int) = in6_rtchange;
281 if (sa->sa_family != AF_INET6 ||
282 sa->sa_len != sizeof(struct sockaddr_in6))
285 if ((unsigned)cmd >= PRC_NCMDS)
287 if (PRC_IS_REDIRECT(cmd))
288 notify = in6_rtchange, d = NULL;
289 else if (cmd == PRC_HOSTDEAD)
291 else if (inet6ctlerrmap[cmd] == 0)
294 /* if the parameter is from icmp6, decode it. */
296 ip6cp = (struct ip6ctlparam *)d;
298 ip6 = ip6cp->ip6c_ip6;
299 off = ip6cp->ip6c_off;
300 sa6_src = ip6cp->ip6c_src;
307 (void) in6_pcbnotify(&ripcb, sa, 0, (const struct sockaddr *)sa6_src,
312 * Generate IPv6 header and pass packet to ip6_output.
313 * Tack on options user may have setup with control call.
317 rip6_output(struct mbuf *m, ...)
319 rip6_output(m, va_alist)
325 struct sockaddr_in6 *dstsock;
326 struct mbuf *control;
327 struct in6_addr *dst;
330 u_int plen = m->m_pkthdr.len;
332 struct ip6_pktopts opt, *optp = 0;
333 struct ifnet *oifp = NULL;
334 int type = 0, code = 0; /* for ICMPv6 output statistics only */
339 so = va_arg(ap, struct socket *);
340 dstsock = va_arg(ap, struct sockaddr_in6 *);
341 control = va_arg(ap, struct mbuf *);
344 in6p = sotoin6pcb(so);
347 if (so->so_cred->cr_uid == 0)
349 dst = &dstsock->sin6_addr;
351 if ((error = ip6_setpktoptions(control, &opt, priv, 0)) != 0)
355 optp = in6p->in6p_outputopts;
358 * For an ICMPv6 packet, we should know its type and code
359 * to update statistics.
361 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
362 struct icmp6_hdr *icmp6;
363 if (m->m_len < sizeof(struct icmp6_hdr) &&
364 (m = m_pullup(m, sizeof(struct icmp6_hdr))) == NULL) {
368 icmp6 = mtod(m, struct icmp6_hdr *);
369 type = icmp6->icmp6_type;
370 code = icmp6->icmp6_code;
373 M_PREPEND(m, sizeof(*ip6), M_WAIT);
374 ip6 = mtod(m, struct ip6_hdr *);
377 * Next header might not be ICMP6 but use its pseudo header anyway.
382 * If the scope of the destination is link-local, embed the interface
383 * index in the address.
385 * XXX advanced-api value overrides sin6_scope_id
387 if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) {
388 struct in6_pktinfo *pi;
391 * XXX Boundary check is assumed to be already done in
392 * ip6_setpktoptions().
394 if (optp && (pi = optp->ip6po_pktinfo) && pi->ipi6_ifindex) {
395 ip6->ip6_dst.s6_addr16[1] = htons(pi->ipi6_ifindex);
396 oifp = ifindex2ifnet[pi->ipi6_ifindex];
397 } else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) &&
398 in6p->in6p_moptions &&
399 in6p->in6p_moptions->im6o_multicast_ifp) {
400 oifp = in6p->in6p_moptions->im6o_multicast_ifp;
401 ip6->ip6_dst.s6_addr16[1] = htons(oifp->if_index);
402 } else if (dstsock->sin6_scope_id) {
404 if (dstsock->sin6_scope_id < 0
405 || if_index < dstsock->sin6_scope_id) {
406 error = ENXIO; /* XXX EINVAL? */
409 ip6->ip6_dst.s6_addr16[1]
410 = htons(dstsock->sin6_scope_id & 0xffff);/*XXX*/
415 * Source address selection.
418 struct in6_addr *in6a;
420 if ((in6a = in6_selectsrc(dstsock, optp,
426 error = EADDRNOTAVAIL;
429 ip6->ip6_src = *in6a;
430 if (in6p->in6p_route.ro_rt)
431 oifp = ifindex2ifnet[in6p->in6p_route.ro_rt->rt_ifp->if_index];
433 ip6->ip6_flow = (ip6->ip6_flow & ~IPV6_FLOWINFO_MASK) |
434 (in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK);
435 ip6->ip6_vfc = (ip6->ip6_vfc & ~IPV6_VERSION_MASK) |
436 (IPV6_VERSION & IPV6_VERSION_MASK);
437 /* ip6_plen will be filled in ip6_output, so not fill it here. */
438 ip6->ip6_nxt = in6p->in6p_ip6_nxt;
439 ip6->ip6_hlim = in6_selecthlim(in6p, oifp);
441 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6 ||
442 in6p->in6p_cksum != -1) {
447 /* compute checksum */
448 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6)
449 off = offsetof(struct icmp6_hdr, icmp6_cksum);
451 off = in6p->in6p_cksum;
452 if (plen < off + 1) {
456 off += sizeof(struct ip6_hdr);
459 while (n && n->m_len <= off) {
465 p = (u_int16_t *)(mtod(n, caddr_t) + off);
467 *p = in6_cksum(m, ip6->ip6_nxt, sizeof(*ip6), plen);
470 error = ip6_output(m, optp, &in6p->in6p_route, 0,
471 in6p->in6p_moptions, &oifp, in6p);
472 if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) {
474 icmp6_ifoutstat_inc(oifp, type, code);
475 icmp6stat.icp6s_outhist[type]++;
477 rip6stat.rip6s_opackets++;
486 if (optp == &opt && optp->ip6po_rthdr && optp->ip6po_route.ro_rt)
487 RTFREE(optp->ip6po_route.ro_rt);
490 ip6_clearpktopts(optp, 0, -1);
497 * Raw IPv6 socket option processing.
500 rip6_ctloutput(so, sopt)
502 struct sockopt *sopt;
506 if (sopt->sopt_level == IPPROTO_ICMPV6)
508 * XXX: is it better to call icmp6_ctloutput() directly
511 return(icmp6_ctloutput(so, sopt));
512 else if (sopt->sopt_level != IPPROTO_IPV6)
517 switch (sopt->sopt_dir) {
519 switch (sopt->sopt_name) {
527 error = ip6_mrouter_get(so, sopt);
530 error = ip6_ctloutput(so, sopt);
536 switch (sopt->sopt_name) {
544 error = ip6_mrouter_set(so, sopt);
547 error = ip6_ctloutput(so, sopt);
557 rip6_attach(struct socket *so, int proto, struct thread *td)
564 panic("rip6_attach");
565 if ((error = suser(td)) != 0)
568 error = soreserve(so, rip_sendspace, rip_recvspace);
572 error = in_pcballoc(so, &ripcbinfo, td);
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 ICMP6_FILTER_SETPASSALL(inp->in6p_icmp6filt);
588 rip6_detach(struct socket *so)
594 panic("rip6_detach");
596 if (so == ip6_mrouter)
598 if (inp->in6p_icmp6filt) {
599 FREE(inp->in6p_icmp6filt, M_PCB);
600 inp->in6p_icmp6filt = NULL;
607 rip6_abort(struct socket *so)
609 soisdisconnected(so);
610 return rip6_detach(so);
614 rip6_disconnect(struct socket *so)
616 struct inpcb *inp = sotoinpcb(so);
618 if ((so->so_state & SS_ISCONNECTED) == 0)
620 inp->in6p_faddr = in6addr_any;
621 return rip6_abort(so);
625 rip6_bind(struct socket *so, struct sockaddr *nam, struct thread *td)
627 struct inpcb *inp = sotoinpcb(so);
628 struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
629 struct ifaddr *ia = NULL;
631 if (nam->sa_len != sizeof(*addr))
634 if (TAILQ_EMPTY(&ifnet) || addr->sin6_family != AF_INET6)
635 return EADDRNOTAVAIL;
636 #ifdef ENABLE_DEFAULT_SCOPE
637 if (addr->sin6_scope_id == 0) { /* not change if specified */
638 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr);
641 if (!IN6_IS_ADDR_UNSPECIFIED(&addr->sin6_addr) &&
642 (ia = ifa_ifwithaddr((struct sockaddr *)addr)) == 0)
643 return EADDRNOTAVAIL;
645 ((struct in6_ifaddr *)ia)->ia6_flags &
646 (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY|
647 IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)) {
648 return(EADDRNOTAVAIL);
650 inp->in6p_laddr = addr->sin6_addr;
655 rip6_connect(struct socket *so, struct sockaddr *nam, struct thread *td)
657 struct inpcb *inp = sotoinpcb(so);
658 struct sockaddr_in6 *addr = (struct sockaddr_in6 *)nam;
659 struct in6_addr *in6a = NULL;
661 #ifdef ENABLE_DEFAULT_SCOPE
662 struct sockaddr_in6 tmp;
665 if (nam->sa_len != sizeof(*addr))
667 if (TAILQ_EMPTY(&ifnet))
668 return EADDRNOTAVAIL;
669 if (addr->sin6_family != AF_INET6)
671 #ifdef ENABLE_DEFAULT_SCOPE
672 if (addr->sin6_scope_id == 0) { /* not change if specified */
673 /* avoid overwrites */
676 addr->sin6_scope_id = scope6_addr2default(&addr->sin6_addr);
679 /* Source address selection. XXX: need pcblookup? */
680 in6a = in6_selectsrc(addr, inp->in6p_outputopts,
681 inp->in6p_moptions, &inp->in6p_route,
682 &inp->in6p_laddr, &error);
684 return (error ? error : EADDRNOTAVAIL);
685 inp->in6p_laddr = *in6a;
686 inp->in6p_faddr = addr->sin6_addr;
692 rip6_shutdown(struct socket *so)
699 rip6_send(struct socket *so, int flags, struct mbuf *m, struct sockaddr *nam,
700 struct mbuf *control, struct thread *td)
702 struct inpcb *inp = sotoinpcb(so);
703 struct sockaddr_in6 tmp;
704 struct sockaddr_in6 *dst;
706 /* always copy sockaddr to avoid overwrites */
707 if (so->so_state & SS_ISCONNECTED) {
713 bzero(&tmp, sizeof(tmp));
714 tmp.sin6_family = AF_INET6;
715 tmp.sin6_len = sizeof(struct sockaddr_in6);
716 bcopy(&inp->in6p_faddr, &tmp.sin6_addr,
717 sizeof(struct in6_addr));
724 tmp = *(struct sockaddr_in6 *)nam;
727 #ifdef ENABLE_DEFAULT_SCOPE
728 if (dst->sin6_scope_id == 0) { /* not change if specified */
729 dst->sin6_scope_id = scope6_addr2default(&dst->sin6_addr);
732 return rip6_output(m, so, dst, control);
735 struct pr_usrreqs rip6_usrreqs = {
736 rip6_abort, pru_accept_notsupp, rip6_attach, rip6_bind, rip6_connect,
737 pru_connect2_notsupp, in6_control, rip6_detach, rip6_disconnect,
738 pru_listen_notsupp, in6_setpeeraddr, pru_rcvd_notsupp,
739 pru_rcvoob_notsupp, rip6_send, pru_sense_null, rip6_shutdown,
740 in6_setsockaddr, sosend, soreceive, sopoll