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