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