xref: /freebsd/sys/netinet/ip_output.c (revision 3528d68f716b03a2e42bd3c732bf39d6e93b59bf)
1df8bae1dSRodney W. Grimes /*
2df8bae1dSRodney W. Grimes  * Copyright (c) 1982, 1986, 1988, 1990, 1993
3df8bae1dSRodney W. Grimes  *	The Regents of the University of California.  All rights reserved.
4df8bae1dSRodney W. Grimes  *
5df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
6df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
7df8bae1dSRodney W. Grimes  * are met:
8df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
9df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
10df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
11df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
12df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
13df8bae1dSRodney W. Grimes  * 3. All advertising materials mentioning features or use of this software
14df8bae1dSRodney W. Grimes  *    must display the following acknowledgement:
15df8bae1dSRodney W. Grimes  *	This product includes software developed by the University of
16df8bae1dSRodney W. Grimes  *	California, Berkeley and its contributors.
17df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
18df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
19df8bae1dSRodney W. Grimes  *    without specific prior written permission.
20df8bae1dSRodney W. Grimes  *
21df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
32df8bae1dSRodney W. Grimes  *
33df8bae1dSRodney W. Grimes  *	@(#)ip_output.c	8.3 (Berkeley) 1/21/94
34c3aac50fSPeter Wemm  * $FreeBSD$
35df8bae1dSRodney W. Grimes  */
36df8bae1dSRodney W. Grimes 
379c9137eaSGarrett Wollman #define _IP_VHL
389c9137eaSGarrett Wollman 
391f7e052cSJulian Elischer #include "opt_ipfw.h"
40b715f178SLuigi Rizzo #include "opt_ipdn.h"
41fbd1372aSJoerg Wunsch #include "opt_ipdivert.h"
421ee25934SPeter Wemm #include "opt_ipfilter.h"
436a800098SYoshinobu Inoue #include "opt_ipsec.h"
44c4ac87eaSDarren Reed #include "opt_pfil_hooks.h"
4564dddc18SKris Kennaway #include "opt_random_ip_id.h"
46fbd1372aSJoerg Wunsch 
47df8bae1dSRodney W. Grimes #include <sys/param.h>
4826f9a767SRodney W. Grimes #include <sys/systm.h>
49f0f6d643SLuigi Rizzo #include <sys/kernel.h>
50df8bae1dSRodney W. Grimes #include <sys/malloc.h>
51df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
52df8bae1dSRodney W. Grimes #include <sys/protosw.h>
53df8bae1dSRodney W. Grimes #include <sys/socket.h>
54df8bae1dSRodney W. Grimes #include <sys/socketvar.h>
55df8bae1dSRodney W. Grimes 
56df8bae1dSRodney W. Grimes #include <net/if.h>
57df8bae1dSRodney W. Grimes #include <net/route.h>
58df8bae1dSRodney W. Grimes 
59df8bae1dSRodney W. Grimes #include <netinet/in.h>
60df8bae1dSRodney W. Grimes #include <netinet/in_systm.h>
61df8bae1dSRodney W. Grimes #include <netinet/ip.h>
62df8bae1dSRodney W. Grimes #include <netinet/in_pcb.h>
63df8bae1dSRodney W. Grimes #include <netinet/in_var.h>
64df8bae1dSRodney W. Grimes #include <netinet/ip_var.h>
65df8bae1dSRodney W. Grimes 
669c9137eaSGarrett Wollman #include <machine/in_cksum.h>
67df8bae1dSRodney W. Grimes 
68a1c995b6SPoul-Henning Kamp static MALLOC_DEFINE(M_IPMOPTS, "ip_moptions", "internet multicast options");
6955166637SPoul-Henning Kamp 
706a800098SYoshinobu Inoue #ifdef IPSEC
716a800098SYoshinobu Inoue #include <netinet6/ipsec.h>
726a800098SYoshinobu Inoue #include <netkey/key.h>
736a800098SYoshinobu Inoue #ifdef IPSEC_DEBUG
746a800098SYoshinobu Inoue #include <netkey/key_debug.h>
756a800098SYoshinobu Inoue #else
766a800098SYoshinobu Inoue #define	KEYDEBUG(lev,arg)
776a800098SYoshinobu Inoue #endif
786a800098SYoshinobu Inoue #endif /*IPSEC*/
796a800098SYoshinobu Inoue 
80cfe8b629SGarrett Wollman #include <netinet/ip_fw.h>
81b715f178SLuigi Rizzo #include <netinet/ip_dummynet.h>
82b715f178SLuigi Rizzo 
83f9e354dfSJulian Elischer #ifdef IPFIREWALL_FORWARD_DEBUG
84f9e354dfSJulian Elischer #define print_ip(a)	 printf("%ld.%ld.%ld.%ld",(ntohl(a.s_addr)>>24)&0xFF,\
85f9e354dfSJulian Elischer 				 		  (ntohl(a.s_addr)>>16)&0xFF,\
86f9e354dfSJulian Elischer 						  (ntohl(a.s_addr)>>8)&0xFF,\
87f9e354dfSJulian Elischer 						  (ntohl(a.s_addr))&0xFF);
88f9e354dfSJulian Elischer #endif
89f9e354dfSJulian Elischer 
90f23b4c91SGarrett Wollman u_short ip_id;
91f23b4c91SGarrett Wollman 
92df8bae1dSRodney W. Grimes static struct mbuf *ip_insertoptions __P((struct mbuf *, struct mbuf *, int *));
9333841545SHajimu UMEMOTO static struct ifnet *ip_multicast_if __P((struct in_addr *, int *));
94df8bae1dSRodney W. Grimes static void	ip_mloopback
9586b1d6d2SBill Fenner 	__P((struct ifnet *, struct mbuf *, struct sockaddr_in *, int));
960312fbe9SPoul-Henning Kamp static int	ip_getmoptions
97cfe8b629SGarrett Wollman 	__P((struct sockopt *, struct ip_moptions *));
98cfe8b629SGarrett Wollman static int	ip_pcbopts __P((int, struct mbuf **, struct mbuf *));
990312fbe9SPoul-Henning Kamp static int	ip_setmoptions
100cfe8b629SGarrett Wollman 	__P((struct sockopt *, struct ip_moptions **));
101df8bae1dSRodney W. Grimes 
102beec8214SDarren Reed int	ip_optcopy __P((struct ip *, struct ip *));
103afed1b49SDarren Reed 
104afed1b49SDarren Reed 
10593e0e116SJulian Elischer extern	struct protosw inetsw[];
10693e0e116SJulian Elischer 
107df8bae1dSRodney W. Grimes /*
108df8bae1dSRodney W. Grimes  * IP output.  The packet in mbuf chain m contains a skeletal IP
109df8bae1dSRodney W. Grimes  * header (with len, off, ttl, proto, tos, src, dst).
110df8bae1dSRodney W. Grimes  * The mbuf chain containing the packet will be freed.
111df8bae1dSRodney W. Grimes  * The mbuf opt, if present, will not be freed.
112df8bae1dSRodney W. Grimes  */
113df8bae1dSRodney W. Grimes int
114df8bae1dSRodney W. Grimes ip_output(m0, opt, ro, flags, imo)
115df8bae1dSRodney W. Grimes 	struct mbuf *m0;
116df8bae1dSRodney W. Grimes 	struct mbuf *opt;
117df8bae1dSRodney W. Grimes 	struct route *ro;
118df8bae1dSRodney W. Grimes 	int flags;
119df8bae1dSRodney W. Grimes 	struct ip_moptions *imo;
120df8bae1dSRodney W. Grimes {
12123bf9953SPoul-Henning Kamp 	struct ip *ip, *mhip;
12223bf9953SPoul-Henning Kamp 	struct ifnet *ifp;
12323bf9953SPoul-Henning Kamp 	struct mbuf *m = m0;
12423bf9953SPoul-Henning Kamp 	int hlen = sizeof (struct ip);
125df8bae1dSRodney W. Grimes 	int len, off, error = 0;
126df8bae1dSRodney W. Grimes 	struct sockaddr_in *dst;
127df8bae1dSRodney W. Grimes 	struct in_ifaddr *ia;
128db4f9cc7SJonathan Lemon 	int isbroadcast, sw_csum;
1296a800098SYoshinobu Inoue #ifdef IPSEC
1306a800098SYoshinobu Inoue 	struct route iproute;
131d0a98d79SYoshinobu Inoue 	struct socket *so = NULL;
1326a800098SYoshinobu Inoue 	struct secpolicy *sp = NULL;
1336a800098SYoshinobu Inoue #endif
1348948e4baSArchie Cobbs 	u_int16_t divert_cookie;		/* firewall cookie */
135c4ac87eaSDarren Reed #ifdef PFIL_HOOKS
136c4ac87eaSDarren Reed 	struct packet_filter_hook *pfh;
137c4ac87eaSDarren Reed 	struct mbuf *m1;
138c4ac87eaSDarren Reed 	int rv;
139c4ac87eaSDarren Reed #endif /* PFIL_HOOKS */
140f9e354dfSJulian Elischer #ifdef IPFIREWALL_FORWARD
141f9e354dfSJulian Elischer 	int fwd_rewrite_src = 0;
142f9e354dfSJulian Elischer #endif
143830cc178SLuigi Rizzo 	struct ip_fw *rule = NULL;
144b715f178SLuigi Rizzo 
1458948e4baSArchie Cobbs #ifdef IPDIVERT
1468948e4baSArchie Cobbs 	/* Get and reset firewall cookie */
1478948e4baSArchie Cobbs 	divert_cookie = ip_divert_cookie;
1488948e4baSArchie Cobbs 	ip_divert_cookie = 0;
1498948e4baSArchie Cobbs #else
1508948e4baSArchie Cobbs 	divert_cookie = 0;
1518948e4baSArchie Cobbs #endif
1528948e4baSArchie Cobbs 
153b715f178SLuigi Rizzo         /*
154b715f178SLuigi Rizzo          * dummynet packet are prepended a vestigial mbuf with
155b715f178SLuigi Rizzo          * m_type = MT_DUMMYNET and m_data pointing to the matching
156b715f178SLuigi Rizzo          * rule.
157b715f178SLuigi Rizzo          */
158b715f178SLuigi Rizzo         if (m->m_type == MT_DUMMYNET) {
159b715f178SLuigi Rizzo             /*
160b715f178SLuigi Rizzo              * the packet was already tagged, so part of the
161b715f178SLuigi Rizzo              * processing was already done, and we need to go down.
1626bc748b0SLuigi Rizzo              * Get parameters from the header.
163b715f178SLuigi Rizzo              */
164830cc178SLuigi Rizzo             rule = (struct ip_fw *)(m->m_data) ;
165d1f04b29SLuigi Rizzo 	    opt = NULL ;
166d1f04b29SLuigi Rizzo 	    ro = & ( ((struct dn_pkt *)m)->ro ) ;
167d1f04b29SLuigi Rizzo 	    imo = NULL ;
168d1f04b29SLuigi Rizzo 	    dst = ((struct dn_pkt *)m)->dn_dst ;
169d1f04b29SLuigi Rizzo 	    ifp = ((struct dn_pkt *)m)->ifp ;
170d0a98d79SYoshinobu Inoue 	    flags = ((struct dn_pkt *)m)->flags ;
171d1f04b29SLuigi Rizzo 
17217458d35SLuigi Rizzo             m0 = m = m->m_next ;
173d0a98d79SYoshinobu Inoue #ifdef IPSEC
174686cdd19SJun-ichiro itojun Hagino 	    so = ipsec_getsocket(m);
17533841545SHajimu UMEMOTO 	    (void)ipsec_setsocket(m, NULL);
176d0a98d79SYoshinobu Inoue #endif
177b715f178SLuigi Rizzo             ip = mtod(m, struct ip *);
178b715f178SLuigi Rizzo             hlen = IP_VHL_HL(ip->ip_vhl) << 2 ;
1799a10980eSJonathan Lemon             ia = ifatoia(ro->ro_rt->rt_ifa);
180b715f178SLuigi Rizzo             goto sendit;
181b715f178SLuigi Rizzo         } else
182b715f178SLuigi Rizzo             rule = NULL ;
183d0a98d79SYoshinobu Inoue #ifdef IPSEC
184686cdd19SJun-ichiro itojun Hagino 	so = ipsec_getsocket(m);
18533841545SHajimu UMEMOTO 	(void)ipsec_setsocket(m, NULL);
186d0a98d79SYoshinobu Inoue #endif
187b715f178SLuigi Rizzo 
188df8bae1dSRodney W. Grimes #ifdef	DIAGNOSTIC
189df8bae1dSRodney W. Grimes 	if ((m->m_flags & M_PKTHDR) == 0)
190df8bae1dSRodney W. Grimes 		panic("ip_output no HDR");
1919c9137eaSGarrett Wollman 	if (!ro)
1929c9137eaSGarrett Wollman 		panic("ip_output no route, proto = %d",
1939c9137eaSGarrett Wollman 		      mtod(m, struct ip *)->ip_p);
194df8bae1dSRodney W. Grimes #endif
195df8bae1dSRodney W. Grimes 	if (opt) {
196df8bae1dSRodney W. Grimes 		m = ip_insertoptions(m, opt, &len);
197df8bae1dSRodney W. Grimes 		hlen = len;
198df8bae1dSRodney W. Grimes 	}
199df8bae1dSRodney W. Grimes 	ip = mtod(m, struct ip *);
200df8bae1dSRodney W. Grimes 	/*
201df8bae1dSRodney W. Grimes 	 * Fill in IP header.
202df8bae1dSRodney W. Grimes 	 */
203df8bae1dSRodney W. Grimes 	if ((flags & (IP_FORWARDING|IP_RAWOUTPUT)) == 0) {
2049c9137eaSGarrett Wollman 		ip->ip_vhl = IP_MAKE_VHL(IPVERSION, hlen >> 2);
205df8bae1dSRodney W. Grimes 		ip->ip_off &= IP_DF;
20664dddc18SKris Kennaway #ifdef RANDOM_IP_ID
20764dddc18SKris Kennaway 		ip->ip_id = ip_randomid();
20864dddc18SKris Kennaway #else
209e30177e0SRuslan Ermilov 		ip->ip_id = htons(ip_id++);
21064dddc18SKris Kennaway #endif
211df8bae1dSRodney W. Grimes 		ipstat.ips_localout++;
212df8bae1dSRodney W. Grimes 	} else {
2139c9137eaSGarrett Wollman 		hlen = IP_VHL_HL(ip->ip_vhl) << 2;
214df8bae1dSRodney W. Grimes 	}
2159c9137eaSGarrett Wollman 
216df8bae1dSRodney W. Grimes 	dst = (struct sockaddr_in *)&ro->ro_dst;
217df8bae1dSRodney W. Grimes 	/*
218df8bae1dSRodney W. Grimes 	 * If there is a cached route,
219df8bae1dSRodney W. Grimes 	 * check that it is to the same destination
220df8bae1dSRodney W. Grimes 	 * and is still up.  If not, free it and try again.
221df8bae1dSRodney W. Grimes 	 */
222df8bae1dSRodney W. Grimes 	if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
223df8bae1dSRodney W. Grimes 	   dst->sin_addr.s_addr != ip->ip_dst.s_addr)) {
224df8bae1dSRodney W. Grimes 		RTFREE(ro->ro_rt);
225df8bae1dSRodney W. Grimes 		ro->ro_rt = (struct rtentry *)0;
226df8bae1dSRodney W. Grimes 	}
227df8bae1dSRodney W. Grimes 	if (ro->ro_rt == 0) {
228df8bae1dSRodney W. Grimes 		dst->sin_family = AF_INET;
229df8bae1dSRodney W. Grimes 		dst->sin_len = sizeof(*dst);
230df8bae1dSRodney W. Grimes 		dst->sin_addr = ip->ip_dst;
231df8bae1dSRodney W. Grimes 	}
232df8bae1dSRodney W. Grimes 	/*
233df8bae1dSRodney W. Grimes 	 * If routing to interface only,
234df8bae1dSRodney W. Grimes 	 * short circuit routing lookup.
235df8bae1dSRodney W. Grimes 	 */
236df8bae1dSRodney W. Grimes 	if (flags & IP_ROUTETOIF) {
237df8bae1dSRodney W. Grimes 		if ((ia = ifatoia(ifa_ifwithdstaddr(sintosa(dst)))) == 0 &&
238df8bae1dSRodney W. Grimes 		    (ia = ifatoia(ifa_ifwithnet(sintosa(dst)))) == 0) {
239df8bae1dSRodney W. Grimes 			ipstat.ips_noroute++;
240df8bae1dSRodney W. Grimes 			error = ENETUNREACH;
241df8bae1dSRodney W. Grimes 			goto bad;
242df8bae1dSRodney W. Grimes 		}
243df8bae1dSRodney W. Grimes 		ifp = ia->ia_ifp;
244df8bae1dSRodney W. Grimes 		ip->ip_ttl = 1;
2459f9b3dc4SGarrett Wollman 		isbroadcast = in_broadcast(dst->sin_addr, ifp);
2463afefa39SDaniel C. Sobral 	} else if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) &&
24738c1bc35SRuslan Ermilov 	    imo != NULL && imo->imo_multicast_ifp != NULL) {
2483afefa39SDaniel C. Sobral 		/*
24938c1bc35SRuslan Ermilov 		 * Bypass the normal routing lookup for multicast
25038c1bc35SRuslan Ermilov 		 * packets if the interface is specified.
2513afefa39SDaniel C. Sobral 		 */
25238c1bc35SRuslan Ermilov 		ifp = imo->imo_multicast_ifp;
25338c1bc35SRuslan Ermilov 		IFP_TO_IA(ifp, ia);
25438c1bc35SRuslan Ermilov 		isbroadcast = 0;	/* fool gcc */
255df8bae1dSRodney W. Grimes 	} else {
2562c17fe93SGarrett Wollman 		/*
257f2c2962eSRuslan Ermilov 		 * If this is the case, we probably don't want to allocate
258f2c2962eSRuslan Ermilov 		 * a protocol-cloned route since we didn't get one from the
259f2c2962eSRuslan Ermilov 		 * ULP.  This lets TCP do its thing, while not burdening
260f2c2962eSRuslan Ermilov 		 * forwarding or ICMP with the overhead of cloning a route.
261f2c2962eSRuslan Ermilov 		 * Of course, we still want to do any cloning requested by
262f2c2962eSRuslan Ermilov 		 * the link layer, as this is probably required in all cases
263f2c2962eSRuslan Ermilov 		 * for correct operation (as it is for ARP).
2642c17fe93SGarrett Wollman 		 */
265df8bae1dSRodney W. Grimes 		if (ro->ro_rt == 0)
2662c17fe93SGarrett Wollman 			rtalloc_ign(ro, RTF_PRCLONING);
267df8bae1dSRodney W. Grimes 		if (ro->ro_rt == 0) {
268df8bae1dSRodney W. Grimes 			ipstat.ips_noroute++;
269df8bae1dSRodney W. Grimes 			error = EHOSTUNREACH;
270df8bae1dSRodney W. Grimes 			goto bad;
271df8bae1dSRodney W. Grimes 		}
272df8bae1dSRodney W. Grimes 		ia = ifatoia(ro->ro_rt->rt_ifa);
273df8bae1dSRodney W. Grimes 		ifp = ro->ro_rt->rt_ifp;
274df8bae1dSRodney W. Grimes 		ro->ro_rt->rt_use++;
275df8bae1dSRodney W. Grimes 		if (ro->ro_rt->rt_flags & RTF_GATEWAY)
276f2c2962eSRuslan Ermilov 			dst = (struct sockaddr_in *)ro->ro_rt->rt_gateway;
2779f9b3dc4SGarrett Wollman 		if (ro->ro_rt->rt_flags & RTF_HOST)
278f2c2962eSRuslan Ermilov 			isbroadcast = (ro->ro_rt->rt_flags & RTF_BROADCAST);
2799f9b3dc4SGarrett Wollman 		else
2809f9b3dc4SGarrett Wollman 			isbroadcast = in_broadcast(dst->sin_addr, ifp);
281df8bae1dSRodney W. Grimes 	}
282df8bae1dSRodney W. Grimes 	if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr))) {
283df8bae1dSRodney W. Grimes 		struct in_multi *inm;
284df8bae1dSRodney W. Grimes 
285df8bae1dSRodney W. Grimes 		m->m_flags |= M_MCAST;
286df8bae1dSRodney W. Grimes 		/*
287df8bae1dSRodney W. Grimes 		 * IP destination address is multicast.  Make sure "dst"
288df8bae1dSRodney W. Grimes 		 * still points to the address in "ro".  (It may have been
289df8bae1dSRodney W. Grimes 		 * changed to point to a gateway address, above.)
290df8bae1dSRodney W. Grimes 		 */
291df8bae1dSRodney W. Grimes 		dst = (struct sockaddr_in *)&ro->ro_dst;
292df8bae1dSRodney W. Grimes 		/*
293df8bae1dSRodney W. Grimes 		 * See if the caller provided any multicast options
294df8bae1dSRodney W. Grimes 		 */
295df8bae1dSRodney W. Grimes 		if (imo != NULL) {
296df8bae1dSRodney W. Grimes 			ip->ip_ttl = imo->imo_multicast_ttl;
2971c5de19aSGarrett Wollman 			if (imo->imo_multicast_vif != -1)
2981c5de19aSGarrett Wollman 				ip->ip_src.s_addr =
2991c5de19aSGarrett Wollman 				    ip_mcast_src(imo->imo_multicast_vif);
300df8bae1dSRodney W. Grimes 		} else
301df8bae1dSRodney W. Grimes 			ip->ip_ttl = IP_DEFAULT_MULTICAST_TTL;
302df8bae1dSRodney W. Grimes 		/*
303df8bae1dSRodney W. Grimes 		 * Confirm that the outgoing interface supports multicast.
304df8bae1dSRodney W. Grimes 		 */
3051c5de19aSGarrett Wollman 		if ((imo == NULL) || (imo->imo_multicast_vif == -1)) {
306df8bae1dSRodney W. Grimes 			if ((ifp->if_flags & IFF_MULTICAST) == 0) {
307df8bae1dSRodney W. Grimes 				ipstat.ips_noroute++;
308df8bae1dSRodney W. Grimes 				error = ENETUNREACH;
309df8bae1dSRodney W. Grimes 				goto bad;
310df8bae1dSRodney W. Grimes 			}
3111c5de19aSGarrett Wollman 		}
312df8bae1dSRodney W. Grimes 		/*
313df8bae1dSRodney W. Grimes 		 * If source address not specified yet, use address
314df8bae1dSRodney W. Grimes 		 * of outgoing interface.
315df8bae1dSRodney W. Grimes 		 */
316df8bae1dSRodney W. Grimes 		if (ip->ip_src.s_addr == INADDR_ANY) {
31738c1bc35SRuslan Ermilov 			/* Interface may have no addresses. */
31838c1bc35SRuslan Ermilov 			if (ia != NULL)
31938c1bc35SRuslan Ermilov 				ip->ip_src = IA_SIN(ia)->sin_addr;
320df8bae1dSRodney W. Grimes 		}
321df8bae1dSRodney W. Grimes 
322df8bae1dSRodney W. Grimes 		IN_LOOKUP_MULTI(ip->ip_dst, ifp, inm);
323df8bae1dSRodney W. Grimes 		if (inm != NULL &&
324df8bae1dSRodney W. Grimes 		   (imo == NULL || imo->imo_multicast_loop)) {
325df8bae1dSRodney W. Grimes 			/*
326df8bae1dSRodney W. Grimes 			 * If we belong to the destination multicast group
327df8bae1dSRodney W. Grimes 			 * on the outgoing interface, and the caller did not
328df8bae1dSRodney W. Grimes 			 * forbid loopback, loop back a copy.
329df8bae1dSRodney W. Grimes 			 */
33086b1d6d2SBill Fenner 			ip_mloopback(ifp, m, dst, hlen);
331df8bae1dSRodney W. Grimes 		}
332df8bae1dSRodney W. Grimes 		else {
333df8bae1dSRodney W. Grimes 			/*
334df8bae1dSRodney W. Grimes 			 * If we are acting as a multicast router, perform
335df8bae1dSRodney W. Grimes 			 * multicast forwarding as if the packet had just
336df8bae1dSRodney W. Grimes 			 * arrived on the interface to which we are about
337df8bae1dSRodney W. Grimes 			 * to send.  The multicast forwarding function
338df8bae1dSRodney W. Grimes 			 * recursively calls this function, using the
339df8bae1dSRodney W. Grimes 			 * IP_FORWARDING flag to prevent infinite recursion.
340df8bae1dSRodney W. Grimes 			 *
341df8bae1dSRodney W. Grimes 			 * Multicasts that are looped back by ip_mloopback(),
342df8bae1dSRodney W. Grimes 			 * above, will be forwarded by the ip_input() routine,
343df8bae1dSRodney W. Grimes 			 * if necessary.
344df8bae1dSRodney W. Grimes 			 */
345df8bae1dSRodney W. Grimes 			if (ip_mrouter && (flags & IP_FORWARDING) == 0) {
346f0068c4aSGarrett Wollman 				/*
347f0068c4aSGarrett Wollman 				 * Check if rsvp daemon is running. If not, don't
348f0068c4aSGarrett Wollman 				 * set ip_moptions. This ensures that the packet
349f0068c4aSGarrett Wollman 				 * is multicast and not just sent down one link
350f0068c4aSGarrett Wollman 				 * as prescribed by rsvpd.
351f0068c4aSGarrett Wollman 				 */
352b124e4f2SGarrett Wollman 				if (!rsvp_on)
353f0068c4aSGarrett Wollman 				  imo = NULL;
354f0068c4aSGarrett Wollman 				if (ip_mforward(ip, ifp, m, imo) != 0) {
355df8bae1dSRodney W. Grimes 					m_freem(m);
356df8bae1dSRodney W. Grimes 					goto done;
357df8bae1dSRodney W. Grimes 				}
358df8bae1dSRodney W. Grimes 			}
359df8bae1dSRodney W. Grimes 		}
3605e9ae478SGarrett Wollman 
361df8bae1dSRodney W. Grimes 		/*
362df8bae1dSRodney W. Grimes 		 * Multicasts with a time-to-live of zero may be looped-
363df8bae1dSRodney W. Grimes 		 * back, above, but must not be transmitted on a network.
364df8bae1dSRodney W. Grimes 		 * Also, multicasts addressed to the loopback interface
365df8bae1dSRodney W. Grimes 		 * are not sent -- the above call to ip_mloopback() will
366df8bae1dSRodney W. Grimes 		 * loop back a copy if this host actually belongs to the
367df8bae1dSRodney W. Grimes 		 * destination group on the loopback interface.
368df8bae1dSRodney W. Grimes 		 */
369f5fea3ddSPaul Traina 		if (ip->ip_ttl == 0 || ifp->if_flags & IFF_LOOPBACK) {
370df8bae1dSRodney W. Grimes 			m_freem(m);
371df8bae1dSRodney W. Grimes 			goto done;
372df8bae1dSRodney W. Grimes 		}
373df8bae1dSRodney W. Grimes 
374df8bae1dSRodney W. Grimes 		goto sendit;
375df8bae1dSRodney W. Grimes 	}
376df8bae1dSRodney W. Grimes #ifndef notdef
377df8bae1dSRodney W. Grimes 	/*
378df8bae1dSRodney W. Grimes 	 * If source address not specified yet, use address
379df8bae1dSRodney W. Grimes 	 * of outgoing interface.
380df8bae1dSRodney W. Grimes 	 */
381f9e354dfSJulian Elischer 	if (ip->ip_src.s_addr == INADDR_ANY) {
38238c1bc35SRuslan Ermilov 		/* Interface may have no addresses. */
38338c1bc35SRuslan Ermilov 		if (ia != NULL) {
384df8bae1dSRodney W. Grimes 			ip->ip_src = IA_SIN(ia)->sin_addr;
385f9e354dfSJulian Elischer #ifdef IPFIREWALL_FORWARD
386f9e354dfSJulian Elischer 			/* Keep note that we did this - if the firewall changes
387f9e354dfSJulian Elischer 		 	* the next-hop, our interface may change, changing the
388f9e354dfSJulian Elischer 		 	* default source IP. It's a shame so much effort happens
389f9e354dfSJulian Elischer 		 	* twice. Oh well.
390f9e354dfSJulian Elischer 		 	*/
391f9e354dfSJulian Elischer 			fwd_rewrite_src++;
392f9e354dfSJulian Elischer #endif /* IPFIREWALL_FORWARD */
393f9e354dfSJulian Elischer 		}
39438c1bc35SRuslan Ermilov 	}
395f9e354dfSJulian Elischer #endif /* notdef */
396df8bae1dSRodney W. Grimes 	/*
397b5390296SDavid Greenman 	 * Verify that we have any chance at all of being able to queue
398b5390296SDavid Greenman 	 *      the packet or packet fragments
399b5390296SDavid Greenman 	 */
400b5390296SDavid Greenman 	if ((ifp->if_snd.ifq_len + ip->ip_len / ifp->if_mtu + 1) >=
401b5390296SDavid Greenman 		ifp->if_snd.ifq_maxlen) {
402b5390296SDavid Greenman 			error = ENOBUFS;
40335609d45SJonathan Lemon 			ipstat.ips_odropped++;
404b5390296SDavid Greenman 			goto bad;
405b5390296SDavid Greenman 	}
406b5390296SDavid Greenman 
407b5390296SDavid Greenman 	/*
408df8bae1dSRodney W. Grimes 	 * Look for broadcast address and
409df8bae1dSRodney W. Grimes 	 * and verify user is allowed to send
410df8bae1dSRodney W. Grimes 	 * such a packet.
411df8bae1dSRodney W. Grimes 	 */
4129f9b3dc4SGarrett Wollman 	if (isbroadcast) {
413df8bae1dSRodney W. Grimes 		if ((ifp->if_flags & IFF_BROADCAST) == 0) {
414df8bae1dSRodney W. Grimes 			error = EADDRNOTAVAIL;
415df8bae1dSRodney W. Grimes 			goto bad;
416df8bae1dSRodney W. Grimes 		}
417df8bae1dSRodney W. Grimes 		if ((flags & IP_ALLOWBROADCAST) == 0) {
418df8bae1dSRodney W. Grimes 			error = EACCES;
419df8bae1dSRodney W. Grimes 			goto bad;
420df8bae1dSRodney W. Grimes 		}
421df8bae1dSRodney W. Grimes 		/* don't allow broadcast messages to be fragmented */
422df8bae1dSRodney W. Grimes 		if ((u_short)ip->ip_len > ifp->if_mtu) {
423df8bae1dSRodney W. Grimes 			error = EMSGSIZE;
424df8bae1dSRodney W. Grimes 			goto bad;
425df8bae1dSRodney W. Grimes 		}
426df8bae1dSRodney W. Grimes 		m->m_flags |= M_BCAST;
4279f9b3dc4SGarrett Wollman 	} else {
428df8bae1dSRodney W. Grimes 		m->m_flags &= ~M_BCAST;
4299f9b3dc4SGarrett Wollman 	}
430df8bae1dSRodney W. Grimes 
431f1743588SDarren Reed sendit:
43233841545SHajimu UMEMOTO #ifdef IPSEC
43333841545SHajimu UMEMOTO 	/* get SP for this packet */
43433841545SHajimu UMEMOTO 	if (so == NULL)
43533841545SHajimu UMEMOTO 		sp = ipsec4_getpolicybyaddr(m, IPSEC_DIR_OUTBOUND, flags, &error);
43633841545SHajimu UMEMOTO 	else
43733841545SHajimu UMEMOTO 		sp = ipsec4_getpolicybysock(m, IPSEC_DIR_OUTBOUND, so, &error);
43833841545SHajimu UMEMOTO 
43933841545SHajimu UMEMOTO 	if (sp == NULL) {
44033841545SHajimu UMEMOTO 		ipsecstat.out_inval++;
44133841545SHajimu UMEMOTO 		goto bad;
44233841545SHajimu UMEMOTO 	}
44333841545SHajimu UMEMOTO 
44433841545SHajimu UMEMOTO 	error = 0;
44533841545SHajimu UMEMOTO 
44633841545SHajimu UMEMOTO 	/* check policy */
44733841545SHajimu UMEMOTO 	switch (sp->policy) {
44833841545SHajimu UMEMOTO 	case IPSEC_POLICY_DISCARD:
44933841545SHajimu UMEMOTO 		/*
45033841545SHajimu UMEMOTO 		 * This packet is just discarded.
45133841545SHajimu UMEMOTO 		 */
45233841545SHajimu UMEMOTO 		ipsecstat.out_polvio++;
45333841545SHajimu UMEMOTO 		goto bad;
45433841545SHajimu UMEMOTO 
45533841545SHajimu UMEMOTO 	case IPSEC_POLICY_BYPASS:
45633841545SHajimu UMEMOTO 	case IPSEC_POLICY_NONE:
45733841545SHajimu UMEMOTO 		/* no need to do IPsec. */
45833841545SHajimu UMEMOTO 		goto skip_ipsec;
45933841545SHajimu UMEMOTO 
46033841545SHajimu UMEMOTO 	case IPSEC_POLICY_IPSEC:
46133841545SHajimu UMEMOTO 		if (sp->req == NULL) {
46233841545SHajimu UMEMOTO 			/* acquire a policy */
46333841545SHajimu UMEMOTO 			error = key_spdacquire(sp);
46433841545SHajimu UMEMOTO 			goto bad;
46533841545SHajimu UMEMOTO 		}
46633841545SHajimu UMEMOTO 		break;
46733841545SHajimu UMEMOTO 
46833841545SHajimu UMEMOTO 	case IPSEC_POLICY_ENTRUST:
46933841545SHajimu UMEMOTO 	default:
47033841545SHajimu UMEMOTO 		printf("ip_output: Invalid policy found. %d\n", sp->policy);
47133841545SHajimu UMEMOTO 	}
47233841545SHajimu UMEMOTO     {
47333841545SHajimu UMEMOTO 	struct ipsec_output_state state;
47433841545SHajimu UMEMOTO 	bzero(&state, sizeof(state));
47533841545SHajimu UMEMOTO 	state.m = m;
47633841545SHajimu UMEMOTO 	if (flags & IP_ROUTETOIF) {
47733841545SHajimu UMEMOTO 		state.ro = &iproute;
47833841545SHajimu UMEMOTO 		bzero(&iproute, sizeof(iproute));
47933841545SHajimu UMEMOTO 	} else
48033841545SHajimu UMEMOTO 		state.ro = ro;
48133841545SHajimu UMEMOTO 	state.dst = (struct sockaddr *)dst;
48233841545SHajimu UMEMOTO 
48333841545SHajimu UMEMOTO 	ip->ip_sum = 0;
48433841545SHajimu UMEMOTO 
48533841545SHajimu UMEMOTO 	/*
48633841545SHajimu UMEMOTO 	 * XXX
48733841545SHajimu UMEMOTO 	 * delayed checksums are not currently compatible with IPsec
48833841545SHajimu UMEMOTO 	 */
48933841545SHajimu UMEMOTO 	if (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA) {
49033841545SHajimu UMEMOTO 		in_delayed_cksum(m);
49133841545SHajimu UMEMOTO 		m->m_pkthdr.csum_flags &= ~CSUM_DELAY_DATA;
49233841545SHajimu UMEMOTO 	}
49333841545SHajimu UMEMOTO 
49433841545SHajimu UMEMOTO 	HTONS(ip->ip_len);
49533841545SHajimu UMEMOTO 	HTONS(ip->ip_off);
49633841545SHajimu UMEMOTO 
49733841545SHajimu UMEMOTO 	error = ipsec4_output(&state, sp, flags);
49833841545SHajimu UMEMOTO 
49933841545SHajimu UMEMOTO 	m = state.m;
50033841545SHajimu UMEMOTO 	if (flags & IP_ROUTETOIF) {
50133841545SHajimu UMEMOTO 		/*
50233841545SHajimu UMEMOTO 		 * if we have tunnel mode SA, we may need to ignore
50333841545SHajimu UMEMOTO 		 * IP_ROUTETOIF.
50433841545SHajimu UMEMOTO 		 */
50533841545SHajimu UMEMOTO 		if (state.ro != &iproute || state.ro->ro_rt != NULL) {
50633841545SHajimu UMEMOTO 			flags &= ~IP_ROUTETOIF;
50733841545SHajimu UMEMOTO 			ro = state.ro;
50833841545SHajimu UMEMOTO 		}
50933841545SHajimu UMEMOTO 	} else
51033841545SHajimu UMEMOTO 		ro = state.ro;
51133841545SHajimu UMEMOTO 	dst = (struct sockaddr_in *)state.dst;
51233841545SHajimu UMEMOTO 	if (error) {
51333841545SHajimu UMEMOTO 		/* mbuf is already reclaimed in ipsec4_output. */
51433841545SHajimu UMEMOTO 		m0 = NULL;
51533841545SHajimu UMEMOTO 		switch (error) {
51633841545SHajimu UMEMOTO 		case EHOSTUNREACH:
51733841545SHajimu UMEMOTO 		case ENETUNREACH:
51833841545SHajimu UMEMOTO 		case EMSGSIZE:
51933841545SHajimu UMEMOTO 		case ENOBUFS:
52033841545SHajimu UMEMOTO 		case ENOMEM:
52133841545SHajimu UMEMOTO 			break;
52233841545SHajimu UMEMOTO 		default:
52333841545SHajimu UMEMOTO 			printf("ip4_output (ipsec): error code %d\n", error);
52433841545SHajimu UMEMOTO 			/*fall through*/
52533841545SHajimu UMEMOTO 		case ENOENT:
52633841545SHajimu UMEMOTO 			/* don't show these error codes to the user */
52733841545SHajimu UMEMOTO 			error = 0;
52833841545SHajimu UMEMOTO 			break;
52933841545SHajimu UMEMOTO 		}
53033841545SHajimu UMEMOTO 		goto bad;
53133841545SHajimu UMEMOTO 	}
53233841545SHajimu UMEMOTO     }
53333841545SHajimu UMEMOTO 
53433841545SHajimu UMEMOTO 	/* be sure to update variables that are affected by ipsec4_output() */
53533841545SHajimu UMEMOTO 	ip = mtod(m, struct ip *);
53633841545SHajimu UMEMOTO #ifdef _IP_VHL
53733841545SHajimu UMEMOTO 	hlen = IP_VHL_HL(ip->ip_vhl) << 2;
53833841545SHajimu UMEMOTO #else
53933841545SHajimu UMEMOTO 	hlen = ip->ip_hl << 2;
54033841545SHajimu UMEMOTO #endif
54133841545SHajimu UMEMOTO 	if (ro->ro_rt == NULL) {
54233841545SHajimu UMEMOTO 		if ((flags & IP_ROUTETOIF) == 0) {
54333841545SHajimu UMEMOTO 			printf("ip_output: "
54433841545SHajimu UMEMOTO 				"can't update route after IPsec processing\n");
54533841545SHajimu UMEMOTO 			error = EHOSTUNREACH;	/*XXX*/
54633841545SHajimu UMEMOTO 			goto bad;
54733841545SHajimu UMEMOTO 		}
54833841545SHajimu UMEMOTO 	} else {
54933841545SHajimu UMEMOTO 		ia = ifatoia(ro->ro_rt->rt_ifa);
55033841545SHajimu UMEMOTO 		ifp = ro->ro_rt->rt_ifp;
55133841545SHajimu UMEMOTO 	}
55233841545SHajimu UMEMOTO 
55333841545SHajimu UMEMOTO 	/* make it flipped, again. */
55433841545SHajimu UMEMOTO 	NTOHS(ip->ip_len);
55533841545SHajimu UMEMOTO 	NTOHS(ip->ip_off);
55633841545SHajimu UMEMOTO skip_ipsec:
55733841545SHajimu UMEMOTO #endif /*IPSEC*/
55833841545SHajimu UMEMOTO 
559fed1c7e9SSøren Schmidt 	/*
560fed1c7e9SSøren Schmidt 	 * IpHack's section.
561fed1c7e9SSøren Schmidt 	 * - Xlate: translate packet's addr/port (NAT).
562e4676ba6SJulian Elischer 	 * - Firewall: deny/allow/etc.
563fed1c7e9SSøren Schmidt 	 * - Wrap: fake packet's addr/port <unimpl.>
564fed1c7e9SSøren Schmidt 	 * - Encapsulate: put it in another IP and send out. <unimp.>
565fed1c7e9SSøren Schmidt 	 */
566c4ac87eaSDarren Reed #ifdef PFIL_HOOKS
567c4ac87eaSDarren Reed 	/*
568c4ac87eaSDarren Reed 	 * Run through list of hooks for output packets.
569c4ac87eaSDarren Reed 	 */
570c4ac87eaSDarren Reed 	m1 = m;
571c4ac87eaSDarren Reed 	pfh = pfil_hook_get(PFIL_OUT, &inetsw[ip_protox[IPPROTO_IP]].pr_pfh);
572fc2ffbe6SPoul-Henning Kamp 	for (; pfh; pfh = TAILQ_NEXT(pfh, pfil_link))
573c4ac87eaSDarren Reed 		if (pfh->pfil_func) {
574c4ac87eaSDarren Reed 			rv = pfh->pfil_func(ip, hlen, ifp, 1, &m1);
575c4ac87eaSDarren Reed 			if (rv) {
576c4ac87eaSDarren Reed 				error = EHOSTUNREACH;
5771ee25934SPeter Wemm 				goto done;
5781ee25934SPeter Wemm 			}
579c4ac87eaSDarren Reed 			m = m1;
580c4ac87eaSDarren Reed 			if (m == NULL)
581c4ac87eaSDarren Reed 				goto done;
582c4ac87eaSDarren Reed 			ip = mtod(m, struct ip *);
583c4ac87eaSDarren Reed 		}
584c4ac87eaSDarren Reed #endif /* PFIL_HOOKS */
585fed1c7e9SSøren Schmidt 
586df8bae1dSRodney W. Grimes 	/*
587e7319babSPoul-Henning Kamp 	 * Check with the firewall...
588e7319babSPoul-Henning Kamp 	 */
5896bc748b0SLuigi Rizzo 	if (fw_enable && ip_fw_chk_ptr) {
5909de9737fSPeter Wemm 		struct sockaddr_in *old = dst;
591b715f178SLuigi Rizzo 
592b715f178SLuigi Rizzo 		off = (*ip_fw_chk_ptr)(&ip,
5938948e4baSArchie Cobbs 		    hlen, ifp, &divert_cookie, &m, &rule, &dst);
594b715f178SLuigi Rizzo                 /*
595b715f178SLuigi Rizzo                  * On return we must do the following:
596507b4b54SLuigi Rizzo                  * m == NULL         -> drop the pkt (old interface, deprecated)
597507b4b54SLuigi Rizzo                  * (off & 0x40000)   -> drop the pkt (new interface)
598b715f178SLuigi Rizzo                  * 1<=off<= 0xffff   -> DIVERT
599b715f178SLuigi Rizzo                  * (off & 0x10000)   -> send to a DUMMYNET pipe
6008948e4baSArchie Cobbs                  * (off & 0x20000)   -> TEE the packet
601b715f178SLuigi Rizzo                  * dst != old        -> IPFIREWALL_FORWARD
602b715f178SLuigi Rizzo                  * off==0, dst==old  -> accept
603b715f178SLuigi Rizzo                  * If some of the above modules is not compiled in, then
604b715f178SLuigi Rizzo                  * we should't have to check the corresponding condition
605b715f178SLuigi Rizzo                  * (because the ipfw control socket should not accept
606b715f178SLuigi Rizzo                  * unsupported rules), but better play safe and drop
607b715f178SLuigi Rizzo                  * packets in case of doubt.
608b715f178SLuigi Rizzo                  */
609507b4b54SLuigi Rizzo 		if (off & IP_FW_PORT_DENY_FLAG) { /* XXX new interface-denied */
610507b4b54SLuigi Rizzo 		    if (m)
611507b4b54SLuigi Rizzo 			m_freem(m);
612507b4b54SLuigi Rizzo 		    error = EACCES ;
613507b4b54SLuigi Rizzo 		    goto done;
614507b4b54SLuigi Rizzo 		}
615b715f178SLuigi Rizzo 		if (!m) { /* firewall said to reject */
616507b4b54SLuigi Rizzo 		    static int __debug=10;
617507b4b54SLuigi Rizzo 		    if (__debug >0) {
618507b4b54SLuigi Rizzo 			printf("firewall returns NULL, please update!\n");
619507b4b54SLuigi Rizzo 			__debug-- ;
620507b4b54SLuigi Rizzo 		    }
621e4676ba6SJulian Elischer 		    error = EACCES;
622e4676ba6SJulian Elischer 		    goto done;
62393e0e116SJulian Elischer 		}
624b715f178SLuigi Rizzo 		if (off == 0 && dst == old) /* common case */
625b715f178SLuigi Rizzo 			goto pass ;
626db69a05dSPaul Saab                 if (ip_dn_io_ptr != NULL && (off & IP_FW_PORT_DYNT_FLAG) != 0) {
627b715f178SLuigi Rizzo                     /*
628b715f178SLuigi Rizzo                      * pass the pkt to dummynet. Need to include
629f0a53591SLuigi Rizzo                      * pipe number, m, ifp, ro, dst because these are
630b715f178SLuigi Rizzo                      * not recomputed in the next pass.
631b715f178SLuigi Rizzo                      * All other parameters have been already used and
632b715f178SLuigi Rizzo                      * so they are not needed anymore.
633b715f178SLuigi Rizzo                      * XXX note: if the ifp or ro entry are deleted
634b715f178SLuigi Rizzo                      * while a pkt is in dummynet, we are in trouble!
635b715f178SLuigi Rizzo                      */
636db69a05dSPaul Saab 		    error = ip_dn_io_ptr(off & 0xffff, DN_TO_IP_OUT, m,
6377a726a2dSLuigi Rizzo 				ifp,ro,dst,rule, flags);
638b715f178SLuigi Rizzo 		    goto done;
639b715f178SLuigi Rizzo 		}
640b715f178SLuigi Rizzo #ifdef IPDIVERT
6418948e4baSArchie Cobbs 		if (off != 0 && (off & IP_FW_PORT_DYNT_FLAG) == 0) {
6428948e4baSArchie Cobbs 			struct mbuf *clone = NULL;
6438948e4baSArchie Cobbs 
6448948e4baSArchie Cobbs 			/* Clone packet if we're doing a 'tee' */
6458948e4baSArchie Cobbs 			if ((off & IP_FW_PORT_TEE_FLAG) != 0)
6468948e4baSArchie Cobbs 				clone = m_dup(m, M_DONTWAIT);
6478948e4baSArchie Cobbs 
648ea53ecd9SJonathan Lemon 			/*
649ea53ecd9SJonathan Lemon 			 * XXX
650ea53ecd9SJonathan Lemon 			 * delayed checksums are not currently compatible
651ea53ecd9SJonathan Lemon 			 * with divert sockets.
652ea53ecd9SJonathan Lemon 			 */
653ea53ecd9SJonathan Lemon 			if (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA) {
654ea53ecd9SJonathan Lemon 				in_delayed_cksum(m);
655ea53ecd9SJonathan Lemon 				m->m_pkthdr.csum_flags &= ~CSUM_DELAY_DATA;
656ea53ecd9SJonathan Lemon 			}
657ea53ecd9SJonathan Lemon 
6588948e4baSArchie Cobbs 			/* Restore packet header fields to original values */
6598948e4baSArchie Cobbs 			HTONS(ip->ip_len);
6608948e4baSArchie Cobbs 			HTONS(ip->ip_off);
6618948e4baSArchie Cobbs 
6628948e4baSArchie Cobbs 			/* Deliver packet to divert input routine */
6638948e4baSArchie Cobbs 			ip_divert_cookie = divert_cookie;
6648948e4baSArchie Cobbs 			divert_packet(m, 0, off & 0xffff);
6658948e4baSArchie Cobbs 
6668948e4baSArchie Cobbs 			/* If 'tee', continue with original packet */
6678948e4baSArchie Cobbs 			if (clone != NULL) {
6688948e4baSArchie Cobbs 				m = clone;
6698948e4baSArchie Cobbs 				ip = mtod(m, struct ip *);
6708948e4baSArchie Cobbs 				goto pass;
6718948e4baSArchie Cobbs 			}
672b715f178SLuigi Rizzo 			goto done;
673b715f178SLuigi Rizzo 		}
674b715f178SLuigi Rizzo #endif
675b715f178SLuigi Rizzo 
676f9e354dfSJulian Elischer #ifdef IPFIREWALL_FORWARD
677f9e354dfSJulian Elischer 		/* Here we check dst to make sure it's directly reachable on the
678f9e354dfSJulian Elischer 		 * interface we previously thought it was.
679f9e354dfSJulian Elischer 		 * If it isn't (which may be likely in some situations) we have
680f9e354dfSJulian Elischer 		 * to re-route it (ie, find a route for the next-hop and the
681f9e354dfSJulian Elischer 		 * associated interface) and set them here. This is nested
682f9e354dfSJulian Elischer 		 * forwarding which in most cases is undesirable, except where
683f9e354dfSJulian Elischer 		 * such control is nigh impossible. So we do it here.
684f9e354dfSJulian Elischer 		 * And I'm babbling.
685f9e354dfSJulian Elischer 		 */
686b715f178SLuigi Rizzo 		if (off == 0 && old != dst) {
687f9e354dfSJulian Elischer 			struct in_ifaddr *ia;
688f9e354dfSJulian Elischer 
689f9e354dfSJulian Elischer 			/* It's changed... */
690f9e354dfSJulian Elischer 			/* There must be a better way to do this next line... */
691f9e354dfSJulian Elischer 			static struct route sro_fwd, *ro_fwd = &sro_fwd;
692f9e354dfSJulian Elischer #ifdef IPFIREWALL_FORWARD_DEBUG
693f9e354dfSJulian Elischer 			printf("IPFIREWALL_FORWARD: New dst ip: ");
694f9e354dfSJulian Elischer 			print_ip(dst->sin_addr);
695f9e354dfSJulian Elischer 			printf("\n");
696f9e354dfSJulian Elischer #endif
697f9e354dfSJulian Elischer 			/*
698f9e354dfSJulian Elischer 			 * We need to figure out if we have been forwarded
699f9e354dfSJulian Elischer 			 * to a local socket. If so then we should somehow
700f9e354dfSJulian Elischer 			 * "loop back" to ip_input, and get directed to the
701f9e354dfSJulian Elischer 			 * PCB as if we had received this packet. This is
702f9e354dfSJulian Elischer 			 * because it may be dificult to identify the packets
703f9e354dfSJulian Elischer 			 * you want to forward until they are being output
704f9e354dfSJulian Elischer 			 * and have selected an interface. (e.g. locally
705f9e354dfSJulian Elischer 			 * initiated packets) If we used the loopback inteface,
706f9e354dfSJulian Elischer 			 * we would not be able to control what happens
707f9e354dfSJulian Elischer 			 * as the packet runs through ip_input() as
708f9e354dfSJulian Elischer 			 * it is done through a ISR.
709f9e354dfSJulian Elischer 			 */
710ca925d9cSJonathan Lemon 			LIST_FOREACH(ia,
711ca925d9cSJonathan Lemon 			    INADDR_HASH(dst->sin_addr.s_addr), ia_hash) {
712f9e354dfSJulian Elischer 				/*
713f9e354dfSJulian Elischer 				 * If the addr to forward to is one
714f9e354dfSJulian Elischer 				 * of ours, we pretend to
715f9e354dfSJulian Elischer 				 * be the destination for this packet.
716f9e354dfSJulian Elischer 				 */
717f9e354dfSJulian Elischer 				if (IA_SIN(ia)->sin_addr.s_addr ==
718f9e354dfSJulian Elischer 						 dst->sin_addr.s_addr)
719f9e354dfSJulian Elischer 					break;
720f9e354dfSJulian Elischer 			}
721f9e354dfSJulian Elischer 			if (ia) {
722f9e354dfSJulian Elischer 				/* tell ip_input "dont filter" */
723f9e354dfSJulian Elischer 				ip_fw_fwd_addr = dst;
724f9e354dfSJulian Elischer 				if (m->m_pkthdr.rcvif == NULL)
725f9e354dfSJulian Elischer 					m->m_pkthdr.rcvif = ifunit("lo0");
72620c822f3SJonathan Lemon 				if (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA) {
72720c822f3SJonathan Lemon 					m->m_pkthdr.csum_flags |=
72820c822f3SJonathan Lemon 					    CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
72920c822f3SJonathan Lemon 					m0->m_pkthdr.csum_data = 0xffff;
73020c822f3SJonathan Lemon 				}
73120c822f3SJonathan Lemon 				m->m_pkthdr.csum_flags |=
73220c822f3SJonathan Lemon 				    CSUM_IP_CHECKED | CSUM_IP_VALID;
73304287599SRuslan Ermilov 				HTONS(ip->ip_len);
73404287599SRuslan Ermilov 				HTONS(ip->ip_off);
735f9e354dfSJulian Elischer 				ip_input(m);
736f9e354dfSJulian Elischer 				goto done;
737f9e354dfSJulian Elischer 			}
738f9e354dfSJulian Elischer 			/* Some of the logic for this was
739f9e354dfSJulian Elischer 			 * nicked from above.
740f9e354dfSJulian Elischer 			 *
741f9e354dfSJulian Elischer 			 * This rewrites the cached route in a local PCB.
742f9e354dfSJulian Elischer 			 * Is this what we want to do?
743f9e354dfSJulian Elischer 			 */
744f9e354dfSJulian Elischer 			bcopy(dst, &ro_fwd->ro_dst, sizeof(*dst));
745f9e354dfSJulian Elischer 
746f9e354dfSJulian Elischer 			ro_fwd->ro_rt = 0;
747f9e354dfSJulian Elischer 			rtalloc_ign(ro_fwd, RTF_PRCLONING);
748f9e354dfSJulian Elischer 
749f9e354dfSJulian Elischer 			if (ro_fwd->ro_rt == 0) {
750f9e354dfSJulian Elischer 				ipstat.ips_noroute++;
751f9e354dfSJulian Elischer 				error = EHOSTUNREACH;
752f9e354dfSJulian Elischer 				goto bad;
753f9e354dfSJulian Elischer 			}
754f9e354dfSJulian Elischer 
755f9e354dfSJulian Elischer 			ia = ifatoia(ro_fwd->ro_rt->rt_ifa);
756f9e354dfSJulian Elischer 			ifp = ro_fwd->ro_rt->rt_ifp;
757f9e354dfSJulian Elischer 			ro_fwd->ro_rt->rt_use++;
758f9e354dfSJulian Elischer 			if (ro_fwd->ro_rt->rt_flags & RTF_GATEWAY)
759f9e354dfSJulian Elischer 				dst = (struct sockaddr_in *)ro_fwd->ro_rt->rt_gateway;
760f9e354dfSJulian Elischer 			if (ro_fwd->ro_rt->rt_flags & RTF_HOST)
761f9e354dfSJulian Elischer 				isbroadcast =
762f9e354dfSJulian Elischer 				    (ro_fwd->ro_rt->rt_flags & RTF_BROADCAST);
763f9e354dfSJulian Elischer 			else
764f9e354dfSJulian Elischer 				isbroadcast = in_broadcast(dst->sin_addr, ifp);
765f9e354dfSJulian Elischer 			RTFREE(ro->ro_rt);
766f9e354dfSJulian Elischer 			ro->ro_rt = ro_fwd->ro_rt;
767f9e354dfSJulian Elischer 			dst = (struct sockaddr_in *)&ro_fwd->ro_dst;
768f9e354dfSJulian Elischer 
769f9e354dfSJulian Elischer 			/*
770f9e354dfSJulian Elischer 			 * If we added a default src ip earlier,
771f9e354dfSJulian Elischer 			 * which would have been gotten from the-then
772f9e354dfSJulian Elischer 			 * interface, do it again, from the new one.
773f9e354dfSJulian Elischer 			 */
774f9e354dfSJulian Elischer 			if (fwd_rewrite_src)
775f9e354dfSJulian Elischer 				ip->ip_src = IA_SIN(ia)->sin_addr;
776b715f178SLuigi Rizzo 			goto pass ;
777f9e354dfSJulian Elischer 		}
778f9e354dfSJulian Elischer #endif /* IPFIREWALL_FORWARD */
779b715f178SLuigi Rizzo                 /*
780b715f178SLuigi Rizzo                  * if we get here, none of the above matches, and
781b715f178SLuigi Rizzo                  * we have to drop the pkt
782b715f178SLuigi Rizzo                  */
783b715f178SLuigi Rizzo 		m_freem(m);
784b715f178SLuigi Rizzo                 error = EACCES; /* not sure this is the right error msg */
785b715f178SLuigi Rizzo                 goto done;
78693e0e116SJulian Elischer 	}
787e7319babSPoul-Henning Kamp 
788b715f178SLuigi Rizzo pass:
789206a3274SRuslan Ermilov 	m->m_pkthdr.csum_flags |= CSUM_IP;
790206a3274SRuslan Ermilov 	sw_csum = m->m_pkthdr.csum_flags & ~ifp->if_hwassist;
791db4f9cc7SJonathan Lemon 	if (sw_csum & CSUM_DELAY_DATA) {
792db4f9cc7SJonathan Lemon 		in_delayed_cksum(m);
793db4f9cc7SJonathan Lemon 		sw_csum &= ~CSUM_DELAY_DATA;
794db4f9cc7SJonathan Lemon 	}
795206a3274SRuslan Ermilov 	m->m_pkthdr.csum_flags &= ifp->if_hwassist;
796db4f9cc7SJonathan Lemon 
797e7319babSPoul-Henning Kamp 	/*
798db4f9cc7SJonathan Lemon 	 * If small enough for interface, or the interface will take
799db4f9cc7SJonathan Lemon 	 * care of the fragmentation for us, can just send directly.
800df8bae1dSRodney W. Grimes 	 */
801db4f9cc7SJonathan Lemon 	if ((u_short)ip->ip_len <= ifp->if_mtu ||
802db4f9cc7SJonathan Lemon 	    ifp->if_hwassist & CSUM_FRAGMENT) {
80304287599SRuslan Ermilov 		HTONS(ip->ip_len);
80404287599SRuslan Ermilov 		HTONS(ip->ip_off);
805df8bae1dSRodney W. Grimes 		ip->ip_sum = 0;
806db4f9cc7SJonathan Lemon 		if (sw_csum & CSUM_DELAY_IP) {
8079c9137eaSGarrett Wollman 			if (ip->ip_vhl == IP_VHL_BORING) {
8089c9137eaSGarrett Wollman 				ip->ip_sum = in_cksum_hdr(ip);
8099c9137eaSGarrett Wollman 			} else {
810df8bae1dSRodney W. Grimes 				ip->ip_sum = in_cksum(m, hlen);
8119c9137eaSGarrett Wollman 			}
812db4f9cc7SJonathan Lemon 		}
8135da9f8faSJosef Karthauser 
8145da9f8faSJosef Karthauser 		/* Record statistics for this interface address. */
81538c1bc35SRuslan Ermilov 		if (!(flags & IP_FORWARDING) && ia) {
8165da9f8faSJosef Karthauser 			ia->ia_ifa.if_opackets++;
8175da9f8faSJosef Karthauser 			ia->ia_ifa.if_obytes += m->m_pkthdr.len;
8185da9f8faSJosef Karthauser 		}
8195da9f8faSJosef Karthauser 
82033841545SHajimu UMEMOTO #ifdef IPSEC
82133841545SHajimu UMEMOTO 		/* clean ipsec history once it goes out of the node */
82233841545SHajimu UMEMOTO 		ipsec_delaux(m);
82333841545SHajimu UMEMOTO #endif
82433841545SHajimu UMEMOTO 
825df8bae1dSRodney W. Grimes 		error = (*ifp->if_output)(ifp, m,
826df8bae1dSRodney W. Grimes 				(struct sockaddr *)dst, ro->ro_rt);
827df8bae1dSRodney W. Grimes 		goto done;
828df8bae1dSRodney W. Grimes 	}
829df8bae1dSRodney W. Grimes 	/*
830df8bae1dSRodney W. Grimes 	 * Too large for interface; fragment if possible.
831df8bae1dSRodney W. Grimes 	 * Must be able to put at least 8 bytes per fragment.
832df8bae1dSRodney W. Grimes 	 */
833df8bae1dSRodney W. Grimes 	if (ip->ip_off & IP_DF) {
834df8bae1dSRodney W. Grimes 		error = EMSGSIZE;
8353d1f141bSGarrett Wollman 		/*
8363d1f141bSGarrett Wollman 		 * This case can happen if the user changed the MTU
8373d1f141bSGarrett Wollman 		 * of an interface after enabling IP on it.  Because
8383d1f141bSGarrett Wollman 		 * most netifs don't keep track of routes pointing to
8393d1f141bSGarrett Wollman 		 * them, there is no way for one to update all its
8403d1f141bSGarrett Wollman 		 * routes when the MTU is changed.
8413d1f141bSGarrett Wollman 		 */
8423d1f141bSGarrett Wollman 		if ((ro->ro_rt->rt_flags & (RTF_UP | RTF_HOST))
8433d1f141bSGarrett Wollman 		    && !(ro->ro_rt->rt_rmx.rmx_locks & RTV_MTU)
8443d1f141bSGarrett Wollman 		    && (ro->ro_rt->rt_rmx.rmx_mtu > ifp->if_mtu)) {
8453d1f141bSGarrett Wollman 			ro->ro_rt->rt_rmx.rmx_mtu = ifp->if_mtu;
8463d1f141bSGarrett Wollman 		}
847df8bae1dSRodney W. Grimes 		ipstat.ips_cantfrag++;
848df8bae1dSRodney W. Grimes 		goto bad;
849df8bae1dSRodney W. Grimes 	}
850df8bae1dSRodney W. Grimes 	len = (ifp->if_mtu - hlen) &~ 7;
851df8bae1dSRodney W. Grimes 	if (len < 8) {
852df8bae1dSRodney W. Grimes 		error = EMSGSIZE;
853df8bae1dSRodney W. Grimes 		goto bad;
854df8bae1dSRodney W. Grimes 	}
855df8bae1dSRodney W. Grimes 
856db4f9cc7SJonathan Lemon 	/*
857db4f9cc7SJonathan Lemon 	 * if the interface will not calculate checksums on
858db4f9cc7SJonathan Lemon 	 * fragmented packets, then do it here.
859db4f9cc7SJonathan Lemon 	 */
860db4f9cc7SJonathan Lemon 	if (m->m_pkthdr.csum_flags & CSUM_DELAY_DATA &&
861db4f9cc7SJonathan Lemon 	    (ifp->if_hwassist & CSUM_IP_FRAGS) == 0) {
862db4f9cc7SJonathan Lemon 		in_delayed_cksum(m);
863db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_flags &= ~CSUM_DELAY_DATA;
864db4f9cc7SJonathan Lemon 	}
865db4f9cc7SJonathan Lemon 
866df8bae1dSRodney W. Grimes     {
867df8bae1dSRodney W. Grimes 	int mhlen, firstlen = len;
868df8bae1dSRodney W. Grimes 	struct mbuf **mnext = &m->m_nextpkt;
869db4f9cc7SJonathan Lemon 	int nfrags = 1;
870df8bae1dSRodney W. Grimes 
871df8bae1dSRodney W. Grimes 	/*
872df8bae1dSRodney W. Grimes 	 * Loop through length of segment after first fragment,
873df8bae1dSRodney W. Grimes 	 * make new header and copy data of each part and link onto chain.
874df8bae1dSRodney W. Grimes 	 */
875df8bae1dSRodney W. Grimes 	m0 = m;
876df8bae1dSRodney W. Grimes 	mhlen = sizeof (struct ip);
877df8bae1dSRodney W. Grimes 	for (off = hlen + len; off < (u_short)ip->ip_len; off += len) {
878df8bae1dSRodney W. Grimes 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
879df8bae1dSRodney W. Grimes 		if (m == 0) {
880df8bae1dSRodney W. Grimes 			error = ENOBUFS;
881df8bae1dSRodney W. Grimes 			ipstat.ips_odropped++;
882df8bae1dSRodney W. Grimes 			goto sendorfree;
883df8bae1dSRodney W. Grimes 		}
884db4f9cc7SJonathan Lemon 		m->m_flags |= (m0->m_flags & M_MCAST) | M_FRAG;
885df8bae1dSRodney W. Grimes 		m->m_data += max_linkhdr;
886df8bae1dSRodney W. Grimes 		mhip = mtod(m, struct ip *);
887df8bae1dSRodney W. Grimes 		*mhip = *ip;
888df8bae1dSRodney W. Grimes 		if (hlen > sizeof (struct ip)) {
889df8bae1dSRodney W. Grimes 			mhlen = ip_optcopy(ip, mhip) + sizeof (struct ip);
8909c9137eaSGarrett Wollman 			mhip->ip_vhl = IP_MAKE_VHL(IPVERSION, mhlen >> 2);
891df8bae1dSRodney W. Grimes 		}
892df8bae1dSRodney W. Grimes 		m->m_len = mhlen;
893cc22c7a7SRuslan Ermilov 		mhip->ip_off = ((off - hlen) >> 3) + ip->ip_off;
894df8bae1dSRodney W. Grimes 		if (off + len >= (u_short)ip->ip_len)
895df8bae1dSRodney W. Grimes 			len = (u_short)ip->ip_len - off;
896df8bae1dSRodney W. Grimes 		else
897df8bae1dSRodney W. Grimes 			mhip->ip_off |= IP_MF;
898df8bae1dSRodney W. Grimes 		mhip->ip_len = htons((u_short)(len + mhlen));
899df8bae1dSRodney W. Grimes 		m->m_next = m_copy(m0, off, len);
900df8bae1dSRodney W. Grimes 		if (m->m_next == 0) {
901df8bae1dSRodney W. Grimes 			(void) m_free(m);
902df8bae1dSRodney W. Grimes 			error = ENOBUFS;	/* ??? */
903df8bae1dSRodney W. Grimes 			ipstat.ips_odropped++;
904df8bae1dSRodney W. Grimes 			goto sendorfree;
905df8bae1dSRodney W. Grimes 		}
906df8bae1dSRodney W. Grimes 		m->m_pkthdr.len = mhlen + len;
907df8bae1dSRodney W. Grimes 		m->m_pkthdr.rcvif = (struct ifnet *)0;
908db4f9cc7SJonathan Lemon 		m->m_pkthdr.csum_flags = m0->m_pkthdr.csum_flags;
90904287599SRuslan Ermilov 		HTONS(mhip->ip_off);
910df8bae1dSRodney W. Grimes 		mhip->ip_sum = 0;
911db4f9cc7SJonathan Lemon 		if (sw_csum & CSUM_DELAY_IP) {
9129c9137eaSGarrett Wollman 			if (mhip->ip_vhl == IP_VHL_BORING) {
913e2184122SBruce Evans 				mhip->ip_sum = in_cksum_hdr(mhip);
9149c9137eaSGarrett Wollman 			} else {
915df8bae1dSRodney W. Grimes 				mhip->ip_sum = in_cksum(m, mhlen);
9169c9137eaSGarrett Wollman 			}
917db4f9cc7SJonathan Lemon 		}
918df8bae1dSRodney W. Grimes 		*mnext = m;
919df8bae1dSRodney W. Grimes 		mnext = &m->m_nextpkt;
920db4f9cc7SJonathan Lemon 		nfrags++;
921df8bae1dSRodney W. Grimes 	}
922db4f9cc7SJonathan Lemon 	ipstat.ips_ofragments += nfrags;
923db4f9cc7SJonathan Lemon 
924db4f9cc7SJonathan Lemon 	/* set first/last markers for fragment chain */
925db4f9cc7SJonathan Lemon 	m->m_flags |= M_LASTFRAG;
926db4f9cc7SJonathan Lemon 	m0->m_flags |= M_FIRSTFRAG | M_FRAG;
927db4f9cc7SJonathan Lemon 	m0->m_pkthdr.csum_data = nfrags;
928db4f9cc7SJonathan Lemon 
929df8bae1dSRodney W. Grimes 	/*
930df8bae1dSRodney W. Grimes 	 * Update first fragment by trimming what's been copied out
931df8bae1dSRodney W. Grimes 	 * and updating header, then send each fragment (in order).
932df8bae1dSRodney W. Grimes 	 */
933df8bae1dSRodney W. Grimes 	m = m0;
934df8bae1dSRodney W. Grimes 	m_adj(m, hlen + firstlen - (u_short)ip->ip_len);
935df8bae1dSRodney W. Grimes 	m->m_pkthdr.len = hlen + firstlen;
936df8bae1dSRodney W. Grimes 	ip->ip_len = htons((u_short)m->m_pkthdr.len);
93704287599SRuslan Ermilov 	ip->ip_off |= IP_MF;
93804287599SRuslan Ermilov 	HTONS(ip->ip_off);
939df8bae1dSRodney W. Grimes 	ip->ip_sum = 0;
940db4f9cc7SJonathan Lemon 	if (sw_csum & CSUM_DELAY_IP) {
9419c9137eaSGarrett Wollman 		if (ip->ip_vhl == IP_VHL_BORING) {
9429c9137eaSGarrett Wollman 			ip->ip_sum = in_cksum_hdr(ip);
9439c9137eaSGarrett Wollman 		} else {
944df8bae1dSRodney W. Grimes 			ip->ip_sum = in_cksum(m, hlen);
9459c9137eaSGarrett Wollman 		}
946db4f9cc7SJonathan Lemon 	}
947df8bae1dSRodney W. Grimes sendorfree:
948df8bae1dSRodney W. Grimes 	for (m = m0; m; m = m0) {
949df8bae1dSRodney W. Grimes 		m0 = m->m_nextpkt;
950df8bae1dSRodney W. Grimes 		m->m_nextpkt = 0;
95133841545SHajimu UMEMOTO #ifdef IPSEC
95233841545SHajimu UMEMOTO 		/* clean ipsec history once it goes out of the node */
95333841545SHajimu UMEMOTO 		ipsec_delaux(m);
95433841545SHajimu UMEMOTO #endif
95507203494SDaniel C. Sobral 		if (error == 0) {
956fe937674SJosef Karthauser 			/* Record statistics for this interface address. */
95707203494SDaniel C. Sobral 			if (ia != NULL) {
958fe937674SJosef Karthauser 				ia->ia_ifa.if_opackets++;
959fe937674SJosef Karthauser 				ia->ia_ifa.if_obytes += m->m_pkthdr.len;
96007203494SDaniel C. Sobral 			}
961fe937674SJosef Karthauser 
962df8bae1dSRodney W. Grimes 			error = (*ifp->if_output)(ifp, m,
963df8bae1dSRodney W. Grimes 			    (struct sockaddr *)dst, ro->ro_rt);
964fe937674SJosef Karthauser 		} else
965df8bae1dSRodney W. Grimes 			m_freem(m);
966df8bae1dSRodney W. Grimes 	}
967df8bae1dSRodney W. Grimes 
968df8bae1dSRodney W. Grimes 	if (error == 0)
969df8bae1dSRodney W. Grimes 		ipstat.ips_fragmented++;
970df8bae1dSRodney W. Grimes     }
971df8bae1dSRodney W. Grimes done:
9726a800098SYoshinobu Inoue #ifdef IPSEC
9736a800098SYoshinobu Inoue 	if (ro == &iproute && ro->ro_rt) {
9746a800098SYoshinobu Inoue 		RTFREE(ro->ro_rt);
9756a800098SYoshinobu Inoue 		ro->ro_rt = NULL;
9766a800098SYoshinobu Inoue 	}
9776a800098SYoshinobu Inoue 	if (sp != NULL) {
9786a800098SYoshinobu Inoue 		KEYDEBUG(KEYDEBUG_IPSEC_STAMP,
9796a800098SYoshinobu Inoue 			printf("DP ip_output call free SP:%p\n", sp));
9806a800098SYoshinobu Inoue 		key_freesp(sp);
9816a800098SYoshinobu Inoue 	}
9826a800098SYoshinobu Inoue #endif /* IPSEC */
983df8bae1dSRodney W. Grimes 	return (error);
984df8bae1dSRodney W. Grimes bad:
9853528d68fSBill Paul 	m_freem(m);
986df8bae1dSRodney W. Grimes 	goto done;
987df8bae1dSRodney W. Grimes }
988df8bae1dSRodney W. Grimes 
9891c238475SJonathan Lemon void
990db4f9cc7SJonathan Lemon in_delayed_cksum(struct mbuf *m)
991db4f9cc7SJonathan Lemon {
992db4f9cc7SJonathan Lemon 	struct ip *ip;
993db4f9cc7SJonathan Lemon 	u_short csum, offset;
994db4f9cc7SJonathan Lemon 
995db4f9cc7SJonathan Lemon 	ip = mtod(m, struct ip *);
996db4f9cc7SJonathan Lemon 	offset = IP_VHL_HL(ip->ip_vhl) << 2 ;
997db4f9cc7SJonathan Lemon 	csum = in_cksum_skip(m, ip->ip_len, offset);
998206a3274SRuslan Ermilov 	if (m->m_pkthdr.csum_flags & CSUM_UDP && csum == 0)
999206a3274SRuslan Ermilov 		csum = 0xffff;
1000db4f9cc7SJonathan Lemon 	offset += m->m_pkthdr.csum_data;	/* checksum offset */
1001db4f9cc7SJonathan Lemon 
1002db4f9cc7SJonathan Lemon 	if (offset + sizeof(u_short) > m->m_len) {
1003db4f9cc7SJonathan Lemon 		printf("delayed m_pullup, m->len: %d  off: %d  p: %d\n",
1004db4f9cc7SJonathan Lemon 		    m->m_len, offset, ip->ip_p);
1005db4f9cc7SJonathan Lemon 		/*
1006db4f9cc7SJonathan Lemon 		 * XXX
1007db4f9cc7SJonathan Lemon 		 * this shouldn't happen, but if it does, the
1008db4f9cc7SJonathan Lemon 		 * correct behavior may be to insert the checksum
1009db4f9cc7SJonathan Lemon 		 * in the existing chain instead of rearranging it.
1010db4f9cc7SJonathan Lemon 		 */
1011db4f9cc7SJonathan Lemon 		m = m_pullup(m, offset + sizeof(u_short));
1012db4f9cc7SJonathan Lemon 	}
1013db4f9cc7SJonathan Lemon 	*(u_short *)(m->m_data + offset) = csum;
1014db4f9cc7SJonathan Lemon }
1015db4f9cc7SJonathan Lemon 
1016df8bae1dSRodney W. Grimes /*
1017df8bae1dSRodney W. Grimes  * Insert IP options into preformed packet.
1018df8bae1dSRodney W. Grimes  * Adjust IP destination as required for IP source routing,
1019df8bae1dSRodney W. Grimes  * as indicated by a non-zero in_addr at the start of the options.
1020072b9b24SPaul Traina  *
1021072b9b24SPaul Traina  * XXX This routine assumes that the packet has no options in place.
1022df8bae1dSRodney W. Grimes  */
1023df8bae1dSRodney W. Grimes static struct mbuf *
1024df8bae1dSRodney W. Grimes ip_insertoptions(m, opt, phlen)
1025df8bae1dSRodney W. Grimes 	register struct mbuf *m;
1026df8bae1dSRodney W. Grimes 	struct mbuf *opt;
1027df8bae1dSRodney W. Grimes 	int *phlen;
1028df8bae1dSRodney W. Grimes {
1029df8bae1dSRodney W. Grimes 	register struct ipoption *p = mtod(opt, struct ipoption *);
1030df8bae1dSRodney W. Grimes 	struct mbuf *n;
1031df8bae1dSRodney W. Grimes 	register struct ip *ip = mtod(m, struct ip *);
1032df8bae1dSRodney W. Grimes 	unsigned optlen;
1033df8bae1dSRodney W. Grimes 
1034df8bae1dSRodney W. Grimes 	optlen = opt->m_len - sizeof(p->ipopt_dst);
1035df8bae1dSRodney W. Grimes 	if (optlen + (u_short)ip->ip_len > IP_MAXPACKET)
1036df8bae1dSRodney W. Grimes 		return (m);		/* XXX should fail */
1037df8bae1dSRodney W. Grimes 	if (p->ipopt_dst.s_addr)
1038df8bae1dSRodney W. Grimes 		ip->ip_dst = p->ipopt_dst;
1039df8bae1dSRodney W. Grimes 	if (m->m_flags & M_EXT || m->m_data - optlen < m->m_pktdat) {
1040df8bae1dSRodney W. Grimes 		MGETHDR(n, M_DONTWAIT, MT_HEADER);
1041df8bae1dSRodney W. Grimes 		if (n == 0)
1042df8bae1dSRodney W. Grimes 			return (m);
10435db1e34eSRuslan Ermilov 		n->m_pkthdr.rcvif = (struct ifnet *)0;
1044df8bae1dSRodney W. Grimes 		n->m_pkthdr.len = m->m_pkthdr.len + optlen;
1045df8bae1dSRodney W. Grimes 		m->m_len -= sizeof(struct ip);
1046df8bae1dSRodney W. Grimes 		m->m_data += sizeof(struct ip);
1047df8bae1dSRodney W. Grimes 		n->m_next = m;
1048df8bae1dSRodney W. Grimes 		m = n;
1049df8bae1dSRodney W. Grimes 		m->m_len = optlen + sizeof(struct ip);
1050df8bae1dSRodney W. Grimes 		m->m_data += max_linkhdr;
105194a5d9b6SDavid Greenman 		(void)memcpy(mtod(m, void *), ip, sizeof(struct ip));
1052df8bae1dSRodney W. Grimes 	} else {
1053df8bae1dSRodney W. Grimes 		m->m_data -= optlen;
1054df8bae1dSRodney W. Grimes 		m->m_len += optlen;
1055df8bae1dSRodney W. Grimes 		m->m_pkthdr.len += optlen;
1056df8bae1dSRodney W. Grimes 		ovbcopy((caddr_t)ip, mtod(m, caddr_t), sizeof(struct ip));
1057df8bae1dSRodney W. Grimes 	}
1058df8bae1dSRodney W. Grimes 	ip = mtod(m, struct ip *);
10590453d3cbSBruce Evans 	bcopy(p->ipopt_list, ip + 1, optlen);
1060df8bae1dSRodney W. Grimes 	*phlen = sizeof(struct ip) + optlen;
10619c9137eaSGarrett Wollman 	ip->ip_vhl = IP_MAKE_VHL(IPVERSION, *phlen >> 2);
1062df8bae1dSRodney W. Grimes 	ip->ip_len += optlen;
1063df8bae1dSRodney W. Grimes 	return (m);
1064df8bae1dSRodney W. Grimes }
1065df8bae1dSRodney W. Grimes 
1066df8bae1dSRodney W. Grimes /*
1067df8bae1dSRodney W. Grimes  * Copy options from ip to jp,
1068df8bae1dSRodney W. Grimes  * omitting those not copied during fragmentation.
1069df8bae1dSRodney W. Grimes  */
1070beec8214SDarren Reed int
1071df8bae1dSRodney W. Grimes ip_optcopy(ip, jp)
1072df8bae1dSRodney W. Grimes 	struct ip *ip, *jp;
1073df8bae1dSRodney W. Grimes {
1074df8bae1dSRodney W. Grimes 	register u_char *cp, *dp;
1075df8bae1dSRodney W. Grimes 	int opt, optlen, cnt;
1076df8bae1dSRodney W. Grimes 
1077df8bae1dSRodney W. Grimes 	cp = (u_char *)(ip + 1);
1078df8bae1dSRodney W. Grimes 	dp = (u_char *)(jp + 1);
10799c9137eaSGarrett Wollman 	cnt = (IP_VHL_HL(ip->ip_vhl) << 2) - sizeof (struct ip);
1080df8bae1dSRodney W. Grimes 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
1081df8bae1dSRodney W. Grimes 		opt = cp[0];
1082df8bae1dSRodney W. Grimes 		if (opt == IPOPT_EOL)
1083df8bae1dSRodney W. Grimes 			break;
1084df8bae1dSRodney W. Grimes 		if (opt == IPOPT_NOP) {
1085df8bae1dSRodney W. Grimes 			/* Preserve for IP mcast tunnel's LSRR alignment. */
1086df8bae1dSRodney W. Grimes 			*dp++ = IPOPT_NOP;
1087df8bae1dSRodney W. Grimes 			optlen = 1;
1088df8bae1dSRodney W. Grimes 			continue;
1089686cdd19SJun-ichiro itojun Hagino 		}
1090686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC
1091686cdd19SJun-ichiro itojun Hagino 		if (cnt < IPOPT_OLEN + sizeof(*cp))
1092686cdd19SJun-ichiro itojun Hagino 			panic("malformed IPv4 option passed to ip_optcopy");
1093686cdd19SJun-ichiro itojun Hagino #endif
1094df8bae1dSRodney W. Grimes 		optlen = cp[IPOPT_OLEN];
1095686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC
1096686cdd19SJun-ichiro itojun Hagino 		if (optlen < IPOPT_OLEN + sizeof(*cp) || optlen > cnt)
1097686cdd19SJun-ichiro itojun Hagino 			panic("malformed IPv4 option passed to ip_optcopy");
1098686cdd19SJun-ichiro itojun Hagino #endif
1099df8bae1dSRodney W. Grimes 		/* bogus lengths should have been caught by ip_dooptions */
1100df8bae1dSRodney W. Grimes 		if (optlen > cnt)
1101df8bae1dSRodney W. Grimes 			optlen = cnt;
1102df8bae1dSRodney W. Grimes 		if (IPOPT_COPIED(opt)) {
11030453d3cbSBruce Evans 			bcopy(cp, dp, optlen);
1104df8bae1dSRodney W. Grimes 			dp += optlen;
1105df8bae1dSRodney W. Grimes 		}
1106df8bae1dSRodney W. Grimes 	}
1107df8bae1dSRodney W. Grimes 	for (optlen = dp - (u_char *)(jp+1); optlen & 0x3; optlen++)
1108df8bae1dSRodney W. Grimes 		*dp++ = IPOPT_EOL;
1109df8bae1dSRodney W. Grimes 	return (optlen);
1110df8bae1dSRodney W. Grimes }
1111df8bae1dSRodney W. Grimes 
1112df8bae1dSRodney W. Grimes /*
1113df8bae1dSRodney W. Grimes  * IP socket option processing.
1114df8bae1dSRodney W. Grimes  */
1115df8bae1dSRodney W. Grimes int
1116cfe8b629SGarrett Wollman ip_ctloutput(so, sopt)
1117df8bae1dSRodney W. Grimes 	struct socket *so;
1118cfe8b629SGarrett Wollman 	struct sockopt *sopt;
1119df8bae1dSRodney W. Grimes {
1120cfe8b629SGarrett Wollman 	struct	inpcb *inp = sotoinpcb(so);
1121cfe8b629SGarrett Wollman 	int	error, optval;
1122df8bae1dSRodney W. Grimes 
1123cfe8b629SGarrett Wollman 	error = optval = 0;
1124cfe8b629SGarrett Wollman 	if (sopt->sopt_level != IPPROTO_IP) {
1125cfe8b629SGarrett Wollman 		return (EINVAL);
1126cfe8b629SGarrett Wollman 	}
1127df8bae1dSRodney W. Grimes 
1128cfe8b629SGarrett Wollman 	switch (sopt->sopt_dir) {
1129cfe8b629SGarrett Wollman 	case SOPT_SET:
1130cfe8b629SGarrett Wollman 		switch (sopt->sopt_name) {
1131df8bae1dSRodney W. Grimes 		case IP_OPTIONS:
1132df8bae1dSRodney W. Grimes #ifdef notyet
1133df8bae1dSRodney W. Grimes 		case IP_RETOPTS:
1134df8bae1dSRodney W. Grimes #endif
1135cfe8b629SGarrett Wollman 		{
1136cfe8b629SGarrett Wollman 			struct mbuf *m;
1137cfe8b629SGarrett Wollman 			if (sopt->sopt_valsize > MLEN) {
1138cfe8b629SGarrett Wollman 				error = EMSGSIZE;
1139cfe8b629SGarrett Wollman 				break;
1140cfe8b629SGarrett Wollman 			}
1141b40ce416SJulian Elischer 			MGET(m, sopt->sopt_td ? M_TRYWAIT : M_DONTWAIT, MT_HEADER);
1142cfe8b629SGarrett Wollman 			if (m == 0) {
1143cfe8b629SGarrett Wollman 				error = ENOBUFS;
1144cfe8b629SGarrett Wollman 				break;
1145cfe8b629SGarrett Wollman 			}
1146cfe8b629SGarrett Wollman 			m->m_len = sopt->sopt_valsize;
1147cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, mtod(m, char *), m->m_len,
1148cfe8b629SGarrett Wollman 					    m->m_len);
1149cfe8b629SGarrett Wollman 
1150cfe8b629SGarrett Wollman 			return (ip_pcbopts(sopt->sopt_name, &inp->inp_options,
1151cfe8b629SGarrett Wollman 					   m));
1152cfe8b629SGarrett Wollman 		}
1153df8bae1dSRodney W. Grimes 
1154df8bae1dSRodney W. Grimes 		case IP_TOS:
1155df8bae1dSRodney W. Grimes 		case IP_TTL:
1156df8bae1dSRodney W. Grimes 		case IP_RECVOPTS:
1157df8bae1dSRodney W. Grimes 		case IP_RECVRETOPTS:
1158df8bae1dSRodney W. Grimes 		case IP_RECVDSTADDR:
115982c23ebaSBill Fenner 		case IP_RECVIF:
11606a800098SYoshinobu Inoue 		case IP_FAITH:
1161cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &optval, sizeof optval,
1162cfe8b629SGarrett Wollman 					    sizeof optval);
1163cfe8b629SGarrett Wollman 			if (error)
1164cfe8b629SGarrett Wollman 				break;
1165df8bae1dSRodney W. Grimes 
1166cfe8b629SGarrett Wollman 			switch (sopt->sopt_name) {
1167df8bae1dSRodney W. Grimes 			case IP_TOS:
1168ca98b82cSDavid Greenman 				inp->inp_ip_tos = optval;
1169df8bae1dSRodney W. Grimes 				break;
1170df8bae1dSRodney W. Grimes 
1171df8bae1dSRodney W. Grimes 			case IP_TTL:
1172ca98b82cSDavid Greenman 				inp->inp_ip_ttl = optval;
1173df8bae1dSRodney W. Grimes 				break;
1174df8bae1dSRodney W. Grimes #define	OPTSET(bit) \
1175df8bae1dSRodney W. Grimes 	if (optval) \
1176df8bae1dSRodney W. Grimes 		inp->inp_flags |= bit; \
1177df8bae1dSRodney W. Grimes 	else \
1178df8bae1dSRodney W. Grimes 		inp->inp_flags &= ~bit;
1179df8bae1dSRodney W. Grimes 
1180df8bae1dSRodney W. Grimes 			case IP_RECVOPTS:
1181df8bae1dSRodney W. Grimes 				OPTSET(INP_RECVOPTS);
1182df8bae1dSRodney W. Grimes 				break;
1183df8bae1dSRodney W. Grimes 
1184df8bae1dSRodney W. Grimes 			case IP_RECVRETOPTS:
1185df8bae1dSRodney W. Grimes 				OPTSET(INP_RECVRETOPTS);
1186df8bae1dSRodney W. Grimes 				break;
1187df8bae1dSRodney W. Grimes 
1188df8bae1dSRodney W. Grimes 			case IP_RECVDSTADDR:
1189df8bae1dSRodney W. Grimes 				OPTSET(INP_RECVDSTADDR);
1190df8bae1dSRodney W. Grimes 				break;
119182c23ebaSBill Fenner 
119282c23ebaSBill Fenner 			case IP_RECVIF:
119382c23ebaSBill Fenner 				OPTSET(INP_RECVIF);
119482c23ebaSBill Fenner 				break;
11956a800098SYoshinobu Inoue 
11966a800098SYoshinobu Inoue 			case IP_FAITH:
11976a800098SYoshinobu Inoue 				OPTSET(INP_FAITH);
11986a800098SYoshinobu Inoue 				break;
1199df8bae1dSRodney W. Grimes 			}
1200df8bae1dSRodney W. Grimes 			break;
1201df8bae1dSRodney W. Grimes #undef OPTSET
1202df8bae1dSRodney W. Grimes 
1203df8bae1dSRodney W. Grimes 		case IP_MULTICAST_IF:
1204f0068c4aSGarrett Wollman 		case IP_MULTICAST_VIF:
1205df8bae1dSRodney W. Grimes 		case IP_MULTICAST_TTL:
1206df8bae1dSRodney W. Grimes 		case IP_MULTICAST_LOOP:
1207df8bae1dSRodney W. Grimes 		case IP_ADD_MEMBERSHIP:
1208df8bae1dSRodney W. Grimes 		case IP_DROP_MEMBERSHIP:
1209cfe8b629SGarrett Wollman 			error = ip_setmoptions(sopt, &inp->inp_moptions);
1210df8bae1dSRodney W. Grimes 			break;
1211df8bae1dSRodney W. Grimes 
121233b3ac06SPeter Wemm 		case IP_PORTRANGE:
1213cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &optval, sizeof optval,
1214cfe8b629SGarrett Wollman 					    sizeof optval);
1215cfe8b629SGarrett Wollman 			if (error)
1216cfe8b629SGarrett Wollman 				break;
121733b3ac06SPeter Wemm 
121833b3ac06SPeter Wemm 			switch (optval) {
121933b3ac06SPeter Wemm 			case IP_PORTRANGE_DEFAULT:
122033b3ac06SPeter Wemm 				inp->inp_flags &= ~(INP_LOWPORT);
122133b3ac06SPeter Wemm 				inp->inp_flags &= ~(INP_HIGHPORT);
122233b3ac06SPeter Wemm 				break;
122333b3ac06SPeter Wemm 
122433b3ac06SPeter Wemm 			case IP_PORTRANGE_HIGH:
122533b3ac06SPeter Wemm 				inp->inp_flags &= ~(INP_LOWPORT);
122633b3ac06SPeter Wemm 				inp->inp_flags |= INP_HIGHPORT;
122733b3ac06SPeter Wemm 				break;
122833b3ac06SPeter Wemm 
122933b3ac06SPeter Wemm 			case IP_PORTRANGE_LOW:
123033b3ac06SPeter Wemm 				inp->inp_flags &= ~(INP_HIGHPORT);
123133b3ac06SPeter Wemm 				inp->inp_flags |= INP_LOWPORT;
123233b3ac06SPeter Wemm 				break;
123333b3ac06SPeter Wemm 
123433b3ac06SPeter Wemm 			default:
123533b3ac06SPeter Wemm 				error = EINVAL;
123633b3ac06SPeter Wemm 				break;
123733b3ac06SPeter Wemm 			}
1238ce8c72b1SPeter Wemm 			break;
123933b3ac06SPeter Wemm 
12406a800098SYoshinobu Inoue #ifdef IPSEC
12416a800098SYoshinobu Inoue 		case IP_IPSEC_POLICY:
12426a800098SYoshinobu Inoue 		{
12436a800098SYoshinobu Inoue 			caddr_t req;
1244686cdd19SJun-ichiro itojun Hagino 			size_t len = 0;
12456a800098SYoshinobu Inoue 			int priv;
12466a800098SYoshinobu Inoue 			struct mbuf *m;
12476a800098SYoshinobu Inoue 			int optname;
12486a800098SYoshinobu Inoue 
12496a800098SYoshinobu Inoue 			if ((error = soopt_getm(sopt, &m)) != 0) /* XXX */
12506a800098SYoshinobu Inoue 				break;
12516a800098SYoshinobu Inoue 			if ((error = soopt_mcopyin(sopt, m)) != 0) /* XXX */
12526a800098SYoshinobu Inoue 				break;
1253b40ce416SJulian Elischer 			priv = (sopt->sopt_td != NULL &&
1254b40ce416SJulian Elischer 				suser_td(sopt->sopt_td) != 0) ? 0 : 1;
12556a800098SYoshinobu Inoue 			req = mtod(m, caddr_t);
1256686cdd19SJun-ichiro itojun Hagino 			len = m->m_len;
12576a800098SYoshinobu Inoue 			optname = sopt->sopt_name;
1258686cdd19SJun-ichiro itojun Hagino 			error = ipsec4_set_policy(inp, optname, req, len, priv);
12596a800098SYoshinobu Inoue 			m_freem(m);
12606a800098SYoshinobu Inoue 			break;
12616a800098SYoshinobu Inoue 		}
12626a800098SYoshinobu Inoue #endif /*IPSEC*/
12636a800098SYoshinobu Inoue 
1264df8bae1dSRodney W. Grimes 		default:
1265df8bae1dSRodney W. Grimes 			error = ENOPROTOOPT;
1266df8bae1dSRodney W. Grimes 			break;
1267df8bae1dSRodney W. Grimes 		}
1268df8bae1dSRodney W. Grimes 		break;
1269df8bae1dSRodney W. Grimes 
1270cfe8b629SGarrett Wollman 	case SOPT_GET:
1271cfe8b629SGarrett Wollman 		switch (sopt->sopt_name) {
1272df8bae1dSRodney W. Grimes 		case IP_OPTIONS:
1273df8bae1dSRodney W. Grimes 		case IP_RETOPTS:
1274cfe8b629SGarrett Wollman 			if (inp->inp_options)
1275cfe8b629SGarrett Wollman 				error = sooptcopyout(sopt,
1276cfe8b629SGarrett Wollman 						     mtod(inp->inp_options,
1277cfe8b629SGarrett Wollman 							  char *),
1278cfe8b629SGarrett Wollman 						     inp->inp_options->m_len);
1279cfe8b629SGarrett Wollman 			else
1280cfe8b629SGarrett Wollman 				sopt->sopt_valsize = 0;
1281df8bae1dSRodney W. Grimes 			break;
1282df8bae1dSRodney W. Grimes 
1283df8bae1dSRodney W. Grimes 		case IP_TOS:
1284df8bae1dSRodney W. Grimes 		case IP_TTL:
1285df8bae1dSRodney W. Grimes 		case IP_RECVOPTS:
1286df8bae1dSRodney W. Grimes 		case IP_RECVRETOPTS:
1287df8bae1dSRodney W. Grimes 		case IP_RECVDSTADDR:
128882c23ebaSBill Fenner 		case IP_RECVIF:
1289cfe8b629SGarrett Wollman 		case IP_PORTRANGE:
12906a800098SYoshinobu Inoue 		case IP_FAITH:
1291cfe8b629SGarrett Wollman 			switch (sopt->sopt_name) {
1292df8bae1dSRodney W. Grimes 
1293df8bae1dSRodney W. Grimes 			case IP_TOS:
1294ca98b82cSDavid Greenman 				optval = inp->inp_ip_tos;
1295df8bae1dSRodney W. Grimes 				break;
1296df8bae1dSRodney W. Grimes 
1297df8bae1dSRodney W. Grimes 			case IP_TTL:
1298ca98b82cSDavid Greenman 				optval = inp->inp_ip_ttl;
1299df8bae1dSRodney W. Grimes 				break;
1300df8bae1dSRodney W. Grimes 
1301df8bae1dSRodney W. Grimes #define	OPTBIT(bit)	(inp->inp_flags & bit ? 1 : 0)
1302df8bae1dSRodney W. Grimes 
1303df8bae1dSRodney W. Grimes 			case IP_RECVOPTS:
1304df8bae1dSRodney W. Grimes 				optval = OPTBIT(INP_RECVOPTS);
1305df8bae1dSRodney W. Grimes 				break;
1306df8bae1dSRodney W. Grimes 
1307df8bae1dSRodney W. Grimes 			case IP_RECVRETOPTS:
1308df8bae1dSRodney W. Grimes 				optval = OPTBIT(INP_RECVRETOPTS);
1309df8bae1dSRodney W. Grimes 				break;
1310df8bae1dSRodney W. Grimes 
1311df8bae1dSRodney W. Grimes 			case IP_RECVDSTADDR:
1312df8bae1dSRodney W. Grimes 				optval = OPTBIT(INP_RECVDSTADDR);
1313df8bae1dSRodney W. Grimes 				break;
131482c23ebaSBill Fenner 
131582c23ebaSBill Fenner 			case IP_RECVIF:
131682c23ebaSBill Fenner 				optval = OPTBIT(INP_RECVIF);
131782c23ebaSBill Fenner 				break;
1318cfe8b629SGarrett Wollman 
1319cfe8b629SGarrett Wollman 			case IP_PORTRANGE:
1320cfe8b629SGarrett Wollman 				if (inp->inp_flags & INP_HIGHPORT)
1321cfe8b629SGarrett Wollman 					optval = IP_PORTRANGE_HIGH;
1322cfe8b629SGarrett Wollman 				else if (inp->inp_flags & INP_LOWPORT)
1323cfe8b629SGarrett Wollman 					optval = IP_PORTRANGE_LOW;
1324cfe8b629SGarrett Wollman 				else
1325cfe8b629SGarrett Wollman 					optval = 0;
1326cfe8b629SGarrett Wollman 				break;
13276a800098SYoshinobu Inoue 
13286a800098SYoshinobu Inoue 			case IP_FAITH:
13296a800098SYoshinobu Inoue 				optval = OPTBIT(INP_FAITH);
13306a800098SYoshinobu Inoue 				break;
1331df8bae1dSRodney W. Grimes 			}
1332cfe8b629SGarrett Wollman 			error = sooptcopyout(sopt, &optval, sizeof optval);
1333df8bae1dSRodney W. Grimes 			break;
1334df8bae1dSRodney W. Grimes 
1335df8bae1dSRodney W. Grimes 		case IP_MULTICAST_IF:
1336f0068c4aSGarrett Wollman 		case IP_MULTICAST_VIF:
1337df8bae1dSRodney W. Grimes 		case IP_MULTICAST_TTL:
1338df8bae1dSRodney W. Grimes 		case IP_MULTICAST_LOOP:
1339df8bae1dSRodney W. Grimes 		case IP_ADD_MEMBERSHIP:
1340df8bae1dSRodney W. Grimes 		case IP_DROP_MEMBERSHIP:
1341cfe8b629SGarrett Wollman 			error = ip_getmoptions(sopt, inp->inp_moptions);
134233b3ac06SPeter Wemm 			break;
134333b3ac06SPeter Wemm 
13446a800098SYoshinobu Inoue #ifdef IPSEC
13456a800098SYoshinobu Inoue 		case IP_IPSEC_POLICY:
13466a800098SYoshinobu Inoue 		{
1347f63e7634SYoshinobu Inoue 			struct mbuf *m = NULL;
13486a800098SYoshinobu Inoue 			caddr_t req = NULL;
1349686cdd19SJun-ichiro itojun Hagino 			size_t len = 0;
13506a800098SYoshinobu Inoue 
1351686cdd19SJun-ichiro itojun Hagino 			if (m != 0) {
13526a800098SYoshinobu Inoue 				req = mtod(m, caddr_t);
1353686cdd19SJun-ichiro itojun Hagino 				len = m->m_len;
1354686cdd19SJun-ichiro itojun Hagino 			}
1355686cdd19SJun-ichiro itojun Hagino 			error = ipsec4_get_policy(sotoinpcb(so), req, len, &m);
13566a800098SYoshinobu Inoue 			if (error == 0)
13576a800098SYoshinobu Inoue 				error = soopt_mcopyout(sopt, m); /* XXX */
1358f63e7634SYoshinobu Inoue 			if (error == 0)
13596a800098SYoshinobu Inoue 				m_freem(m);
13606a800098SYoshinobu Inoue 			break;
13616a800098SYoshinobu Inoue 		}
13626a800098SYoshinobu Inoue #endif /*IPSEC*/
13636a800098SYoshinobu Inoue 
1364df8bae1dSRodney W. Grimes 		default:
1365df8bae1dSRodney W. Grimes 			error = ENOPROTOOPT;
1366df8bae1dSRodney W. Grimes 			break;
1367df8bae1dSRodney W. Grimes 		}
1368df8bae1dSRodney W. Grimes 		break;
1369df8bae1dSRodney W. Grimes 	}
1370df8bae1dSRodney W. Grimes 	return (error);
1371df8bae1dSRodney W. Grimes }
1372df8bae1dSRodney W. Grimes 
1373df8bae1dSRodney W. Grimes /*
1374df8bae1dSRodney W. Grimes  * Set up IP options in pcb for insertion in output packets.
1375df8bae1dSRodney W. Grimes  * Store in mbuf with pointer in pcbopt, adding pseudo-option
1376df8bae1dSRodney W. Grimes  * with destination address if source routed.
1377df8bae1dSRodney W. Grimes  */
13780312fbe9SPoul-Henning Kamp static int
1379df8bae1dSRodney W. Grimes ip_pcbopts(optname, pcbopt, m)
1380df8bae1dSRodney W. Grimes 	int optname;
1381df8bae1dSRodney W. Grimes 	struct mbuf **pcbopt;
1382df8bae1dSRodney W. Grimes 	register struct mbuf *m;
1383df8bae1dSRodney W. Grimes {
1384d68fa50cSBruce Evans 	register int cnt, optlen;
1385df8bae1dSRodney W. Grimes 	register u_char *cp;
1386df8bae1dSRodney W. Grimes 	u_char opt;
1387df8bae1dSRodney W. Grimes 
1388df8bae1dSRodney W. Grimes 	/* turn off any old options */
1389df8bae1dSRodney W. Grimes 	if (*pcbopt)
1390df8bae1dSRodney W. Grimes 		(void)m_free(*pcbopt);
1391df8bae1dSRodney W. Grimes 	*pcbopt = 0;
1392df8bae1dSRodney W. Grimes 	if (m == (struct mbuf *)0 || m->m_len == 0) {
1393df8bae1dSRodney W. Grimes 		/*
1394df8bae1dSRodney W. Grimes 		 * Only turning off any previous options.
1395df8bae1dSRodney W. Grimes 		 */
1396df8bae1dSRodney W. Grimes 		if (m)
1397df8bae1dSRodney W. Grimes 			(void)m_free(m);
1398df8bae1dSRodney W. Grimes 		return (0);
1399df8bae1dSRodney W. Grimes 	}
1400df8bae1dSRodney W. Grimes 
14010c8d2590SBruce Evans 	if (m->m_len % sizeof(int32_t))
1402df8bae1dSRodney W. Grimes 		goto bad;
1403df8bae1dSRodney W. Grimes 	/*
1404df8bae1dSRodney W. Grimes 	 * IP first-hop destination address will be stored before
1405df8bae1dSRodney W. Grimes 	 * actual options; move other options back
1406df8bae1dSRodney W. Grimes 	 * and clear it when none present.
1407df8bae1dSRodney W. Grimes 	 */
1408df8bae1dSRodney W. Grimes 	if (m->m_data + m->m_len + sizeof(struct in_addr) >= &m->m_dat[MLEN])
1409df8bae1dSRodney W. Grimes 		goto bad;
1410df8bae1dSRodney W. Grimes 	cnt = m->m_len;
1411df8bae1dSRodney W. Grimes 	m->m_len += sizeof(struct in_addr);
1412df8bae1dSRodney W. Grimes 	cp = mtod(m, u_char *) + sizeof(struct in_addr);
1413df8bae1dSRodney W. Grimes 	ovbcopy(mtod(m, caddr_t), (caddr_t)cp, (unsigned)cnt);
1414df8bae1dSRodney W. Grimes 	bzero(mtod(m, caddr_t), sizeof(struct in_addr));
1415df8bae1dSRodney W. Grimes 
1416df8bae1dSRodney W. Grimes 	for (; cnt > 0; cnt -= optlen, cp += optlen) {
1417df8bae1dSRodney W. Grimes 		opt = cp[IPOPT_OPTVAL];
1418df8bae1dSRodney W. Grimes 		if (opt == IPOPT_EOL)
1419df8bae1dSRodney W. Grimes 			break;
1420df8bae1dSRodney W. Grimes 		if (opt == IPOPT_NOP)
1421df8bae1dSRodney W. Grimes 			optlen = 1;
1422df8bae1dSRodney W. Grimes 		else {
1423707d00a3SJonathan Lemon 			if (cnt < IPOPT_OLEN + sizeof(*cp))
1424707d00a3SJonathan Lemon 				goto bad;
1425df8bae1dSRodney W. Grimes 			optlen = cp[IPOPT_OLEN];
1426707d00a3SJonathan Lemon 			if (optlen < IPOPT_OLEN + sizeof(*cp) || optlen > cnt)
1427df8bae1dSRodney W. Grimes 				goto bad;
1428df8bae1dSRodney W. Grimes 		}
1429df8bae1dSRodney W. Grimes 		switch (opt) {
1430df8bae1dSRodney W. Grimes 
1431df8bae1dSRodney W. Grimes 		default:
1432df8bae1dSRodney W. Grimes 			break;
1433df8bae1dSRodney W. Grimes 
1434df8bae1dSRodney W. Grimes 		case IPOPT_LSRR:
1435df8bae1dSRodney W. Grimes 		case IPOPT_SSRR:
1436df8bae1dSRodney W. Grimes 			/*
1437df8bae1dSRodney W. Grimes 			 * user process specifies route as:
1438df8bae1dSRodney W. Grimes 			 *	->A->B->C->D
1439df8bae1dSRodney W. Grimes 			 * D must be our final destination (but we can't
1440df8bae1dSRodney W. Grimes 			 * check that since we may not have connected yet).
1441df8bae1dSRodney W. Grimes 			 * A is first hop destination, which doesn't appear in
1442df8bae1dSRodney W. Grimes 			 * actual IP option, but is stored before the options.
1443df8bae1dSRodney W. Grimes 			 */
1444df8bae1dSRodney W. Grimes 			if (optlen < IPOPT_MINOFF - 1 + sizeof(struct in_addr))
1445df8bae1dSRodney W. Grimes 				goto bad;
1446df8bae1dSRodney W. Grimes 			m->m_len -= sizeof(struct in_addr);
1447df8bae1dSRodney W. Grimes 			cnt -= sizeof(struct in_addr);
1448df8bae1dSRodney W. Grimes 			optlen -= sizeof(struct in_addr);
1449df8bae1dSRodney W. Grimes 			cp[IPOPT_OLEN] = optlen;
1450df8bae1dSRodney W. Grimes 			/*
1451df8bae1dSRodney W. Grimes 			 * Move first hop before start of options.
1452df8bae1dSRodney W. Grimes 			 */
1453df8bae1dSRodney W. Grimes 			bcopy((caddr_t)&cp[IPOPT_OFFSET+1], mtod(m, caddr_t),
1454df8bae1dSRodney W. Grimes 			    sizeof(struct in_addr));
1455df8bae1dSRodney W. Grimes 			/*
1456df8bae1dSRodney W. Grimes 			 * Then copy rest of options back
1457df8bae1dSRodney W. Grimes 			 * to close up the deleted entry.
1458df8bae1dSRodney W. Grimes 			 */
1459df8bae1dSRodney W. Grimes 			ovbcopy((caddr_t)(&cp[IPOPT_OFFSET+1] +
1460df8bae1dSRodney W. Grimes 			    sizeof(struct in_addr)),
1461df8bae1dSRodney W. Grimes 			    (caddr_t)&cp[IPOPT_OFFSET+1],
1462df8bae1dSRodney W. Grimes 			    (unsigned)cnt + sizeof(struct in_addr));
1463df8bae1dSRodney W. Grimes 			break;
1464df8bae1dSRodney W. Grimes 		}
1465df8bae1dSRodney W. Grimes 	}
1466df8bae1dSRodney W. Grimes 	if (m->m_len > MAX_IPOPTLEN + sizeof(struct in_addr))
1467df8bae1dSRodney W. Grimes 		goto bad;
1468df8bae1dSRodney W. Grimes 	*pcbopt = m;
1469df8bae1dSRodney W. Grimes 	return (0);
1470df8bae1dSRodney W. Grimes 
1471df8bae1dSRodney W. Grimes bad:
1472df8bae1dSRodney W. Grimes 	(void)m_free(m);
1473df8bae1dSRodney W. Grimes 	return (EINVAL);
1474df8bae1dSRodney W. Grimes }
1475df8bae1dSRodney W. Grimes 
1476df8bae1dSRodney W. Grimes /*
1477cfe8b629SGarrett Wollman  * XXX
1478cfe8b629SGarrett Wollman  * The whole multicast option thing needs to be re-thought.
1479cfe8b629SGarrett Wollman  * Several of these options are equally applicable to non-multicast
1480cfe8b629SGarrett Wollman  * transmission, and one (IP_MULTICAST_TTL) totally duplicates a
1481cfe8b629SGarrett Wollman  * standard option (IP_TTL).
1482cfe8b629SGarrett Wollman  */
148333841545SHajimu UMEMOTO 
148433841545SHajimu UMEMOTO /*
148533841545SHajimu UMEMOTO  * following RFC1724 section 3.3, 0.0.0.0/8 is interpreted as interface index.
148633841545SHajimu UMEMOTO  */
148733841545SHajimu UMEMOTO static struct ifnet *
148833841545SHajimu UMEMOTO ip_multicast_if(a, ifindexp)
148933841545SHajimu UMEMOTO 	struct in_addr *a;
149033841545SHajimu UMEMOTO 	int *ifindexp;
149133841545SHajimu UMEMOTO {
149233841545SHajimu UMEMOTO 	int ifindex;
149333841545SHajimu UMEMOTO 	struct ifnet *ifp;
149433841545SHajimu UMEMOTO 
149533841545SHajimu UMEMOTO 	if (ifindexp)
149633841545SHajimu UMEMOTO 		*ifindexp = 0;
149733841545SHajimu UMEMOTO 	if (ntohl(a->s_addr) >> 24 == 0) {
149833841545SHajimu UMEMOTO 		ifindex = ntohl(a->s_addr) & 0xffffff;
149933841545SHajimu UMEMOTO 		if (ifindex < 0 || if_index < ifindex)
150033841545SHajimu UMEMOTO 			return NULL;
1501f9132cebSJonathan Lemon 		ifp = ifnet_byindex(ifindex);
150233841545SHajimu UMEMOTO 		if (ifindexp)
150333841545SHajimu UMEMOTO 			*ifindexp = ifindex;
150433841545SHajimu UMEMOTO 	} else {
150533841545SHajimu UMEMOTO 		INADDR_TO_IFP(*a, ifp);
150633841545SHajimu UMEMOTO 	}
150733841545SHajimu UMEMOTO 	return ifp;
150833841545SHajimu UMEMOTO }
150933841545SHajimu UMEMOTO 
1510cfe8b629SGarrett Wollman /*
1511df8bae1dSRodney W. Grimes  * Set the IP multicast options in response to user setsockopt().
1512df8bae1dSRodney W. Grimes  */
15130312fbe9SPoul-Henning Kamp static int
1514cfe8b629SGarrett Wollman ip_setmoptions(sopt, imop)
1515cfe8b629SGarrett Wollman 	struct sockopt *sopt;
1516df8bae1dSRodney W. Grimes 	struct ip_moptions **imop;
1517df8bae1dSRodney W. Grimes {
1518cfe8b629SGarrett Wollman 	int error = 0;
1519cfe8b629SGarrett Wollman 	int i;
1520df8bae1dSRodney W. Grimes 	struct in_addr addr;
1521cfe8b629SGarrett Wollman 	struct ip_mreq mreq;
1522cfe8b629SGarrett Wollman 	struct ifnet *ifp;
1523cfe8b629SGarrett Wollman 	struct ip_moptions *imo = *imop;
1524df8bae1dSRodney W. Grimes 	struct route ro;
1525cfe8b629SGarrett Wollman 	struct sockaddr_in *dst;
152633841545SHajimu UMEMOTO 	int ifindex;
15279b626c29SGarrett Wollman 	int s;
1528df8bae1dSRodney W. Grimes 
1529df8bae1dSRodney W. Grimes 	if (imo == NULL) {
1530df8bae1dSRodney W. Grimes 		/*
1531df8bae1dSRodney W. Grimes 		 * No multicast option buffer attached to the pcb;
1532df8bae1dSRodney W. Grimes 		 * allocate one and initialize to default values.
1533df8bae1dSRodney W. Grimes 		 */
1534df8bae1dSRodney W. Grimes 		imo = (struct ip_moptions*)malloc(sizeof(*imo), M_IPMOPTS,
1535df8bae1dSRodney W. Grimes 		    M_WAITOK);
1536df8bae1dSRodney W. Grimes 
1537df8bae1dSRodney W. Grimes 		if (imo == NULL)
1538df8bae1dSRodney W. Grimes 			return (ENOBUFS);
1539df8bae1dSRodney W. Grimes 		*imop = imo;
1540df8bae1dSRodney W. Grimes 		imo->imo_multicast_ifp = NULL;
154133841545SHajimu UMEMOTO 		imo->imo_multicast_addr.s_addr = INADDR_ANY;
15421c5de19aSGarrett Wollman 		imo->imo_multicast_vif = -1;
1543df8bae1dSRodney W. Grimes 		imo->imo_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
1544df8bae1dSRodney W. Grimes 		imo->imo_multicast_loop = IP_DEFAULT_MULTICAST_LOOP;
1545df8bae1dSRodney W. Grimes 		imo->imo_num_memberships = 0;
1546df8bae1dSRodney W. Grimes 	}
1547df8bae1dSRodney W. Grimes 
1548cfe8b629SGarrett Wollman 	switch (sopt->sopt_name) {
1549f0068c4aSGarrett Wollman 	/* store an index number for the vif you wanna use in the send */
1550f0068c4aSGarrett Wollman 	case IP_MULTICAST_VIF:
1551cfe8b629SGarrett Wollman 		if (legal_vif_num == 0) {
15525e9ae478SGarrett Wollman 			error = EOPNOTSUPP;
15535e9ae478SGarrett Wollman 			break;
15545e9ae478SGarrett Wollman 		}
1555cfe8b629SGarrett Wollman 		error = sooptcopyin(sopt, &i, sizeof i, sizeof i);
1556cfe8b629SGarrett Wollman 		if (error)
1557f0068c4aSGarrett Wollman 			break;
15581c5de19aSGarrett Wollman 		if (!legal_vif_num(i) && (i != -1)) {
1559f0068c4aSGarrett Wollman 			error = EINVAL;
1560f0068c4aSGarrett Wollman 			break;
1561f0068c4aSGarrett Wollman 		}
1562f0068c4aSGarrett Wollman 		imo->imo_multicast_vif = i;
1563f0068c4aSGarrett Wollman 		break;
1564f0068c4aSGarrett Wollman 
1565df8bae1dSRodney W. Grimes 	case IP_MULTICAST_IF:
1566df8bae1dSRodney W. Grimes 		/*
1567df8bae1dSRodney W. Grimes 		 * Select the interface for outgoing multicast packets.
1568df8bae1dSRodney W. Grimes 		 */
1569cfe8b629SGarrett Wollman 		error = sooptcopyin(sopt, &addr, sizeof addr, sizeof addr);
1570cfe8b629SGarrett Wollman 		if (error)
1571df8bae1dSRodney W. Grimes 			break;
1572df8bae1dSRodney W. Grimes 		/*
1573df8bae1dSRodney W. Grimes 		 * INADDR_ANY is used to remove a previous selection.
1574df8bae1dSRodney W. Grimes 		 * When no interface is selected, a default one is
1575df8bae1dSRodney W. Grimes 		 * chosen every time a multicast packet is sent.
1576df8bae1dSRodney W. Grimes 		 */
1577df8bae1dSRodney W. Grimes 		if (addr.s_addr == INADDR_ANY) {
1578df8bae1dSRodney W. Grimes 			imo->imo_multicast_ifp = NULL;
1579df8bae1dSRodney W. Grimes 			break;
1580df8bae1dSRodney W. Grimes 		}
1581df8bae1dSRodney W. Grimes 		/*
1582df8bae1dSRodney W. Grimes 		 * The selected interface is identified by its local
1583df8bae1dSRodney W. Grimes 		 * IP address.  Find the interface and confirm that
1584df8bae1dSRodney W. Grimes 		 * it supports multicasting.
1585df8bae1dSRodney W. Grimes 		 */
158620e8807cSGarrett Wollman 		s = splimp();
158733841545SHajimu UMEMOTO 		ifp = ip_multicast_if(&addr, &ifindex);
1588df8bae1dSRodney W. Grimes 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
1589fbc6ab00SBill Fenner 			splx(s);
1590df8bae1dSRodney W. Grimes 			error = EADDRNOTAVAIL;
1591df8bae1dSRodney W. Grimes 			break;
1592df8bae1dSRodney W. Grimes 		}
1593df8bae1dSRodney W. Grimes 		imo->imo_multicast_ifp = ifp;
159433841545SHajimu UMEMOTO 		if (ifindex)
159533841545SHajimu UMEMOTO 			imo->imo_multicast_addr = addr;
159633841545SHajimu UMEMOTO 		else
159733841545SHajimu UMEMOTO 			imo->imo_multicast_addr.s_addr = INADDR_ANY;
15989b626c29SGarrett Wollman 		splx(s);
1599df8bae1dSRodney W. Grimes 		break;
1600df8bae1dSRodney W. Grimes 
1601df8bae1dSRodney W. Grimes 	case IP_MULTICAST_TTL:
1602df8bae1dSRodney W. Grimes 		/*
1603df8bae1dSRodney W. Grimes 		 * Set the IP time-to-live for outgoing multicast packets.
1604cfe8b629SGarrett Wollman 		 * The original multicast API required a char argument,
1605cfe8b629SGarrett Wollman 		 * which is inconsistent with the rest of the socket API.
1606cfe8b629SGarrett Wollman 		 * We allow either a char or an int.
1607df8bae1dSRodney W. Grimes 		 */
1608cfe8b629SGarrett Wollman 		if (sopt->sopt_valsize == 1) {
1609cfe8b629SGarrett Wollman 			u_char ttl;
1610cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &ttl, 1, 1);
1611cfe8b629SGarrett Wollman 			if (error)
1612df8bae1dSRodney W. Grimes 				break;
1613cfe8b629SGarrett Wollman 			imo->imo_multicast_ttl = ttl;
1614cfe8b629SGarrett Wollman 		} else {
1615cfe8b629SGarrett Wollman 			u_int ttl;
1616cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &ttl, sizeof ttl,
1617cfe8b629SGarrett Wollman 					    sizeof ttl);
1618cfe8b629SGarrett Wollman 			if (error)
1619cfe8b629SGarrett Wollman 				break;
1620cfe8b629SGarrett Wollman 			if (ttl > 255)
1621cfe8b629SGarrett Wollman 				error = EINVAL;
1622cfe8b629SGarrett Wollman 			else
1623cfe8b629SGarrett Wollman 				imo->imo_multicast_ttl = ttl;
1624df8bae1dSRodney W. Grimes 		}
1625df8bae1dSRodney W. Grimes 		break;
1626df8bae1dSRodney W. Grimes 
1627df8bae1dSRodney W. Grimes 	case IP_MULTICAST_LOOP:
1628df8bae1dSRodney W. Grimes 		/*
1629df8bae1dSRodney W. Grimes 		 * Set the loopback flag for outgoing multicast packets.
1630cfe8b629SGarrett Wollman 		 * Must be zero or one.  The original multicast API required a
1631cfe8b629SGarrett Wollman 		 * char argument, which is inconsistent with the rest
1632cfe8b629SGarrett Wollman 		 * of the socket API.  We allow either a char or an int.
1633df8bae1dSRodney W. Grimes 		 */
1634cfe8b629SGarrett Wollman 		if (sopt->sopt_valsize == 1) {
1635cfe8b629SGarrett Wollman 			u_char loop;
1636cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &loop, 1, 1);
1637cfe8b629SGarrett Wollman 			if (error)
1638df8bae1dSRodney W. Grimes 				break;
1639cfe8b629SGarrett Wollman 			imo->imo_multicast_loop = !!loop;
1640cfe8b629SGarrett Wollman 		} else {
1641cfe8b629SGarrett Wollman 			u_int loop;
1642cfe8b629SGarrett Wollman 			error = sooptcopyin(sopt, &loop, sizeof loop,
1643cfe8b629SGarrett Wollman 					    sizeof loop);
1644cfe8b629SGarrett Wollman 			if (error)
1645cfe8b629SGarrett Wollman 				break;
1646cfe8b629SGarrett Wollman 			imo->imo_multicast_loop = !!loop;
1647df8bae1dSRodney W. Grimes 		}
1648df8bae1dSRodney W. Grimes 		break;
1649df8bae1dSRodney W. Grimes 
1650df8bae1dSRodney W. Grimes 	case IP_ADD_MEMBERSHIP:
1651df8bae1dSRodney W. Grimes 		/*
1652df8bae1dSRodney W. Grimes 		 * Add a multicast group membership.
1653df8bae1dSRodney W. Grimes 		 * Group must be a valid IP multicast address.
1654df8bae1dSRodney W. Grimes 		 */
1655cfe8b629SGarrett Wollman 		error = sooptcopyin(sopt, &mreq, sizeof mreq, sizeof mreq);
1656cfe8b629SGarrett Wollman 		if (error)
1657df8bae1dSRodney W. Grimes 			break;
1658cfe8b629SGarrett Wollman 
1659cfe8b629SGarrett Wollman 		if (!IN_MULTICAST(ntohl(mreq.imr_multiaddr.s_addr))) {
1660df8bae1dSRodney W. Grimes 			error = EINVAL;
1661df8bae1dSRodney W. Grimes 			break;
1662df8bae1dSRodney W. Grimes 		}
166320e8807cSGarrett Wollman 		s = splimp();
1664df8bae1dSRodney W. Grimes 		/*
1665df8bae1dSRodney W. Grimes 		 * If no interface address was provided, use the interface of
1666df8bae1dSRodney W. Grimes 		 * the route to the given multicast address.
1667df8bae1dSRodney W. Grimes 		 */
1668cfe8b629SGarrett Wollman 		if (mreq.imr_interface.s_addr == INADDR_ANY) {
16691c5de19aSGarrett Wollman 			bzero((caddr_t)&ro, sizeof(ro));
1670df8bae1dSRodney W. Grimes 			dst = (struct sockaddr_in *)&ro.ro_dst;
1671df8bae1dSRodney W. Grimes 			dst->sin_len = sizeof(*dst);
1672df8bae1dSRodney W. Grimes 			dst->sin_family = AF_INET;
1673cfe8b629SGarrett Wollman 			dst->sin_addr = mreq.imr_multiaddr;
1674df8bae1dSRodney W. Grimes 			rtalloc(&ro);
1675df8bae1dSRodney W. Grimes 			if (ro.ro_rt == NULL) {
1676df8bae1dSRodney W. Grimes 				error = EADDRNOTAVAIL;
16779b626c29SGarrett Wollman 				splx(s);
1678df8bae1dSRodney W. Grimes 				break;
1679df8bae1dSRodney W. Grimes 			}
1680df8bae1dSRodney W. Grimes 			ifp = ro.ro_rt->rt_ifp;
1681df8bae1dSRodney W. Grimes 			rtfree(ro.ro_rt);
1682df8bae1dSRodney W. Grimes 		}
1683df8bae1dSRodney W. Grimes 		else {
168433841545SHajimu UMEMOTO 			ifp = ip_multicast_if(&mreq.imr_interface, NULL);
1685df8bae1dSRodney W. Grimes 		}
16869b626c29SGarrett Wollman 
1687df8bae1dSRodney W. Grimes 		/*
1688df8bae1dSRodney W. Grimes 		 * See if we found an interface, and confirm that it
1689df8bae1dSRodney W. Grimes 		 * supports multicast.
1690df8bae1dSRodney W. Grimes 		 */
1691df8bae1dSRodney W. Grimes 		if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
1692df8bae1dSRodney W. Grimes 			error = EADDRNOTAVAIL;
16939b626c29SGarrett Wollman 			splx(s);
1694df8bae1dSRodney W. Grimes 			break;
1695df8bae1dSRodney W. Grimes 		}
1696df8bae1dSRodney W. Grimes 		/*
1697df8bae1dSRodney W. Grimes 		 * See if the membership already exists or if all the
1698df8bae1dSRodney W. Grimes 		 * membership slots are full.
1699df8bae1dSRodney W. Grimes 		 */
1700df8bae1dSRodney W. Grimes 		for (i = 0; i < imo->imo_num_memberships; ++i) {
1701df8bae1dSRodney W. Grimes 			if (imo->imo_membership[i]->inm_ifp == ifp &&
1702df8bae1dSRodney W. Grimes 			    imo->imo_membership[i]->inm_addr.s_addr
1703cfe8b629SGarrett Wollman 						== mreq.imr_multiaddr.s_addr)
1704df8bae1dSRodney W. Grimes 				break;
1705df8bae1dSRodney W. Grimes 		}
1706df8bae1dSRodney W. Grimes 		if (i < imo->imo_num_memberships) {
1707df8bae1dSRodney W. Grimes 			error = EADDRINUSE;
17089b626c29SGarrett Wollman 			splx(s);
1709df8bae1dSRodney W. Grimes 			break;
1710df8bae1dSRodney W. Grimes 		}
1711df8bae1dSRodney W. Grimes 		if (i == IP_MAX_MEMBERSHIPS) {
1712df8bae1dSRodney W. Grimes 			error = ETOOMANYREFS;
17139b626c29SGarrett Wollman 			splx(s);
1714df8bae1dSRodney W. Grimes 			break;
1715df8bae1dSRodney W. Grimes 		}
1716df8bae1dSRodney W. Grimes 		/*
1717df8bae1dSRodney W. Grimes 		 * Everything looks good; add a new record to the multicast
1718df8bae1dSRodney W. Grimes 		 * address list for the given interface.
1719df8bae1dSRodney W. Grimes 		 */
1720df8bae1dSRodney W. Grimes 		if ((imo->imo_membership[i] =
1721cfe8b629SGarrett Wollman 		    in_addmulti(&mreq.imr_multiaddr, ifp)) == NULL) {
1722df8bae1dSRodney W. Grimes 			error = ENOBUFS;
17239b626c29SGarrett Wollman 			splx(s);
1724df8bae1dSRodney W. Grimes 			break;
1725df8bae1dSRodney W. Grimes 		}
1726df8bae1dSRodney W. Grimes 		++imo->imo_num_memberships;
17279b626c29SGarrett Wollman 		splx(s);
1728df8bae1dSRodney W. Grimes 		break;
1729df8bae1dSRodney W. Grimes 
1730df8bae1dSRodney W. Grimes 	case IP_DROP_MEMBERSHIP:
1731df8bae1dSRodney W. Grimes 		/*
1732df8bae1dSRodney W. Grimes 		 * Drop a multicast group membership.
1733df8bae1dSRodney W. Grimes 		 * Group must be a valid IP multicast address.
1734df8bae1dSRodney W. Grimes 		 */
1735cfe8b629SGarrett Wollman 		error = sooptcopyin(sopt, &mreq, sizeof mreq, sizeof mreq);
1736cfe8b629SGarrett Wollman 		if (error)
1737df8bae1dSRodney W. Grimes 			break;
1738cfe8b629SGarrett Wollman 
1739cfe8b629SGarrett Wollman 		if (!IN_MULTICAST(ntohl(mreq.imr_multiaddr.s_addr))) {
1740df8bae1dSRodney W. Grimes 			error = EINVAL;
1741df8bae1dSRodney W. Grimes 			break;
1742df8bae1dSRodney W. Grimes 		}
17439b626c29SGarrett Wollman 
174420e8807cSGarrett Wollman 		s = splimp();
1745df8bae1dSRodney W. Grimes 		/*
1746df8bae1dSRodney W. Grimes 		 * If an interface address was specified, get a pointer
1747df8bae1dSRodney W. Grimes 		 * to its ifnet structure.
1748df8bae1dSRodney W. Grimes 		 */
1749cfe8b629SGarrett Wollman 		if (mreq.imr_interface.s_addr == INADDR_ANY)
1750df8bae1dSRodney W. Grimes 			ifp = NULL;
1751df8bae1dSRodney W. Grimes 		else {
175233841545SHajimu UMEMOTO 			ifp = ip_multicast_if(&mreq.imr_interface, NULL);
1753df8bae1dSRodney W. Grimes 			if (ifp == NULL) {
1754df8bae1dSRodney W. Grimes 				error = EADDRNOTAVAIL;
17559b626c29SGarrett Wollman 				splx(s);
1756df8bae1dSRodney W. Grimes 				break;
1757df8bae1dSRodney W. Grimes 			}
1758df8bae1dSRodney W. Grimes 		}
1759df8bae1dSRodney W. Grimes 		/*
1760df8bae1dSRodney W. Grimes 		 * Find the membership in the membership array.
1761df8bae1dSRodney W. Grimes 		 */
1762df8bae1dSRodney W. Grimes 		for (i = 0; i < imo->imo_num_memberships; ++i) {
1763df8bae1dSRodney W. Grimes 			if ((ifp == NULL ||
1764df8bae1dSRodney W. Grimes 			     imo->imo_membership[i]->inm_ifp == ifp) &&
1765df8bae1dSRodney W. Grimes 			     imo->imo_membership[i]->inm_addr.s_addr ==
1766cfe8b629SGarrett Wollman 			     mreq.imr_multiaddr.s_addr)
1767df8bae1dSRodney W. Grimes 				break;
1768df8bae1dSRodney W. Grimes 		}
1769df8bae1dSRodney W. Grimes 		if (i == imo->imo_num_memberships) {
1770df8bae1dSRodney W. Grimes 			error = EADDRNOTAVAIL;
17719b626c29SGarrett Wollman 			splx(s);
1772df8bae1dSRodney W. Grimes 			break;
1773df8bae1dSRodney W. Grimes 		}
1774df8bae1dSRodney W. Grimes 		/*
1775df8bae1dSRodney W. Grimes 		 * Give up the multicast address record to which the
1776df8bae1dSRodney W. Grimes 		 * membership points.
1777df8bae1dSRodney W. Grimes 		 */
1778df8bae1dSRodney W. Grimes 		in_delmulti(imo->imo_membership[i]);
1779df8bae1dSRodney W. Grimes 		/*
1780df8bae1dSRodney W. Grimes 		 * Remove the gap in the membership array.
1781df8bae1dSRodney W. Grimes 		 */
1782df8bae1dSRodney W. Grimes 		for (++i; i < imo->imo_num_memberships; ++i)
1783df8bae1dSRodney W. Grimes 			imo->imo_membership[i-1] = imo->imo_membership[i];
1784df8bae1dSRodney W. Grimes 		--imo->imo_num_memberships;
17859b626c29SGarrett Wollman 		splx(s);
1786df8bae1dSRodney W. Grimes 		break;
1787df8bae1dSRodney W. Grimes 
1788df8bae1dSRodney W. Grimes 	default:
1789df8bae1dSRodney W. Grimes 		error = EOPNOTSUPP;
1790df8bae1dSRodney W. Grimes 		break;
1791df8bae1dSRodney W. Grimes 	}
1792df8bae1dSRodney W. Grimes 
1793df8bae1dSRodney W. Grimes 	/*
1794df8bae1dSRodney W. Grimes 	 * If all options have default values, no need to keep the mbuf.
1795df8bae1dSRodney W. Grimes 	 */
1796df8bae1dSRodney W. Grimes 	if (imo->imo_multicast_ifp == NULL &&
17971c5de19aSGarrett Wollman 	    imo->imo_multicast_vif == -1 &&
1798df8bae1dSRodney W. Grimes 	    imo->imo_multicast_ttl == IP_DEFAULT_MULTICAST_TTL &&
1799df8bae1dSRodney W. Grimes 	    imo->imo_multicast_loop == IP_DEFAULT_MULTICAST_LOOP &&
1800df8bae1dSRodney W. Grimes 	    imo->imo_num_memberships == 0) {
1801df8bae1dSRodney W. Grimes 		free(*imop, M_IPMOPTS);
1802df8bae1dSRodney W. Grimes 		*imop = NULL;
1803df8bae1dSRodney W. Grimes 	}
1804df8bae1dSRodney W. Grimes 
1805df8bae1dSRodney W. Grimes 	return (error);
1806df8bae1dSRodney W. Grimes }
1807df8bae1dSRodney W. Grimes 
1808df8bae1dSRodney W. Grimes /*
1809df8bae1dSRodney W. Grimes  * Return the IP multicast options in response to user getsockopt().
1810df8bae1dSRodney W. Grimes  */
18110312fbe9SPoul-Henning Kamp static int
1812cfe8b629SGarrett Wollman ip_getmoptions(sopt, imo)
1813cfe8b629SGarrett Wollman 	struct sockopt *sopt;
1814df8bae1dSRodney W. Grimes 	register struct ip_moptions *imo;
1815df8bae1dSRodney W. Grimes {
1816cfe8b629SGarrett Wollman 	struct in_addr addr;
1817df8bae1dSRodney W. Grimes 	struct in_ifaddr *ia;
1818cfe8b629SGarrett Wollman 	int error, optval;
1819cfe8b629SGarrett Wollman 	u_char coptval;
1820df8bae1dSRodney W. Grimes 
1821cfe8b629SGarrett Wollman 	error = 0;
1822cfe8b629SGarrett Wollman 	switch (sopt->sopt_name) {
1823f0068c4aSGarrett Wollman 	case IP_MULTICAST_VIF:
1824f0068c4aSGarrett Wollman 		if (imo != NULL)
1825cfe8b629SGarrett Wollman 			optval = imo->imo_multicast_vif;
1826f0068c4aSGarrett Wollman 		else
1827cfe8b629SGarrett Wollman 			optval = -1;
1828cfe8b629SGarrett Wollman 		error = sooptcopyout(sopt, &optval, sizeof optval);
1829cfe8b629SGarrett Wollman 		break;
1830f0068c4aSGarrett Wollman 
1831df8bae1dSRodney W. Grimes 	case IP_MULTICAST_IF:
1832df8bae1dSRodney W. Grimes 		if (imo == NULL || imo->imo_multicast_ifp == NULL)
1833cfe8b629SGarrett Wollman 			addr.s_addr = INADDR_ANY;
183433841545SHajimu UMEMOTO 		else if (imo->imo_multicast_addr.s_addr) {
183533841545SHajimu UMEMOTO 			/* return the value user has set */
183633841545SHajimu UMEMOTO 			addr = imo->imo_multicast_addr;
183733841545SHajimu UMEMOTO 		} else {
1838df8bae1dSRodney W. Grimes 			IFP_TO_IA(imo->imo_multicast_ifp, ia);
1839cfe8b629SGarrett Wollman 			addr.s_addr = (ia == NULL) ? INADDR_ANY
1840df8bae1dSRodney W. Grimes 				: IA_SIN(ia)->sin_addr.s_addr;
1841df8bae1dSRodney W. Grimes 		}
1842cfe8b629SGarrett Wollman 		error = sooptcopyout(sopt, &addr, sizeof addr);
1843cfe8b629SGarrett Wollman 		break;
1844df8bae1dSRodney W. Grimes 
1845df8bae1dSRodney W. Grimes 	case IP_MULTICAST_TTL:
1846cfe8b629SGarrett Wollman 		if (imo == 0)
1847cfe8b629SGarrett Wollman 			optval = coptval = IP_DEFAULT_MULTICAST_TTL;
1848cfe8b629SGarrett Wollman 		else
1849cfe8b629SGarrett Wollman 			optval = coptval = imo->imo_multicast_ttl;
1850cfe8b629SGarrett Wollman 		if (sopt->sopt_valsize == 1)
1851cfe8b629SGarrett Wollman 			error = sooptcopyout(sopt, &coptval, 1);
1852cfe8b629SGarrett Wollman 		else
1853cfe8b629SGarrett Wollman 			error = sooptcopyout(sopt, &optval, sizeof optval);
1854cfe8b629SGarrett Wollman 		break;
1855df8bae1dSRodney W. Grimes 
1856df8bae1dSRodney W. Grimes 	case IP_MULTICAST_LOOP:
1857cfe8b629SGarrett Wollman 		if (imo == 0)
1858cfe8b629SGarrett Wollman 			optval = coptval = IP_DEFAULT_MULTICAST_LOOP;
1859cfe8b629SGarrett Wollman 		else
1860cfe8b629SGarrett Wollman 			optval = coptval = imo->imo_multicast_loop;
1861cfe8b629SGarrett Wollman 		if (sopt->sopt_valsize == 1)
1862cfe8b629SGarrett Wollman 			error = sooptcopyout(sopt, &coptval, 1);
1863cfe8b629SGarrett Wollman 		else
1864cfe8b629SGarrett Wollman 			error = sooptcopyout(sopt, &optval, sizeof optval);
1865cfe8b629SGarrett Wollman 		break;
1866df8bae1dSRodney W. Grimes 
1867df8bae1dSRodney W. Grimes 	default:
1868cfe8b629SGarrett Wollman 		error = ENOPROTOOPT;
1869cfe8b629SGarrett Wollman 		break;
1870df8bae1dSRodney W. Grimes 	}
1871cfe8b629SGarrett Wollman 	return (error);
1872df8bae1dSRodney W. Grimes }
1873df8bae1dSRodney W. Grimes 
1874df8bae1dSRodney W. Grimes /*
1875df8bae1dSRodney W. Grimes  * Discard the IP multicast options.
1876df8bae1dSRodney W. Grimes  */
1877df8bae1dSRodney W. Grimes void
1878df8bae1dSRodney W. Grimes ip_freemoptions(imo)
1879df8bae1dSRodney W. Grimes 	register struct ip_moptions *imo;
1880df8bae1dSRodney W. Grimes {
1881df8bae1dSRodney W. Grimes 	register int i;
1882df8bae1dSRodney W. Grimes 
1883df8bae1dSRodney W. Grimes 	if (imo != NULL) {
1884df8bae1dSRodney W. Grimes 		for (i = 0; i < imo->imo_num_memberships; ++i)
1885df8bae1dSRodney W. Grimes 			in_delmulti(imo->imo_membership[i]);
1886df8bae1dSRodney W. Grimes 		free(imo, M_IPMOPTS);
1887df8bae1dSRodney W. Grimes 	}
1888df8bae1dSRodney W. Grimes }
1889df8bae1dSRodney W. Grimes 
1890df8bae1dSRodney W. Grimes /*
1891df8bae1dSRodney W. Grimes  * Routine called from ip_output() to loop back a copy of an IP multicast
1892df8bae1dSRodney W. Grimes  * packet to the input queue of a specified interface.  Note that this
1893df8bae1dSRodney W. Grimes  * calls the output routine of the loopback "driver", but with an interface
1894f5fea3ddSPaul Traina  * pointer that might NOT be a loopback interface -- evil, but easier than
1895f5fea3ddSPaul Traina  * replicating that code here.
1896df8bae1dSRodney W. Grimes  */
1897df8bae1dSRodney W. Grimes static void
189886b1d6d2SBill Fenner ip_mloopback(ifp, m, dst, hlen)
1899df8bae1dSRodney W. Grimes 	struct ifnet *ifp;
1900df8bae1dSRodney W. Grimes 	register struct mbuf *m;
1901df8bae1dSRodney W. Grimes 	register struct sockaddr_in *dst;
190286b1d6d2SBill Fenner 	int hlen;
1903df8bae1dSRodney W. Grimes {
1904df8bae1dSRodney W. Grimes 	register struct ip *ip;
1905df8bae1dSRodney W. Grimes 	struct mbuf *copym;
1906df8bae1dSRodney W. Grimes 
1907df8bae1dSRodney W. Grimes 	copym = m_copy(m, 0, M_COPYALL);
190886b1d6d2SBill Fenner 	if (copym != NULL && (copym->m_flags & M_EXT || copym->m_len < hlen))
190986b1d6d2SBill Fenner 		copym = m_pullup(copym, hlen);
1910df8bae1dSRodney W. Grimes 	if (copym != NULL) {
1911df8bae1dSRodney W. Grimes 		/*
1912df8bae1dSRodney W. Grimes 		 * We don't bother to fragment if the IP length is greater
1913df8bae1dSRodney W. Grimes 		 * than the interface's MTU.  Can this possibly matter?
1914df8bae1dSRodney W. Grimes 		 */
1915df8bae1dSRodney W. Grimes 		ip = mtod(copym, struct ip *);
191604287599SRuslan Ermilov 		HTONS(ip->ip_len);
191704287599SRuslan Ermilov 		HTONS(ip->ip_off);
1918df8bae1dSRodney W. Grimes 		ip->ip_sum = 0;
19199c9137eaSGarrett Wollman 		if (ip->ip_vhl == IP_VHL_BORING) {
19209c9137eaSGarrett Wollman 			ip->ip_sum = in_cksum_hdr(ip);
19219c9137eaSGarrett Wollman 		} else {
192286b1d6d2SBill Fenner 			ip->ip_sum = in_cksum(copym, hlen);
19239c9137eaSGarrett Wollman 		}
19249c9137eaSGarrett Wollman 		/*
19259c9137eaSGarrett Wollman 		 * NB:
1926e1596dffSBill Fenner 		 * It's not clear whether there are any lingering
1927e1596dffSBill Fenner 		 * reentrancy problems in other areas which might
1928e1596dffSBill Fenner 		 * be exposed by using ip_input directly (in
1929e1596dffSBill Fenner 		 * particular, everything which modifies the packet
1930e1596dffSBill Fenner 		 * in-place).  Yet another option is using the
1931e1596dffSBill Fenner 		 * protosw directly to deliver the looped back
1932e1596dffSBill Fenner 		 * packet.  For the moment, we'll err on the side
1933ed7509acSJulian Elischer 		 * of safety by using if_simloop().
19349c9137eaSGarrett Wollman 		 */
1935201c2527SJulian Elischer #if 1 /* XXX */
1936201c2527SJulian Elischer 		if (dst->sin_family != AF_INET) {
19372b8a366cSJulian Elischer 			printf("ip_mloopback: bad address family %d\n",
1938201c2527SJulian Elischer 						dst->sin_family);
1939201c2527SJulian Elischer 			dst->sin_family = AF_INET;
1940201c2527SJulian Elischer 		}
1941201c2527SJulian Elischer #endif
1942201c2527SJulian Elischer 
19439c9137eaSGarrett Wollman #ifdef notdef
1944e1596dffSBill Fenner 		copym->m_pkthdr.rcvif = ifp;
1945ed7509acSJulian Elischer 		ip_input(copym);
19469c9137eaSGarrett Wollman #else
194750c6dc99SJonathan Lemon 		/* if the checksum hasn't been computed, mark it as valid */
194850c6dc99SJonathan Lemon 		if (copym->m_pkthdr.csum_flags & CSUM_DELAY_DATA) {
194950c6dc99SJonathan Lemon 			copym->m_pkthdr.csum_flags |=
195050c6dc99SJonathan Lemon 			    CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
195150c6dc99SJonathan Lemon 			copym->m_pkthdr.csum_data = 0xffff;
195250c6dc99SJonathan Lemon 		}
195306a429a3SArchie Cobbs 		if_simloop(ifp, copym, dst->sin_family, 0);
19549c9137eaSGarrett Wollman #endif
1955df8bae1dSRodney W. Grimes 	}
1956df8bae1dSRodney W. Grimes }
1957