Home | History | Annotate | Line # | Download | only in netinet
ip_output.c revision 1.28
      1  1.28  christos /*	$NetBSD: ip_output.c,v 1.28 1996/02/13 23:43:07 christos Exp $	*/
      2  1.19       cgd 
      3   1.1       cgd /*
      4  1.18   mycroft  * Copyright (c) 1982, 1986, 1988, 1990, 1993
      5  1.18   mycroft  *	The Regents of the University of California.  All rights reserved.
      6   1.1       cgd  *
      7   1.1       cgd  * Redistribution and use in source and binary forms, with or without
      8   1.1       cgd  * modification, are permitted provided that the following conditions
      9   1.1       cgd  * are met:
     10   1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     11   1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     12   1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     14   1.1       cgd  *    documentation and/or other materials provided with the distribution.
     15   1.1       cgd  * 3. All advertising materials mentioning features or use of this software
     16   1.1       cgd  *    must display the following acknowledgement:
     17   1.1       cgd  *	This product includes software developed by the University of
     18   1.1       cgd  *	California, Berkeley and its contributors.
     19   1.1       cgd  * 4. Neither the name of the University nor the names of its contributors
     20   1.1       cgd  *    may be used to endorse or promote products derived from this software
     21   1.1       cgd  *    without specific prior written permission.
     22   1.1       cgd  *
     23   1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     24   1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     25   1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     26   1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     27   1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     28   1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     29   1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     30   1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     31   1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     32   1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     33   1.1       cgd  * SUCH DAMAGE.
     34   1.1       cgd  *
     35  1.19       cgd  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
     36   1.1       cgd  */
     37   1.1       cgd 
     38   1.8   mycroft #include <sys/param.h>
     39   1.8   mycroft #include <sys/malloc.h>
     40   1.8   mycroft #include <sys/mbuf.h>
     41   1.8   mycroft #include <sys/errno.h>
     42   1.8   mycroft #include <sys/protosw.h>
     43   1.8   mycroft #include <sys/socket.h>
     44   1.8   mycroft #include <sys/socketvar.h>
     45  1.28  christos #include <sys/systm.h>
     46   1.1       cgd 
     47   1.8   mycroft #include <net/if.h>
     48   1.8   mycroft #include <net/route.h>
     49   1.1       cgd 
     50   1.8   mycroft #include <netinet/in.h>
     51   1.8   mycroft #include <netinet/in_systm.h>
     52   1.8   mycroft #include <netinet/ip.h>
     53   1.8   mycroft #include <netinet/in_pcb.h>
     54   1.8   mycroft #include <netinet/in_var.h>
     55   1.8   mycroft #include <netinet/ip_var.h>
     56   1.1       cgd 
     57   1.1       cgd #ifdef vax
     58   1.8   mycroft #include <machine/mtpr.h>
     59   1.1       cgd #endif
     60   1.1       cgd 
     61  1.28  christos #include <machine/stdarg.h>
     62  1.28  christos 
     63  1.12   mycroft static struct mbuf *ip_insertoptions __P((struct mbuf *, struct mbuf *, int *));
     64  1.12   mycroft static void ip_mloopback
     65  1.18   mycroft 	__P((struct ifnet *, struct mbuf *, struct sockaddr_in *));
     66   1.1       cgd 
     67   1.1       cgd /*
     68   1.1       cgd  * IP output.  The packet in mbuf chain m contains a skeletal IP
     69   1.1       cgd  * header (with len, off, ttl, proto, tos, src, dst).
     70   1.1       cgd  * The mbuf chain containing the packet will be freed.
     71   1.1       cgd  * The mbuf opt, if present, will not be freed.
     72   1.1       cgd  */
     73  1.12   mycroft int
     74  1.28  christos #if __STDC__
     75  1.28  christos ip_output(struct mbuf *m0, ...)
     76  1.28  christos #else
     77  1.28  christos ip_output(m0, va_alist)
     78   1.1       cgd 	struct mbuf *m0;
     79  1.28  christos 	va_dcl
     80  1.28  christos #endif
     81   1.1       cgd {
     82   1.1       cgd 	register struct ip *ip, *mhip;
     83   1.1       cgd 	register struct ifnet *ifp;
     84   1.1       cgd 	register struct mbuf *m = m0;
     85   1.1       cgd 	register int hlen = sizeof (struct ip);
     86   1.1       cgd 	int len, off, error = 0;
     87   1.1       cgd 	struct route iproute;
     88   1.1       cgd 	struct sockaddr_in *dst;
     89   1.1       cgd 	struct in_ifaddr *ia;
     90  1.28  christos 	struct mbuf *opt;
     91  1.28  christos 	struct route *ro;
     92  1.28  christos 	int flags;
     93  1.28  christos 	struct ip_moptions *imo;
     94  1.28  christos 	va_list ap;
     95  1.28  christos 
     96  1.28  christos 	va_start(ap, m0);
     97  1.28  christos 	opt = va_arg(ap, struct mbuf *);
     98  1.28  christos 	ro = va_arg(ap, struct route *);
     99  1.28  christos 	flags = va_arg(ap, int);
    100  1.28  christos 	imo = va_arg(ap, struct ip_moptions *);
    101  1.28  christos 	va_end(ap);
    102  1.28  christos 
    103  1.28  christos 
    104   1.1       cgd 
    105   1.1       cgd #ifdef	DIAGNOSTIC
    106   1.1       cgd 	if ((m->m_flags & M_PKTHDR) == 0)
    107   1.1       cgd 		panic("ip_output no HDR");
    108   1.1       cgd #endif
    109   1.1       cgd 	if (opt) {
    110   1.1       cgd 		m = ip_insertoptions(m, opt, &len);
    111   1.1       cgd 		hlen = len;
    112   1.1       cgd 	}
    113   1.1       cgd 	ip = mtod(m, struct ip *);
    114   1.1       cgd 	/*
    115   1.1       cgd 	 * Fill in IP header.
    116   1.1       cgd 	 */
    117  1.18   mycroft 	if ((flags & (IP_FORWARDING|IP_RAWOUTPUT)) == 0) {
    118   1.1       cgd 		ip->ip_v = IPVERSION;
    119   1.1       cgd 		ip->ip_off &= IP_DF;
    120   1.1       cgd 		ip->ip_id = htons(ip_id++);
    121   1.1       cgd 		ip->ip_hl = hlen >> 2;
    122  1.18   mycroft 		ipstat.ips_localout++;
    123   1.1       cgd 	} else {
    124   1.1       cgd 		hlen = ip->ip_hl << 2;
    125   1.1       cgd 	}
    126   1.1       cgd 	/*
    127   1.1       cgd 	 * Route packet.
    128   1.1       cgd 	 */
    129   1.1       cgd 	if (ro == 0) {
    130   1.1       cgd 		ro = &iproute;
    131   1.1       cgd 		bzero((caddr_t)ro, sizeof (*ro));
    132   1.1       cgd 	}
    133  1.24   mycroft 	dst = satosin(&ro->ro_dst);
    134   1.1       cgd 	/*
    135   1.1       cgd 	 * If there is a cached route,
    136   1.1       cgd 	 * check that it is to the same destination
    137   1.1       cgd 	 * and is still up.  If not, free it and try again.
    138   1.1       cgd 	 */
    139   1.1       cgd 	if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
    140   1.1       cgd 	   dst->sin_addr.s_addr != ip->ip_dst.s_addr)) {
    141   1.1       cgd 		RTFREE(ro->ro_rt);
    142   1.1       cgd 		ro->ro_rt = (struct rtentry *)0;
    143   1.1       cgd 	}
    144   1.1       cgd 	if (ro->ro_rt == 0) {
    145   1.1       cgd 		dst->sin_family = AF_INET;
    146   1.1       cgd 		dst->sin_len = sizeof(*dst);
    147   1.1       cgd 		dst->sin_addr = ip->ip_dst;
    148   1.1       cgd 	}
    149   1.1       cgd 	/*
    150   1.1       cgd 	 * If routing to interface only,
    151   1.1       cgd 	 * short circuit routing lookup.
    152   1.1       cgd 	 */
    153   1.1       cgd 	if (flags & IP_ROUTETOIF) {
    154  1.18   mycroft 		if ((ia = ifatoia(ifa_ifwithdstaddr(sintosa(dst)))) == 0 &&
    155  1.18   mycroft 		    (ia = ifatoia(ifa_ifwithnet(sintosa(dst)))) == 0) {
    156  1.18   mycroft 			ipstat.ips_noroute++;
    157   1.1       cgd 			error = ENETUNREACH;
    158   1.1       cgd 			goto bad;
    159   1.1       cgd 		}
    160   1.1       cgd 		ifp = ia->ia_ifp;
    161  1.18   mycroft 		ip->ip_ttl = 1;
    162   1.1       cgd 	} else {
    163   1.1       cgd 		if (ro->ro_rt == 0)
    164   1.1       cgd 			rtalloc(ro);
    165   1.1       cgd 		if (ro->ro_rt == 0) {
    166  1.18   mycroft 			ipstat.ips_noroute++;
    167   1.1       cgd 			error = EHOSTUNREACH;
    168   1.1       cgd 			goto bad;
    169   1.1       cgd 		}
    170  1.18   mycroft 		ia = ifatoia(ro->ro_rt->rt_ifa);
    171   1.1       cgd 		ifp = ro->ro_rt->rt_ifp;
    172   1.1       cgd 		ro->ro_rt->rt_use++;
    173   1.1       cgd 		if (ro->ro_rt->rt_flags & RTF_GATEWAY)
    174  1.24   mycroft 			dst = satosin(ro->ro_rt->rt_gateway);
    175   1.1       cgd 	}
    176  1.23   mycroft 	if (IN_MULTICAST(ip->ip_dst.s_addr)) {
    177   1.5   hpeyerl 		struct in_multi *inm;
    178   1.5   hpeyerl 
    179   1.5   hpeyerl 		m->m_flags |= M_MCAST;
    180   1.5   hpeyerl 		/*
    181   1.5   hpeyerl 		 * IP destination address is multicast.  Make sure "dst"
    182   1.5   hpeyerl 		 * still points to the address in "ro".  (It may have been
    183   1.5   hpeyerl 		 * changed to point to a gateway address, above.)
    184   1.5   hpeyerl 		 */
    185  1.24   mycroft 		dst = satosin(&ro->ro_dst);
    186   1.5   hpeyerl 		/*
    187   1.5   hpeyerl 		 * See if the caller provided any multicast options
    188   1.5   hpeyerl 		 */
    189  1.13   mycroft 		if (imo != NULL) {
    190   1.5   hpeyerl 			ip->ip_ttl = imo->imo_multicast_ttl;
    191   1.5   hpeyerl 			if (imo->imo_multicast_ifp != NULL)
    192   1.5   hpeyerl 				ifp = imo->imo_multicast_ifp;
    193  1.18   mycroft 		} else
    194   1.5   hpeyerl 			ip->ip_ttl = IP_DEFAULT_MULTICAST_TTL;
    195   1.5   hpeyerl 		/*
    196   1.5   hpeyerl 		 * Confirm that the outgoing interface supports multicast.
    197   1.5   hpeyerl 		 */
    198   1.5   hpeyerl 		if ((ifp->if_flags & IFF_MULTICAST) == 0) {
    199  1.18   mycroft 			ipstat.ips_noroute++;
    200   1.5   hpeyerl 			error = ENETUNREACH;
    201   1.5   hpeyerl 			goto bad;
    202   1.5   hpeyerl 		}
    203   1.5   hpeyerl 		/*
    204   1.5   hpeyerl 		 * If source address not specified yet, use address
    205   1.5   hpeyerl 		 * of outgoing interface.
    206   1.5   hpeyerl 		 */
    207   1.5   hpeyerl 		if (ip->ip_src.s_addr == INADDR_ANY) {
    208   1.5   hpeyerl 			register struct in_ifaddr *ia;
    209   1.5   hpeyerl 
    210  1.26   mycroft 			for (ia = in_ifaddr.tqh_first; ia; ia = ia->ia_list.tqe_next)
    211   1.5   hpeyerl 				if (ia->ia_ifp == ifp) {
    212  1.25   mycroft 					ip->ip_src = ia->ia_addr.sin_addr;
    213   1.5   hpeyerl 					break;
    214   1.5   hpeyerl 				}
    215   1.5   hpeyerl 		}
    216   1.5   hpeyerl 
    217   1.5   hpeyerl 		IN_LOOKUP_MULTI(ip->ip_dst, ifp, inm);
    218   1.5   hpeyerl 		if (inm != NULL &&
    219   1.5   hpeyerl 		   (imo == NULL || imo->imo_multicast_loop)) {
    220   1.5   hpeyerl 			/*
    221  1.11   mycroft 			 * If we belong to the destination multicast group
    222   1.5   hpeyerl 			 * on the outgoing interface, and the caller did not
    223   1.5   hpeyerl 			 * forbid loopback, loop back a copy.
    224   1.5   hpeyerl 			 */
    225   1.5   hpeyerl 			ip_mloopback(ifp, m, dst);
    226   1.5   hpeyerl 		}
    227   1.5   hpeyerl #ifdef MROUTING
    228  1.18   mycroft 		else {
    229   1.5   hpeyerl 			/*
    230   1.5   hpeyerl 			 * If we are acting as a multicast router, perform
    231   1.5   hpeyerl 			 * multicast forwarding as if the packet had just
    232   1.5   hpeyerl 			 * arrived on the interface to which we are about
    233   1.5   hpeyerl 			 * to send.  The multicast forwarding function
    234   1.5   hpeyerl 			 * recursively calls this function, using the
    235   1.5   hpeyerl 			 * IP_FORWARDING flag to prevent infinite recursion.
    236   1.5   hpeyerl 			 *
    237   1.5   hpeyerl 			 * Multicasts that are looped back by ip_mloopback(),
    238   1.5   hpeyerl 			 * above, will be forwarded by the ip_input() routine,
    239   1.5   hpeyerl 			 * if necessary.
    240   1.5   hpeyerl 			 */
    241  1.18   mycroft 			extern struct socket *ip_mrouter;
    242  1.22       cgd 
    243  1.18   mycroft 			if (ip_mrouter && (flags & IP_FORWARDING) == 0) {
    244  1.18   mycroft 				if (ip_mforward(m, ifp) != 0) {
    245  1.18   mycroft 					m_freem(m);
    246  1.18   mycroft 					goto done;
    247  1.18   mycroft 				}
    248   1.5   hpeyerl 			}
    249   1.5   hpeyerl 		}
    250   1.5   hpeyerl #endif
    251   1.5   hpeyerl 		/*
    252   1.5   hpeyerl 		 * Multicasts with a time-to-live of zero may be looped-
    253   1.5   hpeyerl 		 * back, above, but must not be transmitted on a network.
    254   1.5   hpeyerl 		 * Also, multicasts addressed to the loopback interface
    255   1.5   hpeyerl 		 * are not sent -- the above call to ip_mloopback() will
    256   1.5   hpeyerl 		 * loop back a copy if this host actually belongs to the
    257   1.5   hpeyerl 		 * destination group on the loopback interface.
    258   1.5   hpeyerl 		 */
    259  1.20   mycroft 		if (ip->ip_ttl == 0 || (ifp->if_flags & IFF_LOOPBACK) != 0) {
    260   1.5   hpeyerl 			m_freem(m);
    261   1.5   hpeyerl 			goto done;
    262   1.5   hpeyerl 		}
    263   1.5   hpeyerl 
    264   1.5   hpeyerl 		goto sendit;
    265   1.5   hpeyerl 	}
    266   1.1       cgd #ifndef notdef
    267   1.1       cgd 	/*
    268   1.1       cgd 	 * If source address not specified yet, use address
    269   1.1       cgd 	 * of outgoing interface.
    270   1.1       cgd 	 */
    271   1.1       cgd 	if (ip->ip_src.s_addr == INADDR_ANY)
    272  1.25   mycroft 		ip->ip_src = ia->ia_addr.sin_addr;
    273   1.1       cgd #endif
    274   1.1       cgd 	/*
    275   1.1       cgd 	 * Look for broadcast address and
    276   1.1       cgd 	 * and verify user is allowed to send
    277   1.1       cgd 	 * such a packet.
    278   1.1       cgd 	 */
    279  1.18   mycroft 	if (in_broadcast(dst->sin_addr, ifp)) {
    280   1.1       cgd 		if ((ifp->if_flags & IFF_BROADCAST) == 0) {
    281   1.1       cgd 			error = EADDRNOTAVAIL;
    282   1.1       cgd 			goto bad;
    283   1.1       cgd 		}
    284   1.1       cgd 		if ((flags & IP_ALLOWBROADCAST) == 0) {
    285   1.1       cgd 			error = EACCES;
    286   1.1       cgd 			goto bad;
    287   1.1       cgd 		}
    288   1.1       cgd 		/* don't allow broadcast messages to be fragmented */
    289  1.21       cgd 		if ((u_int16_t)ip->ip_len > ifp->if_mtu) {
    290   1.1       cgd 			error = EMSGSIZE;
    291   1.1       cgd 			goto bad;
    292   1.1       cgd 		}
    293   1.1       cgd 		m->m_flags |= M_BCAST;
    294  1.18   mycroft 	} else
    295  1.18   mycroft 		m->m_flags &= ~M_BCAST;
    296  1.18   mycroft 
    297   1.5   hpeyerl sendit:
    298   1.1       cgd 	/*
    299   1.1       cgd 	 * If small enough for interface, can just send directly.
    300   1.1       cgd 	 */
    301  1.21       cgd 	if ((u_int16_t)ip->ip_len <= ifp->if_mtu) {
    302  1.21       cgd 		ip->ip_len = htons((u_int16_t)ip->ip_len);
    303  1.21       cgd 		ip->ip_off = htons((u_int16_t)ip->ip_off);
    304   1.1       cgd 		ip->ip_sum = 0;
    305   1.1       cgd 		ip->ip_sum = in_cksum(m, hlen);
    306  1.24   mycroft 		error = (*ifp->if_output)(ifp, m, sintosa(dst), ro->ro_rt);
    307   1.1       cgd 		goto done;
    308   1.1       cgd 	}
    309   1.1       cgd 	/*
    310   1.1       cgd 	 * Too large for interface; fragment if possible.
    311   1.1       cgd 	 * Must be able to put at least 8 bytes per fragment.
    312   1.1       cgd 	 */
    313   1.1       cgd 	if (ip->ip_off & IP_DF) {
    314   1.1       cgd 		error = EMSGSIZE;
    315  1.18   mycroft 		ipstat.ips_cantfrag++;
    316   1.1       cgd 		goto bad;
    317   1.1       cgd 	}
    318   1.1       cgd 	len = (ifp->if_mtu - hlen) &~ 7;
    319   1.1       cgd 	if (len < 8) {
    320   1.1       cgd 		error = EMSGSIZE;
    321   1.1       cgd 		goto bad;
    322   1.1       cgd 	}
    323   1.1       cgd 
    324   1.1       cgd     {
    325   1.1       cgd 	int mhlen, firstlen = len;
    326   1.1       cgd 	struct mbuf **mnext = &m->m_nextpkt;
    327   1.1       cgd 
    328   1.1       cgd 	/*
    329   1.1       cgd 	 * Loop through length of segment after first fragment,
    330   1.1       cgd 	 * make new header and copy data of each part and link onto chain.
    331   1.1       cgd 	 */
    332   1.1       cgd 	m0 = m;
    333   1.1       cgd 	mhlen = sizeof (struct ip);
    334  1.21       cgd 	for (off = hlen + len; off < (u_int16_t)ip->ip_len; off += len) {
    335   1.1       cgd 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
    336   1.1       cgd 		if (m == 0) {
    337   1.1       cgd 			error = ENOBUFS;
    338  1.18   mycroft 			ipstat.ips_odropped++;
    339   1.1       cgd 			goto sendorfree;
    340   1.1       cgd 		}
    341  1.22       cgd 		*mnext = m;
    342  1.22       cgd 		mnext = &m->m_nextpkt;
    343   1.1       cgd 		m->m_data += max_linkhdr;
    344   1.1       cgd 		mhip = mtod(m, struct ip *);
    345   1.1       cgd 		*mhip = *ip;
    346   1.1       cgd 		if (hlen > sizeof (struct ip)) {
    347   1.1       cgd 			mhlen = ip_optcopy(ip, mhip) + sizeof (struct ip);
    348   1.1       cgd 			mhip->ip_hl = mhlen >> 2;
    349   1.1       cgd 		}
    350   1.1       cgd 		m->m_len = mhlen;
    351   1.1       cgd 		mhip->ip_off = ((off - hlen) >> 3) + (ip->ip_off & ~IP_MF);
    352   1.1       cgd 		if (ip->ip_off & IP_MF)
    353   1.1       cgd 			mhip->ip_off |= IP_MF;
    354  1.21       cgd 		if (off + len >= (u_int16_t)ip->ip_len)
    355  1.21       cgd 			len = (u_int16_t)ip->ip_len - off;
    356   1.1       cgd 		else
    357   1.1       cgd 			mhip->ip_off |= IP_MF;
    358  1.21       cgd 		mhip->ip_len = htons((u_int16_t)(len + mhlen));
    359   1.1       cgd 		m->m_next = m_copy(m0, off, len);
    360   1.1       cgd 		if (m->m_next == 0) {
    361   1.1       cgd 			error = ENOBUFS;	/* ??? */
    362  1.18   mycroft 			ipstat.ips_odropped++;
    363   1.1       cgd 			goto sendorfree;
    364   1.1       cgd 		}
    365   1.1       cgd 		m->m_pkthdr.len = mhlen + len;
    366   1.1       cgd 		m->m_pkthdr.rcvif = (struct ifnet *)0;
    367  1.21       cgd 		mhip->ip_off = htons((u_int16_t)mhip->ip_off);
    368   1.1       cgd 		mhip->ip_sum = 0;
    369   1.1       cgd 		mhip->ip_sum = in_cksum(m, mhlen);
    370   1.1       cgd 		ipstat.ips_ofragments++;
    371   1.1       cgd 	}
    372   1.1       cgd 	/*
    373   1.1       cgd 	 * Update first fragment by trimming what's been copied out
    374   1.1       cgd 	 * and updating header, then send each fragment (in order).
    375   1.1       cgd 	 */
    376   1.1       cgd 	m = m0;
    377  1.21       cgd 	m_adj(m, hlen + firstlen - (u_int16_t)ip->ip_len);
    378   1.1       cgd 	m->m_pkthdr.len = hlen + firstlen;
    379  1.21       cgd 	ip->ip_len = htons((u_int16_t)m->m_pkthdr.len);
    380  1.21       cgd 	ip->ip_off = htons((u_int16_t)(ip->ip_off | IP_MF));
    381   1.1       cgd 	ip->ip_sum = 0;
    382   1.1       cgd 	ip->ip_sum = in_cksum(m, hlen);
    383   1.1       cgd sendorfree:
    384   1.1       cgd 	for (m = m0; m; m = m0) {
    385   1.1       cgd 		m0 = m->m_nextpkt;
    386   1.1       cgd 		m->m_nextpkt = 0;
    387   1.1       cgd 		if (error == 0)
    388  1.24   mycroft 			error = (*ifp->if_output)(ifp, m, sintosa(dst),
    389  1.24   mycroft 			    ro->ro_rt);
    390   1.1       cgd 		else
    391   1.1       cgd 			m_freem(m);
    392   1.1       cgd 	}
    393  1.18   mycroft 
    394  1.18   mycroft 	if (error == 0)
    395  1.18   mycroft 		ipstat.ips_fragmented++;
    396   1.1       cgd     }
    397   1.1       cgd done:
    398   1.1       cgd 	if (ro == &iproute && (flags & IP_ROUTETOIF) == 0 && ro->ro_rt)
    399   1.1       cgd 		RTFREE(ro->ro_rt);
    400   1.1       cgd 	return (error);
    401   1.1       cgd bad:
    402   1.1       cgd 	m_freem(m0);
    403   1.1       cgd 	goto done;
    404   1.1       cgd }
    405   1.1       cgd 
    406   1.1       cgd /*
    407   1.1       cgd  * Insert IP options into preformed packet.
    408   1.1       cgd  * Adjust IP destination as required for IP source routing,
    409   1.1       cgd  * as indicated by a non-zero in_addr at the start of the options.
    410   1.1       cgd  */
    411  1.12   mycroft static struct mbuf *
    412   1.1       cgd ip_insertoptions(m, opt, phlen)
    413   1.1       cgd 	register struct mbuf *m;
    414   1.1       cgd 	struct mbuf *opt;
    415   1.1       cgd 	int *phlen;
    416   1.1       cgd {
    417   1.1       cgd 	register struct ipoption *p = mtod(opt, struct ipoption *);
    418   1.1       cgd 	struct mbuf *n;
    419   1.1       cgd 	register struct ip *ip = mtod(m, struct ip *);
    420   1.1       cgd 	unsigned optlen;
    421   1.1       cgd 
    422   1.1       cgd 	optlen = opt->m_len - sizeof(p->ipopt_dst);
    423  1.21       cgd 	if (optlen + (u_int16_t)ip->ip_len > IP_MAXPACKET)
    424   1.1       cgd 		return (m);		/* XXX should fail */
    425   1.1       cgd 	if (p->ipopt_dst.s_addr)
    426   1.1       cgd 		ip->ip_dst = p->ipopt_dst;
    427   1.1       cgd 	if (m->m_flags & M_EXT || m->m_data - optlen < m->m_pktdat) {
    428   1.1       cgd 		MGETHDR(n, M_DONTWAIT, MT_HEADER);
    429   1.1       cgd 		if (n == 0)
    430   1.1       cgd 			return (m);
    431   1.1       cgd 		n->m_pkthdr.len = m->m_pkthdr.len + optlen;
    432   1.1       cgd 		m->m_len -= sizeof(struct ip);
    433   1.1       cgd 		m->m_data += sizeof(struct ip);
    434   1.1       cgd 		n->m_next = m;
    435   1.1       cgd 		m = n;
    436   1.1       cgd 		m->m_len = optlen + sizeof(struct ip);
    437   1.1       cgd 		m->m_data += max_linkhdr;
    438   1.1       cgd 		bcopy((caddr_t)ip, mtod(m, caddr_t), sizeof(struct ip));
    439   1.1       cgd 	} else {
    440   1.1       cgd 		m->m_data -= optlen;
    441   1.1       cgd 		m->m_len += optlen;
    442   1.1       cgd 		m->m_pkthdr.len += optlen;
    443   1.1       cgd 		ovbcopy((caddr_t)ip, mtod(m, caddr_t), sizeof(struct ip));
    444   1.1       cgd 	}
    445   1.1       cgd 	ip = mtod(m, struct ip *);
    446   1.1       cgd 	bcopy((caddr_t)p->ipopt_list, (caddr_t)(ip + 1), (unsigned)optlen);
    447   1.1       cgd 	*phlen = sizeof(struct ip) + optlen;
    448   1.1       cgd 	ip->ip_len += optlen;
    449   1.1       cgd 	return (m);
    450   1.1       cgd }
    451   1.1       cgd 
    452   1.1       cgd /*
    453   1.1       cgd  * Copy options from ip to jp,
    454   1.1       cgd  * omitting those not copied during fragmentation.
    455   1.1       cgd  */
    456  1.12   mycroft int
    457   1.1       cgd ip_optcopy(ip, jp)
    458   1.1       cgd 	struct ip *ip, *jp;
    459   1.1       cgd {
    460   1.1       cgd 	register u_char *cp, *dp;
    461   1.1       cgd 	int opt, optlen, cnt;
    462   1.1       cgd 
    463   1.1       cgd 	cp = (u_char *)(ip + 1);
    464   1.1       cgd 	dp = (u_char *)(jp + 1);
    465   1.1       cgd 	cnt = (ip->ip_hl << 2) - sizeof (struct ip);
    466   1.1       cgd 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
    467   1.1       cgd 		opt = cp[0];
    468   1.1       cgd 		if (opt == IPOPT_EOL)
    469   1.1       cgd 			break;
    470  1.18   mycroft 		if (opt == IPOPT_NOP) {
    471  1.18   mycroft 			/* Preserve for IP mcast tunnel's LSRR alignment. */
    472  1.18   mycroft 			*dp++ = IPOPT_NOP;
    473   1.1       cgd 			optlen = 1;
    474  1.18   mycroft 			continue;
    475  1.18   mycroft 		} else
    476   1.1       cgd 			optlen = cp[IPOPT_OLEN];
    477   1.1       cgd 		/* bogus lengths should have been caught by ip_dooptions */
    478   1.1       cgd 		if (optlen > cnt)
    479   1.1       cgd 			optlen = cnt;
    480   1.1       cgd 		if (IPOPT_COPIED(opt)) {
    481   1.1       cgd 			bcopy((caddr_t)cp, (caddr_t)dp, (unsigned)optlen);
    482   1.1       cgd 			dp += optlen;
    483   1.1       cgd 		}
    484   1.1       cgd 	}
    485   1.1       cgd 	for (optlen = dp - (u_char *)(jp+1); optlen & 0x3; optlen++)
    486   1.1       cgd 		*dp++ = IPOPT_EOL;
    487   1.1       cgd 	return (optlen);
    488   1.1       cgd }
    489   1.1       cgd 
    490   1.1       cgd /*
    491   1.1       cgd  * IP socket option processing.
    492   1.1       cgd  */
    493  1.12   mycroft int
    494   1.1       cgd ip_ctloutput(op, so, level, optname, mp)
    495   1.1       cgd 	int op;
    496   1.1       cgd 	struct socket *so;
    497   1.1       cgd 	int level, optname;
    498   1.1       cgd 	struct mbuf **mp;
    499   1.1       cgd {
    500   1.1       cgd 	register struct inpcb *inp = sotoinpcb(so);
    501  1.16    brezak 	register struct mbuf *m = *mp;
    502  1.28  christos 	register int optval = 0;
    503   1.1       cgd 	int error = 0;
    504   1.1       cgd 
    505  1.18   mycroft 	if (level != IPPROTO_IP) {
    506   1.1       cgd 		error = EINVAL;
    507  1.18   mycroft 		if (op == PRCO_SETOPT && *mp)
    508  1.18   mycroft 			(void) m_free(*mp);
    509  1.18   mycroft 	} else switch (op) {
    510   1.1       cgd 
    511   1.1       cgd 	case PRCO_SETOPT:
    512   1.1       cgd 		switch (optname) {
    513   1.1       cgd 		case IP_OPTIONS:
    514   1.1       cgd #ifdef notyet
    515   1.1       cgd 		case IP_RETOPTS:
    516   1.1       cgd 			return (ip_pcbopts(optname, &inp->inp_options, m));
    517   1.1       cgd #else
    518   1.1       cgd 			return (ip_pcbopts(&inp->inp_options, m));
    519   1.1       cgd #endif
    520   1.1       cgd 
    521   1.1       cgd 		case IP_TOS:
    522   1.1       cgd 		case IP_TTL:
    523   1.1       cgd 		case IP_RECVOPTS:
    524   1.1       cgd 		case IP_RECVRETOPTS:
    525   1.1       cgd 		case IP_RECVDSTADDR:
    526  1.27       cgd 			if (m == NULL || m->m_len != sizeof(int))
    527   1.1       cgd 				error = EINVAL;
    528   1.1       cgd 			else {
    529   1.1       cgd 				optval = *mtod(m, int *);
    530   1.1       cgd 				switch (optname) {
    531   1.1       cgd 
    532   1.1       cgd 				case IP_TOS:
    533   1.1       cgd 					inp->inp_ip.ip_tos = optval;
    534   1.1       cgd 					break;
    535   1.1       cgd 
    536   1.1       cgd 				case IP_TTL:
    537   1.1       cgd 					inp->inp_ip.ip_ttl = optval;
    538   1.1       cgd 					break;
    539   1.1       cgd #define	OPTSET(bit) \
    540   1.1       cgd 	if (optval) \
    541   1.1       cgd 		inp->inp_flags |= bit; \
    542   1.1       cgd 	else \
    543   1.1       cgd 		inp->inp_flags &= ~bit;
    544   1.1       cgd 
    545   1.1       cgd 				case IP_RECVOPTS:
    546   1.1       cgd 					OPTSET(INP_RECVOPTS);
    547   1.1       cgd 					break;
    548   1.1       cgd 
    549   1.1       cgd 				case IP_RECVRETOPTS:
    550   1.1       cgd 					OPTSET(INP_RECVRETOPTS);
    551   1.1       cgd 					break;
    552   1.1       cgd 
    553   1.1       cgd 				case IP_RECVDSTADDR:
    554   1.1       cgd 					OPTSET(INP_RECVDSTADDR);
    555   1.1       cgd 					break;
    556   1.1       cgd 				}
    557   1.1       cgd 			}
    558   1.1       cgd 			break;
    559   1.1       cgd #undef OPTSET
    560  1.18   mycroft 
    561  1.18   mycroft 		case IP_MULTICAST_IF:
    562  1.18   mycroft 		case IP_MULTICAST_TTL:
    563  1.18   mycroft 		case IP_MULTICAST_LOOP:
    564  1.18   mycroft 		case IP_ADD_MEMBERSHIP:
    565  1.18   mycroft 		case IP_DROP_MEMBERSHIP:
    566  1.18   mycroft 			error = ip_setmoptions(optname, &inp->inp_moptions, m);
    567  1.18   mycroft 			break;
    568   1.1       cgd 
    569   1.1       cgd 		default:
    570  1.18   mycroft 			error = ENOPROTOOPT;
    571   1.1       cgd 			break;
    572   1.1       cgd 		}
    573   1.1       cgd 		if (m)
    574   1.1       cgd 			(void)m_free(m);
    575   1.1       cgd 		break;
    576   1.1       cgd 
    577   1.1       cgd 	case PRCO_GETOPT:
    578   1.1       cgd 		switch (optname) {
    579   1.1       cgd 		case IP_OPTIONS:
    580   1.1       cgd 		case IP_RETOPTS:
    581   1.1       cgd 			*mp = m = m_get(M_WAIT, MT_SOOPTS);
    582   1.1       cgd 			if (inp->inp_options) {
    583   1.1       cgd 				m->m_len = inp->inp_options->m_len;
    584   1.1       cgd 				bcopy(mtod(inp->inp_options, caddr_t),
    585   1.1       cgd 				    mtod(m, caddr_t), (unsigned)m->m_len);
    586   1.1       cgd 			} else
    587   1.1       cgd 				m->m_len = 0;
    588   1.1       cgd 			break;
    589   1.1       cgd 
    590   1.1       cgd 		case IP_TOS:
    591   1.1       cgd 		case IP_TTL:
    592   1.1       cgd 		case IP_RECVOPTS:
    593   1.1       cgd 		case IP_RECVRETOPTS:
    594   1.1       cgd 		case IP_RECVDSTADDR:
    595   1.1       cgd 			*mp = m = m_get(M_WAIT, MT_SOOPTS);
    596   1.1       cgd 			m->m_len = sizeof(int);
    597   1.1       cgd 			switch (optname) {
    598   1.1       cgd 
    599   1.1       cgd 			case IP_TOS:
    600   1.1       cgd 				optval = inp->inp_ip.ip_tos;
    601   1.1       cgd 				break;
    602   1.1       cgd 
    603   1.1       cgd 			case IP_TTL:
    604   1.1       cgd 				optval = inp->inp_ip.ip_ttl;
    605   1.1       cgd 				break;
    606   1.1       cgd 
    607   1.1       cgd #define	OPTBIT(bit)	(inp->inp_flags & bit ? 1 : 0)
    608   1.1       cgd 
    609   1.1       cgd 			case IP_RECVOPTS:
    610   1.1       cgd 				optval = OPTBIT(INP_RECVOPTS);
    611   1.1       cgd 				break;
    612   1.1       cgd 
    613   1.1       cgd 			case IP_RECVRETOPTS:
    614   1.1       cgd 				optval = OPTBIT(INP_RECVRETOPTS);
    615   1.1       cgd 				break;
    616   1.1       cgd 
    617   1.1       cgd 			case IP_RECVDSTADDR:
    618   1.1       cgd 				optval = OPTBIT(INP_RECVDSTADDR);
    619   1.1       cgd 				break;
    620   1.1       cgd 			}
    621   1.1       cgd 			*mtod(m, int *) = optval;
    622   1.1       cgd 			break;
    623  1.18   mycroft 
    624  1.18   mycroft 		case IP_MULTICAST_IF:
    625  1.18   mycroft 		case IP_MULTICAST_TTL:
    626  1.18   mycroft 		case IP_MULTICAST_LOOP:
    627  1.18   mycroft 		case IP_ADD_MEMBERSHIP:
    628  1.18   mycroft 		case IP_DROP_MEMBERSHIP:
    629  1.18   mycroft 			error = ip_getmoptions(optname, inp->inp_moptions, mp);
    630  1.18   mycroft 			break;
    631   1.1       cgd 
    632   1.1       cgd 		default:
    633  1.18   mycroft 			error = ENOPROTOOPT;
    634   1.1       cgd 			break;
    635   1.1       cgd 		}
    636   1.1       cgd 		break;
    637   1.1       cgd 	}
    638   1.1       cgd 	return (error);
    639   1.1       cgd }
    640   1.1       cgd 
    641   1.1       cgd /*
    642   1.1       cgd  * Set up IP options in pcb for insertion in output packets.
    643   1.1       cgd  * Store in mbuf with pointer in pcbopt, adding pseudo-option
    644   1.1       cgd  * with destination address if source routed.
    645   1.1       cgd  */
    646  1.12   mycroft int
    647   1.1       cgd #ifdef notyet
    648   1.1       cgd ip_pcbopts(optname, pcbopt, m)
    649   1.1       cgd 	int optname;
    650   1.1       cgd #else
    651   1.1       cgd ip_pcbopts(pcbopt, m)
    652   1.1       cgd #endif
    653   1.1       cgd 	struct mbuf **pcbopt;
    654   1.1       cgd 	register struct mbuf *m;
    655   1.1       cgd {
    656   1.1       cgd 	register cnt, optlen;
    657   1.1       cgd 	register u_char *cp;
    658   1.1       cgd 	u_char opt;
    659   1.1       cgd 
    660   1.1       cgd 	/* turn off any old options */
    661   1.1       cgd 	if (*pcbopt)
    662   1.1       cgd 		(void)m_free(*pcbopt);
    663   1.1       cgd 	*pcbopt = 0;
    664   1.1       cgd 	if (m == (struct mbuf *)0 || m->m_len == 0) {
    665   1.1       cgd 		/*
    666   1.1       cgd 		 * Only turning off any previous options.
    667   1.1       cgd 		 */
    668   1.1       cgd 		if (m)
    669   1.1       cgd 			(void)m_free(m);
    670   1.1       cgd 		return (0);
    671   1.1       cgd 	}
    672   1.1       cgd 
    673   1.1       cgd #ifndef	vax
    674  1.21       cgd 	if (m->m_len % sizeof(int32_t))
    675   1.1       cgd 		goto bad;
    676   1.1       cgd #endif
    677   1.1       cgd 	/*
    678   1.1       cgd 	 * IP first-hop destination address will be stored before
    679   1.1       cgd 	 * actual options; move other options back
    680   1.1       cgd 	 * and clear it when none present.
    681   1.1       cgd 	 */
    682   1.1       cgd 	if (m->m_data + m->m_len + sizeof(struct in_addr) >= &m->m_dat[MLEN])
    683   1.1       cgd 		goto bad;
    684   1.1       cgd 	cnt = m->m_len;
    685   1.1       cgd 	m->m_len += sizeof(struct in_addr);
    686   1.1       cgd 	cp = mtod(m, u_char *) + sizeof(struct in_addr);
    687   1.1       cgd 	ovbcopy(mtod(m, caddr_t), (caddr_t)cp, (unsigned)cnt);
    688   1.1       cgd 	bzero(mtod(m, caddr_t), sizeof(struct in_addr));
    689   1.1       cgd 
    690   1.1       cgd 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
    691   1.1       cgd 		opt = cp[IPOPT_OPTVAL];
    692   1.1       cgd 		if (opt == IPOPT_EOL)
    693   1.1       cgd 			break;
    694   1.1       cgd 		if (opt == IPOPT_NOP)
    695   1.1       cgd 			optlen = 1;
    696   1.1       cgd 		else {
    697   1.1       cgd 			optlen = cp[IPOPT_OLEN];
    698   1.1       cgd 			if (optlen <= IPOPT_OLEN || optlen > cnt)
    699   1.1       cgd 				goto bad;
    700   1.1       cgd 		}
    701   1.1       cgd 		switch (opt) {
    702   1.1       cgd 
    703   1.1       cgd 		default:
    704   1.1       cgd 			break;
    705   1.1       cgd 
    706   1.1       cgd 		case IPOPT_LSRR:
    707   1.1       cgd 		case IPOPT_SSRR:
    708   1.1       cgd 			/*
    709   1.1       cgd 			 * user process specifies route as:
    710   1.1       cgd 			 *	->A->B->C->D
    711   1.1       cgd 			 * D must be our final destination (but we can't
    712   1.1       cgd 			 * check that since we may not have connected yet).
    713   1.1       cgd 			 * A is first hop destination, which doesn't appear in
    714   1.1       cgd 			 * actual IP option, but is stored before the options.
    715   1.1       cgd 			 */
    716   1.1       cgd 			if (optlen < IPOPT_MINOFF - 1 + sizeof(struct in_addr))
    717   1.1       cgd 				goto bad;
    718   1.1       cgd 			m->m_len -= sizeof(struct in_addr);
    719   1.1       cgd 			cnt -= sizeof(struct in_addr);
    720   1.1       cgd 			optlen -= sizeof(struct in_addr);
    721   1.1       cgd 			cp[IPOPT_OLEN] = optlen;
    722   1.1       cgd 			/*
    723   1.1       cgd 			 * Move first hop before start of options.
    724   1.1       cgd 			 */
    725   1.1       cgd 			bcopy((caddr_t)&cp[IPOPT_OFFSET+1], mtod(m, caddr_t),
    726   1.1       cgd 			    sizeof(struct in_addr));
    727   1.1       cgd 			/*
    728   1.1       cgd 			 * Then copy rest of options back
    729   1.1       cgd 			 * to close up the deleted entry.
    730   1.1       cgd 			 */
    731   1.1       cgd 			ovbcopy((caddr_t)(&cp[IPOPT_OFFSET+1] +
    732   1.1       cgd 			    sizeof(struct in_addr)),
    733   1.1       cgd 			    (caddr_t)&cp[IPOPT_OFFSET+1],
    734   1.1       cgd 			    (unsigned)cnt + sizeof(struct in_addr));
    735   1.1       cgd 			break;
    736   1.1       cgd 		}
    737   1.1       cgd 	}
    738   1.1       cgd 	if (m->m_len > MAX_IPOPTLEN + sizeof(struct in_addr))
    739   1.1       cgd 		goto bad;
    740   1.1       cgd 	*pcbopt = m;
    741   1.1       cgd 	return (0);
    742   1.1       cgd 
    743   1.1       cgd bad:
    744   1.1       cgd 	(void)m_free(m);
    745   1.1       cgd 	return (EINVAL);
    746   1.1       cgd }
    747   1.5   hpeyerl 
    748   1.5   hpeyerl /*
    749   1.5   hpeyerl  * Set the IP multicast options in response to user setsockopt().
    750   1.5   hpeyerl  */
    751   1.5   hpeyerl int
    752   1.5   hpeyerl ip_setmoptions(optname, imop, m)
    753   1.5   hpeyerl 	int optname;
    754   1.5   hpeyerl 	struct ip_moptions **imop;
    755   1.5   hpeyerl 	struct mbuf *m;
    756   1.5   hpeyerl {
    757   1.5   hpeyerl 	register int error = 0;
    758   1.5   hpeyerl 	u_char loop;
    759   1.5   hpeyerl 	register int i;
    760   1.5   hpeyerl 	struct in_addr addr;
    761   1.5   hpeyerl 	register struct ip_mreq *mreq;
    762   1.5   hpeyerl 	register struct ifnet *ifp;
    763   1.5   hpeyerl 	register struct ip_moptions *imo = *imop;
    764   1.5   hpeyerl 	struct route ro;
    765   1.5   hpeyerl 	register struct sockaddr_in *dst;
    766   1.5   hpeyerl 
    767   1.5   hpeyerl 	if (imo == NULL) {
    768   1.5   hpeyerl 		/*
    769   1.5   hpeyerl 		 * No multicast option buffer attached to the pcb;
    770   1.5   hpeyerl 		 * allocate one and initialize to default values.
    771   1.5   hpeyerl 		 */
    772  1.22       cgd 		imo = (struct ip_moptions *)malloc(sizeof(*imo), M_IPMOPTS,
    773   1.5   hpeyerl 		    M_WAITOK);
    774   1.5   hpeyerl 
    775   1.5   hpeyerl 		if (imo == NULL)
    776   1.5   hpeyerl 			return (ENOBUFS);
    777   1.5   hpeyerl 		*imop = imo;
    778   1.5   hpeyerl 		imo->imo_multicast_ifp = NULL;
    779   1.5   hpeyerl 		imo->imo_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
    780   1.5   hpeyerl 		imo->imo_multicast_loop = IP_DEFAULT_MULTICAST_LOOP;
    781   1.5   hpeyerl 		imo->imo_num_memberships = 0;
    782   1.5   hpeyerl 	}
    783   1.5   hpeyerl 
    784   1.5   hpeyerl 	switch (optname) {
    785   1.5   hpeyerl 
    786   1.5   hpeyerl 	case IP_MULTICAST_IF:
    787   1.5   hpeyerl 		/*
    788   1.5   hpeyerl 		 * Select the interface for outgoing multicast packets.
    789   1.5   hpeyerl 		 */
    790   1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct in_addr)) {
    791   1.5   hpeyerl 			error = EINVAL;
    792   1.5   hpeyerl 			break;
    793   1.5   hpeyerl 		}
    794   1.5   hpeyerl 		addr = *(mtod(m, struct in_addr *));
    795   1.5   hpeyerl 		/*
    796   1.5   hpeyerl 		 * INADDR_ANY is used to remove a previous selection.
    797  1.11   mycroft 		 * When no interface is selected, a default one is
    798   1.5   hpeyerl 		 * chosen every time a multicast packet is sent.
    799   1.5   hpeyerl 		 */
    800   1.5   hpeyerl 		if (addr.s_addr == INADDR_ANY) {
    801   1.5   hpeyerl 			imo->imo_multicast_ifp = NULL;
    802   1.5   hpeyerl 			break;
    803   1.5   hpeyerl 		}
    804   1.5   hpeyerl 		/*
    805   1.5   hpeyerl 		 * The selected interface is identified by its local
    806   1.5   hpeyerl 		 * IP address.  Find the interface and confirm that
    807  1.11   mycroft 		 * it supports multicasting.
    808   1.5   hpeyerl 		 */
    809   1.5   hpeyerl 		INADDR_TO_IFP(addr, ifp);
    810   1.5   hpeyerl 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
    811   1.5   hpeyerl 			error = EADDRNOTAVAIL;
    812   1.5   hpeyerl 			break;
    813   1.5   hpeyerl 		}
    814   1.5   hpeyerl 		imo->imo_multicast_ifp = ifp;
    815   1.5   hpeyerl 		break;
    816   1.5   hpeyerl 
    817   1.5   hpeyerl 	case IP_MULTICAST_TTL:
    818   1.5   hpeyerl 		/*
    819   1.5   hpeyerl 		 * Set the IP time-to-live for outgoing multicast packets.
    820   1.5   hpeyerl 		 */
    821   1.5   hpeyerl 		if (m == NULL || m->m_len != 1) {
    822   1.5   hpeyerl 			error = EINVAL;
    823   1.5   hpeyerl 			break;
    824   1.5   hpeyerl 		}
    825   1.5   hpeyerl 		imo->imo_multicast_ttl = *(mtod(m, u_char *));
    826   1.5   hpeyerl 		break;
    827  1.11   mycroft 
    828   1.5   hpeyerl 	case IP_MULTICAST_LOOP:
    829   1.5   hpeyerl 		/*
    830   1.5   hpeyerl 		 * Set the loopback flag for outgoing multicast packets.
    831   1.5   hpeyerl 		 * Must be zero or one.
    832   1.5   hpeyerl 		 */
    833   1.5   hpeyerl 		if (m == NULL || m->m_len != 1 ||
    834   1.5   hpeyerl 		   (loop = *(mtod(m, u_char *))) > 1) {
    835   1.5   hpeyerl 			error = EINVAL;
    836   1.5   hpeyerl 			break;
    837  1.11   mycroft 		}
    838   1.5   hpeyerl 		imo->imo_multicast_loop = loop;
    839   1.5   hpeyerl 		break;
    840   1.5   hpeyerl 
    841   1.5   hpeyerl 	case IP_ADD_MEMBERSHIP:
    842   1.5   hpeyerl 		/*
    843   1.5   hpeyerl 		 * Add a multicast group membership.
    844   1.5   hpeyerl 		 * Group must be a valid IP multicast address.
    845   1.5   hpeyerl 		 */
    846   1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
    847   1.5   hpeyerl 			error = EINVAL;
    848   1.5   hpeyerl 			break;
    849   1.5   hpeyerl 		}
    850   1.5   hpeyerl 		mreq = mtod(m, struct ip_mreq *);
    851  1.23   mycroft 		if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
    852   1.5   hpeyerl 			error = EINVAL;
    853   1.5   hpeyerl 			break;
    854   1.5   hpeyerl 		}
    855   1.5   hpeyerl 		/*
    856   1.5   hpeyerl 		 * If no interface address was provided, use the interface of
    857   1.5   hpeyerl 		 * the route to the given multicast address.
    858   1.5   hpeyerl 		 */
    859   1.5   hpeyerl 		if (mreq->imr_interface.s_addr == INADDR_ANY) {
    860   1.5   hpeyerl 			ro.ro_rt = NULL;
    861  1.24   mycroft 			dst = satosin(&ro.ro_dst);
    862   1.5   hpeyerl 			dst->sin_len = sizeof(*dst);
    863   1.5   hpeyerl 			dst->sin_family = AF_INET;
    864   1.5   hpeyerl 			dst->sin_addr = mreq->imr_multiaddr;
    865   1.5   hpeyerl 			rtalloc(&ro);
    866   1.5   hpeyerl 			if (ro.ro_rt == NULL) {
    867   1.5   hpeyerl 				error = EADDRNOTAVAIL;
    868   1.5   hpeyerl 				break;
    869   1.5   hpeyerl 			}
    870   1.5   hpeyerl 			ifp = ro.ro_rt->rt_ifp;
    871   1.5   hpeyerl 			rtfree(ro.ro_rt);
    872  1.23   mycroft 		} else {
    873   1.5   hpeyerl 			INADDR_TO_IFP(mreq->imr_interface, ifp);
    874   1.5   hpeyerl 		}
    875   1.5   hpeyerl 		/*
    876   1.5   hpeyerl 		 * See if we found an interface, and confirm that it
    877   1.5   hpeyerl 		 * supports multicast.
    878   1.5   hpeyerl 		 */
    879  1.11   mycroft 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
    880   1.5   hpeyerl 			error = EADDRNOTAVAIL;
    881   1.5   hpeyerl 			break;
    882   1.5   hpeyerl 		}
    883   1.5   hpeyerl 		/*
    884   1.5   hpeyerl 		 * See if the membership already exists or if all the
    885   1.5   hpeyerl 		 * membership slots are full.
    886  1.11   mycroft 		 */
    887   1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i) {
    888   1.5   hpeyerl 			if (imo->imo_membership[i]->inm_ifp == ifp &&
    889   1.5   hpeyerl 			    imo->imo_membership[i]->inm_addr.s_addr
    890   1.5   hpeyerl 						== mreq->imr_multiaddr.s_addr)
    891   1.5   hpeyerl 				break;
    892  1.11   mycroft 		}
    893   1.5   hpeyerl 		if (i < imo->imo_num_memberships) {
    894   1.5   hpeyerl 			error = EADDRINUSE;
    895   1.5   hpeyerl 			break;
    896   1.5   hpeyerl 		}
    897   1.5   hpeyerl 		if (i == IP_MAX_MEMBERSHIPS) {
    898  1.11   mycroft 			error = ETOOMANYREFS;
    899   1.5   hpeyerl 			break;
    900   1.5   hpeyerl 		}
    901   1.5   hpeyerl 		/*
    902   1.5   hpeyerl 		 * Everything looks good; add a new record to the multicast
    903   1.5   hpeyerl 		 * address list for the given interface.
    904   1.5   hpeyerl 		 */
    905   1.5   hpeyerl 		if ((imo->imo_membership[i] =
    906   1.5   hpeyerl 		    in_addmulti(&mreq->imr_multiaddr, ifp)) == NULL) {
    907   1.5   hpeyerl 			error = ENOBUFS;
    908   1.5   hpeyerl 			break;
    909   1.5   hpeyerl 		}
    910   1.5   hpeyerl 		++imo->imo_num_memberships;
    911   1.5   hpeyerl 		break;
    912   1.5   hpeyerl 
    913   1.5   hpeyerl 	case IP_DROP_MEMBERSHIP:
    914   1.5   hpeyerl 		/*
    915   1.5   hpeyerl 		 * Drop a multicast group membership.
    916   1.5   hpeyerl 		 * Group must be a valid IP multicast address.
    917   1.5   hpeyerl 		 */
    918   1.5   hpeyerl 		if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
    919   1.5   hpeyerl 			error = EINVAL;
    920   1.5   hpeyerl 			break;
    921   1.5   hpeyerl 		}
    922   1.5   hpeyerl 		mreq = mtod(m, struct ip_mreq *);
    923  1.23   mycroft 		if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
    924   1.5   hpeyerl 			error = EINVAL;
    925   1.5   hpeyerl 			break;
    926   1.5   hpeyerl 		}
    927   1.5   hpeyerl 		/*
    928   1.5   hpeyerl 		 * If an interface address was specified, get a pointer
    929   1.5   hpeyerl 		 * to its ifnet structure.
    930   1.5   hpeyerl 		 */
    931   1.5   hpeyerl 		if (mreq->imr_interface.s_addr == INADDR_ANY)
    932   1.5   hpeyerl 			ifp = NULL;
    933   1.5   hpeyerl 		else {
    934   1.5   hpeyerl 			INADDR_TO_IFP(mreq->imr_interface, ifp);
    935   1.5   hpeyerl 			if (ifp == NULL) {
    936   1.5   hpeyerl 				error = EADDRNOTAVAIL;
    937   1.5   hpeyerl 				break;
    938   1.5   hpeyerl 			}
    939   1.5   hpeyerl 		}
    940   1.5   hpeyerl 		/*
    941   1.5   hpeyerl 		 * Find the membership in the membership array.
    942   1.5   hpeyerl 		 */
    943   1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i) {
    944   1.5   hpeyerl 			if ((ifp == NULL ||
    945   1.5   hpeyerl 			     imo->imo_membership[i]->inm_ifp == ifp) &&
    946   1.5   hpeyerl 			     imo->imo_membership[i]->inm_addr.s_addr ==
    947  1.11   mycroft 			     mreq->imr_multiaddr.s_addr)
    948   1.5   hpeyerl 				break;
    949   1.5   hpeyerl 		}
    950   1.5   hpeyerl 		if (i == imo->imo_num_memberships) {
    951   1.5   hpeyerl 			error = EADDRNOTAVAIL;
    952   1.5   hpeyerl 			break;
    953   1.5   hpeyerl 		}
    954   1.5   hpeyerl 		/*
    955   1.5   hpeyerl 		 * Give up the multicast address record to which the
    956   1.5   hpeyerl 		 * membership points.
    957   1.5   hpeyerl 		 */
    958  1.11   mycroft 		in_delmulti(imo->imo_membership[i]);
    959   1.5   hpeyerl 		/*
    960   1.5   hpeyerl 		 * Remove the gap in the membership array.
    961   1.5   hpeyerl 		 */
    962   1.5   hpeyerl 		for (++i; i < imo->imo_num_memberships; ++i)
    963   1.5   hpeyerl 			imo->imo_membership[i-1] = imo->imo_membership[i];
    964   1.5   hpeyerl 		--imo->imo_num_memberships;
    965   1.5   hpeyerl 		break;
    966   1.5   hpeyerl 
    967   1.5   hpeyerl 	default:
    968   1.5   hpeyerl 		error = EOPNOTSUPP;
    969   1.5   hpeyerl 		break;
    970   1.5   hpeyerl 	}
    971   1.5   hpeyerl 
    972   1.5   hpeyerl 	/*
    973   1.5   hpeyerl 	 * If all options have default values, no need to keep the mbuf.
    974   1.5   hpeyerl 	 */
    975   1.5   hpeyerl 	if (imo->imo_multicast_ifp == NULL &&
    976   1.5   hpeyerl 	    imo->imo_multicast_ttl == IP_DEFAULT_MULTICAST_TTL &&
    977   1.5   hpeyerl 	    imo->imo_multicast_loop == IP_DEFAULT_MULTICAST_LOOP &&
    978   1.5   hpeyerl 	    imo->imo_num_memberships == 0) {
    979   1.5   hpeyerl 		free(*imop, M_IPMOPTS);
    980   1.5   hpeyerl 		*imop = NULL;
    981   1.5   hpeyerl 	}
    982   1.5   hpeyerl 
    983   1.5   hpeyerl 	return (error);
    984   1.5   hpeyerl }
    985   1.5   hpeyerl 
    986   1.5   hpeyerl /*
    987   1.5   hpeyerl  * Return the IP multicast options in response to user getsockopt().
    988   1.5   hpeyerl  */
    989   1.5   hpeyerl int
    990   1.5   hpeyerl ip_getmoptions(optname, imo, mp)
    991   1.5   hpeyerl 	int optname;
    992   1.5   hpeyerl 	register struct ip_moptions *imo;
    993   1.5   hpeyerl 	register struct mbuf **mp;
    994   1.5   hpeyerl {
    995   1.5   hpeyerl 	u_char *ttl;
    996   1.5   hpeyerl 	u_char *loop;
    997   1.5   hpeyerl 	struct in_addr *addr;
    998   1.5   hpeyerl 	struct in_ifaddr *ia;
    999   1.5   hpeyerl 
   1000   1.5   hpeyerl 	*mp = m_get(M_WAIT, MT_SOOPTS);
   1001   1.5   hpeyerl 
   1002   1.5   hpeyerl 	switch (optname) {
   1003   1.5   hpeyerl 
   1004   1.5   hpeyerl 	case IP_MULTICAST_IF:
   1005   1.5   hpeyerl 		addr = mtod(*mp, struct in_addr *);
   1006   1.5   hpeyerl 		(*mp)->m_len = sizeof(struct in_addr);
   1007   1.5   hpeyerl 		if (imo == NULL || imo->imo_multicast_ifp == NULL)
   1008   1.5   hpeyerl 			addr->s_addr = INADDR_ANY;
   1009   1.5   hpeyerl 		else {
   1010   1.5   hpeyerl 			IFP_TO_IA(imo->imo_multicast_ifp, ia);
   1011   1.5   hpeyerl 			addr->s_addr = (ia == NULL) ? INADDR_ANY
   1012  1.25   mycroft 					: ia->ia_addr.sin_addr.s_addr;
   1013   1.5   hpeyerl 		}
   1014   1.5   hpeyerl 		return (0);
   1015   1.5   hpeyerl 
   1016   1.5   hpeyerl 	case IP_MULTICAST_TTL:
   1017   1.5   hpeyerl 		ttl = mtod(*mp, u_char *);
   1018   1.5   hpeyerl 		(*mp)->m_len = 1;
   1019   1.5   hpeyerl 		*ttl = (imo == NULL) ? IP_DEFAULT_MULTICAST_TTL
   1020   1.5   hpeyerl 				     : imo->imo_multicast_ttl;
   1021   1.5   hpeyerl 		return (0);
   1022   1.5   hpeyerl 
   1023   1.5   hpeyerl 	case IP_MULTICAST_LOOP:
   1024   1.5   hpeyerl 		loop = mtod(*mp, u_char *);
   1025   1.5   hpeyerl 		(*mp)->m_len = 1;
   1026   1.5   hpeyerl 		*loop = (imo == NULL) ? IP_DEFAULT_MULTICAST_LOOP
   1027   1.5   hpeyerl 				      : imo->imo_multicast_loop;
   1028   1.5   hpeyerl 		return (0);
   1029   1.5   hpeyerl 
   1030   1.5   hpeyerl 	default:
   1031   1.5   hpeyerl 		return (EOPNOTSUPP);
   1032   1.5   hpeyerl 	}
   1033   1.5   hpeyerl }
   1034   1.5   hpeyerl 
   1035   1.5   hpeyerl /*
   1036   1.5   hpeyerl  * Discard the IP multicast options.
   1037   1.5   hpeyerl  */
   1038   1.5   hpeyerl void
   1039   1.5   hpeyerl ip_freemoptions(imo)
   1040   1.5   hpeyerl 	register struct ip_moptions *imo;
   1041   1.5   hpeyerl {
   1042   1.5   hpeyerl 	register int i;
   1043   1.5   hpeyerl 
   1044   1.5   hpeyerl 	if (imo != NULL) {
   1045   1.5   hpeyerl 		for (i = 0; i < imo->imo_num_memberships; ++i)
   1046   1.5   hpeyerl 			in_delmulti(imo->imo_membership[i]);
   1047   1.5   hpeyerl 		free(imo, M_IPMOPTS);
   1048   1.5   hpeyerl 	}
   1049   1.5   hpeyerl }
   1050   1.5   hpeyerl 
   1051   1.5   hpeyerl /*
   1052   1.5   hpeyerl  * Routine called from ip_output() to loop back a copy of an IP multicast
   1053   1.5   hpeyerl  * packet to the input queue of a specified interface.  Note that this
   1054   1.5   hpeyerl  * calls the output routine of the loopback "driver", but with an interface
   1055   1.5   hpeyerl  * pointer that might NOT be &loif -- easier than replicating that code here.
   1056   1.5   hpeyerl  */
   1057  1.12   mycroft static void
   1058   1.5   hpeyerl ip_mloopback(ifp, m, dst)
   1059   1.5   hpeyerl 	struct ifnet *ifp;
   1060   1.5   hpeyerl 	register struct mbuf *m;
   1061   1.5   hpeyerl 	register struct sockaddr_in *dst;
   1062   1.5   hpeyerl {
   1063   1.5   hpeyerl 	register struct ip *ip;
   1064   1.5   hpeyerl 	struct mbuf *copym;
   1065   1.5   hpeyerl 
   1066   1.5   hpeyerl 	copym = m_copy(m, 0, M_COPYALL);
   1067   1.5   hpeyerl 	if (copym != NULL) {
   1068   1.5   hpeyerl 		/*
   1069   1.5   hpeyerl 		 * We don't bother to fragment if the IP length is greater
   1070   1.5   hpeyerl 		 * than the interface's MTU.  Can this possibly matter?
   1071   1.5   hpeyerl 		 */
   1072   1.5   hpeyerl 		ip = mtod(copym, struct ip *);
   1073  1.21       cgd 		ip->ip_len = htons((u_int16_t)ip->ip_len);
   1074  1.21       cgd 		ip->ip_off = htons((u_int16_t)ip->ip_off);
   1075   1.5   hpeyerl 		ip->ip_sum = 0;
   1076   1.5   hpeyerl 		ip->ip_sum = in_cksum(copym, ip->ip_hl << 2);
   1077  1.24   mycroft 		(void) looutput(ifp, copym, sintosa(dst), NULL);
   1078   1.5   hpeyerl 	}
   1079   1.5   hpeyerl }
   1080