Home | History | Annotate | Line # | Download | only in agr
if_agr.c revision 1.20.10.4
      1  1.20.10.4      yamt /*	$NetBSD: if_agr.c,v 1.20.10.4 2010/08/11 22:54:55 yamt Exp $	*/
      2        1.1      yamt 
      3        1.1      yamt /*-
      4        1.1      yamt  * Copyright (c)2005 YAMAMOTO Takashi,
      5        1.1      yamt  * All rights reserved.
      6        1.1      yamt  *
      7        1.1      yamt  * Redistribution and use in source and binary forms, with or without
      8        1.1      yamt  * modification, are permitted provided that the following conditions
      9        1.1      yamt  * are met:
     10        1.1      yamt  * 1. Redistributions of source code must retain the above copyright
     11        1.1      yamt  *    notice, this list of conditions and the following disclaimer.
     12        1.1      yamt  * 2. Redistributions in binary form must reproduce the above copyright
     13        1.1      yamt  *    notice, this list of conditions and the following disclaimer in the
     14        1.1      yamt  *    documentation and/or other materials provided with the distribution.
     15        1.1      yamt  *
     16        1.1      yamt  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     17        1.1      yamt  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18        1.1      yamt  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19        1.1      yamt  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     20        1.1      yamt  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21        1.1      yamt  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22        1.1      yamt  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23        1.1      yamt  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24        1.1      yamt  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25        1.1      yamt  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26        1.1      yamt  * SUCH DAMAGE.
     27        1.1      yamt  */
     28        1.1      yamt 
     29        1.1      yamt #include <sys/cdefs.h>
     30  1.20.10.4      yamt __KERNEL_RCSID(0, "$NetBSD: if_agr.c,v 1.20.10.4 2010/08/11 22:54:55 yamt Exp $");
     31        1.1      yamt 
     32        1.1      yamt #include "opt_inet.h"
     33        1.1      yamt 
     34        1.1      yamt #include <sys/param.h>
     35        1.2      yamt #include <sys/callout.h>
     36        1.1      yamt #include <sys/malloc.h>
     37        1.1      yamt #include <sys/mbuf.h>
     38        1.1      yamt #include <sys/systm.h>
     39        1.1      yamt #include <sys/types.h>
     40        1.1      yamt #include <sys/queue.h>
     41        1.1      yamt #include <sys/sockio.h>
     42        1.1      yamt #include <sys/proc.h>	/* XXX for curproc */
     43        1.5      yamt #include <sys/kauth.h>
     44  1.20.10.3      yamt #include <sys/xcall.h>
     45        1.1      yamt 
     46        1.1      yamt #include <net/bpf.h>
     47        1.1      yamt #include <net/if.h>
     48        1.1      yamt #include <net/if_dl.h>
     49        1.1      yamt #include <net/if_types.h>
     50  1.20.10.2      yamt #include <net/if_ether.h>
     51        1.1      yamt 
     52        1.1      yamt #if defined(INET)
     53        1.1      yamt #include <netinet/in.h>
     54        1.1      yamt #include <netinet/if_inarp.h>
     55        1.1      yamt #endif
     56        1.1      yamt 
     57        1.1      yamt #include <net/agr/if_agrvar.h>
     58        1.1      yamt #include <net/agr/if_agrvar_impl.h>
     59        1.1      yamt #include <net/agr/if_agrioctl.h>
     60        1.1      yamt #include <net/agr/if_agrsubr.h>
     61        1.1      yamt #include <net/agr/if_agrethervar.h>
     62        1.1      yamt 
     63        1.1      yamt void agrattach(int);
     64        1.1      yamt 
     65        1.1      yamt static int agr_clone_create(struct if_clone *, int);
     66        1.1      yamt static int agr_clone_destroy(struct ifnet *);
     67        1.1      yamt static void agr_start(struct ifnet *);
     68  1.20.10.3      yamt static int agr_setconfig(struct agr_softc *, const struct agrreq *);
     69  1.20.10.3      yamt static int agr_getconfig(struct agr_softc *, struct agrreq *);
     70  1.20.10.3      yamt static int agr_getportlist(struct agr_softc *, struct agrreq *);
     71        1.1      yamt static int agr_addport(struct ifnet *, struct ifnet *);
     72        1.1      yamt static int agr_remport(struct ifnet *, struct ifnet *);
     73        1.1      yamt static int agrreq_copyin(const void *, struct agrreq *);
     74        1.1      yamt static int agrreq_copyout(void *, struct agrreq *);
     75       1.11  christos static int agr_ioctl(struct ifnet *, u_long, void *);
     76        1.1      yamt static struct agr_port *agr_select_tx_port(struct agr_softc *, struct mbuf *);
     77       1.11  christos static int agr_ioctl_filter(struct ifnet *, u_long, void *);
     78        1.1      yamt static void agr_reset_iftype(struct ifnet *);
     79        1.1      yamt static int agr_config_promisc(struct agr_softc *);
     80        1.1      yamt static int agrport_config_promisc_callback(struct agr_port *, void *);
     81        1.9   thorpej static int agrport_config_promisc(struct agr_port *, bool);
     82        1.1      yamt static int agrport_cleanup(struct agr_softc *, struct agr_port *);
     83        1.1      yamt 
     84  1.20.10.3      yamt static int agr_enter(struct agr_softc *);
     85  1.20.10.3      yamt static void agr_exit(struct agr_softc *);
     86  1.20.10.3      yamt static int agr_pause(struct agr_softc *);
     87  1.20.10.3      yamt static void agr_evacuate(struct agr_softc *);
     88  1.20.10.3      yamt static void agr_sync(void);
     89  1.20.10.3      yamt static void agr_ports_lock(struct agr_softc *);
     90  1.20.10.3      yamt static void agr_ports_unlock(struct agr_softc *);
     91  1.20.10.3      yamt static bool agr_ports_enter(struct agr_softc *);
     92  1.20.10.3      yamt static void agr_ports_exit(struct agr_softc *);
     93  1.20.10.3      yamt 
     94        1.1      yamt static struct if_clone agr_cloner =
     95        1.1      yamt     IF_CLONE_INITIALIZER("agr", agr_clone_create, agr_clone_destroy);
     96        1.1      yamt 
     97        1.1      yamt /*
     98        1.1      yamt  * EXPORTED FUNCTIONS
     99        1.1      yamt  */
    100        1.1      yamt 
    101        1.1      yamt /*
    102        1.1      yamt  * agrattch: device attach routine.
    103        1.1      yamt  */
    104        1.1      yamt 
    105        1.1      yamt void
    106        1.1      yamt agrattach(int count)
    107        1.1      yamt {
    108        1.1      yamt 
    109        1.1      yamt 	if_clone_attach(&agr_cloner);
    110        1.1      yamt }
    111        1.1      yamt 
    112        1.1      yamt /*
    113        1.1      yamt  * agr_input: frame collector.
    114        1.1      yamt  */
    115        1.1      yamt 
    116        1.1      yamt void
    117        1.1      yamt agr_input(struct ifnet *ifp_port, struct mbuf *m)
    118        1.1      yamt {
    119        1.1      yamt 	struct agr_port *port;
    120        1.1      yamt 	struct ifnet *ifp;
    121  1.20.10.2      yamt #if NVLAN > 0
    122  1.20.10.2      yamt 	struct m_tag *mtag;
    123  1.20.10.2      yamt #endif
    124        1.1      yamt 
    125        1.1      yamt 	port = ifp_port->if_agrprivate;
    126        1.1      yamt 	KASSERT(port);
    127        1.1      yamt 	ifp = port->port_agrifp;
    128        1.1      yamt 	if ((port->port_flags & AGRPORT_COLLECTING) == 0) {
    129        1.1      yamt 		m_freem(m);
    130        1.1      yamt 		ifp->if_ierrors++;
    131        1.1      yamt 		return;
    132        1.1      yamt 	}
    133        1.1      yamt 
    134        1.1      yamt 	ifp->if_ipackets++;
    135        1.1      yamt 	m->m_pkthdr.rcvif = ifp;
    136        1.1      yamt 
    137  1.20.10.2      yamt #define DNH_DEBUG
    138  1.20.10.2      yamt #if NVLAN > 0
    139  1.20.10.2      yamt 	/* got a vlan packet? */
    140  1.20.10.2      yamt 	if ((mtag = m_tag_find(m, PACKET_TAG_VLAN, NULL)) != NULL) {
    141  1.20.10.2      yamt #ifdef DNH_DEBUG
    142  1.20.10.2      yamt 		printf("%s: vlan tag %d attached\n",
    143  1.20.10.2      yamt 			ifp->if_xname,
    144  1.20.10.2      yamt 			htole16((*(u_int *)(mtag + 1)) & 0xffff));
    145  1.20.10.2      yamt 		printf("%s: vlan input\n", ifp->if_xname);
    146  1.20.10.2      yamt #endif
    147  1.20.10.2      yamt 		vlan_input(ifp, m);
    148  1.20.10.2      yamt 		return;
    149  1.20.10.2      yamt #ifdef DNH_DEBUG
    150  1.20.10.2      yamt 	} else {
    151  1.20.10.2      yamt 		struct ethercom *ec = (void *)ifp;
    152  1.20.10.2      yamt 		printf("%s: no vlan tag attached, ec_nvlans=%d\n",
    153  1.20.10.2      yamt 			ifp->if_xname, ec->ec_nvlans);
    154  1.20.10.2      yamt #endif
    155  1.20.10.2      yamt 	}
    156  1.20.10.2      yamt #endif
    157  1.20.10.2      yamt 
    158  1.20.10.4      yamt 	bpf_mtap(ifp, m);
    159        1.1      yamt 	(*ifp->if_input)(ifp, m);
    160        1.1      yamt }
    161        1.1      yamt 
    162        1.1      yamt /*
    163        1.1      yamt  * EXPORTED AGR-INTERNAL FUNCTIONS
    164        1.1      yamt  */
    165        1.1      yamt 
    166       1.12      yamt void
    167        1.1      yamt agr_lock(struct agr_softc *sc)
    168        1.1      yamt {
    169        1.1      yamt 
    170       1.12      yamt 	mutex_enter(&sc->sc_lock);
    171        1.1      yamt }
    172        1.1      yamt 
    173        1.1      yamt void
    174       1.12      yamt agr_unlock(struct agr_softc *sc)
    175        1.1      yamt {
    176        1.1      yamt 
    177       1.12      yamt 	mutex_exit(&sc->sc_lock);
    178        1.1      yamt }
    179        1.1      yamt 
    180        1.1      yamt /*
    181        1.1      yamt  * agr_xmit_frame: transmit a pre-built frame.
    182        1.1      yamt  */
    183        1.1      yamt 
    184        1.1      yamt int
    185        1.1      yamt agr_xmit_frame(struct ifnet *ifp_port, struct mbuf *m)
    186        1.1      yamt {
    187        1.1      yamt 	int error;
    188        1.1      yamt 
    189        1.1      yamt 	struct sockaddr_storage dst0;
    190        1.1      yamt 	struct sockaddr *dst;
    191        1.1      yamt 	int hdrlen;
    192        1.1      yamt 
    193        1.1      yamt 	/*
    194        1.1      yamt 	 * trim off link level header and let if_output re-add it.
    195        1.1      yamt 	 * XXX better to introduce an API to transmit pre-built frames.
    196        1.1      yamt 	 */
    197        1.1      yamt 
    198        1.1      yamt 	hdrlen = ifp_port->if_hdrlen;
    199        1.1      yamt 	if (m->m_pkthdr.len < hdrlen) {
    200        1.1      yamt 		m_freem(m);
    201        1.1      yamt 		return EINVAL;
    202        1.1      yamt 	}
    203        1.1      yamt 	memset(&dst0, 0, sizeof(dst0));
    204        1.1      yamt 	dst = (struct sockaddr *)&dst0;
    205        1.1      yamt 	dst->sa_family = pseudo_AF_HDRCMPLT;
    206        1.1      yamt 	dst->sa_len = hdrlen;
    207        1.1      yamt 	m_copydata(m, 0, hdrlen, &dst->sa_data);
    208        1.1      yamt 	m_adj(m, hdrlen);
    209        1.1      yamt 
    210        1.1      yamt 	error = (*ifp_port->if_output)(ifp_port, m, dst, NULL);
    211        1.1      yamt 
    212        1.1      yamt 	return error;
    213        1.1      yamt }
    214        1.1      yamt 
    215        1.1      yamt int
    216       1.11  christos agrport_ioctl(struct agr_port *port, u_long cmd, void *arg)
    217        1.1      yamt {
    218        1.1      yamt 	struct ifnet *ifp = port->port_ifp;
    219        1.1      yamt 
    220        1.1      yamt 	KASSERT(ifp->if_agrprivate == (void *)port);
    221        1.1      yamt 	KASSERT(ifp->if_ioctl == agr_ioctl_filter);
    222        1.1      yamt 
    223        1.1      yamt 	return (*port->port_ioctl)(ifp, cmd, arg);
    224        1.1      yamt }
    225        1.1      yamt 
    226        1.1      yamt /*
    227        1.1      yamt  * INTERNAL FUNCTIONS
    228        1.1      yamt  */
    229        1.1      yamt 
    230  1.20.10.2      yamt /*
    231  1.20.10.2      yamt  * Enable vlan hardware assist for the specified port.
    232  1.20.10.2      yamt  */
    233  1.20.10.2      yamt static int
    234  1.20.10.2      yamt agr_vlan_add(struct agr_port *port, void *arg)
    235  1.20.10.2      yamt {
    236  1.20.10.2      yamt 	struct ifnet *ifp = port->port_ifp;
    237  1.20.10.2      yamt 	struct ethercom *ec_port = (void *)ifp;
    238  1.20.10.2      yamt 	struct ifreq ifr;
    239  1.20.10.2      yamt 	int error=0;
    240  1.20.10.2      yamt 
    241  1.20.10.2      yamt 	if (ec_port->ec_nvlans++ == 0 &&
    242  1.20.10.2      yamt 	    (ec_port->ec_capabilities & ETHERCAP_VLAN_MTU) != 0) {
    243  1.20.10.2      yamt 		struct ifnet *p = port->port_ifp;
    244  1.20.10.2      yamt 		/*
    245  1.20.10.2      yamt 		 * Enable Tx/Rx of VLAN-sized frames.
    246  1.20.10.2      yamt 		 */
    247  1.20.10.2      yamt 		ec_port->ec_capenable |= ETHERCAP_VLAN_MTU;
    248  1.20.10.2      yamt 		if (p->if_flags & IFF_UP) {
    249  1.20.10.2      yamt 			ifr.ifr_flags = p->if_flags;
    250  1.20.10.2      yamt 			error = (*p->if_ioctl)(p, SIOCSIFFLAGS,
    251  1.20.10.2      yamt 			    (void *) &ifr);
    252  1.20.10.2      yamt 			if (error) {
    253  1.20.10.2      yamt 				if (ec_port->ec_nvlans-- == 1)
    254  1.20.10.2      yamt 					ec_port->ec_capenable &=
    255  1.20.10.2      yamt 					    ~ETHERCAP_VLAN_MTU;
    256  1.20.10.2      yamt 				return (error);
    257  1.20.10.2      yamt 			}
    258  1.20.10.2      yamt 		}
    259  1.20.10.2      yamt 	}
    260  1.20.10.2      yamt 
    261  1.20.10.2      yamt 	return error;
    262  1.20.10.2      yamt }
    263  1.20.10.2      yamt 
    264  1.20.10.2      yamt /*
    265  1.20.10.2      yamt  * Disable vlan hardware assist for the specified port.
    266  1.20.10.2      yamt  */
    267  1.20.10.2      yamt static int
    268  1.20.10.2      yamt agr_vlan_del(struct agr_port *port, void *arg)
    269  1.20.10.2      yamt {
    270  1.20.10.2      yamt 	struct ethercom *ec_port = (void *)port->port_ifp;
    271  1.20.10.2      yamt 	struct ifreq ifr;
    272  1.20.10.2      yamt 
    273  1.20.10.2      yamt 	/* Disable vlan support */
    274  1.20.10.2      yamt 	if (ec_port->ec_nvlans-- == 1) {
    275  1.20.10.2      yamt 		/*
    276  1.20.10.2      yamt 		 * Disable Tx/Rx of VLAN-sized frames.
    277  1.20.10.2      yamt 		 */
    278  1.20.10.2      yamt 		ec_port->ec_capenable &= ~ETHERCAP_VLAN_MTU;
    279  1.20.10.2      yamt 		if (port->port_ifp->if_flags & IFF_UP) {
    280  1.20.10.2      yamt 			ifr.ifr_flags = port->port_ifp->if_flags;
    281  1.20.10.2      yamt 			(void) (*port->port_ifp->if_ioctl)(port->port_ifp,
    282  1.20.10.2      yamt 			    SIOCSIFFLAGS, (void *) &ifr);
    283  1.20.10.2      yamt 		}
    284  1.20.10.2      yamt 	}
    285  1.20.10.2      yamt 
    286  1.20.10.2      yamt 	return 0;
    287  1.20.10.2      yamt }
    288  1.20.10.2      yamt 
    289  1.20.10.2      yamt 
    290  1.20.10.2      yamt /*
    291  1.20.10.2      yamt  * Check for vlan attach/detach.
    292  1.20.10.2      yamt  * ec->ec_nvlans is directly modified by the vlan driver.
    293  1.20.10.2      yamt  * We keep a local count in sc (sc->sc_nvlans) to detect
    294  1.20.10.2      yamt  * when the vlan driver attaches or detaches.
    295  1.20.10.2      yamt  * Note the agr interface must be up for this to work.
    296  1.20.10.2      yamt  */
    297  1.20.10.2      yamt static void
    298  1.20.10.2      yamt agr_vlan_check(struct ifnet *ifp, struct agr_softc *sc)
    299  1.20.10.2      yamt {
    300  1.20.10.2      yamt 	struct ethercom *ec = (void *)ifp;
    301  1.20.10.2      yamt 	int error;
    302  1.20.10.2      yamt 
    303  1.20.10.2      yamt 	/* vlans in sync? */
    304  1.20.10.2      yamt 	if (sc->sc_nvlans == ec->ec_nvlans) {
    305  1.20.10.2      yamt 		return;
    306  1.20.10.2      yamt 	}
    307  1.20.10.2      yamt 
    308  1.20.10.2      yamt 	if (sc->sc_nvlans == 0) {
    309  1.20.10.2      yamt 		/* vlan added */
    310  1.20.10.2      yamt 		error = agr_port_foreach(sc, agr_vlan_add, NULL);
    311  1.20.10.2      yamt 		sc->sc_nvlans = ec->ec_nvlans;
    312  1.20.10.2      yamt 	} else if (ec->ec_nvlans == 0) {
    313  1.20.10.2      yamt 		/* vlan removed */
    314  1.20.10.2      yamt 		error = agr_port_foreach(sc, agr_vlan_del, NULL);
    315  1.20.10.2      yamt 		sc->sc_nvlans = 0;
    316  1.20.10.2      yamt 	}
    317  1.20.10.2      yamt }
    318  1.20.10.2      yamt 
    319        1.1      yamt static int
    320        1.1      yamt agr_clone_create(struct if_clone *ifc, int unit)
    321        1.1      yamt {
    322        1.1      yamt 	struct agr_softc *sc;
    323        1.1      yamt 	struct ifnet *ifp;
    324        1.1      yamt 
    325        1.1      yamt 	sc = agr_alloc_softc();
    326        1.1      yamt 	TAILQ_INIT(&sc->sc_ports);
    327  1.20.10.3      yamt 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NET);
    328  1.20.10.3      yamt 	mutex_init(&sc->sc_entry_mtx, MUTEX_DEFAULT, IPL_NONE);
    329  1.20.10.3      yamt 	cv_init(&sc->sc_insc_cv, "agr_softc");
    330  1.20.10.3      yamt 	cv_init(&sc->sc_ports_cv, "agrports");
    331        1.1      yamt 	agrtimer_init(sc);
    332        1.1      yamt 	ifp = &sc->sc_if;
    333        1.1      yamt 	snprintf(ifp->if_xname, sizeof(ifp->if_xname), "%s%d",
    334        1.1      yamt 	    ifc->ifc_name, unit);
    335        1.1      yamt 
    336        1.1      yamt 	ifp->if_softc = sc;
    337        1.1      yamt 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    338        1.1      yamt 	ifp->if_start = agr_start;
    339        1.1      yamt 	ifp->if_ioctl = agr_ioctl;
    340        1.1      yamt 	IFQ_SET_READY(&ifp->if_snd);
    341        1.1      yamt 
    342        1.1      yamt 	if_attach(ifp);
    343        1.1      yamt 
    344        1.1      yamt 	agr_reset_iftype(ifp);
    345        1.1      yamt 
    346        1.1      yamt 	return 0;
    347        1.1      yamt }
    348        1.1      yamt 
    349        1.1      yamt static void
    350        1.1      yamt agr_reset_iftype(struct ifnet *ifp)
    351        1.1      yamt {
    352        1.1      yamt 
    353        1.1      yamt 	ifp->if_type = IFT_OTHER;
    354        1.1      yamt 	ifp->if_dlt = DLT_NULL;
    355        1.1      yamt 	ifp->if_addrlen = 0;
    356        1.1      yamt 	if_alloc_sadl(ifp);
    357        1.1      yamt }
    358        1.1      yamt 
    359        1.1      yamt static int
    360        1.1      yamt agr_clone_destroy(struct ifnet *ifp)
    361        1.1      yamt {
    362        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
    363        1.1      yamt 	int error;
    364        1.1      yamt 
    365  1.20.10.3      yamt 	if ((error = agr_pause(sc)) != 0)
    366  1.20.10.3      yamt 		return error;
    367        1.1      yamt 
    368  1.20.10.3      yamt 	if_detach(ifp);
    369  1.20.10.3      yamt 	agrtimer_destroy(sc);
    370  1.20.10.3      yamt 	/* Now that the ifnet has been detached, and our
    371  1.20.10.3      yamt 	 * component ifnets are disconnected, there can be
    372  1.20.10.3      yamt 	 * no new threads in the softc.  Wait for every
    373  1.20.10.3      yamt 	 * thread to get out of the softc.
    374  1.20.10.3      yamt 	 */
    375  1.20.10.3      yamt 	agr_evacuate(sc);
    376  1.20.10.3      yamt 	mutex_destroy(&sc->sc_lock);
    377  1.20.10.3      yamt 	mutex_destroy(&sc->sc_entry_mtx);
    378  1.20.10.3      yamt 	cv_destroy(&sc->sc_insc_cv);
    379  1.20.10.3      yamt 	cv_destroy(&sc->sc_ports_cv);
    380  1.20.10.3      yamt 	agr_free_softc(sc);
    381        1.1      yamt 
    382  1.20.10.3      yamt 	return 0;
    383        1.1      yamt }
    384        1.1      yamt 
    385        1.1      yamt static struct agr_port *
    386        1.1      yamt agr_select_tx_port(struct agr_softc *sc, struct mbuf *m)
    387        1.1      yamt {
    388        1.1      yamt 
    389        1.1      yamt 	return (*sc->sc_iftop->iftop_select_tx_port)(sc, m);
    390        1.1      yamt }
    391        1.1      yamt 
    392        1.1      yamt #if 0 /* "generic" version */
    393        1.1      yamt static struct agr_port *
    394        1.1      yamt agr_select_tx_port(struct agr_softc *sc, struct mbuf *m)
    395        1.1      yamt {
    396        1.1      yamt 	struct agr_port *port;
    397        1.1      yamt 	uint32_t hash;
    398        1.1      yamt 
    399        1.1      yamt 	hash = (*sc->sc_iftop->iftop_hashmbuf)(sc, m);
    400        1.1      yamt 	if (sc->sc_nports == 0)
    401        1.1      yamt 		return NULL;
    402        1.1      yamt 	hash %= sc->sc_nports;
    403        1.1      yamt 	port = TAILQ_FIRST(&sc->sc_ports);
    404        1.1      yamt 	KASSERT(port != NULL);
    405        1.1      yamt 	while (hash--) {
    406        1.1      yamt 		port = TAILQ_NEXT(port, port_q);
    407        1.1      yamt 		KASSERT(port != NULL);
    408        1.1      yamt 	}
    409        1.1      yamt 
    410        1.1      yamt 	return port;
    411        1.1      yamt }
    412        1.1      yamt #endif /* 0 */
    413        1.1      yamt 
    414        1.1      yamt static void
    415        1.1      yamt agr_start(struct ifnet *ifp)
    416        1.1      yamt {
    417        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
    418        1.1      yamt 	struct mbuf *m;
    419        1.1      yamt 
    420       1.12      yamt 	AGR_LOCK(sc);
    421        1.1      yamt 
    422        1.1      yamt 	while (/* CONSTCOND */ 1) {
    423        1.1      yamt 		struct agr_port *port;
    424        1.1      yamt 
    425        1.1      yamt 		IFQ_DEQUEUE(&ifp->if_snd, m);
    426        1.1      yamt 		if (m == NULL) {
    427        1.1      yamt 			break;
    428        1.1      yamt 		}
    429  1.20.10.4      yamt 		bpf_mtap(ifp, m);
    430        1.1      yamt 		port = agr_select_tx_port(sc, m);
    431        1.1      yamt 		if (port) {
    432        1.1      yamt 			int error;
    433        1.1      yamt 
    434        1.1      yamt 			error = agr_xmit_frame(port->port_ifp, m);
    435        1.1      yamt 			if (error) {
    436        1.1      yamt 				ifp->if_oerrors++;
    437        1.1      yamt 			} else {
    438        1.1      yamt 				ifp->if_opackets++;
    439        1.1      yamt 			}
    440        1.1      yamt 		} else {
    441        1.1      yamt 			m_freem(m);
    442        1.1      yamt 			ifp->if_oerrors++;
    443        1.1      yamt 		}
    444        1.1      yamt 	}
    445        1.1      yamt 
    446       1.12      yamt 	AGR_UNLOCK(sc);
    447        1.1      yamt 
    448        1.1      yamt 	ifp->if_flags &= ~IFF_OACTIVE;
    449        1.1      yamt }
    450        1.1      yamt 
    451        1.1      yamt static int
    452  1.20.10.3      yamt agr_setconfig(struct agr_softc *sc, const struct agrreq *ar)
    453        1.1      yamt {
    454  1.20.10.3      yamt 	struct ifnet *ifp = &sc->sc_if;
    455        1.1      yamt 	int cmd = ar->ar_cmd;
    456        1.1      yamt 	struct ifnet *ifp_port;
    457        1.1      yamt 	int error = 0;
    458        1.1      yamt 	char ifname[IFNAMSIZ];
    459        1.1      yamt 
    460        1.8      yamt 	memset(ifname, 0, sizeof(ifname));
    461        1.8      yamt 	error = copyin(ar->ar_buf, ifname,
    462        1.8      yamt 	    MIN(ar->ar_buflen, sizeof(ifname) - 1));
    463        1.1      yamt 	if (error) {
    464        1.1      yamt 		return error;
    465        1.1      yamt 	}
    466        1.1      yamt 	ifp_port = ifunit(ifname);
    467        1.1      yamt 	if (ifp_port == NULL) {
    468        1.1      yamt 		return ENOENT;
    469        1.1      yamt 	}
    470        1.1      yamt 
    471  1.20.10.3      yamt 	agr_ports_lock(sc);
    472        1.1      yamt 	switch (cmd) {
    473        1.1      yamt 	case AGRCMD_ADDPORT:
    474        1.1      yamt 		error = agr_addport(ifp, ifp_port);
    475        1.1      yamt 		break;
    476        1.1      yamt 
    477        1.1      yamt 	case AGRCMD_REMPORT:
    478        1.1      yamt 		error = agr_remport(ifp, ifp_port);
    479        1.1      yamt 		break;
    480        1.1      yamt 
    481        1.1      yamt 	default:
    482        1.1      yamt 		error = EINVAL;
    483        1.1      yamt 		break;
    484        1.1      yamt 	}
    485  1.20.10.3      yamt 	agr_ports_unlock(sc);
    486        1.1      yamt 
    487        1.1      yamt 	return error;
    488        1.1      yamt }
    489        1.1      yamt 
    490        1.1      yamt static int
    491  1.20.10.3      yamt agr_getportlist(struct agr_softc *sc, struct agrreq *ar)
    492        1.1      yamt {
    493        1.1      yamt 	struct agr_port *port;
    494        1.1      yamt 	struct agrportlist apl;
    495        1.1      yamt 	struct agrportinfo api;
    496        1.1      yamt 	char *cp = ar->ar_buf;
    497        1.1      yamt 	size_t bufleft = (cp == NULL) ? 0 : ar->ar_buflen;
    498        1.1      yamt 	int error;
    499        1.1      yamt 
    500        1.1      yamt 	if (cp != NULL) {
    501        1.1      yamt 		memset(&apl, 0, sizeof(apl));
    502        1.1      yamt 		memset(&api, 0, sizeof(api));
    503        1.1      yamt 
    504        1.1      yamt 		if (bufleft < sizeof(apl)) {
    505        1.1      yamt 			return E2BIG;
    506        1.1      yamt 		}
    507        1.1      yamt 		apl.apl_nports = sc->sc_nports;
    508        1.1      yamt 		error = copyout(&apl, cp, sizeof(apl));
    509        1.1      yamt 		if (error) {
    510        1.1      yamt 			return error;
    511        1.1      yamt 		}
    512        1.1      yamt 		cp += sizeof(apl);
    513        1.1      yamt 	}
    514        1.1      yamt 	bufleft -= sizeof(apl);
    515        1.1      yamt 
    516        1.1      yamt 	TAILQ_FOREACH(port, &sc->sc_ports, port_q) {
    517        1.1      yamt 		if (cp != NULL) {
    518        1.1      yamt 			if (bufleft < sizeof(api)) {
    519        1.1      yamt 				return E2BIG;
    520        1.1      yamt 			}
    521        1.1      yamt 			memcpy(api.api_ifname, port->port_ifp->if_xname,
    522        1.1      yamt 			    sizeof(api.api_ifname));
    523        1.1      yamt 			api.api_flags = 0;
    524        1.1      yamt 			if (port->port_flags & AGRPORT_COLLECTING) {
    525        1.1      yamt 				api.api_flags |= AGRPORTINFO_COLLECTING;
    526        1.1      yamt 			}
    527        1.1      yamt 			if (port->port_flags & AGRPORT_DISTRIBUTING) {
    528        1.1      yamt 				api.api_flags |= AGRPORTINFO_DISTRIBUTING;
    529        1.1      yamt 			}
    530        1.1      yamt 			error = copyout(&api, cp, sizeof(api));
    531        1.1      yamt 			if (error) {
    532        1.1      yamt 				return error;
    533        1.1      yamt 			}
    534        1.1      yamt 			cp += sizeof(api);
    535        1.1      yamt 		}
    536        1.1      yamt 		bufleft -= sizeof(api);
    537        1.1      yamt 	}
    538        1.1      yamt 
    539        1.1      yamt 	if (cp == NULL) {
    540        1.1      yamt 		ar->ar_buflen = -bufleft; /* necessary buffer size */
    541        1.1      yamt 	}
    542        1.1      yamt 
    543        1.1      yamt 	return 0;
    544        1.1      yamt }
    545        1.1      yamt 
    546        1.1      yamt static int
    547  1.20.10.3      yamt agr_getconfig(struct agr_softc *sc, struct agrreq *ar)
    548        1.1      yamt {
    549        1.1      yamt 	int cmd = ar->ar_cmd;
    550        1.1      yamt 	int error;
    551        1.1      yamt 
    552  1.20.10.3      yamt 	(void)agr_ports_enter(sc);
    553        1.1      yamt 	switch (cmd) {
    554        1.1      yamt 	case AGRCMD_PORTLIST:
    555  1.20.10.3      yamt 		error = agr_getportlist(sc, ar);
    556        1.1      yamt 		break;
    557        1.1      yamt 
    558        1.1      yamt 	default:
    559        1.1      yamt 		error = EINVAL;
    560        1.1      yamt 		break;
    561        1.1      yamt 	}
    562  1.20.10.3      yamt 	agr_ports_exit(sc);
    563        1.1      yamt 
    564        1.1      yamt 	return error;
    565        1.1      yamt }
    566        1.1      yamt 
    567        1.1      yamt static int
    568        1.1      yamt agr_addport(struct ifnet *ifp, struct ifnet *ifp_port)
    569        1.1      yamt {
    570       1.20    dyoung 	const struct ifaddr *ifa;
    571        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
    572        1.1      yamt 	struct agr_port *port = NULL;
    573        1.1      yamt 	int error = 0;
    574        1.1      yamt 
    575        1.1      yamt 	if (ifp_port->if_ioctl == NULL) {
    576        1.1      yamt 		error = EOPNOTSUPP;
    577        1.1      yamt 		goto out;
    578        1.1      yamt 	}
    579        1.1      yamt 
    580        1.1      yamt 	if (ifp_port->if_agrprivate) {
    581        1.1      yamt 		error = EBUSY;
    582        1.1      yamt 		goto out;
    583        1.1      yamt 	}
    584        1.1      yamt 
    585        1.1      yamt 	if (ifp_port->if_start == agr_start) {
    586        1.1      yamt 		error = EINVAL;
    587        1.1      yamt 		goto out;
    588        1.1      yamt 	}
    589        1.1      yamt 
    590        1.1      yamt 	port = malloc(sizeof(*port) + ifp_port->if_addrlen, M_DEVBUF,
    591        1.1      yamt 	    M_WAITOK | M_ZERO);
    592        1.1      yamt 	if (port == NULL) {
    593        1.1      yamt 		error = ENOMEM;
    594        1.1      yamt 		goto out;
    595        1.1      yamt 	}
    596        1.1      yamt 	port->port_flags = AGRPORT_LARVAL;
    597        1.1      yamt 
    598       1.20    dyoung 	IFADDR_FOREACH(ifa, ifp_port) {
    599       1.20    dyoung 		if (ifa->ifa_addr->sa_family != AF_LINK) {
    600       1.20    dyoung 			error = EBUSY;
    601       1.20    dyoung 			goto out;
    602       1.20    dyoung 		}
    603        1.1      yamt 	}
    604        1.1      yamt 
    605        1.1      yamt 	if (sc->sc_nports == 0) {
    606        1.1      yamt 		switch (ifp_port->if_type) {
    607        1.1      yamt 		case IFT_ETHER:
    608        1.1      yamt 			sc->sc_iftop = &agrether_ops;
    609        1.1      yamt 			break;
    610        1.1      yamt 
    611        1.1      yamt 		default:
    612        1.1      yamt 			error = EPROTONOSUPPORT; /* XXX */
    613        1.1      yamt 			goto out;
    614        1.1      yamt 		}
    615        1.1      yamt 
    616        1.1      yamt 		error = (*sc->sc_iftop->iftop_ctor)(sc, ifp_port);
    617        1.1      yamt 		if (error)
    618        1.1      yamt 			goto out;
    619        1.1      yamt 		agrtimer_start(sc);
    620        1.1      yamt 	} else {
    621        1.1      yamt 		if (ifp->if_type != ifp_port->if_type) {
    622        1.1      yamt 			error = EINVAL;
    623        1.1      yamt 			goto out;
    624        1.1      yamt 		}
    625        1.1      yamt 		if (ifp->if_addrlen != ifp_port->if_addrlen) {
    626        1.1      yamt 			error = EINVAL;
    627        1.1      yamt 			goto out;
    628        1.1      yamt 		}
    629        1.1      yamt 	}
    630        1.1      yamt 
    631       1.14    dyoung 	memcpy(port->port_origlladdr, CLLADDR(ifp_port->if_sadl),
    632        1.1      yamt 	    ifp_port->if_addrlen);
    633        1.1      yamt 
    634        1.1      yamt 	/*
    635        1.1      yamt 	 * start to modify ifp_port.
    636        1.1      yamt 	 */
    637        1.1      yamt 
    638  1.20.10.2      yamt 	/*
    639  1.20.10.2      yamt 	 * XXX this should probably be SIOCALIFADDR but that doesn't
    640  1.20.10.2      yamt 	 * appear to work (ENOTTY). We want to change the mac address
    641  1.20.10.2      yamt 	 * of each port to that of the first port. No need for arps
    642  1.20.10.2      yamt 	 * since there are no inet addresses assigned to the ports.
    643  1.20.10.2      yamt 	 */
    644  1.20.10.1      yamt 	error = (*ifp_port->if_ioctl)(ifp_port, SIOCINITIFADDR, ifp->if_dl);
    645        1.1      yamt 
    646        1.1      yamt 	if (error) {
    647  1.20.10.1      yamt 		printf("%s: SIOCINITIFADDR error %d\n", __func__, error);
    648        1.1      yamt 		goto cleanup;
    649        1.1      yamt 	}
    650        1.1      yamt 	port->port_flags |= AGRPORT_LADDRCHANGED;
    651        1.1      yamt 
    652        1.1      yamt 	ifp->if_type = ifp_port->if_type;
    653       1.12      yamt 	AGR_LOCK(sc);
    654        1.1      yamt 
    655        1.1      yamt 	port->port_ifp = ifp_port;
    656        1.1      yamt 	ifp_port->if_agrprivate = port;
    657        1.1      yamt 	port->port_agrifp = ifp;
    658        1.1      yamt 	TAILQ_INSERT_TAIL(&sc->sc_ports, port, port_q);
    659        1.1      yamt 	sc->sc_nports++;
    660        1.1      yamt 
    661        1.1      yamt 	port->port_ioctl = ifp_port->if_ioctl;
    662        1.1      yamt 	ifp_port->if_ioctl = agr_ioctl_filter;
    663        1.1      yamt 
    664        1.1      yamt 	port->port_flags |= AGRPORT_ATTACHED;
    665        1.1      yamt 
    666       1.12      yamt 	AGR_UNLOCK(sc);
    667        1.1      yamt 
    668        1.1      yamt 	error = (*sc->sc_iftop->iftop_portinit)(sc, port);
    669        1.1      yamt 	if (error) {
    670        1.1      yamt 		printf("%s: portinit error %d\n", __func__, error);
    671        1.1      yamt 		goto cleanup;
    672        1.1      yamt 	}
    673        1.1      yamt 
    674        1.1      yamt 	ifp->if_flags |= IFF_RUNNING;
    675        1.1      yamt 
    676        1.1      yamt 	agrport_config_promisc(port, (ifp->if_flags & IFF_PROMISC) != 0);
    677       1.10   thorpej 	error = (*sc->sc_iftop->iftop_configmulti_port)(sc, port, true);
    678        1.1      yamt 	if (error) {
    679        1.1      yamt 		printf("%s: configmulti error %d\n", __func__, error);
    680        1.1      yamt 		goto cleanup;
    681        1.1      yamt 	}
    682        1.1      yamt 
    683       1.12      yamt 	AGR_LOCK(sc);
    684        1.1      yamt 	port->port_flags &= ~AGRPORT_LARVAL;
    685       1.12      yamt 	AGR_UNLOCK(sc);
    686        1.1      yamt out:
    687        1.1      yamt 	if (error && port) {
    688        1.1      yamt 		free(port, M_DEVBUF);
    689        1.1      yamt 	}
    690        1.1      yamt 	return error;
    691        1.1      yamt 
    692        1.1      yamt cleanup:
    693        1.1      yamt 	if (agrport_cleanup(sc, port)) {
    694        1.1      yamt 		printf("%s: error on cleanup\n", __func__);
    695        1.1      yamt 
    696        1.1      yamt 		port = NULL; /* XXX */
    697        1.1      yamt 	}
    698        1.1      yamt 
    699        1.1      yamt 	if (sc->sc_nports == 0) {
    700        1.1      yamt 		KASSERT(TAILQ_EMPTY(&sc->sc_ports));
    701        1.1      yamt 		agrtimer_stop(sc);
    702        1.1      yamt 		(*sc->sc_iftop->iftop_dtor)(sc);
    703        1.1      yamt 		sc->sc_iftop = NULL;
    704        1.1      yamt 		agr_reset_iftype(ifp);
    705        1.1      yamt 	} else {
    706        1.1      yamt 		KASSERT(!TAILQ_EMPTY(&sc->sc_ports));
    707        1.1      yamt 	}
    708        1.1      yamt 
    709        1.1      yamt 	goto out;
    710        1.1      yamt }
    711        1.1      yamt 
    712        1.1      yamt static int
    713        1.1      yamt agr_remport(struct ifnet *ifp, struct ifnet *ifp_port)
    714        1.1      yamt {
    715        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
    716        1.1      yamt 	struct agr_port *port;
    717        1.1      yamt 	int error = 0;
    718        1.1      yamt 
    719        1.1      yamt 	if (ifp_port->if_agrprivate == NULL) {
    720        1.1      yamt 		error = ENOENT;
    721        1.1      yamt 		return error;
    722        1.1      yamt 	}
    723        1.1      yamt 
    724        1.1      yamt 	port = ifp_port->if_agrprivate;
    725        1.1      yamt 	if (port->port_agrifp != ifp) {
    726        1.1      yamt 		error = EINVAL;
    727        1.1      yamt 		return error;
    728        1.1      yamt 	}
    729        1.1      yamt 
    730        1.1      yamt 	KASSERT(sc->sc_nports > 0);
    731        1.1      yamt 
    732       1.12      yamt 	AGR_LOCK(sc);
    733        1.1      yamt 	port->port_flags |= AGRPORT_DETACHING;
    734       1.12      yamt 	AGR_UNLOCK(sc);
    735        1.1      yamt 
    736        1.1      yamt 	error = (*sc->sc_iftop->iftop_portfini)(sc, port);
    737        1.1      yamt 	if (error) {
    738        1.1      yamt 		/* XXX XXX */
    739        1.1      yamt 		printf("%s: portfini error %d\n", __func__, error);
    740        1.1      yamt 		goto out;
    741        1.1      yamt 	}
    742        1.1      yamt 
    743       1.10   thorpej 	error = (*sc->sc_iftop->iftop_configmulti_port)(sc, port, false);
    744        1.1      yamt 	if (error) {
    745        1.1      yamt 		/* XXX XXX */
    746        1.1      yamt 		printf("%s: configmulti_port error %d\n", __func__, error);
    747        1.1      yamt 		goto out;
    748        1.1      yamt 	}
    749        1.1      yamt 
    750        1.1      yamt 	error = agrport_cleanup(sc, port);
    751        1.1      yamt 	if (error) {
    752        1.1      yamt 		/* XXX XXX */
    753        1.1      yamt 		printf("%s: agrport_cleanup error %d\n", __func__, error);
    754        1.1      yamt 		goto out;
    755        1.1      yamt 	}
    756        1.1      yamt 
    757        1.1      yamt 	free(port, M_DEVBUF);
    758        1.1      yamt 
    759        1.1      yamt out:
    760        1.1      yamt 	if (sc->sc_nports == 0) {
    761        1.1      yamt 		KASSERT(TAILQ_EMPTY(&sc->sc_ports));
    762        1.1      yamt 		agrtimer_stop(sc);
    763        1.1      yamt 		(*sc->sc_iftop->iftop_dtor)(sc);
    764        1.1      yamt 		sc->sc_iftop = NULL;
    765        1.1      yamt 		/* XXX should purge all addresses? */
    766        1.1      yamt 		agr_reset_iftype(ifp);
    767        1.1      yamt 	} else {
    768        1.1      yamt 		KASSERT(!TAILQ_EMPTY(&sc->sc_ports));
    769        1.1      yamt 	}
    770        1.1      yamt 
    771        1.1      yamt 	return error;
    772        1.1      yamt }
    773        1.1      yamt 
    774        1.1      yamt static int
    775        1.1      yamt agrport_cleanup(struct agr_softc *sc, struct agr_port *port)
    776        1.1      yamt {
    777        1.1      yamt 	struct ifnet *ifp_port = port->port_ifp;
    778        1.1      yamt 	int error;
    779        1.1      yamt 	int result = 0;
    780        1.1      yamt 
    781       1.10   thorpej 	error = agrport_config_promisc(port, false);
    782        1.1      yamt 	if (error) {
    783        1.1      yamt 		printf("%s: config_promisc error %d\n", __func__, error);
    784        1.1      yamt 		result = error;
    785        1.1      yamt 	}
    786        1.1      yamt 
    787        1.1      yamt 	if ((port->port_flags & AGRPORT_LADDRCHANGED)) {
    788        1.1      yamt #if 0
    789        1.1      yamt 		memcpy(LLADDR(ifp_port->if_sadl), port->port_origlladdr,
    790        1.1      yamt 		    ifp_port->if_addrlen);
    791        1.1      yamt 		if (ifp_port->if_init != NULL) {
    792        1.1      yamt 			error = (*ifp_port->if_init)(ifp_port);
    793        1.1      yamt 		}
    794        1.1      yamt #else
    795       1.16    dyoung 		union {
    796       1.16    dyoung 			struct sockaddr sa;
    797       1.16    dyoung 			struct sockaddr_dl sdl;
    798       1.16    dyoung 			struct sockaddr_storage ss;
    799       1.16    dyoung 		} u;
    800        1.1      yamt 		struct ifaddr ifa;
    801        1.1      yamt 
    802       1.16    dyoung 		sockaddr_dl_init(&u.sdl, sizeof(u.ss),
    803       1.16    dyoung 		    0, ifp_port->if_type, NULL, 0,
    804       1.16    dyoung 		    port->port_origlladdr, ifp_port->if_addrlen);
    805       1.16    dyoung 		memset(&ifa, 0, sizeof(ifa));
    806       1.16    dyoung 		ifa.ifa_addr = &u.sa;
    807  1.20.10.1      yamt 		error = agrport_ioctl(port, SIOCINITIFADDR, &ifa);
    808        1.1      yamt #endif
    809        1.1      yamt 		if (error) {
    810        1.1      yamt 			printf("%s: if_init error %d\n", __func__, error);
    811        1.1      yamt 			result = error;
    812        1.1      yamt 		} else {
    813        1.1      yamt 			port->port_flags &= ~AGRPORT_LADDRCHANGED;
    814        1.1      yamt 		}
    815        1.1      yamt 	}
    816        1.1      yamt 
    817       1.12      yamt 	AGR_LOCK(sc);
    818        1.1      yamt 	if ((port->port_flags & AGRPORT_ATTACHED)) {
    819        1.1      yamt 		ifp_port->if_agrprivate = NULL;
    820        1.1      yamt 
    821        1.1      yamt 		TAILQ_REMOVE(&sc->sc_ports, port, port_q);
    822        1.1      yamt 		sc->sc_nports--;
    823        1.1      yamt 
    824        1.1      yamt 		KASSERT(ifp_port->if_ioctl == agr_ioctl_filter);
    825        1.1      yamt 		ifp_port->if_ioctl = port->port_ioctl;
    826        1.1      yamt 
    827        1.1      yamt 		port->port_flags &= ~AGRPORT_ATTACHED;
    828        1.1      yamt 	}
    829       1.12      yamt 	AGR_UNLOCK(sc);
    830        1.1      yamt 
    831        1.1      yamt 	return result;
    832        1.1      yamt }
    833        1.1      yamt 
    834        1.1      yamt static int
    835        1.1      yamt agr_ioctl_multi(struct ifnet *ifp, u_long cmd, struct ifreq *ifr)
    836        1.1      yamt {
    837        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
    838        1.1      yamt 	int error;
    839        1.1      yamt 
    840        1.1      yamt 	error = (*sc->sc_iftop->iftop_configmulti_ifreq)(sc, ifr,
    841        1.1      yamt 	    (cmd == SIOCADDMULTI));
    842        1.1      yamt 
    843        1.1      yamt 	return error;
    844        1.1      yamt }
    845        1.1      yamt 
    846  1.20.10.1      yamt /*
    847  1.20.10.1      yamt  * XXX an incomplete hack; can't filter ioctls handled ifioctl().
    848  1.20.10.1      yamt  *
    849  1.20.10.1      yamt  * the intention here is to prevent operations on underlying interfaces
    850  1.20.10.1      yamt  * so that their states are not changed in the way that agr(4) doesn't
    851  1.20.10.1      yamt  * expect.  cf. the BUGS section in the agr(4) manual page.
    852  1.20.10.1      yamt  */
    853        1.1      yamt static int
    854       1.11  christos agr_ioctl_filter(struct ifnet *ifp, u_long cmd, void *arg)
    855        1.1      yamt {
    856        1.1      yamt 	struct agr_port *port = ifp->if_agrprivate;
    857        1.1      yamt 	int error;
    858        1.1      yamt 
    859        1.1      yamt 	KASSERT(port);
    860        1.1      yamt 
    861        1.1      yamt 	switch (cmd) {
    862  1.20.10.1      yamt 	case SIOCADDMULTI: /* add m'cast addr */
    863  1.20.10.1      yamt 	case SIOCAIFADDR: /* add/chg IF alias */
    864  1.20.10.1      yamt 	case SIOCALIFADDR: /* add IF addr */
    865  1.20.10.1      yamt 	case SIOCDELMULTI: /* del m'cast addr */
    866  1.20.10.1      yamt 	case SIOCDIFADDR: /* delete IF addr */
    867  1.20.10.1      yamt 	case SIOCDIFPHYADDR: /* delete gif addrs */
    868  1.20.10.1      yamt 	case SIOCDLIFADDR: /* delete IF addr */
    869  1.20.10.1      yamt 	case SIOCINITIFADDR:
    870  1.20.10.1      yamt 	case SIOCSDRVSPEC: /* set driver-specific parameters */
    871  1.20.10.1      yamt 	case SIOCSIFADDR: /* set ifnet address */
    872  1.20.10.1      yamt 	case SIOCSIFBRDADDR: /* set broadcast addr */
    873  1.20.10.1      yamt 	case SIOCSIFDSTADDR: /* set p-p address */
    874  1.20.10.1      yamt 	case SIOCSIFGENERIC: /* generic IF set op */
    875  1.20.10.1      yamt 	case SIOCSIFMEDIA: /* set net media */
    876  1.20.10.1      yamt 	case SIOCSIFMETRIC: /* set IF metric */
    877  1.20.10.1      yamt 	case SIOCSIFMTU: /* set ifnet mtu */
    878  1.20.10.1      yamt 	case SIOCSIFNETMASK: /* set net addr mask */
    879  1.20.10.1      yamt 	case SIOCSIFPHYADDR: /* set gif addres */
    880  1.20.10.1      yamt 	case SIOCSLIFPHYADDR: /* set gif addrs */
    881  1.20.10.1      yamt 	case SIOCSVH: /* set carp param */
    882  1.20.10.1      yamt 		error = EBUSY;
    883        1.1      yamt 		break;
    884  1.20.10.1      yamt 	case SIOCSIFCAP: /* XXX */
    885  1.20.10.1      yamt 	case SIOCSIFFLAGS: /* XXX */
    886        1.1      yamt 	default:
    887  1.20.10.1      yamt 		error = agrport_ioctl(port, cmd, arg);
    888        1.1      yamt 		break;
    889        1.1      yamt 	}
    890        1.1      yamt 	return error;
    891        1.1      yamt }
    892        1.1      yamt 
    893        1.1      yamt static int
    894        1.1      yamt agrreq_copyin(const void *ubuf, struct agrreq *ar)
    895        1.1      yamt {
    896        1.1      yamt 	int error;
    897        1.1      yamt 
    898        1.1      yamt 	error = copyin(ubuf, ar, sizeof(*ar));
    899        1.1      yamt 	if (error) {
    900        1.1      yamt 		return error;
    901        1.1      yamt 	}
    902        1.1      yamt 
    903        1.1      yamt 	if (ar->ar_version != AGRREQ_VERSION) {
    904        1.1      yamt 		return EINVAL;
    905        1.1      yamt 	}
    906        1.1      yamt 
    907        1.1      yamt 	return 0;
    908        1.1      yamt }
    909        1.1      yamt 
    910        1.1      yamt static int
    911        1.1      yamt agrreq_copyout(void *ubuf, struct agrreq *ar)
    912        1.1      yamt {
    913        1.1      yamt 	int error;
    914        1.1      yamt 
    915        1.1      yamt 	KASSERT(ar->ar_version == AGRREQ_VERSION);
    916        1.1      yamt 
    917        1.1      yamt 	error = copyout(ar, ubuf, sizeof(*ar));
    918        1.1      yamt 	if (error) {
    919        1.1      yamt 		return error;
    920        1.1      yamt 	}
    921        1.1      yamt 
    922        1.1      yamt 	return 0;
    923        1.1      yamt }
    924        1.1      yamt 
    925  1.20.10.3      yamt /* Make sure that if any interrupt handlers are out of the softc. */
    926  1.20.10.3      yamt static void
    927  1.20.10.3      yamt agr_sync(void)
    928  1.20.10.3      yamt {
    929  1.20.10.3      yamt 	uint64_t h;
    930  1.20.10.3      yamt 
    931  1.20.10.3      yamt 	if (!mp_online)
    932  1.20.10.3      yamt 		return;
    933  1.20.10.3      yamt 
    934  1.20.10.3      yamt 	h = xc_broadcast(0, (xcfunc_t)nullop, NULL, NULL);
    935  1.20.10.3      yamt 	xc_wait(h);
    936  1.20.10.3      yamt }
    937  1.20.10.3      yamt 
    938        1.1      yamt static int
    939  1.20.10.3      yamt agr_pause(struct agr_softc *sc)
    940  1.20.10.3      yamt {
    941  1.20.10.3      yamt 	int error;
    942  1.20.10.3      yamt 
    943  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
    944  1.20.10.3      yamt 	if ((error = sc->sc_noentry) != 0)
    945  1.20.10.3      yamt 		goto out;
    946  1.20.10.3      yamt 
    947  1.20.10.3      yamt 	sc->sc_noentry = EBUSY;
    948  1.20.10.3      yamt 
    949  1.20.10.3      yamt 	while (sc->sc_insc != 0)
    950  1.20.10.3      yamt 		cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
    951  1.20.10.3      yamt 
    952  1.20.10.3      yamt 	if (sc->sc_nports == 0) {
    953  1.20.10.3      yamt 		sc->sc_noentry = ENXIO;
    954  1.20.10.3      yamt 	} else {
    955  1.20.10.3      yamt 		sc->sc_noentry = 0;
    956  1.20.10.3      yamt 		error = EBUSY;
    957  1.20.10.3      yamt 	}
    958  1.20.10.3      yamt 	cv_broadcast(&sc->sc_insc_cv);
    959  1.20.10.3      yamt out:
    960  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
    961  1.20.10.3      yamt 	return error;
    962  1.20.10.3      yamt }
    963  1.20.10.3      yamt 
    964  1.20.10.3      yamt static void
    965  1.20.10.3      yamt agr_evacuate(struct agr_softc *sc)
    966  1.20.10.3      yamt {
    967  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
    968  1.20.10.3      yamt 	cv_broadcast(&sc->sc_insc_cv);
    969  1.20.10.3      yamt 	while (sc->sc_insc != 0 || sc->sc_paused != 0)
    970  1.20.10.3      yamt 		cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
    971  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
    972  1.20.10.3      yamt 
    973  1.20.10.3      yamt 	agr_sync();
    974  1.20.10.3      yamt }
    975  1.20.10.3      yamt 
    976  1.20.10.3      yamt static int
    977  1.20.10.3      yamt agr_enter(struct agr_softc *sc)
    978  1.20.10.3      yamt {
    979  1.20.10.3      yamt 	int error;
    980  1.20.10.3      yamt 
    981  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
    982  1.20.10.3      yamt 	sc->sc_paused++;
    983  1.20.10.3      yamt 	while ((error = sc->sc_noentry) == EBUSY)
    984  1.20.10.3      yamt 		cv_wait(&sc->sc_insc_cv, &sc->sc_entry_mtx);
    985  1.20.10.3      yamt 	sc->sc_paused--;
    986  1.20.10.3      yamt 	if (error == 0)
    987  1.20.10.3      yamt 		sc->sc_insc++;
    988  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
    989  1.20.10.3      yamt 
    990  1.20.10.3      yamt 	return error;
    991  1.20.10.3      yamt }
    992  1.20.10.3      yamt 
    993  1.20.10.3      yamt static void
    994  1.20.10.3      yamt agr_exit(struct agr_softc *sc)
    995  1.20.10.3      yamt {
    996  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
    997  1.20.10.3      yamt 	if (--sc->sc_insc == 0)
    998  1.20.10.3      yamt 		cv_signal(&sc->sc_insc_cv);
    999  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
   1000  1.20.10.3      yamt }
   1001  1.20.10.3      yamt 
   1002  1.20.10.3      yamt static bool
   1003  1.20.10.3      yamt agr_ports_enter(struct agr_softc *sc)
   1004  1.20.10.3      yamt {
   1005  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
   1006  1.20.10.4      yamt 	while (sc->sc_wrports)
   1007  1.20.10.3      yamt 		cv_wait(&sc->sc_ports_cv, &sc->sc_entry_mtx);
   1008  1.20.10.3      yamt 	sc->sc_rdports++;
   1009  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
   1010  1.20.10.3      yamt 
   1011  1.20.10.3      yamt 	return true;
   1012  1.20.10.3      yamt }
   1013  1.20.10.3      yamt 
   1014  1.20.10.3      yamt static void
   1015  1.20.10.3      yamt agr_ports_exit(struct agr_softc *sc)
   1016  1.20.10.3      yamt {
   1017  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
   1018  1.20.10.3      yamt 	if (--sc->sc_rdports == 0)
   1019  1.20.10.3      yamt 		cv_signal(&sc->sc_ports_cv);
   1020  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
   1021  1.20.10.3      yamt }
   1022  1.20.10.3      yamt 
   1023  1.20.10.3      yamt static void
   1024  1.20.10.3      yamt agr_ports_lock(struct agr_softc *sc)
   1025  1.20.10.3      yamt {
   1026  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
   1027  1.20.10.3      yamt 	while (sc->sc_rdports != 0)
   1028  1.20.10.3      yamt 		cv_wait(&sc->sc_ports_cv, &sc->sc_entry_mtx);
   1029  1.20.10.3      yamt 	sc->sc_wrports = true;
   1030  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
   1031  1.20.10.3      yamt }
   1032  1.20.10.3      yamt 
   1033  1.20.10.3      yamt static void
   1034  1.20.10.3      yamt agr_ports_unlock(struct agr_softc *sc)
   1035  1.20.10.3      yamt {
   1036  1.20.10.3      yamt 	mutex_enter(&sc->sc_entry_mtx);
   1037  1.20.10.3      yamt 	sc->sc_wrports = false;
   1038  1.20.10.3      yamt 	cv_signal(&sc->sc_ports_cv);
   1039  1.20.10.3      yamt 	mutex_exit(&sc->sc_entry_mtx);
   1040  1.20.10.3      yamt }
   1041  1.20.10.3      yamt 
   1042  1.20.10.3      yamt static int
   1043  1.20.10.3      yamt agr_ioctl(struct ifnet *ifp, const u_long cmd, void *data)
   1044        1.1      yamt {
   1045        1.1      yamt 	struct agr_softc *sc = ifp->if_softc;
   1046        1.1      yamt 	struct ifreq *ifr = (struct ifreq *)data;
   1047        1.1      yamt 	struct ifaddr *ifa = (struct ifaddr *)data;
   1048        1.1      yamt 	struct agrreq ar;
   1049  1.20.10.3      yamt 	int error;
   1050  1.20.10.3      yamt 	bool in_ports = false;
   1051        1.1      yamt 	int s;
   1052        1.1      yamt 
   1053  1.20.10.3      yamt 	if ((error = agr_enter(sc)) != 0)
   1054  1.20.10.3      yamt 		return error;
   1055        1.1      yamt 
   1056        1.1      yamt 	s = splnet();
   1057        1.1      yamt 
   1058        1.1      yamt 	switch (cmd) {
   1059  1.20.10.1      yamt 	case SIOCINITIFADDR:
   1060  1.20.10.3      yamt 		in_ports = agr_ports_enter(sc);
   1061        1.1      yamt 		if (sc->sc_nports == 0) {
   1062        1.1      yamt 			error = EINVAL;
   1063        1.1      yamt 			break;
   1064        1.1      yamt 		}
   1065        1.1      yamt 		ifp->if_flags |= IFF_UP;
   1066        1.1      yamt 		switch (ifa->ifa_addr->sa_family) {
   1067        1.1      yamt #if defined(INET)
   1068        1.1      yamt 		case AF_INET:
   1069        1.1      yamt 			arp_ifinit(ifp, ifa);
   1070        1.1      yamt 			break;
   1071        1.1      yamt #endif
   1072        1.1      yamt 		default:
   1073        1.1      yamt 			break;
   1074        1.1      yamt 		}
   1075        1.1      yamt 		break;
   1076        1.1      yamt 
   1077        1.1      yamt #if 0 /* notyet */
   1078        1.1      yamt 	case SIOCSIFMTU:
   1079        1.1      yamt #endif
   1080        1.1      yamt 
   1081        1.1      yamt 	case SIOCSIFFLAGS:
   1082  1.20.10.2      yamt 		/*
   1083  1.20.10.2      yamt 		 * Check for a change in vlan status.  This ioctl is the
   1084  1.20.10.2      yamt 		 * only way we can tell that a vlan has attached or detached.
   1085  1.20.10.2      yamt 		 * Note the agr interface must be up.
   1086  1.20.10.2      yamt 		 */
   1087  1.20.10.2      yamt 		agr_vlan_check(ifp, sc);
   1088  1.20.10.2      yamt 
   1089  1.20.10.1      yamt 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
   1090  1.20.10.1      yamt 			break;
   1091        1.1      yamt 		agr_config_promisc(sc);
   1092        1.1      yamt 		break;
   1093        1.1      yamt 
   1094        1.1      yamt 	case SIOCSETAGR:
   1095        1.1      yamt 		splx(s);
   1096       1.18      elad 		error = kauth_authorize_network(kauth_cred_get(),
   1097        1.7      elad 		    KAUTH_NETWORK_INTERFACE,
   1098        1.7      elad 		    KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
   1099        1.7      elad 		    NULL);
   1100        1.1      yamt 		if (!error) {
   1101        1.1      yamt 			error = agrreq_copyin(ifr->ifr_data, &ar);
   1102        1.1      yamt 		}
   1103        1.1      yamt 		if (!error) {
   1104  1.20.10.3      yamt 			error = agr_setconfig(sc, &ar);
   1105        1.1      yamt 		}
   1106        1.1      yamt 		s = splnet();
   1107        1.1      yamt 		break;
   1108        1.1      yamt 
   1109        1.1      yamt 	case SIOCGETAGR:
   1110        1.1      yamt 		splx(s);
   1111        1.1      yamt 		error = agrreq_copyin(ifr->ifr_data, &ar);
   1112        1.1      yamt 		if (!error) {
   1113  1.20.10.3      yamt 			error = agr_getconfig(sc, &ar);
   1114        1.1      yamt 		}
   1115        1.1      yamt 		if (!error) {
   1116        1.1      yamt 			error = agrreq_copyout(ifr->ifr_data, &ar);
   1117        1.1      yamt 		}
   1118        1.1      yamt 		s = splnet();
   1119        1.1      yamt 		break;
   1120        1.1      yamt 
   1121        1.1      yamt 	case SIOCADDMULTI:
   1122        1.1      yamt 	case SIOCDELMULTI:
   1123  1.20.10.3      yamt 		in_ports = agr_ports_enter(sc);
   1124  1.20.10.3      yamt 		if (sc->sc_nports == 0)
   1125        1.1      yamt 			error = EINVAL;
   1126  1.20.10.3      yamt 		else
   1127  1.20.10.3      yamt 			error = agr_ioctl_multi(ifp, cmd, ifr);
   1128        1.1      yamt 		break;
   1129        1.1      yamt 
   1130        1.1      yamt 	default:
   1131  1.20.10.1      yamt 		error = ifioctl_common(ifp, cmd, data);
   1132        1.1      yamt 		break;
   1133        1.1      yamt 	}
   1134        1.1      yamt 
   1135  1.20.10.3      yamt 	if (in_ports)
   1136  1.20.10.3      yamt 		agr_ports_exit(sc);
   1137  1.20.10.3      yamt 
   1138        1.1      yamt 	splx(s);
   1139        1.1      yamt 
   1140  1.20.10.3      yamt 	agr_exit(sc);
   1141        1.1      yamt 
   1142        1.1      yamt 	return error;
   1143        1.1      yamt }
   1144        1.1      yamt 
   1145        1.1      yamt static int
   1146        1.1      yamt agr_config_promisc(struct agr_softc *sc)
   1147        1.1      yamt {
   1148        1.1      yamt 	int error;
   1149        1.1      yamt 
   1150        1.1      yamt 	agr_port_foreach(sc, agrport_config_promisc_callback, &error);
   1151        1.1      yamt 
   1152        1.1      yamt 	return error;
   1153        1.1      yamt }
   1154        1.1      yamt 
   1155        1.1      yamt static int
   1156        1.1      yamt agrport_config_promisc_callback(struct agr_port *port, void *arg)
   1157        1.1      yamt {
   1158        1.1      yamt 	struct agr_softc *sc = AGR_SC_FROM_PORT(port);
   1159        1.1      yamt 	int *errorp = arg;
   1160        1.1      yamt 	int error;
   1161        1.9   thorpej 	bool promisc;
   1162        1.1      yamt 
   1163        1.1      yamt 	promisc = (sc->sc_if.if_flags & IFF_PROMISC) != 0;
   1164        1.1      yamt 
   1165        1.1      yamt 	error = agrport_config_promisc(port, promisc);
   1166        1.1      yamt 	if (error) {
   1167        1.1      yamt 		*errorp = error;
   1168        1.1      yamt 	}
   1169        1.1      yamt 
   1170        1.1      yamt 	return 0;
   1171        1.1      yamt }
   1172        1.1      yamt 
   1173        1.1      yamt static int
   1174        1.9   thorpej agrport_config_promisc(struct agr_port *port, bool promisc)
   1175        1.1      yamt {
   1176        1.1      yamt 	int error;
   1177        1.1      yamt 
   1178        1.1      yamt 	if (( promisc && (port->port_flags & AGRPORT_PROMISC) != 0) ||
   1179        1.1      yamt 	    (!promisc && (port->port_flags & AGRPORT_PROMISC) == 0)) {
   1180        1.1      yamt 		return 0;
   1181        1.1      yamt 	}
   1182        1.1      yamt 
   1183        1.1      yamt 	error = ifpromisc(port->port_ifp, promisc);
   1184        1.1      yamt 	if (error == 0) {
   1185        1.1      yamt 		if (promisc) {
   1186        1.1      yamt 			port->port_flags |= AGRPORT_PROMISC;
   1187        1.1      yamt 		} else {
   1188        1.1      yamt 			port->port_flags &= ~AGRPORT_PROMISC;
   1189        1.1      yamt 		}
   1190        1.1      yamt 	}
   1191        1.1      yamt 
   1192        1.1      yamt 	return error;
   1193        1.1      yamt }
   1194