Home | History | Annotate | Line # | Download | only in net
if_gif.c revision 1.97
      1  1.97  knakahar /*	$NetBSD: if_gif.c,v 1.97 2015/12/09 03:33:32 knakahara Exp $	*/
      2  1.34    itojun /*	$KAME: if_gif.c,v 1.76 2001/08/20 02:01:02 kjc Exp $	*/
      3   1.3    itojun 
      4   1.2    itojun /*
      5   1.2    itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      6   1.2    itojun  * All rights reserved.
      7   1.9    itojun  *
      8   1.2    itojun  * Redistribution and use in source and binary forms, with or without
      9   1.2    itojun  * modification, are permitted provided that the following conditions
     10   1.2    itojun  * are met:
     11   1.2    itojun  * 1. Redistributions of source code must retain the above copyright
     12   1.2    itojun  *    notice, this list of conditions and the following disclaimer.
     13   1.2    itojun  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.2    itojun  *    notice, this list of conditions and the following disclaimer in the
     15   1.2    itojun  *    documentation and/or other materials provided with the distribution.
     16   1.2    itojun  * 3. Neither the name of the project nor the names of its contributors
     17   1.2    itojun  *    may be used to endorse or promote products derived from this software
     18   1.2    itojun  *    without specific prior written permission.
     19   1.9    itojun  *
     20   1.2    itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     21   1.2    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     22   1.2    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     23   1.2    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     24   1.2    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     25   1.2    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     26   1.2    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     27   1.2    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     28   1.2    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     29   1.2    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     30   1.2    itojun  * SUCH DAMAGE.
     31   1.2    itojun  */
     32  1.36     lukem 
     33  1.36     lukem #include <sys/cdefs.h>
     34  1.97  knakahar __KERNEL_RCSID(0, "$NetBSD: if_gif.c,v 1.97 2015/12/09 03:33:32 knakahara Exp $");
     35   1.2    itojun 
     36  1.88     pooka #ifdef _KERNEL_OPT
     37   1.2    itojun #include "opt_inet.h"
     38  1.88     pooka #endif
     39   1.2    itojun 
     40   1.2    itojun #include <sys/param.h>
     41   1.2    itojun #include <sys/systm.h>
     42   1.2    itojun #include <sys/kernel.h>
     43   1.2    itojun #include <sys/mbuf.h>
     44   1.2    itojun #include <sys/socket.h>
     45   1.2    itojun #include <sys/sockio.h>
     46   1.2    itojun #include <sys/errno.h>
     47   1.2    itojun #include <sys/ioctl.h>
     48   1.2    itojun #include <sys/time.h>
     49  1.86    martin #include <sys/socketvar.h>
     50   1.2    itojun #include <sys/syslog.h>
     51  1.17    martin #include <sys/proc.h>
     52   1.9    itojun #include <sys/protosw.h>
     53  1.72        ad #include <sys/cpu.h>
     54  1.72        ad #include <sys/intr.h>
     55   1.2    itojun 
     56   1.2    itojun #include <net/if.h>
     57   1.2    itojun #include <net/if_types.h>
     58   1.2    itojun #include <net/netisr.h>
     59   1.2    itojun #include <net/route.h>
     60   1.2    itojun #include <net/bpf.h>
     61   1.2    itojun 
     62   1.2    itojun #include <netinet/in.h>
     63   1.2    itojun #include <netinet/in_systm.h>
     64  1.15    itojun #include <netinet/ip.h>
     65  1.15    itojun #ifdef	INET
     66   1.2    itojun #include <netinet/in_var.h>
     67  1.57  christos #endif	/* INET */
     68   1.2    itojun #include <netinet/in_gif.h>
     69   1.2    itojun 
     70   1.2    itojun #ifdef INET6
     71   1.2    itojun #ifndef INET
     72   1.2    itojun #include <netinet/in.h>
     73   1.2    itojun #endif
     74   1.2    itojun #include <netinet6/in6_var.h>
     75   1.2    itojun #include <netinet/ip6.h>
     76   1.2    itojun #include <netinet6/ip6_var.h>
     77   1.2    itojun #include <netinet6/in6_gif.h>
     78   1.9    itojun #include <netinet6/ip6protosw.h>
     79   1.2    itojun #endif /* INET6 */
     80   1.2    itojun 
     81   1.9    itojun #include <netinet/ip_encap.h>
     82   1.2    itojun #include <net/if_gif.h>
     83   1.2    itojun 
     84  1.87  christos #include <net/net_osdep.h>
     85   1.2    itojun 
     86  1.87  christos #include "ioconf.h"
     87   1.4    itojun 
     88  1.56   thorpej static void	gifintr(void *);
     89   1.2    itojun 
     90   1.2    itojun /*
     91   1.2    itojun  * gif global variable definitions
     92   1.2    itojun  */
     93  1.56   thorpej LIST_HEAD(, gif_softc) gif_softc_list;	/* XXX should be static */
     94  1.12   thorpej 
     95  1.56   thorpej static int	gif_clone_create(struct if_clone *, int);
     96  1.56   thorpej static int	gif_clone_destroy(struct ifnet *);
     97  1.95  knakahar static int	gif_check_nesting(struct ifnet *, struct mbuf *);
     98  1.12   thorpej 
     99  1.97  knakahar static int	gif_encap_attach(struct gif_softc *);
    100  1.97  knakahar static int	gif_encap_detach(struct gif_softc *);
    101  1.97  knakahar 
    102  1.56   thorpej static struct if_clone gif_cloner =
    103  1.12   thorpej     IF_CLONE_INITIALIZER("gif", gif_clone_create, gif_clone_destroy);
    104  1.12   thorpej 
    105   1.9    itojun #ifndef MAX_GIF_NEST
    106   1.9    itojun /*
    107   1.9    itojun  * This macro controls the upper limitation on nesting of gif tunnels.
    108   1.9    itojun  * Since, setting a large value to this macro with a careless configuration
    109   1.9    itojun  * may introduce system crash, we don't allow any nestings by default.
    110   1.9    itojun  * If you need to configure nested gif tunnels, you can define this macro
    111  1.31    itojun  * in your kernel configuration file.  However, if you do so, please be
    112   1.9    itojun  * careful to configure the tunnels so that it won't make a loop.
    113   1.9    itojun  */
    114   1.9    itojun #define MAX_GIF_NEST 1
    115   1.9    itojun #endif
    116   1.9    itojun static int max_gif_nesting = MAX_GIF_NEST;
    117   1.2    itojun 
    118  1.12   thorpej /* ARGSUSED */
    119   1.2    itojun void
    120  1.63  christos gifattach(int count)
    121  1.12   thorpej {
    122  1.12   thorpej 
    123  1.12   thorpej 	LIST_INIT(&gif_softc_list);
    124  1.12   thorpej 	if_clone_attach(&gif_cloner);
    125  1.12   thorpej }
    126  1.12   thorpej 
    127  1.56   thorpej static int
    128  1.56   thorpej gif_clone_create(struct if_clone *ifc, int unit)
    129   1.2    itojun {
    130  1.12   thorpej 	struct gif_softc *sc;
    131  1.12   thorpej 
    132  1.75  christos 	sc = malloc(sizeof(struct gif_softc), M_DEVBUF, M_WAITOK|M_ZERO);
    133   1.2    itojun 
    134  1.75  christos 	if_initname(&sc->gif_if, ifc->ifc_name, unit);
    135   1.9    itojun 
    136  1.31    itojun 	gifattach0(sc);
    137  1.31    itojun 
    138  1.31    itojun 	LIST_INSERT_HEAD(&gif_softc_list, sc, gif_list);
    139  1.31    itojun 	return (0);
    140  1.31    itojun }
    141  1.31    itojun 
    142  1.31    itojun void
    143  1.56   thorpej gifattach0(struct gif_softc *sc)
    144  1.31    itojun {
    145  1.31    itojun 
    146  1.12   thorpej 	sc->encap_cookie4 = sc->encap_cookie6 = NULL;
    147   1.9    itojun 
    148  1.31    itojun 	sc->gif_if.if_addrlen = 0;
    149  1.12   thorpej 	sc->gif_if.if_mtu    = GIF_MTU;
    150  1.12   thorpej 	sc->gif_if.if_flags  = IFF_POINTOPOINT | IFF_MULTICAST;
    151  1.12   thorpej 	sc->gif_if.if_ioctl  = gif_ioctl;
    152  1.12   thorpej 	sc->gif_if.if_output = gif_output;
    153  1.12   thorpej 	sc->gif_if.if_type   = IFT_GIF;
    154  1.19   thorpej 	sc->gif_if.if_dlt    = DLT_NULL;
    155  1.76    dyoung 	sc->gif_if.if_softc  = sc;
    156  1.34    itojun 	IFQ_SET_READY(&sc->gif_if.if_snd);
    157  1.12   thorpej 	if_attach(&sc->gif_if);
    158  1.20   thorpej 	if_alloc_sadl(&sc->gif_if);
    159  1.78     joerg 	bpf_attach(&sc->gif_if, DLT_NULL, sizeof(u_int));
    160  1.12   thorpej }
    161  1.12   thorpej 
    162  1.56   thorpej static int
    163  1.56   thorpej gif_clone_destroy(struct ifnet *ifp)
    164  1.12   thorpej {
    165  1.12   thorpej 	struct gif_softc *sc = (void *) ifp;
    166  1.12   thorpej 
    167  1.12   thorpej 	LIST_REMOVE(sc, gif_list);
    168  1.12   thorpej 
    169  1.94  knakahar 	gif_delete_tunnel(&sc->gif_if);
    170  1.78     joerg 	bpf_detach(ifp);
    171  1.69    dyoung 	if_detach(ifp);
    172  1.66    dyoung 	rtcache_free(&sc->gif_ro);
    173  1.12   thorpej 
    174  1.12   thorpej 	free(sc, M_DEVBUF);
    175  1.47     peter 
    176  1.47     peter 	return (0);
    177   1.9    itojun }
    178   1.9    itojun 
    179  1.42    itojun #ifdef GIF_ENCAPCHECK
    180  1.31    itojun int
    181  1.56   thorpej gif_encapcheck(struct mbuf *m, int off, int proto, void *arg)
    182   1.9    itojun {
    183   1.9    itojun 	struct ip ip;
    184   1.9    itojun 	struct gif_softc *sc;
    185   1.9    itojun 
    186  1.76    dyoung 	sc = arg;
    187   1.9    itojun 	if (sc == NULL)
    188   1.9    itojun 		return 0;
    189   1.9    itojun 
    190   1.9    itojun 	if ((sc->gif_if.if_flags & IFF_UP) == 0)
    191   1.9    itojun 		return 0;
    192   1.9    itojun 
    193   1.9    itojun 	/* no physical address */
    194   1.9    itojun 	if (!sc->gif_psrc || !sc->gif_pdst)
    195   1.9    itojun 		return 0;
    196   1.9    itojun 
    197   1.9    itojun 	switch (proto) {
    198   1.9    itojun #ifdef INET
    199   1.9    itojun 	case IPPROTO_IPV4:
    200   1.9    itojun 		break;
    201   1.9    itojun #endif
    202   1.9    itojun #ifdef INET6
    203   1.9    itojun 	case IPPROTO_IPV6:
    204   1.9    itojun 		break;
    205   1.9    itojun #endif
    206   1.9    itojun 	default:
    207   1.9    itojun 		return 0;
    208   1.9    itojun 	}
    209  1.40  christos 
    210  1.40  christos 	/* Bail on short packets */
    211  1.40  christos 	KASSERT(m->m_flags & M_PKTHDR);
    212  1.40  christos 	if (m->m_pkthdr.len < sizeof(ip))
    213  1.40  christos 		return 0;
    214   1.9    itojun 
    215  1.76    dyoung 	m_copydata(m, 0, sizeof(ip), &ip);
    216   1.9    itojun 
    217   1.9    itojun 	switch (ip.ip_v) {
    218   1.9    itojun #ifdef INET
    219   1.9    itojun 	case 4:
    220   1.9    itojun 		if (sc->gif_psrc->sa_family != AF_INET ||
    221   1.9    itojun 		    sc->gif_pdst->sa_family != AF_INET)
    222   1.9    itojun 			return 0;
    223   1.9    itojun 		return gif_encapcheck4(m, off, proto, arg);
    224   1.9    itojun #endif
    225   1.9    itojun #ifdef INET6
    226   1.9    itojun 	case 6:
    227  1.41    itojun 		if (m->m_pkthdr.len < sizeof(struct ip6_hdr))
    228  1.41    itojun 			return 0;
    229   1.9    itojun 		if (sc->gif_psrc->sa_family != AF_INET6 ||
    230   1.9    itojun 		    sc->gif_pdst->sa_family != AF_INET6)
    231   1.9    itojun 			return 0;
    232   1.9    itojun 		return gif_encapcheck6(m, off, proto, arg);
    233   1.9    itojun #endif
    234   1.9    itojun 	default:
    235   1.9    itojun 		return 0;
    236   1.2    itojun 	}
    237   1.2    itojun }
    238  1.42    itojun #endif
    239   1.2    itojun 
    240  1.95  knakahar /*
    241  1.95  knakahar  * gif may cause infinite recursion calls when misconfigured.
    242  1.95  knakahar  * We'll prevent this by introducing upper limit.
    243  1.95  knakahar  */
    244  1.95  knakahar static int
    245  1.95  knakahar gif_check_nesting(struct ifnet *ifp, struct mbuf *m)
    246  1.95  knakahar {
    247  1.95  knakahar 	struct m_tag *mtag;
    248  1.95  knakahar 	int *count;
    249  1.95  knakahar 
    250  1.95  knakahar 	mtag = m_tag_find(m, PACKET_TAG_TUNNEL_INFO, NULL);
    251  1.95  knakahar 	if (mtag != NULL) {
    252  1.95  knakahar 		count = (int *)(mtag + 1);
    253  1.95  knakahar 		if (++(*count) > max_gif_nesting) {
    254  1.95  knakahar 			log(LOG_NOTICE,
    255  1.95  knakahar 			    "%s: recursively called too many times(%d)\n",
    256  1.95  knakahar 			    if_name(ifp),
    257  1.95  knakahar 			    *count);
    258  1.95  knakahar 			return EIO;
    259  1.95  knakahar 		}
    260  1.95  knakahar 	} else {
    261  1.95  knakahar 		mtag = m_tag_get(PACKET_TAG_TUNNEL_INFO, sizeof(*count),
    262  1.95  knakahar 		    M_NOWAIT);
    263  1.95  knakahar 		if (mtag != NULL) {
    264  1.95  knakahar 			m_tag_prepend(m, mtag);
    265  1.95  knakahar 			count = (int *)(mtag + 1);
    266  1.95  knakahar 			*count = 0;
    267  1.95  knakahar 		} else {
    268  1.95  knakahar 			log(LOG_DEBUG,
    269  1.95  knakahar 			    "%s: m_tag_get() failed, recursion calls are not prevented.\n",
    270  1.95  knakahar 			    if_name(ifp));
    271  1.95  knakahar 		}
    272  1.95  knakahar 	}
    273  1.95  knakahar 
    274  1.95  knakahar 	return 0;
    275  1.95  knakahar }
    276  1.95  knakahar 
    277   1.2    itojun int
    278  1.65    dyoung gif_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
    279  1.63  christos     struct rtentry *rt)
    280   1.2    itojun {
    281  1.76    dyoung 	struct gif_softc *sc = ifp->if_softc;
    282   1.2    itojun 	int error = 0;
    283  1.39    itojun 	ALTQ_DECL(struct altq_pktattr pktattr;)
    284  1.33    itojun 	int s;
    285  1.33    itojun 
    286  1.33    itojun 	IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
    287   1.2    itojun 
    288  1.95  knakahar 	if ((error = gif_check_nesting(ifp, m)) != 0) {
    289  1.95  knakahar 		m_free(m);
    290   1.2    itojun 		goto end;
    291   1.2    itojun 	}
    292   1.2    itojun 
    293   1.2    itojun 	m->m_flags &= ~(M_BCAST|M_MCAST);
    294   1.2    itojun 	if (!(ifp->if_flags & IFF_UP) ||
    295   1.2    itojun 	    sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
    296   1.2    itojun 		m_freem(m);
    297   1.2    itojun 		error = ENETDOWN;
    298   1.2    itojun 		goto end;
    299   1.2    itojun 	}
    300   1.2    itojun 
    301   1.9    itojun 	/* XXX should we check if our outer source is legal? */
    302   1.2    itojun 
    303  1.33    itojun 	/* use DLT_NULL encapsulation here to pass inner af type */
    304  1.33    itojun 	M_PREPEND(m, sizeof(int), M_DONTWAIT);
    305  1.33    itojun 	if (!m) {
    306  1.33    itojun 		error = ENOBUFS;
    307  1.33    itojun 		goto end;
    308  1.33    itojun 	}
    309  1.33    itojun 	*mtod(m, int *) = dst->sa_family;
    310  1.33    itojun 
    311  1.79    dyoung 	/* Clear checksum-offload flags. */
    312  1.79    dyoung 	m->m_pkthdr.csum_flags = 0;
    313  1.79    dyoung 	m->m_pkthdr.csum_data = 0;
    314  1.79    dyoung 
    315  1.33    itojun 	s = splnet();
    316  1.33    itojun 	IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
    317  1.33    itojun 	if (error) {
    318  1.33    itojun 		splx(s);
    319  1.31    itojun 		goto end;
    320   1.2    itojun 	}
    321  1.33    itojun 	splx(s);
    322  1.33    itojun 
    323  1.72        ad 	softint_schedule(sc->gif_si);
    324  1.33    itojun 	error = 0;
    325   1.2    itojun 
    326   1.2    itojun   end:
    327  1.31    itojun 	if (error)
    328  1.31    itojun 		ifp->if_oerrors++;
    329   1.2    itojun 	return error;
    330   1.2    itojun }
    331   1.2    itojun 
    332  1.56   thorpej static void
    333  1.56   thorpej gifintr(void *arg)
    334  1.33    itojun {
    335  1.33    itojun 	struct gif_softc *sc;
    336  1.33    itojun 	struct ifnet *ifp;
    337  1.33    itojun 	struct mbuf *m;
    338  1.33    itojun 	int family;
    339  1.33    itojun 	int len;
    340  1.33    itojun 	int s;
    341  1.33    itojun 	int error;
    342  1.33    itojun 
    343  1.76    dyoung 	sc = arg;
    344  1.33    itojun 	ifp = &sc->gif_if;
    345  1.33    itojun 
    346  1.33    itojun 	/* output processing */
    347  1.33    itojun 	while (1) {
    348  1.33    itojun 		s = splnet();
    349  1.34    itojun 		IFQ_DEQUEUE(&sc->gif_if.if_snd, m);
    350  1.33    itojun 		splx(s);
    351  1.33    itojun 		if (m == NULL)
    352  1.33    itojun 			break;
    353  1.33    itojun 
    354  1.33    itojun 		/* grab and chop off inner af type */
    355  1.33    itojun 		if (sizeof(int) > m->m_len) {
    356  1.33    itojun 			m = m_pullup(m, sizeof(int));
    357  1.33    itojun 			if (!m) {
    358  1.33    itojun 				ifp->if_oerrors++;
    359  1.33    itojun 				continue;
    360  1.33    itojun 			}
    361  1.33    itojun 		}
    362  1.33    itojun 		family = *mtod(m, int *);
    363  1.78     joerg 		bpf_mtap(ifp, m);
    364  1.33    itojun 		m_adj(m, sizeof(int));
    365  1.33    itojun 
    366  1.33    itojun 		len = m->m_pkthdr.len;
    367  1.33    itojun 
    368  1.33    itojun 		/* dispatch to output logic based on outer AF */
    369  1.33    itojun 		switch (sc->gif_psrc->sa_family) {
    370  1.33    itojun #ifdef INET
    371  1.33    itojun 		case AF_INET:
    372  1.85  hsuenaga 			mutex_enter(softnet_lock);
    373  1.33    itojun 			error = in_gif_output(ifp, family, m);
    374  1.85  hsuenaga 			mutex_exit(softnet_lock);
    375  1.33    itojun 			break;
    376  1.33    itojun #endif
    377  1.33    itojun #ifdef INET6
    378  1.33    itojun 		case AF_INET6:
    379  1.85  hsuenaga 			mutex_enter(softnet_lock);
    380  1.33    itojun 			error = in6_gif_output(ifp, family, m);
    381  1.85  hsuenaga 			mutex_exit(softnet_lock);
    382  1.33    itojun 			break;
    383  1.33    itojun #endif
    384  1.33    itojun 		default:
    385  1.50     perry 			m_freem(m);
    386  1.33    itojun 			error = ENETDOWN;
    387  1.33    itojun 			break;
    388  1.33    itojun 		}
    389  1.33    itojun 
    390  1.33    itojun 		if (error)
    391  1.33    itojun 			ifp->if_oerrors++;
    392  1.33    itojun 		else {
    393  1.50     perry 			ifp->if_opackets++;
    394  1.33    itojun 			ifp->if_obytes += len;
    395  1.33    itojun 		}
    396  1.33    itojun 	}
    397  1.33    itojun }
    398  1.33    itojun 
    399  1.33    itojun void
    400  1.56   thorpej gif_input(struct mbuf *m, int af, struct ifnet *ifp)
    401   1.2    itojun {
    402  1.83     rmind 	pktqueue_t *pktq;
    403  1.83     rmind 	size_t pktlen;
    404  1.83     rmind 	int s;
    405   1.2    itojun 
    406  1.33    itojun 	if (ifp == NULL) {
    407   1.2    itojun 		/* just in case */
    408   1.2    itojun 		m_freem(m);
    409   1.2    itojun 		return;
    410   1.2    itojun 	}
    411   1.2    itojun 
    412  1.33    itojun 	m->m_pkthdr.rcvif = ifp;
    413  1.83     rmind 	pktlen = m->m_pkthdr.len;
    414  1.50     perry 
    415  1.78     joerg 	bpf_mtap_af(ifp, af, m);
    416   1.2    itojun 
    417   1.2    itojun 	/*
    418   1.2    itojun 	 * Put the packet to the network layer input queue according to the
    419  1.83     rmind 	 * specified address family.  Note: we avoid direct call to the
    420  1.83     rmind 	 * input function of the network layer in order to avoid recursion.
    421  1.83     rmind 	 * This may be revisited in the future.
    422   1.2    itojun 	 */
    423   1.2    itojun 	switch (af) {
    424   1.2    itojun #ifdef INET
    425   1.2    itojun 	case AF_INET:
    426  1.83     rmind 		pktq = ip_pktq;
    427   1.2    itojun 		break;
    428   1.2    itojun #endif
    429   1.2    itojun #ifdef INET6
    430   1.2    itojun 	case AF_INET6:
    431  1.83     rmind 		pktq = ip6_pktq;
    432   1.2    itojun 		break;
    433   1.2    itojun #endif
    434   1.2    itojun 	default:
    435   1.2    itojun 		m_freem(m);
    436   1.2    itojun 		return;
    437   1.2    itojun 	}
    438   1.2    itojun 
    439  1.27   thorpej 	s = splnet();
    440  1.83     rmind 	if (__predict_true(pktq_enqueue(pktq, m, 0))) {
    441  1.83     rmind 		ifp->if_ibytes += pktlen;
    442  1.83     rmind 		ifp->if_ipackets++;
    443  1.83     rmind 	} else {
    444   1.2    itojun 		m_freem(m);
    445   1.2    itojun 	}
    446   1.2    itojun 	splx(s);
    447   1.2    itojun }
    448   1.2    itojun 
    449   1.9    itojun /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */
    450   1.2    itojun int
    451  1.67  christos gif_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    452   1.2    itojun {
    453  1.76    dyoung 	struct gif_softc *sc  = ifp->if_softc;
    454   1.2    itojun 	struct ifreq     *ifr = (struct ifreq*)data;
    455  1.84       roy 	struct ifaddr    *ifa = (struct ifaddr*)data;
    456   1.2    itojun 	int error = 0, size;
    457   1.9    itojun 	struct sockaddr *dst, *src;
    458  1.31    itojun 
    459   1.2    itojun 	switch (cmd) {
    460  1.76    dyoung 	case SIOCINITIFADDR:
    461  1.32    itojun 		ifp->if_flags |= IFF_UP;
    462  1.84       roy 		ifa->ifa_rtrequest = p2p_rtrequest;
    463   1.2    itojun 		break;
    464  1.50     perry 
    465   1.2    itojun 	case SIOCADDMULTI:
    466   1.2    itojun 	case SIOCDELMULTI:
    467   1.2    itojun 		switch (ifr->ifr_addr.sa_family) {
    468   1.2    itojun #ifdef INET
    469   1.2    itojun 		case AF_INET:	/* IP supports Multicast */
    470   1.2    itojun 			break;
    471   1.2    itojun #endif /* INET */
    472   1.2    itojun #ifdef INET6
    473   1.2    itojun 		case AF_INET6:	/* IP6 supports Multicast */
    474   1.2    itojun 			break;
    475   1.2    itojun #endif /* INET6 */
    476   1.2    itojun 		default:  /* Other protocols doesn't support Multicast */
    477   1.2    itojun 			error = EAFNOSUPPORT;
    478   1.2    itojun 			break;
    479   1.2    itojun 		}
    480   1.2    itojun 		break;
    481   1.2    itojun 
    482   1.2    itojun 	case SIOCSIFMTU:
    483  1.73    dyoung 		if (ifr->ifr_mtu < GIF_MTU_MIN || ifr->ifr_mtu > GIF_MTU_MAX)
    484  1.73    dyoung 			return EINVAL;
    485  1.73    dyoung 		else if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
    486  1.73    dyoung 			error = 0;
    487   1.2    itojun 		break;
    488   1.2    itojun 
    489  1.31    itojun #ifdef INET
    490   1.2    itojun 	case SIOCSIFPHYADDR:
    491  1.31    itojun #endif
    492   1.2    itojun #ifdef INET6
    493   1.2    itojun 	case SIOCSIFPHYADDR_IN6:
    494   1.2    itojun #endif /* INET6 */
    495  1.25    itojun 	case SIOCSLIFPHYADDR:
    496  1.11    itojun 		switch (cmd) {
    497  1.15    itojun #ifdef INET
    498  1.11    itojun 		case SIOCSIFPHYADDR:
    499  1.11    itojun 			src = (struct sockaddr *)
    500  1.11    itojun 				&(((struct in_aliasreq *)data)->ifra_addr);
    501  1.11    itojun 			dst = (struct sockaddr *)
    502  1.11    itojun 				&(((struct in_aliasreq *)data)->ifra_dstaddr);
    503  1.11    itojun 			break;
    504  1.15    itojun #endif
    505  1.11    itojun #ifdef INET6
    506  1.11    itojun 		case SIOCSIFPHYADDR_IN6:
    507  1.11    itojun 			src = (struct sockaddr *)
    508  1.11    itojun 				&(((struct in6_aliasreq *)data)->ifra_addr);
    509  1.11    itojun 			dst = (struct sockaddr *)
    510  1.11    itojun 				&(((struct in6_aliasreq *)data)->ifra_dstaddr);
    511  1.25    itojun 			break;
    512  1.25    itojun #endif
    513  1.25    itojun 		case SIOCSLIFPHYADDR:
    514  1.25    itojun 			src = (struct sockaddr *)
    515  1.25    itojun 				&(((struct if_laddrreq *)data)->addr);
    516  1.25    itojun 			dst = (struct sockaddr *)
    517  1.25    itojun 				&(((struct if_laddrreq *)data)->dstaddr);
    518  1.31    itojun 			break;
    519  1.31    itojun 		default:
    520  1.31    itojun 			return EINVAL;
    521  1.25    itojun 		}
    522  1.25    itojun 
    523  1.25    itojun 		/* sa_family must be equal */
    524  1.25    itojun 		if (src->sa_family != dst->sa_family)
    525  1.25    itojun 			return EINVAL;
    526  1.25    itojun 
    527  1.25    itojun 		/* validate sa_len */
    528  1.25    itojun 		switch (src->sa_family) {
    529  1.25    itojun #ifdef INET
    530  1.25    itojun 		case AF_INET:
    531  1.25    itojun 			if (src->sa_len != sizeof(struct sockaddr_in))
    532  1.16    itojun 				return EINVAL;
    533  1.11    itojun 			break;
    534  1.11    itojun #endif
    535  1.25    itojun #ifdef INET6
    536  1.25    itojun 		case AF_INET6:
    537  1.25    itojun 			if (src->sa_len != sizeof(struct sockaddr_in6))
    538  1.25    itojun 				return EINVAL;
    539  1.25    itojun 			break;
    540  1.25    itojun #endif
    541  1.25    itojun 		default:
    542  1.25    itojun 			return EAFNOSUPPORT;
    543  1.25    itojun 		}
    544  1.25    itojun 		switch (dst->sa_family) {
    545  1.25    itojun #ifdef INET
    546  1.25    itojun 		case AF_INET:
    547  1.25    itojun 			if (dst->sa_len != sizeof(struct sockaddr_in))
    548  1.25    itojun 				return EINVAL;
    549  1.25    itojun 			break;
    550  1.25    itojun #endif
    551  1.25    itojun #ifdef INET6
    552  1.25    itojun 		case AF_INET6:
    553  1.25    itojun 			if (dst->sa_len != sizeof(struct sockaddr_in6))
    554  1.25    itojun 				return EINVAL;
    555  1.25    itojun 			break;
    556  1.25    itojun #endif
    557  1.25    itojun 		default:
    558  1.25    itojun 			return EAFNOSUPPORT;
    559  1.25    itojun 		}
    560  1.25    itojun 
    561  1.25    itojun 		/* check sa_family looks sane for the cmd */
    562  1.25    itojun 		switch (cmd) {
    563  1.25    itojun 		case SIOCSIFPHYADDR:
    564  1.25    itojun 			if (src->sa_family == AF_INET)
    565  1.25    itojun 				break;
    566  1.25    itojun 			return EAFNOSUPPORT;
    567  1.25    itojun #ifdef INET6
    568  1.25    itojun 		case SIOCSIFPHYADDR_IN6:
    569  1.25    itojun 			if (src->sa_family == AF_INET6)
    570  1.25    itojun 				break;
    571  1.25    itojun 			return EAFNOSUPPORT;
    572  1.25    itojun #endif /* INET6 */
    573  1.25    itojun 		case SIOCSLIFPHYADDR:
    574  1.25    itojun 			/* checks done in the above */
    575  1.25    itojun 			break;
    576  1.11    itojun 		}
    577  1.11    itojun 
    578  1.31    itojun 		error = gif_set_tunnel(&sc->gif_if, src, dst);
    579   1.9    itojun 		break;
    580   1.9    itojun 
    581   1.9    itojun #ifdef SIOCDIFPHYADDR
    582   1.9    itojun 	case SIOCDIFPHYADDR:
    583  1.31    itojun 		gif_delete_tunnel(&sc->gif_if);
    584   1.2    itojun 		break;
    585   1.9    itojun #endif
    586  1.50     perry 
    587   1.2    itojun 	case SIOCGIFPSRCADDR:
    588   1.2    itojun #ifdef INET6
    589   1.2    itojun 	case SIOCGIFPSRCADDR_IN6:
    590   1.2    itojun #endif /* INET6 */
    591   1.2    itojun 		if (sc->gif_psrc == NULL) {
    592   1.2    itojun 			error = EADDRNOTAVAIL;
    593   1.2    itojun 			goto bad;
    594   1.2    itojun 		}
    595   1.2    itojun 		src = sc->gif_psrc;
    596  1.16    itojun 		switch (cmd) {
    597   1.2    itojun #ifdef INET
    598  1.16    itojun 		case SIOCGIFPSRCADDR:
    599   1.2    itojun 			dst = &ifr->ifr_addr;
    600  1.16    itojun 			size = sizeof(ifr->ifr_addr);
    601   1.2    itojun 			break;
    602   1.2    itojun #endif /* INET */
    603   1.2    itojun #ifdef INET6
    604  1.16    itojun 		case SIOCGIFPSRCADDR_IN6:
    605   1.2    itojun 			dst = (struct sockaddr *)
    606   1.2    itojun 				&(((struct in6_ifreq *)data)->ifr_addr);
    607  1.16    itojun 			size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
    608   1.2    itojun 			break;
    609   1.2    itojun #endif /* INET6 */
    610   1.2    itojun 		default:
    611   1.2    itojun 			error = EADDRNOTAVAIL;
    612   1.2    itojun 			goto bad;
    613   1.2    itojun 		}
    614  1.16    itojun 		if (src->sa_len > size)
    615  1.16    itojun 			return EINVAL;
    616  1.68    dyoung 		memcpy(dst, src, src->sa_len);
    617   1.2    itojun 		break;
    618  1.50     perry 
    619   1.2    itojun 	case SIOCGIFPDSTADDR:
    620   1.2    itojun #ifdef INET6
    621   1.2    itojun 	case SIOCGIFPDSTADDR_IN6:
    622   1.2    itojun #endif /* INET6 */
    623   1.2    itojun 		if (sc->gif_pdst == NULL) {
    624   1.2    itojun 			error = EADDRNOTAVAIL;
    625   1.2    itojun 			goto bad;
    626   1.2    itojun 		}
    627   1.2    itojun 		src = sc->gif_pdst;
    628  1.16    itojun 		switch (cmd) {
    629   1.2    itojun #ifdef INET
    630  1.16    itojun 		case SIOCGIFPDSTADDR:
    631   1.2    itojun 			dst = &ifr->ifr_addr;
    632  1.16    itojun 			size = sizeof(ifr->ifr_addr);
    633   1.2    itojun 			break;
    634   1.2    itojun #endif /* INET */
    635   1.2    itojun #ifdef INET6
    636  1.16    itojun 		case SIOCGIFPDSTADDR_IN6:
    637   1.2    itojun 			dst = (struct sockaddr *)
    638   1.2    itojun 				&(((struct in6_ifreq *)data)->ifr_addr);
    639  1.16    itojun 			size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
    640   1.2    itojun 			break;
    641   1.2    itojun #endif /* INET6 */
    642   1.2    itojun 		default:
    643   1.2    itojun 			error = EADDRNOTAVAIL;
    644   1.2    itojun 			goto bad;
    645   1.2    itojun 		}
    646  1.25    itojun 		if (src->sa_len > size)
    647  1.25    itojun 			return EINVAL;
    648  1.68    dyoung 		memcpy(dst, src, src->sa_len);
    649  1.25    itojun 		break;
    650  1.25    itojun 
    651  1.25    itojun 	case SIOCGLIFPHYADDR:
    652  1.25    itojun 		if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
    653  1.25    itojun 			error = EADDRNOTAVAIL;
    654  1.25    itojun 			goto bad;
    655  1.25    itojun 		}
    656  1.25    itojun 
    657  1.25    itojun 		/* copy src */
    658  1.25    itojun 		src = sc->gif_psrc;
    659  1.25    itojun 		dst = (struct sockaddr *)
    660  1.25    itojun 			&(((struct if_laddrreq *)data)->addr);
    661  1.25    itojun 		size = sizeof(((struct if_laddrreq *)data)->addr);
    662  1.25    itojun 		if (src->sa_len > size)
    663  1.25    itojun 			return EINVAL;
    664  1.68    dyoung 		memcpy(dst, src, src->sa_len);
    665  1.25    itojun 
    666  1.25    itojun 		/* copy dst */
    667  1.25    itojun 		src = sc->gif_pdst;
    668  1.25    itojun 		dst = (struct sockaddr *)
    669  1.25    itojun 			&(((struct if_laddrreq *)data)->dstaddr);
    670  1.25    itojun 		size = sizeof(((struct if_laddrreq *)data)->dstaddr);
    671  1.16    itojun 		if (src->sa_len > size)
    672  1.16    itojun 			return EINVAL;
    673  1.68    dyoung 		memcpy(dst, src, src->sa_len);
    674   1.2    itojun 		break;
    675   1.2    itojun 
    676   1.2    itojun 	default:
    677  1.76    dyoung 		return ifioctl_common(ifp, cmd, data);
    678   1.2    itojun 	}
    679   1.2    itojun  bad:
    680   1.2    itojun 	return error;
    681  1.12   thorpej }
    682  1.12   thorpej 
    683  1.97  knakahar static int
    684  1.97  knakahar gif_encap_attach(struct gif_softc *sc)
    685  1.97  knakahar {
    686  1.97  knakahar 	int error;
    687  1.97  knakahar 
    688  1.97  knakahar 	if (sc == NULL || sc->gif_psrc == NULL)
    689  1.97  knakahar 		return EINVAL;
    690  1.97  knakahar 
    691  1.97  knakahar 	switch (sc->gif_psrc->sa_family) {
    692  1.97  knakahar #ifdef INET
    693  1.97  knakahar 	case AF_INET:
    694  1.97  knakahar 		error = in_gif_attach(sc);
    695  1.97  knakahar 		break;
    696  1.97  knakahar #endif
    697  1.97  knakahar #ifdef INET6
    698  1.97  knakahar 	case AF_INET6:
    699  1.97  knakahar 		error = in6_gif_attach(sc);
    700  1.97  knakahar 		break;
    701  1.97  knakahar #endif
    702  1.97  knakahar 	default:
    703  1.97  knakahar 		error = EINVAL;
    704  1.97  knakahar 		break;
    705  1.97  knakahar 	}
    706  1.97  knakahar 
    707  1.97  knakahar 	return error;
    708  1.97  knakahar }
    709  1.97  knakahar 
    710  1.97  knakahar static int
    711  1.97  knakahar gif_encap_detach(struct gif_softc *sc)
    712  1.97  knakahar {
    713  1.97  knakahar 	int error;
    714  1.97  knakahar 
    715  1.97  knakahar 	if (sc == NULL || sc->gif_psrc == NULL)
    716  1.97  knakahar 		return EINVAL;
    717  1.97  knakahar 
    718  1.97  knakahar 	switch (sc->gif_psrc->sa_family) {
    719  1.97  knakahar #ifdef INET
    720  1.97  knakahar 	case AF_INET:
    721  1.97  knakahar 		error = in_gif_detach(sc);
    722  1.97  knakahar 		break;
    723  1.97  knakahar #endif
    724  1.97  knakahar #ifdef INET6
    725  1.97  knakahar 	case AF_INET6:
    726  1.97  knakahar 		error = in6_gif_detach(sc);
    727  1.97  knakahar 		break;
    728  1.97  knakahar #endif
    729  1.97  knakahar 	default:
    730  1.97  knakahar 		error = EINVAL;
    731  1.97  knakahar 		break;
    732  1.97  knakahar 	}
    733  1.97  knakahar 
    734  1.97  knakahar 	return error;
    735  1.97  knakahar }
    736  1.97  knakahar 
    737  1.31    itojun int
    738  1.56   thorpej gif_set_tunnel(struct ifnet *ifp, struct sockaddr *src, struct sockaddr *dst)
    739  1.31    itojun {
    740  1.76    dyoung 	struct gif_softc *sc = ifp->if_softc;
    741  1.31    itojun 	struct gif_softc *sc2;
    742  1.71    dyoung 	struct sockaddr *osrc, *odst;
    743  1.96  knakahar 	struct sockaddr *nsrc, *ndst;
    744  1.31    itojun 	int s;
    745  1.31    itojun 	int error;
    746  1.31    itojun 
    747  1.31    itojun 	s = splsoftnet();
    748  1.31    itojun 
    749  1.68    dyoung 	LIST_FOREACH(sc2, &gif_softc_list, gif_list) {
    750  1.31    itojun 		if (sc2 == sc)
    751  1.31    itojun 			continue;
    752  1.31    itojun 		if (!sc2->gif_pdst || !sc2->gif_psrc)
    753  1.31    itojun 			continue;
    754  1.31    itojun 		/* can't configure same pair of address onto two gifs */
    755  1.71    dyoung 		if (sockaddr_cmp(sc2->gif_pdst, dst) == 0 &&
    756  1.71    dyoung 		    sockaddr_cmp(sc2->gif_psrc, src) == 0) {
    757  1.91  knakahar 			/* continue to use the old configureation. */
    758  1.96  knakahar 			splx(s);
    759  1.96  knakahar 			return EADDRNOTAVAIL;
    760  1.31    itojun 		}
    761  1.31    itojun 
    762  1.31    itojun 		/* XXX both end must be valid? (I mean, not 0.0.0.0) */
    763  1.31    itojun 	}
    764  1.31    itojun 
    765  1.96  knakahar 	if ((nsrc = sockaddr_dup(src, M_WAITOK)) == NULL) {
    766  1.96  knakahar 		splx(s);
    767  1.96  knakahar 		return ENOMEM;
    768  1.96  knakahar 	}
    769  1.96  knakahar 	if ((ndst = sockaddr_dup(dst, M_WAITOK)) == NULL) {
    770  1.96  knakahar 		sockaddr_free(nsrc);
    771  1.96  knakahar 		splx(s);
    772  1.96  knakahar 		return ENOMEM;
    773  1.96  knakahar 	}
    774  1.96  knakahar 
    775  1.96  knakahar 	/* Firstly, clear old configurations. */
    776  1.58   msaitoh 	if (sc->gif_si) {
    777  1.72        ad 		softint_disestablish(sc->gif_si);
    778  1.58   msaitoh 		sc->gif_si = NULL;
    779  1.58   msaitoh 	}
    780  1.31    itojun 	/* XXX we can detach from both, but be polite just in case */
    781  1.31    itojun 	if (sc->gif_psrc)
    782  1.97  knakahar 		(void)gif_encap_detach(sc);
    783  1.31    itojun 
    784  1.96  knakahar 	/*
    785  1.96  knakahar 	 * Secondly, try to set new configurations.
    786  1.96  knakahar 	 * If the setup failed, rollback to old configurations.
    787  1.96  knakahar 	 */
    788  1.96  knakahar 	do {
    789  1.96  knakahar 		osrc = sc->gif_psrc;
    790  1.96  knakahar 		odst = sc->gif_pdst;
    791  1.96  knakahar 		sc->gif_psrc = nsrc;
    792  1.96  knakahar 		sc->gif_pdst = ndst;
    793  1.33    itojun 
    794  1.97  knakahar 		error = gif_encap_attach(sc);
    795  1.96  knakahar 		if (error) {
    796  1.96  knakahar 			/* rollback to the last configuration. */
    797  1.96  knakahar 			nsrc = osrc;
    798  1.96  knakahar 			ndst = odst;
    799  1.96  knakahar 			osrc = sc->gif_psrc;
    800  1.96  knakahar 			odst = sc->gif_pdst;
    801  1.31    itojun 
    802  1.96  knakahar 			continue;
    803  1.96  knakahar 		}
    804  1.31    itojun 
    805  1.96  knakahar 		sc->gif_si = softint_establish(SOFTINT_NET, gifintr, sc);
    806  1.96  knakahar 		if (sc->gif_si == NULL) {
    807  1.97  knakahar 			(void)gif_encap_detach(sc);
    808  1.96  knakahar 
    809  1.96  knakahar 			/* rollback to the last configuration. */
    810  1.96  knakahar 			nsrc = osrc;
    811  1.96  knakahar 			ndst = odst;
    812  1.96  knakahar 			osrc = sc->gif_psrc;
    813  1.96  knakahar 			odst = sc->gif_pdst;
    814  1.96  knakahar 
    815  1.96  knakahar 			error = ENOMEM;
    816  1.96  knakahar 			continue;
    817  1.96  knakahar 		}
    818  1.96  knakahar 	} while (error != 0 && (nsrc != NULL && ndst != NULL));
    819  1.96  knakahar 	/* Thirdly, even rollback failed, clear configurations. */
    820  1.96  knakahar 	if (error) {
    821  1.96  knakahar 		osrc = sc->gif_psrc;
    822  1.96  knakahar 		odst = sc->gif_pdst;
    823  1.96  knakahar 		sc->gif_psrc = NULL;
    824  1.96  knakahar 		sc->gif_pdst = NULL;
    825  1.31    itojun 	}
    826  1.31    itojun 
    827  1.31    itojun 	if (osrc)
    828  1.71    dyoung 		sockaddr_free(osrc);
    829  1.31    itojun 	if (odst)
    830  1.71    dyoung 		sockaddr_free(odst);
    831  1.31    itojun 
    832  1.31    itojun 	if (sc->gif_psrc && sc->gif_pdst)
    833  1.31    itojun 		ifp->if_flags |= IFF_RUNNING;
    834  1.31    itojun 	else
    835  1.31    itojun 		ifp->if_flags &= ~IFF_RUNNING;
    836  1.92  knakahar 
    837  1.31    itojun 	splx(s);
    838  1.31    itojun 	return error;
    839  1.31    itojun }
    840  1.31    itojun 
    841  1.12   thorpej void
    842  1.56   thorpej gif_delete_tunnel(struct ifnet *ifp)
    843  1.12   thorpej {
    844  1.76    dyoung 	struct gif_softc *sc = ifp->if_softc;
    845  1.12   thorpej 	int s;
    846  1.12   thorpej 
    847  1.12   thorpej 	s = splsoftnet();
    848  1.12   thorpej 
    849  1.35    itojun 	if (sc->gif_si) {
    850  1.72        ad 		softint_disestablish(sc->gif_si);
    851  1.35    itojun 		sc->gif_si = NULL;
    852  1.35    itojun 	}
    853  1.12   thorpej 	if (sc->gif_psrc) {
    854  1.71    dyoung 		sockaddr_free(sc->gif_psrc);
    855  1.12   thorpej 		sc->gif_psrc = NULL;
    856  1.12   thorpej 	}
    857  1.12   thorpej 	if (sc->gif_pdst) {
    858  1.71    dyoung 		sockaddr_free(sc->gif_pdst);
    859  1.12   thorpej 		sc->gif_pdst = NULL;
    860  1.12   thorpej 	}
    861  1.31    itojun 	/* it is safe to detach from both */
    862  1.31    itojun #ifdef INET
    863  1.31    itojun 	(void)in_gif_detach(sc);
    864  1.31    itojun #endif
    865  1.31    itojun #ifdef INET6
    866  1.31    itojun 	(void)in6_gif_detach(sc);
    867  1.31    itojun #endif
    868  1.12   thorpej 
    869  1.31    itojun 	if (sc->gif_psrc && sc->gif_pdst)
    870  1.31    itojun 		ifp->if_flags |= IFF_RUNNING;
    871  1.31    itojun 	else
    872  1.31    itojun 		ifp->if_flags &= ~IFF_RUNNING;
    873  1.12   thorpej 	splx(s);
    874   1.2    itojun }
    875