xref: /freebsd/sys/net/if_gre.c (revision febd0759f34e2faaaed0abf5fafb1071090aef38)
173d7ddbcSMaxim Sobolev /*	$NetBSD: if_gre.c,v 1.49 2003/12/11 00:22:29 itojun Exp $ */
28e96e13eSMaxim Sobolev /*	 $FreeBSD$ */
38e96e13eSMaxim Sobolev 
4c398230bSWarner Losh /*-
58e96e13eSMaxim Sobolev  * Copyright (c) 1998 The NetBSD Foundation, Inc.
68e96e13eSMaxim Sobolev  * All rights reserved.
78e96e13eSMaxim Sobolev  *
88e96e13eSMaxim Sobolev  * This code is derived from software contributed to The NetBSD Foundation
98e96e13eSMaxim Sobolev  * by Heiko W.Rupp <hwr@pilhuhn.de>
108e96e13eSMaxim Sobolev  *
119e669156SBjoern A. Zeeb  * IPv6-over-GRE contributed by Gert Doering <gert@greenie.muc.de>
129e669156SBjoern A. Zeeb  *
138e96e13eSMaxim Sobolev  * Redistribution and use in source and binary forms, with or without
148e96e13eSMaxim Sobolev  * modification, are permitted provided that the following conditions
158e96e13eSMaxim Sobolev  * are met:
168e96e13eSMaxim Sobolev  * 1. Redistributions of source code must retain the above copyright
178e96e13eSMaxim Sobolev  *    notice, this list of conditions and the following disclaimer.
188e96e13eSMaxim Sobolev  * 2. Redistributions in binary form must reproduce the above copyright
198e96e13eSMaxim Sobolev  *    notice, this list of conditions and the following disclaimer in the
208e96e13eSMaxim Sobolev  *    documentation and/or other materials provided with the distribution.
218e96e13eSMaxim Sobolev  * 3. All advertising materials mentioning features or use of this software
228e96e13eSMaxim Sobolev  *    must display the following acknowledgement:
238e96e13eSMaxim Sobolev  *        This product includes software developed by the NetBSD
248e96e13eSMaxim Sobolev  *        Foundation, Inc. and its contributors.
258e96e13eSMaxim Sobolev  * 4. Neither the name of The NetBSD Foundation nor the names of its
268e96e13eSMaxim Sobolev  *    contributors may be used to endorse or promote products derived
278e96e13eSMaxim Sobolev  *    from this software without specific prior written permission.
288e96e13eSMaxim Sobolev  *
298e96e13eSMaxim Sobolev  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
308e96e13eSMaxim Sobolev  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
318e96e13eSMaxim Sobolev  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
328e96e13eSMaxim Sobolev  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
338e96e13eSMaxim Sobolev  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
348e96e13eSMaxim Sobolev  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
358e96e13eSMaxim Sobolev  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
368e96e13eSMaxim Sobolev  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
378e96e13eSMaxim Sobolev  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
388e96e13eSMaxim Sobolev  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
398e96e13eSMaxim Sobolev  * POSSIBILITY OF SUCH DAMAGE.
408e96e13eSMaxim Sobolev  */
418e96e13eSMaxim Sobolev 
428e96e13eSMaxim Sobolev /*
438e96e13eSMaxim Sobolev  * Encapsulate L3 protocols into IP
449e669156SBjoern A. Zeeb  * See RFC 2784 (successor of RFC 1701 and 1702) for more details.
458e96e13eSMaxim Sobolev  * If_gre is compatible with Cisco GRE tunnels, so you can
468e96e13eSMaxim Sobolev  * have a NetBSD box as the other end of a tunnel interface of a Cisco
478e96e13eSMaxim Sobolev  * router. See gre(4) for more details.
488e96e13eSMaxim Sobolev  * Also supported:  IP in IP encaps (proto 55) as of RFC 2004
498e96e13eSMaxim Sobolev  */
508e96e13eSMaxim Sobolev 
5112768622SBruce Evans #include "opt_atalk.h"
528e96e13eSMaxim Sobolev #include "opt_inet.h"
53f16770aeSBruce M Simpson #include "opt_inet6.h"
548e96e13eSMaxim Sobolev 
558e96e13eSMaxim Sobolev #include <sys/param.h>
568e96e13eSMaxim Sobolev #include <sys/kernel.h>
578e96e13eSMaxim Sobolev #include <sys/malloc.h>
585dba30f1SPoul-Henning Kamp #include <sys/module.h>
598e96e13eSMaxim Sobolev #include <sys/mbuf.h>
608e96e13eSMaxim Sobolev #include <sys/protosw.h>
618e96e13eSMaxim Sobolev #include <sys/socket.h>
628e96e13eSMaxim Sobolev #include <sys/sockio.h>
638e96e13eSMaxim Sobolev #include <sys/sysctl.h>
641b861caaSBruce Evans #include <sys/systm.h>
658e96e13eSMaxim Sobolev 
668e96e13eSMaxim Sobolev #include <net/ethernet.h>
678e96e13eSMaxim Sobolev #include <net/if.h>
68f889d2efSBrooks Davis #include <net/if_clone.h>
698e96e13eSMaxim Sobolev #include <net/if_types.h>
708e96e13eSMaxim Sobolev #include <net/route.h>
718e96e13eSMaxim Sobolev 
728e96e13eSMaxim Sobolev #ifdef INET
738e96e13eSMaxim Sobolev #include <netinet/in.h>
748e96e13eSMaxim Sobolev #include <netinet/in_systm.h>
758e96e13eSMaxim Sobolev #include <netinet/in_var.h>
768e96e13eSMaxim Sobolev #include <netinet/ip.h>
778e96e13eSMaxim Sobolev #include <netinet/ip_gre.h>
788e96e13eSMaxim Sobolev #include <netinet/ip_var.h>
798e96e13eSMaxim Sobolev #include <netinet/ip_encap.h>
808e96e13eSMaxim Sobolev #else
818e96e13eSMaxim Sobolev #error "Huh? if_gre without inet?"
828e96e13eSMaxim Sobolev #endif
838e96e13eSMaxim Sobolev 
848e96e13eSMaxim Sobolev #include <net/bpf.h>
858e96e13eSMaxim Sobolev 
868e96e13eSMaxim Sobolev #include <net/net_osdep.h>
878e96e13eSMaxim Sobolev #include <net/if_gre.h>
888e96e13eSMaxim Sobolev 
898e96e13eSMaxim Sobolev /*
908e96e13eSMaxim Sobolev  * It is not easy to calculate the right value for a GRE MTU.
918e96e13eSMaxim Sobolev  * We leave this task to the admin and use the same default that
928e96e13eSMaxim Sobolev  * other vendors use.
938e96e13eSMaxim Sobolev  */
948e96e13eSMaxim Sobolev #define GREMTU	1476
958e96e13eSMaxim Sobolev 
968e96e13eSMaxim Sobolev #define GRENAME	"gre"
978e96e13eSMaxim Sobolev 
98bdae44a8SRobert Watson /*
99bdae44a8SRobert Watson  * gre_mtx protects all global variables in if_gre.c.
100bdae44a8SRobert Watson  * XXX: gre_softc data not protected yet.
101bdae44a8SRobert Watson  */
102bdae44a8SRobert Watson struct mtx gre_mtx;
1038e96e13eSMaxim Sobolev static MALLOC_DEFINE(M_GRE, GRENAME, "Generic Routing Encapsulation");
1048e96e13eSMaxim Sobolev 
1058e96e13eSMaxim Sobolev struct gre_softc_head gre_softc_list;
1068e96e13eSMaxim Sobolev 
1079ee35470SAlfred Perlstein static int	gre_clone_create(struct if_clone *, int);
1089ee35470SAlfred Perlstein static void	gre_clone_destroy(struct ifnet *);
109c23d234cSMaxim Sobolev static int	gre_ioctl(struct ifnet *, u_long, caddr_t);
110c23d234cSMaxim Sobolev static int	gre_output(struct ifnet *, struct mbuf *, struct sockaddr *,
111c23d234cSMaxim Sobolev 		    struct rtentry *rt);
1128e96e13eSMaxim Sobolev 
113f889d2efSBrooks Davis IFC_SIMPLE_DECLARE(gre, 0);
1148e96e13eSMaxim Sobolev 
115c23d234cSMaxim Sobolev static int gre_compute_route(struct gre_softc *sc);
1168e96e13eSMaxim Sobolev 
1179ee35470SAlfred Perlstein static void	greattach(void);
1188e96e13eSMaxim Sobolev 
1198e96e13eSMaxim Sobolev #ifdef INET
1208e96e13eSMaxim Sobolev extern struct domain inetdomain;
1218e96e13eSMaxim Sobolev static const struct protosw in_gre_protosw =
1228e96e13eSMaxim Sobolev { SOCK_RAW,     &inetdomain,    IPPROTO_GRE,    PR_ATOMIC|PR_ADDR,
1238e96e13eSMaxim Sobolev   (pr_input_t*)gre_input, (pr_output_t*)rip_output, rip_ctlinput, rip_ctloutput,
1248e96e13eSMaxim Sobolev   0,
1258e96e13eSMaxim Sobolev   0,		0,		0,		0,
1268e96e13eSMaxim Sobolev   &rip_usrreqs
1278e96e13eSMaxim Sobolev };
1288e96e13eSMaxim Sobolev static const struct protosw in_mobile_protosw =
1298e96e13eSMaxim Sobolev { SOCK_RAW,     &inetdomain,    IPPROTO_MOBILE, PR_ATOMIC|PR_ADDR,
1308e96e13eSMaxim Sobolev   (pr_input_t*)gre_mobile_input, (pr_output_t*)rip_output, rip_ctlinput, rip_ctloutput,
1318e96e13eSMaxim Sobolev   0,
1328e96e13eSMaxim Sobolev   0,		0,		0,		0,
1338e96e13eSMaxim Sobolev   &rip_usrreqs
1348e96e13eSMaxim Sobolev };
1358e96e13eSMaxim Sobolev #endif
1368e96e13eSMaxim Sobolev 
1378e96e13eSMaxim Sobolev SYSCTL_DECL(_net_link);
1381d3bcf35SBruce M Simpson SYSCTL_NODE(_net_link, IFT_TUNNEL, gre, CTLFLAG_RW, 0,
1398e96e13eSMaxim Sobolev     "Generic Routing Encapsulation");
1408e96e13eSMaxim Sobolev #ifndef MAX_GRE_NEST
1418e96e13eSMaxim Sobolev /*
1428e96e13eSMaxim Sobolev  * This macro controls the default upper limitation on nesting of gre tunnels.
1438e96e13eSMaxim Sobolev  * Since, setting a large value to this macro with a careless configuration
1448e96e13eSMaxim Sobolev  * may introduce system crash, we don't allow any nestings by default.
1458e96e13eSMaxim Sobolev  * If you need to configure nested gre tunnels, you can define this macro
1468e96e13eSMaxim Sobolev  * in your kernel configuration file.  However, if you do so, please be
1478e96e13eSMaxim Sobolev  * careful to configure the tunnels so that it won't make a loop.
1488e96e13eSMaxim Sobolev  */
1498e96e13eSMaxim Sobolev #define MAX_GRE_NEST 1
1508e96e13eSMaxim Sobolev #endif
1518e96e13eSMaxim Sobolev static int max_gre_nesting = MAX_GRE_NEST;
1528e96e13eSMaxim Sobolev SYSCTL_INT(_net_link_gre, OID_AUTO, max_nesting, CTLFLAG_RW,
1538e96e13eSMaxim Sobolev     &max_gre_nesting, 0, "Max nested tunnels");
1548e96e13eSMaxim Sobolev 
1558e96e13eSMaxim Sobolev /* ARGSUSED */
156c23d234cSMaxim Sobolev static void
1578e96e13eSMaxim Sobolev greattach(void)
1588e96e13eSMaxim Sobolev {
1598e96e13eSMaxim Sobolev 
160bdae44a8SRobert Watson 	mtx_init(&gre_mtx, "gre_mtx", NULL, MTX_DEF);
1618e96e13eSMaxim Sobolev 	LIST_INIT(&gre_softc_list);
1628e96e13eSMaxim Sobolev 	if_clone_attach(&gre_cloner);
1638e96e13eSMaxim Sobolev }
1648e96e13eSMaxim Sobolev 
165c23d234cSMaxim Sobolev static int
1668e96e13eSMaxim Sobolev gre_clone_create(ifc, unit)
1678e96e13eSMaxim Sobolev 	struct if_clone *ifc;
1688e96e13eSMaxim Sobolev 	int unit;
1698e96e13eSMaxim Sobolev {
1708e96e13eSMaxim Sobolev 	struct gre_softc *sc;
1718e96e13eSMaxim Sobolev 
172b3c9a01eSBruce M Simpson 	sc = malloc(sizeof(struct gre_softc), M_GRE, M_WAITOK | M_ZERO);
1738e96e13eSMaxim Sobolev 
174066b192eSBjoern A. Zeeb 	GRE2IFP(sc) = if_alloc(IFT_TUNNEL);
175066b192eSBjoern A. Zeeb 	if (GRE2IFP(sc) == NULL) {
176066b192eSBjoern A. Zeeb 		free(sc, M_GRE);
177066b192eSBjoern A. Zeeb 		return (ENOSPC);
178066b192eSBjoern A. Zeeb 	}
179066b192eSBjoern A. Zeeb 
180fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_softc = sc;
181066b192eSBjoern A. Zeeb 	if_initname(GRE2IFP(sc), ifc->ifc_name, unit);
182066b192eSBjoern A. Zeeb 
183fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_snd.ifq_maxlen = IFQ_MAXLEN;
184fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_addrlen = 0;
185fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_hdrlen = 24; /* IP + GRE */
186fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_mtu = GREMTU;
187fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_flags = IFF_POINTOPOINT|IFF_MULTICAST;
188fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_output = gre_output;
189fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_ioctl = gre_ioctl;
1908e96e13eSMaxim Sobolev 	sc->g_dst.s_addr = sc->g_src.s_addr = INADDR_ANY;
1918e96e13eSMaxim Sobolev 	sc->g_proto = IPPROTO_GRE;
192fc74a9f9SBrooks Davis 	GRE2IFP(sc)->if_flags |= IFF_LINK0;
1938e96e13eSMaxim Sobolev 	sc->encap = NULL;
1948e96e13eSMaxim Sobolev 	sc->called = 0;
1957735aeb9SMaxim Sobolev 	sc->wccp_ver = WCCP_V1;
196fc74a9f9SBrooks Davis 	if_attach(GRE2IFP(sc));
197fc74a9f9SBrooks Davis 	bpfattach(GRE2IFP(sc), DLT_NULL, sizeof(u_int32_t));
198bdae44a8SRobert Watson 	mtx_lock(&gre_mtx);
1998e96e13eSMaxim Sobolev 	LIST_INSERT_HEAD(&gre_softc_list, sc, sc_list);
200bdae44a8SRobert Watson 	mtx_unlock(&gre_mtx);
2018e96e13eSMaxim Sobolev 	return (0);
2028e96e13eSMaxim Sobolev }
2038e96e13eSMaxim Sobolev 
204c23d234cSMaxim Sobolev static void
2058e96e13eSMaxim Sobolev gre_clone_destroy(ifp)
2068e96e13eSMaxim Sobolev 	struct ifnet *ifp;
2078e96e13eSMaxim Sobolev {
2088e96e13eSMaxim Sobolev 	struct gre_softc *sc = ifp->if_softc;
2098e96e13eSMaxim Sobolev 
210bdae44a8SRobert Watson 	mtx_lock(&gre_mtx);
2118e96e13eSMaxim Sobolev 	LIST_REMOVE(sc, sc_list);
212bdae44a8SRobert Watson 	mtx_unlock(&gre_mtx);
213febd0759SAndrew Thompson 
214febd0759SAndrew Thompson #ifdef INET
215febd0759SAndrew Thompson 	if (sc->encap != NULL)
216febd0759SAndrew Thompson 		encap_detach(sc->encap);
217febd0759SAndrew Thompson #endif
218febd0759SAndrew Thompson 	bpfdetach(ifp);
219febd0759SAndrew Thompson 	if_detach(ifp);
220febd0759SAndrew Thompson 	if_free(ifp);
221febd0759SAndrew Thompson 	free(sc, M_GRE);
2228e96e13eSMaxim Sobolev }
2238e96e13eSMaxim Sobolev 
2248e96e13eSMaxim Sobolev /*
2258e96e13eSMaxim Sobolev  * The output routine. Takes a packet and encapsulates it in the protocol
2268e96e13eSMaxim Sobolev  * given by sc->g_proto. See also RFC 1701 and RFC 2004
2278e96e13eSMaxim Sobolev  */
228c23d234cSMaxim Sobolev static int
2298e96e13eSMaxim Sobolev gre_output(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
2308e96e13eSMaxim Sobolev 	   struct rtentry *rt)
2318e96e13eSMaxim Sobolev {
2328e96e13eSMaxim Sobolev 	int error = 0;
2338e96e13eSMaxim Sobolev 	struct gre_softc *sc = ifp->if_softc;
2348e96e13eSMaxim Sobolev 	struct greip *gh;
2358e96e13eSMaxim Sobolev 	struct ip *ip;
2369e669156SBjoern A. Zeeb 	u_short ip_id = 0;
2379e669156SBjoern A. Zeeb 	uint8_t ip_tos = 0;
23873d7ddbcSMaxim Sobolev 	u_int16_t etype = 0;
2398e96e13eSMaxim Sobolev 	struct mobile_h mob_h;
24001399f34SDavid Malone 	u_int32_t af;
2418e96e13eSMaxim Sobolev 
2428e96e13eSMaxim Sobolev 	/*
2438e96e13eSMaxim Sobolev 	 * gre may cause infinite recursion calls when misconfigured.
2448e96e13eSMaxim Sobolev 	 * We'll prevent this by introducing upper limit.
2458e96e13eSMaxim Sobolev 	 */
2468e96e13eSMaxim Sobolev 	if (++(sc->called) > max_gre_nesting) {
2478e96e13eSMaxim Sobolev 		printf("%s: gre_output: recursively called too many "
248fc74a9f9SBrooks Davis 		       "times(%d)\n", if_name(GRE2IFP(sc)), sc->called);
2498e96e13eSMaxim Sobolev 		m_freem(m);
2508e96e13eSMaxim Sobolev 		error = EIO;    /* is there better errno? */
2518e96e13eSMaxim Sobolev 		goto end;
2528e96e13eSMaxim Sobolev 	}
2538e96e13eSMaxim Sobolev 
25413f4c340SRobert Watson 	if (!((ifp->if_flags & IFF_UP) &&
25513f4c340SRobert Watson 	    (ifp->if_drv_flags & IFF_DRV_RUNNING)) ||
2568e96e13eSMaxim Sobolev 	    sc->g_src.s_addr == INADDR_ANY || sc->g_dst.s_addr == INADDR_ANY) {
2578e96e13eSMaxim Sobolev 		m_freem(m);
2588e96e13eSMaxim Sobolev 		error = ENETDOWN;
2598e96e13eSMaxim Sobolev 		goto end;
2608e96e13eSMaxim Sobolev 	}
2618e96e13eSMaxim Sobolev 
2628e96e13eSMaxim Sobolev 	gh = NULL;
2638e96e13eSMaxim Sobolev 	ip = NULL;
2648e96e13eSMaxim Sobolev 
26501399f34SDavid Malone 	/* BPF writes need to be handled specially. */
26601399f34SDavid Malone 	if (dst->sa_family == AF_UNSPEC) {
26701399f34SDavid Malone 		bcopy(dst->sa_data, &af, sizeof(af));
26801399f34SDavid Malone 		dst->sa_family = af;
26901399f34SDavid Malone 	}
27001399f34SDavid Malone 
2718e96e13eSMaxim Sobolev 	if (ifp->if_bpf) {
27201399f34SDavid Malone 		af = dst->sa_family;
273437ffe18SSam Leffler 		bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m);
2748e96e13eSMaxim Sobolev 	}
2758e96e13eSMaxim Sobolev 
2768e96e13eSMaxim Sobolev 	m->m_flags &= ~(M_BCAST|M_MCAST);
2778e96e13eSMaxim Sobolev 
2788e96e13eSMaxim Sobolev 	if (sc->g_proto == IPPROTO_MOBILE) {
2798e96e13eSMaxim Sobolev 		if (dst->sa_family == AF_INET) {
2808e96e13eSMaxim Sobolev 			struct mbuf *m0;
2818e96e13eSMaxim Sobolev 			int msiz;
2828e96e13eSMaxim Sobolev 
2838e96e13eSMaxim Sobolev 			ip = mtod(m, struct ip *);
2848e96e13eSMaxim Sobolev 
2858e96e13eSMaxim Sobolev 			/*
2868e96e13eSMaxim Sobolev 			 * RFC2004 specifies that fragmented diagrams shouldn't
2878e96e13eSMaxim Sobolev 			 * be encapsulated.
2888e96e13eSMaxim Sobolev 			 */
2898e96e13eSMaxim Sobolev 			if ((ip->ip_off & IP_MF) != 0) {
2908e96e13eSMaxim Sobolev 				_IF_DROP(&ifp->if_snd);
2918e96e13eSMaxim Sobolev 				m_freem(m);
2928e96e13eSMaxim Sobolev 				error = EINVAL;    /* is there better errno? */
2938e96e13eSMaxim Sobolev 				goto end;
2948e96e13eSMaxim Sobolev 			}
2958e96e13eSMaxim Sobolev 			memset(&mob_h, 0, MOB_H_SIZ_L);
2968e96e13eSMaxim Sobolev 			mob_h.proto = (ip->ip_p) << 8;
2978e96e13eSMaxim Sobolev 			mob_h.odst = ip->ip_dst.s_addr;
2988e96e13eSMaxim Sobolev 			ip->ip_dst.s_addr = sc->g_dst.s_addr;
2998e96e13eSMaxim Sobolev 
3008e96e13eSMaxim Sobolev 			/*
3018e96e13eSMaxim Sobolev 			 * If the packet comes from our host, we only change
3028e96e13eSMaxim Sobolev 			 * the destination address in the IP header.
3038e96e13eSMaxim Sobolev 			 * Else we also need to save and change the source
3048e96e13eSMaxim Sobolev 			 */
3058e96e13eSMaxim Sobolev 			if (in_hosteq(ip->ip_src, sc->g_src)) {
3068e96e13eSMaxim Sobolev 				msiz = MOB_H_SIZ_S;
3078e96e13eSMaxim Sobolev 			} else {
3088e96e13eSMaxim Sobolev 				mob_h.proto |= MOB_H_SBIT;
3098e96e13eSMaxim Sobolev 				mob_h.osrc = ip->ip_src.s_addr;
3108e96e13eSMaxim Sobolev 				ip->ip_src.s_addr = sc->g_src.s_addr;
3118e96e13eSMaxim Sobolev 				msiz = MOB_H_SIZ_L;
3128e96e13eSMaxim Sobolev 			}
3138e96e13eSMaxim Sobolev 			mob_h.proto = htons(mob_h.proto);
31473d7ddbcSMaxim Sobolev 			mob_h.hcrc = gre_in_cksum((u_int16_t *)&mob_h, msiz);
3158e96e13eSMaxim Sobolev 
3168e96e13eSMaxim Sobolev 			if ((m->m_data - msiz) < m->m_pktdat) {
3178e96e13eSMaxim Sobolev 				/* need new mbuf */
318a163d034SWarner Losh 				MGETHDR(m0, M_DONTWAIT, MT_HEADER);
3198e96e13eSMaxim Sobolev 				if (m0 == NULL) {
3208e96e13eSMaxim Sobolev 					_IF_DROP(&ifp->if_snd);
3218e96e13eSMaxim Sobolev 					m_freem(m);
3228e96e13eSMaxim Sobolev 					error = ENOBUFS;
3238e96e13eSMaxim Sobolev 					goto end;
3248e96e13eSMaxim Sobolev 				}
3258e96e13eSMaxim Sobolev 				m0->m_next = m;
3268e96e13eSMaxim Sobolev 				m->m_data += sizeof(struct ip);
3278e96e13eSMaxim Sobolev 				m->m_len -= sizeof(struct ip);
3288e96e13eSMaxim Sobolev 				m0->m_pkthdr.len = m->m_pkthdr.len + msiz;
3298e96e13eSMaxim Sobolev 				m0->m_len = msiz + sizeof(struct ip);
3308e96e13eSMaxim Sobolev 				m0->m_data += max_linkhdr;
3318e96e13eSMaxim Sobolev 				memcpy(mtod(m0, caddr_t), (caddr_t)ip,
3328e96e13eSMaxim Sobolev 				       sizeof(struct ip));
3338e96e13eSMaxim Sobolev 				m = m0;
3348e96e13eSMaxim Sobolev 			} else {  /* we have some space left in the old one */
3358e96e13eSMaxim Sobolev 				m->m_data -= msiz;
3368e96e13eSMaxim Sobolev 				m->m_len += msiz;
3378e96e13eSMaxim Sobolev 				m->m_pkthdr.len += msiz;
3388e96e13eSMaxim Sobolev 				bcopy(ip, mtod(m, caddr_t),
3398e96e13eSMaxim Sobolev 					sizeof(struct ip));
3408e96e13eSMaxim Sobolev 			}
3418e96e13eSMaxim Sobolev 			ip = mtod(m, struct ip *);
3428e96e13eSMaxim Sobolev 			memcpy((caddr_t)(ip + 1), &mob_h, (unsigned)msiz);
3438e96e13eSMaxim Sobolev 			ip->ip_len = ntohs(ip->ip_len) + msiz;
3448e96e13eSMaxim Sobolev 		} else {  /* AF_INET */
3458e96e13eSMaxim Sobolev 			_IF_DROP(&ifp->if_snd);
3468e96e13eSMaxim Sobolev 			m_freem(m);
3478e96e13eSMaxim Sobolev 			error = EINVAL;
3488e96e13eSMaxim Sobolev 			goto end;
3498e96e13eSMaxim Sobolev 		}
3508e96e13eSMaxim Sobolev 	} else if (sc->g_proto == IPPROTO_GRE) {
3518e96e13eSMaxim Sobolev 		switch (dst->sa_family) {
3528e96e13eSMaxim Sobolev 		case AF_INET:
3538e96e13eSMaxim Sobolev 			ip = mtod(m, struct ip *);
3549e669156SBjoern A. Zeeb 			ip_tos = ip->ip_tos;
3559e669156SBjoern A. Zeeb 			ip_id = ip->ip_id;
3568e96e13eSMaxim Sobolev 			etype = ETHERTYPE_IP;
3578e96e13eSMaxim Sobolev 			break;
3589e669156SBjoern A. Zeeb #ifdef INET6
3599e669156SBjoern A. Zeeb 		case AF_INET6:
3609e669156SBjoern A. Zeeb 			ip_id = ip_newid();
3619e669156SBjoern A. Zeeb 			etype = ETHERTYPE_IPV6;
3629e669156SBjoern A. Zeeb 			break;
3639e669156SBjoern A. Zeeb #endif
3648e96e13eSMaxim Sobolev #ifdef NETATALK
3658e96e13eSMaxim Sobolev 		case AF_APPLETALK:
3668e96e13eSMaxim Sobolev 			etype = ETHERTYPE_ATALK;
3678e96e13eSMaxim Sobolev 			break;
3688e96e13eSMaxim Sobolev #endif
3698e96e13eSMaxim Sobolev 		default:
3708e96e13eSMaxim Sobolev 			_IF_DROP(&ifp->if_snd);
3718e96e13eSMaxim Sobolev 			m_freem(m);
3728e96e13eSMaxim Sobolev 			error = EAFNOSUPPORT;
3738e96e13eSMaxim Sobolev 			goto end;
3748e96e13eSMaxim Sobolev 		}
375a163d034SWarner Losh 		M_PREPEND(m, sizeof(struct greip), M_DONTWAIT);
3768e96e13eSMaxim Sobolev 	} else {
3778e96e13eSMaxim Sobolev 		_IF_DROP(&ifp->if_snd);
3788e96e13eSMaxim Sobolev 		m_freem(m);
3798e96e13eSMaxim Sobolev 		error = EINVAL;
3808e96e13eSMaxim Sobolev 		goto end;
3818e96e13eSMaxim Sobolev 	}
3828e96e13eSMaxim Sobolev 
3835efdd80aSAndre Oppermann 	if (m == NULL) {	/* mbuf allocation failed */
3848e96e13eSMaxim Sobolev 		_IF_DROP(&ifp->if_snd);
3858e96e13eSMaxim Sobolev 		error = ENOBUFS;
3868e96e13eSMaxim Sobolev 		goto end;
3878e96e13eSMaxim Sobolev 	}
3888e96e13eSMaxim Sobolev 
3898e96e13eSMaxim Sobolev 	gh = mtod(m, struct greip *);
3908e96e13eSMaxim Sobolev 	if (sc->g_proto == IPPROTO_GRE) {
3918e96e13eSMaxim Sobolev 		/* we don't have any GRE flags for now */
3924c837892SMaxim Sobolev 		memset((void *)gh, 0, sizeof(struct greip));
3938e96e13eSMaxim Sobolev 		gh->gi_ptype = htons(etype);
3948e96e13eSMaxim Sobolev 	}
3958e96e13eSMaxim Sobolev 
3968e96e13eSMaxim Sobolev 	gh->gi_pr = sc->g_proto;
3978e96e13eSMaxim Sobolev 	if (sc->g_proto != IPPROTO_MOBILE) {
3988e96e13eSMaxim Sobolev 		gh->gi_src = sc->g_src;
3998e96e13eSMaxim Sobolev 		gh->gi_dst = sc->g_dst;
40097c4cd98SMaxim Sobolev 		((struct ip*)gh)->ip_v = IPPROTO_IPV4;
4018e96e13eSMaxim Sobolev 		((struct ip*)gh)->ip_hl = (sizeof(struct ip)) >> 2;
402c23d234cSMaxim Sobolev 		((struct ip*)gh)->ip_ttl = GRE_TTL;
4039e669156SBjoern A. Zeeb 		((struct ip*)gh)->ip_tos = ip_tos;
4049e669156SBjoern A. Zeeb 		((struct ip*)gh)->ip_id = ip_id;
4054c837892SMaxim Sobolev 		gh->gi_len = m->m_pkthdr.len;
4068e96e13eSMaxim Sobolev 	}
4078e96e13eSMaxim Sobolev 
4088e96e13eSMaxim Sobolev 	ifp->if_opackets++;
4098e96e13eSMaxim Sobolev 	ifp->if_obytes += m->m_pkthdr.len;
4108b75eec1SAndre Oppermann 	/*
4118b75eec1SAndre Oppermann 	 * Send it off and with IP_FORWARD flag to prevent it from
4128b75eec1SAndre Oppermann 	 * overwriting the ip_id again.  ip_id is already set to the
4138b75eec1SAndre Oppermann 	 * ip_id of the encapsulated packet.
4148b75eec1SAndre Oppermann 	 */
4155efdd80aSAndre Oppermann 	error = ip_output(m, NULL, &sc->route, IP_FORWARDING,
41673d7ddbcSMaxim Sobolev 	    (struct ip_moptions *)NULL, (struct inpcb *)NULL);
4178e96e13eSMaxim Sobolev   end:
4188e96e13eSMaxim Sobolev 	sc->called = 0;
4198e96e13eSMaxim Sobolev 	if (error)
4208e96e13eSMaxim Sobolev 		ifp->if_oerrors++;
4218e96e13eSMaxim Sobolev 	return (error);
4228e96e13eSMaxim Sobolev }
4238e96e13eSMaxim Sobolev 
424c23d234cSMaxim Sobolev static int
4258e96e13eSMaxim Sobolev gre_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
4268e96e13eSMaxim Sobolev {
4278e96e13eSMaxim Sobolev 	struct ifreq *ifr = (struct ifreq *)data;
4288e96e13eSMaxim Sobolev 	struct if_laddrreq *lifr = (struct if_laddrreq *)data;
4298e96e13eSMaxim Sobolev 	struct in_aliasreq *aifr = (struct in_aliasreq *)data;
4308e96e13eSMaxim Sobolev 	struct gre_softc *sc = ifp->if_softc;
4318e96e13eSMaxim Sobolev 	int s;
4328e96e13eSMaxim Sobolev 	struct sockaddr_in si;
4338e96e13eSMaxim Sobolev 	struct sockaddr *sa = NULL;
4348e96e13eSMaxim Sobolev 	int error;
4358e96e13eSMaxim Sobolev 	struct sockaddr_in sp, sm, dp, dm;
4368e96e13eSMaxim Sobolev 
4378e96e13eSMaxim Sobolev 	error = 0;
4388e96e13eSMaxim Sobolev 
4398e96e13eSMaxim Sobolev 	s = splnet();
4408e96e13eSMaxim Sobolev 	switch (cmd) {
4418e96e13eSMaxim Sobolev 	case SIOCSIFADDR:
4428e96e13eSMaxim Sobolev 		ifp->if_flags |= IFF_UP;
4438e96e13eSMaxim Sobolev 		break;
4448e96e13eSMaxim Sobolev 	case SIOCSIFDSTADDR:
4458e96e13eSMaxim Sobolev 		break;
4468e96e13eSMaxim Sobolev 	case SIOCSIFFLAGS:
4478e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
4488e96e13eSMaxim Sobolev 			break;
4498e96e13eSMaxim Sobolev 		if ((ifr->ifr_flags & IFF_LINK0) != 0)
4508e96e13eSMaxim Sobolev 			sc->g_proto = IPPROTO_GRE;
4518e96e13eSMaxim Sobolev 		else
4528e96e13eSMaxim Sobolev 			sc->g_proto = IPPROTO_MOBILE;
4537735aeb9SMaxim Sobolev 		if ((ifr->ifr_flags & IFF_LINK2) != 0)
4547735aeb9SMaxim Sobolev 			sc->wccp_ver = WCCP_V2;
4557735aeb9SMaxim Sobolev 		else
4567735aeb9SMaxim Sobolev 			sc->wccp_ver = WCCP_V1;
4578e96e13eSMaxim Sobolev 		goto recompute;
4588e96e13eSMaxim Sobolev 	case SIOCSIFMTU:
4598e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
4608e96e13eSMaxim Sobolev 			break;
4618e96e13eSMaxim Sobolev 		if (ifr->ifr_mtu < 576) {
4628e96e13eSMaxim Sobolev 			error = EINVAL;
4638e96e13eSMaxim Sobolev 			break;
4648e96e13eSMaxim Sobolev 		}
4658e96e13eSMaxim Sobolev 		ifp->if_mtu = ifr->ifr_mtu;
4668e96e13eSMaxim Sobolev 		break;
4678e96e13eSMaxim Sobolev 	case SIOCGIFMTU:
468fc74a9f9SBrooks Davis 		ifr->ifr_mtu = GRE2IFP(sc)->if_mtu;
4698e96e13eSMaxim Sobolev 		break;
4708e96e13eSMaxim Sobolev 	case SIOCADDMULTI:
4718e96e13eSMaxim Sobolev 	case SIOCDELMULTI:
4728e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
4738e96e13eSMaxim Sobolev 			break;
4748e96e13eSMaxim Sobolev 		if (ifr == 0) {
4758e96e13eSMaxim Sobolev 			error = EAFNOSUPPORT;
4768e96e13eSMaxim Sobolev 			break;
4778e96e13eSMaxim Sobolev 		}
4788e96e13eSMaxim Sobolev 		switch (ifr->ifr_addr.sa_family) {
4798e96e13eSMaxim Sobolev #ifdef INET
4808e96e13eSMaxim Sobolev 		case AF_INET:
4818e96e13eSMaxim Sobolev 			break;
4828e96e13eSMaxim Sobolev #endif
4839e669156SBjoern A. Zeeb #ifdef INET6
4849e669156SBjoern A. Zeeb 		case AF_INET6:
4859e669156SBjoern A. Zeeb 			break;
4869e669156SBjoern A. Zeeb #endif
4878e96e13eSMaxim Sobolev 		default:
4888e96e13eSMaxim Sobolev 			error = EAFNOSUPPORT;
4898e96e13eSMaxim Sobolev 			break;
4908e96e13eSMaxim Sobolev 		}
4918e96e13eSMaxim Sobolev 		break;
4928e96e13eSMaxim Sobolev 	case GRESPROTO:
4938e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
4948e96e13eSMaxim Sobolev 			break;
4958e96e13eSMaxim Sobolev 		sc->g_proto = ifr->ifr_flags;
4968e96e13eSMaxim Sobolev 		switch (sc->g_proto) {
4978e96e13eSMaxim Sobolev 		case IPPROTO_GRE:
4988e96e13eSMaxim Sobolev 			ifp->if_flags |= IFF_LINK0;
4998e96e13eSMaxim Sobolev 			break;
5008e96e13eSMaxim Sobolev 		case IPPROTO_MOBILE:
5018e96e13eSMaxim Sobolev 			ifp->if_flags &= ~IFF_LINK0;
5028e96e13eSMaxim Sobolev 			break;
5038e96e13eSMaxim Sobolev 		default:
5048e96e13eSMaxim Sobolev 			error = EPROTONOSUPPORT;
5058e96e13eSMaxim Sobolev 			break;
5068e96e13eSMaxim Sobolev 		}
5078e96e13eSMaxim Sobolev 		goto recompute;
5088e96e13eSMaxim Sobolev 	case GREGPROTO:
5098e96e13eSMaxim Sobolev 		ifr->ifr_flags = sc->g_proto;
5108e96e13eSMaxim Sobolev 		break;
5118e96e13eSMaxim Sobolev 	case GRESADDRS:
5128e96e13eSMaxim Sobolev 	case GRESADDRD:
5138e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
5148e96e13eSMaxim Sobolev 			break;
5158e96e13eSMaxim Sobolev 		/*
5168e96e13eSMaxim Sobolev 		 * set tunnel endpoints, compute a less specific route
5178e96e13eSMaxim Sobolev 		 * to the remote end and mark if as up
5188e96e13eSMaxim Sobolev 		 */
5198e96e13eSMaxim Sobolev 		sa = &ifr->ifr_addr;
5208e96e13eSMaxim Sobolev 		if (cmd == GRESADDRS)
5218e96e13eSMaxim Sobolev 			sc->g_src = (satosin(sa))->sin_addr;
5228e96e13eSMaxim Sobolev 		if (cmd == GRESADDRD)
5238e96e13eSMaxim Sobolev 			sc->g_dst = (satosin(sa))->sin_addr;
5248e96e13eSMaxim Sobolev 	recompute:
5258e96e13eSMaxim Sobolev #ifdef INET
5268e96e13eSMaxim Sobolev 		if (sc->encap != NULL) {
5278e96e13eSMaxim Sobolev 			encap_detach(sc->encap);
5288e96e13eSMaxim Sobolev 			sc->encap = NULL;
5298e96e13eSMaxim Sobolev 		}
5308e96e13eSMaxim Sobolev #endif
5318e96e13eSMaxim Sobolev 		if ((sc->g_src.s_addr != INADDR_ANY) &&
5328e96e13eSMaxim Sobolev 		    (sc->g_dst.s_addr != INADDR_ANY)) {
5338e96e13eSMaxim Sobolev 			bzero(&sp, sizeof(sp));
5348e96e13eSMaxim Sobolev 			bzero(&sm, sizeof(sm));
5358e96e13eSMaxim Sobolev 			bzero(&dp, sizeof(dp));
5368e96e13eSMaxim Sobolev 			bzero(&dm, sizeof(dm));
5378e96e13eSMaxim Sobolev 			sp.sin_len = sm.sin_len = dp.sin_len = dm.sin_len =
5388e96e13eSMaxim Sobolev 			    sizeof(struct sockaddr_in);
5398e96e13eSMaxim Sobolev 			sp.sin_family = sm.sin_family = dp.sin_family =
5408e96e13eSMaxim Sobolev 			    dm.sin_family = AF_INET;
5418e96e13eSMaxim Sobolev 			sp.sin_addr = sc->g_src;
5428e96e13eSMaxim Sobolev 			dp.sin_addr = sc->g_dst;
5438e96e13eSMaxim Sobolev 			sm.sin_addr.s_addr = dm.sin_addr.s_addr =
5448e96e13eSMaxim Sobolev 			    INADDR_BROADCAST;
5458e96e13eSMaxim Sobolev #ifdef INET
5468e96e13eSMaxim Sobolev 			sc->encap = encap_attach(AF_INET, sc->g_proto,
5478e96e13eSMaxim Sobolev 			    sintosa(&sp), sintosa(&sm), sintosa(&dp),
5488e96e13eSMaxim Sobolev 			    sintosa(&dm), (sc->g_proto == IPPROTO_GRE) ?
5498e96e13eSMaxim Sobolev 				&in_gre_protosw : &in_mobile_protosw, sc);
5508e96e13eSMaxim Sobolev 			if (sc->encap == NULL)
5518e96e13eSMaxim Sobolev 				printf("%s: unable to attach encap\n",
552fc74a9f9SBrooks Davis 				    if_name(GRE2IFP(sc)));
5538e96e13eSMaxim Sobolev #endif
5548e96e13eSMaxim Sobolev 			if (sc->route.ro_rt != 0) /* free old route */
5558e96e13eSMaxim Sobolev 				RTFREE(sc->route.ro_rt);
5568e96e13eSMaxim Sobolev 			if (gre_compute_route(sc) == 0)
55713f4c340SRobert Watson 				ifp->if_drv_flags |= IFF_DRV_RUNNING;
5588e96e13eSMaxim Sobolev 			else
55913f4c340SRobert Watson 				ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
5608e96e13eSMaxim Sobolev 		}
5618e96e13eSMaxim Sobolev 		break;
5628e96e13eSMaxim Sobolev 	case GREGADDRS:
5638e96e13eSMaxim Sobolev 		memset(&si, 0, sizeof(si));
5648e96e13eSMaxim Sobolev 		si.sin_family = AF_INET;
5658e96e13eSMaxim Sobolev 		si.sin_len = sizeof(struct sockaddr_in);
5668e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_src.s_addr;
5678e96e13eSMaxim Sobolev 		sa = sintosa(&si);
5688e96e13eSMaxim Sobolev 		ifr->ifr_addr = *sa;
5698e96e13eSMaxim Sobolev 		break;
5708e96e13eSMaxim Sobolev 	case GREGADDRD:
5718e96e13eSMaxim Sobolev 		memset(&si, 0, sizeof(si));
5728e96e13eSMaxim Sobolev 		si.sin_family = AF_INET;
5738e96e13eSMaxim Sobolev 		si.sin_len = sizeof(struct sockaddr_in);
5748e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_dst.s_addr;
5758e96e13eSMaxim Sobolev 		sa = sintosa(&si);
5768e96e13eSMaxim Sobolev 		ifr->ifr_addr = *sa;
5778e96e13eSMaxim Sobolev 		break;
5788e96e13eSMaxim Sobolev 	case SIOCSIFPHYADDR:
5798e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
5808e96e13eSMaxim Sobolev 			break;
5818e96e13eSMaxim Sobolev 		if (aifr->ifra_addr.sin_family != AF_INET ||
5828e96e13eSMaxim Sobolev 		    aifr->ifra_dstaddr.sin_family != AF_INET) {
5838e96e13eSMaxim Sobolev 			error = EAFNOSUPPORT;
5848e96e13eSMaxim Sobolev 			break;
5858e96e13eSMaxim Sobolev 		}
5868e96e13eSMaxim Sobolev 		if (aifr->ifra_addr.sin_len != sizeof(si) ||
5878e96e13eSMaxim Sobolev 		    aifr->ifra_dstaddr.sin_len != sizeof(si)) {
5888e96e13eSMaxim Sobolev 			error = EINVAL;
5898e96e13eSMaxim Sobolev 			break;
5908e96e13eSMaxim Sobolev 		}
5918e96e13eSMaxim Sobolev 		sc->g_src = aifr->ifra_addr.sin_addr;
5928e96e13eSMaxim Sobolev 		sc->g_dst = aifr->ifra_dstaddr.sin_addr;
5938e96e13eSMaxim Sobolev 		goto recompute;
5948e96e13eSMaxim Sobolev 	case SIOCSLIFPHYADDR:
5958e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
5968e96e13eSMaxim Sobolev 			break;
5978e96e13eSMaxim Sobolev 		if (lifr->addr.ss_family != AF_INET ||
5988e96e13eSMaxim Sobolev 		    lifr->dstaddr.ss_family != AF_INET) {
5998e96e13eSMaxim Sobolev 			error = EAFNOSUPPORT;
6008e96e13eSMaxim Sobolev 			break;
6018e96e13eSMaxim Sobolev 		}
6028e96e13eSMaxim Sobolev 		if (lifr->addr.ss_len != sizeof(si) ||
6038e96e13eSMaxim Sobolev 		    lifr->dstaddr.ss_len != sizeof(si)) {
6048e96e13eSMaxim Sobolev 			error = EINVAL;
6058e96e13eSMaxim Sobolev 			break;
6068e96e13eSMaxim Sobolev 		}
6078e96e13eSMaxim Sobolev 		sc->g_src = (satosin((struct sockadrr *)&lifr->addr))->sin_addr;
6088e96e13eSMaxim Sobolev 		sc->g_dst =
6098e96e13eSMaxim Sobolev 		    (satosin((struct sockadrr *)&lifr->dstaddr))->sin_addr;
6108e96e13eSMaxim Sobolev 		goto recompute;
6118e96e13eSMaxim Sobolev 	case SIOCDIFPHYADDR:
6128e96e13eSMaxim Sobolev 		if ((error = suser(curthread)) != 0)
6138e96e13eSMaxim Sobolev 			break;
6148e96e13eSMaxim Sobolev 		sc->g_src.s_addr = INADDR_ANY;
6158e96e13eSMaxim Sobolev 		sc->g_dst.s_addr = INADDR_ANY;
6168e96e13eSMaxim Sobolev 		goto recompute;
6178e96e13eSMaxim Sobolev 	case SIOCGLIFPHYADDR:
6188e96e13eSMaxim Sobolev 		if (sc->g_src.s_addr == INADDR_ANY ||
6198e96e13eSMaxim Sobolev 		    sc->g_dst.s_addr == INADDR_ANY) {
6208e96e13eSMaxim Sobolev 			error = EADDRNOTAVAIL;
6218e96e13eSMaxim Sobolev 			break;
6228e96e13eSMaxim Sobolev 		}
6238e96e13eSMaxim Sobolev 		memset(&si, 0, sizeof(si));
6248e96e13eSMaxim Sobolev 		si.sin_family = AF_INET;
6258e96e13eSMaxim Sobolev 		si.sin_len = sizeof(struct sockaddr_in);
6268e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_src.s_addr;
6278e96e13eSMaxim Sobolev 		memcpy(&lifr->addr, &si, sizeof(si));
6288e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_dst.s_addr;
6298e96e13eSMaxim Sobolev 		memcpy(&lifr->dstaddr, &si, sizeof(si));
6308e96e13eSMaxim Sobolev 		break;
6318e96e13eSMaxim Sobolev 	case SIOCGIFPSRCADDR:
632f16770aeSBruce M Simpson #ifdef INET6
633f16770aeSBruce M Simpson 	case SIOCGIFPSRCADDR_IN6:
634f16770aeSBruce M Simpson #endif
6358e96e13eSMaxim Sobolev 		if (sc->g_src.s_addr == INADDR_ANY) {
6368e96e13eSMaxim Sobolev 			error = EADDRNOTAVAIL;
6378e96e13eSMaxim Sobolev 			break;
6388e96e13eSMaxim Sobolev 		}
6398e96e13eSMaxim Sobolev 		memset(&si, 0, sizeof(si));
6408e96e13eSMaxim Sobolev 		si.sin_family = AF_INET;
6418e96e13eSMaxim Sobolev 		si.sin_len = sizeof(struct sockaddr_in);
6428e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_src.s_addr;
6438e96e13eSMaxim Sobolev 		bcopy(&si, &ifr->ifr_addr, sizeof(ifr->ifr_addr));
6448e96e13eSMaxim Sobolev 		break;
6458e96e13eSMaxim Sobolev 	case SIOCGIFPDSTADDR:
646f16770aeSBruce M Simpson #ifdef INET6
647f16770aeSBruce M Simpson 	case SIOCGIFPDSTADDR_IN6:
648f16770aeSBruce M Simpson #endif
6498e96e13eSMaxim Sobolev 		if (sc->g_dst.s_addr == INADDR_ANY) {
6508e96e13eSMaxim Sobolev 			error = EADDRNOTAVAIL;
6518e96e13eSMaxim Sobolev 			break;
6528e96e13eSMaxim Sobolev 		}
6538e96e13eSMaxim Sobolev 		memset(&si, 0, sizeof(si));
6548e96e13eSMaxim Sobolev 		si.sin_family = AF_INET;
6558e96e13eSMaxim Sobolev 		si.sin_len = sizeof(struct sockaddr_in);
6568e96e13eSMaxim Sobolev 		si.sin_addr.s_addr = sc->g_dst.s_addr;
6578e96e13eSMaxim Sobolev 		bcopy(&si, &ifr->ifr_addr, sizeof(ifr->ifr_addr));
6588e96e13eSMaxim Sobolev 		break;
6598e96e13eSMaxim Sobolev 	default:
6608e96e13eSMaxim Sobolev 		error = EINVAL;
6618e96e13eSMaxim Sobolev 		break;
6628e96e13eSMaxim Sobolev 	}
6638e96e13eSMaxim Sobolev 
6648e96e13eSMaxim Sobolev 	splx(s);
6658e96e13eSMaxim Sobolev 	return (error);
6668e96e13eSMaxim Sobolev }
6678e96e13eSMaxim Sobolev 
6688e96e13eSMaxim Sobolev /*
6698e96e13eSMaxim Sobolev  * computes a route to our destination that is not the one
6708e96e13eSMaxim Sobolev  * which would be taken by ip_output(), as this one will loop back to
6718e96e13eSMaxim Sobolev  * us. If the interface is p2p as  a--->b, then a routing entry exists
6728e96e13eSMaxim Sobolev  * If we now send a packet to b (e.g. ping b), this will come down here
67373d7ddbcSMaxim Sobolev  * gets src=a, dst=b tacked on and would from ip_output() sent back to
6748e96e13eSMaxim Sobolev  * if_gre.
6758e96e13eSMaxim Sobolev  * Goal here is to compute a route to b that is less specific than
6768e96e13eSMaxim Sobolev  * a-->b. We know that this one exists as in normal operation we have
6778e96e13eSMaxim Sobolev  * at least a default route which matches.
6788e96e13eSMaxim Sobolev  */
679c23d234cSMaxim Sobolev static int
6808e96e13eSMaxim Sobolev gre_compute_route(struct gre_softc *sc)
6818e96e13eSMaxim Sobolev {
6828e96e13eSMaxim Sobolev 	struct route *ro;
6838e96e13eSMaxim Sobolev 	u_int32_t a, b, c;
6848e96e13eSMaxim Sobolev 
6858e96e13eSMaxim Sobolev 	ro = &sc->route;
6868e96e13eSMaxim Sobolev 
6878e96e13eSMaxim Sobolev 	memset(ro, 0, sizeof(struct route));
6888e96e13eSMaxim Sobolev 	((struct sockaddr_in *)&ro->ro_dst)->sin_addr = sc->g_dst;
6898e96e13eSMaxim Sobolev 	ro->ro_dst.sa_family = AF_INET;
6908e96e13eSMaxim Sobolev 	ro->ro_dst.sa_len = sizeof(ro->ro_dst);
6918e96e13eSMaxim Sobolev 
6928e96e13eSMaxim Sobolev 	/*
6938e96e13eSMaxim Sobolev 	 * toggle last bit, so our interface is not found, but a less
6948e96e13eSMaxim Sobolev 	 * specific route. I'd rather like to specify a shorter mask,
6958e96e13eSMaxim Sobolev 	 * but this is not possible. Should work though. XXX
6968e96e13eSMaxim Sobolev 	 * there is a simpler way ...
6978e96e13eSMaxim Sobolev 	 */
698fc74a9f9SBrooks Davis 	if ((GRE2IFP(sc)->if_flags & IFF_LINK1) == 0) {
6998e96e13eSMaxim Sobolev 		a = ntohl(sc->g_dst.s_addr);
7008e96e13eSMaxim Sobolev 		b = a & 0x01;
7018e96e13eSMaxim Sobolev 		c = a & 0xfffffffe;
7028e96e13eSMaxim Sobolev 		b = b ^ 0x01;
7038e96e13eSMaxim Sobolev 		a = b | c;
7048e96e13eSMaxim Sobolev 		((struct sockaddr_in *)&ro->ro_dst)->sin_addr.s_addr
7058e96e13eSMaxim Sobolev 		    = htonl(a);
7068e96e13eSMaxim Sobolev 	}
7078e96e13eSMaxim Sobolev 
7088e96e13eSMaxim Sobolev #ifdef DIAGNOSTIC
709fc74a9f9SBrooks Davis 	printf("%s: searching for a route to %s", if_name(GRE2IFP(sc)),
7108e96e13eSMaxim Sobolev 	    inet_ntoa(((struct sockaddr_in *)&ro->ro_dst)->sin_addr));
7118e96e13eSMaxim Sobolev #endif
7128e96e13eSMaxim Sobolev 
7138e96e13eSMaxim Sobolev 	rtalloc(ro);
7148e96e13eSMaxim Sobolev 
7158e96e13eSMaxim Sobolev 	/*
7168e96e13eSMaxim Sobolev 	 * check if this returned a route at all and this route is no
7178e96e13eSMaxim Sobolev 	 * recursion to ourself
7188e96e13eSMaxim Sobolev 	 */
7198e96e13eSMaxim Sobolev 	if (ro->ro_rt == NULL || ro->ro_rt->rt_ifp->if_softc == sc) {
7208e96e13eSMaxim Sobolev #ifdef DIAGNOSTIC
7218e96e13eSMaxim Sobolev 		if (ro->ro_rt == NULL)
7228e96e13eSMaxim Sobolev 			printf(" - no route found!\n");
7238e96e13eSMaxim Sobolev 		else
7248e96e13eSMaxim Sobolev 			printf(" - route loops back to ourself!\n");
7258e96e13eSMaxim Sobolev #endif
7268e96e13eSMaxim Sobolev 		return EADDRNOTAVAIL;
7278e96e13eSMaxim Sobolev 	}
7288e96e13eSMaxim Sobolev 
7298e96e13eSMaxim Sobolev 	/*
7308e96e13eSMaxim Sobolev 	 * now change it back - else ip_output will just drop
7318e96e13eSMaxim Sobolev 	 * the route and search one to this interface ...
7328e96e13eSMaxim Sobolev 	 */
733fc74a9f9SBrooks Davis 	if ((GRE2IFP(sc)->if_flags & IFF_LINK1) == 0)
7348e96e13eSMaxim Sobolev 		((struct sockaddr_in *)&ro->ro_dst)->sin_addr = sc->g_dst;
7358e96e13eSMaxim Sobolev 
7368e96e13eSMaxim Sobolev #ifdef DIAGNOSTIC
7378e96e13eSMaxim Sobolev 	printf(", choosing %s with gateway %s", if_name(ro->ro_rt->rt_ifp),
7388e96e13eSMaxim Sobolev 	    inet_ntoa(((struct sockaddr_in *)(ro->ro_rt->rt_gateway))->sin_addr));
7398e96e13eSMaxim Sobolev 	printf("\n");
7408e96e13eSMaxim Sobolev #endif
7418e96e13eSMaxim Sobolev 
7428e96e13eSMaxim Sobolev 	return 0;
7438e96e13eSMaxim Sobolev }
7448e96e13eSMaxim Sobolev 
7458e96e13eSMaxim Sobolev /*
7468e96e13eSMaxim Sobolev  * do a checksum of a buffer - much like in_cksum, which operates on
7478e96e13eSMaxim Sobolev  * mbufs.
7488e96e13eSMaxim Sobolev  */
74973d7ddbcSMaxim Sobolev u_int16_t
75073d7ddbcSMaxim Sobolev gre_in_cksum(u_int16_t *p, u_int len)
7518e96e13eSMaxim Sobolev {
75273d7ddbcSMaxim Sobolev 	u_int32_t sum = 0;
7538e96e13eSMaxim Sobolev 	int nwords = len >> 1;
7548e96e13eSMaxim Sobolev 
7558e96e13eSMaxim Sobolev 	while (nwords-- != 0)
7568e96e13eSMaxim Sobolev 		sum += *p++;
7578e96e13eSMaxim Sobolev 
7588e96e13eSMaxim Sobolev 	if (len & 1) {
7598e96e13eSMaxim Sobolev 		union {
7608e96e13eSMaxim Sobolev 			u_short w;
7618e96e13eSMaxim Sobolev 			u_char c[2];
7628e96e13eSMaxim Sobolev 		} u;
7638e96e13eSMaxim Sobolev 		u.c[0] = *(u_char *)p;
7648e96e13eSMaxim Sobolev 		u.c[1] = 0;
7658e96e13eSMaxim Sobolev 		sum += u.w;
7668e96e13eSMaxim Sobolev 	}
7678e96e13eSMaxim Sobolev 
7688e96e13eSMaxim Sobolev 	/* end-around-carry */
7698e96e13eSMaxim Sobolev 	sum = (sum >> 16) + (sum & 0xffff);
7708e96e13eSMaxim Sobolev 	sum += (sum >> 16);
7718e96e13eSMaxim Sobolev 	return (~sum);
7728e96e13eSMaxim Sobolev }
7738e96e13eSMaxim Sobolev 
7748e96e13eSMaxim Sobolev static int
7758e96e13eSMaxim Sobolev gremodevent(module_t mod, int type, void *data)
7768e96e13eSMaxim Sobolev {
777bdae44a8SRobert Watson 	struct gre_softc *sc;
7788e96e13eSMaxim Sobolev 
7798e96e13eSMaxim Sobolev 	switch (type) {
7808e96e13eSMaxim Sobolev 	case MOD_LOAD:
7818e96e13eSMaxim Sobolev 		greattach();
7828e96e13eSMaxim Sobolev 		break;
7838e96e13eSMaxim Sobolev 	case MOD_UNLOAD:
7848e96e13eSMaxim Sobolev 		if_clone_detach(&gre_cloner);
7858e96e13eSMaxim Sobolev 
786bdae44a8SRobert Watson 		mtx_lock(&gre_mtx);
787bdae44a8SRobert Watson 		while ((sc = LIST_FIRST(&gre_softc_list)) != NULL) {
788bdae44a8SRobert Watson 			mtx_unlock(&gre_mtx);
789febd0759SAndrew Thompson 			ifc_simple_destroy(&gre_cloner, GRE2IFP(sc));
790bdae44a8SRobert Watson 			mtx_lock(&gre_mtx);
791bdae44a8SRobert Watson 		}
792bdae44a8SRobert Watson 		mtx_unlock(&gre_mtx);
793bdae44a8SRobert Watson 		mtx_destroy(&gre_mtx);
7948e96e13eSMaxim Sobolev 		break;
7953e019deaSPoul-Henning Kamp 	default:
7963e019deaSPoul-Henning Kamp 		return EOPNOTSUPP;
7978e96e13eSMaxim Sobolev 	}
7988e96e13eSMaxim Sobolev 	return 0;
7998e96e13eSMaxim Sobolev }
8008e96e13eSMaxim Sobolev 
8018e96e13eSMaxim Sobolev static moduledata_t gre_mod = {
8028e96e13eSMaxim Sobolev 	"if_gre",
8038e96e13eSMaxim Sobolev 	gremodevent,
8048e96e13eSMaxim Sobolev 	0
8058e96e13eSMaxim Sobolev };
8068e96e13eSMaxim Sobolev 
8078e96e13eSMaxim Sobolev DECLARE_MODULE(if_gre, gre_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
8088e96e13eSMaxim Sobolev MODULE_VERSION(if_gre, 1);
809