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