xref: /freebsd/sys/net/if_gif.c (revision 20af0ffaa11c896c3388acef3f82a34eb987e107)
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>
45cfa1ca9dSYoshinobu Inoue #include <sys/syslog.h>
46686cdd19SJun-ichiro itojun Hagino #include <sys/protosw.h>
4753dab5feSBrooks Davis #include <sys/conf.h>
4853dab5feSBrooks Davis #include <machine/bus.h>	/* XXX: Shouldn't really be required! */
4953dab5feSBrooks Davis #include <sys/rman.h>
50cfa1ca9dSYoshinobu Inoue #include <machine/cpu.h>
51cfa1ca9dSYoshinobu Inoue 
52cfa1ca9dSYoshinobu Inoue #include <net/if.h>
53cfa1ca9dSYoshinobu Inoue #include <net/if_types.h>
54cfa1ca9dSYoshinobu Inoue #include <net/netisr.h>
55cfa1ca9dSYoshinobu Inoue #include <net/route.h>
56cfa1ca9dSYoshinobu Inoue #include <net/bpf.h>
57cfa1ca9dSYoshinobu Inoue 
58cfa1ca9dSYoshinobu Inoue #include <netinet/in.h>
59cfa1ca9dSYoshinobu Inoue #include <netinet/in_systm.h>
60cfa1ca9dSYoshinobu Inoue #include <netinet/ip.h>
6133841545SHajimu UMEMOTO #ifdef	INET
6233841545SHajimu UMEMOTO #include <netinet/in_var.h>
63cfa1ca9dSYoshinobu Inoue #include <netinet/in_gif.h>
6453dab5feSBrooks Davis #include <netinet/ip_var.h>
65cfa1ca9dSYoshinobu Inoue #endif	/* INET */
66cfa1ca9dSYoshinobu Inoue 
67cfa1ca9dSYoshinobu Inoue #ifdef INET6
68cfa1ca9dSYoshinobu Inoue #ifndef INET
69cfa1ca9dSYoshinobu Inoue #include <netinet/in.h>
70cfa1ca9dSYoshinobu Inoue #endif
71cfa1ca9dSYoshinobu Inoue #include <netinet6/in6_var.h>
72cfa1ca9dSYoshinobu Inoue #include <netinet/ip6.h>
73cfa1ca9dSYoshinobu Inoue #include <netinet6/ip6_var.h>
74cfa1ca9dSYoshinobu Inoue #include <netinet6/in6_gif.h>
75686cdd19SJun-ichiro itojun Hagino #include <netinet6/ip6protosw.h>
76cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
77cfa1ca9dSYoshinobu Inoue 
78686cdd19SJun-ichiro itojun Hagino #include <netinet/ip_encap.h>
79cfa1ca9dSYoshinobu Inoue #include <net/if_gif.h>
80cfa1ca9dSYoshinobu Inoue 
81cfa1ca9dSYoshinobu Inoue #include <net/net_osdep.h>
82cfa1ca9dSYoshinobu Inoue 
8353dab5feSBrooks Davis #define GIFNAME		"gif"
8453dab5feSBrooks Davis #define GIF_MAXUNIT	0x7fff	/* ifp->if_unit is only 15 bits */
85686cdd19SJun-ichiro itojun Hagino 
8653dab5feSBrooks Davis static MALLOC_DEFINE(M_GIF, "gif", "Generic Tunnel Interface");
8753dab5feSBrooks Davis static struct rman gifunits[1];
8820af0ffaSBrooks Davis LIST_HEAD(, gif_softc) gif_softc_list;
8953dab5feSBrooks Davis 
9053dab5feSBrooks Davis int	gif_clone_create __P((struct if_clone *, int *));
9153dab5feSBrooks Davis void	gif_clone_destroy __P((struct ifnet *));
9253dab5feSBrooks Davis 
9353dab5feSBrooks Davis struct if_clone gif_cloner =
9453dab5feSBrooks Davis     IF_CLONE_INITIALIZER("gif", gif_clone_create, gif_clone_destroy);
9553dab5feSBrooks Davis 
9653dab5feSBrooks Davis static int gifmodevent __P((module_t, int, void *));
9753dab5feSBrooks Davis void gif_delete_tunnel __P((struct gif_softc *));
98686cdd19SJun-ichiro itojun Hagino static int gif_encapcheck __P((const struct mbuf *, int, int, void *));
9953dab5feSBrooks Davis 
100686cdd19SJun-ichiro itojun Hagino #ifdef INET
10153dab5feSBrooks Davis extern  struct domain inetdomain;
102f0ffb944SJulian Elischer struct protosw in_gif_protosw =
10353dab5feSBrooks Davis { SOCK_RAW,	&inetdomain,	0/*IPPROTO_IPV[46]*/,	PR_ATOMIC|PR_ADDR,
10453dab5feSBrooks Davis   in_gif_input,	rip_output,	0,		rip_ctloutput,
10553dab5feSBrooks Davis   0,
10653dab5feSBrooks Davis   0,		0,		0,		0,
10753dab5feSBrooks Davis   &rip_usrreqs
10853dab5feSBrooks Davis };
109686cdd19SJun-ichiro itojun Hagino #endif
110686cdd19SJun-ichiro itojun Hagino #ifdef INET6
11153dab5feSBrooks Davis extern  struct domain6 inet6domain;
11253dab5feSBrooks Davis struct ip6protosw in6_gif_protosw =
11353dab5feSBrooks Davis { SOCK_RAW,	&inet6domain,	0/*IPPROTO_IPV[46]*/,	PR_ATOMIC|PR_ADDR,
11453dab5feSBrooks Davis   in6_gif_input, rip6_output,	0,		rip6_ctloutput,
11553dab5feSBrooks Davis   0,
11653dab5feSBrooks Davis   0,		0,		0,		0,
11753dab5feSBrooks Davis   &rip6_usrreqs
11853dab5feSBrooks Davis };
119686cdd19SJun-ichiro itojun Hagino #endif
120cfa1ca9dSYoshinobu Inoue 
121686cdd19SJun-ichiro itojun Hagino #ifndef MAX_GIF_NEST
122686cdd19SJun-ichiro itojun Hagino /*
123686cdd19SJun-ichiro itojun Hagino  * This macro controls the upper limitation on nesting of gif tunnels.
124686cdd19SJun-ichiro itojun Hagino  * Since, setting a large value to this macro with a careless configuration
125686cdd19SJun-ichiro itojun Hagino  * may introduce system crash, we don't allow any nestings by default.
126686cdd19SJun-ichiro itojun Hagino  * If you need to configure nested gif tunnels, you can define this macro
127686cdd19SJun-ichiro itojun Hagino  * in your kernel configuration file. However, if you do so, please be
128686cdd19SJun-ichiro itojun Hagino  * careful to configure the tunnels so that it won't make a loop.
129686cdd19SJun-ichiro itojun Hagino  */
130686cdd19SJun-ichiro itojun Hagino #define MAX_GIF_NEST 1
131686cdd19SJun-ichiro itojun Hagino #endif
132686cdd19SJun-ichiro itojun Hagino static int max_gif_nesting = MAX_GIF_NEST;
133cfa1ca9dSYoshinobu Inoue 
13453dab5feSBrooks Davis int
13553dab5feSBrooks Davis gif_clone_create(ifc, unit)
13653dab5feSBrooks Davis 	struct if_clone *ifc;
13753dab5feSBrooks Davis 	int *unit;
138cfa1ca9dSYoshinobu Inoue {
13953dab5feSBrooks Davis 	struct resource *r;
14033841545SHajimu UMEMOTO 	struct gif_softc *sc;
141cfa1ca9dSYoshinobu Inoue 
14253dab5feSBrooks Davis 	if (*unit > GIF_MAXUNIT)
14353dab5feSBrooks Davis 		return (ENXIO);
14453dab5feSBrooks Davis 
14553dab5feSBrooks Davis 	if (*unit < 0) {
14653dab5feSBrooks Davis 		r = rman_reserve_resource(gifunits, 0, GIF_MAXUNIT, 1,
14753dab5feSBrooks Davis 		    RF_ALLOCATED | RF_ACTIVE, NULL);
14853dab5feSBrooks Davis 		if (r == NULL)
14953dab5feSBrooks Davis 			return (ENOSPC);
15053dab5feSBrooks Davis 		*unit = rman_get_start(r);
15153dab5feSBrooks Davis 	} else {
15253dab5feSBrooks Davis 		r = rman_reserve_resource(gifunits, *unit, *unit, 1,
15353dab5feSBrooks Davis 		    RF_ALLOCATED | RF_ACTIVE, NULL);
15453dab5feSBrooks Davis 		if (r == NULL)
15553dab5feSBrooks Davis 			return (EEXIST);
15653dab5feSBrooks Davis 	}
15753dab5feSBrooks Davis 
15853dab5feSBrooks Davis 	sc = malloc (sizeof(struct gif_softc), M_GIF, M_WAITOK);
15953dab5feSBrooks Davis 	bzero(sc, sizeof(struct gif_softc));
16053dab5feSBrooks Davis 
16153dab5feSBrooks Davis 	sc->gif_if.if_softc = sc;
16253dab5feSBrooks Davis 	sc->gif_if.if_name = GIFNAME;
16353dab5feSBrooks Davis 	sc->gif_if.if_unit = *unit;
16453dab5feSBrooks Davis 	sc->r_unit = r;
165686cdd19SJun-ichiro itojun Hagino 
166686cdd19SJun-ichiro itojun Hagino 	sc->encap_cookie4 = sc->encap_cookie6 = NULL;
167686cdd19SJun-ichiro itojun Hagino #ifdef INET
168686cdd19SJun-ichiro itojun Hagino 	sc->encap_cookie4 = encap_attach_func(AF_INET, -1,
16953dab5feSBrooks Davis 	    gif_encapcheck, (struct protosw*)&in_gif_protosw, sc);
170686cdd19SJun-ichiro itojun Hagino 	if (sc->encap_cookie4 == NULL) {
17153dab5feSBrooks Davis 		printf("%s: unable to attach encap4\n", if_name(&sc->gif_if));
17253dab5feSBrooks Davis 		free(sc, M_GIF);
17353dab5feSBrooks Davis 		return (EIO);	/* XXX */
174686cdd19SJun-ichiro itojun Hagino 	}
175686cdd19SJun-ichiro itojun Hagino #endif
176686cdd19SJun-ichiro itojun Hagino #ifdef INET6
177686cdd19SJun-ichiro itojun Hagino 	sc->encap_cookie6 = encap_attach_func(AF_INET6, -1,
178686cdd19SJun-ichiro itojun Hagino 	    gif_encapcheck, (struct protosw *)&in6_gif_protosw, sc);
179686cdd19SJun-ichiro itojun Hagino 	if (sc->encap_cookie6 == NULL) {
180686cdd19SJun-ichiro itojun Hagino 		if (sc->encap_cookie4) {
181686cdd19SJun-ichiro itojun Hagino 			encap_detach(sc->encap_cookie4);
182686cdd19SJun-ichiro itojun Hagino 			sc->encap_cookie4 = NULL;
183686cdd19SJun-ichiro itojun Hagino 		}
18453dab5feSBrooks Davis 		printf("%s: unable to attach encap6\n", if_name(&sc->gif_if));
18553dab5feSBrooks Davis 		free(sc, M_GIF);
18653dab5feSBrooks Davis 		return (EIO);	/* XXX */
187686cdd19SJun-ichiro itojun Hagino 	}
188686cdd19SJun-ichiro itojun Hagino #endif
189686cdd19SJun-ichiro itojun Hagino 
190cfa1ca9dSYoshinobu Inoue 	sc->gif_if.if_mtu    = GIF_MTU;
191cfa1ca9dSYoshinobu Inoue 	sc->gif_if.if_flags  = IFF_POINTOPOINT | IFF_MULTICAST;
19233841545SHajimu UMEMOTO #if 0
19333841545SHajimu UMEMOTO 	/* turn off ingress filter */
19433841545SHajimu UMEMOTO 	sc->gif_if.if_flags  |= IFF_LINK2;
19533841545SHajimu UMEMOTO #endif
196cfa1ca9dSYoshinobu Inoue 	sc->gif_if.if_ioctl  = gif_ioctl;
197cfa1ca9dSYoshinobu Inoue 	sc->gif_if.if_output = gif_output;
198cfa1ca9dSYoshinobu Inoue 	sc->gif_if.if_type   = IFT_GIF;
199686cdd19SJun-ichiro itojun Hagino 	sc->gif_if.if_snd.ifq_maxlen = IFQ_MAXLEN;
200cfa1ca9dSYoshinobu Inoue 	if_attach(&sc->gif_if);
201cfa1ca9dSYoshinobu Inoue 	bpfattach(&sc->gif_if, DLT_NULL, sizeof(u_int));
20220af0ffaSBrooks Davis 	LIST_INSERT_HEAD(&gif_softc_list, sc, gif_link);
20353dab5feSBrooks Davis 	return (0);
204cfa1ca9dSYoshinobu Inoue }
205cfa1ca9dSYoshinobu Inoue 
20653dab5feSBrooks Davis void
20753dab5feSBrooks Davis gif_clone_destroy(ifp)
20853dab5feSBrooks Davis 	struct ifnet *ifp;
20953dab5feSBrooks Davis {
21053dab5feSBrooks Davis 	int err;
21153dab5feSBrooks Davis 	struct gif_softc *sc = ifp->if_softc;
21253dab5feSBrooks Davis 
21353dab5feSBrooks Davis 	gif_delete_tunnel(sc);
21420af0ffaSBrooks Davis 	LIST_REMOVE(sc, gif_link);
21553dab5feSBrooks Davis 	if (sc->encap_cookie4 != NULL) {
21653dab5feSBrooks Davis 		err = encap_detach(sc->encap_cookie4);
21753dab5feSBrooks Davis 		KASSERT(err == 0, ("Unexpected error detaching encap_cookie4"));
21853dab5feSBrooks Davis 	}
21953dab5feSBrooks Davis 	if (sc->encap_cookie6 != NULL) {
22053dab5feSBrooks Davis 		err = encap_detach(sc->encap_cookie6);
22153dab5feSBrooks Davis 		KASSERT(err == 0, ("Unexpected error detaching encap_cookie6"));
22253dab5feSBrooks Davis 	}
22353dab5feSBrooks Davis 
22453dab5feSBrooks Davis 	bpfdetach(ifp);
22553dab5feSBrooks Davis 	if_detach(ifp);
22653dab5feSBrooks Davis 
22753dab5feSBrooks Davis 	err = rman_release_resource(sc->r_unit);
22853dab5feSBrooks Davis 	KASSERT(err == 0, ("Unexpected error freeing resource"));
22953dab5feSBrooks Davis 
23053dab5feSBrooks Davis 	free(sc, M_GIF);
23153dab5feSBrooks Davis }
23253dab5feSBrooks Davis 
23353dab5feSBrooks Davis static int
23453dab5feSBrooks Davis gifmodevent(mod, type, data)
23553dab5feSBrooks Davis 	module_t mod;
23653dab5feSBrooks Davis 	int type;
23753dab5feSBrooks Davis 	void *data;
23853dab5feSBrooks Davis {
23953dab5feSBrooks Davis 	int err;
24053dab5feSBrooks Davis 
24153dab5feSBrooks Davis 	switch (type) {
24253dab5feSBrooks Davis 	case MOD_LOAD:
24353dab5feSBrooks Davis 		gifunits->rm_type = RMAN_ARRAY;
24453dab5feSBrooks Davis 		gifunits->rm_descr = "configurable if_gif units";
24553dab5feSBrooks Davis 		err = rman_init(gifunits);
24653dab5feSBrooks Davis 		if (err != 0)
24753dab5feSBrooks Davis 			return (err);
24853dab5feSBrooks Davis 		err = rman_manage_region(gifunits, 0, GIF_MAXUNIT);
24953dab5feSBrooks Davis 		if (err != 0) {
25053dab5feSBrooks Davis 			printf("%s: gifunits: rman_manage_region: Failed %d\n",
25153dab5feSBrooks Davis 			    GIFNAME, err);
25253dab5feSBrooks Davis 			rman_fini(gifunits);
25353dab5feSBrooks Davis 			return (err);
25453dab5feSBrooks Davis 		}
25520af0ffaSBrooks Davis 		LIST_INIT(&gif_softc_list);
25653dab5feSBrooks Davis 		if_clone_attach(&gif_cloner);
25753dab5feSBrooks Davis 
25853dab5feSBrooks Davis #ifdef INET6
25953dab5feSBrooks Davis 		ip6_gif_hlim = GIF_HLIM;
26053dab5feSBrooks Davis #endif
26153dab5feSBrooks Davis 
26253dab5feSBrooks Davis 		break;
26353dab5feSBrooks Davis 	case MOD_UNLOAD:
26453dab5feSBrooks Davis 		if_clone_detach(&gif_cloner);
26553dab5feSBrooks Davis 
26620af0ffaSBrooks Davis 		while (!LIST_EMPTY(&gif_softc_list))
26720af0ffaSBrooks Davis 			gif_clone_destroy(&LIST_FIRST(&gif_softc_list)->gif_if);
26853dab5feSBrooks Davis 
26953dab5feSBrooks Davis 		err = rman_fini(gifunits);
27053dab5feSBrooks Davis 		if (err != 0)
27153dab5feSBrooks Davis 			return (err);
27253dab5feSBrooks Davis #ifdef INET6
27353dab5feSBrooks Davis 		ip6_gif_hlim = 0;
27453dab5feSBrooks Davis #endif
27553dab5feSBrooks Davis 		break;
27653dab5feSBrooks Davis 	}
27753dab5feSBrooks Davis 	return 0;
27853dab5feSBrooks Davis }
27953dab5feSBrooks Davis 
28053dab5feSBrooks Davis static moduledata_t gif_mod = {
28153dab5feSBrooks Davis 	"if_gif",
28253dab5feSBrooks Davis 	gifmodevent,
28353dab5feSBrooks Davis 	0
28453dab5feSBrooks Davis };
28553dab5feSBrooks Davis 
28653dab5feSBrooks Davis DECLARE_MODULE(if_gif, gif_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
28720af0ffaSBrooks Davis MODULE_VERSION(if_gif, 1);
288cfa1ca9dSYoshinobu Inoue 
289686cdd19SJun-ichiro itojun Hagino static int
290686cdd19SJun-ichiro itojun Hagino gif_encapcheck(m, off, proto, arg)
291686cdd19SJun-ichiro itojun Hagino 	const struct mbuf *m;
292686cdd19SJun-ichiro itojun Hagino 	int off;
293686cdd19SJun-ichiro itojun Hagino 	int proto;
294686cdd19SJun-ichiro itojun Hagino 	void *arg;
295686cdd19SJun-ichiro itojun Hagino {
296686cdd19SJun-ichiro itojun Hagino 	struct ip ip;
297686cdd19SJun-ichiro itojun Hagino 	struct gif_softc *sc;
298686cdd19SJun-ichiro itojun Hagino 
299686cdd19SJun-ichiro itojun Hagino 	sc = (struct gif_softc *)arg;
300686cdd19SJun-ichiro itojun Hagino 	if (sc == NULL)
301686cdd19SJun-ichiro itojun Hagino 		return 0;
302686cdd19SJun-ichiro itojun Hagino 
303686cdd19SJun-ichiro itojun Hagino 	if ((sc->gif_if.if_flags & IFF_UP) == 0)
304686cdd19SJun-ichiro itojun Hagino 		return 0;
305686cdd19SJun-ichiro itojun Hagino 
306686cdd19SJun-ichiro itojun Hagino 	/* no physical address */
307686cdd19SJun-ichiro itojun Hagino 	if (!sc->gif_psrc || !sc->gif_pdst)
308686cdd19SJun-ichiro itojun Hagino 		return 0;
309686cdd19SJun-ichiro itojun Hagino 
310686cdd19SJun-ichiro itojun Hagino 	switch (proto) {
311686cdd19SJun-ichiro itojun Hagino #ifdef INET
312686cdd19SJun-ichiro itojun Hagino 	case IPPROTO_IPV4:
313686cdd19SJun-ichiro itojun Hagino 		break;
314686cdd19SJun-ichiro itojun Hagino #endif
315686cdd19SJun-ichiro itojun Hagino #ifdef INET6
316686cdd19SJun-ichiro itojun Hagino 	case IPPROTO_IPV6:
317686cdd19SJun-ichiro itojun Hagino 		break;
318686cdd19SJun-ichiro itojun Hagino #endif
319686cdd19SJun-ichiro itojun Hagino 	default:
320686cdd19SJun-ichiro itojun Hagino 		return 0;
321686cdd19SJun-ichiro itojun Hagino 	}
322686cdd19SJun-ichiro itojun Hagino 
323686cdd19SJun-ichiro itojun Hagino 	/* LINTED const cast */
324686cdd19SJun-ichiro itojun Hagino 	m_copydata((struct mbuf *)m, 0, sizeof(ip), (caddr_t)&ip);
325686cdd19SJun-ichiro itojun Hagino 
326686cdd19SJun-ichiro itojun Hagino 	switch (ip.ip_v) {
327686cdd19SJun-ichiro itojun Hagino #ifdef INET
328686cdd19SJun-ichiro itojun Hagino 	case 4:
329686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_psrc->sa_family != AF_INET ||
330686cdd19SJun-ichiro itojun Hagino 		    sc->gif_pdst->sa_family != AF_INET)
331686cdd19SJun-ichiro itojun Hagino 			return 0;
332686cdd19SJun-ichiro itojun Hagino 		return gif_encapcheck4(m, off, proto, arg);
333686cdd19SJun-ichiro itojun Hagino #endif
334686cdd19SJun-ichiro itojun Hagino #ifdef INET6
335686cdd19SJun-ichiro itojun Hagino 	case 6:
336686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_psrc->sa_family != AF_INET6 ||
337686cdd19SJun-ichiro itojun Hagino 		    sc->gif_pdst->sa_family != AF_INET6)
338686cdd19SJun-ichiro itojun Hagino 			return 0;
339686cdd19SJun-ichiro itojun Hagino 		return gif_encapcheck6(m, off, proto, arg);
340686cdd19SJun-ichiro itojun Hagino #endif
341686cdd19SJun-ichiro itojun Hagino 	default:
342686cdd19SJun-ichiro itojun Hagino 		return 0;
343686cdd19SJun-ichiro itojun Hagino 	}
344686cdd19SJun-ichiro itojun Hagino }
345686cdd19SJun-ichiro itojun Hagino 
346cfa1ca9dSYoshinobu Inoue int
347cfa1ca9dSYoshinobu Inoue gif_output(ifp, m, dst, rt)
348cfa1ca9dSYoshinobu Inoue 	struct ifnet *ifp;
349cfa1ca9dSYoshinobu Inoue 	struct mbuf *m;
350cfa1ca9dSYoshinobu Inoue 	struct sockaddr *dst;
351cfa1ca9dSYoshinobu Inoue 	struct rtentry *rt;	/* added in net2 */
352cfa1ca9dSYoshinobu Inoue {
35333841545SHajimu UMEMOTO 	struct gif_softc *sc = (struct gif_softc*)ifp;
354cfa1ca9dSYoshinobu Inoue 	int error = 0;
355cfa1ca9dSYoshinobu Inoue 	static int called = 0;	/* XXX: MUTEX */
356cfa1ca9dSYoshinobu Inoue 
357cfa1ca9dSYoshinobu Inoue 	/*
358cfa1ca9dSYoshinobu Inoue 	 * gif may cause infinite recursion calls when misconfigured.
359cfa1ca9dSYoshinobu Inoue 	 * We'll prevent this by introducing upper limit.
360cfa1ca9dSYoshinobu Inoue 	 * XXX: this mechanism may introduce another problem about
361cfa1ca9dSYoshinobu Inoue 	 *      mutual exclusion of the variable CALLED, especially if we
362cfa1ca9dSYoshinobu Inoue 	 *      use kernel thread.
363cfa1ca9dSYoshinobu Inoue 	 */
364686cdd19SJun-ichiro itojun Hagino 	if (++called > max_gif_nesting) {
365cfa1ca9dSYoshinobu Inoue 		log(LOG_NOTICE,
366cfa1ca9dSYoshinobu Inoue 		    "gif_output: recursively called too many times(%d)\n",
367cfa1ca9dSYoshinobu Inoue 		    called);
368cfa1ca9dSYoshinobu Inoue 		m_freem(m);
369cfa1ca9dSYoshinobu Inoue 		error = EIO;	/* is there better errno? */
370cfa1ca9dSYoshinobu Inoue 		goto end;
371cfa1ca9dSYoshinobu Inoue 	}
372686cdd19SJun-ichiro itojun Hagino 
373cfa1ca9dSYoshinobu Inoue 	m->m_flags &= ~(M_BCAST|M_MCAST);
374cfa1ca9dSYoshinobu Inoue 	if (!(ifp->if_flags & IFF_UP) ||
375cfa1ca9dSYoshinobu Inoue 	    sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
376cfa1ca9dSYoshinobu Inoue 		m_freem(m);
377cfa1ca9dSYoshinobu Inoue 		error = ENETDOWN;
378cfa1ca9dSYoshinobu Inoue 		goto end;
379cfa1ca9dSYoshinobu Inoue 	}
380cfa1ca9dSYoshinobu Inoue 
381cfa1ca9dSYoshinobu Inoue 	if (ifp->if_bpf) {
382cfa1ca9dSYoshinobu Inoue 		/*
383cfa1ca9dSYoshinobu Inoue 		 * We need to prepend the address family as
384cfa1ca9dSYoshinobu Inoue 		 * a four byte field.  Cons up a dummy header
385cfa1ca9dSYoshinobu Inoue 		 * to pacify bpf.  This is safe because bpf
386cfa1ca9dSYoshinobu Inoue 		 * will only read from the mbuf (i.e., it won't
387cfa1ca9dSYoshinobu Inoue 		 * try to free it or keep a pointer a to it).
388cfa1ca9dSYoshinobu Inoue 		 */
389cfa1ca9dSYoshinobu Inoue 		struct mbuf m0;
39033841545SHajimu UMEMOTO 		u_int32_t af = dst->sa_family;
391cfa1ca9dSYoshinobu Inoue 
392cfa1ca9dSYoshinobu Inoue 		m0.m_next = m;
393cfa1ca9dSYoshinobu Inoue 		m0.m_len = 4;
394cfa1ca9dSYoshinobu Inoue 		m0.m_data = (char *)&af;
395cfa1ca9dSYoshinobu Inoue 
396cfa1ca9dSYoshinobu Inoue 		bpf_mtap(ifp, &m0);
397cfa1ca9dSYoshinobu Inoue 	}
398cfa1ca9dSYoshinobu Inoue 	ifp->if_opackets++;
399cfa1ca9dSYoshinobu Inoue 	ifp->if_obytes += m->m_pkthdr.len;
400cfa1ca9dSYoshinobu Inoue 
40133841545SHajimu UMEMOTO 	/* inner AF-specific encapsulation */
40233841545SHajimu UMEMOTO 
403686cdd19SJun-ichiro itojun Hagino 	/* XXX should we check if our outer source is legal? */
404686cdd19SJun-ichiro itojun Hagino 
40533841545SHajimu UMEMOTO 	/* dispatch to output logic based on outer AF */
406cfa1ca9dSYoshinobu Inoue 	switch (sc->gif_psrc->sa_family) {
407cfa1ca9dSYoshinobu Inoue #ifdef INET
408cfa1ca9dSYoshinobu Inoue 	case AF_INET:
409cfa1ca9dSYoshinobu Inoue 		error = in_gif_output(ifp, dst->sa_family, m, rt);
410cfa1ca9dSYoshinobu Inoue 		break;
411cfa1ca9dSYoshinobu Inoue #endif
412cfa1ca9dSYoshinobu Inoue #ifdef INET6
413cfa1ca9dSYoshinobu Inoue 	case AF_INET6:
414cfa1ca9dSYoshinobu Inoue 		error = in6_gif_output(ifp, dst->sa_family, m, rt);
415cfa1ca9dSYoshinobu Inoue 		break;
416cfa1ca9dSYoshinobu Inoue #endif
417cfa1ca9dSYoshinobu Inoue 	default:
418cfa1ca9dSYoshinobu Inoue 		m_freem(m);
419cfa1ca9dSYoshinobu Inoue 		error = ENETDOWN;
42033841545SHajimu UMEMOTO 		goto end;
421cfa1ca9dSYoshinobu Inoue 	}
422cfa1ca9dSYoshinobu Inoue 
423cfa1ca9dSYoshinobu Inoue   end:
424cfa1ca9dSYoshinobu Inoue 	called = 0;		/* reset recursion counter */
42533841545SHajimu UMEMOTO 	if (error)
42633841545SHajimu UMEMOTO 		ifp->if_oerrors++;
427cfa1ca9dSYoshinobu Inoue 	return error;
428cfa1ca9dSYoshinobu Inoue }
429cfa1ca9dSYoshinobu Inoue 
430cfa1ca9dSYoshinobu Inoue void
431cfa1ca9dSYoshinobu Inoue gif_input(m, af, gifp)
432cfa1ca9dSYoshinobu Inoue 	struct mbuf *m;
433cfa1ca9dSYoshinobu Inoue 	int af;
434cfa1ca9dSYoshinobu Inoue 	struct ifnet *gifp;
435cfa1ca9dSYoshinobu Inoue {
436df5e1987SJonathan Lemon 	int isr;
43733841545SHajimu UMEMOTO 	struct ifqueue *ifq = 0;
438cfa1ca9dSYoshinobu Inoue 
439cfa1ca9dSYoshinobu Inoue 	if (gifp == NULL) {
440cfa1ca9dSYoshinobu Inoue 		/* just in case */
441cfa1ca9dSYoshinobu Inoue 		m_freem(m);
442cfa1ca9dSYoshinobu Inoue 		return;
443cfa1ca9dSYoshinobu Inoue 	}
444cfa1ca9dSYoshinobu Inoue 
445cfa1ca9dSYoshinobu Inoue 	m->m_pkthdr.rcvif = gifp;
446cfa1ca9dSYoshinobu Inoue 
447cfa1ca9dSYoshinobu Inoue 	if (gifp->if_bpf) {
448cfa1ca9dSYoshinobu Inoue 		/*
449cfa1ca9dSYoshinobu Inoue 		 * We need to prepend the address family as
450cfa1ca9dSYoshinobu Inoue 		 * a four byte field.  Cons up a dummy header
451cfa1ca9dSYoshinobu Inoue 		 * to pacify bpf.  This is safe because bpf
452cfa1ca9dSYoshinobu Inoue 		 * will only read from the mbuf (i.e., it won't
453cfa1ca9dSYoshinobu Inoue 		 * try to free it or keep a pointer a to it).
454cfa1ca9dSYoshinobu Inoue 		 */
455cfa1ca9dSYoshinobu Inoue 		struct mbuf m0;
45633841545SHajimu UMEMOTO 		u_int32_t af1 = af;
457cfa1ca9dSYoshinobu Inoue 
458cfa1ca9dSYoshinobu Inoue 		m0.m_next = m;
459cfa1ca9dSYoshinobu Inoue 		m0.m_len = 4;
46033841545SHajimu UMEMOTO 		m0.m_data = (char *)&af1;
461cfa1ca9dSYoshinobu Inoue 
462cfa1ca9dSYoshinobu Inoue 		bpf_mtap(gifp, &m0);
463cfa1ca9dSYoshinobu Inoue 	}
464cfa1ca9dSYoshinobu Inoue 
465cfa1ca9dSYoshinobu Inoue 	/*
466cfa1ca9dSYoshinobu Inoue 	 * Put the packet to the network layer input queue according to the
467cfa1ca9dSYoshinobu Inoue 	 * specified address family.
468cfa1ca9dSYoshinobu Inoue 	 * Note: older versions of gif_input directly called network layer
469cfa1ca9dSYoshinobu Inoue 	 * input functions, e.g. ip6_input, here. We changed the policy to
470cfa1ca9dSYoshinobu Inoue 	 * prevent too many recursive calls of such input functions, which
471cfa1ca9dSYoshinobu Inoue 	 * might cause kernel panic. But the change may introduce another
472cfa1ca9dSYoshinobu Inoue 	 * problem; if the input queue is full, packets are discarded.
473cfa1ca9dSYoshinobu Inoue 	 * We believed it rarely occurs and changed the policy. If we find
474cfa1ca9dSYoshinobu Inoue 	 * it occurs more times than we thought, we may change the policy
475cfa1ca9dSYoshinobu Inoue 	 * again.
476cfa1ca9dSYoshinobu Inoue 	 */
477cfa1ca9dSYoshinobu Inoue 	switch (af) {
478cfa1ca9dSYoshinobu Inoue #ifdef INET
479cfa1ca9dSYoshinobu Inoue 	case AF_INET:
480cfa1ca9dSYoshinobu Inoue 		ifq = &ipintrq;
481cfa1ca9dSYoshinobu Inoue 		isr = NETISR_IP;
482cfa1ca9dSYoshinobu Inoue 		break;
483cfa1ca9dSYoshinobu Inoue #endif
484cfa1ca9dSYoshinobu Inoue #ifdef INET6
485cfa1ca9dSYoshinobu Inoue 	case AF_INET6:
486cfa1ca9dSYoshinobu Inoue 		ifq = &ip6intrq;
487cfa1ca9dSYoshinobu Inoue 		isr = NETISR_IPV6;
488cfa1ca9dSYoshinobu Inoue 		break;
489cfa1ca9dSYoshinobu Inoue #endif
490cfa1ca9dSYoshinobu Inoue 	default:
491cfa1ca9dSYoshinobu Inoue 		m_freem(m);
492cfa1ca9dSYoshinobu Inoue 		return;
493cfa1ca9dSYoshinobu Inoue 	}
494cfa1ca9dSYoshinobu Inoue 
495cfa1ca9dSYoshinobu Inoue 	gifp->if_ipackets++;
496cfa1ca9dSYoshinobu Inoue 	gifp->if_ibytes += m->m_pkthdr.len;
497df5e1987SJonathan Lemon 	(void) IF_HANDOFF(ifq, m, NULL);
498df5e1987SJonathan Lemon 	/* we need schednetisr since the address family may change */
499df5e1987SJonathan Lemon 	schednetisr(isr);
500cfa1ca9dSYoshinobu Inoue 
501cfa1ca9dSYoshinobu Inoue 	return;
502cfa1ca9dSYoshinobu Inoue }
503cfa1ca9dSYoshinobu Inoue 
504686cdd19SJun-ichiro itojun Hagino /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */
505cfa1ca9dSYoshinobu Inoue int
506cfa1ca9dSYoshinobu Inoue gif_ioctl(ifp, cmd, data)
507cfa1ca9dSYoshinobu Inoue 	struct ifnet *ifp;
508cfa1ca9dSYoshinobu Inoue 	u_long cmd;
509cfa1ca9dSYoshinobu Inoue 	caddr_t data;
510cfa1ca9dSYoshinobu Inoue {
511cfa1ca9dSYoshinobu Inoue 	struct gif_softc *sc  = (struct gif_softc*)ifp;
512cfa1ca9dSYoshinobu Inoue 	struct ifreq     *ifr = (struct ifreq*)data;
513cfa1ca9dSYoshinobu Inoue 	int error = 0, size;
514686cdd19SJun-ichiro itojun Hagino 	struct sockaddr *dst, *src;
515686cdd19SJun-ichiro itojun Hagino 	struct sockaddr *sa;
516a98dc5e6SYaroslav Tykhiy 	int s;
51753dab5feSBrooks Davis 	struct ifnet *ifp2;
518686cdd19SJun-ichiro itojun Hagino 	struct gif_softc *sc2;
519cfa1ca9dSYoshinobu Inoue 
520cfa1ca9dSYoshinobu Inoue 	switch (cmd) {
521cfa1ca9dSYoshinobu Inoue 	case SIOCSIFADDR:
522cfa1ca9dSYoshinobu Inoue 		break;
523cfa1ca9dSYoshinobu Inoue 
524cfa1ca9dSYoshinobu Inoue 	case SIOCSIFDSTADDR:
525cfa1ca9dSYoshinobu Inoue 		break;
526cfa1ca9dSYoshinobu Inoue 
527cfa1ca9dSYoshinobu Inoue 	case SIOCADDMULTI:
528cfa1ca9dSYoshinobu Inoue 	case SIOCDELMULTI:
529cfa1ca9dSYoshinobu Inoue 		break;
530cfa1ca9dSYoshinobu Inoue 
531686cdd19SJun-ichiro itojun Hagino #ifdef	SIOCSIFMTU /* xxx */
532cfa1ca9dSYoshinobu Inoue 	case SIOCGIFMTU:
533cfa1ca9dSYoshinobu Inoue 		break;
534686cdd19SJun-ichiro itojun Hagino 
535cfa1ca9dSYoshinobu Inoue 	case SIOCSIFMTU:
536cfa1ca9dSYoshinobu Inoue 		{
537cfa1ca9dSYoshinobu Inoue 			u_long mtu;
538cfa1ca9dSYoshinobu Inoue 			mtu = ifr->ifr_mtu;
539cfa1ca9dSYoshinobu Inoue 			if (mtu < GIF_MTU_MIN || mtu > GIF_MTU_MAX) {
540cfa1ca9dSYoshinobu Inoue 				return (EINVAL);
541cfa1ca9dSYoshinobu Inoue 			}
542cfa1ca9dSYoshinobu Inoue 			ifp->if_mtu = mtu;
543cfa1ca9dSYoshinobu Inoue 		}
544cfa1ca9dSYoshinobu Inoue 		break;
545686cdd19SJun-ichiro itojun Hagino #endif /* SIOCSIFMTU */
546cfa1ca9dSYoshinobu Inoue 
547cfa1ca9dSYoshinobu Inoue 	case SIOCSIFPHYADDR:
548cfa1ca9dSYoshinobu Inoue #ifdef INET6
549cfa1ca9dSYoshinobu Inoue 	case SIOCSIFPHYADDR_IN6:
550cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
55133841545SHajimu UMEMOTO 	case SIOCSLIFPHYADDR:
552686cdd19SJun-ichiro itojun Hagino 		switch (cmd) {
55333841545SHajimu UMEMOTO #ifdef INET
554686cdd19SJun-ichiro itojun Hagino 		case SIOCSIFPHYADDR:
555cfa1ca9dSYoshinobu Inoue 			src = (struct sockaddr *)
556cfa1ca9dSYoshinobu Inoue 				&(((struct in_aliasreq *)data)->ifra_addr);
557cfa1ca9dSYoshinobu Inoue 			dst = (struct sockaddr *)
558cfa1ca9dSYoshinobu Inoue 				&(((struct in_aliasreq *)data)->ifra_dstaddr);
559cfa1ca9dSYoshinobu Inoue 			break;
56033841545SHajimu UMEMOTO #endif
561cfa1ca9dSYoshinobu Inoue #ifdef INET6
562686cdd19SJun-ichiro itojun Hagino 		case SIOCSIFPHYADDR_IN6:
563cfa1ca9dSYoshinobu Inoue 			src = (struct sockaddr *)
564cfa1ca9dSYoshinobu Inoue 				&(((struct in6_aliasreq *)data)->ifra_addr);
565cfa1ca9dSYoshinobu Inoue 			dst = (struct sockaddr *)
566cfa1ca9dSYoshinobu Inoue 				&(((struct in6_aliasreq *)data)->ifra_dstaddr);
567686cdd19SJun-ichiro itojun Hagino 			break;
568686cdd19SJun-ichiro itojun Hagino #endif
56933841545SHajimu UMEMOTO 		case SIOCSLIFPHYADDR:
57033841545SHajimu UMEMOTO 			src = (struct sockaddr *)
57133841545SHajimu UMEMOTO 				&(((struct if_laddrreq *)data)->addr);
57233841545SHajimu UMEMOTO 			dst = (struct sockaddr *)
57333841545SHajimu UMEMOTO 				&(((struct if_laddrreq *)data)->dstaddr);
57433841545SHajimu UMEMOTO 		}
57533841545SHajimu UMEMOTO 
57633841545SHajimu UMEMOTO 		/* sa_family must be equal */
57733841545SHajimu UMEMOTO 		if (src->sa_family != dst->sa_family)
57833841545SHajimu UMEMOTO 			return EINVAL;
57933841545SHajimu UMEMOTO 
58033841545SHajimu UMEMOTO 		/* validate sa_len */
58133841545SHajimu UMEMOTO 		switch (src->sa_family) {
58233841545SHajimu UMEMOTO #ifdef INET
58333841545SHajimu UMEMOTO 		case AF_INET:
58433841545SHajimu UMEMOTO 			if (src->sa_len != sizeof(struct sockaddr_in))
58533841545SHajimu UMEMOTO 				return EINVAL;
58633841545SHajimu UMEMOTO 			break;
58733841545SHajimu UMEMOTO #endif
58833841545SHajimu UMEMOTO #ifdef INET6
58933841545SHajimu UMEMOTO 		case AF_INET6:
59033841545SHajimu UMEMOTO 			if (src->sa_len != sizeof(struct sockaddr_in6))
59133841545SHajimu UMEMOTO 				return EINVAL;
59233841545SHajimu UMEMOTO 			break;
59333841545SHajimu UMEMOTO #endif
59433841545SHajimu UMEMOTO 		default:
59533841545SHajimu UMEMOTO 			return EAFNOSUPPORT;
59633841545SHajimu UMEMOTO 		}
59733841545SHajimu UMEMOTO 		switch (dst->sa_family) {
59833841545SHajimu UMEMOTO #ifdef INET
59933841545SHajimu UMEMOTO 		case AF_INET:
60033841545SHajimu UMEMOTO 			if (dst->sa_len != sizeof(struct sockaddr_in))
60133841545SHajimu UMEMOTO 				return EINVAL;
60233841545SHajimu UMEMOTO 			break;
60333841545SHajimu UMEMOTO #endif
60433841545SHajimu UMEMOTO #ifdef INET6
60533841545SHajimu UMEMOTO 		case AF_INET6:
60633841545SHajimu UMEMOTO 			if (dst->sa_len != sizeof(struct sockaddr_in6))
60733841545SHajimu UMEMOTO 				return EINVAL;
60833841545SHajimu UMEMOTO 			break;
60933841545SHajimu UMEMOTO #endif
61033841545SHajimu UMEMOTO 		default:
61133841545SHajimu UMEMOTO 			return EAFNOSUPPORT;
61233841545SHajimu UMEMOTO 		}
61333841545SHajimu UMEMOTO 
61433841545SHajimu UMEMOTO 		/* check sa_family looks sane for the cmd */
61533841545SHajimu UMEMOTO 		switch (cmd) {
61633841545SHajimu UMEMOTO 		case SIOCSIFPHYADDR:
61733841545SHajimu UMEMOTO 			if (src->sa_family == AF_INET)
61833841545SHajimu UMEMOTO 				break;
61933841545SHajimu UMEMOTO 			return EAFNOSUPPORT;
62033841545SHajimu UMEMOTO #ifdef INET6
62133841545SHajimu UMEMOTO 		case SIOCSIFPHYADDR_IN6:
62233841545SHajimu UMEMOTO 			if (src->sa_family == AF_INET6)
62333841545SHajimu UMEMOTO 				break;
62433841545SHajimu UMEMOTO 			return EAFNOSUPPORT;
62533841545SHajimu UMEMOTO #endif /* INET6 */
62633841545SHajimu UMEMOTO 		case SIOCSLIFPHYADDR:
62733841545SHajimu UMEMOTO 			/* checks done in the above */
62833841545SHajimu UMEMOTO 			break;
629686cdd19SJun-ichiro itojun Hagino 		}
630cfa1ca9dSYoshinobu Inoue 
63153dab5feSBrooks Davis 		TAILQ_FOREACH(ifp2, &ifnet, if_link) {
63253dab5feSBrooks Davis 			if (strcmp(ifp2->if_name, GIFNAME) != 0)
63353dab5feSBrooks Davis 				continue;
63453dab5feSBrooks Davis 			sc2 = ifp2->if_softc;
635686cdd19SJun-ichiro itojun Hagino 			if (sc2 == sc)
636686cdd19SJun-ichiro itojun Hagino 				continue;
637686cdd19SJun-ichiro itojun Hagino 			if (!sc2->gif_pdst || !sc2->gif_psrc)
638686cdd19SJun-ichiro itojun Hagino 				continue;
639686cdd19SJun-ichiro itojun Hagino 			if (sc2->gif_pdst->sa_family != dst->sa_family ||
640686cdd19SJun-ichiro itojun Hagino 			    sc2->gif_pdst->sa_len != dst->sa_len ||
641686cdd19SJun-ichiro itojun Hagino 			    sc2->gif_psrc->sa_family != src->sa_family ||
642686cdd19SJun-ichiro itojun Hagino 			    sc2->gif_psrc->sa_len != src->sa_len)
643686cdd19SJun-ichiro itojun Hagino 				continue;
644914594eaSKris Kennaway #ifndef XBONEHACK
645686cdd19SJun-ichiro itojun Hagino 			/* can't configure same pair of address onto two gifs */
646686cdd19SJun-ichiro itojun Hagino 			if (bcmp(sc2->gif_pdst, dst, dst->sa_len) == 0 &&
647686cdd19SJun-ichiro itojun Hagino 			    bcmp(sc2->gif_psrc, src, src->sa_len) == 0) {
648cfa1ca9dSYoshinobu Inoue 				error = EADDRNOTAVAIL;
649cfa1ca9dSYoshinobu Inoue 				goto bad;
650cfa1ca9dSYoshinobu Inoue 			}
651914594eaSKris Kennaway #endif
652686cdd19SJun-ichiro itojun Hagino 
653686cdd19SJun-ichiro itojun Hagino 			/* can't configure multiple multi-dest interfaces */
654686cdd19SJun-ichiro itojun Hagino #define multidest(x) \
655686cdd19SJun-ichiro itojun Hagino 	(((struct sockaddr_in *)(x))->sin_addr.s_addr == INADDR_ANY)
656686cdd19SJun-ichiro itojun Hagino #ifdef INET6
657686cdd19SJun-ichiro itojun Hagino #define multidest6(x) \
658686cdd19SJun-ichiro itojun Hagino 	(IN6_IS_ADDR_UNSPECIFIED(&((struct sockaddr_in6 *)(x))->sin6_addr))
659686cdd19SJun-ichiro itojun Hagino #endif
660686cdd19SJun-ichiro itojun Hagino 			if (dst->sa_family == AF_INET &&
661686cdd19SJun-ichiro itojun Hagino 			    multidest(dst) && multidest(sc2->gif_pdst)) {
662686cdd19SJun-ichiro itojun Hagino 				error = EADDRNOTAVAIL;
663686cdd19SJun-ichiro itojun Hagino 				goto bad;
664cfa1ca9dSYoshinobu Inoue 			}
665686cdd19SJun-ichiro itojun Hagino #ifdef INET6
666686cdd19SJun-ichiro itojun Hagino 			if (dst->sa_family == AF_INET6 &&
667686cdd19SJun-ichiro itojun Hagino 			    multidest6(dst) && multidest6(sc2->gif_pdst)) {
668686cdd19SJun-ichiro itojun Hagino 				error = EADDRNOTAVAIL;
669686cdd19SJun-ichiro itojun Hagino 				goto bad;
670cfa1ca9dSYoshinobu Inoue 			}
671686cdd19SJun-ichiro itojun Hagino #endif
672686cdd19SJun-ichiro itojun Hagino 		}
673686cdd19SJun-ichiro itojun Hagino 
674686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_psrc)
675686cdd19SJun-ichiro itojun Hagino 			free((caddr_t)sc->gif_psrc, M_IFADDR);
67633841545SHajimu UMEMOTO 		sa = (struct sockaddr *)malloc(src->sa_len, M_IFADDR, M_WAITOK);
67733841545SHajimu UMEMOTO 		bcopy((caddr_t)src, (caddr_t)sa, src->sa_len);
678cfa1ca9dSYoshinobu Inoue 		sc->gif_psrc = sa;
679cfa1ca9dSYoshinobu Inoue 
680686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_pdst)
681686cdd19SJun-ichiro itojun Hagino 			free((caddr_t)sc->gif_pdst, M_IFADDR);
68233841545SHajimu UMEMOTO 		sa = (struct sockaddr *)malloc(dst->sa_len, M_IFADDR, M_WAITOK);
68333841545SHajimu UMEMOTO 		bcopy((caddr_t)dst, (caddr_t)sa, dst->sa_len);
684cfa1ca9dSYoshinobu Inoue 		sc->gif_pdst = sa;
685cfa1ca9dSYoshinobu Inoue 
686a98dc5e6SYaroslav Tykhiy 		ifp->if_flags |= IFF_RUNNING;
687a98dc5e6SYaroslav Tykhiy 		s = splimp();
688a98dc5e6SYaroslav Tykhiy 		if_up(ifp);	/* mark interface UP and send up RTM_IFINFO */
689a98dc5e6SYaroslav Tykhiy 		splx(s);
690cfa1ca9dSYoshinobu Inoue 
691686cdd19SJun-ichiro itojun Hagino 		error = 0;
692cfa1ca9dSYoshinobu Inoue 		break;
693cfa1ca9dSYoshinobu Inoue 
694686cdd19SJun-ichiro itojun Hagino #ifdef SIOCDIFPHYADDR
695686cdd19SJun-ichiro itojun Hagino 	case SIOCDIFPHYADDR:
696686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_psrc) {
697686cdd19SJun-ichiro itojun Hagino 			free((caddr_t)sc->gif_psrc, M_IFADDR);
698686cdd19SJun-ichiro itojun Hagino 			sc->gif_psrc = NULL;
699686cdd19SJun-ichiro itojun Hagino 		}
700686cdd19SJun-ichiro itojun Hagino 		if (sc->gif_pdst) {
701686cdd19SJun-ichiro itojun Hagino 			free((caddr_t)sc->gif_pdst, M_IFADDR);
702686cdd19SJun-ichiro itojun Hagino 			sc->gif_pdst = NULL;
703686cdd19SJun-ichiro itojun Hagino 		}
70433841545SHajimu UMEMOTO 		/* change the IFF_{UP, RUNNING} flag as well? */
705686cdd19SJun-ichiro itojun Hagino 		break;
706686cdd19SJun-ichiro itojun Hagino #endif
707686cdd19SJun-ichiro itojun Hagino 
708cfa1ca9dSYoshinobu Inoue 	case SIOCGIFPSRCADDR:
709cfa1ca9dSYoshinobu Inoue #ifdef INET6
710cfa1ca9dSYoshinobu Inoue 	case SIOCGIFPSRCADDR_IN6:
711cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
712cfa1ca9dSYoshinobu Inoue 		if (sc->gif_psrc == NULL) {
713cfa1ca9dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
714cfa1ca9dSYoshinobu Inoue 			goto bad;
715cfa1ca9dSYoshinobu Inoue 		}
716cfa1ca9dSYoshinobu Inoue 		src = sc->gif_psrc;
71733841545SHajimu UMEMOTO 		switch (cmd) {
718cfa1ca9dSYoshinobu Inoue #ifdef INET
71933841545SHajimu UMEMOTO 		case SIOCGIFPSRCADDR:
720cfa1ca9dSYoshinobu Inoue 			dst = &ifr->ifr_addr;
72133841545SHajimu UMEMOTO 			size = sizeof(ifr->ifr_addr);
722cfa1ca9dSYoshinobu Inoue 			break;
723cfa1ca9dSYoshinobu Inoue #endif /* INET */
724cfa1ca9dSYoshinobu Inoue #ifdef INET6
72533841545SHajimu UMEMOTO 		case SIOCGIFPSRCADDR_IN6:
726cfa1ca9dSYoshinobu Inoue 			dst = (struct sockaddr *)
727cfa1ca9dSYoshinobu Inoue 				&(((struct in6_ifreq *)data)->ifr_addr);
72833841545SHajimu UMEMOTO 			size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
729cfa1ca9dSYoshinobu Inoue 			break;
730cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
731cfa1ca9dSYoshinobu Inoue 		default:
732cfa1ca9dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
733cfa1ca9dSYoshinobu Inoue 			goto bad;
734cfa1ca9dSYoshinobu Inoue 		}
73533841545SHajimu UMEMOTO 		if (src->sa_len > size)
73633841545SHajimu UMEMOTO 			return EINVAL;
73733841545SHajimu UMEMOTO 		bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
738cfa1ca9dSYoshinobu Inoue 		break;
739cfa1ca9dSYoshinobu Inoue 
740cfa1ca9dSYoshinobu Inoue 	case SIOCGIFPDSTADDR:
741cfa1ca9dSYoshinobu Inoue #ifdef INET6
742cfa1ca9dSYoshinobu Inoue 	case SIOCGIFPDSTADDR_IN6:
743cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
744cfa1ca9dSYoshinobu Inoue 		if (sc->gif_pdst == NULL) {
745cfa1ca9dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
746cfa1ca9dSYoshinobu Inoue 			goto bad;
747cfa1ca9dSYoshinobu Inoue 		}
748cfa1ca9dSYoshinobu Inoue 		src = sc->gif_pdst;
74933841545SHajimu UMEMOTO 		switch (cmd) {
750cfa1ca9dSYoshinobu Inoue #ifdef INET
75133841545SHajimu UMEMOTO 		case SIOCGIFPDSTADDR:
752cfa1ca9dSYoshinobu Inoue 			dst = &ifr->ifr_addr;
75333841545SHajimu UMEMOTO 			size = sizeof(ifr->ifr_addr);
754cfa1ca9dSYoshinobu Inoue 			break;
755cfa1ca9dSYoshinobu Inoue #endif /* INET */
756cfa1ca9dSYoshinobu Inoue #ifdef INET6
75733841545SHajimu UMEMOTO 		case SIOCGIFPDSTADDR_IN6:
758cfa1ca9dSYoshinobu Inoue 			dst = (struct sockaddr *)
759cfa1ca9dSYoshinobu Inoue 				&(((struct in6_ifreq *)data)->ifr_addr);
76033841545SHajimu UMEMOTO 			size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
761cfa1ca9dSYoshinobu Inoue 			break;
762cfa1ca9dSYoshinobu Inoue #endif /* INET6 */
763cfa1ca9dSYoshinobu Inoue 		default:
764cfa1ca9dSYoshinobu Inoue 			error = EADDRNOTAVAIL;
765cfa1ca9dSYoshinobu Inoue 			goto bad;
766cfa1ca9dSYoshinobu Inoue 		}
76733841545SHajimu UMEMOTO 		if (src->sa_len > size)
76833841545SHajimu UMEMOTO 			return EINVAL;
76933841545SHajimu UMEMOTO 		bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
77033841545SHajimu UMEMOTO 		break;
77133841545SHajimu UMEMOTO 
77233841545SHajimu UMEMOTO 	case SIOCGLIFPHYADDR:
77333841545SHajimu UMEMOTO 		if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
77433841545SHajimu UMEMOTO 			error = EADDRNOTAVAIL;
77533841545SHajimu UMEMOTO 			goto bad;
77633841545SHajimu UMEMOTO 		}
77733841545SHajimu UMEMOTO 
77833841545SHajimu UMEMOTO 		/* copy src */
77933841545SHajimu UMEMOTO 		src = sc->gif_psrc;
78033841545SHajimu UMEMOTO 		dst = (struct sockaddr *)
78133841545SHajimu UMEMOTO 			&(((struct if_laddrreq *)data)->addr);
78233841545SHajimu UMEMOTO 		size = sizeof(((struct if_laddrreq *)data)->addr);
78333841545SHajimu UMEMOTO 		if (src->sa_len > size)
78433841545SHajimu UMEMOTO 			return EINVAL;
78533841545SHajimu UMEMOTO 		bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
78633841545SHajimu UMEMOTO 
78733841545SHajimu UMEMOTO 		/* copy dst */
78833841545SHajimu UMEMOTO 		src = sc->gif_pdst;
78933841545SHajimu UMEMOTO 		dst = (struct sockaddr *)
79033841545SHajimu UMEMOTO 			&(((struct if_laddrreq *)data)->dstaddr);
79133841545SHajimu UMEMOTO 		size = sizeof(((struct if_laddrreq *)data)->dstaddr);
79233841545SHajimu UMEMOTO 		if (src->sa_len > size)
79333841545SHajimu UMEMOTO 			return EINVAL;
79433841545SHajimu UMEMOTO 		bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
795cfa1ca9dSYoshinobu Inoue 		break;
796cfa1ca9dSYoshinobu Inoue 
797cfa1ca9dSYoshinobu Inoue 	case SIOCSIFFLAGS:
798686cdd19SJun-ichiro itojun Hagino 		/* if_ioctl() takes care of it */
799cfa1ca9dSYoshinobu Inoue 		break;
800cfa1ca9dSYoshinobu Inoue 
801cfa1ca9dSYoshinobu Inoue 	default:
802cfa1ca9dSYoshinobu Inoue 		error = EINVAL;
803cfa1ca9dSYoshinobu Inoue 		break;
804cfa1ca9dSYoshinobu Inoue 	}
805cfa1ca9dSYoshinobu Inoue  bad:
806cfa1ca9dSYoshinobu Inoue 	return error;
807cfa1ca9dSYoshinobu Inoue }
80853dab5feSBrooks Davis 
80953dab5feSBrooks Davis void
81053dab5feSBrooks Davis gif_delete_tunnel(sc)
81153dab5feSBrooks Davis 	struct gif_softc *sc;
81253dab5feSBrooks Davis {
81353dab5feSBrooks Davis 	/* XXX: NetBSD protects this function with splsoftnet() */
81453dab5feSBrooks Davis 
81553dab5feSBrooks Davis 	if (sc->gif_psrc) {
81653dab5feSBrooks Davis 		free((caddr_t)sc->gif_psrc, M_IFADDR);
81753dab5feSBrooks Davis 		sc->gif_psrc = NULL;
81853dab5feSBrooks Davis 	}
81953dab5feSBrooks Davis 	if (sc->gif_pdst) {
82053dab5feSBrooks Davis 		free((caddr_t)sc->gif_pdst, M_IFADDR);
82153dab5feSBrooks Davis 		sc->gif_pdst = NULL;
82253dab5feSBrooks Davis 	}
82353dab5feSBrooks Davis 	/* change the IFF_UP flag as well? */
82453dab5feSBrooks Davis }
825