1686cdd19SJun-ichiro itojun Hagino /* $FreeBSD$ */ 233841545SHajimu UMEMOTO /* $KAME: if_gif.c,v 1.47 2001/05/01 05:28:42 itojun Exp $ */ 3686cdd19SJun-ichiro itojun Hagino 4cfa1ca9dSYoshinobu Inoue /* 5cfa1ca9dSYoshinobu Inoue * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6cfa1ca9dSYoshinobu Inoue * All rights reserved. 7cfa1ca9dSYoshinobu Inoue * 8cfa1ca9dSYoshinobu Inoue * Redistribution and use in source and binary forms, with or without 9cfa1ca9dSYoshinobu Inoue * modification, are permitted provided that the following conditions 10cfa1ca9dSYoshinobu Inoue * are met: 11cfa1ca9dSYoshinobu Inoue * 1. Redistributions of source code must retain the above copyright 12cfa1ca9dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer. 13cfa1ca9dSYoshinobu Inoue * 2. Redistributions in binary form must reproduce the above copyright 14cfa1ca9dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer in the 15cfa1ca9dSYoshinobu Inoue * documentation and/or other materials provided with the distribution. 16cfa1ca9dSYoshinobu Inoue * 3. Neither the name of the project nor the names of its contributors 17cfa1ca9dSYoshinobu Inoue * may be used to endorse or promote products derived from this software 18cfa1ca9dSYoshinobu Inoue * without specific prior written permission. 19cfa1ca9dSYoshinobu Inoue * 20cfa1ca9dSYoshinobu Inoue * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21cfa1ca9dSYoshinobu Inoue * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22cfa1ca9dSYoshinobu Inoue * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23cfa1ca9dSYoshinobu Inoue * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24cfa1ca9dSYoshinobu Inoue * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25cfa1ca9dSYoshinobu Inoue * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26cfa1ca9dSYoshinobu Inoue * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27cfa1ca9dSYoshinobu Inoue * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28cfa1ca9dSYoshinobu Inoue * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29cfa1ca9dSYoshinobu Inoue * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30cfa1ca9dSYoshinobu Inoue * SUCH DAMAGE. 31cfa1ca9dSYoshinobu Inoue */ 32cfa1ca9dSYoshinobu Inoue 33cfa1ca9dSYoshinobu Inoue #include "opt_inet.h" 34cfa1ca9dSYoshinobu Inoue #include "opt_inet6.h" 35cfa1ca9dSYoshinobu Inoue 36cfa1ca9dSYoshinobu Inoue #include <sys/param.h> 37cfa1ca9dSYoshinobu Inoue #include <sys/systm.h> 38cfa1ca9dSYoshinobu Inoue #include <sys/kernel.h> 39cfa1ca9dSYoshinobu Inoue #include <sys/malloc.h> 40cfa1ca9dSYoshinobu Inoue #include <sys/mbuf.h> 41cfa1ca9dSYoshinobu Inoue #include <sys/socket.h> 42cfa1ca9dSYoshinobu Inoue #include <sys/sockio.h> 43cfa1ca9dSYoshinobu Inoue #include <sys/errno.h> 44cfa1ca9dSYoshinobu Inoue #include <sys/time.h> 45872f786aSBrooks Davis #include <sys/sysctl.h> 46cfa1ca9dSYoshinobu Inoue #include <sys/syslog.h> 47686cdd19SJun-ichiro itojun Hagino #include <sys/protosw.h> 4853dab5feSBrooks Davis #include <sys/conf.h> 4953dab5feSBrooks Davis #include <machine/bus.h> /* XXX: Shouldn't really be required! */ 5053dab5feSBrooks Davis #include <sys/rman.h> 51cfa1ca9dSYoshinobu Inoue #include <machine/cpu.h> 52cfa1ca9dSYoshinobu Inoue 53cfa1ca9dSYoshinobu Inoue #include <net/if.h> 54cfa1ca9dSYoshinobu Inoue #include <net/if_types.h> 55cfa1ca9dSYoshinobu Inoue #include <net/netisr.h> 56cfa1ca9dSYoshinobu Inoue #include <net/route.h> 57cfa1ca9dSYoshinobu Inoue #include <net/bpf.h> 58cfa1ca9dSYoshinobu Inoue 59cfa1ca9dSYoshinobu Inoue #include <netinet/in.h> 60cfa1ca9dSYoshinobu Inoue #include <netinet/in_systm.h> 61cfa1ca9dSYoshinobu Inoue #include <netinet/ip.h> 6233841545SHajimu UMEMOTO #ifdef INET 6333841545SHajimu UMEMOTO #include <netinet/in_var.h> 64cfa1ca9dSYoshinobu Inoue #include <netinet/in_gif.h> 6553dab5feSBrooks Davis #include <netinet/ip_var.h> 66cfa1ca9dSYoshinobu Inoue #endif /* INET */ 67cfa1ca9dSYoshinobu Inoue 68cfa1ca9dSYoshinobu Inoue #ifdef INET6 69cfa1ca9dSYoshinobu Inoue #ifndef INET 70cfa1ca9dSYoshinobu Inoue #include <netinet/in.h> 71cfa1ca9dSYoshinobu Inoue #endif 72cfa1ca9dSYoshinobu Inoue #include <netinet6/in6_var.h> 73cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h> 74cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h> 75cfa1ca9dSYoshinobu Inoue #include <netinet6/in6_gif.h> 76686cdd19SJun-ichiro itojun Hagino #include <netinet6/ip6protosw.h> 77cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 78cfa1ca9dSYoshinobu Inoue 79686cdd19SJun-ichiro itojun Hagino #include <netinet/ip_encap.h> 80cfa1ca9dSYoshinobu Inoue #include <net/if_gif.h> 81cfa1ca9dSYoshinobu Inoue 82cfa1ca9dSYoshinobu Inoue #include <net/net_osdep.h> 83cfa1ca9dSYoshinobu Inoue 8453dab5feSBrooks Davis #define GIFNAME "gif" 8553dab5feSBrooks Davis #define GIF_MAXUNIT 0x7fff /* ifp->if_unit is only 15 bits */ 86686cdd19SJun-ichiro itojun Hagino 8753dab5feSBrooks Davis static MALLOC_DEFINE(M_GIF, "gif", "Generic Tunnel Interface"); 8853dab5feSBrooks Davis static struct rman gifunits[1]; 89e8783c4dSMike Smith static LIST_HEAD(, gif_softc) gif_softc_list; 9053dab5feSBrooks Davis 9194408d94SBrooks Davis void (*ng_gif_input_p)(struct ifnet *ifp, struct mbuf **mp, int af); 9294408d94SBrooks Davis void (*ng_gif_input_orphan_p)(struct ifnet *ifp, struct mbuf *m, int af); 9394408d94SBrooks Davis void (*ng_gif_attach_p)(struct ifnet *ifp); 9494408d94SBrooks Davis void (*ng_gif_detach_p)(struct ifnet *ifp); 9594408d94SBrooks Davis 9653dab5feSBrooks Davis int gif_clone_create __P((struct if_clone *, int *)); 9753dab5feSBrooks Davis void gif_clone_destroy __P((struct ifnet *)); 9853dab5feSBrooks Davis 9953dab5feSBrooks Davis struct if_clone gif_cloner = 10053dab5feSBrooks Davis IF_CLONE_INITIALIZER("gif", gif_clone_create, gif_clone_destroy); 10153dab5feSBrooks Davis 10253dab5feSBrooks Davis static int gifmodevent __P((module_t, int, void *)); 10353dab5feSBrooks Davis void gif_delete_tunnel __P((struct gif_softc *)); 104686cdd19SJun-ichiro itojun Hagino static int gif_encapcheck __P((const struct mbuf *, int, int, void *)); 10553dab5feSBrooks Davis 106686cdd19SJun-ichiro itojun Hagino #ifdef INET 10753dab5feSBrooks Davis extern struct domain inetdomain; 108f0ffb944SJulian Elischer struct protosw in_gif_protosw = 10953dab5feSBrooks Davis { SOCK_RAW, &inetdomain, 0/*IPPROTO_IPV[46]*/, PR_ATOMIC|PR_ADDR, 11053dab5feSBrooks Davis in_gif_input, rip_output, 0, rip_ctloutput, 11153dab5feSBrooks Davis 0, 11253dab5feSBrooks Davis 0, 0, 0, 0, 11353dab5feSBrooks Davis &rip_usrreqs 11453dab5feSBrooks Davis }; 115686cdd19SJun-ichiro itojun Hagino #endif 116686cdd19SJun-ichiro itojun Hagino #ifdef INET6 11753dab5feSBrooks Davis extern struct domain6 inet6domain; 11853dab5feSBrooks Davis struct ip6protosw in6_gif_protosw = 11953dab5feSBrooks Davis { SOCK_RAW, &inet6domain, 0/*IPPROTO_IPV[46]*/, PR_ATOMIC|PR_ADDR, 12053dab5feSBrooks Davis in6_gif_input, rip6_output, 0, rip6_ctloutput, 12153dab5feSBrooks Davis 0, 12253dab5feSBrooks Davis 0, 0, 0, 0, 12353dab5feSBrooks Davis &rip6_usrreqs 12453dab5feSBrooks Davis }; 125686cdd19SJun-ichiro itojun Hagino #endif 126cfa1ca9dSYoshinobu Inoue 127872f786aSBrooks Davis SYSCTL_DECL(_net_link); 128872f786aSBrooks Davis SYSCTL_NODE(_net_link, IFT_GIF, gif, CTLFLAG_RW, 0, 129872f786aSBrooks Davis "Generic Tunnel Interface"); 130686cdd19SJun-ichiro itojun Hagino #ifndef MAX_GIF_NEST 131686cdd19SJun-ichiro itojun Hagino /* 132872f786aSBrooks Davis * This macro controls the default upper limitation on nesting of gif tunnels. 133686cdd19SJun-ichiro itojun Hagino * Since, setting a large value to this macro with a careless configuration 134686cdd19SJun-ichiro itojun Hagino * may introduce system crash, we don't allow any nestings by default. 135686cdd19SJun-ichiro itojun Hagino * If you need to configure nested gif tunnels, you can define this macro 136686cdd19SJun-ichiro itojun Hagino * in your kernel configuration file. However, if you do so, please be 137686cdd19SJun-ichiro itojun Hagino * careful to configure the tunnels so that it won't make a loop. 138686cdd19SJun-ichiro itojun Hagino */ 139686cdd19SJun-ichiro itojun Hagino #define MAX_GIF_NEST 1 140686cdd19SJun-ichiro itojun Hagino #endif 141686cdd19SJun-ichiro itojun Hagino static int max_gif_nesting = MAX_GIF_NEST; 142872f786aSBrooks Davis SYSCTL_INT(_net_link_gif, OID_AUTO, max_nesting, CTLFLAG_RW, 143872f786aSBrooks Davis &max_gif_nesting, 0, "Max nested tunnels"); 144872f786aSBrooks Davis 145872f786aSBrooks Davis /* 146872f786aSBrooks Davis * By default, we disallow creation of multiple tunnels between the same 147872f786aSBrooks Davis * pair of addresses. Some applications require this functionality so 148872f786aSBrooks Davis * we allow control over this check here. 149872f786aSBrooks Davis */ 150872f786aSBrooks Davis #ifdef XBONEHACK 151872f786aSBrooks Davis static int parallel_tunnels = 1; 152872f786aSBrooks Davis #else 153872f786aSBrooks Davis static int parallel_tunnels = 0; 154872f786aSBrooks Davis #endif 155872f786aSBrooks Davis SYSCTL_INT(_net_link_gif, OID_AUTO, parallel_tunnels, CTLFLAG_RW, 156872f786aSBrooks Davis ¶llel_tunnels, 0, "Allow parallel tunnels?"); 157cfa1ca9dSYoshinobu Inoue 15853dab5feSBrooks Davis int 15953dab5feSBrooks Davis gif_clone_create(ifc, unit) 16053dab5feSBrooks Davis struct if_clone *ifc; 16153dab5feSBrooks Davis int *unit; 162cfa1ca9dSYoshinobu Inoue { 16353dab5feSBrooks Davis struct resource *r; 16433841545SHajimu UMEMOTO struct gif_softc *sc; 165cfa1ca9dSYoshinobu Inoue 16653dab5feSBrooks Davis if (*unit > GIF_MAXUNIT) 16753dab5feSBrooks Davis return (ENXIO); 16853dab5feSBrooks Davis 16953dab5feSBrooks Davis if (*unit < 0) { 17053dab5feSBrooks Davis r = rman_reserve_resource(gifunits, 0, GIF_MAXUNIT, 1, 17153dab5feSBrooks Davis RF_ALLOCATED | RF_ACTIVE, NULL); 17253dab5feSBrooks Davis if (r == NULL) 17353dab5feSBrooks Davis return (ENOSPC); 17453dab5feSBrooks Davis *unit = rman_get_start(r); 17553dab5feSBrooks Davis } else { 17653dab5feSBrooks Davis r = rman_reserve_resource(gifunits, *unit, *unit, 1, 17753dab5feSBrooks Davis RF_ALLOCATED | RF_ACTIVE, NULL); 17853dab5feSBrooks Davis if (r == NULL) 17953dab5feSBrooks Davis return (EEXIST); 18053dab5feSBrooks Davis } 18153dab5feSBrooks Davis 18253dab5feSBrooks Davis sc = malloc (sizeof(struct gif_softc), M_GIF, M_WAITOK); 18353dab5feSBrooks Davis bzero(sc, sizeof(struct gif_softc)); 18453dab5feSBrooks Davis 18553dab5feSBrooks Davis sc->gif_if.if_softc = sc; 18653dab5feSBrooks Davis sc->gif_if.if_name = GIFNAME; 18753dab5feSBrooks Davis sc->gif_if.if_unit = *unit; 18853dab5feSBrooks Davis sc->r_unit = r; 189686cdd19SJun-ichiro itojun Hagino 190686cdd19SJun-ichiro itojun Hagino sc->encap_cookie4 = sc->encap_cookie6 = NULL; 191686cdd19SJun-ichiro itojun Hagino #ifdef INET 192686cdd19SJun-ichiro itojun Hagino sc->encap_cookie4 = encap_attach_func(AF_INET, -1, 19353dab5feSBrooks Davis gif_encapcheck, (struct protosw*)&in_gif_protosw, sc); 194686cdd19SJun-ichiro itojun Hagino if (sc->encap_cookie4 == NULL) { 19553dab5feSBrooks Davis printf("%s: unable to attach encap4\n", if_name(&sc->gif_if)); 19653dab5feSBrooks Davis free(sc, M_GIF); 19753dab5feSBrooks Davis return (EIO); /* XXX */ 198686cdd19SJun-ichiro itojun Hagino } 199686cdd19SJun-ichiro itojun Hagino #endif 200686cdd19SJun-ichiro itojun Hagino #ifdef INET6 201686cdd19SJun-ichiro itojun Hagino sc->encap_cookie6 = encap_attach_func(AF_INET6, -1, 202686cdd19SJun-ichiro itojun Hagino gif_encapcheck, (struct protosw *)&in6_gif_protosw, sc); 203686cdd19SJun-ichiro itojun Hagino if (sc->encap_cookie6 == NULL) { 204686cdd19SJun-ichiro itojun Hagino if (sc->encap_cookie4) { 205686cdd19SJun-ichiro itojun Hagino encap_detach(sc->encap_cookie4); 206686cdd19SJun-ichiro itojun Hagino sc->encap_cookie4 = NULL; 207686cdd19SJun-ichiro itojun Hagino } 20853dab5feSBrooks Davis printf("%s: unable to attach encap6\n", if_name(&sc->gif_if)); 20953dab5feSBrooks Davis free(sc, M_GIF); 21053dab5feSBrooks Davis return (EIO); /* XXX */ 211686cdd19SJun-ichiro itojun Hagino } 212686cdd19SJun-ichiro itojun Hagino #endif 213686cdd19SJun-ichiro itojun Hagino 214cfa1ca9dSYoshinobu Inoue sc->gif_if.if_mtu = GIF_MTU; 215cfa1ca9dSYoshinobu Inoue sc->gif_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST; 21633841545SHajimu UMEMOTO #if 0 21733841545SHajimu UMEMOTO /* turn off ingress filter */ 21833841545SHajimu UMEMOTO sc->gif_if.if_flags |= IFF_LINK2; 21933841545SHajimu UMEMOTO #endif 220cfa1ca9dSYoshinobu Inoue sc->gif_if.if_ioctl = gif_ioctl; 221cfa1ca9dSYoshinobu Inoue sc->gif_if.if_output = gif_output; 222cfa1ca9dSYoshinobu Inoue sc->gif_if.if_type = IFT_GIF; 223686cdd19SJun-ichiro itojun Hagino sc->gif_if.if_snd.ifq_maxlen = IFQ_MAXLEN; 224cfa1ca9dSYoshinobu Inoue if_attach(&sc->gif_if); 225cfa1ca9dSYoshinobu Inoue bpfattach(&sc->gif_if, DLT_NULL, sizeof(u_int)); 22694408d94SBrooks Davis if (ng_gif_attach_p != NULL) 22794408d94SBrooks Davis (*ng_gif_attach_p)(&sc->gif_if); 22820af0ffaSBrooks Davis LIST_INSERT_HEAD(&gif_softc_list, sc, gif_link); 22953dab5feSBrooks Davis return (0); 230cfa1ca9dSYoshinobu Inoue } 231cfa1ca9dSYoshinobu Inoue 23253dab5feSBrooks Davis void 23353dab5feSBrooks Davis gif_clone_destroy(ifp) 23453dab5feSBrooks Davis struct ifnet *ifp; 23553dab5feSBrooks Davis { 23653dab5feSBrooks Davis int err; 23753dab5feSBrooks Davis struct gif_softc *sc = ifp->if_softc; 23853dab5feSBrooks Davis 23953dab5feSBrooks Davis gif_delete_tunnel(sc); 24020af0ffaSBrooks Davis LIST_REMOVE(sc, gif_link); 24153dab5feSBrooks Davis if (sc->encap_cookie4 != NULL) { 24253dab5feSBrooks Davis err = encap_detach(sc->encap_cookie4); 24353dab5feSBrooks Davis KASSERT(err == 0, ("Unexpected error detaching encap_cookie4")); 24453dab5feSBrooks Davis } 24553dab5feSBrooks Davis if (sc->encap_cookie6 != NULL) { 24653dab5feSBrooks Davis err = encap_detach(sc->encap_cookie6); 24753dab5feSBrooks Davis KASSERT(err == 0, ("Unexpected error detaching encap_cookie6")); 24853dab5feSBrooks Davis } 24953dab5feSBrooks Davis 25094408d94SBrooks Davis if (ng_gif_detach_p != NULL) 25194408d94SBrooks Davis (*ng_gif_detach_p)(ifp); 25253dab5feSBrooks Davis bpfdetach(ifp); 25353dab5feSBrooks Davis if_detach(ifp); 25453dab5feSBrooks Davis 25553dab5feSBrooks Davis err = rman_release_resource(sc->r_unit); 25653dab5feSBrooks Davis KASSERT(err == 0, ("Unexpected error freeing resource")); 25753dab5feSBrooks Davis 25853dab5feSBrooks Davis free(sc, M_GIF); 25953dab5feSBrooks Davis } 26053dab5feSBrooks Davis 26153dab5feSBrooks Davis static int 26253dab5feSBrooks Davis gifmodevent(mod, type, data) 26353dab5feSBrooks Davis module_t mod; 26453dab5feSBrooks Davis int type; 26553dab5feSBrooks Davis void *data; 26653dab5feSBrooks Davis { 26753dab5feSBrooks Davis int err; 26853dab5feSBrooks Davis 26953dab5feSBrooks Davis switch (type) { 27053dab5feSBrooks Davis case MOD_LOAD: 27153dab5feSBrooks Davis gifunits->rm_type = RMAN_ARRAY; 27253dab5feSBrooks Davis gifunits->rm_descr = "configurable if_gif units"; 27353dab5feSBrooks Davis err = rman_init(gifunits); 27453dab5feSBrooks Davis if (err != 0) 27553dab5feSBrooks Davis return (err); 27653dab5feSBrooks Davis err = rman_manage_region(gifunits, 0, GIF_MAXUNIT); 27753dab5feSBrooks Davis if (err != 0) { 27853dab5feSBrooks Davis printf("%s: gifunits: rman_manage_region: Failed %d\n", 27953dab5feSBrooks Davis GIFNAME, err); 28053dab5feSBrooks Davis rman_fini(gifunits); 28153dab5feSBrooks Davis return (err); 28253dab5feSBrooks Davis } 28320af0ffaSBrooks Davis LIST_INIT(&gif_softc_list); 28453dab5feSBrooks Davis if_clone_attach(&gif_cloner); 28553dab5feSBrooks Davis 28653dab5feSBrooks Davis #ifdef INET6 28753dab5feSBrooks Davis ip6_gif_hlim = GIF_HLIM; 28853dab5feSBrooks Davis #endif 28953dab5feSBrooks Davis 29053dab5feSBrooks Davis break; 29153dab5feSBrooks Davis case MOD_UNLOAD: 29253dab5feSBrooks Davis if_clone_detach(&gif_cloner); 29353dab5feSBrooks Davis 29420af0ffaSBrooks Davis while (!LIST_EMPTY(&gif_softc_list)) 29520af0ffaSBrooks Davis gif_clone_destroy(&LIST_FIRST(&gif_softc_list)->gif_if); 29653dab5feSBrooks Davis 29753dab5feSBrooks Davis err = rman_fini(gifunits); 29853dab5feSBrooks Davis if (err != 0) 29953dab5feSBrooks Davis return (err); 30053dab5feSBrooks Davis #ifdef INET6 30153dab5feSBrooks Davis ip6_gif_hlim = 0; 30253dab5feSBrooks Davis #endif 30353dab5feSBrooks Davis break; 30453dab5feSBrooks Davis } 30553dab5feSBrooks Davis return 0; 30653dab5feSBrooks Davis } 30753dab5feSBrooks Davis 30853dab5feSBrooks Davis static moduledata_t gif_mod = { 30953dab5feSBrooks Davis "if_gif", 31053dab5feSBrooks Davis gifmodevent, 31153dab5feSBrooks Davis 0 31253dab5feSBrooks Davis }; 31353dab5feSBrooks Davis 31453dab5feSBrooks Davis DECLARE_MODULE(if_gif, gif_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 31520af0ffaSBrooks Davis MODULE_VERSION(if_gif, 1); 316cfa1ca9dSYoshinobu Inoue 317686cdd19SJun-ichiro itojun Hagino static int 318686cdd19SJun-ichiro itojun Hagino gif_encapcheck(m, off, proto, arg) 319686cdd19SJun-ichiro itojun Hagino const struct mbuf *m; 320686cdd19SJun-ichiro itojun Hagino int off; 321686cdd19SJun-ichiro itojun Hagino int proto; 322686cdd19SJun-ichiro itojun Hagino void *arg; 323686cdd19SJun-ichiro itojun Hagino { 324686cdd19SJun-ichiro itojun Hagino struct ip ip; 325686cdd19SJun-ichiro itojun Hagino struct gif_softc *sc; 326686cdd19SJun-ichiro itojun Hagino 327686cdd19SJun-ichiro itojun Hagino sc = (struct gif_softc *)arg; 328686cdd19SJun-ichiro itojun Hagino if (sc == NULL) 329686cdd19SJun-ichiro itojun Hagino return 0; 330686cdd19SJun-ichiro itojun Hagino 331686cdd19SJun-ichiro itojun Hagino if ((sc->gif_if.if_flags & IFF_UP) == 0) 332686cdd19SJun-ichiro itojun Hagino return 0; 333686cdd19SJun-ichiro itojun Hagino 334686cdd19SJun-ichiro itojun Hagino /* no physical address */ 335686cdd19SJun-ichiro itojun Hagino if (!sc->gif_psrc || !sc->gif_pdst) 336686cdd19SJun-ichiro itojun Hagino return 0; 337686cdd19SJun-ichiro itojun Hagino 338686cdd19SJun-ichiro itojun Hagino switch (proto) { 339686cdd19SJun-ichiro itojun Hagino #ifdef INET 340686cdd19SJun-ichiro itojun Hagino case IPPROTO_IPV4: 341686cdd19SJun-ichiro itojun Hagino break; 342686cdd19SJun-ichiro itojun Hagino #endif 343686cdd19SJun-ichiro itojun Hagino #ifdef INET6 344686cdd19SJun-ichiro itojun Hagino case IPPROTO_IPV6: 345686cdd19SJun-ichiro itojun Hagino break; 346686cdd19SJun-ichiro itojun Hagino #endif 347686cdd19SJun-ichiro itojun Hagino default: 348686cdd19SJun-ichiro itojun Hagino return 0; 349686cdd19SJun-ichiro itojun Hagino } 350686cdd19SJun-ichiro itojun Hagino 351686cdd19SJun-ichiro itojun Hagino /* LINTED const cast */ 352686cdd19SJun-ichiro itojun Hagino m_copydata((struct mbuf *)m, 0, sizeof(ip), (caddr_t)&ip); 353686cdd19SJun-ichiro itojun Hagino 354686cdd19SJun-ichiro itojun Hagino switch (ip.ip_v) { 355686cdd19SJun-ichiro itojun Hagino #ifdef INET 356686cdd19SJun-ichiro itojun Hagino case 4: 357686cdd19SJun-ichiro itojun Hagino if (sc->gif_psrc->sa_family != AF_INET || 358686cdd19SJun-ichiro itojun Hagino sc->gif_pdst->sa_family != AF_INET) 359686cdd19SJun-ichiro itojun Hagino return 0; 360686cdd19SJun-ichiro itojun Hagino return gif_encapcheck4(m, off, proto, arg); 361686cdd19SJun-ichiro itojun Hagino #endif 362686cdd19SJun-ichiro itojun Hagino #ifdef INET6 363686cdd19SJun-ichiro itojun Hagino case 6: 364686cdd19SJun-ichiro itojun Hagino if (sc->gif_psrc->sa_family != AF_INET6 || 365686cdd19SJun-ichiro itojun Hagino sc->gif_pdst->sa_family != AF_INET6) 366686cdd19SJun-ichiro itojun Hagino return 0; 367686cdd19SJun-ichiro itojun Hagino return gif_encapcheck6(m, off, proto, arg); 368686cdd19SJun-ichiro itojun Hagino #endif 369686cdd19SJun-ichiro itojun Hagino default: 370686cdd19SJun-ichiro itojun Hagino return 0; 371686cdd19SJun-ichiro itojun Hagino } 372686cdd19SJun-ichiro itojun Hagino } 373686cdd19SJun-ichiro itojun Hagino 374cfa1ca9dSYoshinobu Inoue int 375cfa1ca9dSYoshinobu Inoue gif_output(ifp, m, dst, rt) 376cfa1ca9dSYoshinobu Inoue struct ifnet *ifp; 377cfa1ca9dSYoshinobu Inoue struct mbuf *m; 378cfa1ca9dSYoshinobu Inoue struct sockaddr *dst; 379cfa1ca9dSYoshinobu Inoue struct rtentry *rt; /* added in net2 */ 380cfa1ca9dSYoshinobu Inoue { 38133841545SHajimu UMEMOTO struct gif_softc *sc = (struct gif_softc*)ifp; 382cfa1ca9dSYoshinobu Inoue int error = 0; 383cfa1ca9dSYoshinobu Inoue static int called = 0; /* XXX: MUTEX */ 384cfa1ca9dSYoshinobu Inoue 385cfa1ca9dSYoshinobu Inoue /* 386cfa1ca9dSYoshinobu Inoue * gif may cause infinite recursion calls when misconfigured. 387cfa1ca9dSYoshinobu Inoue * We'll prevent this by introducing upper limit. 388cfa1ca9dSYoshinobu Inoue * XXX: this mechanism may introduce another problem about 389cfa1ca9dSYoshinobu Inoue * mutual exclusion of the variable CALLED, especially if we 390cfa1ca9dSYoshinobu Inoue * use kernel thread. 391cfa1ca9dSYoshinobu Inoue */ 392686cdd19SJun-ichiro itojun Hagino if (++called > max_gif_nesting) { 393cfa1ca9dSYoshinobu Inoue log(LOG_NOTICE, 394cfa1ca9dSYoshinobu Inoue "gif_output: recursively called too many times(%d)\n", 395cfa1ca9dSYoshinobu Inoue called); 396cfa1ca9dSYoshinobu Inoue m_freem(m); 397cfa1ca9dSYoshinobu Inoue error = EIO; /* is there better errno? */ 398cfa1ca9dSYoshinobu Inoue goto end; 399cfa1ca9dSYoshinobu Inoue } 400686cdd19SJun-ichiro itojun Hagino 401cfa1ca9dSYoshinobu Inoue m->m_flags &= ~(M_BCAST|M_MCAST); 402cfa1ca9dSYoshinobu Inoue if (!(ifp->if_flags & IFF_UP) || 403cfa1ca9dSYoshinobu Inoue sc->gif_psrc == NULL || sc->gif_pdst == NULL) { 404cfa1ca9dSYoshinobu Inoue m_freem(m); 405cfa1ca9dSYoshinobu Inoue error = ENETDOWN; 406cfa1ca9dSYoshinobu Inoue goto end; 407cfa1ca9dSYoshinobu Inoue } 408cfa1ca9dSYoshinobu Inoue 409cfa1ca9dSYoshinobu Inoue if (ifp->if_bpf) { 410cfa1ca9dSYoshinobu Inoue /* 411cfa1ca9dSYoshinobu Inoue * We need to prepend the address family as 412cfa1ca9dSYoshinobu Inoue * a four byte field. Cons up a dummy header 413cfa1ca9dSYoshinobu Inoue * to pacify bpf. This is safe because bpf 414cfa1ca9dSYoshinobu Inoue * will only read from the mbuf (i.e., it won't 415cfa1ca9dSYoshinobu Inoue * try to free it or keep a pointer a to it). 416cfa1ca9dSYoshinobu Inoue */ 417cfa1ca9dSYoshinobu Inoue struct mbuf m0; 41833841545SHajimu UMEMOTO u_int32_t af = dst->sa_family; 419cfa1ca9dSYoshinobu Inoue 420cfa1ca9dSYoshinobu Inoue m0.m_next = m; 421cfa1ca9dSYoshinobu Inoue m0.m_len = 4; 422cfa1ca9dSYoshinobu Inoue m0.m_data = (char *)⁡ 423cfa1ca9dSYoshinobu Inoue 424cfa1ca9dSYoshinobu Inoue bpf_mtap(ifp, &m0); 425cfa1ca9dSYoshinobu Inoue } 426cfa1ca9dSYoshinobu Inoue ifp->if_opackets++; 427cfa1ca9dSYoshinobu Inoue ifp->if_obytes += m->m_pkthdr.len; 428cfa1ca9dSYoshinobu Inoue 42933841545SHajimu UMEMOTO /* inner AF-specific encapsulation */ 43033841545SHajimu UMEMOTO 431686cdd19SJun-ichiro itojun Hagino /* XXX should we check if our outer source is legal? */ 432686cdd19SJun-ichiro itojun Hagino 43333841545SHajimu UMEMOTO /* dispatch to output logic based on outer AF */ 434cfa1ca9dSYoshinobu Inoue switch (sc->gif_psrc->sa_family) { 435cfa1ca9dSYoshinobu Inoue #ifdef INET 436cfa1ca9dSYoshinobu Inoue case AF_INET: 437cfa1ca9dSYoshinobu Inoue error = in_gif_output(ifp, dst->sa_family, m, rt); 438cfa1ca9dSYoshinobu Inoue break; 439cfa1ca9dSYoshinobu Inoue #endif 440cfa1ca9dSYoshinobu Inoue #ifdef INET6 441cfa1ca9dSYoshinobu Inoue case AF_INET6: 442cfa1ca9dSYoshinobu Inoue error = in6_gif_output(ifp, dst->sa_family, m, rt); 443cfa1ca9dSYoshinobu Inoue break; 444cfa1ca9dSYoshinobu Inoue #endif 445cfa1ca9dSYoshinobu Inoue default: 446cfa1ca9dSYoshinobu Inoue m_freem(m); 447cfa1ca9dSYoshinobu Inoue error = ENETDOWN; 44833841545SHajimu UMEMOTO goto end; 449cfa1ca9dSYoshinobu Inoue } 450cfa1ca9dSYoshinobu Inoue 451cfa1ca9dSYoshinobu Inoue end: 452cfa1ca9dSYoshinobu Inoue called = 0; /* reset recursion counter */ 45333841545SHajimu UMEMOTO if (error) 45433841545SHajimu UMEMOTO ifp->if_oerrors++; 455cfa1ca9dSYoshinobu Inoue return error; 456cfa1ca9dSYoshinobu Inoue } 457cfa1ca9dSYoshinobu Inoue 458cfa1ca9dSYoshinobu Inoue void 459cfa1ca9dSYoshinobu Inoue gif_input(m, af, gifp) 460cfa1ca9dSYoshinobu Inoue struct mbuf *m; 461cfa1ca9dSYoshinobu Inoue int af; 462cfa1ca9dSYoshinobu Inoue struct ifnet *gifp; 463cfa1ca9dSYoshinobu Inoue { 464df5e1987SJonathan Lemon int isr; 46533841545SHajimu UMEMOTO struct ifqueue *ifq = 0; 466cfa1ca9dSYoshinobu Inoue 467cfa1ca9dSYoshinobu Inoue if (gifp == NULL) { 468cfa1ca9dSYoshinobu Inoue /* just in case */ 469cfa1ca9dSYoshinobu Inoue m_freem(m); 470cfa1ca9dSYoshinobu Inoue return; 471cfa1ca9dSYoshinobu Inoue } 472cfa1ca9dSYoshinobu Inoue 473cfa1ca9dSYoshinobu Inoue m->m_pkthdr.rcvif = gifp; 474cfa1ca9dSYoshinobu Inoue 475cfa1ca9dSYoshinobu Inoue if (gifp->if_bpf) { 476cfa1ca9dSYoshinobu Inoue /* 477cfa1ca9dSYoshinobu Inoue * We need to prepend the address family as 478cfa1ca9dSYoshinobu Inoue * a four byte field. Cons up a dummy header 479cfa1ca9dSYoshinobu Inoue * to pacify bpf. This is safe because bpf 480cfa1ca9dSYoshinobu Inoue * will only read from the mbuf (i.e., it won't 481cfa1ca9dSYoshinobu Inoue * try to free it or keep a pointer a to it). 482cfa1ca9dSYoshinobu Inoue */ 483cfa1ca9dSYoshinobu Inoue struct mbuf m0; 48433841545SHajimu UMEMOTO u_int32_t af1 = af; 485cfa1ca9dSYoshinobu Inoue 486cfa1ca9dSYoshinobu Inoue m0.m_next = m; 487cfa1ca9dSYoshinobu Inoue m0.m_len = 4; 48833841545SHajimu UMEMOTO m0.m_data = (char *)&af1; 489cfa1ca9dSYoshinobu Inoue 490cfa1ca9dSYoshinobu Inoue bpf_mtap(gifp, &m0); 491cfa1ca9dSYoshinobu Inoue } 492cfa1ca9dSYoshinobu Inoue 49394408d94SBrooks Davis if (ng_gif_input_p != NULL) { 49494408d94SBrooks Davis (*ng_gif_input_p)(gifp, &m, af); 49594408d94SBrooks Davis if (m == NULL) 49694408d94SBrooks Davis return; 49794408d94SBrooks Davis } 49894408d94SBrooks Davis 499cfa1ca9dSYoshinobu Inoue /* 500cfa1ca9dSYoshinobu Inoue * Put the packet to the network layer input queue according to the 501cfa1ca9dSYoshinobu Inoue * specified address family. 502cfa1ca9dSYoshinobu Inoue * Note: older versions of gif_input directly called network layer 503cfa1ca9dSYoshinobu Inoue * input functions, e.g. ip6_input, here. We changed the policy to 504cfa1ca9dSYoshinobu Inoue * prevent too many recursive calls of such input functions, which 505cfa1ca9dSYoshinobu Inoue * might cause kernel panic. But the change may introduce another 506cfa1ca9dSYoshinobu Inoue * problem; if the input queue is full, packets are discarded. 507cfa1ca9dSYoshinobu Inoue * We believed it rarely occurs and changed the policy. If we find 508cfa1ca9dSYoshinobu Inoue * it occurs more times than we thought, we may change the policy 509cfa1ca9dSYoshinobu Inoue * again. 510cfa1ca9dSYoshinobu Inoue */ 511cfa1ca9dSYoshinobu Inoue switch (af) { 512cfa1ca9dSYoshinobu Inoue #ifdef INET 513cfa1ca9dSYoshinobu Inoue case AF_INET: 514cfa1ca9dSYoshinobu Inoue ifq = &ipintrq; 515cfa1ca9dSYoshinobu Inoue isr = NETISR_IP; 516cfa1ca9dSYoshinobu Inoue break; 517cfa1ca9dSYoshinobu Inoue #endif 518cfa1ca9dSYoshinobu Inoue #ifdef INET6 519cfa1ca9dSYoshinobu Inoue case AF_INET6: 520cfa1ca9dSYoshinobu Inoue ifq = &ip6intrq; 521cfa1ca9dSYoshinobu Inoue isr = NETISR_IPV6; 522cfa1ca9dSYoshinobu Inoue break; 523cfa1ca9dSYoshinobu Inoue #endif 524cfa1ca9dSYoshinobu Inoue default: 52594408d94SBrooks Davis if (ng_gif_input_orphan_p != NULL) 52694408d94SBrooks Davis (*ng_gif_input_orphan_p)(gifp, m, af); 52794408d94SBrooks Davis else 528cfa1ca9dSYoshinobu Inoue m_freem(m); 529cfa1ca9dSYoshinobu Inoue return; 530cfa1ca9dSYoshinobu Inoue } 531cfa1ca9dSYoshinobu Inoue 532cfa1ca9dSYoshinobu Inoue gifp->if_ipackets++; 533cfa1ca9dSYoshinobu Inoue gifp->if_ibytes += m->m_pkthdr.len; 534df5e1987SJonathan Lemon (void) IF_HANDOFF(ifq, m, NULL); 535df5e1987SJonathan Lemon /* we need schednetisr since the address family may change */ 536df5e1987SJonathan Lemon schednetisr(isr); 537cfa1ca9dSYoshinobu Inoue 538cfa1ca9dSYoshinobu Inoue return; 539cfa1ca9dSYoshinobu Inoue } 540cfa1ca9dSYoshinobu Inoue 541686cdd19SJun-ichiro itojun Hagino /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */ 542cfa1ca9dSYoshinobu Inoue int 543cfa1ca9dSYoshinobu Inoue gif_ioctl(ifp, cmd, data) 544cfa1ca9dSYoshinobu Inoue struct ifnet *ifp; 545cfa1ca9dSYoshinobu Inoue u_long cmd; 546cfa1ca9dSYoshinobu Inoue caddr_t data; 547cfa1ca9dSYoshinobu Inoue { 548cfa1ca9dSYoshinobu Inoue struct gif_softc *sc = (struct gif_softc*)ifp; 549cfa1ca9dSYoshinobu Inoue struct ifreq *ifr = (struct ifreq*)data; 550cfa1ca9dSYoshinobu Inoue int error = 0, size; 551686cdd19SJun-ichiro itojun Hagino struct sockaddr *dst, *src; 552686cdd19SJun-ichiro itojun Hagino struct sockaddr *sa; 553a98dc5e6SYaroslav Tykhiy int s; 55453dab5feSBrooks Davis struct ifnet *ifp2; 555686cdd19SJun-ichiro itojun Hagino struct gif_softc *sc2; 556cfa1ca9dSYoshinobu Inoue 557cfa1ca9dSYoshinobu Inoue switch (cmd) { 558cfa1ca9dSYoshinobu Inoue case SIOCSIFADDR: 559cfa1ca9dSYoshinobu Inoue break; 560cfa1ca9dSYoshinobu Inoue 561cfa1ca9dSYoshinobu Inoue case SIOCSIFDSTADDR: 562cfa1ca9dSYoshinobu Inoue break; 563cfa1ca9dSYoshinobu Inoue 564cfa1ca9dSYoshinobu Inoue case SIOCADDMULTI: 565cfa1ca9dSYoshinobu Inoue case SIOCDELMULTI: 566cfa1ca9dSYoshinobu Inoue break; 567cfa1ca9dSYoshinobu Inoue 568686cdd19SJun-ichiro itojun Hagino #ifdef SIOCSIFMTU /* xxx */ 569cfa1ca9dSYoshinobu Inoue case SIOCGIFMTU: 570cfa1ca9dSYoshinobu Inoue break; 571686cdd19SJun-ichiro itojun Hagino 572cfa1ca9dSYoshinobu Inoue case SIOCSIFMTU: 573cfa1ca9dSYoshinobu Inoue { 574cfa1ca9dSYoshinobu Inoue u_long mtu; 575cfa1ca9dSYoshinobu Inoue mtu = ifr->ifr_mtu; 576cfa1ca9dSYoshinobu Inoue if (mtu < GIF_MTU_MIN || mtu > GIF_MTU_MAX) { 577cfa1ca9dSYoshinobu Inoue return (EINVAL); 578cfa1ca9dSYoshinobu Inoue } 579cfa1ca9dSYoshinobu Inoue ifp->if_mtu = mtu; 580cfa1ca9dSYoshinobu Inoue } 581cfa1ca9dSYoshinobu Inoue break; 582686cdd19SJun-ichiro itojun Hagino #endif /* SIOCSIFMTU */ 583cfa1ca9dSYoshinobu Inoue 584cfa1ca9dSYoshinobu Inoue case SIOCSIFPHYADDR: 585cfa1ca9dSYoshinobu Inoue #ifdef INET6 586cfa1ca9dSYoshinobu Inoue case SIOCSIFPHYADDR_IN6: 587cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 58833841545SHajimu UMEMOTO case SIOCSLIFPHYADDR: 589686cdd19SJun-ichiro itojun Hagino switch (cmd) { 59033841545SHajimu UMEMOTO #ifdef INET 591686cdd19SJun-ichiro itojun Hagino case SIOCSIFPHYADDR: 592cfa1ca9dSYoshinobu Inoue src = (struct sockaddr *) 593cfa1ca9dSYoshinobu Inoue &(((struct in_aliasreq *)data)->ifra_addr); 594cfa1ca9dSYoshinobu Inoue dst = (struct sockaddr *) 595cfa1ca9dSYoshinobu Inoue &(((struct in_aliasreq *)data)->ifra_dstaddr); 596cfa1ca9dSYoshinobu Inoue break; 59733841545SHajimu UMEMOTO #endif 598cfa1ca9dSYoshinobu Inoue #ifdef INET6 599686cdd19SJun-ichiro itojun Hagino case SIOCSIFPHYADDR_IN6: 600cfa1ca9dSYoshinobu Inoue src = (struct sockaddr *) 601cfa1ca9dSYoshinobu Inoue &(((struct in6_aliasreq *)data)->ifra_addr); 602cfa1ca9dSYoshinobu Inoue dst = (struct sockaddr *) 603cfa1ca9dSYoshinobu Inoue &(((struct in6_aliasreq *)data)->ifra_dstaddr); 604686cdd19SJun-ichiro itojun Hagino break; 605686cdd19SJun-ichiro itojun Hagino #endif 60633841545SHajimu UMEMOTO case SIOCSLIFPHYADDR: 60733841545SHajimu UMEMOTO src = (struct sockaddr *) 60833841545SHajimu UMEMOTO &(((struct if_laddrreq *)data)->addr); 60933841545SHajimu UMEMOTO dst = (struct sockaddr *) 61033841545SHajimu UMEMOTO &(((struct if_laddrreq *)data)->dstaddr); 61133841545SHajimu UMEMOTO } 61233841545SHajimu UMEMOTO 61333841545SHajimu UMEMOTO /* sa_family must be equal */ 61433841545SHajimu UMEMOTO if (src->sa_family != dst->sa_family) 61533841545SHajimu UMEMOTO return EINVAL; 61633841545SHajimu UMEMOTO 61733841545SHajimu UMEMOTO /* validate sa_len */ 61833841545SHajimu UMEMOTO switch (src->sa_family) { 61933841545SHajimu UMEMOTO #ifdef INET 62033841545SHajimu UMEMOTO case AF_INET: 62133841545SHajimu UMEMOTO if (src->sa_len != sizeof(struct sockaddr_in)) 62233841545SHajimu UMEMOTO return EINVAL; 62333841545SHajimu UMEMOTO break; 62433841545SHajimu UMEMOTO #endif 62533841545SHajimu UMEMOTO #ifdef INET6 62633841545SHajimu UMEMOTO case AF_INET6: 62733841545SHajimu UMEMOTO if (src->sa_len != sizeof(struct sockaddr_in6)) 62833841545SHajimu UMEMOTO return EINVAL; 62933841545SHajimu UMEMOTO break; 63033841545SHajimu UMEMOTO #endif 63133841545SHajimu UMEMOTO default: 63233841545SHajimu UMEMOTO return EAFNOSUPPORT; 63333841545SHajimu UMEMOTO } 63433841545SHajimu UMEMOTO switch (dst->sa_family) { 63533841545SHajimu UMEMOTO #ifdef INET 63633841545SHajimu UMEMOTO case AF_INET: 63733841545SHajimu UMEMOTO if (dst->sa_len != sizeof(struct sockaddr_in)) 63833841545SHajimu UMEMOTO return EINVAL; 63933841545SHajimu UMEMOTO break; 64033841545SHajimu UMEMOTO #endif 64133841545SHajimu UMEMOTO #ifdef INET6 64233841545SHajimu UMEMOTO case AF_INET6: 64333841545SHajimu UMEMOTO if (dst->sa_len != sizeof(struct sockaddr_in6)) 64433841545SHajimu UMEMOTO return EINVAL; 64533841545SHajimu UMEMOTO break; 64633841545SHajimu UMEMOTO #endif 64733841545SHajimu UMEMOTO default: 64833841545SHajimu UMEMOTO return EAFNOSUPPORT; 64933841545SHajimu UMEMOTO } 65033841545SHajimu UMEMOTO 65133841545SHajimu UMEMOTO /* check sa_family looks sane for the cmd */ 65233841545SHajimu UMEMOTO switch (cmd) { 65333841545SHajimu UMEMOTO case SIOCSIFPHYADDR: 65433841545SHajimu UMEMOTO if (src->sa_family == AF_INET) 65533841545SHajimu UMEMOTO break; 65633841545SHajimu UMEMOTO return EAFNOSUPPORT; 65733841545SHajimu UMEMOTO #ifdef INET6 65833841545SHajimu UMEMOTO case SIOCSIFPHYADDR_IN6: 65933841545SHajimu UMEMOTO if (src->sa_family == AF_INET6) 66033841545SHajimu UMEMOTO break; 66133841545SHajimu UMEMOTO return EAFNOSUPPORT; 66233841545SHajimu UMEMOTO #endif /* INET6 */ 66333841545SHajimu UMEMOTO case SIOCSLIFPHYADDR: 66433841545SHajimu UMEMOTO /* checks done in the above */ 66533841545SHajimu UMEMOTO break; 666686cdd19SJun-ichiro itojun Hagino } 667cfa1ca9dSYoshinobu Inoue 66853dab5feSBrooks Davis TAILQ_FOREACH(ifp2, &ifnet, if_link) { 66953dab5feSBrooks Davis if (strcmp(ifp2->if_name, GIFNAME) != 0) 67053dab5feSBrooks Davis continue; 67153dab5feSBrooks Davis sc2 = ifp2->if_softc; 672686cdd19SJun-ichiro itojun Hagino if (sc2 == sc) 673686cdd19SJun-ichiro itojun Hagino continue; 674686cdd19SJun-ichiro itojun Hagino if (!sc2->gif_pdst || !sc2->gif_psrc) 675686cdd19SJun-ichiro itojun Hagino continue; 676686cdd19SJun-ichiro itojun Hagino if (sc2->gif_pdst->sa_family != dst->sa_family || 677686cdd19SJun-ichiro itojun Hagino sc2->gif_pdst->sa_len != dst->sa_len || 678686cdd19SJun-ichiro itojun Hagino sc2->gif_psrc->sa_family != src->sa_family || 679686cdd19SJun-ichiro itojun Hagino sc2->gif_psrc->sa_len != src->sa_len) 680686cdd19SJun-ichiro itojun Hagino continue; 681872f786aSBrooks Davis 682872f786aSBrooks Davis /* 683872f786aSBrooks Davis * Disallow parallel tunnels unless instructed 684872f786aSBrooks Davis * otherwise. 685872f786aSBrooks Davis */ 686872f786aSBrooks Davis if (!parallel_tunnels && 687872f786aSBrooks Davis bcmp(sc2->gif_pdst, dst, dst->sa_len) == 0 && 688686cdd19SJun-ichiro itojun Hagino bcmp(sc2->gif_psrc, src, src->sa_len) == 0) { 689cfa1ca9dSYoshinobu Inoue error = EADDRNOTAVAIL; 690cfa1ca9dSYoshinobu Inoue goto bad; 691cfa1ca9dSYoshinobu Inoue } 692686cdd19SJun-ichiro itojun Hagino 693686cdd19SJun-ichiro itojun Hagino /* can't configure multiple multi-dest interfaces */ 694686cdd19SJun-ichiro itojun Hagino #define multidest(x) \ 695686cdd19SJun-ichiro itojun Hagino (((struct sockaddr_in *)(x))->sin_addr.s_addr == INADDR_ANY) 696686cdd19SJun-ichiro itojun Hagino #ifdef INET6 697686cdd19SJun-ichiro itojun Hagino #define multidest6(x) \ 698686cdd19SJun-ichiro itojun Hagino (IN6_IS_ADDR_UNSPECIFIED(&((struct sockaddr_in6 *)(x))->sin6_addr)) 699686cdd19SJun-ichiro itojun Hagino #endif 700686cdd19SJun-ichiro itojun Hagino if (dst->sa_family == AF_INET && 701686cdd19SJun-ichiro itojun Hagino multidest(dst) && multidest(sc2->gif_pdst)) { 702686cdd19SJun-ichiro itojun Hagino error = EADDRNOTAVAIL; 703686cdd19SJun-ichiro itojun Hagino goto bad; 704cfa1ca9dSYoshinobu Inoue } 705686cdd19SJun-ichiro itojun Hagino #ifdef INET6 706686cdd19SJun-ichiro itojun Hagino if (dst->sa_family == AF_INET6 && 707686cdd19SJun-ichiro itojun Hagino multidest6(dst) && multidest6(sc2->gif_pdst)) { 708686cdd19SJun-ichiro itojun Hagino error = EADDRNOTAVAIL; 709686cdd19SJun-ichiro itojun Hagino goto bad; 710cfa1ca9dSYoshinobu Inoue } 711686cdd19SJun-ichiro itojun Hagino #endif 712686cdd19SJun-ichiro itojun Hagino } 713686cdd19SJun-ichiro itojun Hagino 714686cdd19SJun-ichiro itojun Hagino if (sc->gif_psrc) 715686cdd19SJun-ichiro itojun Hagino free((caddr_t)sc->gif_psrc, M_IFADDR); 71633841545SHajimu UMEMOTO sa = (struct sockaddr *)malloc(src->sa_len, M_IFADDR, M_WAITOK); 71733841545SHajimu UMEMOTO bcopy((caddr_t)src, (caddr_t)sa, src->sa_len); 718cfa1ca9dSYoshinobu Inoue sc->gif_psrc = sa; 719cfa1ca9dSYoshinobu Inoue 720686cdd19SJun-ichiro itojun Hagino if (sc->gif_pdst) 721686cdd19SJun-ichiro itojun Hagino free((caddr_t)sc->gif_pdst, M_IFADDR); 72233841545SHajimu UMEMOTO sa = (struct sockaddr *)malloc(dst->sa_len, M_IFADDR, M_WAITOK); 72333841545SHajimu UMEMOTO bcopy((caddr_t)dst, (caddr_t)sa, dst->sa_len); 724cfa1ca9dSYoshinobu Inoue sc->gif_pdst = sa; 725cfa1ca9dSYoshinobu Inoue 726a98dc5e6SYaroslav Tykhiy ifp->if_flags |= IFF_RUNNING; 727a98dc5e6SYaroslav Tykhiy s = splimp(); 728a98dc5e6SYaroslav Tykhiy if_up(ifp); /* mark interface UP and send up RTM_IFINFO */ 729a98dc5e6SYaroslav Tykhiy splx(s); 730cfa1ca9dSYoshinobu Inoue 731686cdd19SJun-ichiro itojun Hagino error = 0; 732cfa1ca9dSYoshinobu Inoue break; 733cfa1ca9dSYoshinobu Inoue 734686cdd19SJun-ichiro itojun Hagino #ifdef SIOCDIFPHYADDR 735686cdd19SJun-ichiro itojun Hagino case SIOCDIFPHYADDR: 736686cdd19SJun-ichiro itojun Hagino if (sc->gif_psrc) { 737686cdd19SJun-ichiro itojun Hagino free((caddr_t)sc->gif_psrc, M_IFADDR); 738686cdd19SJun-ichiro itojun Hagino sc->gif_psrc = NULL; 739686cdd19SJun-ichiro itojun Hagino } 740686cdd19SJun-ichiro itojun Hagino if (sc->gif_pdst) { 741686cdd19SJun-ichiro itojun Hagino free((caddr_t)sc->gif_pdst, M_IFADDR); 742686cdd19SJun-ichiro itojun Hagino sc->gif_pdst = NULL; 743686cdd19SJun-ichiro itojun Hagino } 74433841545SHajimu UMEMOTO /* change the IFF_{UP, RUNNING} flag as well? */ 745686cdd19SJun-ichiro itojun Hagino break; 746686cdd19SJun-ichiro itojun Hagino #endif 747686cdd19SJun-ichiro itojun Hagino 748cfa1ca9dSYoshinobu Inoue case SIOCGIFPSRCADDR: 749cfa1ca9dSYoshinobu Inoue #ifdef INET6 750cfa1ca9dSYoshinobu Inoue case SIOCGIFPSRCADDR_IN6: 751cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 752cfa1ca9dSYoshinobu Inoue if (sc->gif_psrc == NULL) { 753cfa1ca9dSYoshinobu Inoue error = EADDRNOTAVAIL; 754cfa1ca9dSYoshinobu Inoue goto bad; 755cfa1ca9dSYoshinobu Inoue } 756cfa1ca9dSYoshinobu Inoue src = sc->gif_psrc; 75733841545SHajimu UMEMOTO switch (cmd) { 758cfa1ca9dSYoshinobu Inoue #ifdef INET 75933841545SHajimu UMEMOTO case SIOCGIFPSRCADDR: 760cfa1ca9dSYoshinobu Inoue dst = &ifr->ifr_addr; 76133841545SHajimu UMEMOTO size = sizeof(ifr->ifr_addr); 762cfa1ca9dSYoshinobu Inoue break; 763cfa1ca9dSYoshinobu Inoue #endif /* INET */ 764cfa1ca9dSYoshinobu Inoue #ifdef INET6 76533841545SHajimu UMEMOTO case SIOCGIFPSRCADDR_IN6: 766cfa1ca9dSYoshinobu Inoue dst = (struct sockaddr *) 767cfa1ca9dSYoshinobu Inoue &(((struct in6_ifreq *)data)->ifr_addr); 76833841545SHajimu UMEMOTO size = sizeof(((struct in6_ifreq *)data)->ifr_addr); 769cfa1ca9dSYoshinobu Inoue break; 770cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 771cfa1ca9dSYoshinobu Inoue default: 772cfa1ca9dSYoshinobu Inoue error = EADDRNOTAVAIL; 773cfa1ca9dSYoshinobu Inoue goto bad; 774cfa1ca9dSYoshinobu Inoue } 77533841545SHajimu UMEMOTO if (src->sa_len > size) 77633841545SHajimu UMEMOTO return EINVAL; 77733841545SHajimu UMEMOTO bcopy((caddr_t)src, (caddr_t)dst, src->sa_len); 778cfa1ca9dSYoshinobu Inoue break; 779cfa1ca9dSYoshinobu Inoue 780cfa1ca9dSYoshinobu Inoue case SIOCGIFPDSTADDR: 781cfa1ca9dSYoshinobu Inoue #ifdef INET6 782cfa1ca9dSYoshinobu Inoue case SIOCGIFPDSTADDR_IN6: 783cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 784cfa1ca9dSYoshinobu Inoue if (sc->gif_pdst == NULL) { 785cfa1ca9dSYoshinobu Inoue error = EADDRNOTAVAIL; 786cfa1ca9dSYoshinobu Inoue goto bad; 787cfa1ca9dSYoshinobu Inoue } 788cfa1ca9dSYoshinobu Inoue src = sc->gif_pdst; 78933841545SHajimu UMEMOTO switch (cmd) { 790cfa1ca9dSYoshinobu Inoue #ifdef INET 79133841545SHajimu UMEMOTO case SIOCGIFPDSTADDR: 792cfa1ca9dSYoshinobu Inoue dst = &ifr->ifr_addr; 79333841545SHajimu UMEMOTO size = sizeof(ifr->ifr_addr); 794cfa1ca9dSYoshinobu Inoue break; 795cfa1ca9dSYoshinobu Inoue #endif /* INET */ 796cfa1ca9dSYoshinobu Inoue #ifdef INET6 79733841545SHajimu UMEMOTO case SIOCGIFPDSTADDR_IN6: 798cfa1ca9dSYoshinobu Inoue dst = (struct sockaddr *) 799cfa1ca9dSYoshinobu Inoue &(((struct in6_ifreq *)data)->ifr_addr); 80033841545SHajimu UMEMOTO size = sizeof(((struct in6_ifreq *)data)->ifr_addr); 801cfa1ca9dSYoshinobu Inoue break; 802cfa1ca9dSYoshinobu Inoue #endif /* INET6 */ 803cfa1ca9dSYoshinobu Inoue default: 804cfa1ca9dSYoshinobu Inoue error = EADDRNOTAVAIL; 805cfa1ca9dSYoshinobu Inoue goto bad; 806cfa1ca9dSYoshinobu Inoue } 80733841545SHajimu UMEMOTO if (src->sa_len > size) 80833841545SHajimu UMEMOTO return EINVAL; 80933841545SHajimu UMEMOTO bcopy((caddr_t)src, (caddr_t)dst, src->sa_len); 81033841545SHajimu UMEMOTO break; 81133841545SHajimu UMEMOTO 81233841545SHajimu UMEMOTO case SIOCGLIFPHYADDR: 81333841545SHajimu UMEMOTO if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) { 81433841545SHajimu UMEMOTO error = EADDRNOTAVAIL; 81533841545SHajimu UMEMOTO goto bad; 81633841545SHajimu UMEMOTO } 81733841545SHajimu UMEMOTO 81833841545SHajimu UMEMOTO /* copy src */ 81933841545SHajimu UMEMOTO src = sc->gif_psrc; 82033841545SHajimu UMEMOTO dst = (struct sockaddr *) 82133841545SHajimu UMEMOTO &(((struct if_laddrreq *)data)->addr); 82233841545SHajimu UMEMOTO size = sizeof(((struct if_laddrreq *)data)->addr); 82333841545SHajimu UMEMOTO if (src->sa_len > size) 82433841545SHajimu UMEMOTO return EINVAL; 82533841545SHajimu UMEMOTO bcopy((caddr_t)src, (caddr_t)dst, src->sa_len); 82633841545SHajimu UMEMOTO 82733841545SHajimu UMEMOTO /* copy dst */ 82833841545SHajimu UMEMOTO src = sc->gif_pdst; 82933841545SHajimu UMEMOTO dst = (struct sockaddr *) 83033841545SHajimu UMEMOTO &(((struct if_laddrreq *)data)->dstaddr); 83133841545SHajimu UMEMOTO size = sizeof(((struct if_laddrreq *)data)->dstaddr); 83233841545SHajimu UMEMOTO if (src->sa_len > size) 83333841545SHajimu UMEMOTO return EINVAL; 83433841545SHajimu UMEMOTO bcopy((caddr_t)src, (caddr_t)dst, src->sa_len); 835cfa1ca9dSYoshinobu Inoue break; 836cfa1ca9dSYoshinobu Inoue 837cfa1ca9dSYoshinobu Inoue case SIOCSIFFLAGS: 838686cdd19SJun-ichiro itojun Hagino /* if_ioctl() takes care of it */ 839cfa1ca9dSYoshinobu Inoue break; 840cfa1ca9dSYoshinobu Inoue 841cfa1ca9dSYoshinobu Inoue default: 842cfa1ca9dSYoshinobu Inoue error = EINVAL; 843cfa1ca9dSYoshinobu Inoue break; 844cfa1ca9dSYoshinobu Inoue } 845cfa1ca9dSYoshinobu Inoue bad: 846cfa1ca9dSYoshinobu Inoue return error; 847cfa1ca9dSYoshinobu Inoue } 84853dab5feSBrooks Davis 84953dab5feSBrooks Davis void 85053dab5feSBrooks Davis gif_delete_tunnel(sc) 85153dab5feSBrooks Davis struct gif_softc *sc; 85253dab5feSBrooks Davis { 85353dab5feSBrooks Davis /* XXX: NetBSD protects this function with splsoftnet() */ 85453dab5feSBrooks Davis 85553dab5feSBrooks Davis if (sc->gif_psrc) { 85653dab5feSBrooks Davis free((caddr_t)sc->gif_psrc, M_IFADDR); 85753dab5feSBrooks Davis sc->gif_psrc = NULL; 85853dab5feSBrooks Davis } 85953dab5feSBrooks Davis if (sc->gif_pdst) { 86053dab5feSBrooks Davis free((caddr_t)sc->gif_pdst, M_IFADDR); 86153dab5feSBrooks Davis sc->gif_pdst = NULL; 86253dab5feSBrooks Davis } 86353dab5feSBrooks Davis /* change the IFF_UP flag as well? */ 86453dab5feSBrooks Davis } 865