Home | History | Annotate | Line # | Download | only in netinet
ip_output.c revision 1.62.2.1
      1  1.62.2.1    bouyer /*	$NetBSD: ip_output.c,v 1.62.2.1 2000/11/20 18:10:32 bouyer Exp $	*/
      2      1.61    itojun 
      3      1.61    itojun /*
      4      1.61    itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5      1.61    itojun  * All rights reserved.
      6      1.61    itojun  *
      7      1.61    itojun  * Redistribution and use in source and binary forms, with or without
      8      1.61    itojun  * modification, are permitted provided that the following conditions
      9      1.61    itojun  * are met:
     10      1.61    itojun  * 1. Redistributions of source code must retain the above copyright
     11      1.61    itojun  *    notice, this list of conditions and the following disclaimer.
     12      1.61    itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13      1.61    itojun  *    notice, this list of conditions and the following disclaimer in the
     14      1.61    itojun  *    documentation and/or other materials provided with the distribution.
     15      1.61    itojun  * 3. Neither the name of the project nor the names of its contributors
     16      1.61    itojun  *    may be used to endorse or promote products derived from this software
     17      1.61    itojun  *    without specific prior written permission.
     18      1.61    itojun  *
     19      1.61    itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20      1.61    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21      1.61    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22      1.61    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23      1.61    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24      1.61    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25      1.61    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26      1.61    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27      1.61    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28      1.61    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29      1.61    itojun  * SUCH DAMAGE.
     30      1.61    itojun  */
     31      1.54   thorpej 
     32      1.54   thorpej /*-
     33      1.54   thorpej  * Copyright (c) 1998 The NetBSD Foundation, Inc.
     34      1.54   thorpej  * All rights reserved.
     35      1.54   thorpej  *
     36      1.54   thorpej  * This code is derived from software contributed to The NetBSD Foundation
     37      1.54   thorpej  * by Public Access Networks Corporation ("Panix").  It was developed under
     38      1.54   thorpej  * contract to Panix by Eric Haszlakiewicz and Thor Lancelot Simon.
     39      1.54   thorpej  *
     40      1.54   thorpej  * Redistribution and use in source and binary forms, with or without
     41      1.54   thorpej  * modification, are permitted provided that the following conditions
     42      1.54   thorpej  * are met:
     43      1.54   thorpej  * 1. Redistributions of source code must retain the above copyright
     44      1.54   thorpej  *    notice, this list of conditions and the following disclaimer.
     45      1.54   thorpej  * 2. Redistributions in binary form must reproduce the above copyright
     46      1.54   thorpej  *    notice, this list of conditions and the following disclaimer in the
     47      1.54   thorpej  *    documentation and/or other materials provided with the distribution.
     48      1.54   thorpej  * 3. All advertising materials mentioning features or use of this software
     49      1.54   thorpej  *    must display the following acknowledgement:
     50      1.54   thorpej  *	This product includes software developed by the NetBSD
     51      1.54   thorpej  *	Foundation, Inc. and its contributors.
     52      1.54   thorpej  * 4. Neither the name of The NetBSD Foundation nor the names of its
     53      1.54   thorpej  *    contributors may be used to endorse or promote products derived
     54      1.54   thorpej  *    from this software without specific prior written permission.
     55      1.54   thorpej  *
     56      1.54   thorpej  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     57      1.54   thorpej  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     58      1.54   thorpej  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     59      1.54   thorpej  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     60      1.54   thorpej  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     61      1.54   thorpej  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     62      1.54   thorpej  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     63      1.54   thorpej  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     64      1.54   thorpej  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     65      1.54   thorpej  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     66      1.54   thorpej  * POSSIBILITY OF SUCH DAMAGE.
     67      1.54   thorpej  */
     68      1.19       cgd 
     69       1.1       cgd /*
     70      1.18   mycroft  * Copyright (c) 1982, 1986, 1988, 1990, 1993
     71      1.18   mycroft  *	The Regents of the University of California.  All rights reserved.
     72       1.1       cgd  *
     73       1.1       cgd  * Redistribution and use in source and binary forms, with or without
     74       1.1       cgd  * modification, are permitted provided that the following conditions
     75       1.1       cgd  * are met:
     76       1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     77       1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     78       1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     79       1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     80       1.1       cgd  *    documentation and/or other materials provided with the distribution.
     81       1.1       cgd  * 3. All advertising materials mentioning features or use of this software
     82       1.1       cgd  *    must display the following acknowledgement:
     83       1.1       cgd  *	This product includes software developed by the University of
     84       1.1       cgd  *	California, Berkeley and its contributors.
     85       1.1       cgd  * 4. Neither the name of the University nor the names of its contributors
     86       1.1       cgd  *    may be used to endorse or promote products derived from this software
     87       1.1       cgd  *    without specific prior written permission.
     88       1.1       cgd  *
     89       1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     90       1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     91       1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     92       1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     93       1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     94       1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     95       1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     96       1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     97       1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     98       1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     99       1.1       cgd  * SUCH DAMAGE.
    100       1.1       cgd  *
    101      1.19       cgd  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
    102       1.1       cgd  */
    103      1.42    scottr 
    104      1.50       mrg #include "opt_pfil_hooks.h"
    105      1.62   thorpej #include "opt_ipsec.h"
    106      1.42    scottr #include "opt_mrouting.h"
    107       1.1       cgd 
    108       1.8   mycroft #include <sys/param.h>
    109       1.8   mycroft #include <sys/malloc.h>
    110       1.8   mycroft #include <sys/mbuf.h>
    111       1.8   mycroft #include <sys/errno.h>
    112       1.8   mycroft #include <sys/protosw.h>
    113       1.8   mycroft #include <sys/socket.h>
    114       1.8   mycroft #include <sys/socketvar.h>
    115      1.28  christos #include <sys/systm.h>
    116      1.61    itojun #include <sys/proc.h>
    117      1.61    itojun 
    118       1.8   mycroft #include <net/if.h>
    119       1.8   mycroft #include <net/route.h>
    120      1.38       mrg #include <net/pfil.h>
    121       1.1       cgd 
    122       1.8   mycroft #include <netinet/in.h>
    123       1.8   mycroft #include <netinet/in_systm.h>
    124       1.8   mycroft #include <netinet/ip.h>
    125       1.8   mycroft #include <netinet/in_pcb.h>
    126       1.8   mycroft #include <netinet/in_var.h>
    127       1.8   mycroft #include <netinet/ip_var.h>
    128      1.32       mrg 
    129  1.62.2.1    bouyer #ifdef MROUTING
    130  1.62.2.1    bouyer #include <netinet/ip_mroute.h>
    131  1.62.2.1    bouyer #endif
    132  1.62.2.1    bouyer 
    133      1.52      matt #ifdef __vax__
    134       1.8   mycroft #include <machine/mtpr.h>
    135       1.1       cgd #endif
    136       1.1       cgd 
    137      1.28  christos #include <machine/stdarg.h>
    138      1.28  christos 
    139      1.61    itojun #ifdef IPSEC
    140      1.61    itojun #include <netinet6/ipsec.h>
    141      1.61    itojun #include <netkey/key.h>
    142      1.61    itojun #include <netkey/key_debug.h>
    143      1.61    itojun #endif /*IPSEC*/
    144      1.61    itojun 
    145      1.12   mycroft static struct mbuf *ip_insertoptions __P((struct mbuf *, struct mbuf *, int *));
    146      1.12   mycroft static void ip_mloopback
    147      1.18   mycroft 	__P((struct ifnet *, struct mbuf *, struct sockaddr_in *));
    148       1.1       cgd 
    149       1.1       cgd /*
    150       1.1       cgd  * IP output.  The packet in mbuf chain m contains a skeletal IP
    151       1.1       cgd  * header (with len, off, ttl, proto, tos, src, dst).
    152       1.1       cgd  * The mbuf chain containing the packet will be freed.
    153       1.1       cgd  * The mbuf opt, if present, will not be freed.
    154       1.1       cgd  */
    155      1.12   mycroft int
    156      1.28  christos #if __STDC__
    157      1.28  christos ip_output(struct mbuf *m0, ...)
    158      1.28  christos #else
    159      1.28  christos ip_output(m0, va_alist)
    160       1.1       cgd 	struct mbuf *m0;
    161      1.28  christos 	va_dcl
    162      1.28  christos #endif
    163       1.1       cgd {
    164  1.62.2.1    bouyer 	struct ip *ip, *mhip;
    165  1.62.2.1    bouyer 	struct ifnet *ifp;
    166  1.62.2.1    bouyer 	struct mbuf *m = m0;
    167  1.62.2.1    bouyer 	int hlen = sizeof (struct ip);
    168       1.1       cgd 	int len, off, error = 0;
    169       1.1       cgd 	struct route iproute;
    170       1.1       cgd 	struct sockaddr_in *dst;
    171       1.1       cgd 	struct in_ifaddr *ia;
    172      1.28  christos 	struct mbuf *opt;
    173      1.28  christos 	struct route *ro;
    174      1.28  christos 	int flags;
    175      1.40      matt 	int *mtu_p;
    176      1.48      matt 	int mtu;
    177      1.28  christos 	struct ip_moptions *imo;
    178      1.28  christos 	va_list ap;
    179      1.32       mrg #ifdef PFIL_HOOKS
    180      1.30       mrg 	struct packet_filter_hook *pfh;
    181      1.30       mrg 	struct mbuf *m1;
    182      1.36       mrg 	int rv;
    183      1.32       mrg #endif /* PFIL_HOOKS */
    184      1.61    itojun #ifdef IPSEC
    185  1.62.2.1    bouyer 	struct socket *so;
    186      1.61    itojun 	struct secpolicy *sp = NULL;
    187      1.61    itojun #endif /*IPSEC*/
    188      1.28  christos 
    189      1.28  christos 	va_start(ap, m0);
    190      1.28  christos 	opt = va_arg(ap, struct mbuf *);
    191      1.28  christos 	ro = va_arg(ap, struct route *);
    192      1.28  christos 	flags = va_arg(ap, int);
    193      1.28  christos 	imo = va_arg(ap, struct ip_moptions *);
    194      1.40      matt 	if (flags & IP_RETURNMTU)
    195      1.40      matt 		mtu_p = va_arg(ap, int *);
    196      1.40      matt 	else
    197      1.40      matt 		mtu_p = NULL;
    198      1.28  christos 	va_end(ap);
    199      1.28  christos 
    200      1.61    itojun #ifdef IPSEC
    201  1.62.2.1    bouyer 	so = ipsec_getsocket(m);
    202  1.62.2.1    bouyer 	ipsec_setsocket(m, NULL);
    203      1.61    itojun #endif /*IPSEC*/
    204      1.61    itojun 
    205       1.1       cgd #ifdef	DIAGNOSTIC
    206       1.1       cgd 	if ((m->m_flags & M_PKTHDR) == 0)
    207       1.1       cgd 		panic("ip_output no HDR");
    208       1.1       cgd #endif
    209       1.1       cgd 	if (opt) {
    210       1.1       cgd 		m = ip_insertoptions(m, opt, &len);
    211       1.1       cgd 		hlen = len;
    212       1.1       cgd 	}
    213       1.1       cgd 	ip = mtod(m, struct ip *);
    214       1.1       cgd 	/*
    215       1.1       cgd 	 * Fill in IP header.
    216       1.1       cgd 	 */
    217      1.18   mycroft 	if ((flags & (IP_FORWARDING|IP_RAWOUTPUT)) == 0) {
    218       1.1       cgd 		ip->ip_v = IPVERSION;
    219       1.1       cgd 		ip->ip_off &= IP_DF;
    220       1.1       cgd 		ip->ip_id = htons(ip_id++);
    221       1.1       cgd 		ip->ip_hl = hlen >> 2;
    222      1.18   mycroft 		ipstat.ips_localout++;
    223       1.1       cgd 	} else {
    224       1.1       cgd 		hlen = ip->ip_hl << 2;
    225       1.1       cgd 	}
    226       1.1       cgd 	/*
    227       1.1       cgd 	 * Route packet.
    228       1.1       cgd 	 */
    229       1.1       cgd 	if (ro == 0) {
    230       1.1       cgd 		ro = &iproute;
    231       1.1       cgd 		bzero((caddr_t)ro, sizeof (*ro));
    232       1.1       cgd 	}
    233      1.24   mycroft 	dst = satosin(&ro->ro_dst);
    234       1.1       cgd 	/*
    235       1.1       cgd 	 * If there is a cached route,
    236       1.1       cgd 	 * check that it is to the same destination
    237       1.1       cgd 	 * and is still up.  If not, free it and try again.
    238       1.1       cgd 	 */
    239       1.1       cgd 	if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
    240      1.31   mycroft 	    !in_hosteq(dst->sin_addr, ip->ip_dst))) {
    241       1.1       cgd 		RTFREE(ro->ro_rt);
    242       1.1       cgd 		ro->ro_rt = (struct rtentry *)0;
    243       1.1       cgd 	}
    244       1.1       cgd 	if (ro->ro_rt == 0) {
    245       1.1       cgd 		dst->sin_family = AF_INET;
    246       1.1       cgd 		dst->sin_len = sizeof(*dst);
    247       1.1       cgd 		dst->sin_addr = ip->ip_dst;
    248       1.1       cgd 	}
    249       1.1       cgd 	/*
    250       1.1       cgd 	 * If routing to interface only,
    251       1.1       cgd 	 * short circuit routing lookup.
    252       1.1       cgd 	 */
    253       1.1       cgd 	if (flags & IP_ROUTETOIF) {
    254      1.29       mrg 		if ((ia = ifatoia(ifa_ifwithladdr(sintosa(dst)))) == 0) {
    255      1.18   mycroft 			ipstat.ips_noroute++;
    256       1.1       cgd 			error = ENETUNREACH;
    257       1.1       cgd 			goto bad;
    258       1.1       cgd 		}
    259       1.1       cgd 		ifp = ia->ia_ifp;
    260      1.48      matt 		mtu = ifp->if_mtu;
    261      1.18   mycroft 		ip->ip_ttl = 1;
    262       1.1       cgd 	} else {
    263       1.1       cgd 		if (ro->ro_rt == 0)
    264       1.1       cgd 			rtalloc(ro);
    265       1.1       cgd 		if (ro->ro_rt == 0) {
    266      1.18   mycroft 			ipstat.ips_noroute++;
    267       1.1       cgd 			error = EHOSTUNREACH;
    268       1.1       cgd 			goto bad;
    269       1.1       cgd 		}
    270      1.18   mycroft 		ia = ifatoia(ro->ro_rt->rt_ifa);
    271       1.1       cgd 		ifp = ro->ro_rt->rt_ifp;
    272      1.48      matt 		if ((mtu = ro->ro_rt->rt_rmx.rmx_mtu) == 0)
    273      1.48      matt 			mtu = ifp->if_mtu;
    274       1.1       cgd 		ro->ro_rt->rt_use++;
    275       1.1       cgd 		if (ro->ro_rt->rt_flags & RTF_GATEWAY)
    276      1.24   mycroft 			dst = satosin(ro->ro_rt->rt_gateway);
    277       1.1       cgd 	}
    278  1.62.2.1    bouyer 	if (IN_MULTICAST(ip->ip_dst.s_addr) ||
    279  1.62.2.1    bouyer 	    (ip->ip_dst.s_addr == INADDR_BROADCAST)) {
    280       1.5   hpeyerl 		struct in_multi *inm;
    281       1.5   hpeyerl 
    282  1.62.2.1    bouyer 		m->m_flags |= (ip->ip_dst.s_addr == INADDR_BROADCAST) ?
    283  1.62.2.1    bouyer 			M_BCAST : M_MCAST;
    284       1.5   hpeyerl 		/*
    285       1.5   hpeyerl 		 * IP destination address is multicast.  Make sure "dst"
    286       1.5   hpeyerl 		 * still points to the address in "ro".  (It may have been
    287       1.5   hpeyerl 		 * changed to point to a gateway address, above.)
    288       1.5   hpeyerl 		 */
    289      1.24   mycroft 		dst = satosin(&ro->ro_dst);
    290       1.5   hpeyerl 		/*
    291       1.5   hpeyerl 		 * See if the caller provided any multicast options
    292       1.5   hpeyerl 		 */
    293      1.13   mycroft 		if (imo != NULL) {
    294       1.5   hpeyerl 			ip->ip_ttl = imo->imo_multicast_ttl;
    295      1.48      matt 			if (imo->imo_multicast_ifp != NULL) {
    296       1.5   hpeyerl 				ifp = imo->imo_multicast_ifp;
    297      1.48      matt 				mtu = ifp->if_mtu;
    298      1.48      matt 			}
    299      1.18   mycroft 		} else
    300       1.5   hpeyerl 			ip->ip_ttl = IP_DEFAULT_MULTICAST_TTL;
    301       1.5   hpeyerl 		/*
    302       1.5   hpeyerl 		 * Confirm that the outgoing interface supports multicast.
    303       1.5   hpeyerl 		 */
    304  1.62.2.1    bouyer 		if (((m->m_flags & M_MCAST) &&
    305  1.62.2.1    bouyer 		     (ifp->if_flags & IFF_MULTICAST) == 0) ||
    306  1.62.2.1    bouyer 		    ((m->m_flags & M_BCAST) &&
    307  1.62.2.1    bouyer 		     (ifp->if_flags & IFF_BROADCAST) == 0))  {
    308      1.18   mycroft 			ipstat.ips_noroute++;
    309       1.5   hpeyerl 			error = ENETUNREACH;
    310       1.5   hpeyerl 			goto bad;
    311       1.5   hpeyerl 		}
    312       1.5   hpeyerl 		/*
    313      1.44       tls 		 * If source address not specified yet, use an address
    314       1.5   hpeyerl 		 * of outgoing interface.
    315       1.5   hpeyerl 		 */
    316      1.31   mycroft 		if (in_nullhost(ip->ip_src)) {
    317  1.62.2.1    bouyer 			struct in_ifaddr *ia;
    318       1.5   hpeyerl 
    319      1.44       tls 			IFP_TO_IA(ifp, ia);
    320      1.44       tls 			ip->ip_src = ia->ia_addr.sin_addr;
    321       1.5   hpeyerl 		}
    322       1.5   hpeyerl 
    323       1.5   hpeyerl 		IN_LOOKUP_MULTI(ip->ip_dst, ifp, inm);
    324       1.5   hpeyerl 		if (inm != NULL &&
    325       1.5   hpeyerl 		   (imo == NULL || imo->imo_multicast_loop)) {
    326       1.5   hpeyerl 			/*
    327      1.11   mycroft 			 * If we belong to the destination multicast group
    328       1.5   hpeyerl 			 * on the outgoing interface, and the caller did not
    329       1.5   hpeyerl 			 * forbid loopback, loop back a copy.
    330       1.5   hpeyerl 			 */
    331       1.5   hpeyerl 			ip_mloopback(ifp, m, dst);
    332       1.5   hpeyerl 		}
    333       1.5   hpeyerl #ifdef MROUTING
    334      1.18   mycroft 		else {
    335       1.5   hpeyerl 			/*
    336       1.5   hpeyerl 			 * If we are acting as a multicast router, perform
    337       1.5   hpeyerl 			 * multicast forwarding as if the packet had just
    338       1.5   hpeyerl 			 * arrived on the interface to which we are about
    339       1.5   hpeyerl 			 * to send.  The multicast forwarding function
    340       1.5   hpeyerl 			 * recursively calls this function, using the
    341       1.5   hpeyerl 			 * IP_FORWARDING flag to prevent infinite recursion.
    342       1.5   hpeyerl 			 *
    343       1.5   hpeyerl 			 * Multicasts that are looped back by ip_mloopback(),
    344       1.5   hpeyerl 			 * above, will be forwarded by the ip_input() routine,
    345       1.5   hpeyerl 			 * if necessary.
    346       1.5   hpeyerl 			 */
    347      1.18   mycroft 			extern struct socket *ip_mrouter;
    348      1.22       cgd 
    349      1.18   mycroft 			if (ip_mrouter && (flags & IP_FORWARDING) == 0) {
    350      1.18   mycroft 				if (ip_mforward(m, ifp) != 0) {
    351      1.18   mycroft 					m_freem(m);
    352      1.18   mycroft 					goto done;
    353      1.18   mycroft 				}
    354       1.5   hpeyerl 			}
    355       1.5   hpeyerl 		}
    356       1.5   hpeyerl #endif
    357       1.5   hpeyerl 		/*
    358       1.5   hpeyerl 		 * Multicasts with a time-to-live of zero may be looped-
    359       1.5   hpeyerl 		 * back, above, but must not be transmitted on a network.
    360       1.5   hpeyerl 		 * Also, multicasts addressed to the loopback interface
    361       1.5   hpeyerl 		 * are not sent -- the above call to ip_mloopback() will
    362       1.5   hpeyerl 		 * loop back a copy if this host actually belongs to the
    363       1.5   hpeyerl 		 * destination group on the loopback interface.
    364       1.5   hpeyerl 		 */
    365      1.20   mycroft 		if (ip->ip_ttl == 0 || (ifp->if_flags & IFF_LOOPBACK) != 0) {
    366       1.5   hpeyerl 			m_freem(m);
    367       1.5   hpeyerl 			goto done;
    368       1.5   hpeyerl 		}
    369       1.5   hpeyerl 
    370       1.5   hpeyerl 		goto sendit;
    371       1.5   hpeyerl 	}
    372       1.1       cgd #ifndef notdef
    373       1.1       cgd 	/*
    374       1.1       cgd 	 * If source address not specified yet, use address
    375       1.1       cgd 	 * of outgoing interface.
    376       1.1       cgd 	 */
    377      1.31   mycroft 	if (in_nullhost(ip->ip_src))
    378      1.25   mycroft 		ip->ip_src = ia->ia_addr.sin_addr;
    379       1.1       cgd #endif
    380      1.59       hwr 
    381      1.59       hwr 	/*
    382      1.59       hwr 	 * packets with Class-D address as source are not valid per
    383      1.59       hwr 	 * RFC 1112
    384      1.59       hwr 	 */
    385      1.59       hwr 	if (IN_MULTICAST(ip->ip_src.s_addr)) {
    386      1.59       hwr 		ipstat.ips_odropped++;
    387      1.59       hwr 		error = EADDRNOTAVAIL;
    388      1.59       hwr 		goto bad;
    389      1.59       hwr 	}
    390      1.59       hwr 
    391       1.1       cgd 	/*
    392       1.1       cgd 	 * Look for broadcast address and
    393       1.1       cgd 	 * and verify user is allowed to send
    394       1.1       cgd 	 * such a packet.
    395       1.1       cgd 	 */
    396      1.18   mycroft 	if (in_broadcast(dst->sin_addr, ifp)) {
    397       1.1       cgd 		if ((ifp->if_flags & IFF_BROADCAST) == 0) {
    398       1.1       cgd 			error = EADDRNOTAVAIL;
    399       1.1       cgd 			goto bad;
    400       1.1       cgd 		}
    401       1.1       cgd 		if ((flags & IP_ALLOWBROADCAST) == 0) {
    402       1.1       cgd 			error = EACCES;
    403       1.1       cgd 			goto bad;
    404       1.1       cgd 		}
    405       1.1       cgd 		/* don't allow broadcast messages to be fragmented */
    406      1.21       cgd 		if ((u_int16_t)ip->ip_len > ifp->if_mtu) {
    407       1.1       cgd 			error = EMSGSIZE;
    408       1.1       cgd 			goto bad;
    409       1.1       cgd 		}
    410       1.1       cgd 		m->m_flags |= M_BCAST;
    411      1.18   mycroft 	} else
    412      1.18   mycroft 		m->m_flags &= ~M_BCAST;
    413      1.18   mycroft 
    414      1.60       mrg sendit:
    415  1.62.2.1    bouyer 	/*
    416  1.62.2.1    bouyer 	 * If we're doing Path MTU Discovery, we need to set DF unless
    417  1.62.2.1    bouyer 	 * the route's MTU is locked.
    418  1.62.2.1    bouyer 	 */
    419  1.62.2.1    bouyer 	if ((flags & IP_MTUDISC) != 0 && ro->ro_rt != NULL &&
    420  1.62.2.1    bouyer 	    (ro->ro_rt->rt_rmx.rmx_locks & RTV_MTU) == 0)
    421  1.62.2.1    bouyer 		ip->ip_off |= IP_DF;
    422  1.62.2.1    bouyer 
    423      1.32       mrg #ifdef PFIL_HOOKS
    424      1.30       mrg 	/*
    425      1.30       mrg 	 * Run through list of hooks for output packets.
    426      1.30       mrg 	 */
    427      1.30       mrg 	m1 = m;
    428  1.62.2.1    bouyer 	pfh = pfil_hook_get(PFIL_OUT, &inetsw[ip_protox[IPPROTO_IP]].pr_pfh);
    429  1.62.2.1    bouyer 	for (; pfh; pfh = pfh->pfil_link.tqe_next)
    430      1.30       mrg 		if (pfh->pfil_func) {
    431      1.36       mrg 		    	rv = pfh->pfil_func(ip, hlen, ifp, 1, &m1);
    432      1.36       mrg 			if (rv) {
    433      1.30       mrg 				error = EHOSTUNREACH;
    434      1.34     veego 				goto done;
    435      1.30       mrg 			}
    436      1.49  sommerfe 			m = m1;
    437      1.49  sommerfe 			if (m == NULL)
    438      1.49  sommerfe 				goto done;
    439      1.49  sommerfe 			ip = mtod(m, struct ip *);
    440      1.30       mrg 		}
    441      1.32       mrg #endif /* PFIL_HOOKS */
    442      1.61    itojun 
    443      1.61    itojun #ifdef IPSEC
    444      1.61    itojun 	/* get SP for this packet */
    445      1.61    itojun 	if (so == NULL)
    446  1.62.2.1    bouyer 		sp = ipsec4_getpolicybyaddr(m, IPSEC_DIR_OUTBOUND, flags, &error);
    447      1.61    itojun 	else
    448  1.62.2.1    bouyer 		sp = ipsec4_getpolicybysock(m, IPSEC_DIR_OUTBOUND, so, &error);
    449      1.61    itojun 
    450      1.61    itojun 	if (sp == NULL) {
    451      1.61    itojun 		ipsecstat.out_inval++;
    452      1.61    itojun 		goto bad;
    453      1.61    itojun 	}
    454      1.61    itojun 
    455      1.61    itojun 	error = 0;
    456      1.61    itojun 
    457      1.61    itojun 	/* check policy */
    458      1.61    itojun 	switch (sp->policy) {
    459      1.61    itojun 	case IPSEC_POLICY_DISCARD:
    460      1.61    itojun 		/*
    461      1.61    itojun 		 * This packet is just discarded.
    462      1.61    itojun 		 */
    463      1.61    itojun 		ipsecstat.out_polvio++;
    464      1.61    itojun 		goto bad;
    465      1.61    itojun 
    466      1.61    itojun 	case IPSEC_POLICY_BYPASS:
    467      1.61    itojun 	case IPSEC_POLICY_NONE:
    468      1.61    itojun 		/* no need to do IPsec. */
    469      1.61    itojun 		goto skip_ipsec;
    470      1.61    itojun 
    471      1.61    itojun 	case IPSEC_POLICY_IPSEC:
    472      1.61    itojun 		if (sp->req == NULL) {
    473      1.61    itojun 			/* XXX should be panic ? */
    474      1.61    itojun 			printf("ip_output: No IPsec request specified.\n");
    475      1.61    itojun 			error = EINVAL;
    476      1.61    itojun 			goto bad;
    477      1.61    itojun 		}
    478      1.61    itojun 		break;
    479      1.61    itojun 
    480      1.61    itojun 	case IPSEC_POLICY_ENTRUST:
    481      1.61    itojun 	default:
    482      1.61    itojun 		printf("ip_output: Invalid policy found. %d\n", sp->policy);
    483      1.61    itojun 	}
    484      1.61    itojun 
    485      1.61    itojun 	ip->ip_len = htons((u_short)ip->ip_len);
    486      1.61    itojun 	ip->ip_off = htons((u_short)ip->ip_off);
    487      1.61    itojun 	ip->ip_sum = 0;
    488      1.61    itojun 
    489      1.61    itojun     {
    490      1.61    itojun 	struct ipsec_output_state state;
    491      1.61    itojun 	bzero(&state, sizeof(state));
    492      1.61    itojun 	state.m = m;
    493      1.61    itojun 	if (flags & IP_ROUTETOIF) {
    494      1.61    itojun 		state.ro = &iproute;
    495      1.61    itojun 		bzero(&iproute, sizeof(iproute));
    496      1.61    itojun 	} else
    497      1.61    itojun 		state.ro = ro;
    498      1.61    itojun 	state.dst = (struct sockaddr *)dst;
    499      1.61    itojun 
    500      1.61    itojun 	error = ipsec4_output(&state, sp, flags);
    501      1.61    itojun 
    502      1.61    itojun 	m = state.m;
    503      1.61    itojun 	if (flags & IP_ROUTETOIF) {
    504      1.61    itojun 		/*
    505      1.61    itojun 		 * if we have tunnel mode SA, we may need to ignore
    506      1.61    itojun 		 * IP_ROUTETOIF.
    507      1.61    itojun 		 */
    508      1.61    itojun 		if (state.ro != &iproute || state.ro->ro_rt != NULL) {
    509      1.61    itojun 			flags &= ~IP_ROUTETOIF;
    510      1.61    itojun 			ro = state.ro;
    511      1.61    itojun 		}
    512      1.61    itojun 	} else
    513      1.61    itojun 		ro = state.ro;
    514      1.61    itojun 	dst = (struct sockaddr_in *)state.dst;
    515      1.61    itojun 	if (error) {
    516      1.61    itojun 		/* mbuf is already reclaimed in ipsec4_output. */
    517      1.61    itojun 		m0 = NULL;
    518      1.61    itojun 		switch (error) {
    519      1.61    itojun 		case EHOSTUNREACH:
    520      1.61    itojun 		case ENETUNREACH:
    521      1.61    itojun 		case EMSGSIZE:
    522      1.61    itojun 		case ENOBUFS:
    523      1.61    itojun 		case ENOMEM:
    524      1.61    itojun 			break;
    525      1.61    itojun 		default:
    526      1.61    itojun 			printf("ip4_output (ipsec): error code %d\n", error);
    527      1.61    itojun 			/*fall through*/
    528      1.61    itojun 		case ENOENT:
    529      1.61    itojun 			/* don't show these error codes to the user */
    530      1.61    itojun 			error = 0;
    531      1.61    itojun 			break;
    532      1.61    itojun 		}
    533      1.61    itojun 		goto bad;
    534      1.61    itojun 	}
    535      1.61    itojun     }
    536      1.61    itojun 
    537      1.61    itojun 	/* be sure to update variables that are affected by ipsec4_output() */
    538      1.61    itojun 	ip = mtod(m, struct ip *);
    539      1.61    itojun #ifdef _IP_VHL
    540      1.61    itojun 	hlen = IP_VHL_HL(ip->ip_vhl) << 2;
    541      1.61    itojun #else
    542      1.61    itojun 	hlen = ip->ip_hl << 2;
    543      1.61    itojun #endif
    544      1.61    itojun 	if (ro->ro_rt == NULL) {
    545      1.61    itojun 		if ((flags & IP_ROUTETOIF) == 0) {
    546      1.61    itojun 			printf("ip_output: "
    547      1.61    itojun 				"can't update route after IPsec processing\n");
    548      1.61    itojun 			error = EHOSTUNREACH;	/*XXX*/
    549      1.61    itojun 			goto bad;
    550      1.61    itojun 		}
    551      1.61    itojun 	} else {
    552      1.61    itojun 		/* nobody uses ia beyond here */
    553      1.61    itojun 		ifp = ro->ro_rt->rt_ifp;
    554      1.61    itojun 	}
    555      1.61    itojun 
    556      1.61    itojun 	/* make it flipped, again. */
    557      1.61    itojun 	ip->ip_len = ntohs((u_short)ip->ip_len);
    558      1.61    itojun 	ip->ip_off = ntohs((u_short)ip->ip_off);
    559      1.61    itojun skip_ipsec:
    560      1.61    itojun #endif /*IPSEC*/
    561      1.61    itojun 
    562       1.1       cgd 	/*
    563      1.48      matt 	 * If small enough for mtu of path, can just send directly.
    564       1.1       cgd 	 */
    565      1.48      matt 	if ((u_int16_t)ip->ip_len <= mtu) {
    566  1.62.2.1    bouyer #if IFA_STATS
    567  1.62.2.1    bouyer 		/*
    568  1.62.2.1    bouyer 		 * search for the source address structure to
    569  1.62.2.1    bouyer 		 * maintain output statistics.
    570  1.62.2.1    bouyer 		 */
    571  1.62.2.1    bouyer 		INADDR_TO_IA(ip->ip_src, ia);
    572  1.62.2.1    bouyer 		if (ia)
    573  1.62.2.1    bouyer 			ia->ia_ifa.ifa_data.ifad_outbytes += ip->ip_len;
    574  1.62.2.1    bouyer #endif
    575      1.55   thorpej 		HTONS(ip->ip_len);
    576      1.55   thorpej 		HTONS(ip->ip_off);
    577       1.1       cgd 		ip->ip_sum = 0;
    578       1.1       cgd 		ip->ip_sum = in_cksum(m, hlen);
    579      1.24   mycroft 		error = (*ifp->if_output)(ifp, m, sintosa(dst), ro->ro_rt);
    580       1.1       cgd 		goto done;
    581       1.1       cgd 	}
    582      1.61    itojun 
    583       1.1       cgd 	/*
    584       1.1       cgd 	 * Too large for interface; fragment if possible.
    585       1.1       cgd 	 * Must be able to put at least 8 bytes per fragment.
    586       1.1       cgd 	 */
    587      1.61    itojun #if 0
    588      1.61    itojun 	/*
    589      1.61    itojun 	 * If IPsec packet is too big for the interface, try fragment it.
    590      1.61    itojun 	 * XXX This really is a quickhack.  May be inappropriate.
    591      1.61    itojun 	 * XXX fails if somebody is sending AH'ed packet, with:
    592      1.61    itojun 	 *	sizeof(packet without AH) < mtu < sizeof(packet with AH)
    593      1.61    itojun 	 */
    594      1.61    itojun 	if (sab && ip->ip_p != IPPROTO_AH && (flags & IP_FORWARDING) == 0)
    595      1.61    itojun 		ip->ip_off &= ~IP_DF;
    596      1.61    itojun #endif /*IPSEC*/
    597       1.1       cgd 	if (ip->ip_off & IP_DF) {
    598      1.40      matt 		if (flags & IP_RETURNMTU)
    599      1.48      matt 			*mtu_p = mtu;
    600       1.1       cgd 		error = EMSGSIZE;
    601      1.18   mycroft 		ipstat.ips_cantfrag++;
    602       1.1       cgd 		goto bad;
    603       1.1       cgd 	}
    604      1.48      matt 	len = (mtu - hlen) &~ 7;
    605       1.1       cgd 	if (len < 8) {
    606       1.1       cgd 		error = EMSGSIZE;
    607       1.1       cgd 		goto bad;
    608       1.1       cgd 	}
    609       1.1       cgd 
    610       1.1       cgd     {
    611       1.1       cgd 	int mhlen, firstlen = len;
    612       1.1       cgd 	struct mbuf **mnext = &m->m_nextpkt;
    613      1.48      matt 	int fragments = 0;
    614      1.48      matt 	int s;
    615       1.1       cgd 
    616       1.1       cgd 	/*
    617       1.1       cgd 	 * Loop through length of segment after first fragment,
    618       1.1       cgd 	 * make new header and copy data of each part and link onto chain.
    619       1.1       cgd 	 */
    620       1.1       cgd 	m0 = m;
    621       1.1       cgd 	mhlen = sizeof (struct ip);
    622      1.21       cgd 	for (off = hlen + len; off < (u_int16_t)ip->ip_len; off += len) {
    623       1.1       cgd 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
    624       1.1       cgd 		if (m == 0) {
    625       1.1       cgd 			error = ENOBUFS;
    626      1.18   mycroft 			ipstat.ips_odropped++;
    627       1.1       cgd 			goto sendorfree;
    628       1.1       cgd 		}
    629      1.22       cgd 		*mnext = m;
    630      1.22       cgd 		mnext = &m->m_nextpkt;
    631       1.1       cgd 		m->m_data += max_linkhdr;
    632       1.1       cgd 		mhip = mtod(m, struct ip *);
    633       1.1       cgd 		*mhip = *ip;
    634  1.62.2.1    bouyer 		/* we must inherit MCAST and BCAST flags */
    635  1.62.2.1    bouyer 		m->m_flags |= m0->m_flags & (M_MCAST|M_BCAST);
    636       1.1       cgd 		if (hlen > sizeof (struct ip)) {
    637       1.1       cgd 			mhlen = ip_optcopy(ip, mhip) + sizeof (struct ip);
    638       1.1       cgd 			mhip->ip_hl = mhlen >> 2;
    639       1.1       cgd 		}
    640       1.1       cgd 		m->m_len = mhlen;
    641       1.1       cgd 		mhip->ip_off = ((off - hlen) >> 3) + (ip->ip_off & ~IP_MF);
    642       1.1       cgd 		if (ip->ip_off & IP_MF)
    643       1.1       cgd 			mhip->ip_off |= IP_MF;
    644      1.21       cgd 		if (off + len >= (u_int16_t)ip->ip_len)
    645      1.21       cgd 			len = (u_int16_t)ip->ip_len - off;
    646       1.1       cgd 		else
    647       1.1       cgd 			mhip->ip_off |= IP_MF;
    648      1.21       cgd 		mhip->ip_len = htons((u_int16_t)(len + mhlen));
    649       1.1       cgd 		m->m_next = m_copy(m0, off, len);
    650       1.1       cgd 		if (m->m_next == 0) {
    651       1.1       cgd 			error = ENOBUFS;	/* ??? */
    652      1.18   mycroft 			ipstat.ips_odropped++;
    653       1.1       cgd 			goto sendorfree;
    654       1.1       cgd 		}
    655       1.1       cgd 		m->m_pkthdr.len = mhlen + len;
    656       1.1       cgd 		m->m_pkthdr.rcvif = (struct ifnet *)0;
    657      1.55   thorpej 		HTONS(mhip->ip_off);
    658       1.1       cgd 		mhip->ip_sum = 0;
    659       1.1       cgd 		mhip->ip_sum = in_cksum(m, mhlen);
    660       1.1       cgd 		ipstat.ips_ofragments++;
    661      1.48      matt 		fragments++;
    662       1.1       cgd 	}
    663       1.1       cgd 	/*
    664       1.1       cgd 	 * Update first fragment by trimming what's been copied out
    665       1.1       cgd 	 * and updating header, then send each fragment (in order).
    666       1.1       cgd 	 */
    667       1.1       cgd 	m = m0;
    668      1.21       cgd 	m_adj(m, hlen + firstlen - (u_int16_t)ip->ip_len);
    669       1.1       cgd 	m->m_pkthdr.len = hlen + firstlen;
    670      1.21       cgd 	ip->ip_len = htons((u_int16_t)m->m_pkthdr.len);
    671      1.55   thorpej 	ip->ip_off |= IP_MF;
    672      1.55   thorpej 	HTONS(ip->ip_off);
    673       1.1       cgd 	ip->ip_sum = 0;
    674       1.1       cgd 	ip->ip_sum = in_cksum(m, hlen);
    675       1.1       cgd sendorfree:
    676      1.48      matt 	/*
    677      1.48      matt 	 * If there is no room for all the fragments, don't queue
    678      1.48      matt 	 * any of them.
    679      1.48      matt 	 */
    680      1.48      matt 	s = splimp();
    681      1.48      matt 	if (ifp->if_snd.ifq_maxlen - ifp->if_snd.ifq_len < fragments)
    682      1.48      matt 		error = ENOBUFS;
    683      1.48      matt 	splx(s);
    684       1.1       cgd 	for (m = m0; m; m = m0) {
    685       1.1       cgd 		m0 = m->m_nextpkt;
    686       1.1       cgd 		m->m_nextpkt = 0;
    687  1.62.2.1    bouyer 		if (error == 0) {
    688  1.62.2.1    bouyer #if IFA_STATS
    689  1.62.2.1    bouyer 			/*
    690  1.62.2.1    bouyer 			 * search for the source address structure to
    691  1.62.2.1    bouyer 			 * maintain output statistics.
    692  1.62.2.1    bouyer 			 */
    693  1.62.2.1    bouyer 			INADDR_TO_IA(ip->ip_src, ia);
    694  1.62.2.1    bouyer 			if (ia) {
    695  1.62.2.1    bouyer 				ia->ia_ifa.ifa_data.ifad_outbytes +=
    696  1.62.2.1    bouyer 					ntohs(ip->ip_len);
    697  1.62.2.1    bouyer 			}
    698  1.62.2.1    bouyer #endif
    699      1.24   mycroft 			error = (*ifp->if_output)(ifp, m, sintosa(dst),
    700      1.24   mycroft 			    ro->ro_rt);
    701  1.62.2.1    bouyer 		} else
    702       1.1       cgd 			m_freem(m);
    703       1.1       cgd 	}
    704      1.18   mycroft 
    705      1.18   mycroft 	if (error == 0)
    706      1.18   mycroft 		ipstat.ips_fragmented++;
    707       1.1       cgd     }
    708       1.1       cgd done:
    709      1.31   mycroft 	if (ro == &iproute && (flags & IP_ROUTETOIF) == 0 && ro->ro_rt) {
    710       1.1       cgd 		RTFREE(ro->ro_rt);
    711      1.31   mycroft 		ro->ro_rt = 0;
    712      1.31   mycroft 	}
    713      1.61    itojun 
    714      1.61    itojun #ifdef IPSEC
    715      1.61    itojun 	if (sp != NULL) {
    716      1.61    itojun 		KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
    717      1.61    itojun 			printf("DP ip_output call free SP:%p\n", sp));
    718      1.61    itojun 		key_freesp(sp);
    719      1.61    itojun 	}
    720      1.61    itojun #endif /* IPSEC */
    721      1.61    itojun 
    722       1.1       cgd 	return (error);
    723       1.1       cgd bad:
    724      1.33        is 	m_freem(m);
    725       1.1       cgd 	goto done;
    726       1.1       cgd }
    727      1.47       kml 
    728      1.47       kml /*
    729      1.47       kml  * Determine the maximum length of the options to be inserted;
    730      1.47       kml  * we would far rather allocate too much space rather than too little.
    731      1.47       kml  */
    732      1.47       kml 
    733      1.47       kml u_int
    734      1.47       kml ip_optlen(inp)
    735      1.47       kml 	struct inpcb *inp;
    736      1.47       kml {
    737      1.47       kml 	struct mbuf *m = inp->inp_options;
    738      1.47       kml 
    739      1.47       kml 	if (m && m->m_len > offsetof(struct ipoption, ipopt_dst))
    740      1.47       kml 		return(m->m_len - offsetof(struct ipoption, ipopt_dst));
    741      1.47       kml 	else
    742      1.47       kml 		return 0;
    743      1.47       kml }
    744      1.47       kml 
    745       1.1       cgd 
    746       1.1       cgd /*
    747       1.1       cgd  * Insert IP options into preformed packet.
    748       1.1       cgd  * Adjust IP destination as required for IP source routing,
    749       1.1       cgd  * as indicated by a non-zero in_addr at the start of the options.
    750       1.1       cgd  */
    751      1.12   mycroft static struct mbuf *
    752       1.1       cgd ip_insertoptions(m, opt, phlen)
    753  1.62.2.1    bouyer 	struct mbuf *m;
    754       1.1       cgd 	struct mbuf *opt;
    755       1.1       cgd 	int *phlen;
    756       1.1       cgd {
    757  1.62.2.1    bouyer 	struct ipoption *p = mtod(opt, struct ipoption *);
    758       1.1       cgd 	struct mbuf *n;
    759  1.62.2.1    bouyer 	struct ip *ip = mtod(m, struct ip *);
    760       1.1       cgd 	unsigned optlen;
    761       1.1       cgd 
    762       1.1       cgd 	optlen = opt->m_len - sizeof(p->ipopt_dst);
    763      1.21       cgd 	if (optlen + (u_int16_t)ip->ip_len > IP_MAXPACKET)
    764       1.1       cgd 		return (m);		/* XXX should fail */
    765      1.31   mycroft 	if (!in_nullhost(p->ipopt_dst))
    766       1.1       cgd 		ip->ip_dst = p->ipopt_dst;
    767       1.1       cgd 	if (m->m_flags & M_EXT || m->m_data - optlen < m->m_pktdat) {
    768       1.1       cgd 		MGETHDR(n, M_DONTWAIT, MT_HEADER);
    769       1.1       cgd 		if (n == 0)
    770       1.1       cgd 			return (m);
    771       1.1       cgd 		n->m_pkthdr.len = m->m_pkthdr.len + optlen;
    772       1.1       cgd 		m->m_len -= sizeof(struct ip);
    773       1.1       cgd 		m->m_data += sizeof(struct ip);
    774       1.1       cgd 		n->m_next = m;
    775       1.1       cgd 		m = n;
    776       1.1       cgd 		m->m_len = optlen + sizeof(struct ip);
    777       1.1       cgd 		m->m_data += max_linkhdr;
    778       1.1       cgd 		bcopy((caddr_t)ip, mtod(m, caddr_t), sizeof(struct ip));
    779       1.1       cgd 	} else {
    780       1.1       cgd 		m->m_data -= optlen;
    781       1.1       cgd 		m->m_len += optlen;
    782       1.1       cgd 		m->m_pkthdr.len += optlen;
    783      1.57     perry 		memmove(mtod(m, caddr_t), ip, sizeof(struct ip));
    784       1.1       cgd 	}
    785       1.1       cgd 	ip = mtod(m, struct ip *);
    786       1.1       cgd 	bcopy((caddr_t)p->ipopt_list, (caddr_t)(ip + 1), (unsigned)optlen);
    787       1.1       cgd 	*phlen = sizeof(struct ip) + optlen;
    788       1.1       cgd 	ip->ip_len += optlen;
    789       1.1       cgd 	return (m);
    790       1.1       cgd }
    791       1.1       cgd 
    792       1.1       cgd /*
    793       1.1       cgd  * Copy options from ip to jp,
    794       1.1       cgd  * omitting those not copied during fragmentation.
    795       1.1       cgd  */
    796      1.12   mycroft int
    797       1.1       cgd ip_optcopy(ip, jp)
    798       1.1       cgd 	struct ip *ip, *jp;
    799       1.1       cgd {
    800  1.62.2.1    bouyer 	u_char *cp, *dp;
    801       1.1       cgd 	int opt, optlen, cnt;
    802       1.1       cgd 
    803       1.1       cgd 	cp = (u_char *)(ip + 1);
    804       1.1       cgd 	dp = (u_char *)(jp + 1);
    805       1.1       cgd 	cnt = (ip->ip_hl << 2) - sizeof (struct ip);
    806       1.1       cgd 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
    807       1.1       cgd 		opt = cp[0];
    808       1.1       cgd 		if (opt == IPOPT_EOL)
    809       1.1       cgd 			break;
    810      1.18   mycroft 		if (opt == IPOPT_NOP) {
    811      1.18   mycroft 			/* Preserve for IP mcast tunnel's LSRR alignment. */
    812      1.18   mycroft 			*dp++ = IPOPT_NOP;
    813       1.1       cgd 			optlen = 1;
    814      1.18   mycroft 			continue;
    815  1.62.2.1    bouyer 		}
    816  1.62.2.1    bouyer #ifdef DIAGNOSTIC
    817  1.62.2.1    bouyer 		if (cnt < IPOPT_OLEN + sizeof(*cp))
    818  1.62.2.1    bouyer 			panic("malformed IPv4 option passed to ip_optcopy");
    819  1.62.2.1    bouyer #endif
    820  1.62.2.1    bouyer 		optlen = cp[IPOPT_OLEN];
    821  1.62.2.1    bouyer #ifdef DIAGNOSTIC
    822  1.62.2.1    bouyer 		if (optlen < IPOPT_OLEN + sizeof(*cp) || optlen > cnt)
    823  1.62.2.1    bouyer 			panic("malformed IPv4 option passed to ip_optcopy");
    824  1.62.2.1    bouyer #endif
    825       1.1       cgd 		/* bogus lengths should have been caught by ip_dooptions */
    826       1.1       cgd 		if (optlen > cnt)
    827       1.1       cgd 			optlen = cnt;
    828       1.1       cgd 		if (IPOPT_COPIED(opt)) {
    829       1.1       cgd 			bcopy((caddr_t)cp, (caddr_t)dp, (unsigned)optlen);
    830       1.1       cgd 			dp += optlen;
    831       1.1       cgd 		}
    832       1.1       cgd 	}
    833       1.1       cgd 	for (optlen = dp - (u_char *)(jp+1); optlen & 0x3; optlen++)
    834       1.1       cgd 		*dp++ = IPOPT_EOL;
    835       1.1       cgd 	return (optlen);
    836       1.1       cgd }
    837       1.1       cgd 
    838       1.1       cgd /*
    839       1.1       cgd  * IP socket option processing.
    840       1.1       cgd  */
    841      1.12   mycroft int
    842       1.1       cgd ip_ctloutput(op, so, level, optname, mp)
    843       1.1       cgd 	int op;
    844       1.1       cgd 	struct socket *so;
    845       1.1       cgd 	int level, optname;
    846       1.1       cgd 	struct mbuf **mp;
    847       1.1       cgd {
    848  1.62.2.1    bouyer 	struct inpcb *inp = sotoinpcb(so);
    849  1.62.2.1    bouyer 	struct mbuf *m = *mp;
    850  1.62.2.1    bouyer 	int optval = 0;
    851       1.1       cgd 	int error = 0;
    852      1.61    itojun #ifdef IPSEC
    853      1.61    itojun #ifdef __NetBSD__
    854      1.61    itojun 	struct proc *p = curproc;	/*XXX*/
    855      1.61    itojun #endif
    856      1.61    itojun #endif
    857       1.1       cgd 
    858      1.18   mycroft 	if (level != IPPROTO_IP) {
    859       1.1       cgd 		error = EINVAL;
    860      1.18   mycroft 		if (op == PRCO_SETOPT && *mp)
    861      1.18   mycroft 			(void) m_free(*mp);
    862      1.18   mycroft 	} else switch (op) {
    863       1.1       cgd 
    864       1.1       cgd 	case PRCO_SETOPT:
    865       1.1       cgd 		switch (optname) {
    866       1.1       cgd 		case IP_OPTIONS:
    867       1.1       cgd #ifdef notyet
    868       1.1       cgd 		case IP_RETOPTS:
    869       1.1       cgd 			return (ip_pcbopts(optname, &inp->inp_options, m));
    870       1.1       cgd #else
    871       1.1       cgd 			return (ip_pcbopts(&inp->inp_options, m));
    872       1.1       cgd #endif
    873       1.1       cgd 
    874       1.1       cgd 		case IP_TOS:
    875       1.1       cgd 		case IP_TTL:
    876       1.1       cgd 		case IP_RECVOPTS:
    877       1.1       cgd 		case IP_RECVRETOPTS:
    878       1.1       cgd 		case IP_RECVDSTADDR:
    879      1.37   thorpej 		case IP_RECVIF:
    880      1.27       cgd 			if (m == NULL || m->m_len != sizeof(int))
    881       1.1       cgd 				error = EINVAL;
    882       1.1       cgd 			else {
    883       1.1       cgd 				optval = *mtod(m, int *);
    884       1.1       cgd 				switch (optname) {
    885       1.1       cgd 
    886       1.1       cgd 				case IP_TOS:
    887       1.1       cgd 					inp->inp_ip.ip_tos = optval;
    888       1.1       cgd 					break;
    889       1.1       cgd 
    890       1.1       cgd 				case IP_TTL:
    891       1.1       cgd 					inp->inp_ip.ip_ttl = optval;
    892       1.1       cgd 					break;
    893       1.1       cgd #define	OPTSET(bit) \
    894       1.1       cgd 	if (optval) \
    895       1.1       cgd 		inp->inp_flags |= bit; \
    896       1.1       cgd 	else \
    897       1.1       cgd 		inp->inp_flags &= ~bit;
    898       1.1       cgd 
    899       1.1       cgd 				case IP_RECVOPTS:
    900       1.1       cgd 					OPTSET(INP_RECVOPTS);
    901       1.1       cgd 					break;
    902       1.1       cgd 
    903       1.1       cgd 				case IP_RECVRETOPTS:
    904       1.1       cgd 					OPTSET(INP_RECVRETOPTS);
    905       1.1       cgd 					break;
    906       1.1       cgd 
    907       1.1       cgd 				case IP_RECVDSTADDR:
    908       1.1       cgd 					OPTSET(INP_RECVDSTADDR);
    909       1.1       cgd 					break;
    910      1.37   thorpej 
    911      1.37   thorpej 				case IP_RECVIF:
    912      1.37   thorpej 					OPTSET(INP_RECVIF);
    913      1.37   thorpej 					break;
    914       1.1       cgd 				}
    915       1.1       cgd 			}
    916       1.1       cgd 			break;
    917       1.1       cgd #undef OPTSET
    918      1.18   mycroft 
    919      1.18   mycroft 		case IP_MULTICAST_IF:
    920      1.18   mycroft 		case IP_MULTICAST_TTL:
    921      1.18   mycroft 		case IP_MULTICAST_LOOP:
    922      1.18   mycroft 		case IP_ADD_MEMBERSHIP:
    923      1.18   mycroft 		case IP_DROP_MEMBERSHIP:
    924      1.18   mycroft 			error = ip_setmoptions(optname, &inp->inp_moptions, m);
    925      1.18   mycroft 			break;
    926       1.1       cgd 
    927      1.41     lukem 		case IP_PORTRANGE:
    928      1.41     lukem 			if (m == 0 || m->m_len != sizeof(int))
    929      1.41     lukem 				error = EINVAL;
    930      1.41     lukem 			else {
    931      1.41     lukem 				optval = *mtod(m, int *);
    932      1.41     lukem 
    933      1.41     lukem 				switch (optval) {
    934      1.41     lukem 
    935      1.41     lukem 				case IP_PORTRANGE_DEFAULT:
    936      1.41     lukem 				case IP_PORTRANGE_HIGH:
    937      1.41     lukem 					inp->inp_flags &= ~(INP_LOWPORT);
    938      1.41     lukem 					break;
    939      1.41     lukem 
    940      1.41     lukem 				case IP_PORTRANGE_LOW:
    941      1.41     lukem 					inp->inp_flags |= INP_LOWPORT;
    942      1.41     lukem 					break;
    943      1.41     lukem 
    944      1.41     lukem 				default:
    945      1.41     lukem 					error = EINVAL;
    946      1.41     lukem 					break;
    947      1.41     lukem 				}
    948      1.41     lukem 			}
    949      1.41     lukem 			break;
    950      1.41     lukem 
    951      1.61    itojun #ifdef IPSEC
    952      1.61    itojun 		case IP_IPSEC_POLICY:
    953  1.62.2.1    bouyer 		{
    954      1.61    itojun 			caddr_t req = NULL;
    955  1.62.2.1    bouyer 			size_t len = 0;
    956      1.61    itojun 			int priv = 0;
    957  1.62.2.1    bouyer 
    958      1.61    itojun #ifdef __NetBSD__
    959      1.61    itojun 			if (p == 0 || suser(p->p_ucred, &p->p_acflag))
    960      1.61    itojun 				priv = 0;
    961      1.61    itojun 			else
    962      1.61    itojun 				priv = 1;
    963      1.61    itojun #else
    964      1.61    itojun 			priv = (in6p->in6p_socket->so_state & SS_PRIV);
    965      1.61    itojun #endif
    966  1.62.2.1    bouyer 			if (m) {
    967      1.61    itojun 				req = mtod(m, caddr_t);
    968      1.61    itojun 				len = m->m_len;
    969      1.61    itojun 			}
    970  1.62.2.1    bouyer 			error = ipsec4_set_policy(inp, optname, req, len, priv);
    971      1.61    itojun 			break;
    972      1.61    itojun 		    }
    973      1.61    itojun #endif /*IPSEC*/
    974      1.61    itojun 
    975       1.1       cgd 		default:
    976      1.18   mycroft 			error = ENOPROTOOPT;
    977       1.1       cgd 			break;
    978       1.1       cgd 		}
    979       1.1       cgd 		if (m)
    980       1.1       cgd 			(void)m_free(m);
    981       1.1       cgd 		break;
    982       1.1       cgd 
    983       1.1       cgd 	case PRCO_GETOPT:
    984       1.1       cgd 		switch (optname) {
    985       1.1       cgd 		case IP_OPTIONS:
    986       1.1       cgd 		case IP_RETOPTS:
    987       1.1       cgd 			*mp = m = m_get(M_WAIT, MT_SOOPTS);
    988       1.1       cgd 			if (inp->inp_options) {
    989       1.1       cgd 				m->m_len = inp->inp_options->m_len;
    990       1.1       cgd 				bcopy(mtod(inp->inp_options, caddr_t),
    991       1.1       cgd 				    mtod(m, caddr_t), (unsigned)m->m_len);
    992       1.1       cgd 			} else
    993       1.1       cgd 				m->m_len = 0;
    994       1.1       cgd 			break;
    995       1.1       cgd 
    996       1.1       cgd 		case IP_TOS:
    997       1.1       cgd 		case IP_TTL:
    998       1.1       cgd 		case IP_RECVOPTS:
    999       1.1       cgd 		case IP_RECVRETOPTS:
   1000       1.1       cgd 		case IP_RECVDSTADDR:
   1001      1.37   thorpej 		case IP_RECVIF:
   1002      1.40      matt 		case IP_ERRORMTU:
   1003       1.1       cgd 			*mp = m = m_get(M_WAIT, MT_SOOPTS);
   1004       1.1       cgd 			m->m_len = sizeof(int);
   1005       1.1       cgd 			switch (optname) {
   1006       1.1       cgd 
   1007       1.1       cgd 			case IP_TOS:
   1008       1.1       cgd 				optval = inp->inp_ip.ip_tos;
   1009       1.1       cgd 				break;
   1010       1.1       cgd 
   1011       1.1       cgd 			case IP_TTL:
   1012       1.1       cgd 				optval = inp->inp_ip.ip_ttl;
   1013      1.40      matt 				break;
   1014      1.40      matt 
   1015      1.40      matt 			case IP_ERRORMTU:
   1016      1.40      matt 				optval = inp->inp_errormtu;
   1017       1.1       cgd 				break;
   1018       1.1       cgd 
   1019       1.1       cgd #define	OPTBIT(bit)	(inp->inp_flags & bit ? 1 : 0)
   1020       1.1       cgd 
   1021       1.1       cgd 			case IP_RECVOPTS:
   1022       1.1       cgd 				optval = OPTBIT(INP_RECVOPTS);
   1023       1.1       cgd 				break;
   1024       1.1       cgd 
   1025       1.1       cgd 			case IP_RECVRETOPTS:
   1026       1.1       cgd 				optval = OPTBIT(INP_RECVRETOPTS);
   1027       1.1       cgd 				break;
   1028       1.1       cgd 
   1029       1.1       cgd 			case IP_RECVDSTADDR:
   1030       1.1       cgd 				optval = OPTBIT(INP_RECVDSTADDR);
   1031      1.37   thorpej 				break;
   1032      1.37   thorpej 
   1033      1.37   thorpej 			case IP_RECVIF:
   1034      1.37   thorpej 				optval = OPTBIT(INP_RECVIF);
   1035       1.1       cgd 				break;
   1036       1.1       cgd 			}
   1037       1.1       cgd 			*mtod(m, int *) = optval;
   1038       1.1       cgd 			break;
   1039      1.61    itojun 
   1040      1.61    itojun #ifdef IPSEC
   1041      1.61    itojun 		case IP_IPSEC_POLICY:
   1042  1.62.2.1    bouyer 		{
   1043  1.62.2.1    bouyer 			caddr_t req = NULL;
   1044  1.62.2.1    bouyer 			size_t len;
   1045  1.62.2.1    bouyer 
   1046  1.62.2.1    bouyer 			if (m) {
   1047  1.62.2.1    bouyer 				req = mtod(m, caddr_t);
   1048  1.62.2.1    bouyer 				len = m->m_len;
   1049  1.62.2.1    bouyer 			}
   1050  1.62.2.1    bouyer 			error = ipsec4_get_policy(inp, req, len, mp);
   1051      1.61    itojun 			break;
   1052  1.62.2.1    bouyer 		}
   1053      1.61    itojun #endif /*IPSEC*/
   1054      1.18   mycroft 
   1055      1.18   mycroft 		case IP_MULTICAST_IF:
   1056      1.18   mycroft 		case IP_MULTICAST_TTL:
   1057      1.18   mycroft 		case IP_MULTICAST_LOOP:
   1058      1.18   mycroft 		case IP_ADD_MEMBERSHIP:
   1059      1.18   mycroft 		case IP_DROP_MEMBERSHIP:
   1060      1.18   mycroft 			error = ip_getmoptions(optname, inp->inp_moptions, mp);
   1061      1.41     lukem 			break;
   1062      1.41     lukem 
   1063      1.41     lukem 		case IP_PORTRANGE:
   1064      1.41     lukem 			*mp = m = m_get(M_WAIT, MT_SOOPTS);
   1065      1.41     lukem 			m->m_len = sizeof(int);
   1066      1.41     lukem 
   1067      1.41     lukem 			if (inp->inp_flags & INP_LOWPORT)
   1068      1.41     lukem 				optval = IP_PORTRANGE_LOW;
   1069      1.41     lukem 			else
   1070      1.41     lukem 				optval = IP_PORTRANGE_DEFAULT;
   1071      1.41     lukem 
   1072      1.41     lukem 			*mtod(m, int *) = optval;
   1073      1.18   mycroft 			break;
   1074       1.1       cgd 
   1075       1.1       cgd 		default:
   1076      1.18   mycroft 			error = ENOPROTOOPT;
   1077       1.1       cgd 			break;
   1078       1.1       cgd 		}
   1079       1.1       cgd 		break;
   1080       1.1       cgd 	}
   1081       1.1       cgd 	return (error);
   1082       1.1       cgd }
   1083       1.1       cgd 
   1084       1.1       cgd /*
   1085       1.1       cgd  * Set up IP options in pcb for insertion in output packets.
   1086       1.1       cgd  * Store in mbuf with pointer in pcbopt, adding pseudo-option
   1087       1.1       cgd  * with destination address if source routed.
   1088       1.1       cgd  */
   1089      1.12   mycroft int
   1090       1.1       cgd #ifdef notyet
   1091       1.1       cgd ip_pcbopts(optname, pcbopt, m)
   1092       1.1       cgd 	int optname;
   1093       1.1       cgd #else
   1094       1.1       cgd ip_pcbopts(pcbopt, m)
   1095       1.1       cgd #endif
   1096       1.1       cgd 	struct mbuf **pcbopt;
   1097  1.62.2.1    bouyer 	struct mbuf *m;
   1098       1.1       cgd {
   1099  1.62.2.1    bouyer 	int cnt, optlen;
   1100  1.62.2.1    bouyer 	u_char *cp;
   1101       1.1       cgd 	u_char opt;
   1102       1.1       cgd 
   1103       1.1       cgd 	/* turn off any old options */
   1104       1.1       cgd 	if (*pcbopt)
   1105       1.1       cgd 		(void)m_free(*pcbopt);
   1106       1.1       cgd 	*pcbopt = 0;
   1107       1.1       cgd 	if (m == (struct mbuf *)0 || m->m_len == 0) {
   1108       1.1       cgd 		/*
   1109       1.1       cgd 		 * Only turning off any previous options.
   1110       1.1       cgd 		 */
   1111       1.1       cgd 		if (m)
   1112       1.1       cgd 			(void)m_free(m);
   1113       1.1       cgd 		return (0);
   1114       1.1       cgd 	}
   1115       1.1       cgd 
   1116       1.1       cgd #ifndef	vax
   1117      1.21       cgd 	if (m->m_len % sizeof(int32_t))
   1118       1.1       cgd 		goto bad;
   1119       1.1       cgd #endif
   1120       1.1       cgd 	/*
   1121       1.1       cgd 	 * IP first-hop destination address will be stored before
   1122       1.1       cgd 	 * actual options; move other options back
   1123       1.1       cgd 	 * and clear it when none present.
   1124       1.1       cgd 	 */
   1125       1.1       cgd 	if (m->m_data + m->m_len + sizeof(struct in_addr) >= &m->m_dat[MLEN])
   1126       1.1       cgd 		goto bad;
   1127       1.1       cgd 	cnt = m->m_len;
   1128       1.1       cgd 	m->m_len += sizeof(struct in_addr);
   1129       1.1       cgd 	cp = mtod(m, u_char *) + sizeof(struct in_addr);
   1130      1.57     perry 	memmove(cp, mtod(m, caddr_t), (unsigned)cnt);
   1131       1.1       cgd 	bzero(mtod(m, caddr_t), sizeof(struct in_addr));
   1132       1.1       cgd 
   1133       1.1       cgd 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
   1134       1.1       cgd 		opt = cp[IPOPT_OPTVAL];
   1135       1.1       cgd 		if (opt == IPOPT_EOL)
   1136       1.1       cgd 			break;
   1137       1.1       cgd 		if (opt == IPOPT_NOP)
   1138       1.1       cgd 			optlen = 1;
   1139       1.1       cgd 		else {
   1140  1.62.2.1    bouyer 			if (cnt < IPOPT_OLEN + sizeof(*cp))
   1141  1.62.2.1    bouyer 				goto bad;
   1142       1.1       cgd 			optlen = cp[IPOPT_OLEN];
   1143  1.62.2.1    bouyer 			if (optlen < IPOPT_OLEN  + sizeof(*cp) || optlen > cnt)
   1144       1.1       cgd 				goto bad;
   1145       1.1       cgd 		}
   1146       1.1       cgd 		switch (opt) {
   1147       1.1       cgd 
   1148       1.1       cgd 		default:
   1149       1.1       cgd 			break;
   1150       1.1       cgd 
   1151       1.1       cgd 		case IPOPT_LSRR:
   1152       1.1       cgd 		case IPOPT_SSRR:
   1153       1.1       cgd 			/*
   1154       1.1       cgd 			 * user process specifies route as:
   1155       1.1       cgd 			 *	->A->B->C->D
   1156       1.1       cgd 			 * D must be our final destination (but we can't
   1157       1.1       cgd 			 * check that since we may not have connected yet).
   1158       1.1       cgd 			 * A is first hop destination, which doesn't appear in
   1159       1.1       cgd 			 * actual IP option, but is stored before the options.
   1160       1.1       cgd 			 */
   1161       1.1       cgd 			if (optlen < IPOPT_MINOFF - 1 + sizeof(struct in_addr))
   1162       1.1       cgd 				goto bad;
   1163       1.1       cgd 			m->m_len -= sizeof(struct in_addr);
   1164       1.1       cgd 			cnt -= sizeof(struct in_addr);
   1165       1.1       cgd 			optlen -= sizeof(struct in_addr);
   1166       1.1       cgd 			cp[IPOPT_OLEN] = optlen;
   1167       1.1       cgd 			/*
   1168       1.1       cgd 			 * Move first hop before start of options.
   1169       1.1       cgd 			 */
   1170       1.1       cgd 			bcopy((caddr_t)&cp[IPOPT_OFFSET+1], mtod(m, caddr_t),
   1171       1.1       cgd 			    sizeof(struct in_addr));
   1172       1.1       cgd 			/*
   1173       1.1       cgd 			 * Then copy rest of options back
   1174       1.1       cgd 			 * to close up the deleted entry.
   1175       1.1       cgd 			 */
   1176      1.57     perry 			memmove(&cp[IPOPT_OFFSET+1],
   1177      1.57     perry                             (caddr_t)(&cp[IPOPT_OFFSET+1] + sizeof(struct in_addr)),
   1178       1.1       cgd 			    (unsigned)cnt + sizeof(struct in_addr));
   1179       1.1       cgd 			break;
   1180       1.1       cgd 		}
   1181       1.1       cgd 	}
   1182       1.1       cgd 	if (m->m_len > MAX_IPOPTLEN + sizeof(struct in_addr))
   1183       1.1       cgd 		goto bad;
   1184       1.1       cgd 	*pcbopt = m;
   1185       1.1       cgd 	return (0);
   1186       1.1       cgd 
   1187       1.1       cgd bad:
   1188       1.1       cgd 	(void)m_free(m);
   1189       1.1       cgd 	return (EINVAL);
   1190       1.1       cgd }
   1191       1.5   hpeyerl 
   1192       1.5   hpeyerl /*
   1193       1.5   hpeyerl  * Set the IP multicast options in response to user setsockopt().
   1194       1.5   hpeyerl  */
   1195       1.5   hpeyerl int
   1196       1.5   hpeyerl ip_setmoptions(optname, imop, m)
   1197       1.5   hpeyerl 	int optname;
   1198       1.5   hpeyerl 	struct ip_moptions **imop;
   1199       1.5   hpeyerl 	struct mbuf *m;
   1200       1.5   hpeyerl {
   1201  1.62.2.1    bouyer 	int error = 0;
   1202       1.5   hpeyerl 	u_char loop;
   1203  1.62.2.1    bouyer 	int i;
   1204       1.5   hpeyerl 	struct in_addr addr;
   1205  1.62.2.1    bouyer 	struct ip_mreq *mreq;
   1206  1.62.2.1    bouyer 	struct ifnet *ifp;
   1207  1.62.2.1    bouyer 	struct ip_moptions *imo = *imop;
   1208       1.5   hpeyerl 	struct route ro;
   1209  1.62.2.1    bouyer 	struct sockaddr_in *dst;
   1210       1.5   hpeyerl 
   1211       1.5   hpeyerl 	if (imo == NULL) {
   1212       1.5   hpeyerl 		/*
   1213       1.5   hpeyerl 		 * No multicast option buffer attached to the pcb;
   1214       1.5   hpeyerl 		 * allocate one and initialize to default values.
   1215       1.5   hpeyerl 		 */
   1216      1.22       cgd 		imo = (struct ip_moptions *)malloc(sizeof(*imo), M_IPMOPTS,
   1217       1.5   hpeyerl 		    M_WAITOK);
   1218       1.5   hpeyerl 
   1219       1.5   hpeyerl 		if (imo == NULL)
   1220       1.5   hpeyerl 			return (ENOBUFS);
   1221       1.5   hpeyerl 		*imop = imo;
   1222       1.5   hpeyerl 		imo->imo_multicast_ifp = NULL;
   1223       1.5   hpeyerl 		imo->imo_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
   1224       1.5   hpeyerl 		imo->imo_multicast_loop = IP_DEFAULT_MULTICAST_LOOP;
   1225       1.5   hpeyerl 		imo->imo_num_memberships = 0;
   1226       1.5   hpeyerl 	}
   1227       1.5   hpeyerl 
   1228       1.5   hpeyerl 	switch (optname) {
   1229       1.5   hpeyerl 
   1230       1.5   hpeyerl 	case IP_MULTICAST_IF:
   1231       1.5   hpeyerl 		/*
   1232       1.5   hpeyerl 		 * Select the interface for outgoing multicast packets.
   1233       1.5   hpeyerl 		 */
   1234       1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct in_addr)) {
   1235       1.5   hpeyerl 			error = EINVAL;
   1236       1.5   hpeyerl 			break;
   1237       1.5   hpeyerl 		}
   1238       1.5   hpeyerl 		addr = *(mtod(m, struct in_addr *));
   1239       1.5   hpeyerl 		/*
   1240       1.5   hpeyerl 		 * INADDR_ANY is used to remove a previous selection.
   1241      1.11   mycroft 		 * When no interface is selected, a default one is
   1242       1.5   hpeyerl 		 * chosen every time a multicast packet is sent.
   1243       1.5   hpeyerl 		 */
   1244      1.31   mycroft 		if (in_nullhost(addr)) {
   1245       1.5   hpeyerl 			imo->imo_multicast_ifp = NULL;
   1246       1.5   hpeyerl 			break;
   1247       1.5   hpeyerl 		}
   1248       1.5   hpeyerl 		/*
   1249       1.5   hpeyerl 		 * The selected interface is identified by its local
   1250       1.5   hpeyerl 		 * IP address.  Find the interface and confirm that
   1251      1.11   mycroft 		 * it supports multicasting.
   1252       1.5   hpeyerl 		 */
   1253       1.5   hpeyerl 		INADDR_TO_IFP(addr, ifp);
   1254       1.5   hpeyerl 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
   1255       1.5   hpeyerl 			error = EADDRNOTAVAIL;
   1256       1.5   hpeyerl 			break;
   1257       1.5   hpeyerl 		}
   1258       1.5   hpeyerl 		imo->imo_multicast_ifp = ifp;
   1259       1.5   hpeyerl 		break;
   1260       1.5   hpeyerl 
   1261       1.5   hpeyerl 	case IP_MULTICAST_TTL:
   1262       1.5   hpeyerl 		/*
   1263       1.5   hpeyerl 		 * Set the IP time-to-live for outgoing multicast packets.
   1264       1.5   hpeyerl 		 */
   1265       1.5   hpeyerl 		if (m == NULL || m->m_len != 1) {
   1266       1.5   hpeyerl 			error = EINVAL;
   1267       1.5   hpeyerl 			break;
   1268       1.5   hpeyerl 		}
   1269       1.5   hpeyerl 		imo->imo_multicast_ttl = *(mtod(m, u_char *));
   1270       1.5   hpeyerl 		break;
   1271      1.11   mycroft 
   1272       1.5   hpeyerl 	case IP_MULTICAST_LOOP:
   1273       1.5   hpeyerl 		/*
   1274       1.5   hpeyerl 		 * Set the loopback flag for outgoing multicast packets.
   1275       1.5   hpeyerl 		 * Must be zero or one.
   1276       1.5   hpeyerl 		 */
   1277       1.5   hpeyerl 		if (m == NULL || m->m_len != 1 ||
   1278       1.5   hpeyerl 		   (loop = *(mtod(m, u_char *))) > 1) {
   1279       1.5   hpeyerl 			error = EINVAL;
   1280       1.5   hpeyerl 			break;
   1281      1.11   mycroft 		}
   1282       1.5   hpeyerl 		imo->imo_multicast_loop = loop;
   1283       1.5   hpeyerl 		break;
   1284       1.5   hpeyerl 
   1285       1.5   hpeyerl 	case IP_ADD_MEMBERSHIP:
   1286       1.5   hpeyerl 		/*
   1287       1.5   hpeyerl 		 * Add a multicast group membership.
   1288       1.5   hpeyerl 		 * Group must be a valid IP multicast address.
   1289       1.5   hpeyerl 		 */
   1290       1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
   1291       1.5   hpeyerl 			error = EINVAL;
   1292       1.5   hpeyerl 			break;
   1293       1.5   hpeyerl 		}
   1294       1.5   hpeyerl 		mreq = mtod(m, struct ip_mreq *);
   1295      1.23   mycroft 		if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
   1296       1.5   hpeyerl 			error = EINVAL;
   1297       1.5   hpeyerl 			break;
   1298       1.5   hpeyerl 		}
   1299       1.5   hpeyerl 		/*
   1300       1.5   hpeyerl 		 * If no interface address was provided, use the interface of
   1301       1.5   hpeyerl 		 * the route to the given multicast address.
   1302       1.5   hpeyerl 		 */
   1303      1.31   mycroft 		if (in_nullhost(mreq->imr_interface)) {
   1304      1.53        ws 			bzero((caddr_t)&ro, sizeof(ro));
   1305       1.5   hpeyerl 			ro.ro_rt = NULL;
   1306      1.24   mycroft 			dst = satosin(&ro.ro_dst);
   1307       1.5   hpeyerl 			dst->sin_len = sizeof(*dst);
   1308       1.5   hpeyerl 			dst->sin_family = AF_INET;
   1309       1.5   hpeyerl 			dst->sin_addr = mreq->imr_multiaddr;
   1310       1.5   hpeyerl 			rtalloc(&ro);
   1311       1.5   hpeyerl 			if (ro.ro_rt == NULL) {
   1312       1.5   hpeyerl 				error = EADDRNOTAVAIL;
   1313       1.5   hpeyerl 				break;
   1314       1.5   hpeyerl 			}
   1315       1.5   hpeyerl 			ifp = ro.ro_rt->rt_ifp;
   1316       1.5   hpeyerl 			rtfree(ro.ro_rt);
   1317      1.23   mycroft 		} else {
   1318       1.5   hpeyerl 			INADDR_TO_IFP(mreq->imr_interface, ifp);
   1319       1.5   hpeyerl 		}
   1320       1.5   hpeyerl 		/*
   1321       1.5   hpeyerl 		 * See if we found an interface, and confirm that it
   1322       1.5   hpeyerl 		 * supports multicast.
   1323       1.5   hpeyerl 		 */
   1324      1.11   mycroft 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
   1325       1.5   hpeyerl 			error = EADDRNOTAVAIL;
   1326       1.5   hpeyerl 			break;
   1327       1.5   hpeyerl 		}
   1328       1.5   hpeyerl 		/*
   1329       1.5   hpeyerl 		 * See if the membership already exists or if all the
   1330       1.5   hpeyerl 		 * membership slots are full.
   1331      1.11   mycroft 		 */
   1332       1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i) {
   1333       1.5   hpeyerl 			if (imo->imo_membership[i]->inm_ifp == ifp &&
   1334      1.31   mycroft 			    in_hosteq(imo->imo_membership[i]->inm_addr,
   1335      1.31   mycroft 				      mreq->imr_multiaddr))
   1336       1.5   hpeyerl 				break;
   1337      1.11   mycroft 		}
   1338       1.5   hpeyerl 		if (i < imo->imo_num_memberships) {
   1339       1.5   hpeyerl 			error = EADDRINUSE;
   1340       1.5   hpeyerl 			break;
   1341       1.5   hpeyerl 		}
   1342       1.5   hpeyerl 		if (i == IP_MAX_MEMBERSHIPS) {
   1343      1.11   mycroft 			error = ETOOMANYREFS;
   1344       1.5   hpeyerl 			break;
   1345       1.5   hpeyerl 		}
   1346       1.5   hpeyerl 		/*
   1347       1.5   hpeyerl 		 * Everything looks good; add a new record to the multicast
   1348       1.5   hpeyerl 		 * address list for the given interface.
   1349       1.5   hpeyerl 		 */
   1350       1.5   hpeyerl 		if ((imo->imo_membership[i] =
   1351       1.5   hpeyerl 		    in_addmulti(&mreq->imr_multiaddr, ifp)) == NULL) {
   1352       1.5   hpeyerl 			error = ENOBUFS;
   1353       1.5   hpeyerl 			break;
   1354       1.5   hpeyerl 		}
   1355       1.5   hpeyerl 		++imo->imo_num_memberships;
   1356       1.5   hpeyerl 		break;
   1357       1.5   hpeyerl 
   1358       1.5   hpeyerl 	case IP_DROP_MEMBERSHIP:
   1359       1.5   hpeyerl 		/*
   1360       1.5   hpeyerl 		 * Drop a multicast group membership.
   1361       1.5   hpeyerl 		 * Group must be a valid IP multicast address.
   1362       1.5   hpeyerl 		 */
   1363       1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
   1364       1.5   hpeyerl 			error = EINVAL;
   1365       1.5   hpeyerl 			break;
   1366       1.5   hpeyerl 		}
   1367       1.5   hpeyerl 		mreq = mtod(m, struct ip_mreq *);
   1368      1.23   mycroft 		if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
   1369       1.5   hpeyerl 			error = EINVAL;
   1370       1.5   hpeyerl 			break;
   1371       1.5   hpeyerl 		}
   1372       1.5   hpeyerl 		/*
   1373       1.5   hpeyerl 		 * If an interface address was specified, get a pointer
   1374       1.5   hpeyerl 		 * to its ifnet structure.
   1375       1.5   hpeyerl 		 */
   1376      1.31   mycroft 		if (in_nullhost(mreq->imr_interface))
   1377       1.5   hpeyerl 			ifp = NULL;
   1378       1.5   hpeyerl 		else {
   1379       1.5   hpeyerl 			INADDR_TO_IFP(mreq->imr_interface, ifp);
   1380       1.5   hpeyerl 			if (ifp == NULL) {
   1381       1.5   hpeyerl 				error = EADDRNOTAVAIL;
   1382       1.5   hpeyerl 				break;
   1383       1.5   hpeyerl 			}
   1384       1.5   hpeyerl 		}
   1385       1.5   hpeyerl 		/*
   1386       1.5   hpeyerl 		 * Find the membership in the membership array.
   1387       1.5   hpeyerl 		 */
   1388       1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i) {
   1389       1.5   hpeyerl 			if ((ifp == NULL ||
   1390       1.5   hpeyerl 			     imo->imo_membership[i]->inm_ifp == ifp) &&
   1391      1.31   mycroft 			     in_hosteq(imo->imo_membership[i]->inm_addr,
   1392      1.31   mycroft 				       mreq->imr_multiaddr))
   1393       1.5   hpeyerl 				break;
   1394       1.5   hpeyerl 		}
   1395       1.5   hpeyerl 		if (i == imo->imo_num_memberships) {
   1396       1.5   hpeyerl 			error = EADDRNOTAVAIL;
   1397       1.5   hpeyerl 			break;
   1398       1.5   hpeyerl 		}
   1399       1.5   hpeyerl 		/*
   1400       1.5   hpeyerl 		 * Give up the multicast address record to which the
   1401       1.5   hpeyerl 		 * membership points.
   1402       1.5   hpeyerl 		 */
   1403      1.11   mycroft 		in_delmulti(imo->imo_membership[i]);
   1404       1.5   hpeyerl 		/*
   1405       1.5   hpeyerl 		 * Remove the gap in the membership array.
   1406       1.5   hpeyerl 		 */
   1407       1.5   hpeyerl 		for (++i; i < imo->imo_num_memberships; ++i)
   1408       1.5   hpeyerl 			imo->imo_membership[i-1] = imo->imo_membership[i];
   1409       1.5   hpeyerl 		--imo->imo_num_memberships;
   1410       1.5   hpeyerl 		break;
   1411       1.5   hpeyerl 
   1412       1.5   hpeyerl 	default:
   1413       1.5   hpeyerl 		error = EOPNOTSUPP;
   1414       1.5   hpeyerl 		break;
   1415       1.5   hpeyerl 	}
   1416       1.5   hpeyerl 
   1417       1.5   hpeyerl 	/*
   1418       1.5   hpeyerl 	 * If all options have default values, no need to keep the mbuf.
   1419       1.5   hpeyerl 	 */
   1420       1.5   hpeyerl 	if (imo->imo_multicast_ifp == NULL &&
   1421       1.5   hpeyerl 	    imo->imo_multicast_ttl == IP_DEFAULT_MULTICAST_TTL &&
   1422       1.5   hpeyerl 	    imo->imo_multicast_loop == IP_DEFAULT_MULTICAST_LOOP &&
   1423       1.5   hpeyerl 	    imo->imo_num_memberships == 0) {
   1424       1.5   hpeyerl 		free(*imop, M_IPMOPTS);
   1425       1.5   hpeyerl 		*imop = NULL;
   1426       1.5   hpeyerl 	}
   1427       1.5   hpeyerl 
   1428       1.5   hpeyerl 	return (error);
   1429       1.5   hpeyerl }
   1430       1.5   hpeyerl 
   1431       1.5   hpeyerl /*
   1432       1.5   hpeyerl  * Return the IP multicast options in response to user getsockopt().
   1433       1.5   hpeyerl  */
   1434       1.5   hpeyerl int
   1435       1.5   hpeyerl ip_getmoptions(optname, imo, mp)
   1436       1.5   hpeyerl 	int optname;
   1437  1.62.2.1    bouyer 	struct ip_moptions *imo;
   1438  1.62.2.1    bouyer 	struct mbuf **mp;
   1439       1.5   hpeyerl {
   1440       1.5   hpeyerl 	u_char *ttl;
   1441       1.5   hpeyerl 	u_char *loop;
   1442       1.5   hpeyerl 	struct in_addr *addr;
   1443       1.5   hpeyerl 	struct in_ifaddr *ia;
   1444       1.5   hpeyerl 
   1445       1.5   hpeyerl 	*mp = m_get(M_WAIT, MT_SOOPTS);
   1446       1.5   hpeyerl 
   1447       1.5   hpeyerl 	switch (optname) {
   1448       1.5   hpeyerl 
   1449       1.5   hpeyerl 	case IP_MULTICAST_IF:
   1450       1.5   hpeyerl 		addr = mtod(*mp, struct in_addr *);
   1451       1.5   hpeyerl 		(*mp)->m_len = sizeof(struct in_addr);
   1452       1.5   hpeyerl 		if (imo == NULL || imo->imo_multicast_ifp == NULL)
   1453      1.31   mycroft 			*addr = zeroin_addr;
   1454       1.5   hpeyerl 		else {
   1455       1.5   hpeyerl 			IFP_TO_IA(imo->imo_multicast_ifp, ia);
   1456      1.31   mycroft 			*addr = ia ? ia->ia_addr.sin_addr : zeroin_addr;
   1457       1.5   hpeyerl 		}
   1458       1.5   hpeyerl 		return (0);
   1459       1.5   hpeyerl 
   1460       1.5   hpeyerl 	case IP_MULTICAST_TTL:
   1461       1.5   hpeyerl 		ttl = mtod(*mp, u_char *);
   1462       1.5   hpeyerl 		(*mp)->m_len = 1;
   1463      1.31   mycroft 		*ttl = imo ? imo->imo_multicast_ttl
   1464      1.31   mycroft 			   : IP_DEFAULT_MULTICAST_TTL;
   1465       1.5   hpeyerl 		return (0);
   1466       1.5   hpeyerl 
   1467       1.5   hpeyerl 	case IP_MULTICAST_LOOP:
   1468       1.5   hpeyerl 		loop = mtod(*mp, u_char *);
   1469       1.5   hpeyerl 		(*mp)->m_len = 1;
   1470      1.31   mycroft 		*loop = imo ? imo->imo_multicast_loop
   1471      1.31   mycroft 			    : IP_DEFAULT_MULTICAST_LOOP;
   1472       1.5   hpeyerl 		return (0);
   1473       1.5   hpeyerl 
   1474       1.5   hpeyerl 	default:
   1475       1.5   hpeyerl 		return (EOPNOTSUPP);
   1476       1.5   hpeyerl 	}
   1477       1.5   hpeyerl }
   1478       1.5   hpeyerl 
   1479       1.5   hpeyerl /*
   1480       1.5   hpeyerl  * Discard the IP multicast options.
   1481       1.5   hpeyerl  */
   1482       1.5   hpeyerl void
   1483       1.5   hpeyerl ip_freemoptions(imo)
   1484  1.62.2.1    bouyer 	struct ip_moptions *imo;
   1485       1.5   hpeyerl {
   1486  1.62.2.1    bouyer 	int i;
   1487       1.5   hpeyerl 
   1488       1.5   hpeyerl 	if (imo != NULL) {
   1489       1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i)
   1490       1.5   hpeyerl 			in_delmulti(imo->imo_membership[i]);
   1491       1.5   hpeyerl 		free(imo, M_IPMOPTS);
   1492       1.5   hpeyerl 	}
   1493       1.5   hpeyerl }
   1494       1.5   hpeyerl 
   1495       1.5   hpeyerl /*
   1496       1.5   hpeyerl  * Routine called from ip_output() to loop back a copy of an IP multicast
   1497       1.5   hpeyerl  * packet to the input queue of a specified interface.  Note that this
   1498       1.5   hpeyerl  * calls the output routine of the loopback "driver", but with an interface
   1499       1.5   hpeyerl  * pointer that might NOT be &loif -- easier than replicating that code here.
   1500       1.5   hpeyerl  */
   1501      1.12   mycroft static void
   1502       1.5   hpeyerl ip_mloopback(ifp, m, dst)
   1503       1.5   hpeyerl 	struct ifnet *ifp;
   1504  1.62.2.1    bouyer 	struct mbuf *m;
   1505  1.62.2.1    bouyer 	struct sockaddr_in *dst;
   1506       1.5   hpeyerl {
   1507  1.62.2.1    bouyer 	struct ip *ip;
   1508       1.5   hpeyerl 	struct mbuf *copym;
   1509       1.5   hpeyerl 
   1510       1.5   hpeyerl 	copym = m_copy(m, 0, M_COPYALL);
   1511  1.62.2.1    bouyer 	if (copym != NULL
   1512  1.62.2.1    bouyer 	 && (copym->m_flags & M_EXT || copym->m_len < sizeof(struct ip)))
   1513  1.62.2.1    bouyer 		copym = m_pullup(copym, sizeof(struct ip));
   1514       1.5   hpeyerl 	if (copym != NULL) {
   1515       1.5   hpeyerl 		/*
   1516       1.5   hpeyerl 		 * We don't bother to fragment if the IP length is greater
   1517       1.5   hpeyerl 		 * than the interface's MTU.  Can this possibly matter?
   1518       1.5   hpeyerl 		 */
   1519       1.5   hpeyerl 		ip = mtod(copym, struct ip *);
   1520      1.55   thorpej 		HTONS(ip->ip_len);
   1521      1.55   thorpej 		HTONS(ip->ip_off);
   1522       1.5   hpeyerl 		ip->ip_sum = 0;
   1523       1.5   hpeyerl 		ip->ip_sum = in_cksum(copym, ip->ip_hl << 2);
   1524      1.24   mycroft 		(void) looutput(ifp, copym, sintosa(dst), NULL);
   1525       1.5   hpeyerl 	}
   1526       1.5   hpeyerl }
   1527