raw_ip6.c revision 1.2.2.3
1 1.2.2.3 thorpej /* $NetBSD: raw_ip6.c,v 1.2.2.3 1999/08/02 22:36:07 thorpej Exp $ */ 2 1.2.2.3 thorpej 3 1.2.2.2 thorpej /* 4 1.2.2.2 thorpej * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 5 1.2.2.2 thorpej * All rights reserved. 6 1.2.2.2 thorpej * 7 1.2.2.2 thorpej * Redistribution and use in source and binary forms, with or without 8 1.2.2.2 thorpej * modification, are permitted provided that the following conditions 9 1.2.2.2 thorpej * are met: 10 1.2.2.2 thorpej * 1. Redistributions of source code must retain the above copyright 11 1.2.2.2 thorpej * notice, this list of conditions and the following disclaimer. 12 1.2.2.2 thorpej * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.2.2 thorpej * notice, this list of conditions and the following disclaimer in the 14 1.2.2.2 thorpej * documentation and/or other materials provided with the distribution. 15 1.2.2.2 thorpej * 3. Neither the name of the project nor the names of its contributors 16 1.2.2.2 thorpej * may be used to endorse or promote products derived from this software 17 1.2.2.2 thorpej * without specific prior written permission. 18 1.2.2.2 thorpej * 19 1.2.2.2 thorpej * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 20 1.2.2.2 thorpej * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 1.2.2.2 thorpej * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 1.2.2.2 thorpej * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 23 1.2.2.2 thorpej * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 1.2.2.2 thorpej * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 1.2.2.2 thorpej * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 1.2.2.2 thorpej * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 1.2.2.2 thorpej * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 1.2.2.2 thorpej * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 1.2.2.2 thorpej * SUCH DAMAGE. 30 1.2.2.2 thorpej */ 31 1.2.2.2 thorpej 32 1.2.2.2 thorpej /* 33 1.2.2.2 thorpej * Copyright (c) 1982, 1986, 1988, 1993 34 1.2.2.2 thorpej * The Regents of the University of California. All rights reserved. 35 1.2.2.2 thorpej * 36 1.2.2.2 thorpej * Redistribution and use in source and binary forms, with or without 37 1.2.2.2 thorpej * modification, are permitted provided that the following conditions 38 1.2.2.2 thorpej * are met: 39 1.2.2.2 thorpej * 1. Redistributions of source code must retain the above copyright 40 1.2.2.2 thorpej * notice, this list of conditions and the following disclaimer. 41 1.2.2.2 thorpej * 2. Redistributions in binary form must reproduce the above copyright 42 1.2.2.2 thorpej * notice, this list of conditions and the following disclaimer in the 43 1.2.2.2 thorpej * documentation and/or other materials provided with the distribution. 44 1.2.2.2 thorpej * 3. All advertising materials mentioning features or use of this software 45 1.2.2.2 thorpej * must display the following acknowledgement: 46 1.2.2.2 thorpej * This product includes software developed by the University of 47 1.2.2.2 thorpej * California, Berkeley and its contributors. 48 1.2.2.2 thorpej * 4. Neither the name of the University nor the names of its contributors 49 1.2.2.2 thorpej * may be used to endorse or promote products derived from this software 50 1.2.2.2 thorpej * without specific prior written permission. 51 1.2.2.2 thorpej * 52 1.2.2.2 thorpej * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 53 1.2.2.2 thorpej * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 54 1.2.2.2 thorpej * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 55 1.2.2.2 thorpej * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 56 1.2.2.2 thorpej * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 57 1.2.2.2 thorpej * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 58 1.2.2.2 thorpej * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 59 1.2.2.2 thorpej * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 60 1.2.2.2 thorpej * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 61 1.2.2.2 thorpej * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 62 1.2.2.2 thorpej * SUCH DAMAGE. 63 1.2.2.2 thorpej * 64 1.2.2.2 thorpej * @(#)raw_ip.c 8.2 (Berkeley) 1/4/94 65 1.2.2.2 thorpej */ 66 1.2.2.2 thorpej 67 1.2.2.3 thorpej #ifdef __NetBSD__ /*XXX*/ 68 1.2.2.3 thorpej #include "opt_ipsec.h" 69 1.2.2.3 thorpej #endif 70 1.2.2.3 thorpej 71 1.2.2.2 thorpej #include <sys/param.h> 72 1.2.2.2 thorpej #include <sys/malloc.h> 73 1.2.2.2 thorpej #include <sys/mbuf.h> 74 1.2.2.2 thorpej #include <sys/socket.h> 75 1.2.2.2 thorpej #include <sys/protosw.h> 76 1.2.2.2 thorpej #include <sys/socketvar.h> 77 1.2.2.2 thorpej #include <sys/errno.h> 78 1.2.2.2 thorpej #include <sys/systm.h> 79 1.2.2.2 thorpej #ifdef __NetBSD__ 80 1.2.2.2 thorpej #include <sys/proc.h> 81 1.2.2.2 thorpej #endif 82 1.2.2.2 thorpej 83 1.2.2.2 thorpej #include <net/if.h> 84 1.2.2.2 thorpej #include <net/route.h> 85 1.2.2.2 thorpej #include <net/if_types.h> 86 1.2.2.2 thorpej 87 1.2.2.2 thorpej #include <netinet/in.h> 88 1.2.2.2 thorpej #include <netinet/in_var.h> 89 1.2.2.2 thorpej #include <netinet6/ip6.h> 90 1.2.2.2 thorpej #include <netinet6/ip6_var.h> 91 1.2.2.2 thorpej #include <netinet6/ip6_mroute.h> 92 1.2.2.2 thorpej #include <netinet6/icmp6.h> 93 1.2.2.2 thorpej #include <netinet6/in6_pcb.h> 94 1.2.2.2 thorpej #include <netinet6/nd6.h> 95 1.2.2.2 thorpej 96 1.2.2.2 thorpej #ifdef IPSEC 97 1.2.2.2 thorpej #include <netinet6/ipsec.h> 98 1.2.2.2 thorpej #endif /*IPSEC*/ 99 1.2.2.2 thorpej 100 1.2.2.2 thorpej #include <machine/stdarg.h> 101 1.2.2.2 thorpej 102 1.2.2.2 thorpej #include "faith.h" 103 1.2.2.2 thorpej 104 1.2.2.2 thorpej struct in6pcb rawin6pcb; 105 1.2.2.2 thorpej #define ifatoia6(ifa) ((struct in6_ifaddr *)(ifa)) 106 1.2.2.2 thorpej 107 1.2.2.2 thorpej /* 108 1.2.2.2 thorpej * Raw interface to IP6 protocol. 109 1.2.2.2 thorpej */ 110 1.2.2.2 thorpej 111 1.2.2.2 thorpej /* 112 1.2.2.2 thorpej * Initialize raw connection block queue. 113 1.2.2.2 thorpej */ 114 1.2.2.2 thorpej void 115 1.2.2.2 thorpej rip6_init() 116 1.2.2.2 thorpej { 117 1.2.2.2 thorpej rawin6pcb.in6p_next = rawin6pcb.in6p_prev = &rawin6pcb; 118 1.2.2.2 thorpej } 119 1.2.2.2 thorpej 120 1.2.2.2 thorpej /* 121 1.2.2.2 thorpej * Setup generic address and protocol structures 122 1.2.2.2 thorpej * for raw_input routine, then pass them along with 123 1.2.2.2 thorpej * mbuf chain. 124 1.2.2.2 thorpej */ 125 1.2.2.2 thorpej int 126 1.2.2.2 thorpej rip6_input(mp, offp, proto) 127 1.2.2.2 thorpej struct mbuf **mp; 128 1.2.2.2 thorpej int *offp, proto; 129 1.2.2.2 thorpej { 130 1.2.2.2 thorpej struct mbuf *m = *mp; 131 1.2.2.2 thorpej register struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *); 132 1.2.2.2 thorpej register struct in6pcb *in6p; 133 1.2.2.2 thorpej struct in6pcb *last = NULL; 134 1.2.2.2 thorpej struct sockaddr_in6 rip6src; 135 1.2.2.2 thorpej struct mbuf *opts = NULL; 136 1.2.2.2 thorpej 137 1.2.2.2 thorpej #if defined(NFAITH) && 0 < NFAITH 138 1.2.2.2 thorpej if (m->m_pkthdr.rcvif) { 139 1.2.2.2 thorpej if (m->m_pkthdr.rcvif->if_type == IFT_FAITH) { 140 1.2.2.2 thorpej /* send icmp6 host unreach? */ 141 1.2.2.2 thorpej m_freem(m); 142 1.2.2.2 thorpej return IPPROTO_DONE; 143 1.2.2.2 thorpej } 144 1.2.2.2 thorpej } 145 1.2.2.2 thorpej #endif 146 1.2.2.2 thorpej bzero(&rip6src, sizeof(rip6src)); 147 1.2.2.2 thorpej rip6src.sin6_len = sizeof(struct sockaddr_in6); 148 1.2.2.2 thorpej rip6src.sin6_family = AF_INET6; 149 1.2.2.2 thorpej rip6src.sin6_addr = ip6->ip6_src; 150 1.2.2.2 thorpej if (IN6_IS_SCOPE_LINKLOCAL(&rip6src.sin6_addr)) 151 1.2.2.2 thorpej rip6src.sin6_addr.s6_addr16[1] = 0; 152 1.2.2.2 thorpej if (m->m_pkthdr.rcvif) { 153 1.2.2.2 thorpej if (IN6_IS_SCOPE_LINKLOCAL(&rip6src.sin6_addr)) 154 1.2.2.2 thorpej rip6src.sin6_scope_id = m->m_pkthdr.rcvif->if_index; 155 1.2.2.2 thorpej else 156 1.2.2.2 thorpej rip6src.sin6_scope_id = 0; 157 1.2.2.2 thorpej } else 158 1.2.2.2 thorpej rip6src.sin6_scope_id = 0; 159 1.2.2.2 thorpej 160 1.2.2.2 thorpej for (in6p = rawin6pcb.in6p_next; 161 1.2.2.2 thorpej in6p != &rawin6pcb; in6p = in6p->in6p_next) { 162 1.2.2.2 thorpej if (in6p->in6p_ip6.ip6_nxt && 163 1.2.2.2 thorpej in6p->in6p_ip6.ip6_nxt != proto) 164 1.2.2.2 thorpej continue; 165 1.2.2.2 thorpej if (!IN6_IS_ADDR_ANY(&in6p->in6p_laddr) && 166 1.2.2.2 thorpej !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst)) 167 1.2.2.2 thorpej continue; 168 1.2.2.2 thorpej if (!IN6_IS_ADDR_ANY(&in6p->in6p_faddr) && 169 1.2.2.2 thorpej !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src)) 170 1.2.2.2 thorpej continue; 171 1.2.2.2 thorpej if (in6p->in6p_cksum != -1 172 1.2.2.3 thorpej && in6_cksum(m, ip6->ip6_nxt, *offp, m->m_pkthdr.len - *offp)) 173 1.2.2.3 thorpej { 174 1.2.2.2 thorpej /* XXX bark something */ 175 1.2.2.2 thorpej continue; 176 1.2.2.2 thorpej } 177 1.2.2.2 thorpej if (last) { 178 1.2.2.2 thorpej struct mbuf *n; 179 1.2.2.2 thorpej if ((n = m_copy(m, 0, (int)M_COPYALL)) != NULL) { 180 1.2.2.2 thorpej if (last->in6p_flags & IN6P_CONTROLOPTS) 181 1.2.2.2 thorpej ip6_savecontrol(last, &opts, ip6, n); 182 1.2.2.2 thorpej /* strip intermediate headers */ 183 1.2.2.2 thorpej m_adj(n, *offp); 184 1.2.2.2 thorpej if (sbappendaddr(&last->in6p_socket->so_rcv, 185 1.2.2.2 thorpej (struct sockaddr *)&rip6src, 186 1.2.2.2 thorpej n, opts) == 0) { 187 1.2.2.2 thorpej /* should notify about lost packet */ 188 1.2.2.2 thorpej m_freem(n); 189 1.2.2.2 thorpej if (opts) 190 1.2.2.2 thorpej m_freem(opts); 191 1.2.2.2 thorpej } else 192 1.2.2.2 thorpej sorwakeup(last->in6p_socket); 193 1.2.2.2 thorpej opts = NULL; 194 1.2.2.2 thorpej } 195 1.2.2.2 thorpej } 196 1.2.2.2 thorpej last = in6p; 197 1.2.2.2 thorpej } 198 1.2.2.2 thorpej if (last) { 199 1.2.2.2 thorpej if (last->in6p_flags & IN6P_CONTROLOPTS) 200 1.2.2.2 thorpej ip6_savecontrol(last, &opts, ip6, m); 201 1.2.2.2 thorpej /* strip intermediate headers */ 202 1.2.2.2 thorpej m_adj(m, *offp); 203 1.2.2.2 thorpej if (sbappendaddr(&last->in6p_socket->so_rcv, 204 1.2.2.2 thorpej (struct sockaddr *)&rip6src, m, opts) == 0) { 205 1.2.2.2 thorpej m_freem(m); 206 1.2.2.2 thorpej if (opts) 207 1.2.2.2 thorpej m_freem(opts); 208 1.2.2.2 thorpej } else 209 1.2.2.2 thorpej sorwakeup(last->in6p_socket); 210 1.2.2.2 thorpej } else { 211 1.2.2.2 thorpej if (proto == IPPROTO_NONE) 212 1.2.2.2 thorpej m_freem(m); 213 1.2.2.2 thorpej else { 214 1.2.2.2 thorpej char *prvnxtp = ip6_get_prevhdr(m, *offp); /* XXX */ 215 1.2.2.2 thorpej icmp6_error(m, ICMP6_PARAM_PROB, 216 1.2.2.2 thorpej ICMP6_PARAMPROB_NEXTHEADER, 217 1.2.2.2 thorpej prvnxtp - mtod(m, char *)); 218 1.2.2.2 thorpej } 219 1.2.2.2 thorpej ip6stat.ip6s_delivered--; 220 1.2.2.2 thorpej } 221 1.2.2.2 thorpej return IPPROTO_DONE; 222 1.2.2.2 thorpej } 223 1.2.2.2 thorpej 224 1.2.2.2 thorpej /* 225 1.2.2.2 thorpej * Generate IPv6 header and pass packet to ip6_output. 226 1.2.2.2 thorpej * Tack on options user may have setup with control call. 227 1.2.2.2 thorpej */ 228 1.2.2.2 thorpej int 229 1.2.2.2 thorpej #if __STDC__ 230 1.2.2.2 thorpej rip6_output(struct mbuf *m, ...) 231 1.2.2.2 thorpej #else 232 1.2.2.2 thorpej rip6_output(m, va_alist) 233 1.2.2.2 thorpej struct mbuf *m; 234 1.2.2.2 thorpej va_dcl 235 1.2.2.2 thorpej #endif 236 1.2.2.2 thorpej { 237 1.2.2.2 thorpej struct socket *so; 238 1.2.2.2 thorpej struct sockaddr_in6 *dstsock; 239 1.2.2.2 thorpej struct mbuf *control; 240 1.2.2.2 thorpej struct in6_addr *dst; 241 1.2.2.2 thorpej struct ip6_hdr *ip6; 242 1.2.2.2 thorpej struct in6pcb *in6p; 243 1.2.2.2 thorpej u_int plen = m->m_pkthdr.len; 244 1.2.2.2 thorpej int error = 0; 245 1.2.2.2 thorpej struct ip6_pktopts opt, *optp = NULL; 246 1.2.2.2 thorpej struct ifnet *oifp = NULL; 247 1.2.2.2 thorpej int priv = 0; 248 1.2.2.2 thorpej va_list ap; 249 1.2.2.2 thorpej 250 1.2.2.2 thorpej va_start(ap, m); 251 1.2.2.2 thorpej so = va_arg(ap, struct socket *); 252 1.2.2.2 thorpej dstsock = va_arg(ap, struct sockaddr_in6 *); 253 1.2.2.2 thorpej control = va_arg(ap, struct mbuf *); 254 1.2.2.2 thorpej va_end(ap); 255 1.2.2.2 thorpej 256 1.2.2.2 thorpej in6p = sotoin6pcb(so); 257 1.2.2.2 thorpej 258 1.2.2.2 thorpej { 259 1.2.2.2 thorpej struct proc *p = curproc; /* XXX */ 260 1.2.2.2 thorpej 261 1.2.2.2 thorpej if (p && !suser(p->p_ucred, &p->p_acflag)) 262 1.2.2.2 thorpej priv = 1; 263 1.2.2.2 thorpej } 264 1.2.2.2 thorpej dst = &dstsock->sin6_addr; 265 1.2.2.2 thorpej if (control) { 266 1.2.2.2 thorpej if ((error = ip6_setpktoptions(control, &opt, priv)) != 0) 267 1.2.2.2 thorpej goto bad; 268 1.2.2.2 thorpej optp = &opt; 269 1.2.2.2 thorpej } else 270 1.2.2.2 thorpej optp = in6p->in6p_outputopts; 271 1.2.2.2 thorpej 272 1.2.2.2 thorpej M_PREPEND(m, sizeof(*ip6), M_WAIT); 273 1.2.2.2 thorpej ip6 = mtod(m, struct ip6_hdr *); 274 1.2.2.2 thorpej 275 1.2.2.2 thorpej /* 276 1.2.2.2 thorpej * Next header might not be ICMP6 but use its pseudo header anyway. 277 1.2.2.2 thorpej */ 278 1.2.2.2 thorpej ip6->ip6_dst = *dst; 279 1.2.2.2 thorpej 280 1.2.2.2 thorpej /* 281 1.2.2.2 thorpej * If the scope of the destination is link-local, embed the interface 282 1.2.2.2 thorpej * index in the address. 283 1.2.2.2 thorpej * 284 1.2.2.2 thorpej * XXX advanced-api value overrides sin6_scope_id 285 1.2.2.2 thorpej */ 286 1.2.2.2 thorpej if (IN6_IS_SCOPE_LINKLOCAL(&ip6->ip6_dst)) { 287 1.2.2.2 thorpej struct in6_pktinfo *pi; 288 1.2.2.2 thorpej 289 1.2.2.2 thorpej /* 290 1.2.2.2 thorpej * XXX Boundary check is assumed to be already done in 291 1.2.2.2 thorpej * in6_setpktoptions(). 292 1.2.2.2 thorpej */ 293 1.2.2.2 thorpej if (optp && (pi = optp->ip6po_pktinfo) && pi->ipi6_ifindex) { 294 1.2.2.2 thorpej ip6->ip6_dst.s6_addr16[1] = htons(pi->ipi6_ifindex); 295 1.2.2.2 thorpej oifp = ifindex2ifnet[pi->ipi6_ifindex]; 296 1.2.2.2 thorpej } 297 1.2.2.2 thorpej else if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) && 298 1.2.2.2 thorpej in6p->in6p_moptions && 299 1.2.2.2 thorpej in6p->in6p_moptions->im6o_multicast_ifp) { 300 1.2.2.2 thorpej ip6->ip6_dst.s6_addr16[1] = 301 1.2.2.2 thorpej htons(in6p->in6p_moptions->im6o_multicast_ifp->if_index); 302 1.2.2.2 thorpej oifp = ifindex2ifnet[in6p->in6p_moptions->im6o_multicast_ifp->if_index]; 303 1.2.2.2 thorpej } else if (dstsock->sin6_scope_id) { 304 1.2.2.2 thorpej /* boundary check */ 305 1.2.2.2 thorpej if (dstsock->sin6_scope_id < 0 306 1.2.2.2 thorpej || if_index < dstsock->sin6_scope_id) { 307 1.2.2.2 thorpej error = ENXIO; /* XXX EINVAL? */ 308 1.2.2.2 thorpej goto bad; 309 1.2.2.2 thorpej } 310 1.2.2.2 thorpej ip6->ip6_dst.s6_addr16[1] 311 1.2.2.2 thorpej = htons(dstsock->sin6_scope_id & 0xffff);/*XXX*/ 312 1.2.2.2 thorpej } 313 1.2.2.2 thorpej } 314 1.2.2.2 thorpej 315 1.2.2.2 thorpej if (IN6_IS_ADDR_ANY(&in6p->in6p_laddr)) { 316 1.2.2.2 thorpej struct in6_addr *in6a; 317 1.2.2.2 thorpej 318 1.2.2.2 thorpej if ((in6a = in6_selectsrc(dstsock, optp, 319 1.2.2.2 thorpej in6p->in6p_moptions, 320 1.2.2.2 thorpej &in6p->in6p_route, 321 1.2.2.2 thorpej &error)) == 0) { 322 1.2.2.2 thorpej if (error == 0) 323 1.2.2.2 thorpej error = EADDRNOTAVAIL; 324 1.2.2.2 thorpej goto bad; 325 1.2.2.2 thorpej } 326 1.2.2.2 thorpej ip6->ip6_src = *in6a; 327 1.2.2.2 thorpej if (in6p->in6p_route.ro_rt) 328 1.2.2.2 thorpej oifp = ifindex2ifnet[in6p->in6p_route.ro_rt->rt_ifp->if_index]; 329 1.2.2.2 thorpej } else 330 1.2.2.2 thorpej ip6->ip6_src = in6p->in6p_laddr; 331 1.2.2.2 thorpej 332 1.2.2.2 thorpej ip6->ip6_flow = in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK; 333 1.2.2.2 thorpej ip6->ip6_vfc = IPV6_VERSION; 334 1.2.2.2 thorpej #if 0 /* ip6_plen will be filled in ip6_output. */ 335 1.2.2.2 thorpej ip6->ip6_plen = htons((u_short)plen); 336 1.2.2.2 thorpej #endif 337 1.2.2.2 thorpej ip6->ip6_nxt = in6p->in6p_ip6.ip6_nxt; 338 1.2.2.2 thorpej if (oifp) 339 1.2.2.2 thorpej ip6->ip6_hlim = nd_ifinfo[oifp->if_index].chlim; 340 1.2.2.2 thorpej else 341 1.2.2.2 thorpej ip6->ip6_hlim = in6p->in6p_ip6.ip6_hlim; 342 1.2.2.2 thorpej 343 1.2.2.2 thorpej if (so->so_proto->pr_protocol == IPPROTO_ICMPV6 || 344 1.2.2.2 thorpej in6p->in6p_cksum != -1) { 345 1.2.2.2 thorpej struct mbuf *n; 346 1.2.2.2 thorpej int off; 347 1.2.2.2 thorpej u_int16_t *p; 348 1.2.2.2 thorpej 349 1.2.2.2 thorpej #define offsetof(type, member) ((size_t)(&((type *)0)->member)) /* XXX */ 350 1.2.2.2 thorpej 351 1.2.2.2 thorpej /* compute checksum */ 352 1.2.2.2 thorpej if (so->so_proto->pr_protocol == IPPROTO_ICMPV6) 353 1.2.2.2 thorpej off = offsetof(struct icmp6_hdr, icmp6_cksum); 354 1.2.2.2 thorpej else 355 1.2.2.2 thorpej off = in6p->in6p_cksum; 356 1.2.2.2 thorpej if (plen < off + 1) { 357 1.2.2.2 thorpej error = EINVAL; 358 1.2.2.2 thorpej goto bad; 359 1.2.2.2 thorpej } 360 1.2.2.2 thorpej off += sizeof(struct ip6_hdr); 361 1.2.2.2 thorpej 362 1.2.2.2 thorpej n = m; 363 1.2.2.2 thorpej while (n && n->m_len <= off) { 364 1.2.2.2 thorpej off -= n->m_len; 365 1.2.2.2 thorpej n = n->m_next; 366 1.2.2.2 thorpej } 367 1.2.2.2 thorpej if (!n) 368 1.2.2.2 thorpej goto bad; 369 1.2.2.2 thorpej p = (u_int16_t *)(mtod(n, caddr_t) + off); 370 1.2.2.2 thorpej *p = 0; 371 1.2.2.2 thorpej *p = in6_cksum(m, ip6->ip6_nxt, sizeof(*ip6), plen); 372 1.2.2.2 thorpej } 373 1.2.2.2 thorpej 374 1.2.2.2 thorpej #ifdef IPSEC 375 1.2.2.2 thorpej m->m_pkthdr.rcvif = (struct ifnet *)so; 376 1.2.2.2 thorpej #endif /*IPSEC*/ 377 1.2.2.2 thorpej 378 1.2.2.2 thorpej error = ip6_output(m, optp, &in6p->in6p_route, 0, in6p->in6p_moptions); 379 1.2.2.2 thorpej goto freectl; 380 1.2.2.2 thorpej 381 1.2.2.2 thorpej bad: 382 1.2.2.2 thorpej if (m) 383 1.2.2.2 thorpej m_freem(m); 384 1.2.2.2 thorpej 385 1.2.2.2 thorpej freectl: 386 1.2.2.2 thorpej if (optp == &opt && optp->ip6po_rthdr && optp->ip6po_route.ro_rt) 387 1.2.2.2 thorpej RTFREE(optp->ip6po_route.ro_rt); 388 1.2.2.2 thorpej if (control) 389 1.2.2.2 thorpej m_freem(control); 390 1.2.2.2 thorpej return(error); 391 1.2.2.2 thorpej } 392 1.2.2.2 thorpej 393 1.2.2.2 thorpej /* 394 1.2.2.2 thorpej * Raw IPv6 socket option processing. 395 1.2.2.2 thorpej */ 396 1.2.2.2 thorpej int 397 1.2.2.2 thorpej rip6_ctloutput(op, so, level, optname, m) 398 1.2.2.2 thorpej int op; 399 1.2.2.2 thorpej struct socket *so; 400 1.2.2.2 thorpej int level, optname; 401 1.2.2.2 thorpej struct mbuf **m; 402 1.2.2.2 thorpej { 403 1.2.2.2 thorpej int error = 0; 404 1.2.2.2 thorpej 405 1.2.2.2 thorpej switch(level) { 406 1.2.2.2 thorpej case IPPROTO_IPV6: 407 1.2.2.2 thorpej switch(optname) { 408 1.2.2.2 thorpej case MRT6_INIT: 409 1.2.2.2 thorpej case MRT6_DONE: 410 1.2.2.2 thorpej case MRT6_ADD_MIF: 411 1.2.2.2 thorpej case MRT6_DEL_MIF: 412 1.2.2.2 thorpej case MRT6_ADD_MFC: 413 1.2.2.2 thorpej case MRT6_DEL_MFC: 414 1.2.2.2 thorpej case MRT6_PIM: 415 1.2.2.2 thorpej if (op == PRCO_SETOPT) { 416 1.2.2.2 thorpej error = ip6_mrouter_set(optname, so, *m); 417 1.2.2.2 thorpej if (*m) 418 1.2.2.2 thorpej (void)m_free(*m); 419 1.2.2.2 thorpej } else if (op == PRCO_GETOPT) { 420 1.2.2.2 thorpej error = ip6_mrouter_get(optname, so, m); 421 1.2.2.2 thorpej } else 422 1.2.2.2 thorpej error = EINVAL; 423 1.2.2.2 thorpej return (error); 424 1.2.2.2 thorpej } 425 1.2.2.2 thorpej return (ip6_ctloutput(op, so, level, optname, m)); 426 1.2.2.2 thorpej /* NOTREACHED */ 427 1.2.2.2 thorpej 428 1.2.2.2 thorpej case IPPROTO_ICMPV6: 429 1.2.2.2 thorpej /* 430 1.2.2.2 thorpej * XXX: is it better to call icmp6_ctloutput() directly 431 1.2.2.2 thorpej * from protosw? 432 1.2.2.2 thorpej */ 433 1.2.2.2 thorpej return(icmp6_ctloutput(op, so, level, optname, m)); 434 1.2.2.2 thorpej 435 1.2.2.2 thorpej default: 436 1.2.2.2 thorpej if (op == PRCO_SETOPT && *m) 437 1.2.2.2 thorpej (void)m_free(*m); 438 1.2.2.2 thorpej return(EINVAL); 439 1.2.2.2 thorpej } 440 1.2.2.2 thorpej } 441 1.2.2.2 thorpej 442 1.2.2.2 thorpej extern u_long rip6_sendspace; 443 1.2.2.2 thorpej extern u_long rip6_recvspace; 444 1.2.2.2 thorpej 445 1.2.2.2 thorpej int 446 1.2.2.2 thorpej rip6_usrreq(so, req, m, nam, control, p) 447 1.2.2.2 thorpej register struct socket *so; 448 1.2.2.2 thorpej int req; 449 1.2.2.2 thorpej struct mbuf *m, *nam, *control; 450 1.2.2.2 thorpej struct proc *p; 451 1.2.2.2 thorpej { 452 1.2.2.2 thorpej register struct in6pcb *in6p = sotoin6pcb(so); 453 1.2.2.2 thorpej int s; 454 1.2.2.2 thorpej int error = 0; 455 1.2.2.2 thorpej /* extern struct socket *ip6_mrouter; */ /* xxx */ 456 1.2.2.2 thorpej 457 1.2.2.2 thorpej if (req == PRU_CONTROL) 458 1.2.2.2 thorpej return (in6_control(so, (u_long)m, (caddr_t)nam, 459 1.2.2.2 thorpej (struct ifnet *)control, p)); 460 1.2.2.2 thorpej 461 1.2.2.2 thorpej switch (req) { 462 1.2.2.2 thorpej case PRU_ATTACH: 463 1.2.2.2 thorpej if (in6p) 464 1.2.2.2 thorpej panic("rip6_attach"); 465 1.2.2.2 thorpej if (p == 0 || suser(p->p_ucred, &p->p_acflag)) { 466 1.2.2.2 thorpej error = EACCES; 467 1.2.2.2 thorpej break; 468 1.2.2.2 thorpej } 469 1.2.2.3 thorpej s = splsoftnet(); 470 1.2.2.2 thorpej if ((error = soreserve(so, rip6_sendspace, rip6_recvspace)) || 471 1.2.2.2 thorpej (error = in6_pcballoc(so, &rawin6pcb))) { 472 1.2.2.2 thorpej splx(s); 473 1.2.2.2 thorpej break; 474 1.2.2.2 thorpej } 475 1.2.2.2 thorpej splx(s); 476 1.2.2.2 thorpej in6p = sotoin6pcb(so); 477 1.2.2.3 thorpej in6p->in6p_ip6.ip6_nxt = (long)nam; 478 1.2.2.2 thorpej in6p->in6p_cksum = -1; 479 1.2.2.2 thorpej #ifdef IPSEC 480 1.2.2.2 thorpej if ((error = ipsec_init_policy(&in6p->in6p_sp)) != 0) 481 1.2.2.2 thorpej break; 482 1.2.2.2 thorpej #endif /*IPSEC*/ 483 1.2.2.2 thorpej 484 1.2.2.2 thorpej MALLOC(in6p->in6p_icmp6filt, struct icmp6_filter *, 485 1.2.2.2 thorpej sizeof(struct icmp6_filter), M_PCB, M_NOWAIT); 486 1.2.2.2 thorpej ICMP6_FILTER_SETPASSALL(in6p->in6p_icmp6filt); 487 1.2.2.2 thorpej break; 488 1.2.2.2 thorpej 489 1.2.2.2 thorpej case PRU_DISCONNECT: 490 1.2.2.2 thorpej if ((so->so_state & SS_ISCONNECTED) == 0) { 491 1.2.2.2 thorpej error = ENOTCONN; 492 1.2.2.2 thorpej break; 493 1.2.2.2 thorpej } 494 1.2.2.2 thorpej in6p->in6p_faddr = in6addr_any; 495 1.2.2.2 thorpej so->so_state &= ~SS_ISCONNECTED; /* XXX */ 496 1.2.2.2 thorpej break; 497 1.2.2.2 thorpej 498 1.2.2.2 thorpej case PRU_ABORT: 499 1.2.2.2 thorpej soisdisconnected(so); 500 1.2.2.2 thorpej /* Fallthrough */ 501 1.2.2.2 thorpej case PRU_DETACH: 502 1.2.2.2 thorpej if (in6p == 0) 503 1.2.2.2 thorpej panic("rip6_detach"); 504 1.2.2.2 thorpej if (so == ip6_mrouter) 505 1.2.2.2 thorpej ip6_mrouter_done(); 506 1.2.2.2 thorpej /* xxx: RSVP */ 507 1.2.2.2 thorpej if (in6p->in6p_icmp6filt) { 508 1.2.2.2 thorpej FREE(in6p->in6p_icmp6filt, M_PCB); 509 1.2.2.2 thorpej in6p->in6p_icmp6filt = NULL; 510 1.2.2.2 thorpej } 511 1.2.2.2 thorpej in6_pcbdetach(in6p); 512 1.2.2.2 thorpej break; 513 1.2.2.2 thorpej 514 1.2.2.2 thorpej case PRU_BIND: 515 1.2.2.2 thorpej { 516 1.2.2.2 thorpej struct sockaddr_in6 *addr = mtod(nam, struct sockaddr_in6 *); 517 1.2.2.2 thorpej struct ifaddr *ia = NULL; 518 1.2.2.2 thorpej 519 1.2.2.2 thorpej if (nam->m_len != sizeof(*addr)) { 520 1.2.2.2 thorpej error = EINVAL; 521 1.2.2.2 thorpej break; 522 1.2.2.2 thorpej } 523 1.2.2.2 thorpej if ((ifnet.tqh_first == 0) || 524 1.2.2.2 thorpej (addr->sin6_family != AF_INET6) || 525 1.2.2.2 thorpej (!IN6_IS_ADDR_ANY(&addr->sin6_addr) && 526 1.2.2.2 thorpej (ia = ifa_ifwithaddr((struct sockaddr *)addr)) == 0)) { 527 1.2.2.2 thorpej error = EADDRNOTAVAIL; 528 1.2.2.2 thorpej break; 529 1.2.2.2 thorpej } 530 1.2.2.2 thorpej if (ia && 531 1.2.2.2 thorpej ((struct in6_ifaddr *)ia)->ia6_flags & 532 1.2.2.2 thorpej (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY| 533 1.2.2.2 thorpej IN6_IFF_DETACHED|IN6_IFF_DEPRECATED)) { 534 1.2.2.2 thorpej error = EADDRNOTAVAIL; 535 1.2.2.2 thorpej break; 536 1.2.2.2 thorpej } 537 1.2.2.2 thorpej in6p->in6p_laddr = addr->sin6_addr; 538 1.2.2.2 thorpej break; 539 1.2.2.2 thorpej } 540 1.2.2.2 thorpej 541 1.2.2.2 thorpej case PRU_CONNECT: 542 1.2.2.2 thorpej { 543 1.2.2.2 thorpej struct sockaddr_in6 *addr = mtod(nam, struct sockaddr_in6 *); 544 1.2.2.2 thorpej struct in6_addr *in6a = NULL; 545 1.2.2.2 thorpej 546 1.2.2.2 thorpej if (nam->m_len != sizeof(*addr)) { 547 1.2.2.2 thorpej error = EINVAL; 548 1.2.2.2 thorpej break; 549 1.2.2.2 thorpej } 550 1.2.2.2 thorpej if (ifnet.tqh_first == 0) { 551 1.2.2.2 thorpej error = EADDRNOTAVAIL; 552 1.2.2.2 thorpej break; 553 1.2.2.2 thorpej } 554 1.2.2.2 thorpej if (addr->sin6_family != AF_INET6) { 555 1.2.2.2 thorpej error = EAFNOSUPPORT; 556 1.2.2.2 thorpej break; 557 1.2.2.2 thorpej } 558 1.2.2.2 thorpej 559 1.2.2.2 thorpej /* Source address selection. XXX: need pcblookup? */ 560 1.2.2.2 thorpej in6a = &in6p->in6p_laddr; 561 1.2.2.2 thorpej if (IN6_IS_ADDR_ANY(in6a) && 562 1.2.2.2 thorpej (in6a = in6_selectsrc(addr, in6p->in6p_outputopts, 563 1.2.2.2 thorpej in6p->in6p_moptions, &in6p->in6p_route, 564 1.2.2.2 thorpej &error)) == NULL) { 565 1.2.2.2 thorpej if (error == 0) 566 1.2.2.2 thorpej error = EADDRNOTAVAIL; 567 1.2.2.2 thorpej break; 568 1.2.2.2 thorpej } 569 1.2.2.2 thorpej in6p->in6p_laddr = *in6a; 570 1.2.2.2 thorpej in6p->in6p_faddr = addr->sin6_addr; 571 1.2.2.2 thorpej soisconnected(so); 572 1.2.2.2 thorpej break; 573 1.2.2.2 thorpej } 574 1.2.2.2 thorpej 575 1.2.2.2 thorpej case PRU_CONNECT2: 576 1.2.2.2 thorpej error = EOPNOTSUPP; 577 1.2.2.2 thorpej break; 578 1.2.2.2 thorpej 579 1.2.2.2 thorpej /* 580 1.2.2.2 thorpej * Mark the connection as being incapable of futther input. 581 1.2.2.2 thorpej */ 582 1.2.2.2 thorpej case PRU_SHUTDOWN: 583 1.2.2.2 thorpej socantsendmore(so); 584 1.2.2.2 thorpej break; 585 1.2.2.2 thorpej /* 586 1.2.2.2 thorpej * Ship a packet out. The appropriate raw output 587 1.2.2.2 thorpej * routine handles any messaging necessary. 588 1.2.2.2 thorpej */ 589 1.2.2.2 thorpej case PRU_SEND: 590 1.2.2.2 thorpej { 591 1.2.2.2 thorpej struct sockaddr_in6 tmp; 592 1.2.2.2 thorpej struct sockaddr_in6 *dst; 593 1.2.2.2 thorpej 594 1.2.2.2 thorpej if (so->so_state & SS_ISCONNECTED) { 595 1.2.2.2 thorpej if (nam) { 596 1.2.2.2 thorpej error = EISCONN; 597 1.2.2.2 thorpej break; 598 1.2.2.2 thorpej } 599 1.2.2.2 thorpej /* XXX */ 600 1.2.2.2 thorpej bzero(&tmp, sizeof(tmp)); 601 1.2.2.2 thorpej tmp.sin6_family = AF_INET6; 602 1.2.2.2 thorpej tmp.sin6_len = sizeof(struct sockaddr_in6); 603 1.2.2.2 thorpej bcopy(&in6p->in6p_faddr, &tmp.sin6_addr, 604 1.2.2.2 thorpej sizeof(struct in6_addr)); 605 1.2.2.2 thorpej dst = &tmp; 606 1.2.2.2 thorpej } else { 607 1.2.2.2 thorpej if (nam == NULL) { 608 1.2.2.2 thorpej error = ENOTCONN; 609 1.2.2.2 thorpej break; 610 1.2.2.2 thorpej } 611 1.2.2.2 thorpej dst = mtod(nam, struct sockaddr_in6 *); 612 1.2.2.2 thorpej } 613 1.2.2.2 thorpej error = rip6_output(m, so, dst, control); 614 1.2.2.2 thorpej m = NULL; 615 1.2.2.2 thorpej break; 616 1.2.2.2 thorpej } 617 1.2.2.2 thorpej 618 1.2.2.2 thorpej case PRU_SENSE: 619 1.2.2.2 thorpej /* 620 1.2.2.2 thorpej * stat: don't bother with a blocksize 621 1.2.2.2 thorpej */ 622 1.2.2.2 thorpej return(0); 623 1.2.2.2 thorpej /* 624 1.2.2.2 thorpej * Not supported. 625 1.2.2.2 thorpej */ 626 1.2.2.2 thorpej case PRU_RCVOOB: 627 1.2.2.2 thorpej case PRU_RCVD: 628 1.2.2.2 thorpej case PRU_LISTEN: 629 1.2.2.2 thorpej case PRU_ACCEPT: 630 1.2.2.2 thorpej case PRU_SENDOOB: 631 1.2.2.2 thorpej error = EOPNOTSUPP; 632 1.2.2.2 thorpej break; 633 1.2.2.2 thorpej 634 1.2.2.2 thorpej case PRU_SOCKADDR: 635 1.2.2.2 thorpej in6_setsockaddr(in6p, nam); 636 1.2.2.2 thorpej break; 637 1.2.2.2 thorpej 638 1.2.2.2 thorpej case PRU_PEERADDR: 639 1.2.2.2 thorpej in6_setpeeraddr(in6p, nam); 640 1.2.2.2 thorpej break; 641 1.2.2.2 thorpej 642 1.2.2.2 thorpej default: 643 1.2.2.2 thorpej panic("rip6_usrreq"); 644 1.2.2.2 thorpej } 645 1.2.2.2 thorpej if (m != NULL) 646 1.2.2.2 thorpej m_freem(m); 647 1.2.2.2 thorpej return(error); 648 1.2.2.2 thorpej } 649
Indexes created Tue Sep 30 20:09:53 GMT 2025