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