Home | History | Annotate | Line # | Download | only in net
if_gre.c revision 1.142
      1  1.142     pooka /*	$NetBSD: if_gre.c,v 1.142 2010/01/19 22:08:01 pooka Exp $ */
      2    1.4   thorpej 
      3    1.1       hwr /*
      4  1.125        ad  * Copyright (c) 1998, 2008 The NetBSD Foundation, Inc.
      5    1.1       hwr  * All rights reserved.
      6    1.1       hwr  *
      7    1.1       hwr  * This code is derived from software contributed to The NetBSD Foundation
      8    1.1       hwr  * by Heiko W.Rupp <hwr (at) pilhuhn.de>
      9    1.1       hwr  *
     10   1.56        is  * IPv6-over-GRE contributed by Gert Doering <gert (at) greenie.muc.de>
     11   1.56        is  *
     12  1.134    dyoung  * GRE over UDP/IPv4/IPv6 sockets contributed by David Young <dyoung (at) NetBSD.org>
     13  1.134    dyoung  *
     14    1.1       hwr  * Redistribution and use in source and binary forms, with or without
     15    1.1       hwr  * modification, are permitted provided that the following conditions
     16    1.1       hwr  * are met:
     17    1.1       hwr  * 1. Redistributions of source code must retain the above copyright
     18    1.1       hwr  *    notice, this list of conditions and the following disclaimer.
     19    1.1       hwr  * 2. Redistributions in binary form must reproduce the above copyright
     20    1.1       hwr  *    notice, this list of conditions and the following disclaimer in the
     21    1.1       hwr  *    documentation and/or other materials provided with the distribution.
     22    1.1       hwr  *
     23    1.1       hwr  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     24    1.1       hwr  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     25    1.1       hwr  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     26    1.1       hwr  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     27    1.1       hwr  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     28    1.1       hwr  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     29    1.1       hwr  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     30    1.1       hwr  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     31    1.1       hwr  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     32    1.1       hwr  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     33    1.1       hwr  * POSSIBILITY OF SUCH DAMAGE.
     34  1.134    dyoung  *
     35  1.134    dyoung  * This material is based upon work partially supported by NSF
     36  1.134    dyoung  * under Contract No. NSF CNS-0626584.
     37    1.1       hwr  */
     38    1.1       hwr 
     39    1.1       hwr /*
     40    1.1       hwr  * Encapsulate L3 protocols into IP
     41    1.1       hwr  * See RFC 1701 and 1702 for more details.
     42    1.1       hwr  * If_gre is compatible with Cisco GRE tunnels, so you can
     43    1.1       hwr  * have a NetBSD box as the other end of a tunnel interface of a Cisco
     44    1.1       hwr  * router. See gre(4) for more details.
     45    1.1       hwr  */
     46   1.22     lukem 
     47   1.22     lukem #include <sys/cdefs.h>
     48  1.142     pooka __KERNEL_RCSID(0, "$NetBSD: if_gre.c,v 1.142 2010/01/19 22:08:01 pooka Exp $");
     49    1.1       hwr 
     50  1.140    dyoung #include "opt_atalk.h"
     51   1.62    dyoung #include "opt_gre.h"
     52    1.1       hwr #include "opt_inet.h"
     53    1.1       hwr 
     54    1.1       hwr #include <sys/param.h>
     55   1.62    dyoung #include <sys/file.h>
     56   1.62    dyoung #include <sys/filedesc.h>
     57    1.1       hwr #include <sys/malloc.h>
     58  1.111    dyoung #include <sys/mallocvar.h>
     59    1.1       hwr #include <sys/mbuf.h>
     60   1.13    martin #include <sys/proc.h>
     61  1.111    dyoung #include <sys/domain.h>
     62    1.1       hwr #include <sys/protosw.h>
     63    1.1       hwr #include <sys/socket.h>
     64   1.62    dyoung #include <sys/socketvar.h>
     65    1.1       hwr #include <sys/ioctl.h>
     66   1.10   thorpej #include <sys/queue.h>
     67  1.118        ad #include <sys/intr.h>
     68    1.1       hwr #include <sys/systm.h>
     69   1.62    dyoung #include <sys/sysctl.h>
     70   1.60      elad #include <sys/kauth.h>
     71    1.1       hwr 
     72   1.93    dyoung #include <sys/kernel.h>
     73   1.93    dyoung #include <sys/mutex.h>
     74   1.93    dyoung #include <sys/condvar.h>
     75   1.62    dyoung #include <sys/kthread.h>
     76   1.62    dyoung 
     77  1.117        ad #include <sys/cpu.h>
     78    1.1       hwr 
     79    1.1       hwr #include <net/ethertypes.h>
     80    1.1       hwr #include <net/if.h>
     81    1.1       hwr #include <net/if_types.h>
     82    1.1       hwr #include <net/netisr.h>
     83    1.1       hwr #include <net/route.h>
     84    1.1       hwr 
     85  1.140    dyoung #include <netinet/in_systm.h>
     86  1.140    dyoung #include <netinet/in.h>
     87  1.140    dyoung #include <netinet/ip.h> /* we always need this for sizeof(struct ip) */
     88  1.140    dyoung 
     89    1.1       hwr #ifdef INET
     90    1.1       hwr #include <netinet/in_var.h>
     91    1.1       hwr #include <netinet/ip_var.h>
     92    1.1       hwr #endif
     93    1.1       hwr 
     94  1.140    dyoung #ifdef INET6
     95  1.140    dyoung #include <netinet6/in6_var.h>
     96  1.140    dyoung #endif
     97    1.1       hwr 
     98    1.1       hwr #ifdef NETATALK
     99    1.1       hwr #include <netatalk/at.h>
    100    1.1       hwr #include <netatalk/at_var.h>
    101    1.1       hwr #include <netatalk/at_extern.h>
    102    1.1       hwr #endif
    103    1.1       hwr 
    104    1.1       hwr #include <sys/time.h>
    105    1.1       hwr #include <net/bpf.h>
    106    1.1       hwr 
    107    1.1       hwr #include <net/if_gre.h>
    108    1.1       hwr 
    109  1.101       skd #include <compat/sys/socket.h>
    110   1.94  christos #include <compat/sys/sockio.h>
    111   1.20    itojun /*
    112   1.27    martin  * It is not easy to calculate the right value for a GRE MTU.
    113   1.27    martin  * We leave this task to the admin and use the same default that
    114   1.27    martin  * other vendors use.
    115   1.20    itojun  */
    116   1.27    martin #define GREMTU 1476
    117    1.1       hwr 
    118   1.62    dyoung #ifdef GRE_DEBUG
    119  1.102    dyoung int gre_debug = 0;
    120  1.132    dyoung #define	GRE_DPRINTF(__sc, ...)						\
    121  1.132    dyoung 	do {								\
    122  1.132    dyoung 		if (__predict_false(gre_debug ||			\
    123  1.132    dyoung 		    ((__sc)->sc_if.if_flags & IFF_DEBUG) != 0)) {	\
    124  1.132    dyoung 			printf("%s.%d: ", __func__, __LINE__);		\
    125  1.132    dyoung 			printf(__VA_ARGS__);				\
    126  1.132    dyoung 		}							\
    127   1.62    dyoung 	} while (/*CONSTCOND*/0)
    128   1.62    dyoung #else
    129   1.62    dyoung #define	GRE_DPRINTF(__sc, __fmt, ...)	do { } while (/*CONSTCOND*/0)
    130   1.62    dyoung #endif /* GRE_DEBUG */
    131   1.62    dyoung 
    132   1.26    martin int ip_gre_ttl = GRE_TTL;
    133  1.111    dyoung MALLOC_DEFINE(M_GRE_BUFQ, "gre_bufq", "gre mbuf queue");
    134    1.1       hwr 
    135  1.111    dyoung static int gre_clone_create(struct if_clone *, int);
    136  1.111    dyoung static int gre_clone_destroy(struct ifnet *);
    137   1.10   thorpej 
    138   1.59   thorpej static struct if_clone gre_cloner =
    139   1.10   thorpej     IF_CLONE_INITIALIZER("gre", gre_clone_create, gre_clone_destroy);
    140    1.1       hwr 
    141  1.111    dyoung static int gre_input(struct gre_softc *, struct mbuf *, int,
    142  1.111    dyoung     const struct gre_h *);
    143  1.115    dyoung static bool gre_is_nullconf(const struct gre_soparm *);
    144  1.111    dyoung static int gre_output(struct ifnet *, struct mbuf *,
    145   1.84    dyoung 			   const struct sockaddr *, struct rtentry *);
    146  1.111    dyoung static int gre_ioctl(struct ifnet *, u_long, void *);
    147   1.62    dyoung static int gre_getsockname(struct socket *, struct mbuf *, struct lwp *);
    148   1.62    dyoung static int gre_getpeername(struct socket *, struct mbuf *, struct lwp *);
    149  1.111    dyoung static int gre_getnames(struct socket *, struct lwp *,
    150  1.111    dyoung     struct sockaddr_storage *, struct sockaddr_storage *);
    151  1.115    dyoung static void gre_clearconf(struct gre_soparm *, bool);
    152  1.112    dyoung static int gre_soreceive(struct socket *, struct mbuf **);
    153  1.133    dyoung static int gre_sosend(struct socket *, struct mbuf *);
    154  1.132    dyoung static struct socket *gre_reconf(struct gre_softc *, const struct gre_soparm *);
    155  1.132    dyoung 
    156  1.132    dyoung static bool gre_fp_send(struct gre_softc *, enum gre_msg, file_t *);
    157  1.132    dyoung static bool gre_fp_recv(struct gre_softc *);
    158  1.132    dyoung static void gre_fp_recvloop(void *);
    159  1.111    dyoung 
    160  1.111    dyoung static int
    161  1.111    dyoung nearest_pow2(size_t len0)
    162  1.111    dyoung {
    163  1.111    dyoung 	size_t len, mid;
    164  1.111    dyoung 
    165  1.111    dyoung 	if (len0 == 0)
    166  1.111    dyoung 		return 1;
    167  1.111    dyoung 
    168  1.111    dyoung 	for (len = len0; (len & (len - 1)) != 0; len &= len - 1)
    169  1.111    dyoung 		;
    170  1.111    dyoung 
    171  1.111    dyoung 	mid = len | (len >> 1);
    172  1.111    dyoung 
    173  1.111    dyoung 	/* avoid overflow */
    174  1.111    dyoung 	if ((len << 1) < len)
    175  1.111    dyoung 		return len;
    176  1.111    dyoung 	if (len0 >= mid)
    177  1.111    dyoung 		return len << 1;
    178  1.111    dyoung 	return len;
    179  1.111    dyoung }
    180  1.111    dyoung 
    181  1.111    dyoung static struct gre_bufq *
    182  1.111    dyoung gre_bufq_init(struct gre_bufq *bq, size_t len0)
    183  1.111    dyoung {
    184  1.111    dyoung 	size_t len;
    185  1.111    dyoung 
    186  1.111    dyoung 	len = nearest_pow2(len0);
    187  1.111    dyoung 
    188  1.111    dyoung 	memset(bq, 0, sizeof(*bq));
    189  1.111    dyoung 	bq->bq_buf = malloc(len * sizeof(struct mbuf *), M_GRE_BUFQ, M_WAITOK);
    190  1.111    dyoung 	bq->bq_len = len;
    191  1.111    dyoung 	bq->bq_lenmask = len - 1;
    192  1.111    dyoung 
    193  1.111    dyoung 	return bq;
    194  1.111    dyoung }
    195  1.111    dyoung 
    196  1.111    dyoung static bool
    197  1.111    dyoung gre_bufq_empty(struct gre_bufq *bq)
    198  1.111    dyoung {
    199  1.111    dyoung 	return bq->bq_prodidx == bq->bq_considx;
    200  1.111    dyoung }
    201  1.111    dyoung 
    202  1.111    dyoung static struct mbuf *
    203  1.111    dyoung gre_bufq_dequeue(struct gre_bufq *bq)
    204  1.111    dyoung {
    205  1.111    dyoung 	struct mbuf *m;
    206  1.111    dyoung 
    207  1.111    dyoung 	if (gre_bufq_empty(bq))
    208  1.111    dyoung 		return NULL;
    209  1.111    dyoung 
    210  1.111    dyoung 	m = bq->bq_buf[bq->bq_considx];
    211  1.111    dyoung 	bq->bq_considx = (bq->bq_considx + 1) & bq->bq_lenmask;
    212  1.111    dyoung 
    213  1.111    dyoung 	return m;
    214  1.111    dyoung }
    215  1.111    dyoung 
    216  1.111    dyoung static void
    217  1.111    dyoung gre_bufq_purge(struct gre_bufq *bq)
    218  1.111    dyoung {
    219  1.111    dyoung 	struct mbuf *m;
    220  1.111    dyoung 
    221  1.111    dyoung 	while ((m = gre_bufq_dequeue(bq)) != NULL)
    222  1.111    dyoung 		m_freem(m);
    223  1.111    dyoung }
    224  1.111    dyoung 
    225  1.111    dyoung static int
    226  1.111    dyoung gre_bufq_enqueue(struct gre_bufq *bq, struct mbuf *m)
    227  1.111    dyoung {
    228  1.111    dyoung 	int next;
    229  1.111    dyoung 
    230  1.111    dyoung 	next = (bq->bq_prodidx + 1) & bq->bq_lenmask;
    231  1.111    dyoung 
    232  1.111    dyoung 	if (next == bq->bq_considx) {
    233  1.111    dyoung 		bq->bq_drops++;
    234  1.111    dyoung 		return ENOBUFS;
    235  1.111    dyoung 	}
    236  1.111    dyoung 
    237  1.111    dyoung 	bq->bq_buf[bq->bq_prodidx] = m;
    238  1.111    dyoung 	bq->bq_prodidx = next;
    239  1.111    dyoung 	return 0;
    240  1.111    dyoung }
    241  1.111    dyoung 
    242  1.111    dyoung static void
    243  1.111    dyoung greintr(void *arg)
    244  1.111    dyoung {
    245  1.111    dyoung 	struct gre_softc *sc = (struct gre_softc *)arg;
    246  1.132    dyoung 	struct socket *so = sc->sc_soparm.sp_so;
    247  1.112    dyoung 	int rc;
    248  1.112    dyoung 	struct mbuf *m;
    249  1.111    dyoung 
    250  1.132    dyoung 	KASSERT(so != NULL);
    251  1.112    dyoung 
    252  1.112    dyoung 	sc->sc_send_ev.ev_count++;
    253  1.132    dyoung 	GRE_DPRINTF(sc, "enter\n");
    254  1.112    dyoung 	while ((m = gre_bufq_dequeue(&sc->sc_snd)) != NULL) {
    255  1.112    dyoung 		/* XXX handle ENOBUFS? */
    256  1.133    dyoung 		if ((rc = gre_sosend(so, m)) != 0)
    257  1.132    dyoung 			GRE_DPRINTF(sc, "gre_sosend failed %d\n", rc);
    258  1.112    dyoung 	}
    259  1.111    dyoung }
    260  1.111    dyoung 
    261  1.111    dyoung /* Caller must hold sc->sc_mtx. */
    262  1.111    dyoung static void
    263  1.111    dyoung gre_wait(struct gre_softc *sc)
    264  1.111    dyoung {
    265  1.111    dyoung 	sc->sc_waiters++;
    266  1.111    dyoung 	cv_wait(&sc->sc_condvar, &sc->sc_mtx);
    267  1.111    dyoung 	sc->sc_waiters--;
    268  1.111    dyoung }
    269   1.62    dyoung 
    270   1.62    dyoung static void
    271  1.132    dyoung gre_fp_wait(struct gre_softc *sc)
    272   1.62    dyoung {
    273  1.132    dyoung 	sc->sc_fp_waiters++;
    274  1.132    dyoung 	cv_wait(&sc->sc_fp_condvar, &sc->sc_mtx);
    275  1.132    dyoung 	sc->sc_fp_waiters--;
    276   1.62    dyoung }
    277   1.62    dyoung 
    278  1.111    dyoung static void
    279  1.111    dyoung gre_evcnt_detach(struct gre_softc *sc)
    280  1.111    dyoung {
    281  1.111    dyoung 	evcnt_detach(&sc->sc_unsupp_ev);
    282  1.111    dyoung 	evcnt_detach(&sc->sc_pullup_ev);
    283  1.111    dyoung 	evcnt_detach(&sc->sc_error_ev);
    284  1.111    dyoung 	evcnt_detach(&sc->sc_block_ev);
    285  1.111    dyoung 	evcnt_detach(&sc->sc_recv_ev);
    286  1.111    dyoung 
    287  1.111    dyoung 	evcnt_detach(&sc->sc_oflow_ev);
    288  1.111    dyoung 	evcnt_detach(&sc->sc_send_ev);
    289  1.111    dyoung }
    290  1.111    dyoung 
    291  1.111    dyoung static void
    292  1.111    dyoung gre_evcnt_attach(struct gre_softc *sc)
    293  1.111    dyoung {
    294  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_recv_ev, EVCNT_TYPE_MISC,
    295  1.111    dyoung 	    NULL, sc->sc_if.if_xname, "recv");
    296  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_block_ev, EVCNT_TYPE_MISC,
    297  1.111    dyoung 	    &sc->sc_recv_ev, sc->sc_if.if_xname, "would block");
    298  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_error_ev, EVCNT_TYPE_MISC,
    299  1.111    dyoung 	    &sc->sc_recv_ev, sc->sc_if.if_xname, "error");
    300  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_pullup_ev, EVCNT_TYPE_MISC,
    301  1.112    dyoung 	    &sc->sc_recv_ev, sc->sc_if.if_xname, "pullup failed");
    302  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_unsupp_ev, EVCNT_TYPE_MISC,
    303  1.111    dyoung 	    &sc->sc_recv_ev, sc->sc_if.if_xname, "unsupported");
    304  1.111    dyoung 
    305  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_send_ev, EVCNT_TYPE_MISC,
    306  1.111    dyoung 	    NULL, sc->sc_if.if_xname, "send");
    307  1.111    dyoung 	evcnt_attach_dynamic(&sc->sc_oflow_ev, EVCNT_TYPE_MISC,
    308  1.112    dyoung 	    &sc->sc_send_ev, sc->sc_if.if_xname, "overflow");
    309   1.62    dyoung }
    310   1.62    dyoung 
    311   1.59   thorpej static int
    312   1.59   thorpej gre_clone_create(struct if_clone *ifc, int unit)
    313    1.1       hwr {
    314  1.132    dyoung 	int rc;
    315    1.8  explorer 	struct gre_softc *sc;
    316  1.132    dyoung 	struct gre_soparm *sp;
    317  1.140    dyoung 	const struct sockaddr *any;
    318  1.140    dyoung 
    319  1.140    dyoung 	if ((any = sockaddr_any_by_family(AF_INET)) == NULL &&
    320  1.140    dyoung 	    (any = sockaddr_any_by_family(AF_INET6)) == NULL)
    321  1.140    dyoung 		return -1;
    322    1.1       hwr 
    323  1.111    dyoung 	sc = malloc(sizeof(struct gre_softc), M_DEVBUF, M_WAITOK|M_ZERO);
    324  1.111    dyoung 	mutex_init(&sc->sc_mtx, MUTEX_DRIVER, IPL_SOFTNET);
    325  1.111    dyoung 	cv_init(&sc->sc_condvar, "gre wait");
    326  1.132    dyoung 	cv_init(&sc->sc_fp_condvar, "gre fp");
    327   1.10   thorpej 
    328  1.136  christos 	if_initname(&sc->sc_if, ifc->ifc_name, unit);
    329   1.10   thorpej 	sc->sc_if.if_softc = sc;
    330   1.51      tron 	sc->sc_if.if_type = IFT_TUNNEL;
    331   1.34    itojun 	sc->sc_if.if_addrlen = 0;
    332  1.111    dyoung 	sc->sc_if.if_hdrlen = sizeof(struct ip) + sizeof(struct gre_h);
    333   1.15   thorpej 	sc->sc_if.if_dlt = DLT_NULL;
    334   1.20    itojun 	sc->sc_if.if_mtu = GREMTU;
    335   1.10   thorpej 	sc->sc_if.if_flags = IFF_POINTOPOINT|IFF_MULTICAST;
    336   1.10   thorpej 	sc->sc_if.if_output = gre_output;
    337   1.10   thorpej 	sc->sc_if.if_ioctl = gre_ioctl;
    338  1.132    dyoung 	sp = &sc->sc_soparm;
    339  1.140    dyoung 	sockaddr_copy(sstosa(&sp->sp_dst), sizeof(sp->sp_dst), any);
    340  1.140    dyoung 	sockaddr_copy(sstosa(&sp->sp_src), sizeof(sp->sp_src), any);
    341  1.132    dyoung 	sp->sp_proto = IPPROTO_GRE;
    342  1.132    dyoung 	sp->sp_type = SOCK_RAW;
    343  1.132    dyoung 
    344  1.132    dyoung 	sc->sc_fd = -1;
    345  1.132    dyoung 
    346  1.132    dyoung 	rc = kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL, gre_fp_recvloop, sc,
    347  1.132    dyoung 	    NULL, sc->sc_if.if_xname);
    348  1.132    dyoung 
    349  1.132    dyoung 	if (rc != 0)
    350  1.132    dyoung 		return -1;
    351  1.111    dyoung 
    352  1.111    dyoung 	gre_evcnt_attach(sc);
    353  1.111    dyoung 
    354  1.111    dyoung 	gre_bufq_init(&sc->sc_snd, 17);
    355   1.35    itojun 	sc->sc_if.if_flags |= IFF_LINK0;
    356   1.10   thorpej 	if_attach(&sc->sc_if);
    357   1.16   thorpej 	if_alloc_sadl(&sc->sc_if);
    358  1.142     pooka 	bpf_ops->bpf_attach(&sc->sc_if, DLT_NULL,
    359  1.142     pooka 	    sizeof(uint32_t), &sc->sc_if.if_bpf);
    360  1.111    dyoung 	sc->sc_state = GRE_S_IDLE;
    361   1.87    dyoung 	return 0;
    362   1.10   thorpej }
    363    1.1       hwr 
    364   1.59   thorpej static int
    365   1.59   thorpej gre_clone_destroy(struct ifnet *ifp)
    366   1.10   thorpej {
    367  1.119    dyoung 	int s;
    368   1.10   thorpej 	struct gre_softc *sc = ifp->if_softc;
    369   1.10   thorpej 
    370  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
    371  1.111    dyoung 
    372  1.142     pooka 	bpf_ops->bpf_detach(ifp);
    373  1.122    dyoung 	s = splnet();
    374   1.93    dyoung 	if_detach(ifp);
    375  1.111    dyoung 
    376  1.119    dyoung 	/* Some LWPs may still wait in gre_ioctl_lock(), however,
    377  1.119    dyoung 	 * no new LWP will enter gre_ioctl_lock(), because ifunit()
    378  1.119    dyoung 	 * cannot locate the interface any longer.
    379  1.119    dyoung 	 */
    380   1.93    dyoung 	mutex_enter(&sc->sc_mtx);
    381  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
    382  1.111    dyoung 	while (sc->sc_state != GRE_S_IDLE)
    383  1.111    dyoung 		gre_wait(sc);
    384  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
    385  1.111    dyoung 	sc->sc_state = GRE_S_DIE;
    386  1.111    dyoung 	cv_broadcast(&sc->sc_condvar);
    387  1.132    dyoung 	while (sc->sc_waiters > 0)
    388  1.132    dyoung 		cv_wait(&sc->sc_condvar, &sc->sc_mtx);
    389  1.119    dyoung 	/* At this point, no other LWP will access the gre_softc, so
    390  1.119    dyoung 	 * we can release the mutex.
    391  1.119    dyoung 	 */
    392   1.93    dyoung 	mutex_exit(&sc->sc_mtx);
    393  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
    394  1.119    dyoung 	/* Note that we must not hold the mutex while we call gre_reconf(). */
    395  1.132    dyoung 	gre_reconf(sc, NULL);
    396  1.132    dyoung 
    397  1.132    dyoung 	mutex_enter(&sc->sc_mtx);
    398  1.132    dyoung 	sc->sc_msg = GRE_M_STOP;
    399  1.132    dyoung 	cv_signal(&sc->sc_fp_condvar);
    400  1.132    dyoung 	while (sc->sc_fp_waiters > 0)
    401  1.132    dyoung 		cv_wait(&sc->sc_fp_condvar, &sc->sc_mtx);
    402  1.132    dyoung 	mutex_exit(&sc->sc_mtx);
    403  1.132    dyoung 
    404  1.119    dyoung 	splx(s);
    405   1.93    dyoung 
    406  1.111    dyoung 	cv_destroy(&sc->sc_condvar);
    407  1.135    dyoung 	cv_destroy(&sc->sc_fp_condvar);
    408   1.93    dyoung 	mutex_destroy(&sc->sc_mtx);
    409  1.111    dyoung 	gre_evcnt_detach(sc);
    410   1.10   thorpej 	free(sc, M_DEVBUF);
    411   1.53     peter 
    412   1.87    dyoung 	return 0;
    413    1.1       hwr }
    414    1.1       hwr 
    415   1.62    dyoung static void
    416  1.141       tls gre_receive(struct socket *so, void *arg, int events, int waitflag)
    417   1.62    dyoung {
    418   1.62    dyoung 	struct gre_softc *sc = (struct gre_softc *)arg;
    419  1.112    dyoung 	int rc;
    420  1.112    dyoung 	const struct gre_h *gh;
    421  1.112    dyoung 	struct mbuf *m;
    422   1.62    dyoung 
    423  1.132    dyoung 	GRE_DPRINTF(sc, "enter\n");
    424  1.112    dyoung 
    425  1.112    dyoung 	sc->sc_recv_ev.ev_count++;
    426  1.112    dyoung 
    427  1.112    dyoung 	rc = gre_soreceive(so, &m);
    428  1.112    dyoung 	/* TBD Back off if ECONNREFUSED (indicates
    429  1.112    dyoung 	 * ICMP Port Unreachable)?
    430  1.112    dyoung 	 */
    431  1.112    dyoung 	if (rc == EWOULDBLOCK) {
    432  1.132    dyoung 		GRE_DPRINTF(sc, "EWOULDBLOCK\n");
    433  1.112    dyoung 		sc->sc_block_ev.ev_count++;
    434  1.112    dyoung 		return;
    435  1.112    dyoung 	} else if (rc != 0 || m == NULL) {
    436  1.112    dyoung 		GRE_DPRINTF(sc, "%s: rc %d m %p\n",
    437  1.112    dyoung 		    sc->sc_if.if_xname, rc, (void *)m);
    438  1.112    dyoung 		sc->sc_error_ev.ev_count++;
    439  1.112    dyoung 		return;
    440  1.112    dyoung 	}
    441  1.121    dyoung 	if (m->m_len < sizeof(*gh) && (m = m_pullup(m, sizeof(*gh))) == NULL) {
    442  1.132    dyoung 		GRE_DPRINTF(sc, "m_pullup failed\n");
    443  1.112    dyoung 		sc->sc_pullup_ev.ev_count++;
    444  1.112    dyoung 		return;
    445  1.112    dyoung 	}
    446  1.112    dyoung 	gh = mtod(m, const struct gre_h *);
    447  1.112    dyoung 
    448  1.112    dyoung 	if (gre_input(sc, m, 0, gh) == 0) {
    449  1.112    dyoung 		sc->sc_unsupp_ev.ev_count++;
    450  1.132    dyoung 		GRE_DPRINTF(sc, "dropping unsupported\n");
    451  1.112    dyoung 		m_freem(m);
    452  1.112    dyoung 	}
    453   1.62    dyoung }
    454   1.62    dyoung 
    455   1.62    dyoung static void
    456   1.88  christos gre_upcall_add(struct socket *so, void *arg)
    457   1.62    dyoung {
    458   1.62    dyoung 	/* XXX What if the kernel already set an upcall? */
    459  1.102    dyoung 	KASSERT((so->so_rcv.sb_flags & SB_UPCALL) == 0);
    460   1.62    dyoung 	so->so_upcallarg = arg;
    461   1.62    dyoung 	so->so_upcall = gre_receive;
    462   1.62    dyoung 	so->so_rcv.sb_flags |= SB_UPCALL;
    463   1.62    dyoung }
    464   1.62    dyoung 
    465   1.62    dyoung static void
    466   1.62    dyoung gre_upcall_remove(struct socket *so)
    467   1.62    dyoung {
    468   1.62    dyoung 	so->so_rcv.sb_flags &= ~SB_UPCALL;
    469   1.62    dyoung 	so->so_upcallarg = NULL;
    470   1.62    dyoung 	so->so_upcall = NULL;
    471   1.62    dyoung }
    472   1.62    dyoung 
    473   1.62    dyoung static int
    474  1.132    dyoung gre_socreate(struct gre_softc *sc, const struct gre_soparm *sp, int *fdout)
    475   1.62    dyoung {
    476  1.111    dyoung 	const struct protosw *pr;
    477  1.111    dyoung 	int fd, rc;
    478   1.62    dyoung 	struct mbuf *m;
    479  1.111    dyoung 	struct sockaddr *sa;
    480  1.132    dyoung 	struct socket *so;
    481  1.111    dyoung 	sa_family_t af;
    482  1.138    plunky 	int val;
    483   1.62    dyoung 
    484  1.132    dyoung 	GRE_DPRINTF(sc, "enter\n");
    485  1.111    dyoung 
    486  1.111    dyoung 	af = sp->sp_src.ss_family;
    487  1.132    dyoung 	rc = fsocreate(af, NULL, sp->sp_type, sp->sp_proto, curlwp, &fd);
    488   1.62    dyoung 	if (rc != 0) {
    489  1.132    dyoung 		GRE_DPRINTF(sc, "fsocreate failed\n");
    490   1.62    dyoung 		return rc;
    491   1.62    dyoung 	}
    492  1.127    dyoung 
    493  1.128    dyoung 	if ((rc = fd_getsock(fd, &so)) != 0)
    494  1.125        ad 		return rc;
    495  1.127    dyoung 
    496  1.120    dyoung 	if ((m = getsombuf(so, MT_SONAME)) == NULL) {
    497   1.62    dyoung 		rc = ENOBUFS;
    498   1.62    dyoung 		goto out;
    499   1.62    dyoung 	}
    500  1.111    dyoung 	sa = mtod(m, struct sockaddr *);
    501  1.132    dyoung 	sockaddr_copy(sa, MIN(MLEN, sizeof(sp->sp_src)), sstocsa(&sp->sp_src));
    502  1.111    dyoung 	m->m_len = sp->sp_src.ss_len;
    503   1.62    dyoung 
    504  1.127    dyoung 	if ((rc = sobind(so, m, curlwp)) != 0) {
    505  1.132    dyoung 		GRE_DPRINTF(sc, "sobind failed\n");
    506   1.62    dyoung 		goto out;
    507   1.62    dyoung 	}
    508   1.62    dyoung 
    509  1.132    dyoung 	sockaddr_copy(sa, MIN(MLEN, sizeof(sp->sp_dst)), sstocsa(&sp->sp_dst));
    510  1.111    dyoung 	m->m_len = sp->sp_dst.ss_len;
    511   1.62    dyoung 
    512  1.132    dyoung 	solock(so);
    513  1.127    dyoung 	if ((rc = soconnect(so, m, curlwp)) != 0) {
    514  1.132    dyoung 		GRE_DPRINTF(sc, "soconnect failed\n");
    515  1.132    dyoung 		sounlock(so);
    516   1.62    dyoung 		goto out;
    517   1.62    dyoung 	}
    518  1.132    dyoung 	sounlock(so);
    519   1.62    dyoung 
    520  1.138    plunky 	m = NULL;
    521  1.138    plunky 
    522  1.111    dyoung 	/* XXX convert to a (new) SOL_SOCKET call */
    523  1.138    plunky   	pr = so->so_proto;
    524  1.138    plunky   	KASSERT(pr != NULL);
    525  1.138    plunky  	rc = so_setsockopt(curlwp, so, IPPROTO_IP, IP_TTL,
    526  1.138    plunky 	    &ip_gre_ttl, sizeof(ip_gre_ttl));
    527  1.138    plunky   	if (rc != 0) {
    528  1.138    plunky  		GRE_DPRINTF(sc, "so_setsockopt ttl failed\n");
    529  1.138    plunky   		rc = 0;
    530  1.138    plunky   	}
    531  1.140    dyoung 
    532  1.138    plunky  	val = 1;
    533  1.138    plunky  	rc = so_setsockopt(curlwp, so, SOL_SOCKET, SO_NOHEADER,
    534  1.138    plunky 	    &val, sizeof(val));
    535  1.138    plunky   	if (rc != 0) {
    536  1.138    plunky  		GRE_DPRINTF(sc, "so_setsockopt SO_NOHEADER failed\n");
    537   1.62    dyoung 		rc = 0;
    538   1.62    dyoung 	}
    539   1.62    dyoung out:
    540   1.62    dyoung 	m_freem(m);
    541   1.62    dyoung 
    542   1.62    dyoung 	if (rc != 0)
    543  1.125        ad 		fd_close(fd);
    544  1.125        ad 	else  {
    545  1.125        ad 		fd_putfile(fd);
    546  1.111    dyoung 		*fdout = fd;
    547  1.125        ad 	}
    548   1.62    dyoung 
    549   1.62    dyoung 	return rc;
    550   1.62    dyoung }
    551   1.62    dyoung 
    552  1.111    dyoung static int
    553  1.133    dyoung gre_sosend(struct socket *so, struct mbuf *top)
    554  1.111    dyoung {
    555  1.111    dyoung 	struct mbuf	**mp;
    556  1.111    dyoung 	struct proc	*p;
    557  1.111    dyoung 	long		space, resid;
    558  1.130        ad 	int		error;
    559  1.133    dyoung 	struct lwp * const l = curlwp;
    560  1.111    dyoung 
    561  1.111    dyoung 	p = l->l_proc;
    562  1.111    dyoung 
    563  1.111    dyoung 	resid = top->m_pkthdr.len;
    564  1.111    dyoung 	if (p)
    565  1.126        ad 		l->l_ru.ru_msgsnd++;
    566  1.130        ad #define	snderr(errno)	{ error = errno; goto release; }
    567  1.111    dyoung 
    568  1.130        ad 	solock(so);
    569  1.111    dyoung 	if ((error = sblock(&so->so_snd, M_NOWAIT)) != 0)
    570  1.111    dyoung 		goto out;
    571  1.111    dyoung 	if (so->so_state & SS_CANTSENDMORE)
    572  1.111    dyoung 		snderr(EPIPE);
    573  1.111    dyoung 	if (so->so_error) {
    574  1.111    dyoung 		error = so->so_error;
    575  1.111    dyoung 		so->so_error = 0;
    576  1.111    dyoung 		goto release;
    577  1.111    dyoung 	}
    578  1.111    dyoung 	if ((so->so_state & SS_ISCONNECTED) == 0) {
    579  1.111    dyoung 		if (so->so_proto->pr_flags & PR_CONNREQUIRED) {
    580  1.111    dyoung 			if ((so->so_state & SS_ISCONFIRMING) == 0)
    581  1.111    dyoung 				snderr(ENOTCONN);
    582  1.111    dyoung 		} else
    583  1.111    dyoung 			snderr(EDESTADDRREQ);
    584  1.111    dyoung 	}
    585  1.111    dyoung 	space = sbspace(&so->so_snd);
    586  1.111    dyoung 	if (resid > so->so_snd.sb_hiwat)
    587  1.111    dyoung 		snderr(EMSGSIZE);
    588  1.111    dyoung 	if (space < resid)
    589  1.111    dyoung 		snderr(EWOULDBLOCK);
    590  1.111    dyoung 	mp = &top;
    591  1.111    dyoung 	/*
    592  1.111    dyoung 	 * Data is prepackaged in "top".
    593  1.111    dyoung 	 */
    594  1.111    dyoung 	if (so->so_state & SS_CANTSENDMORE)
    595  1.111    dyoung 		snderr(EPIPE);
    596  1.111    dyoung 	error = (*so->so_proto->pr_usrreq)(so, PRU_SEND, top, NULL, NULL, l);
    597  1.111    dyoung 	top = NULL;
    598  1.111    dyoung 	mp = &top;
    599  1.111    dyoung  release:
    600  1.111    dyoung 	sbunlock(&so->so_snd);
    601  1.111    dyoung  out:
    602  1.130        ad  	sounlock(so);
    603  1.111    dyoung 	if (top != NULL)
    604  1.111    dyoung 		m_freem(top);
    605  1.111    dyoung 	return error;
    606  1.111    dyoung }
    607  1.111    dyoung 
    608  1.111    dyoung /* This is a stripped-down version of soreceive() that will never
    609  1.111    dyoung  * block.  It will support SOCK_DGRAM sockets.  It may also support
    610  1.111    dyoung  * SOCK_SEQPACKET sockets.
    611  1.111    dyoung  */
    612  1.111    dyoung static int
    613  1.111    dyoung gre_soreceive(struct socket *so, struct mbuf **mp0)
    614  1.102    dyoung {
    615  1.112    dyoung 	struct mbuf *m, **mp;
    616  1.130        ad 	int flags, len, error, type;
    617  1.111    dyoung 	const struct protosw	*pr;
    618  1.112    dyoung 	struct mbuf *nextrecord;
    619  1.111    dyoung 
    620  1.111    dyoung 	KASSERT(mp0 != NULL);
    621  1.111    dyoung 
    622  1.111    dyoung 	flags = MSG_DONTWAIT;
    623  1.111    dyoung 	pr = so->so_proto;
    624  1.111    dyoung 	mp = mp0;
    625  1.111    dyoung 	type = 0;
    626  1.111    dyoung 
    627  1.111    dyoung 	*mp = NULL;
    628  1.111    dyoung 
    629  1.111    dyoung 	KASSERT(pr->pr_flags & PR_ATOMIC);
    630  1.111    dyoung 
    631  1.111    dyoung 	if (so->so_state & SS_ISCONFIRMING)
    632  1.127    dyoung 		(*pr->pr_usrreq)(so, PRU_RCVD, NULL, NULL, NULL, curlwp);
    633  1.111    dyoung  restart:
    634  1.130        ad 	if ((error = sblock(&so->so_rcv, M_NOWAIT)) != 0) {
    635  1.111    dyoung 		return error;
    636  1.130        ad 	}
    637  1.111    dyoung 	m = so->so_rcv.sb_mb;
    638  1.111    dyoung 	/*
    639  1.111    dyoung 	 * If we have less data than requested, do not block awaiting more.
    640  1.111    dyoung 	 */
    641  1.111    dyoung 	if (m == NULL) {
    642  1.111    dyoung #ifdef DIAGNOSTIC
    643  1.111    dyoung 		if (so->so_rcv.sb_cc)
    644  1.111    dyoung 			panic("receive 1");
    645  1.111    dyoung #endif
    646  1.111    dyoung 		if (so->so_error) {
    647  1.111    dyoung 			error = so->so_error;
    648  1.111    dyoung 			so->so_error = 0;
    649  1.111    dyoung 		} else if (so->so_state & SS_CANTRCVMORE)
    650  1.111    dyoung 			;
    651  1.111    dyoung 		else if ((so->so_state & (SS_ISCONNECTED|SS_ISCONNECTING)) == 0
    652  1.111    dyoung 		      && (so->so_proto->pr_flags & PR_CONNREQUIRED))
    653  1.111    dyoung 			error = ENOTCONN;
    654  1.111    dyoung 		else
    655  1.111    dyoung 			error = EWOULDBLOCK;
    656  1.111    dyoung 		goto release;
    657  1.111    dyoung 	}
    658  1.111    dyoung 	/*
    659  1.111    dyoung 	 * On entry here, m points to the first record of the socket buffer.
    660  1.111    dyoung 	 * While we process the initial mbufs containing address and control
    661  1.111    dyoung 	 * info, we save a copy of m->m_nextpkt into nextrecord.
    662  1.111    dyoung 	 */
    663  1.127    dyoung 	if (curlwp != NULL)
    664  1.127    dyoung 		curlwp->l_ru.ru_msgrcv++;
    665  1.111    dyoung 	KASSERT(m == so->so_rcv.sb_mb);
    666  1.111    dyoung 	SBLASTRECORDCHK(&so->so_rcv, "soreceive 1");
    667  1.111    dyoung 	SBLASTMBUFCHK(&so->so_rcv, "soreceive 1");
    668  1.111    dyoung 	nextrecord = m->m_nextpkt;
    669  1.111    dyoung 	if (pr->pr_flags & PR_ADDR) {
    670  1.111    dyoung #ifdef DIAGNOSTIC
    671  1.111    dyoung 		if (m->m_type != MT_SONAME)
    672  1.111    dyoung 			panic("receive 1a");
    673  1.111    dyoung #endif
    674  1.111    dyoung 		sbfree(&so->so_rcv, m);
    675  1.111    dyoung 		MFREE(m, so->so_rcv.sb_mb);
    676  1.111    dyoung 		m = so->so_rcv.sb_mb;
    677  1.111    dyoung 	}
    678  1.111    dyoung 	while (m != NULL && m->m_type == MT_CONTROL && error == 0) {
    679  1.111    dyoung 		sbfree(&so->so_rcv, m);
    680  1.111    dyoung 		/*
    681  1.111    dyoung 		 * Dispose of any SCM_RIGHTS message that went
    682  1.111    dyoung 		 * through the read path rather than recv.
    683  1.111    dyoung 		 */
    684  1.111    dyoung 		if (pr->pr_domain->dom_dispose &&
    685  1.111    dyoung 		    mtod(m, struct cmsghdr *)->cmsg_type == SCM_RIGHTS)
    686  1.111    dyoung 			(*pr->pr_domain->dom_dispose)(m);
    687  1.111    dyoung 		MFREE(m, so->so_rcv.sb_mb);
    688  1.111    dyoung 		m = so->so_rcv.sb_mb;
    689  1.111    dyoung 	}
    690  1.111    dyoung 
    691  1.111    dyoung 	/*
    692  1.111    dyoung 	 * If m is non-NULL, we have some data to read.  From now on,
    693  1.111    dyoung 	 * make sure to keep sb_lastrecord consistent when working on
    694  1.111    dyoung 	 * the last packet on the chain (nextrecord == NULL) and we
    695  1.111    dyoung 	 * change m->m_nextpkt.
    696  1.111    dyoung 	 */
    697  1.111    dyoung 	if (m != NULL) {
    698  1.111    dyoung 		m->m_nextpkt = nextrecord;
    699  1.111    dyoung 		/*
    700  1.111    dyoung 		 * If nextrecord == NULL (this is a single chain),
    701  1.111    dyoung 		 * then sb_lastrecord may not be valid here if m
    702  1.111    dyoung 		 * was changed earlier.
    703  1.111    dyoung 		 */
    704  1.111    dyoung 		if (nextrecord == NULL) {
    705  1.111    dyoung 			KASSERT(so->so_rcv.sb_mb == m);
    706  1.111    dyoung 			so->so_rcv.sb_lastrecord = m;
    707  1.111    dyoung 		}
    708  1.111    dyoung 		type = m->m_type;
    709  1.111    dyoung 		if (type == MT_OOBDATA)
    710  1.111    dyoung 			flags |= MSG_OOB;
    711  1.111    dyoung 	} else {
    712  1.111    dyoung 		KASSERT(so->so_rcv.sb_mb == m);
    713  1.111    dyoung 		so->so_rcv.sb_mb = nextrecord;
    714  1.111    dyoung 		SB_EMPTY_FIXUP(&so->so_rcv);
    715  1.111    dyoung 	}
    716  1.111    dyoung 	SBLASTRECORDCHK(&so->so_rcv, "soreceive 2");
    717  1.111    dyoung 	SBLASTMBUFCHK(&so->so_rcv, "soreceive 2");
    718  1.111    dyoung 
    719  1.111    dyoung 	while (m != NULL) {
    720  1.111    dyoung 		if (m->m_type == MT_OOBDATA) {
    721  1.111    dyoung 			if (type != MT_OOBDATA)
    722  1.111    dyoung 				break;
    723  1.111    dyoung 		} else if (type == MT_OOBDATA)
    724  1.111    dyoung 			break;
    725  1.111    dyoung #ifdef DIAGNOSTIC
    726  1.111    dyoung 		else if (m->m_type != MT_DATA && m->m_type != MT_HEADER)
    727  1.111    dyoung 			panic("receive 3");
    728  1.111    dyoung #endif
    729  1.111    dyoung 		so->so_state &= ~SS_RCVATMARK;
    730  1.111    dyoung 		if (so->so_oobmark != 0 && so->so_oobmark < m->m_len)
    731  1.111    dyoung 			break;
    732  1.111    dyoung 		len = m->m_len;
    733  1.111    dyoung 		/*
    734  1.111    dyoung 		 * mp is set, just pass back the mbufs.
    735  1.111    dyoung 		 * Sockbuf must be consistent here (points to current mbuf,
    736  1.111    dyoung 		 * it points to next record) when we drop priority;
    737  1.111    dyoung 		 * we must note any additions to the sockbuf when we
    738  1.111    dyoung 		 * block interrupts again.
    739  1.111    dyoung 		 */
    740  1.111    dyoung 		if (m->m_flags & M_EOR)
    741  1.111    dyoung 			flags |= MSG_EOR;
    742  1.111    dyoung 		nextrecord = m->m_nextpkt;
    743  1.111    dyoung 		sbfree(&so->so_rcv, m);
    744  1.111    dyoung 		*mp = m;
    745  1.111    dyoung 		mp = &m->m_next;
    746  1.111    dyoung 		so->so_rcv.sb_mb = m = m->m_next;
    747  1.111    dyoung 		*mp = NULL;
    748  1.111    dyoung 		/*
    749  1.111    dyoung 		 * If m != NULL, we also know that
    750  1.111    dyoung 		 * so->so_rcv.sb_mb != NULL.
    751  1.102    dyoung 		 */
    752  1.111    dyoung 		KASSERT(so->so_rcv.sb_mb == m);
    753  1.111    dyoung 		if (m) {
    754  1.111    dyoung 			m->m_nextpkt = nextrecord;
    755  1.111    dyoung 			if (nextrecord == NULL)
    756  1.111    dyoung 				so->so_rcv.sb_lastrecord = m;
    757  1.111    dyoung 		} else {
    758  1.111    dyoung 			so->so_rcv.sb_mb = nextrecord;
    759  1.111    dyoung 			SB_EMPTY_FIXUP(&so->so_rcv);
    760  1.111    dyoung 		}
    761  1.111    dyoung 		SBLASTRECORDCHK(&so->so_rcv, "soreceive 3");
    762  1.111    dyoung 		SBLASTMBUFCHK(&so->so_rcv, "soreceive 3");
    763  1.111    dyoung 		if (so->so_oobmark) {
    764  1.111    dyoung 			so->so_oobmark -= len;
    765  1.111    dyoung 			if (so->so_oobmark == 0) {
    766  1.111    dyoung 				so->so_state |= SS_RCVATMARK;
    767  1.111    dyoung 				break;
    768  1.111    dyoung 			}
    769  1.102    dyoung 		}
    770  1.111    dyoung 		if (flags & MSG_EOR)
    771  1.111    dyoung 			break;
    772  1.111    dyoung 	}
    773  1.111    dyoung 
    774  1.111    dyoung 	if (m != NULL) {
    775  1.111    dyoung 		m_freem(*mp);
    776  1.111    dyoung 		*mp = NULL;
    777  1.111    dyoung 		error = ENOMEM;
    778  1.111    dyoung 		(void) sbdroprecord(&so->so_rcv);
    779  1.111    dyoung 	} else {
    780  1.111    dyoung 		/*
    781  1.111    dyoung 		 * First part is an inline SB_EMPTY_FIXUP().  Second
    782  1.111    dyoung 		 * part makes sure sb_lastrecord is up-to-date if
    783  1.111    dyoung 		 * there is still data in the socket buffer.
    784  1.111    dyoung 		 */
    785  1.111    dyoung 		so->so_rcv.sb_mb = nextrecord;
    786  1.111    dyoung 		if (so->so_rcv.sb_mb == NULL) {
    787  1.111    dyoung 			so->so_rcv.sb_mbtail = NULL;
    788  1.111    dyoung 			so->so_rcv.sb_lastrecord = NULL;
    789  1.111    dyoung 		} else if (nextrecord->m_nextpkt == NULL)
    790  1.111    dyoung 			so->so_rcv.sb_lastrecord = nextrecord;
    791  1.111    dyoung 	}
    792  1.111    dyoung 	SBLASTRECORDCHK(&so->so_rcv, "soreceive 4");
    793  1.111    dyoung 	SBLASTMBUFCHK(&so->so_rcv, "soreceive 4");
    794  1.111    dyoung 	if (pr->pr_flags & PR_WANTRCVD && so->so_pcb)
    795  1.111    dyoung 		(*pr->pr_usrreq)(so, PRU_RCVD, NULL,
    796  1.127    dyoung 		    (struct mbuf *)(long)flags, NULL, curlwp);
    797  1.111    dyoung 	if (*mp0 == NULL && (flags & MSG_EOR) == 0 &&
    798  1.111    dyoung 	    (so->so_state & SS_CANTRCVMORE) == 0) {
    799  1.111    dyoung 		sbunlock(&so->so_rcv);
    800  1.111    dyoung 		goto restart;
    801  1.111    dyoung 	}
    802  1.111    dyoung 
    803  1.111    dyoung  release:
    804  1.111    dyoung 	sbunlock(&so->so_rcv);
    805  1.111    dyoung 	return error;
    806  1.111    dyoung }
    807  1.102    dyoung 
    808  1.102    dyoung static struct socket *
    809  1.132    dyoung gre_reconf(struct gre_softc *sc, const struct gre_soparm *newsoparm)
    810  1.102    dyoung {
    811  1.102    dyoung 	struct ifnet *ifp = &sc->sc_if;
    812  1.102    dyoung 
    813  1.132    dyoung 	GRE_DPRINTF(sc, "enter\n");
    814  1.102    dyoung 
    815  1.102    dyoung shutdown:
    816  1.132    dyoung 	if (sc->sc_soparm.sp_so != NULL) {
    817  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
    818  1.132    dyoung 		gre_upcall_remove(sc->sc_soparm.sp_so);
    819  1.118        ad 		softint_disestablish(sc->sc_si);
    820  1.111    dyoung 		sc->sc_si = NULL;
    821  1.132    dyoung 		gre_fp_send(sc, GRE_M_DELFP, NULL);
    822  1.115    dyoung 		gre_clearconf(&sc->sc_soparm, false);
    823  1.111    dyoung 	}
    824  1.111    dyoung 
    825  1.114    dyoung 	if (newsoparm != NULL) {
    826  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
    827  1.114    dyoung 		sc->sc_soparm = *newsoparm;
    828  1.129    dyoung 		newsoparm = NULL;
    829  1.114    dyoung 	}
    830  1.102    dyoung 
    831  1.132    dyoung 	if (sc->sc_soparm.sp_so != NULL) {
    832  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
    833  1.118        ad 		sc->sc_si = softint_establish(SOFTINT_NET, greintr, sc);
    834  1.132    dyoung 		gre_upcall_add(sc->sc_soparm.sp_so, sc);
    835  1.111    dyoung 		if ((ifp->if_flags & IFF_UP) == 0) {
    836  1.132    dyoung 			GRE_DPRINTF(sc, "down\n");
    837  1.111    dyoung 			goto shutdown;
    838  1.111    dyoung 		}
    839  1.102    dyoung 	}
    840  1.111    dyoung 
    841  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
    842  1.132    dyoung 	if (sc->sc_soparm.sp_so != NULL)
    843  1.102    dyoung 		sc->sc_if.if_flags |= IFF_RUNNING;
    844  1.111    dyoung 	else {
    845  1.111    dyoung 		gre_bufq_purge(&sc->sc_snd);
    846  1.102    dyoung 		sc->sc_if.if_flags &= ~IFF_RUNNING;
    847  1.111    dyoung 	}
    848  1.132    dyoung 	return sc->sc_soparm.sp_so;
    849  1.102    dyoung }
    850  1.102    dyoung 
    851  1.111    dyoung static int
    852  1.111    dyoung gre_input(struct gre_softc *sc, struct mbuf *m, int hlen,
    853  1.111    dyoung     const struct gre_h *gh)
    854   1.62    dyoung {
    855  1.124      matt 	uint16_t flags;
    856  1.124      matt 	uint32_t af;		/* af passed to BPF tap */
    857  1.111    dyoung 	int isr, s;
    858   1.62    dyoung 	struct ifqueue *ifq;
    859   1.62    dyoung 
    860   1.62    dyoung 	sc->sc_if.if_ipackets++;
    861   1.62    dyoung 	sc->sc_if.if_ibytes += m->m_pkthdr.len;
    862   1.62    dyoung 
    863   1.89    dyoung 	hlen += sizeof(struct gre_h);
    864   1.62    dyoung 
    865   1.89    dyoung 	/* process GRE flags as packet can be of variable len */
    866   1.89    dyoung 	flags = ntohs(gh->flags);
    867   1.62    dyoung 
    868   1.89    dyoung 	/* Checksum & Offset are present */
    869   1.89    dyoung 	if ((flags & GRE_CP) | (flags & GRE_RP))
    870   1.89    dyoung 		hlen += 4;
    871   1.89    dyoung 	/* We don't support routing fields (variable length) */
    872   1.89    dyoung 	if (flags & GRE_RP) {
    873   1.89    dyoung 		sc->sc_if.if_ierrors++;
    874   1.89    dyoung 		return 0;
    875   1.89    dyoung 	}
    876   1.89    dyoung 	if (flags & GRE_KP)
    877   1.89    dyoung 		hlen += 4;
    878   1.89    dyoung 	if (flags & GRE_SP)
    879   1.89    dyoung 		hlen += 4;
    880   1.89    dyoung 
    881   1.89    dyoung 	switch (ntohs(gh->ptype)) { /* ethertypes */
    882  1.140    dyoung #ifdef INET
    883  1.111    dyoung 	case ETHERTYPE_IP:
    884  1.111    dyoung 		ifq = &ipintrq;
    885   1.89    dyoung 		isr = NETISR_IP;
    886  1.113    dyoung 		af = AF_INET;
    887   1.89    dyoung 		break;
    888  1.140    dyoung #endif
    889   1.62    dyoung #ifdef NETATALK
    890   1.89    dyoung 	case ETHERTYPE_ATALK:
    891   1.89    dyoung 		ifq = &atintrq1;
    892   1.89    dyoung 		isr = NETISR_ATALK;
    893   1.89    dyoung 		af = AF_APPLETALK;
    894   1.89    dyoung 		break;
    895   1.62    dyoung #endif
    896   1.62    dyoung #ifdef INET6
    897   1.89    dyoung 	case ETHERTYPE_IPV6:
    898   1.89    dyoung 		ifq = &ip6intrq;
    899   1.89    dyoung 		isr = NETISR_IPV6;
    900   1.89    dyoung 		af = AF_INET6;
    901   1.89    dyoung 		break;
    902   1.62    dyoung #endif
    903   1.89    dyoung 	default:	   /* others not yet supported */
    904  1.132    dyoung 		GRE_DPRINTF(sc, "unhandled ethertype 0x%04x\n",
    905   1.89    dyoung 		    ntohs(gh->ptype));
    906   1.89    dyoung 		sc->sc_if.if_noproto++;
    907   1.87    dyoung 		return 0;
    908   1.62    dyoung 	}
    909   1.62    dyoung 
    910   1.62    dyoung 	if (hlen > m->m_pkthdr.len) {
    911   1.62    dyoung 		m_freem(m);
    912   1.62    dyoung 		sc->sc_if.if_ierrors++;
    913   1.87    dyoung 		return EINVAL;
    914   1.62    dyoung 	}
    915   1.62    dyoung 	m_adj(m, hlen);
    916   1.62    dyoung 
    917   1.62    dyoung 	if (sc->sc_if.if_bpf != NULL)
    918  1.142     pooka 		bpf_ops->bpf_mtap_af(sc->sc_if.if_bpf, af, m);
    919   1.62    dyoung 
    920   1.62    dyoung 	m->m_pkthdr.rcvif = &sc->sc_if;
    921   1.62    dyoung 
    922  1.111    dyoung 	s = splnet();
    923   1.62    dyoung 	if (IF_QFULL(ifq)) {
    924   1.62    dyoung 		IF_DROP(ifq);
    925   1.62    dyoung 		m_freem(m);
    926   1.62    dyoung 	} else {
    927   1.62    dyoung 		IF_ENQUEUE(ifq, m);
    928   1.62    dyoung 	}
    929   1.62    dyoung 	/* we need schednetisr since the address family may change */
    930   1.62    dyoung 	schednetisr(isr);
    931  1.111    dyoung 	splx(s);
    932   1.62    dyoung 
    933   1.87    dyoung 	return 1;	/* packet is done, no further processing needed */
    934   1.62    dyoung }
    935   1.62    dyoung 
    936   1.20    itojun /*
    937    1.1       hwr  * The output routine. Takes a packet and encapsulates it in the protocol
    938  1.111    dyoung  * given by sc->sc_soparm.sp_proto. See also RFC 1701 and RFC 2004
    939    1.1       hwr  */
    940   1.59   thorpej static int
    941   1.84    dyoung gre_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
    942   1.74  christos 	   struct rtentry *rt)
    943    1.1       hwr {
    944  1.111    dyoung 	int error = 0;
    945   1.10   thorpej 	struct gre_softc *sc = ifp->if_softc;
    946   1.62    dyoung 	struct gre_h *gh;
    947  1.124      matt 	uint16_t etype = 0;
    948   1.24    martin 
    949  1.111    dyoung 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) {
    950   1.37    itojun 		m_freem(m);
    951   1.38    itojun 		error = ENETDOWN;
    952   1.38    itojun 		goto end;
    953   1.37    itojun 	}
    954    1.1       hwr 
    955  1.113    dyoung 	if (ifp->if_bpf != NULL)
    956  1.142     pooka 		bpf_ops->bpf_mtap_af(ifp->if_bpf, dst->sa_family, m);
    957    1.1       hwr 
    958   1.26    martin 	m->m_flags &= ~(M_BCAST|M_MCAST);
    959    1.1       hwr 
    960  1.132    dyoung 	GRE_DPRINTF(sc, "dst->sa_family=%d\n", dst->sa_family);
    961  1.111    dyoung 	switch (dst->sa_family) {
    962  1.140    dyoung #ifdef INET
    963  1.111    dyoung 	case AF_INET:
    964  1.140    dyoung 		/* TBD Extract the IP ToS field and set the
    965  1.140    dyoung 		 * encapsulating protocol's ToS to suit.
    966  1.140    dyoung 		 */
    967  1.111    dyoung 		etype = htons(ETHERTYPE_IP);
    968   1.62    dyoung 		break;
    969  1.140    dyoung #endif
    970    1.1       hwr #ifdef NETATALK
    971  1.111    dyoung 	case AF_APPLETALK:
    972  1.111    dyoung 		etype = htons(ETHERTYPE_ATALK);
    973  1.111    dyoung 		break;
    974    1.1       hwr #endif
    975   1.56        is #ifdef INET6
    976  1.111    dyoung 	case AF_INET6:
    977  1.111    dyoung 		etype = htons(ETHERTYPE_IPV6);
    978  1.111    dyoung 		break;
    979   1.56        is #endif
    980   1.62    dyoung 	default:
    981    1.1       hwr 		IF_DROP(&ifp->if_snd);
    982    1.1       hwr 		m_freem(m);
    983  1.111    dyoung 		error = EAFNOSUPPORT;
    984   1.38    itojun 		goto end;
    985    1.1       hwr 	}
    986    1.1       hwr 
    987  1.111    dyoung 	M_PREPEND(m, sizeof(*gh), M_DONTWAIT);
    988   1.62    dyoung 
    989   1.62    dyoung 	if (m == NULL) {
    990    1.1       hwr 		IF_DROP(&ifp->if_snd);
    991   1.38    itojun 		error = ENOBUFS;
    992   1.38    itojun 		goto end;
    993    1.1       hwr 	}
    994    1.1       hwr 
    995  1.111    dyoung 	gh = mtod(m, struct gre_h *);
    996  1.111    dyoung 	gh->flags = 0;
    997  1.111    dyoung 	gh->ptype = etype;
    998  1.111    dyoung 	/* XXX Need to handle IP ToS.  Look at how I handle IP TTL. */
    999    1.1       hwr 
   1000    1.1       hwr 	ifp->if_opackets++;
   1001    1.8  explorer 	ifp->if_obytes += m->m_pkthdr.len;
   1002   1.62    dyoung 
   1003    1.1       hwr 	/* send it off */
   1004  1.111    dyoung 	if ((error = gre_bufq_enqueue(&sc->sc_snd, m)) != 0) {
   1005  1.111    dyoung 		sc->sc_oflow_ev.ev_count++;
   1006  1.111    dyoung 		m_freem(m);
   1007  1.112    dyoung 	} else
   1008  1.118        ad 		softint_schedule(sc->sc_si);
   1009   1.38    itojun   end:
   1010    1.8  explorer 	if (error)
   1011    1.1       hwr 		ifp->if_oerrors++;
   1012   1.87    dyoung 	return error;
   1013    1.1       hwr }
   1014    1.1       hwr 
   1015   1.62    dyoung static int
   1016   1.62    dyoung gre_getname(struct socket *so, int req, struct mbuf *nam, struct lwp *l)
   1017   1.62    dyoung {
   1018   1.93    dyoung 	return (*so->so_proto->pr_usrreq)(so, req, NULL, nam, NULL, l);
   1019   1.62    dyoung }
   1020   1.62    dyoung 
   1021   1.62    dyoung static int
   1022   1.62    dyoung gre_getsockname(struct socket *so, struct mbuf *nam, struct lwp *l)
   1023   1.62    dyoung {
   1024   1.62    dyoung 	return gre_getname(so, PRU_SOCKADDR, nam, l);
   1025   1.62    dyoung }
   1026   1.62    dyoung 
   1027   1.62    dyoung static int
   1028   1.62    dyoung gre_getpeername(struct socket *so, struct mbuf *nam, struct lwp *l)
   1029   1.62    dyoung {
   1030   1.62    dyoung 	return gre_getname(so, PRU_PEERADDR, nam, l);
   1031   1.62    dyoung }
   1032   1.62    dyoung 
   1033   1.62    dyoung static int
   1034  1.111    dyoung gre_getnames(struct socket *so, struct lwp *l, struct sockaddr_storage *src,
   1035  1.111    dyoung     struct sockaddr_storage *dst)
   1036   1.62    dyoung {
   1037   1.62    dyoung 	struct mbuf *m;
   1038  1.111    dyoung 	struct sockaddr_storage *ss;
   1039   1.62    dyoung 	int rc;
   1040   1.62    dyoung 
   1041  1.120    dyoung 	if ((m = getsombuf(so, MT_SONAME)) == NULL)
   1042   1.62    dyoung 		return ENOBUFS;
   1043   1.62    dyoung 
   1044  1.111    dyoung 	ss = mtod(m, struct sockaddr_storage *);
   1045   1.62    dyoung 
   1046  1.130        ad 	solock(so);
   1047   1.62    dyoung 	if ((rc = gre_getsockname(so, m, l)) != 0)
   1048   1.62    dyoung 		goto out;
   1049  1.111    dyoung 	*src = *ss;
   1050   1.62    dyoung 
   1051   1.62    dyoung 	if ((rc = gre_getpeername(so, m, l)) != 0)
   1052   1.62    dyoung 		goto out;
   1053  1.111    dyoung 	*dst = *ss;
   1054   1.62    dyoung out:
   1055  1.130        ad 	sounlock(so);
   1056   1.62    dyoung 	m_freem(m);
   1057   1.62    dyoung 	return rc;
   1058   1.62    dyoung }
   1059   1.62    dyoung 
   1060   1.93    dyoung static void
   1061  1.132    dyoung gre_fp_recvloop(void *arg)
   1062  1.132    dyoung {
   1063  1.132    dyoung 	struct gre_softc *sc = arg;
   1064  1.132    dyoung 
   1065  1.132    dyoung 	mutex_enter(&sc->sc_mtx);
   1066  1.132    dyoung 	while (gre_fp_recv(sc))
   1067  1.132    dyoung 		;
   1068  1.132    dyoung 	mutex_exit(&sc->sc_mtx);
   1069  1.132    dyoung 	kthread_exit(0);
   1070  1.132    dyoung }
   1071  1.132    dyoung 
   1072  1.132    dyoung static bool
   1073  1.132    dyoung gre_fp_recv(struct gre_softc *sc)
   1074   1.93    dyoung {
   1075  1.132    dyoung 	int fd, ofd, rc;
   1076  1.132    dyoung 	file_t *fp;
   1077  1.132    dyoung 
   1078  1.132    dyoung 	fp = sc->sc_fp;
   1079  1.132    dyoung 	ofd = sc->sc_fd;
   1080  1.132    dyoung 	fd = -1;
   1081  1.132    dyoung 
   1082  1.132    dyoung 	switch (sc->sc_msg) {
   1083  1.132    dyoung 	case GRE_M_STOP:
   1084  1.132    dyoung 		cv_signal(&sc->sc_fp_condvar);
   1085  1.132    dyoung 		return false;
   1086  1.132    dyoung 	case GRE_M_SETFP:
   1087  1.132    dyoung 		mutex_exit(&sc->sc_mtx);
   1088  1.132    dyoung 		rc = fd_dup(fp, 0, &fd, 0);
   1089  1.132    dyoung 		mutex_enter(&sc->sc_mtx);
   1090  1.132    dyoung 		if (rc != 0) {
   1091  1.132    dyoung 			sc->sc_msg = GRE_M_ERR;
   1092  1.132    dyoung 			break;
   1093  1.132    dyoung 		}
   1094  1.132    dyoung 		/*FALLTHROUGH*/
   1095  1.132    dyoung 	case GRE_M_DELFP:
   1096  1.132    dyoung 		mutex_exit(&sc->sc_mtx);
   1097  1.132    dyoung 		if (ofd != -1 && fd_getfile(ofd) != NULL)
   1098  1.132    dyoung 			fd_close(ofd);
   1099  1.132    dyoung 		mutex_enter(&sc->sc_mtx);
   1100  1.132    dyoung 		sc->sc_fd = fd;
   1101  1.132    dyoung 		sc->sc_msg = GRE_M_OK;
   1102  1.132    dyoung 		break;
   1103  1.132    dyoung 	default:
   1104  1.132    dyoung 		gre_fp_wait(sc);
   1105  1.132    dyoung 		return true;
   1106  1.132    dyoung 	}
   1107  1.132    dyoung 	cv_signal(&sc->sc_fp_condvar);
   1108  1.132    dyoung 	return true;
   1109  1.132    dyoung }
   1110  1.132    dyoung 
   1111  1.132    dyoung static bool
   1112  1.132    dyoung gre_fp_send(struct gre_softc *sc, enum gre_msg msg, file_t *fp)
   1113  1.132    dyoung {
   1114  1.132    dyoung 	bool rc;
   1115   1.93    dyoung 
   1116  1.132    dyoung 	mutex_enter(&sc->sc_mtx);
   1117  1.132    dyoung 	while (sc->sc_msg != GRE_M_NONE)
   1118  1.132    dyoung 		gre_fp_wait(sc);
   1119  1.132    dyoung 	sc->sc_fp = fp;
   1120  1.132    dyoung 	sc->sc_msg = msg;
   1121  1.132    dyoung 	cv_signal(&sc->sc_fp_condvar);
   1122  1.132    dyoung 	while (sc->sc_msg != GRE_M_STOP && sc->sc_msg != GRE_M_OK &&
   1123  1.132    dyoung 	            sc->sc_msg != GRE_M_ERR)
   1124  1.132    dyoung 		gre_fp_wait(sc);
   1125  1.132    dyoung 	rc = (sc->sc_msg != GRE_M_ERR);
   1126  1.132    dyoung 	sc->sc_msg = GRE_M_NONE;
   1127  1.132    dyoung 	cv_signal(&sc->sc_fp_condvar);
   1128  1.132    dyoung 	mutex_exit(&sc->sc_mtx);
   1129  1.132    dyoung 	return rc;
   1130   1.93    dyoung }
   1131   1.93    dyoung 
   1132   1.59   thorpej static int
   1133  1.111    dyoung gre_ssock(struct ifnet *ifp, struct gre_soparm *sp, int fd)
   1134    1.1       hwr {
   1135  1.132    dyoung 	int error = 0;
   1136  1.111    dyoung 	const struct protosw *pr;
   1137  1.125        ad 	file_t *fp;
   1138  1.111    dyoung 	struct gre_softc *sc = ifp->if_softc;
   1139   1.62    dyoung 	struct socket *so;
   1140  1.111    dyoung 	struct sockaddr_storage dst, src;
   1141  1.111    dyoung 
   1142  1.137        ad 	if ((fp = fd_getfile(fd)) == NULL)
   1143  1.137        ad 		return EBADF;
   1144  1.137        ad 	if (fp->f_type != DTYPE_SOCKET) {
   1145  1.137        ad 		fd_putfile(fd);
   1146  1.137        ad 		return ENOTSOCK;
   1147  1.137        ad 	}
   1148  1.111    dyoung 
   1149  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1150  1.111    dyoung 
   1151  1.111    dyoung 	so = (struct socket *)fp->f_data;
   1152  1.111    dyoung 	pr = so->so_proto;
   1153  1.132    dyoung 
   1154  1.132    dyoung 	GRE_DPRINTF(sc, "type %d, proto %d\n", pr->pr_type, pr->pr_protocol);
   1155  1.132    dyoung 
   1156  1.111    dyoung 	if ((pr->pr_flags & PR_ATOMIC) == 0 ||
   1157  1.111    dyoung 	    (sp->sp_type != 0 && pr->pr_type != sp->sp_type) ||
   1158  1.111    dyoung 	    (sp->sp_proto != 0 && pr->pr_protocol != 0 &&
   1159  1.111    dyoung 	     pr->pr_protocol != sp->sp_proto)) {
   1160  1.111    dyoung 		error = EINVAL;
   1161  1.132    dyoung 		goto err;
   1162  1.111    dyoung 	}
   1163  1.111    dyoung 
   1164  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1165  1.111    dyoung 
   1166  1.111    dyoung 	/* check address */
   1167  1.127    dyoung 	if ((error = gre_getnames(so, curlwp, &src, &dst)) != 0)
   1168  1.132    dyoung 		goto err;
   1169  1.111    dyoung 
   1170  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1171  1.111    dyoung 
   1172  1.132    dyoung 	if (!gre_fp_send(sc, GRE_M_SETFP, fp)) {
   1173  1.132    dyoung 		error = EBUSY;
   1174  1.132    dyoung 		goto err;
   1175  1.132    dyoung 	}
   1176  1.111    dyoung 
   1177  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1178  1.111    dyoung 
   1179  1.111    dyoung 	sp->sp_src = src;
   1180  1.111    dyoung 	sp->sp_dst = dst;
   1181  1.111    dyoung 
   1182  1.132    dyoung 	sp->sp_so = so;
   1183  1.111    dyoung 
   1184  1.132    dyoung err:
   1185  1.132    dyoung 	fd_putfile(fd);
   1186  1.111    dyoung 	return error;
   1187  1.111    dyoung }
   1188  1.111    dyoung 
   1189  1.111    dyoung static bool
   1190  1.111    dyoung sockaddr_is_anyaddr(const struct sockaddr *sa)
   1191  1.111    dyoung {
   1192  1.111    dyoung 	socklen_t anylen, salen;
   1193  1.111    dyoung 	const void *anyaddr, *addr;
   1194  1.111    dyoung 
   1195  1.111    dyoung 	if ((anyaddr = sockaddr_anyaddr(sa, &anylen)) == NULL ||
   1196  1.111    dyoung 	    (addr = sockaddr_const_addr(sa, &salen)) == NULL)
   1197  1.111    dyoung 		return false;
   1198  1.111    dyoung 
   1199  1.111    dyoung 	if (salen > anylen)
   1200  1.111    dyoung 		return false;
   1201  1.111    dyoung 
   1202  1.111    dyoung 	return memcmp(anyaddr, addr, MIN(anylen, salen)) == 0;
   1203  1.111    dyoung }
   1204  1.111    dyoung 
   1205  1.115    dyoung static bool
   1206  1.111    dyoung gre_is_nullconf(const struct gre_soparm *sp)
   1207  1.111    dyoung {
   1208  1.111    dyoung 	return sockaddr_is_anyaddr(sstocsa(&sp->sp_src)) ||
   1209  1.111    dyoung 	       sockaddr_is_anyaddr(sstocsa(&sp->sp_dst));
   1210  1.111    dyoung }
   1211  1.111    dyoung 
   1212  1.111    dyoung static void
   1213  1.115    dyoung gre_clearconf(struct gre_soparm *sp, bool force)
   1214  1.111    dyoung {
   1215  1.111    dyoung 	if (sp->sp_bysock || force) {
   1216  1.111    dyoung 		sockaddr_copy(sstosa(&sp->sp_src), sizeof(sp->sp_src),
   1217  1.111    dyoung 		    sockaddr_any(sstosa(&sp->sp_src)));
   1218  1.111    dyoung 		sockaddr_copy(sstosa(&sp->sp_dst), sizeof(sp->sp_dst),
   1219  1.111    dyoung 		    sockaddr_any(sstosa(&sp->sp_dst)));
   1220  1.132    dyoung 		sp->sp_bysock = false;
   1221  1.111    dyoung 	}
   1222  1.132    dyoung 	sp->sp_so = NULL; /* XXX */
   1223  1.111    dyoung }
   1224  1.111    dyoung 
   1225  1.111    dyoung static int
   1226  1.119    dyoung gre_ioctl_lock(struct gre_softc *sc)
   1227  1.119    dyoung {
   1228  1.119    dyoung 	mutex_enter(&sc->sc_mtx);
   1229  1.119    dyoung 
   1230  1.119    dyoung 	while (sc->sc_state == GRE_S_IOCTL)
   1231  1.119    dyoung 		gre_wait(sc);
   1232  1.119    dyoung 
   1233  1.119    dyoung 	if (sc->sc_state != GRE_S_IDLE) {
   1234  1.119    dyoung 		cv_signal(&sc->sc_condvar);
   1235  1.119    dyoung 		mutex_exit(&sc->sc_mtx);
   1236  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1237  1.119    dyoung 		return ENXIO;
   1238  1.119    dyoung 	}
   1239  1.119    dyoung 
   1240  1.119    dyoung 	sc->sc_state = GRE_S_IOCTL;
   1241  1.119    dyoung 
   1242  1.119    dyoung 	mutex_exit(&sc->sc_mtx);
   1243  1.119    dyoung 	return 0;
   1244  1.119    dyoung }
   1245  1.119    dyoung 
   1246  1.119    dyoung static void
   1247  1.119    dyoung gre_ioctl_unlock(struct gre_softc *sc)
   1248  1.119    dyoung {
   1249  1.119    dyoung 	mutex_enter(&sc->sc_mtx);
   1250  1.119    dyoung 
   1251  1.119    dyoung 	KASSERT(sc->sc_state == GRE_S_IOCTL);
   1252  1.119    dyoung 	sc->sc_state = GRE_S_IDLE;
   1253  1.119    dyoung 	cv_signal(&sc->sc_condvar);
   1254  1.119    dyoung 
   1255  1.119    dyoung 	mutex_exit(&sc->sc_mtx);
   1256  1.119    dyoung }
   1257  1.119    dyoung 
   1258  1.119    dyoung static int
   1259  1.111    dyoung gre_ioctl(struct ifnet *ifp, const u_long cmd, void *data)
   1260  1.111    dyoung {
   1261   1.94  christos 	struct ifreq *ifr;
   1262   1.28    itojun 	struct if_laddrreq *lifr = (struct if_laddrreq *)data;
   1263    1.8  explorer 	struct gre_softc *sc = ifp->if_softc;
   1264  1.111    dyoung 	struct gre_soparm *sp;
   1265  1.119    dyoung 	int fd, error = 0, oproto, otype, s;
   1266  1.111    dyoung 	struct gre_soparm sp0;
   1267  1.107    dyoung 
   1268  1.107    dyoung 	ifr = data;
   1269  1.107    dyoung 
   1270  1.132    dyoung 	GRE_DPRINTF(sc, "cmd %lu\n", cmd);
   1271  1.111    dyoung 
   1272   1.61        ad 	switch (cmd) {
   1273   1.61        ad 	case SIOCSIFFLAGS:
   1274   1.61        ad 	case SIOCSIFMTU:
   1275   1.61        ad 	case GRESPROTO:
   1276   1.61        ad 	case GRESADDRD:
   1277   1.61        ad 	case GRESADDRS:
   1278   1.62    dyoung 	case GRESSOCK:
   1279   1.62    dyoung 	case GREDSOCK:
   1280   1.61        ad 	case SIOCSLIFPHYADDR:
   1281   1.61        ad 	case SIOCDIFPHYADDR:
   1282  1.127    dyoung 		if (kauth_authorize_network(curlwp->l_cred,
   1283  1.127    dyoung 		    KAUTH_NETWORK_INTERFACE,
   1284   1.70      elad 		    KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
   1285   1.70      elad 		    NULL) != 0)
   1286   1.87    dyoung 			return EPERM;
   1287   1.61        ad 		break;
   1288   1.61        ad 	default:
   1289   1.61        ad 		break;
   1290   1.61        ad 	}
   1291    1.1       hwr 
   1292  1.119    dyoung 	if ((error = gre_ioctl_lock(sc)) != 0) {
   1293  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1294  1.119    dyoung 		return error;
   1295  1.111    dyoung 	}
   1296  1.119    dyoung 	s = splnet();
   1297  1.111    dyoung 
   1298  1.111    dyoung 	sp0 = sc->sc_soparm;
   1299  1.132    dyoung 	sp0.sp_so = NULL;
   1300  1.111    dyoung 	sp = &sp0;
   1301  1.111    dyoung 
   1302  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1303  1.111    dyoung 
   1304   1.20    itojun 	switch (cmd) {
   1305  1.139    dyoung 	case SIOCINITIFADDR:
   1306  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1307  1.111    dyoung 		if ((ifp->if_flags & IFF_UP) != 0)
   1308  1.111    dyoung 			break;
   1309  1.115    dyoung 		gre_clearconf(sp, false);
   1310   1.36    itojun 		ifp->if_flags |= IFF_UP;
   1311  1.111    dyoung 		goto mksocket;
   1312   1.55     perry 	case SIOCSIFDSTADDR:
   1313    1.1       hwr 		break;
   1314    1.1       hwr 	case SIOCSIFFLAGS:
   1315  1.139    dyoung 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
   1316  1.139    dyoung 			break;
   1317  1.111    dyoung 		oproto = sp->sp_proto;
   1318  1.111    dyoung 		otype = sp->sp_type;
   1319   1.62    dyoung 		switch (ifr->ifr_flags & (IFF_LINK0|IFF_LINK2)) {
   1320   1.62    dyoung 		case IFF_LINK0|IFF_LINK2:
   1321  1.111    dyoung 			sp->sp_proto = IPPROTO_UDP;
   1322  1.111    dyoung 			sp->sp_type = SOCK_DGRAM;
   1323  1.111    dyoung 			break;
   1324  1.111    dyoung 		case IFF_LINK2:
   1325  1.111    dyoung 			sp->sp_proto = 0;
   1326  1.111    dyoung 			sp->sp_type = 0;
   1327   1.62    dyoung 			break;
   1328   1.62    dyoung 		case IFF_LINK0:
   1329  1.111    dyoung 			sp->sp_proto = IPPROTO_GRE;
   1330  1.111    dyoung 			sp->sp_type = SOCK_RAW;
   1331  1.111    dyoung 			break;
   1332  1.111    dyoung 		default:
   1333  1.132    dyoung 			GRE_DPRINTF(sc, "\n");
   1334  1.111    dyoung 			error = EINVAL;
   1335  1.111    dyoung 			goto out;
   1336  1.111    dyoung 		}
   1337  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1338  1.115    dyoung 		gre_clearconf(sp, false);
   1339  1.111    dyoung 		if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) ==
   1340  1.111    dyoung 		    (IFF_UP|IFF_RUNNING) &&
   1341  1.111    dyoung 		    (oproto == sp->sp_proto || sp->sp_proto == 0) &&
   1342  1.111    dyoung 		    (otype == sp->sp_type || sp->sp_type == 0))
   1343  1.111    dyoung 			break;
   1344  1.111    dyoung 		switch (sp->sp_proto) {
   1345  1.111    dyoung 		case IPPROTO_UDP:
   1346  1.111    dyoung 		case IPPROTO_GRE:
   1347  1.111    dyoung 			goto mksocket;
   1348  1.111    dyoung 		default:
   1349  1.111    dyoung 			break;
   1350   1.62    dyoung 		}
   1351    1.1       hwr 		break;
   1352   1.20    itojun 	case SIOCSIFMTU:
   1353  1.111    dyoung 		/* XXX determine MTU automatically by probing w/
   1354  1.111    dyoung 		 * XXX do-not-fragment packets?
   1355  1.111    dyoung 		 */
   1356   1.27    martin 		if (ifr->ifr_mtu < 576) {
   1357    1.1       hwr 			error = EINVAL;
   1358    1.1       hwr 			break;
   1359    1.1       hwr 		}
   1360  1.123    dyoung 		/*FALLTHROUGH*/
   1361    1.1       hwr 	case SIOCGIFMTU:
   1362  1.123    dyoung 		if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
   1363  1.123    dyoung 			error = 0;
   1364    1.1       hwr 		break;
   1365    1.1       hwr 	case SIOCADDMULTI:
   1366    1.1       hwr 	case SIOCDELMULTI:
   1367  1.106    dyoung 		if (ifr == NULL) {
   1368    1.1       hwr 			error = EAFNOSUPPORT;
   1369    1.1       hwr 			break;
   1370    1.1       hwr 		}
   1371  1.106    dyoung 		switch (ifreq_getaddr(cmd, ifr)->sa_family) {
   1372    1.1       hwr #ifdef INET
   1373    1.1       hwr 		case AF_INET:
   1374    1.1       hwr 			break;
   1375    1.1       hwr #endif
   1376   1.56        is #ifdef INET6
   1377   1.56        is 		case AF_INET6:
   1378   1.56        is 			break;
   1379   1.56        is #endif
   1380    1.1       hwr 		default:
   1381    1.1       hwr 			error = EAFNOSUPPORT;
   1382    1.1       hwr 			break;
   1383    1.1       hwr 		}
   1384    1.1       hwr 		break;
   1385    1.1       hwr 	case GRESPROTO:
   1386  1.115    dyoung 		gre_clearconf(sp, false);
   1387  1.111    dyoung 		oproto = sp->sp_proto;
   1388  1.111    dyoung 		otype = sp->sp_type;
   1389  1.111    dyoung 		sp->sp_proto = ifr->ifr_flags;
   1390  1.111    dyoung 		switch (sp->sp_proto) {
   1391   1.62    dyoung 		case IPPROTO_UDP:
   1392   1.62    dyoung 			ifp->if_flags |= IFF_LINK0|IFF_LINK2;
   1393  1.111    dyoung 			sp->sp_type = SOCK_DGRAM;
   1394   1.62    dyoung 			break;
   1395   1.40    itojun 		case IPPROTO_GRE:
   1396    1.3       hwr 			ifp->if_flags |= IFF_LINK0;
   1397   1.62    dyoung 			ifp->if_flags &= ~IFF_LINK2;
   1398  1.111    dyoung 			sp->sp_type = SOCK_RAW;
   1399  1.111    dyoung 			break;
   1400  1.111    dyoung 		case 0:
   1401  1.111    dyoung 			ifp->if_flags &= ~IFF_LINK0;
   1402  1.111    dyoung 			ifp->if_flags |= IFF_LINK2;
   1403  1.111    dyoung 			sp->sp_type = 0;
   1404  1.111    dyoung 			break;
   1405    1.1       hwr 		default:
   1406   1.40    itojun 			error = EPROTONOSUPPORT;
   1407   1.35    itojun 			break;
   1408    1.1       hwr 		}
   1409  1.111    dyoung 		if ((oproto == sp->sp_proto || sp->sp_proto == 0) &&
   1410  1.111    dyoung 		    (otype == sp->sp_type || sp->sp_type == 0))
   1411  1.111    dyoung 			break;
   1412  1.111    dyoung 		switch (sp->sp_proto) {
   1413  1.111    dyoung 		case IPPROTO_UDP:
   1414  1.111    dyoung 		case IPPROTO_GRE:
   1415  1.111    dyoung 			goto mksocket;
   1416  1.111    dyoung 		default:
   1417  1.111    dyoung 			break;
   1418  1.111    dyoung 		}
   1419    1.1       hwr 		break;
   1420    1.1       hwr 	case GREGPROTO:
   1421  1.111    dyoung 		ifr->ifr_flags = sp->sp_proto;
   1422    1.1       hwr 		break;
   1423    1.1       hwr 	case GRESADDRS:
   1424    1.1       hwr 	case GRESADDRD:
   1425  1.115    dyoung 		gre_clearconf(sp, false);
   1426  1.132    dyoung 		/* set tunnel endpoints and mark interface as up */
   1427  1.111    dyoung 		switch (cmd) {
   1428  1.111    dyoung 		case GRESADDRS:
   1429  1.111    dyoung 			sockaddr_copy(sstosa(&sp->sp_src),
   1430  1.111    dyoung 			    sizeof(sp->sp_src), ifreq_getaddr(cmd, ifr));
   1431  1.111    dyoung 			break;
   1432  1.111    dyoung 		case GRESADDRD:
   1433  1.111    dyoung 			sockaddr_copy(sstosa(&sp->sp_dst),
   1434  1.111    dyoung 			    sizeof(sp->sp_dst), ifreq_getaddr(cmd, ifr));
   1435   1.93    dyoung 			break;
   1436   1.63    dyoung 		}
   1437  1.111    dyoung 	checkaddr:
   1438  1.111    dyoung 		if (sockaddr_any(sstosa(&sp->sp_src)) == NULL ||
   1439  1.111    dyoung 		    sockaddr_any(sstosa(&sp->sp_dst)) == NULL) {
   1440   1.93    dyoung 			error = EINVAL;
   1441   1.93    dyoung 			break;
   1442   1.93    dyoung 		}
   1443  1.111    dyoung 		/* let gre_socreate() check the rest */
   1444  1.111    dyoung 	mksocket:
   1445  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1446  1.111    dyoung 		/* If we're administratively down, or the configuration
   1447  1.111    dyoung 		 * is empty, there's no use creating a socket.
   1448  1.111    dyoung 		 */
   1449  1.111    dyoung 		if ((ifp->if_flags & IFF_UP) == 0 || gre_is_nullconf(sp))
   1450  1.111    dyoung 			goto sendconf;
   1451  1.111    dyoung 
   1452  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1453  1.127    dyoung 		fd = 0;
   1454  1.127    dyoung 		error = gre_socreate(sc, sp, &fd);
   1455  1.111    dyoung 		if (error != 0)
   1456   1.62    dyoung 			break;
   1457   1.62    dyoung 
   1458  1.111    dyoung 	setsock:
   1459  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1460   1.93    dyoung 
   1461  1.111    dyoung 		error = gre_ssock(ifp, sp, fd);
   1462   1.93    dyoung 
   1463  1.111    dyoung 		if (cmd != GRESSOCK) {
   1464  1.132    dyoung 			GRE_DPRINTF(sc, "\n");
   1465  1.125        ad 			/* XXX v. dodgy */
   1466  1.125        ad 			if (fd_getfile(fd) != NULL)
   1467  1.125        ad 				fd_close(fd);
   1468   1.93    dyoung 		}
   1469  1.111    dyoung 
   1470   1.93    dyoung 		if (error == 0) {
   1471  1.111    dyoung 	sendconf:
   1472  1.132    dyoung 			GRE_DPRINTF(sc, "\n");
   1473  1.111    dyoung 			ifp->if_flags &= ~IFF_RUNNING;
   1474  1.132    dyoung 			gre_reconf(sc, sp);
   1475   1.93    dyoung 		}
   1476   1.62    dyoung 
   1477   1.62    dyoung 		break;
   1478  1.111    dyoung 	case GREGADDRS:
   1479  1.111    dyoung 		ifreq_setaddr(cmd, ifr, sstosa(&sp->sp_src));
   1480  1.111    dyoung 		break;
   1481  1.111    dyoung 	case GREGADDRD:
   1482  1.111    dyoung 		ifreq_setaddr(cmd, ifr, sstosa(&sp->sp_dst));
   1483  1.111    dyoung 		break;
   1484  1.111    dyoung 	case GREDSOCK:
   1485  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1486  1.111    dyoung 		if (sp->sp_bysock)
   1487  1.111    dyoung 			ifp->if_flags &= ~IFF_UP;
   1488  1.115    dyoung 		gre_clearconf(sp, false);
   1489  1.111    dyoung 		goto mksocket;
   1490  1.111    dyoung 	case GRESSOCK:
   1491  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1492  1.115    dyoung 		gre_clearconf(sp, true);
   1493  1.111    dyoung 		fd = (int)ifr->ifr_value;
   1494  1.132    dyoung 		sp->sp_bysock = true;
   1495  1.111    dyoung 		ifp->if_flags |= IFF_UP;
   1496  1.111    dyoung 		goto setsock;
   1497   1.28    itojun 	case SIOCSLIFPHYADDR:
   1498  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1499  1.111    dyoung 		if (lifr->addr.ss_family != lifr->dstaddr.ss_family) {
   1500   1.31    itojun 			error = EAFNOSUPPORT;
   1501   1.31    itojun 			break;
   1502   1.31    itojun 		}
   1503  1.111    dyoung 		sockaddr_copy(sstosa(&sp->sp_src), sizeof(sp->sp_src),
   1504  1.111    dyoung 		    sstosa(&lifr->addr));
   1505  1.111    dyoung 		sockaddr_copy(sstosa(&sp->sp_dst), sizeof(sp->sp_dst),
   1506  1.111    dyoung 		    sstosa(&lifr->dstaddr));
   1507  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1508  1.111    dyoung 		goto checkaddr;
   1509   1.28    itojun 	case SIOCDIFPHYADDR:
   1510  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1511  1.115    dyoung 		gre_clearconf(sp, true);
   1512  1.111    dyoung 		ifp->if_flags &= ~IFF_UP;
   1513  1.111    dyoung 		goto mksocket;
   1514   1.28    itojun 	case SIOCGLIFPHYADDR:
   1515  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1516  1.111    dyoung 		if (gre_is_nullconf(sp)) {
   1517   1.28    itojun 			error = EADDRNOTAVAIL;
   1518   1.28    itojun 			break;
   1519   1.28    itojun 		}
   1520  1.111    dyoung 		sockaddr_copy(sstosa(&lifr->addr), sizeof(lifr->addr),
   1521  1.111    dyoung 		    sstosa(&sp->sp_src));
   1522  1.111    dyoung 		sockaddr_copy(sstosa(&lifr->dstaddr), sizeof(lifr->dstaddr),
   1523  1.111    dyoung 		    sstosa(&sp->sp_dst));
   1524  1.132    dyoung 		GRE_DPRINTF(sc, "\n");
   1525    1.1       hwr 		break;
   1526    1.1       hwr 	default:
   1527  1.139    dyoung 		error = ifioctl_common(ifp, cmd, data);
   1528   1.31    itojun 		break;
   1529    1.1       hwr 	}
   1530  1.111    dyoung out:
   1531  1.132    dyoung 	GRE_DPRINTF(sc, "\n");
   1532  1.119    dyoung 	splx(s);
   1533  1.119    dyoung 	gre_ioctl_unlock(sc);
   1534   1.87    dyoung 	return error;
   1535    1.1       hwr }
   1536    1.1       hwr 
   1537   1.59   thorpej void	greattach(int);
   1538   1.54  christos 
   1539   1.54  christos /* ARGSUSED */
   1540   1.54  christos void
   1541   1.74  christos greattach(int count)
   1542   1.54  christos {
   1543   1.54  christos 	if_clone_attach(&gre_cloner);
   1544   1.54  christos }
   1545