#include "opt_inet.h"
#include "opt_inet6.h"
#include <sys/param.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/protosw.h>
#include <sys/systm.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/ctype.h>
#include <sys/kernel.h>
#include <sys/random.h>
#include <sys/sysctl.h>
#include <sys/module.h>
#include <sys/proc.h>
#include <sys/caps.h>
#include <sys/lock.h>
#include <sys/thread.h>
#include <sys/thread2.h>
#include <sys/mpipe.h>
#include <net/bpf.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/if_var.h>
#include <net/pfil.h>
#include <net/ifq_var.h>
#include <net/if_clone.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/ip_var.h>
#ifdef INET6
#include <netinet/ip6.h>
#include <netinet6/ip6_var.h>
#endif
#include <netinet/if_ether.h>
#include <net/bridge/if_bridgevar.h>
#include <net/if_llc.h>
#include <net/netmsg2.h>
#include <net/netisr2.h>
#include <net/route.h>
#include <sys/in_cksum.h>
#ifndef BRIDGE_RTHASH_SIZE
#define BRIDGE_RTHASH_SIZE 1024
#endif
#define BRIDGE_RTHASH_MASK (BRIDGE_RTHASH_SIZE - 1)
#ifndef BRIDGE_RTABLE_MAX
#define BRIDGE_RTABLE_MAX 4096
#endif
#define BSTP_DEFAULT_MAX_AGE (20 * 256)
#define BSTP_DEFAULT_HELLO_TIME (2 * 256)
#define BSTP_DEFAULT_FORWARD_DELAY (15 * 256)
#define BSTP_DEFAULT_HOLD_TIME (1 * 256)
#define BSTP_DEFAULT_BRIDGE_PRIORITY 0x8000
#define BSTP_DEFAULT_PORT_PRIORITY 0x80
#define BSTP_DEFAULT_PATH_COST 55
#ifndef BRIDGE_RTABLE_TIMEOUT
#define BRIDGE_RTABLE_TIMEOUT (20 * 60)
#endif
#ifndef BRIDGE_RTABLE_PRUNE_PERIOD
#define BRIDGE_RTABLE_PRUNE_PERIOD (5 * 60)
#endif
#define BRIDGE_IFCAPS_MASK (IFCAP_TXCSUM | IFCAP_TSO)
typedef int (*bridge_ctl_t)(struct bridge_softc *, void *);
struct netmsg_brctl {
struct netmsg_base base;
bridge_ctl_t bc_func;
struct bridge_softc *bc_sc;
void *bc_arg;
};
struct netmsg_brsaddr {
struct netmsg_base base;
struct bridge_softc *br_softc;
struct ifnet *br_dst_if;
struct bridge_rtinfo *br_rtinfo;
int br_setflags;
uint8_t br_dst[ETHER_ADDR_LEN];
uint8_t br_flags;
};
struct netmsg_braddbif {
struct netmsg_base base;
struct bridge_softc *br_softc;
struct bridge_ifinfo *br_bif_info;
struct ifnet *br_bif_ifp;
};
struct netmsg_brdelbif {
struct netmsg_base base;
struct bridge_softc *br_softc;
struct bridge_ifinfo *br_bif_info;
struct bridge_iflist_head *br_bif_list;
};
struct netmsg_brsflags {
struct netmsg_base base;
struct bridge_softc *br_softc;
struct bridge_ifinfo *br_bif_info;
uint32_t br_bif_flags;
};
eventhandler_tag bridge_detach_cookie = NULL;
extern struct mbuf *(*bridge_input_p)(struct ifnet *, struct mbuf *);
extern int (*bridge_output_p)(struct ifnet *, struct mbuf *);
extern void (*bridge_dn_p)(struct mbuf *, struct ifnet *);
extern struct ifnet *(*bridge_interface_p)(void *if_bridge);
static int bridge_rtable_prune_period = BRIDGE_RTABLE_PRUNE_PERIOD;
static int bridge_clone_create(struct if_clone *, int, caddr_t, caddr_t);
static int bridge_clone_destroy(struct ifnet *);
static int bridge_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
static void bridge_mutecaps(struct bridge_ifinfo *, struct ifnet *, int);
static void bridge_ifdetach(void *, struct ifnet *);
static void bridge_init(void *);
static int bridge_from_us(struct bridge_softc *, struct ether_header *);
static void bridge_stop(struct ifnet *);
static void bridge_start(struct ifnet *, struct ifaltq_subque *);
static struct mbuf *bridge_input(struct ifnet *, struct mbuf *);
static int bridge_output(struct ifnet *, struct mbuf *);
static struct ifnet *bridge_interface(void *if_bridge);
static void bridge_forward(struct bridge_softc *, struct mbuf *m);
static void bridge_timer_handler(netmsg_t);
static void bridge_timer(void *);
static void bridge_start_bcast(struct bridge_softc *, struct mbuf *);
static void bridge_broadcast(struct bridge_softc *, struct ifnet *,
struct mbuf *);
static void bridge_span(struct bridge_softc *, struct mbuf *);
static int bridge_rtupdate(struct bridge_softc *, const uint8_t *,
struct ifnet *, uint8_t);
static struct ifnet *bridge_rtlookup(struct bridge_softc *, const uint8_t *);
static void bridge_rtreap(struct bridge_softc *);
static void bridge_rtreap_async(struct bridge_softc *);
static void bridge_rttrim(struct bridge_softc *);
static int bridge_rtage_finddead(struct bridge_softc *);
static void bridge_rtage(struct bridge_softc *);
static void bridge_rtflush(struct bridge_softc *, int);
static int bridge_rtdaddr(struct bridge_softc *, const uint8_t *);
static int bridge_rtsaddr(struct bridge_softc *, const uint8_t *,
struct ifnet *, uint8_t);
static void bridge_rtmsg_sync(struct bridge_softc *sc);
static void bridge_rtreap_handler(netmsg_t);
static void bridge_rtinstall_handler(netmsg_t);
static int bridge_rtinstall_oncpu(struct bridge_softc *, const uint8_t *,
struct ifnet *, int, uint8_t, struct bridge_rtinfo **);
static void bridge_rtable_init(struct bridge_softc *);
static void bridge_rtable_fini(struct bridge_softc *);
static int bridge_rtnode_addr_cmp(const uint8_t *, const uint8_t *);
static struct bridge_rtnode *bridge_rtnode_lookup(struct bridge_softc *,
const uint8_t *);
static void bridge_rtnode_insert(struct bridge_softc *,
struct bridge_rtnode *);
static void bridge_rtnode_destroy(struct bridge_softc *,
struct bridge_rtnode *);
static struct bridge_iflist *bridge_lookup_member(struct bridge_softc *,
const char *name);
static struct bridge_iflist *bridge_lookup_member_if(struct bridge_softc *,
struct ifnet *ifp);
static struct bridge_iflist *bridge_lookup_member_ifinfo(struct bridge_softc *,
struct bridge_ifinfo *);
static void bridge_delete_member(struct bridge_softc *,
struct bridge_iflist *, int);
static void bridge_delete_span(struct bridge_softc *,
struct bridge_iflist *);
static int bridge_control(struct bridge_softc *, u_long,
bridge_ctl_t, void *);
static int bridge_ioctl_init(struct bridge_softc *, void *);
static int bridge_ioctl_stop(struct bridge_softc *, void *);
static int bridge_ioctl_add(struct bridge_softc *, void *);
static int bridge_ioctl_del(struct bridge_softc *, void *);
static void bridge_ioctl_fillflags(struct bridge_softc *sc,
struct bridge_iflist *bif, struct ifbreq *req);
static int bridge_ioctl_gifflags(struct bridge_softc *, void *);
static int bridge_ioctl_sifflags(struct bridge_softc *, void *);
static int bridge_ioctl_scache(struct bridge_softc *, void *);
static int bridge_ioctl_gcache(struct bridge_softc *, void *);
static int bridge_ioctl_gifs(struct bridge_softc *, void *);
static int bridge_ioctl_rts(struct bridge_softc *, void *);
static int bridge_ioctl_saddr(struct bridge_softc *, void *);
static int bridge_ioctl_sto(struct bridge_softc *, void *);
static int bridge_ioctl_gto(struct bridge_softc *, void *);
static int bridge_ioctl_daddr(struct bridge_softc *, void *);
static int bridge_ioctl_flush(struct bridge_softc *, void *);
static int bridge_ioctl_gpri(struct bridge_softc *, void *);
static int bridge_ioctl_spri(struct bridge_softc *, void *);
static int bridge_ioctl_reinit(struct bridge_softc *, void *);
static int bridge_ioctl_ght(struct bridge_softc *, void *);
static int bridge_ioctl_sht(struct bridge_softc *, void *);
static int bridge_ioctl_gfd(struct bridge_softc *, void *);
static int bridge_ioctl_sfd(struct bridge_softc *, void *);
static int bridge_ioctl_gma(struct bridge_softc *, void *);
static int bridge_ioctl_sma(struct bridge_softc *, void *);
static int bridge_ioctl_sifprio(struct bridge_softc *, void *);
static int bridge_ioctl_sifcost(struct bridge_softc *, void *);
static int bridge_ioctl_addspan(struct bridge_softc *, void *);
static int bridge_ioctl_delspan(struct bridge_softc *, void *);
static int bridge_ioctl_sifbondwght(struct bridge_softc *, void *);
static int bridge_pfil(struct mbuf **, struct ifnet *, struct ifnet *,
int);
static int bridge_ip_checkbasic(struct mbuf **mp);
#ifdef INET6
static int bridge_ip6_checkbasic(struct mbuf **mp);
#endif
static int bridge_fragment(struct ifnet *, struct mbuf *,
struct ether_header *, int, struct llc *);
static void bridge_enqueue_handler(netmsg_t);
static void bridge_handoff(struct bridge_softc *, struct ifnet *,
struct mbuf *, int);
static void bridge_del_bif_handler(netmsg_t);
static void bridge_add_bif_handler(netmsg_t);
static void bridge_del_bif(struct bridge_softc *, struct bridge_ifinfo *,
struct bridge_iflist_head *);
static void bridge_add_bif(struct bridge_softc *, struct bridge_ifinfo *,
struct ifnet *);
SYSCTL_DECL(_net_link);
SYSCTL_NODE(_net_link, IFT_BRIDGE, bridge, CTLFLAG_RW, 0, "Bridge");
static int pfil_onlyip = 1;
static int pfil_bridge = 1;
static int pfil_member = 1;
static int bridge_debug;
SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_onlyip, CTLFLAG_RW,
&pfil_onlyip, 0, "Only pass IP packets when pfil is enabled");
SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_bridge, CTLFLAG_RW,
&pfil_bridge, 0, "Packet filter on the bridge interface");
SYSCTL_INT(_net_link_bridge, OID_AUTO, pfil_member, CTLFLAG_RW,
&pfil_member, 0, "Packet filter on the member interface");
SYSCTL_INT(_net_link_bridge, OID_AUTO, debug, CTLFLAG_RW,
&bridge_debug, 0, "Bridge debug mode");
struct bridge_control_arg {
union {
struct ifbreq ifbreq;
struct ifbifconf ifbifconf;
struct ifbareq ifbareq;
struct ifbaconf ifbaconf;
struct ifbrparam ifbrparam;
} bca_u;
int bca_len;
void *bca_uptr;
void *bca_kptr;
};
struct bridge_control {
bridge_ctl_t bc_func;
int bc_argsize;
int bc_flags;
};
#define BC_F_COPYIN 0x01
#define BC_F_COPYOUT 0x02
#define BC_F_SUSER 0x04
const struct bridge_control bridge_control_table[] = {
{ bridge_ioctl_add, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_del, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gifflags, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_COPYOUT },
{ bridge_ioctl_sifflags, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_scache, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gcache, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_gifs, sizeof(struct ifbifconf),
BC_F_COPYIN|BC_F_COPYOUT },
{ bridge_ioctl_rts, sizeof(struct ifbaconf),
BC_F_COPYIN|BC_F_COPYOUT },
{ bridge_ioctl_saddr, sizeof(struct ifbareq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_sto, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gto, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_daddr, sizeof(struct ifbareq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_flush, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gpri, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_spri, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_ght, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_sht, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gfd, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_sfd, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_gma, sizeof(struct ifbrparam),
BC_F_COPYOUT },
{ bridge_ioctl_sma, sizeof(struct ifbrparam),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_sifprio, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_sifcost, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_addspan, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_delspan, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
{ bridge_ioctl_sifbondwght, sizeof(struct ifbreq),
BC_F_COPYIN|BC_F_SUSER },
};
static const int bridge_control_table_size = NELEM(bridge_control_table);
LIST_HEAD(, bridge_softc) bridge_list;
struct if_clone bridge_cloner = IF_CLONE_INITIALIZER("bridge",
bridge_clone_create,
bridge_clone_destroy, 0, IF_MAXUNIT);
static int
bridge_modevent(module_t mod, int type, void *data)
{
switch (type) {
case MOD_LOAD:
LIST_INIT(&bridge_list);
if_clone_attach(&bridge_cloner);
bridge_input_p = bridge_input;
bridge_output_p = bridge_output;
bridge_interface_p = bridge_interface;
bridge_detach_cookie = EVENTHANDLER_REGISTER(
ifnet_detach_event, bridge_ifdetach, NULL,
EVENTHANDLER_PRI_ANY);
#if 0
bstp_linkstate_p = bstp_linkstate;
#endif
break;
case MOD_UNLOAD:
if (!LIST_EMPTY(&bridge_list))
return (EBUSY);
EVENTHANDLER_DEREGISTER(ifnet_detach_event,
bridge_detach_cookie);
if_clone_detach(&bridge_cloner);
bridge_input_p = NULL;
bridge_output_p = NULL;
bridge_interface_p = NULL;
#if 0
bstp_linkstate_p = NULL;
#endif
break;
default:
return (EOPNOTSUPP);
}
return (0);
}
static moduledata_t bridge_mod = {
"if_bridge",
bridge_modevent,
0
};
DECLARE_MODULE(if_bridge, bridge_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
#ifdef BRIDGE_DEBUG_ENABLE
static void
BRIDGE_DEBUG(const char *str, struct ifnet *src_if, struct ifnet *dst_if,
struct mbuf *m)
{
if ((bridge_debug & 2) == 0)
return;
if (str)
kprintf("%s", str);
if (src_if)
kprintf(" src={%s,%s%d}",
src_if->if_xname, src_if->if_dname, src_if->if_dunit);
if (dst_if)
kprintf(" dst={%s,%s%d}",
dst_if->if_xname, dst_if->if_dname, dst_if->if_dunit);
if (m) {
struct ether_header *eh;
struct ip *ip;
eh = mtod(m, struct ether_header *);
kprintf(" %02x:%02x:%02x:%02x:%02x:%02x "
"%02x:%02x:%02x:%02x:%02x:%02x type %04x ",
eh->ether_dhost[0],
eh->ether_dhost[1],
eh->ether_dhost[2],
eh->ether_dhost[3],
eh->ether_dhost[4],
eh->ether_dhost[5],
eh->ether_shost[0],
eh->ether_shost[1],
eh->ether_shost[2],
eh->ether_shost[3],
eh->ether_shost[4],
eh->ether_shost[5],
eh->ether_type);
ip = (void *)(eh + 1);
kprintf("%u.%u.%u.%u -> %u.%u.%u.%u",
(uint8_t)(ip->ip_src.s_addr >> 24),
(uint8_t)(ip->ip_src.s_addr >> 16),
(uint8_t)(ip->ip_src.s_addr >> 8),
(uint8_t)(ip->ip_src.s_addr),
(uint8_t)(ip->ip_dst.s_addr >> 24),
(uint8_t)(ip->ip_dst.s_addr >> 16),
(uint8_t)(ip->ip_dst.s_addr >> 8),
(uint8_t)(ip->ip_dst.s_addr));
kprintf("\n");
}
}
#else
#define BRIDGE_DEBUG(ctl, sif, dif, m)
#endif
static int
bridge_clone_create(struct if_clone *ifc, int unit,
caddr_t params __unused, caddr_t data __unused)
{
struct bridge_softc *sc;
struct ifnet *ifp;
u_char eaddr[6];
int cpu, rnd;
sc = kmalloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
ifp = sc->sc_ifp = &sc->sc_if;
sc->sc_brtmax = BRIDGE_RTABLE_MAX;
sc->sc_brttimeout = BRIDGE_RTABLE_TIMEOUT;
sc->sc_bridge_max_age = BSTP_DEFAULT_MAX_AGE;
sc->sc_bridge_hello_time = BSTP_DEFAULT_HELLO_TIME;
sc->sc_bridge_forward_delay = BSTP_DEFAULT_FORWARD_DELAY;
sc->sc_bridge_priority = BSTP_DEFAULT_BRIDGE_PRIORITY;
sc->sc_hold_time = BSTP_DEFAULT_HOLD_TIME;
bridge_rtable_init(sc);
callout_init_mp(&sc->sc_brcallout);
netmsg_init(&sc->sc_brtimemsg, NULL, &netisr_adone_rport,
MSGF_DROPABLE, bridge_timer_handler);
sc->sc_brtimemsg.lmsg.u.ms_resultp = sc;
callout_init_mp(&sc->sc_bstpcallout);
netmsg_init(&sc->sc_bstptimemsg, NULL, &netisr_adone_rport,
MSGF_DROPABLE, bstp_tick_handler);
sc->sc_bstptimemsg.lmsg.u.ms_resultp = sc;
sc->sc_iflists = kmalloc(sizeof(*sc->sc_iflists) * netisr_ncpus,
M_DEVBUF, M_WAITOK);
for (cpu = 0; cpu < netisr_ncpus; ++cpu)
TAILQ_INIT(&sc->sc_iflists[cpu]);
TAILQ_INIT(&sc->sc_spanlist);
ifp->if_softc = sc;
if_initname(ifp, ifc->ifc_name, unit);
ifp->if_mtu = ETHERMTU;
ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST | IFF_ISBRIDGE;
ifp->if_ioctl = bridge_ioctl;
ifp->if_start = bridge_start;
ifp->if_init = bridge_init;
ifp->if_type = IFT_ETHER;
ifq_set_maxlen(&ifp->if_snd, ifqmaxlen);
ifq_set_ready(&ifp->if_snd);
ifp->if_hdrlen = ETHER_HDR_LEN;
rnd = karc4random();
bcopy(&rnd, &eaddr[0], 4);
rnd = karc4random();
bcopy(&rnd, &eaddr[2], 4);
eaddr[0] &= ~1;
eaddr[0] |= 2;
ether_ifattach(ifp, eaddr, NULL);
ifp->if_baudrate = 0;
crit_enter();
LIST_INSERT_HEAD(&bridge_list, sc, sc_list);
crit_exit();
return (0);
}
static void
bridge_delete_dispatch(netmsg_t msg)
{
struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
struct ifnet *bifp = sc->sc_ifp;
struct bridge_iflist *bif;
ifnet_serialize_all(bifp);
while ((bif = TAILQ_FIRST(&sc->sc_iflists[mycpuid])) != NULL)
bridge_delete_member(sc, bif, 0);
while ((bif = TAILQ_FIRST(&sc->sc_spanlist)) != NULL)
bridge_delete_span(sc, bif);
ifnet_deserialize_all(bifp);
lwkt_replymsg(&msg->lmsg, 0);
}
static int
bridge_clone_destroy(struct ifnet *ifp)
{
struct bridge_softc *sc = ifp->if_softc;
struct netmsg_base msg;
ifnet_serialize_all(ifp);
bridge_stop(ifp);
ifp->if_flags &= ~IFF_UP;
ifnet_deserialize_all(ifp);
netmsg_init(&msg, NULL, &curthread->td_msgport,
0, bridge_delete_dispatch);
msg.lmsg.u.ms_resultp = sc;
lwkt_domsg(BRIDGE_CFGPORT, &msg.lmsg, 0);
crit_enter();
LIST_REMOVE(sc, sc_list);
crit_exit();
ether_ifdetach(ifp);
bridge_rtable_fini(sc);
kfree(sc->sc_iflists, M_DEVBUF);
kfree(sc, M_DEVBUF);
return 0;
}
static int
bridge_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
{
struct bridge_softc *sc = ifp->if_softc;
struct bridge_control_arg args;
struct ifdrv *ifd = (struct ifdrv *) data;
const struct bridge_control *bc;
int error = 0;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
switch (cmd) {
case SIOCADDMULTI:
case SIOCDELMULTI:
break;
case SIOCGDRVSPEC:
case SIOCSDRVSPEC:
if (ifd->ifd_cmd >= bridge_control_table_size) {
error = EINVAL;
break;
}
bc = &bridge_control_table[ifd->ifd_cmd];
if (cmd == SIOCGDRVSPEC &&
(bc->bc_flags & BC_F_COPYOUT) == 0) {
error = EINVAL;
break;
} else if (cmd == SIOCSDRVSPEC &&
(bc->bc_flags & BC_F_COPYOUT)) {
error = EINVAL;
break;
}
if (bc->bc_flags & BC_F_SUSER) {
error = caps_priv_check(cr, SYSCAP_RESTRICTEDROOT |
__SYSCAP_NULLCRED);
if (error)
break;
}
if (ifd->ifd_len != bc->bc_argsize ||
ifd->ifd_len > sizeof(args.bca_u)) {
error = EINVAL;
break;
}
memset(&args, 0, sizeof(args));
if (bc->bc_flags & BC_F_COPYIN) {
error = copyin(ifd->ifd_data, &args.bca_u,
ifd->ifd_len);
if (error)
break;
}
error = bridge_control(sc, cmd, bc->bc_func, &args);
if (error) {
KKASSERT(args.bca_len == 0 && args.bca_kptr == NULL);
break;
}
if (bc->bc_flags & BC_F_COPYOUT) {
error = copyout(&args, ifd->ifd_data, ifd->ifd_len);
if (args.bca_len != 0) {
KKASSERT(args.bca_kptr != NULL);
if (!error) {
error = copyout(args.bca_kptr,
args.bca_uptr, args.bca_len);
}
kfree(args.bca_kptr, M_TEMP);
} else {
KKASSERT(args.bca_kptr == NULL);
}
} else {
KKASSERT(args.bca_len == 0 && args.bca_kptr == NULL);
}
break;
case SIOCSIFFLAGS:
if (!(ifp->if_flags & IFF_UP) &&
(ifp->if_flags & IFF_RUNNING)) {
bridge_stop(ifp);
} else if ((ifp->if_flags & IFF_UP) &&
!(ifp->if_flags & IFF_RUNNING)) {
ifp->if_init(sc);
}
if ((ifp->if_flags & IFF_RUNNING) &&
(ifp->if_flags & (IFF_LINK0|IFF_LINK1|IFF_LINK2)) !=
sc->sc_copy_flags) {
sc->sc_copy_flags = ifp->if_flags &
(IFF_LINK0|IFF_LINK1|IFF_LINK2);
bridge_control(sc, 0, bridge_ioctl_reinit, NULL);
}
break;
case SIOCSIFMTU:
error = EINVAL;
break;
default:
error = ether_ioctl(ifp, cmd, data);
break;
}
return (error);
}
static void
bridge_mutecaps(struct bridge_ifinfo *bif_info, struct ifnet *ifp, int mute)
{
struct ifreq ifr;
if (ifp->if_ioctl == NULL)
return;
bzero(&ifr, sizeof(ifr));
ifr.ifr_reqcap = ifp->if_capenable;
if (mute) {
bif_info->bifi_mutecap = ifr.ifr_reqcap & BRIDGE_IFCAPS_MASK;
if (bif_info->bifi_mutecap != 0)
ifr.ifr_reqcap &= ~BRIDGE_IFCAPS_MASK;
} else {
ifr.ifr_reqcap |= bif_info->bifi_mutecap;
}
if (bif_info->bifi_mutecap != 0) {
ifnet_serialize_all(ifp);
ifp->if_ioctl(ifp, SIOCSIFCAP, (caddr_t)&ifr, NULL);
ifnet_deserialize_all(ifp);
}
}
static struct bridge_iflist *
bridge_lookup_member(struct bridge_softc *sc, const char *name)
{
struct bridge_iflist *bif;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (strcmp(bif->bif_ifp->if_xname, name) == 0)
return (bif);
}
return (NULL);
}
static struct bridge_iflist *
bridge_lookup_member_if(struct bridge_softc *sc, struct ifnet *member_ifp)
{
struct bridge_iflist *bif;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (bif->bif_ifp == member_ifp)
return (bif);
}
return (NULL);
}
static struct bridge_iflist *
bridge_lookup_member_ifinfo(struct bridge_softc *sc,
struct bridge_ifinfo *bif_info)
{
struct bridge_iflist *bif;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (bif->bif_info == bif_info)
return (bif);
}
return (NULL);
}
static void
bridge_delete_member(struct bridge_softc *sc, struct bridge_iflist *bif,
int gone)
{
struct ifnet *ifs = bif->bif_ifp;
struct ifnet *bifp = sc->sc_ifp;
struct bridge_ifinfo *bif_info = bif->bif_info;
struct bridge_iflist_head saved_bifs;
ASSERT_IFNET_SERIALIZED_ALL(bifp);
KKASSERT(bif_info != NULL);
ifs->if_bridge = NULL;
ifnet_deserialize_all(bifp);
if (!gone) {
switch (ifs->if_type) {
case IFT_ETHER:
case IFT_L2VLAN:
ifpromisc(ifs, 0);
bridge_mutecaps(bif_info, ifs, 0);
break;
case IFT_GIF:
break;
default:
panic("bridge_delete_member: impossible");
break;
}
}
TAILQ_INIT(&saved_bifs);
bridge_del_bif(sc, bif_info, &saved_bifs);
netmsg_service_sync();
KKASSERT(!TAILQ_EMPTY(&saved_bifs));
while ((bif = TAILQ_FIRST(&saved_bifs)) != NULL) {
TAILQ_REMOVE(&saved_bifs, bif, bif_next);
kfree(bif, M_DEVBUF);
}
bridge_rtmsg_sync(sc);
bridge_rtdelete(sc, ifs, IFBF_FLUSHALL | IFBF_FLUSHSYNC);
ifnet_serialize_all(bifp);
if (bifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
kfree(bif_info, M_DEVBUF);
}
static void
bridge_delete_span(struct bridge_softc *sc, struct bridge_iflist *bif)
{
KASSERT(bif->bif_ifp->if_bridge == NULL,
("%s: not a span interface", __func__));
TAILQ_REMOVE(&sc->sc_iflists[mycpuid], bif, bif_next);
kfree(bif, M_DEVBUF);
}
static int
bridge_ioctl_init(struct bridge_softc *sc, void *arg __unused)
{
struct ifnet *ifp = sc->sc_ifp;
if (ifp->if_flags & IFF_RUNNING)
return 0;
callout_reset(&sc->sc_brcallout, bridge_rtable_prune_period * hz,
bridge_timer, sc);
ifp->if_flags |= IFF_RUNNING;
bstp_initialization(sc);
return 0;
}
static int
bridge_ioctl_stop(struct bridge_softc *sc, void *arg __unused)
{
struct ifnet *ifp = sc->sc_ifp;
if ((ifp->if_flags & IFF_RUNNING) == 0)
return 0;
callout_stop(&sc->sc_brcallout);
crit_enter();
lwkt_dropmsg(&sc->sc_brtimemsg.lmsg);
crit_exit();
bstp_stop(sc);
ifp->if_flags &= ~IFF_RUNNING;
ifnet_deserialize_all(ifp);
netmsg_service_sync();
bridge_rtmsg_sync(sc);
bridge_rtflush(sc, IFBF_FLUSHDYN | IFBF_FLUSHSYNC);
ifnet_serialize_all(ifp);
return 0;
}
static int
bridge_ioctl_add(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
struct bridge_ifinfo *bif_info;
struct ifnet *ifs, *bifp;
int error = 0;
bifp = sc->sc_ifp;
ASSERT_IFNET_SERIALIZED_ALL(bifp);
ifs = ifunit_netisr(req->ifbr_ifsname);
if (ifs == NULL)
return (ENOENT);
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
if (ifs == bif->bif_ifp)
return (EBUSY);
if (ifs->if_type != IFT_GIF) {
if (TAILQ_EMPTY(&sc->sc_iflists[mycpuid])) {
bifp->if_mtu = ifs->if_mtu;
} else if (bifp->if_mtu != ifs->if_mtu) {
if_printf(bifp, "invalid MTU for %s\n", ifs->if_xname);
return (EINVAL);
}
}
if (ifs->if_bridge == sc)
return (EEXIST);
if (ifs->if_bridge != NULL)
return (EBUSY);
bif_info = kmalloc(sizeof(*bif_info), M_DEVBUF, M_WAITOK | M_ZERO);
bif_info->bifi_priority = BSTP_DEFAULT_PORT_PRIORITY;
bif_info->bifi_path_cost = BSTP_DEFAULT_PATH_COST;
bif_info->bifi_ifp = ifs;
bif_info->bifi_bond_weight = 1;
ifnet_deserialize_all(bifp);
switch (ifs->if_type) {
case IFT_ETHER:
case IFT_L2VLAN:
error = ifpromisc(ifs, 1);
if (error) {
ifnet_serialize_all(bifp);
goto out;
}
bridge_mutecaps(bif_info, ifs, 1);
break;
case IFT_GIF:
break;
default:
error = EINVAL;
ifnet_serialize_all(bifp);
goto out;
}
bridge_add_bif(sc, bif_info, ifs);
ifnet_serialize_all(bifp);
if (bifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
else
bstp_stop(sc);
ifs->if_bridge = sc;
out:
if (error) {
if (bif_info != NULL)
kfree(bif_info, M_DEVBUF);
}
return (error);
}
static int
bridge_ioctl_del(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
bridge_delete_member(sc, bif, 0);
return (0);
}
static int
bridge_ioctl_gifflags(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
bridge_ioctl_fillflags(sc, bif, req);
return (0);
}
static void
bridge_ioctl_fillflags(struct bridge_softc *sc, struct bridge_iflist *bif,
struct ifbreq *req)
{
req->ifbr_ifsflags = bif->bif_flags;
req->ifbr_state = bif->bif_state;
req->ifbr_priority = bif->bif_priority;
req->ifbr_path_cost = bif->bif_path_cost;
req->ifbr_bond_weight = bif->bif_bond_weight;
req->ifbr_portno = bif->bif_ifp->if_index & 0xff;
if (bif->bif_flags & IFBIF_STP) {
req->ifbr_peer_root = bif->bif_peer_root;
req->ifbr_peer_bridge = bif->bif_peer_bridge;
req->ifbr_peer_cost = bif->bif_peer_cost;
req->ifbr_peer_port = bif->bif_peer_port;
if (bstp_supersedes_port_info(sc, bif)) {
req->ifbr_designated_root = bif->bif_peer_root;
req->ifbr_designated_bridge = bif->bif_peer_bridge;
req->ifbr_designated_cost = bif->bif_peer_cost;
req->ifbr_designated_port = bif->bif_peer_port;
} else {
req->ifbr_designated_root = sc->sc_bridge_id;
req->ifbr_designated_bridge = sc->sc_bridge_id;
req->ifbr_designated_cost = bif->bif_path_cost +
bif->bif_peer_cost;
req->ifbr_designated_port = bif->bif_port_id;
}
} else {
req->ifbr_peer_root = 0;
req->ifbr_peer_bridge = 0;
req->ifbr_peer_cost = 0;
req->ifbr_peer_port = 0;
req->ifbr_designated_root = 0;
req->ifbr_designated_bridge = 0;
req->ifbr_designated_cost = 0;
req->ifbr_designated_port = 0;
}
}
static int
bridge_ioctl_sifflags(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
struct ifnet *bifp = sc->sc_ifp;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
if (req->ifbr_ifsflags & IFBIF_SPAN) {
return (EINVAL);
}
if (req->ifbr_ifsflags & IFBIF_STP) {
switch (bif->bif_ifp->if_type) {
case IFT_ETHER:
break;
default:
return (EINVAL);
}
}
bif->bif_flags = (bif->bif_flags & IFBIF_KEEPMASK) |
(req->ifbr_ifsflags & ~IFBIF_KEEPMASK);
if (bifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_scache(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
struct ifnet *ifp = sc->sc_ifp;
sc->sc_brtmax = param->ifbrp_csize;
ifnet_deserialize_all(ifp);
bridge_rttrim(sc);
ifnet_serialize_all(ifp);
return (0);
}
static int
bridge_ioctl_gcache(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_csize = sc->sc_brtmax;
return (0);
}
static int
bridge_ioctl_gifs(struct bridge_softc *sc, void *arg)
{
struct bridge_control_arg *bc_arg = arg;
struct ifbifconf *bifc = arg;
struct bridge_iflist *bif;
struct ifbreq *breq;
int count, len;
count = 0;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next)
count++;
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
count++;
if (bifc->ifbic_len == 0) {
bifc->ifbic_len = sizeof(*breq) * count;
return 0;
} else if (count == 0 || bifc->ifbic_len < sizeof(*breq)) {
bifc->ifbic_len = 0;
return 0;
}
len = min(bifc->ifbic_len, sizeof(*breq) * count);
KKASSERT(len >= sizeof(*breq));
breq = kmalloc(len, M_TEMP, M_WAITOK | M_NULLOK | M_ZERO);
if (breq == NULL) {
bifc->ifbic_len = 0;
return ENOMEM;
}
bc_arg->bca_kptr = breq;
count = 0;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (len < sizeof(*breq))
break;
strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname,
sizeof(breq->ifbr_ifsname));
bridge_ioctl_fillflags(sc, bif, breq);
breq++;
count++;
len -= sizeof(*breq);
}
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) {
if (len < sizeof(*breq))
break;
strlcpy(breq->ifbr_ifsname, bif->bif_ifp->if_xname,
sizeof(breq->ifbr_ifsname));
breq->ifbr_ifsflags = bif->bif_flags;
breq->ifbr_portno = bif->bif_ifp->if_index & 0xff;
breq++;
count++;
len -= sizeof(*breq);
}
bifc->ifbic_len = sizeof(*breq) * count;
KKASSERT(bifc->ifbic_len > 0);
bc_arg->bca_len = bifc->ifbic_len;
bc_arg->bca_uptr = bifc->ifbic_req;
return 0;
}
static int
bridge_ioctl_rts(struct bridge_softc *sc, void *arg)
{
struct bridge_control_arg *bc_arg = arg;
struct ifbaconf *bac = arg;
struct bridge_rtnode *brt;
struct ifbareq *bareq;
int count, len;
count = 0;
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list)
count++;
if (bac->ifbac_len == 0) {
bac->ifbac_len = sizeof(*bareq) * count;
return 0;
} else if (count == 0 || bac->ifbac_len < sizeof(*bareq)) {
bac->ifbac_len = 0;
return 0;
}
len = min(bac->ifbac_len, sizeof(*bareq) * count);
KKASSERT(len >= sizeof(*bareq));
bareq = kmalloc(len, M_TEMP, M_WAITOK | M_NULLOK | M_ZERO);
if (bareq == NULL) {
bac->ifbac_len = 0;
return ENOMEM;
}
bc_arg->bca_kptr = bareq;
count = 0;
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
struct bridge_rtinfo *bri = brt->brt_info;
time_t expire;
if (len < sizeof(*bareq))
break;
strlcpy(bareq->ifba_ifsname, bri->bri_ifp->if_xname,
sizeof(bareq->ifba_ifsname));
memcpy(bareq->ifba_dst, brt->brt_addr, sizeof(brt->brt_addr));
expire = bri->bri_expire;
if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
time_uptime < expire)
bareq->ifba_expire = expire - time_uptime;
else
bareq->ifba_expire = 0;
bareq->ifba_flags = bri->bri_flags;
bareq++;
count++;
len -= sizeof(*bareq);
}
bac->ifbac_len = sizeof(*bareq) * count;
KKASSERT(bac->ifbac_len > 0);
bc_arg->bca_len = bac->ifbac_len;
bc_arg->bca_uptr = bac->ifbac_req;
return 0;
}
static int
bridge_ioctl_saddr(struct bridge_softc *sc, void *arg)
{
struct ifbareq *req = arg;
struct bridge_iflist *bif;
struct ifnet *ifp = sc->sc_ifp;
int error;
ASSERT_IFNET_SERIALIZED_ALL(ifp);
bif = bridge_lookup_member(sc, req->ifba_ifsname);
if (bif == NULL)
return (ENOENT);
ifnet_deserialize_all(ifp);
error = bridge_rtsaddr(sc, req->ifba_dst, bif->bif_ifp,
req->ifba_flags);
ifnet_serialize_all(ifp);
return (error);
}
static int
bridge_ioctl_sto(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
sc->sc_brttimeout = param->ifbrp_ctime;
return (0);
}
static int
bridge_ioctl_gto(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_ctime = sc->sc_brttimeout;
return (0);
}
static int
bridge_ioctl_daddr(struct bridge_softc *sc, void *arg)
{
struct ifbareq *req = arg;
struct ifnet *ifp = sc->sc_ifp;
int error;
ifnet_deserialize_all(ifp);
error = bridge_rtdaddr(sc, req->ifba_dst);
ifnet_serialize_all(ifp);
return error;
}
static int
bridge_ioctl_flush(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct ifnet *ifp = sc->sc_ifp;
ifnet_deserialize_all(ifp);
bridge_rtflush(sc, req->ifbr_ifsflags | IFBF_FLUSHSYNC);
ifnet_serialize_all(ifp);
return (0);
}
static int
bridge_ioctl_gpri(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_prio = sc->sc_bridge_priority;
return (0);
}
static int
bridge_ioctl_spri(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
sc->sc_bridge_priority = param->ifbrp_prio;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_reinit(struct bridge_softc *sc, void *arg __unused)
{
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_ght(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_hellotime = sc->sc_bridge_hello_time >> 8;
return (0);
}
static int
bridge_ioctl_sht(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
if (param->ifbrp_hellotime == 0)
return (EINVAL);
sc->sc_bridge_hello_time = param->ifbrp_hellotime << 8;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_gfd(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_fwddelay = sc->sc_bridge_forward_delay >> 8;
return (0);
}
static int
bridge_ioctl_sfd(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
if (param->ifbrp_fwddelay == 0)
return (EINVAL);
sc->sc_bridge_forward_delay = param->ifbrp_fwddelay << 8;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_gma(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
param->ifbrp_maxage = sc->sc_bridge_max_age >> 8;
return (0);
}
static int
bridge_ioctl_sma(struct bridge_softc *sc, void *arg)
{
struct ifbrparam *param = arg;
if (param->ifbrp_maxage == 0)
return (EINVAL);
sc->sc_bridge_max_age = param->ifbrp_maxage << 8;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_sifprio(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
bif->bif_priority = req->ifbr_priority;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_sifcost(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
bif->bif_path_cost = req->ifbr_path_cost;
if (sc->sc_ifp->if_flags & IFF_RUNNING)
bstp_initialization(sc);
return (0);
}
static int
bridge_ioctl_sifbondwght(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
bif = bridge_lookup_member(sc, req->ifbr_ifsname);
if (bif == NULL)
return (ENOENT);
bif->bif_bond_weight = req->ifbr_bond_weight;
return (0);
}
static int
bridge_ioctl_addspan(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
struct ifnet *ifs;
struct bridge_ifinfo *bif_info;
ifs = ifunit_netisr(req->ifbr_ifsname);
if (ifs == NULL)
return (ENOENT);
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
if (ifs == bif->bif_ifp)
return (EBUSY);
if (ifs->if_bridge != NULL)
return (EBUSY);
switch (ifs->if_type) {
case IFT_ETHER:
case IFT_GIF:
case IFT_L2VLAN:
break;
default:
return (EINVAL);
}
bif_info = kmalloc(sizeof(*bif_info), M_DEVBUF, M_WAITOK | M_ZERO);
bif_info->bifi_ifp = ifs;
bif = kmalloc(sizeof(*bif), M_DEVBUF, M_WAITOK | M_ZERO);
bif->bif_ifp = ifs;
bif->bif_info = bif_info;
bif->bif_flags = IFBIF_SPAN;
TAILQ_INSERT_HEAD(&sc->sc_spanlist, bif, bif_next);
sc->sc_span = 1;
return (0);
}
static int
bridge_ioctl_delspan(struct bridge_softc *sc, void *arg)
{
struct ifbreq *req = arg;
struct bridge_iflist *bif;
struct ifnet *ifs;
ifs = ifunit_netisr(req->ifbr_ifsname);
if (ifs == NULL)
return (ENOENT);
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
if (ifs == bif->bif_ifp)
break;
if (bif == NULL)
return (ENOENT);
bridge_delete_span(sc, bif);
if (TAILQ_EMPTY(&sc->sc_spanlist))
sc->sc_span = 0;
return (0);
}
static void
bridge_ifdetach_dispatch(netmsg_t msg)
{
struct ifnet *ifp, *bifp;
struct bridge_softc *sc;
struct bridge_iflist *bif;
ifp = msg->lmsg.u.ms_resultp;
sc = ifp->if_bridge;
if (sc != NULL) {
bifp = sc->sc_ifp;
ifnet_serialize_all(bifp);
bif = bridge_lookup_member_if(sc, ifp);
if (bif != NULL) {
bridge_delete_member(sc, bif, 1);
} else {
}
ifnet_deserialize_all(bifp);
goto reply;
}
crit_enter();
LIST_FOREACH(sc, &bridge_list, sc_list) {
bifp = sc->sc_ifp;
ifnet_serialize_all(bifp);
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next)
if (ifp == bif->bif_ifp) {
bridge_delete_span(sc, bif);
break;
}
ifnet_deserialize_all(bifp);
}
crit_exit();
reply:
lwkt_replymsg(&msg->lmsg, 0);
}
static void
bridge_ifdetach(void *arg __unused, struct ifnet *ifp)
{
struct netmsg_base msg;
netmsg_init(&msg, NULL, &curthread->td_msgport,
0, bridge_ifdetach_dispatch);
msg.lmsg.u.ms_resultp = ifp;
lwkt_domsg(BRIDGE_CFGPORT, &msg.lmsg, 0);
}
static void
bridge_init(void *xsc)
{
bridge_control(xsc, SIOCSIFFLAGS, bridge_ioctl_init, NULL);
}
static void
bridge_stop(struct ifnet *ifp)
{
bridge_control(ifp->if_softc, SIOCSIFFLAGS, bridge_ioctl_stop, NULL);
}
static int
bridge_from_us(struct bridge_softc *sc, struct ether_header *eh)
{
struct bridge_iflist *bif;
if (memcmp(eh->ether_shost, IF_LLADDR(sc->sc_ifp), ETHER_ADDR_LEN) == 0)
return (1);
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (memcmp(eh->ether_shost, IF_LLADDR(bif->bif_ifp),
ETHER_ADDR_LEN) == 0)
{
return (1);
}
}
return (0);
}
void
bridge_enqueue(struct ifnet *dst_ifp, struct mbuf *m)
{
struct netmsg_packet *nmp;
mbuftrackid(m, 64);
nmp = &m->m_hdr.mh_netmsg;
netmsg_init(&nmp->base, NULL, &netisr_apanic_rport,
0, bridge_enqueue_handler);
nmp->nm_packet = m;
nmp->base.lmsg.u.ms_resultp = dst_ifp;
lwkt_sendmsg_oncpu(netisr_cpuport(mycpuid), &nmp->base.lmsg);
}
static struct ifnet *
bridge_select_unicast(struct bridge_softc *sc, struct ifnet *dst_if,
int from_blocking, struct mbuf *m)
{
struct bridge_iflist *bif, *alt_bif, *nbif;
int alt_priority, alt_count;
uint8_t alt_state;
bif = bridge_lookup_member_if(sc, dst_if);
if (bif == NULL) {
return NULL;
}
if ((bif->bif_flags & IFBIF_STP) == 0) {
goto sendunicast;
}
alt_state = BSTP_IFSTATE_LEARNING;
alt_bif = NULL;
alt_priority = 0;
alt_count = 0;
TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid], bif_next, nbif) {
if (memcmp(IF_LLADDR(bif->bif_ifp), IF_LLADDR(dst_if),
ETHER_ADDR_LEN) != 0)
{
continue;
}
if ((bif->bif_ifp->if_flags & IFF_RUNNING) == 0)
continue;
switch(bif->bif_state) {
case BSTP_IFSTATE_LEARNING:
if (from_blocking == 0 &&
alt_state == BSTP_IFSTATE_LEARNING &&
bif->bif_priority > alt_priority)
{
alt_priority = bif->bif_priority;
alt_bif = bif;
}
break;
case BSTP_IFSTATE_BLOCKING:
if (from_blocking == 0 &&
(alt_state == BSTP_IFSTATE_LEARNING ||
(alt_state == BSTP_IFSTATE_BLOCKING &&
bif->bif_priority > alt_priority)))
{
alt_state = BSTP_IFSTATE_BLOCKING;
alt_priority = bif->bif_priority;
alt_bif = bif;
}
break;
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_LISTENING:
case BSTP_IFSTATE_DISABLED:
break;
default:
if (alt_state != BSTP_IFSTATE_BONDED ||
bif->bif_priority > alt_priority)
{
alt_state = BSTP_IFSTATE_BONDED;
alt_priority = bif->bif_priority;
alt_bif = bif;
alt_count = 0;
} else if (alt_state == BSTP_IFSTATE_BONDED &&
bif->bif_priority == alt_priority)
{
++alt_count;
}
break;
}
}
if (alt_count && (sc->sc_ifp->if_flags & IFF_LINK2)) {
if (++alt_bif->bif_bond_count >= alt_bif->bif_bond_weight) {
alt_bif->bif_bond_count = 0;
TAILQ_REMOVE(&sc->sc_iflists[mycpuid],
alt_bif, bif_next);
TAILQ_INSERT_TAIL(
&sc->sc_iflists[mycpuid],
alt_bif, bif_next);
}
}
if (alt_bif)
dst_if = alt_bif->bif_ifp;
sendunicast:
if ((dst_if->if_flags & IFF_RUNNING) == 0)
dst_if = NULL;
return (dst_if);
}
static int
bridge_output(struct ifnet *ifp, struct mbuf *m)
{
struct bridge_softc *sc = ifp->if_bridge;
struct bridge_iflist *bif, *nbif;
struct ether_header *eh;
struct ifnet *dst_if, *alt_if, *bifp;
int from_us;
int alt_priority;
uint8_t alt_state;
struct mbuf *mc;
int used;
int found;
ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
ASSERT_NETISR_NCPUS(mycpuid);
mbuftrackid(m, 65);
if (sc == NULL) {
m_freem(m);
return (0);
}
bifp = sc->sc_ifp;
if (m->m_len < ETHER_HDR_LEN) {
m = m_pullup(m, ETHER_HDR_LEN);
if (m == NULL) {
IFNET_STAT_INC(bifp, oerrors, 1);
return (0);
}
}
eh = mtod(m, struct ether_header *);
from_us = bridge_from_us(sc, eh);
if ((bifp->if_flags & IFF_RUNNING) == 0) {
dst_if = ifp;
goto sendunicast;
}
if (ETHER_IS_MULTICAST(eh->ether_dhost))
dst_if = NULL;
else
dst_if = bridge_rtlookup(sc, eh->ether_dhost);
if (dst_if)
goto sendunicast;
used = 0;
found = 0;
if (sc->sc_span)
bridge_span(sc, m);
alt_if = NULL;
alt_priority = 0;
alt_state = BSTP_IFSTATE_LEARNING;
TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid], bif_next, nbif) {
dst_if = bif->bif_ifp;
if ((dst_if->if_flags & IFF_RUNNING) == 0)
continue;
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_BONDED:
if (alt_state != BSTP_IFSTATE_BONDED ||
bif->bif_priority > alt_priority)
{
alt_state = BSTP_IFSTATE_BONDED;
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_BLOCKING:
if (alt_state == BSTP_IFSTATE_LEARNING ||
(alt_state == BSTP_IFSTATE_BLOCKING &&
bif->bif_priority > alt_priority))
{
alt_state = BSTP_IFSTATE_BLOCKING;
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_LEARNING:
if (alt_state == BSTP_IFSTATE_LEARNING &&
bif->bif_priority > alt_priority)
{
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_LISTENING:
case BSTP_IFSTATE_DISABLED:
continue;
default:
break;
}
}
KKASSERT(used == 0);
if (TAILQ_NEXT(bif, bif_next) == NULL) {
used = 1;
mc = m;
} else {
mc = m_copypacket(m, M_NOWAIT);
if (mc == NULL) {
IFNET_STAT_INC(bifp, oerrors, 1);
continue;
}
}
bridge_handoff(sc, dst_if, mc, from_us);
found = 1;
if (nbif != NULL && !nbif->bif_onlist) {
KKASSERT(bif->bif_onlist);
nbif = TAILQ_NEXT(bif, bif_next);
}
}
if (found == 0 && alt_if) {
KKASSERT(used == 0);
mc = m;
used = 1;
bridge_handoff(sc, alt_if, mc, from_us);
}
if (used == 0)
m_freem(m);
return (0);
sendunicast:
dst_if = bridge_select_unicast(sc, dst_if, 0, m);
if (sc->sc_span)
bridge_span(sc, m);
if (dst_if == NULL)
m_freem(m);
else
bridge_handoff(sc, dst_if, m, from_us);
return (0);
}
static struct ifnet *
bridge_interface(void *if_bridge)
{
struct bridge_softc *sc = if_bridge;
return (sc->sc_ifp);
}
static void
bridge_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
{
struct bridge_softc *sc = ifp->if_softc;
ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
ASSERT_ALTQ_SQ_SERIALIZED_HW(ifsq);
ASSERT_NETISR_NCPUS(mycpuid);
ifsq_set_oactive(ifsq);
for (;;) {
struct ifnet *dst_if = NULL;
struct ether_header *eh;
struct mbuf *m;
m = ifsq_dequeue(ifsq);
if (m == NULL)
break;
mbuftrackid(m, 75);
if (m->m_len < sizeof(*eh)) {
m = m_pullup(m, sizeof(*eh));
if (m == NULL) {
IFNET_STAT_INC(ifp, oerrors, 1);
continue;
}
}
eh = mtod(m, struct ether_header *);
BPF_MTAP(ifp, m);
IFNET_STAT_INC(ifp, opackets, 1);
if ((m->m_flags & (M_BCAST|M_MCAST)) == 0)
dst_if = bridge_rtlookup(sc, eh->ether_dhost);
if (dst_if == NULL) {
bridge_start_bcast(sc, m);
continue;
}
dst_if = bridge_select_unicast(sc, dst_if, 0, m);
if (dst_if == NULL)
m_freem(m);
else
bridge_enqueue(dst_if, m);
}
ifsq_clr_oactive(ifsq);
}
static void
bridge_forward(struct bridge_softc *sc, struct mbuf *m)
{
struct bridge_iflist *bif;
struct ifnet *src_if, *dst_if, *ifp;
struct ether_header *eh;
int from_blocking;
mbuftrackid(m, 66);
src_if = m->m_pkthdr.rcvif;
ifp = sc->sc_ifp;
ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
IFNET_STAT_INC(ifp, opackets, 1);
IFNET_STAT_INC(ifp, obytes, m->m_pkthdr.len);
bif = bridge_lookup_member_if(sc, src_if);
if (bif == NULL) {
m_freem(m);
return;
}
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_LISTENING:
case BSTP_IFSTATE_DISABLED:
m_freem(m);
return;
default:
break;
}
from_blocking = (bif->bif_state == BSTP_IFSTATE_BLOCKING);
} else {
from_blocking = 0;
}
eh = mtod(m, struct ether_header *);
if ((bif->bif_flags & IFBIF_LEARNING) != 0 &&
from_blocking == 0 &&
ETHER_IS_MULTICAST(eh->ether_shost) == 0 &&
(eh->ether_shost[0] == 0 &&
eh->ether_shost[1] == 0 &&
eh->ether_shost[2] == 0 &&
eh->ether_shost[3] == 0 &&
eh->ether_shost[4] == 0 &&
eh->ether_shost[5] == 0) == 0)
{
bridge_rtupdate(sc, eh->ether_shost, src_if, IFBAF_DYNAMIC);
}
if ((bif->bif_flags & IFBIF_STP) != 0 &&
(bif->bif_state == BSTP_IFSTATE_LISTENING ||
bif->bif_state == BSTP_IFSTATE_LEARNING)) {
m_freem(m);
return;
}
if ((m->m_flags & (M_BCAST|M_MCAST)) == 0) {
dst_if = bridge_rtlookup(sc, eh->ether_dhost);
if (dst_if && memcmp(IF_LLADDR(src_if), IF_LLADDR(dst_if),
ETHER_ADDR_LEN) == 0) {
m_freem(m);
return;
}
} else {
IFNET_STAT_INC(ifp, imcasts, 1);
dst_if = NULL;
}
if (dst_if == NULL) {
if (from_blocking)
m_freem(m);
else
bridge_broadcast(sc, src_if, m);
return;
}
dst_if = bridge_select_unicast(sc, dst_if, from_blocking, m);
if (dst_if == NULL) {
m_freem(m);
return;
}
if (inet_pfil_hook.ph_hashooks > 0
#ifdef INET6
|| inet6_pfil_hook.ph_hashooks > 0
#endif
) {
if (bridge_pfil(&m, ifp, src_if, PFIL_IN) != 0)
return;
if (m == NULL)
return;
if (bridge_pfil(&m, ifp, dst_if, PFIL_OUT) != 0)
return;
if (m == NULL)
return;
}
bridge_handoff(sc, dst_if, m, 0);
}
static struct mbuf *
bridge_input(struct ifnet *ifp, struct mbuf *m)
{
struct bridge_softc *sc = ifp->if_bridge;
struct bridge_iflist *bif;
struct ifnet *bifp, *new_ifp;
struct ether_header *eh;
struct mbuf *mc, *mc2;
ASSERT_IFNET_NOT_SERIALIZED_ALL(ifp);
ASSERT_NETISR_NCPUS(mycpuid);
mbuftrackid(m, 67);
if (sc == NULL)
return m;
new_ifp = NULL;
bifp = sc->sc_ifp;
if ((bifp->if_flags & IFF_RUNNING) == 0)
goto out;
if (bifp->if_flags & IFF_MONITOR) {
m->m_pkthdr.rcvif = bifp;
BPF_MTAP(bifp, m);
IFNET_STAT_INC(bifp, ipackets, 1);
IFNET_STAT_INC(bifp, ibytes, m->m_pkthdr.len);
if (m->m_flags & (M_MCAST | M_BCAST))
IFNET_STAT_INC(bifp, imcasts, 1);
m_freem(m);
m = NULL;
goto out;
}
if (m->m_len < ETHER_HDR_LEN) {
m = m_pullup(m, ETHER_HDR_LEN);
if (m == NULL)
goto out;
}
eh = mtod(m, struct ether_header *);
m->m_pkthdr.fw_flags |= BRIDGE_MBUF_TAGGED;
bcopy(eh->ether_shost, m->m_pkthdr.ether_br_shost, ETHER_ADDR_LEN);
if ((bridge_debug & 1) &&
(ntohs(eh->ether_type) == ETHERTYPE_ARP ||
ntohs(eh->ether_type) == ETHERTYPE_REVARP)) {
kprintf("%02x:%02x:%02x:%02x:%02x:%02x "
"%02x:%02x:%02x:%02x:%02x:%02x type %04x "
"lla %02x:%02x:%02x:%02x:%02x:%02x\n",
eh->ether_dhost[0],
eh->ether_dhost[1],
eh->ether_dhost[2],
eh->ether_dhost[3],
eh->ether_dhost[4],
eh->ether_dhost[5],
eh->ether_shost[0],
eh->ether_shost[1],
eh->ether_shost[2],
eh->ether_shost[3],
eh->ether_shost[4],
eh->ether_shost[5],
eh->ether_type,
((u_char *)IF_LLADDR(bifp))[0],
((u_char *)IF_LLADDR(bifp))[1],
((u_char *)IF_LLADDR(bifp))[2],
((u_char *)IF_LLADDR(bifp))[3],
((u_char *)IF_LLADDR(bifp))[4],
((u_char *)IF_LLADDR(bifp))[5]
);
}
if (memcmp(eh->ether_dhost, IF_LLADDR(bifp), ETHER_ADDR_LEN) == 0) {
bif = bridge_lookup_member_if(sc, ifp);
if ((bif->bif_flags & IFBIF_LEARNING) &&
((bif->bif_flags & IFBIF_STP) == 0 ||
bif->bif_state != BSTP_IFSTATE_BLOCKING))
{
bridge_rtupdate(sc, eh->ether_shost,
ifp, IFBAF_DYNAMIC);
}
m->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
KASSERT(bifp->if_bridge == NULL,
("loop created in bridge_input"));
if (pfil_member != 0) {
if (inet_pfil_hook.ph_hashooks > 0
#ifdef INET6
|| inet6_pfil_hook.ph_hashooks > 0
#endif
) {
if (bridge_pfil(&m, NULL, ifp, PFIL_IN) != 0)
goto out;
if (m == NULL)
goto out;
}
}
new_ifp = bifp;
goto out;
}
BPF_MTAP(bifp, m);
IFNET_STAT_INC(bifp, ipackets, 1);
IFNET_STAT_INC(bifp, ibytes, m->m_pkthdr.len);
if (m->m_flags & (M_MCAST | M_BCAST))
IFNET_STAT_INC(bifp, imcasts, 1);
bif = bridge_lookup_member_if(sc, ifp);
if (bif == NULL)
goto out;
if (sc->sc_span)
bridge_span(sc, m);
if (m->m_flags & (M_BCAST | M_MCAST)) {
if (memcmp(eh->ether_dhost, bstp_etheraddr,
ETHER_ADDR_LEN) == 0) {
ifnet_serialize_all(bifp);
bstp_input(sc, bif, m);
ifnet_deserialize_all(bifp);
m = NULL;
goto out;
}
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_LISTENING:
case BSTP_IFSTATE_DISABLED:
goto out;
default:
break;
}
}
mc = m_dup(m, M_NOWAIT);
if (mc == NULL)
goto out;
if ((bif->bif_flags & IFBIF_STP) == 0 ||
bif->bif_state != BSTP_IFSTATE_BLOCKING)
{
bridge_forward(sc, mc);
}
KASSERT(bifp->if_bridge == NULL,
("loop created in bridge_input"));
mc2 = m_dup(m, M_NOWAIT);
#ifdef notyet
if (mc2 != NULL) {
int i = min(mc2->m_pkthdr.len, max_protohdr);
mc2 = m_copyup(mc2, i, ETHER_ALIGN);
}
#endif
if (mc2 != NULL) {
mc2->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
ether_reinput_oncpu(bifp, mc2, 0);
}
goto out;
}
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_LISTENING:
case BSTP_IFSTATE_DISABLED:
goto out;
default:
break;
}
}
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
if (bif->bif_ifp->if_type != IFT_ETHER)
continue;
if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_dhost,
ETHER_ADDR_LEN) == 0) {
if (bif->bif_ifp != ifp) {
m->m_flags |= M_ETHER_BRIDGED;
}
if ((bif->bif_flags & IFBIF_LEARNING) &&
((bif->bif_flags & IFBIF_STP) == 0 ||
bif->bif_state != BSTP_IFSTATE_BLOCKING)) {
bridge_rtupdate(sc, eh->ether_shost,
ifp, IFBAF_DYNAMIC);
}
new_ifp = bifp;
m->m_pkthdr.fw_flags &= ~BRIDGE_MBUF_TAGGED;
goto out;
}
if (memcmp(IF_LLADDR(bif->bif_ifp), eh->ether_shost,
ETHER_ADDR_LEN) == 0) {
m_freem(m);
m = NULL;
goto out;
}
}
bridge_forward(sc, m);
m = NULL;
out:
if (new_ifp != NULL) {
ether_reinput_oncpu(new_ifp, m, REINPUT_RUNBPF);
m = NULL;
}
return (m);
}
static void
bridge_start_bcast(struct bridge_softc *sc, struct mbuf *m)
{
struct bridge_iflist *bif;
struct mbuf *mc;
struct ifnet *dst_if, *alt_if, *bifp;
int used = 0;
int found = 0;
int alt_priority;
mbuftrackid(m, 68);
bifp = sc->sc_ifp;
ASSERT_IFNET_SERIALIZED_ALL(bifp);
alt_if = NULL;
alt_priority = 0;
TAILQ_FOREACH(bif, &sc->sc_iflists[mycpuid], bif_next) {
dst_if = bif->bif_ifp;
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_BLOCKING:
if (bif->bif_priority > alt_priority) {
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_DISABLED:
continue;
default:
break;
}
}
if ((bif->bif_flags & IFBIF_DISCOVER) == 0 &&
(m->m_flags & (M_BCAST|M_MCAST)) == 0)
continue;
if ((dst_if->if_flags & IFF_RUNNING) == 0)
continue;
if (TAILQ_NEXT(bif, bif_next) == NULL) {
mc = m;
used = 1;
} else {
mc = m_copypacket(m, M_NOWAIT);
if (mc == NULL) {
IFNET_STAT_INC(bifp, oerrors, 1);
continue;
}
}
found = 1;
bridge_enqueue(dst_if, mc);
}
if (found == 0 && alt_if) {
KKASSERT(used == 0);
mc = m;
used = 1;
bridge_enqueue(alt_if, mc);
}
if (used == 0)
m_freem(m);
}
static void
bridge_broadcast(struct bridge_softc *sc, struct ifnet *src_if, struct mbuf *m)
{
struct bridge_iflist *bif, *nbif;
struct ether_header *eh;
struct mbuf *mc;
struct ifnet *dst_if, *alt_if, *bifp;
int used;
int found;
int alt_priority;
int from_us;
uint8_t alt_state;
mbuftrackid(m, 69);
bifp = sc->sc_ifp;
ASSERT_IFNET_NOT_SERIALIZED_ALL(bifp);
eh = mtod(m, struct ether_header *);
from_us = bridge_from_us(sc, eh);
if (inet_pfil_hook.ph_hashooks > 0
#ifdef INET6
|| inet6_pfil_hook.ph_hashooks > 0
#endif
)
{
if (bridge_pfil(&m, bifp, src_if, PFIL_IN) != 0)
return;
if (m == NULL)
return;
if (bridge_pfil(&m, bifp, NULL, PFIL_OUT) != 0)
return;
if (m == NULL)
return;
}
alt_state = BSTP_IFSTATE_LEARNING;
alt_if = NULL;
alt_priority = 0;
found = 0;
used = 0;
TAILQ_FOREACH_MUTABLE(bif, &sc->sc_iflists[mycpuid], bif_next, nbif) {
dst_if = bif->bif_ifp;
if ((dst_if->if_flags & IFF_RUNNING) == 0)
continue;
if (src_if &&
memcmp(IF_LLADDR(src_if), IF_LLADDR(dst_if),
ETHER_ADDR_LEN) == 0)
{
continue;
}
if (bif->bif_flags & IFBIF_STP) {
switch (bif->bif_state) {
case BSTP_IFSTATE_LEARNING:
if (alt_state == BSTP_IFSTATE_LEARNING &&
bif->bif_priority > alt_priority)
{
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_BLOCKING:
if (alt_state == BSTP_IFSTATE_LEARNING ||
(alt_state == BSTP_IFSTATE_BLOCKING &&
bif->bif_priority > alt_priority))
{
alt_state = BSTP_IFSTATE_BLOCKING;
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_BONDED:
if (alt_state != BSTP_IFSTATE_BONDED ||
bif->bif_priority > alt_priority)
{
alt_state = BSTP_IFSTATE_BONDED;
alt_priority = bif->bif_priority;
alt_if = bif->bif_ifp;
}
continue;
case BSTP_IFSTATE_L1BLOCKING:
case BSTP_IFSTATE_DISABLED:
case BSTP_IFSTATE_LISTENING:
continue;
default:
break;
}
}
if ((bif->bif_flags & IFBIF_DISCOVER) == 0 &&
(m->m_flags & (M_BCAST|M_MCAST)) == 0)
{
continue;
}
if (TAILQ_NEXT(bif, bif_next) == NULL) {
mc = m;
used = 1;
} else {
mc = m_copypacket(m, M_NOWAIT);
if (mc == NULL) {
IFNET_STAT_INC(sc->sc_ifp, oerrors, 1);
continue;
}
}
found = 1;
if (inet_pfil_hook.ph_hashooks > 0
#ifdef INET6
|| inet6_pfil_hook.ph_hashooks > 0
#endif
)
{
if (bridge_pfil(&mc, NULL, dst_if, PFIL_OUT) != 0)
continue;
if (mc == NULL)
continue;
}
bridge_handoff(sc, dst_if, mc, from_us);
if (nbif != NULL && !nbif->bif_onlist) {
KKASSERT(bif->bif_onlist);
nbif = TAILQ_NEXT(bif, bif_next);
}
}
if (found == 0 && alt_if) {
KKASSERT(used == 0);
mc = m;
used = 1;
bridge_enqueue(alt_if, mc);
}
if (used == 0)
m_freem(m);
}
static void
bridge_span(struct bridge_softc *sc, struct mbuf *m)
{
struct bridge_iflist *bif;
struct ifnet *dst_if, *bifp;
struct mbuf *mc;
mbuftrackid(m, 70);
bifp = sc->sc_ifp;
ifnet_serialize_all(bifp);
TAILQ_FOREACH(bif, &sc->sc_spanlist, bif_next) {
dst_if = bif->bif_ifp;
if ((dst_if->if_flags & IFF_RUNNING) == 0)
continue;
mc = m_copypacket(m, M_NOWAIT);
if (mc == NULL) {
IFNET_STAT_INC(sc->sc_ifp, oerrors, 1);
continue;
}
bridge_enqueue(dst_if, mc);
}
ifnet_deserialize_all(bifp);
}
static void
bridge_rtmsg_sync_handler(netmsg_t msg)
{
netisr_forwardmsg(&msg->base, mycpuid + 1);
}
static void
bridge_rtmsg_sync(struct bridge_softc *sc)
{
struct netmsg_base msg;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
netmsg_init(&msg, NULL, &curthread->td_msgport,
0, bridge_rtmsg_sync_handler);
netisr_domsg(&msg, 0);
}
static __inline void
bridge_rtinfo_update(struct bridge_rtinfo *bri, struct ifnet *dst_if,
int setflags, uint8_t flags, uint32_t timeo)
{
if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
bri->bri_ifp != dst_if)
bri->bri_ifp = dst_if;
if ((flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
bri->bri_expire != time_uptime + timeo)
bri->bri_expire = time_uptime + timeo;
if (setflags)
bri->bri_flags = flags;
}
static int
bridge_rtinstall_oncpu(struct bridge_softc *sc, const uint8_t *dst,
struct ifnet *dst_if, int setflags, uint8_t flags,
struct bridge_rtinfo **bri0)
{
struct bridge_rtnode *brt;
struct bridge_rtinfo *bri;
if (mycpuid == 0) {
brt = bridge_rtnode_lookup(sc, dst);
if (brt != NULL) {
KKASSERT(*bri0 == NULL);
bridge_rtinfo_update(brt->brt_info, dst_if, setflags,
flags, sc->sc_brttimeout);
return 0;
}
if (sc->sc_brtcnt >= sc->sc_brtmax)
return ENOSPC;
KKASSERT(*bri0 == NULL);
bri = kmalloc(sizeof(struct bridge_rtinfo), M_DEVBUF,
M_WAITOK | M_ZERO);
*bri0 = bri;
bri->bri_flags = IFBAF_DYNAMIC;
bridge_rtinfo_update(bri, dst_if, setflags, flags,
sc->sc_brttimeout);
} else {
bri = *bri0;
KKASSERT(bri != NULL);
}
brt = kmalloc(sizeof(struct bridge_rtnode), M_DEVBUF,
M_WAITOK | M_ZERO);
memcpy(brt->brt_addr, dst, ETHER_ADDR_LEN);
brt->brt_info = bri;
atomic_add_int(&bri->bri_refs, 1);
bridge_rtnode_insert(sc, brt);
return 0;
}
static void
bridge_rtinstall_handler(netmsg_t msg)
{
struct netmsg_brsaddr *brmsg = (struct netmsg_brsaddr *)msg;
int error;
error = bridge_rtinstall_oncpu(brmsg->br_softc,
brmsg->br_dst, brmsg->br_dst_if,
brmsg->br_setflags, brmsg->br_flags,
&brmsg->br_rtinfo);
if (error) {
KKASSERT(mycpuid == 0 && brmsg->br_rtinfo == NULL);
netisr_replymsg(&brmsg->base, error);
return;
} else if (brmsg->br_rtinfo == NULL) {
KKASSERT(mycpuid == 0);
netisr_replymsg(&brmsg->base, 0);
return;
}
netisr_forwardmsg(&brmsg->base, mycpuid + 1);
}
static int
bridge_rtupdate(struct bridge_softc *sc, const uint8_t *dst,
struct ifnet *dst_if, uint8_t flags)
{
struct bridge_rtnode *brt;
if ((brt = bridge_rtnode_lookup(sc, dst)) == NULL) {
struct netmsg_brsaddr *brmsg;
if (sc->sc_brtcnt >= sc->sc_brtmax)
return ENOSPC;
brmsg = kmalloc(sizeof(*brmsg), M_LWKTMSG, M_WAITOK | M_NULLOK);
if (brmsg == NULL)
return ENOMEM;
netmsg_init(&brmsg->base, NULL, &netisr_afree_rport,
0, bridge_rtinstall_handler);
memcpy(brmsg->br_dst, dst, ETHER_ADDR_LEN);
brmsg->br_dst_if = dst_if;
brmsg->br_flags = flags;
brmsg->br_setflags = 0;
brmsg->br_softc = sc;
brmsg->br_rtinfo = NULL;
netisr_sendmsg(&brmsg->base, 0);
return 0;
}
bridge_rtinfo_update(brt->brt_info, dst_if, 0, flags,
sc->sc_brttimeout);
return 0;
}
static int
bridge_rtsaddr(struct bridge_softc *sc, const uint8_t *dst,
struct ifnet *dst_if, uint8_t flags)
{
struct netmsg_brsaddr brmsg;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
netmsg_init(&brmsg.base, NULL, &curthread->td_msgport,
0, bridge_rtinstall_handler);
memcpy(brmsg.br_dst, dst, ETHER_ADDR_LEN);
brmsg.br_dst_if = dst_if;
brmsg.br_flags = flags;
brmsg.br_setflags = 1;
brmsg.br_softc = sc;
brmsg.br_rtinfo = NULL;
return netisr_domsg(&brmsg.base, 0);
}
static struct ifnet *
bridge_rtlookup(struct bridge_softc *sc, const uint8_t *addr)
{
struct bridge_rtnode *brt;
if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
return NULL;
return brt->brt_info->bri_ifp;
}
static void
bridge_rtreap_handler(netmsg_t msg)
{
struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
struct bridge_rtnode *brt, *nbrt;
LIST_FOREACH_MUTABLE(brt, &sc->sc_rtlists[mycpuid], brt_list, nbrt) {
if (brt->brt_info->bri_dead)
bridge_rtnode_destroy(sc, brt);
}
netisr_forwardmsg(&msg->base, mycpuid + 1);
}
static void
bridge_rtreap(struct bridge_softc *sc)
{
struct netmsg_base msg;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
netmsg_init(&msg, NULL, &curthread->td_msgport,
0, bridge_rtreap_handler);
msg.lmsg.u.ms_resultp = sc;
netisr_domsg(&msg, 0);
}
static void
bridge_rtreap_async(struct bridge_softc *sc)
{
struct netmsg_base *msg;
msg = kmalloc(sizeof(*msg), M_LWKTMSG, M_WAITOK);
netmsg_init(msg, NULL, &netisr_afree_rport,
0, bridge_rtreap_handler);
msg->lmsg.u.ms_resultp = sc;
netisr_sendmsg(msg, 0);
}
static void
bridge_rttrim(struct bridge_softc *sc)
{
struct bridge_rtnode *brt;
int dead;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
if (sc->sc_brtcnt <= sc->sc_brtmax)
return;
dead = bridge_rtage_finddead(sc);
KKASSERT(dead <= sc->sc_brtcnt);
if (sc->sc_brtcnt - dead <= sc->sc_brtmax) {
bridge_rtreap(sc);
return;
}
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
struct bridge_rtinfo *bri = brt->brt_info;
if (bri->bri_dead) {
continue;
}
if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
bri->bri_dead = 1;
++dead;
KKASSERT(dead <= sc->sc_brtcnt);
if (sc->sc_brtcnt - dead <= sc->sc_brtmax) {
break;
}
}
}
if (dead)
bridge_rtreap(sc);
}
static void
bridge_timer(void *arg)
{
struct bridge_softc *sc = arg;
struct netmsg_base *msg;
KKASSERT(mycpuid == BRIDGE_CFGCPU);
crit_enter();
if (callout_pending(&sc->sc_brcallout) ||
!callout_active(&sc->sc_brcallout)) {
crit_exit();
return;
}
callout_deactivate(&sc->sc_brcallout);
msg = &sc->sc_brtimemsg;
KKASSERT(msg->lmsg.ms_flags & MSGF_DONE);
lwkt_sendmsg_oncpu(BRIDGE_CFGPORT, &msg->lmsg);
crit_exit();
}
static void
bridge_timer_handler(netmsg_t msg)
{
struct bridge_softc *sc = msg->lmsg.u.ms_resultp;
KKASSERT(&curthread->td_msgport == BRIDGE_CFGPORT);
crit_enter();
lwkt_replymsg(&msg->lmsg, 0);
crit_exit();
bridge_rtage(sc);
if (sc->sc_ifp->if_flags & IFF_RUNNING) {
callout_reset(&sc->sc_brcallout,
bridge_rtable_prune_period * hz, bridge_timer, sc);
}
}
static int
bridge_rtage_finddead(struct bridge_softc *sc)
{
struct bridge_rtnode *brt;
int dead = 0;
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
struct bridge_rtinfo *bri = brt->brt_info;
if ((bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC &&
time_uptime >= bri->bri_expire) {
bri->bri_dead = 1;
++dead;
KKASSERT(dead <= sc->sc_brtcnt);
}
}
return dead;
}
static void
bridge_rtage(struct bridge_softc *sc)
{
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
if (bridge_rtage_finddead(sc))
bridge_rtreap(sc);
}
static void
bridge_rtflush(struct bridge_softc *sc, int bf)
{
struct bridge_rtnode *brt;
int reap;
reap = 0;
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
struct bridge_rtinfo *bri = brt->brt_info;
if ((bf & IFBF_FLUSHALL) ||
(bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC) {
bri->bri_dead = 1;
reap = 1;
}
}
if (reap) {
if (bf & IFBF_FLUSHSYNC)
bridge_rtreap(sc);
else
bridge_rtreap_async(sc);
}
}
static int
bridge_rtdaddr(struct bridge_softc *sc, const uint8_t *addr)
{
struct bridge_rtnode *brt;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
if ((brt = bridge_rtnode_lookup(sc, addr)) == NULL)
return (ENOENT);
brt->brt_info->bri_dead = 1;
bridge_rtreap(sc);
return (0);
}
void
bridge_rtdelete(struct bridge_softc *sc, struct ifnet *ifp, int bf)
{
struct bridge_rtnode *brt;
int reap;
reap = 0;
LIST_FOREACH(brt, &sc->sc_rtlists[mycpuid], brt_list) {
struct bridge_rtinfo *bri = brt->brt_info;
if (bri->bri_ifp == ifp &&
((bf & IFBF_FLUSHALL) ||
(bri->bri_flags & IFBAF_TYPEMASK) == IFBAF_DYNAMIC)) {
bri->bri_dead = 1;
reap = 1;
}
}
if (reap) {
if (bf & IFBF_FLUSHSYNC)
bridge_rtreap(sc);
else
bridge_rtreap_async(sc);
}
}
static void
bridge_rtable_init(struct bridge_softc *sc)
{
int cpu;
sc->sc_rthashs = kmalloc(sizeof(*sc->sc_rthashs) * netisr_ncpus,
M_DEVBUF, M_WAITOK);
for (cpu = 0; cpu < netisr_ncpus; ++cpu) {
int i;
sc->sc_rthashs[cpu] =
kmalloc(sizeof(struct bridge_rtnode_head) * BRIDGE_RTHASH_SIZE,
M_DEVBUF, M_WAITOK);
for (i = 0; i < BRIDGE_RTHASH_SIZE; i++)
LIST_INIT(&sc->sc_rthashs[cpu][i]);
}
sc->sc_rthash_key = karc4random();
sc->sc_rtlists =
kmalloc(sizeof(struct bridge_rtnode_head) * netisr_ncpus,
M_DEVBUF, M_WAITOK);
for (cpu = 0; cpu < netisr_ncpus; ++cpu)
LIST_INIT(&sc->sc_rtlists[cpu]);
}
static void
bridge_rtable_fini(struct bridge_softc *sc)
{
int cpu;
for (cpu = 0; cpu < netisr_ncpus; ++cpu)
kfree(sc->sc_rthashs[cpu], M_DEVBUF);
kfree(sc->sc_rthashs, M_DEVBUF);
kfree(sc->sc_rtlists, M_DEVBUF);
}
#define mix(a, b, c) \
do { \
a -= b; a -= c; a ^= (c >> 13); \
b -= c; b -= a; b ^= (a << 8); \
c -= a; c -= b; c ^= (b >> 13); \
a -= b; a -= c; a ^= (c >> 12); \
b -= c; b -= a; b ^= (a << 16); \
c -= a; c -= b; c ^= (b >> 5); \
a -= b; a -= c; a ^= (c >> 3); \
b -= c; b -= a; b ^= (a << 10); \
c -= a; c -= b; c ^= (b >> 15); \
} while (0)
static __inline uint32_t
bridge_rthash(struct bridge_softc *sc, const uint8_t *addr)
{
uint32_t a = 0x9e3779b9, b = 0x9e3779b9, c = sc->sc_rthash_key;
b += addr[5] << 8;
b += addr[4];
a += addr[3] << 24;
a += addr[2] << 16;
a += addr[1] << 8;
a += addr[0];
mix(a, b, c);
return (c & BRIDGE_RTHASH_MASK);
}
#undef mix
static int
bridge_rtnode_addr_cmp(const uint8_t *a, const uint8_t *b)
{
int i, d;
for (i = 0, d = 0; i < ETHER_ADDR_LEN && d == 0; i++) {
d = ((int)a[i]) - ((int)b[i]);
}
return (d);
}
static struct bridge_rtnode *
bridge_rtnode_lookup(struct bridge_softc *sc, const uint8_t *addr)
{
struct bridge_rtnode *brt;
uint32_t hash;
int dir;
hash = bridge_rthash(sc, addr);
LIST_FOREACH(brt, &sc->sc_rthashs[mycpuid][hash], brt_hash) {
dir = bridge_rtnode_addr_cmp(addr, brt->brt_addr);
if (dir == 0)
return (brt);
if (dir > 0)
return (NULL);
}
return (NULL);
}
static void
bridge_rtnode_insert(struct bridge_softc *sc, struct bridge_rtnode *brt)
{
struct bridge_rtnode *lbrt;
uint32_t hash;
int dir;
hash = bridge_rthash(sc, brt->brt_addr);
lbrt = LIST_FIRST(&sc->sc_rthashs[mycpuid][hash]);
if (lbrt == NULL) {
LIST_INSERT_HEAD(&sc->sc_rthashs[mycpuid][hash],
brt, brt_hash);
goto out;
}
do {
dir = bridge_rtnode_addr_cmp(brt->brt_addr, lbrt->brt_addr);
KASSERT(dir != 0, ("rtnode already exist"));
if (dir > 0) {
LIST_INSERT_BEFORE(lbrt, brt, brt_hash);
goto out;
}
if (LIST_NEXT(lbrt, brt_hash) == NULL) {
LIST_INSERT_AFTER(lbrt, brt, brt_hash);
goto out;
}
lbrt = LIST_NEXT(lbrt, brt_hash);
} while (lbrt != NULL);
panic("no suitable position found for rtnode");
out:
LIST_INSERT_HEAD(&sc->sc_rtlists[mycpuid], brt, brt_list);
if (mycpuid == 0) {
sc->sc_brtcnt++;
}
}
static void
bridge_rtnode_destroy(struct bridge_softc *sc, struct bridge_rtnode *brt)
{
struct bridge_rtinfo *bri;
LIST_REMOVE(brt, brt_hash);
LIST_REMOVE(brt, brt_list);
bri = brt->brt_info;
if (atomic_fetchadd_int(&bri->bri_refs, -1) == 1) {
kfree(bri, M_DEVBUF);
brt->brt_info = NULL;
}
kfree(brt, M_DEVBUF);
if (mycpuid == 0) {
sc->sc_brtcnt--;
}
}
static __inline int
bridge_post_pfil(struct mbuf *m)
{
if (m->m_pkthdr.fw_flags & IPFORWARD_MBUF_TAGGED)
return EOPNOTSUPP;
if (m->m_pkthdr.fw_flags & DUMMYNET_MBUF_TAGGED)
return EOPNOTSUPP;
return 0;
}
static int
bridge_pfil(struct mbuf **mp, struct ifnet *bifp, struct ifnet *ifp, int dir)
{
int snap, error, i, hlen;
struct ether_header *eh1, eh2;
struct ip *ip;
struct llc llc1;
u_int16_t ether_type;
snap = 0;
error = -1;
if (pfil_bridge == 0 && pfil_member == 0)
return (0);
i = min((*mp)->m_pkthdr.len, max_protohdr);
if ((*mp)->m_len < i) {
*mp = m_pullup(*mp, i);
if (*mp == NULL) {
kprintf("%s: m_pullup failed\n", __func__);
return (-1);
}
}
eh1 = mtod(*mp, struct ether_header *);
ether_type = ntohs(eh1->ether_type);
if (ether_type < ETHERMTU) {
struct llc *llc2 = (struct llc *)(eh1 + 1);
if ((*mp)->m_len >= ETHER_HDR_LEN + 8 &&
llc2->llc_dsap == LLC_SNAP_LSAP &&
llc2->llc_ssap == LLC_SNAP_LSAP &&
llc2->llc_control == LLC_UI) {
ether_type = htons(llc2->llc_un.type_snap.ether_type);
snap = 1;
}
}
switch (ether_type) {
case ETHERTYPE_ARP:
case ETHERTYPE_REVARP:
return (0);
case ETHERTYPE_IP:
#ifdef INET6
case ETHERTYPE_IPV6:
#endif
break;
default:
if (pfil_onlyip)
goto bad;
}
m_copydata(*mp, 0, ETHER_HDR_LEN, &eh2);
m_adj(*mp, ETHER_HDR_LEN);
if (snap) {
m_copydata(*mp, 0, sizeof(struct llc), &llc1);
m_adj(*mp, sizeof(struct llc));
}
if (dir == PFIL_IN) {
switch (ether_type) {
case ETHERTYPE_IP:
error = bridge_ip_checkbasic(mp);
break;
#ifdef INET6
case ETHERTYPE_IPV6:
error = bridge_ip6_checkbasic(mp);
break;
#endif
default:
error = 0;
}
if (error)
goto bad;
}
error = 0;
switch (ether_type) {
case ETHERTYPE_IP:
if (pfil_bridge && dir == PFIL_OUT && bifp != NULL) {
error = pfil_run_hooks(&inet_pfil_hook, mp, bifp, dir);
if (*mp == NULL || error != 0)
break;
error = bridge_post_pfil(*mp);
if (error)
break;
}
if (pfil_member && ifp != NULL) {
error = pfil_run_hooks(&inet_pfil_hook, mp, ifp, dir);
if (*mp == NULL || error != 0)
break;
error = bridge_post_pfil(*mp);
if (error)
break;
}
if (pfil_bridge && dir == PFIL_IN && bifp != NULL) {
error = pfil_run_hooks(&inet_pfil_hook, mp, bifp, dir);
if (*mp == NULL || error != 0)
break;
error = bridge_post_pfil(*mp);
if (error)
break;
}
if (pfil_member && ifp != NULL && dir == PFIL_OUT) {
i = (*mp)->m_pkthdr.len;
if (i > ifp->if_mtu) {
error = bridge_fragment(ifp, *mp, &eh2, snap,
&llc1);
return (error);
}
}
ip = mtod(*mp, struct ip *);
hlen = ip->ip_hl << 2;
if (hlen < sizeof(struct ip))
goto bad;
if (hlen > (*mp)->m_len) {
if ((*mp = m_pullup(*mp, hlen)) == NULL)
goto bad;
ip = mtod(*mp, struct ip *);
if (ip == NULL)
goto bad;
}
ip->ip_sum = 0;
if (hlen == sizeof(struct ip))
ip->ip_sum = in_cksum_hdr(ip);
else
ip->ip_sum = in_cksum(*mp, hlen);
break;
#ifdef INET6
case ETHERTYPE_IPV6:
if (pfil_bridge && dir == PFIL_OUT && bifp != NULL)
error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
dir);
if (*mp == NULL || error != 0)
break;
if (pfil_member && ifp != NULL)
error = pfil_run_hooks(&inet6_pfil_hook, mp, ifp,
dir);
if (*mp == NULL || error != 0)
break;
if (pfil_bridge && dir == PFIL_IN && bifp != NULL)
error = pfil_run_hooks(&inet6_pfil_hook, mp, bifp,
dir);
break;
#endif
default:
error = 0;
break;
}
if (*mp == NULL)
return (error);
if (error != 0)
goto bad;
error = -1;
if (snap) {
M_PREPEND(*mp, sizeof(struct llc), M_NOWAIT);
if (*mp == NULL)
return (error);
bcopy(&llc1, mtod(*mp, caddr_t), sizeof(struct llc));
}
M_PREPEND(*mp, ETHER_HDR_LEN, M_NOWAIT);
if (*mp == NULL)
return (error);
bcopy(&eh2, mtod(*mp, caddr_t), ETHER_HDR_LEN);
return (0);
bad:
m_freem(*mp);
*mp = NULL;
return (error);
}
static int
bridge_ip_checkbasic(struct mbuf **mp)
{
struct mbuf *m = *mp;
struct ip *ip;
int len, hlen;
u_short sum;
if (*mp == NULL)
return (-1);
#if 0
if (IP_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) {
if ((m = m_copyup(m, sizeof(struct ip),
(max_linkhdr + 3) & ~3)) == NULL) {
ipstat.ips_toosmall++;
goto bad;
}
} else
#endif
#ifndef __predict_false
#define __predict_false(x) x
#endif
if (__predict_false(m->m_len < sizeof (struct ip))) {
if ((m = m_pullup(m, sizeof (struct ip))) == NULL) {
ipstat.ips_toosmall++;
goto bad;
}
}
ip = mtod(m, struct ip *);
if (ip == NULL) goto bad;
if (ip->ip_v != IPVERSION) {
ipstat.ips_badvers++;
goto bad;
}
hlen = ip->ip_hl << 2;
if (hlen < sizeof(struct ip)) {
ipstat.ips_badhlen++;
goto bad;
}
if (hlen > m->m_len) {
if ((m = m_pullup(m, hlen)) == NULL) {
ipstat.ips_badhlen++;
goto bad;
}
ip = mtod(m, struct ip *);
if (ip == NULL) goto bad;
}
if (m->m_pkthdr.csum_flags & CSUM_IP_CHECKED) {
sum = !(m->m_pkthdr.csum_flags & CSUM_IP_VALID);
} else {
if (hlen == sizeof(struct ip)) {
sum = in_cksum_hdr(ip);
} else {
sum = in_cksum(m, hlen);
}
}
if (sum) {
ipstat.ips_badsum++;
goto bad;
}
len = ntohs(ip->ip_len);
if (len < hlen) {
ipstat.ips_badlen++;
goto bad;
}
if (m->m_pkthdr.len < len) {
ipstat.ips_tooshort++;
goto bad;
}
*mp = m;
return (0);
bad:
*mp = m;
return (-1);
}
#ifdef INET6
static int
bridge_ip6_checkbasic(struct mbuf **mp)
{
struct mbuf *m = *mp;
struct ip6_hdr *ip6;
#if 0
if (IP6_HDR_ALIGNED_P(mtod(m, caddr_t)) == 0) {
struct ifnet *inifp = m->m_pkthdr.rcvif;
if ((m = m_copyup(m, sizeof(struct ip6_hdr),
(max_linkhdr + 3) & ~3)) == NULL) {
ip6stat.ip6s_toosmall++;
in6_ifstat_inc(inifp, ifs6_in_hdrerr);
goto bad;
}
} else
#endif
if (__predict_false(m->m_len < sizeof(struct ip6_hdr))) {
struct ifnet *inifp = m->m_pkthdr.rcvif;
if ((m = m_pullup(m, sizeof(struct ip6_hdr))) == NULL) {
ip6stat.ip6s_toosmall++;
in6_ifstat_inc(inifp, ifs6_in_hdrerr);
goto bad;
}
}
ip6 = mtod(m, struct ip6_hdr *);
if ((ip6->ip6_vfc & IPV6_VERSION_MASK) != IPV6_VERSION) {
ip6stat.ip6s_badvers++;
in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_hdrerr);
goto bad;
}
*mp = m;
return (0);
bad:
*mp = m;
return (-1);
}
#endif
static int
bridge_fragment(struct ifnet *ifp, struct mbuf *m, struct ether_header *eh,
int snap, struct llc *llc)
{
struct mbuf *m0;
struct ip *ip;
int error = -1;
if (m->m_len < sizeof(struct ip) &&
(m = m_pullup(m, sizeof(struct ip))) == NULL)
goto out;
ip = mtod(m, struct ip *);
error = ip_fragment(ip, &m, ifp->if_mtu, ifp->if_hwassist,
CSUM_DELAY_IP);
if (error)
goto out;
for (m0 = m; m0; m0 = m0->m_nextpkt) {
if (error == 0) {
if (snap) {
M_PREPEND(m0, sizeof(struct llc), M_NOWAIT);
if (m0 == NULL) {
error = ENOBUFS;
continue;
}
bcopy(llc, mtod(m0, caddr_t),
sizeof(struct llc));
}
M_PREPEND(m0, ETHER_HDR_LEN, M_NOWAIT);
if (m0 == NULL) {
error = ENOBUFS;
continue;
}
bcopy(eh, mtod(m0, caddr_t), ETHER_HDR_LEN);
} else
m_freem(m);
}
if (error == 0)
ipstat.ips_fragmented++;
return (error);
out:
if (m != NULL)
m_freem(m);
return (error);
}
static void
bridge_enqueue_handler(netmsg_t msg)
{
struct netmsg_packet *nmp;
struct ifnet *dst_ifp;
struct mbuf *m;
nmp = &msg->packet;
m = nmp->nm_packet;
dst_ifp = nmp->base.lmsg.u.ms_resultp;
mbuftrackid(m, 71);
bridge_handoff(dst_ifp->if_bridge, dst_ifp, m, 1);
}
static void
bridge_handoff(struct bridge_softc *sc, struct ifnet *dst_ifp,
struct mbuf *m, int from_us)
{
struct mbuf *m0;
struct ifnet *bifp;
bifp = sc->sc_ifp;
mbuftrackid(m, 72);
for (; m; m = m0) {
struct altq_pktattr pktattr;
m0 = m->m_nextpkt;
m->m_nextpkt = NULL;
if (from_us || m->m_pkthdr.rcvif == dst_ifp) {
m_copyback(m,
offsetof(struct ether_header, ether_shost),
ETHER_ADDR_LEN, IF_LLADDR(sc->sc_ifp));
} else if ((bifp->if_flags & IFF_LINK0) &&
(m->m_pkthdr.fw_flags & BRIDGE_MBUF_TAGGED)) {
m_copyback(m,
offsetof(struct ether_header, ether_shost),
ETHER_ADDR_LEN,
m->m_pkthdr.ether_br_shost);
}
if (ifq_is_enabled(&dst_ifp->if_snd))
altq_etherclassify(&dst_ifp->if_snd, m, &pktattr);
ifq_dispatch(dst_ifp, m, &pktattr);
}
}
static void
bridge_control_dispatch(netmsg_t msg)
{
struct netmsg_brctl *bc_msg = (struct netmsg_brctl *)msg;
struct ifnet *bifp = bc_msg->bc_sc->sc_ifp;
int error;
ifnet_serialize_all(bifp);
error = bc_msg->bc_func(bc_msg->bc_sc, bc_msg->bc_arg);
ifnet_deserialize_all(bifp);
lwkt_replymsg(&bc_msg->base.lmsg, error);
}
static int
bridge_control(struct bridge_softc *sc, u_long cmd,
bridge_ctl_t bc_func, void *bc_arg)
{
struct ifnet *bifp = sc->sc_ifp;
struct netmsg_brctl bc_msg;
int error;
ASSERT_IFNET_SERIALIZED_ALL(bifp);
bzero(&bc_msg, sizeof(bc_msg));
netmsg_init(&bc_msg.base, NULL, &curthread->td_msgport,
0, bridge_control_dispatch);
bc_msg.bc_func = bc_func;
bc_msg.bc_sc = sc;
bc_msg.bc_arg = bc_arg;
ifnet_deserialize_all(bifp);
error = lwkt_domsg(BRIDGE_CFGPORT, &bc_msg.base.lmsg, 0);
ifnet_serialize_all(bifp);
return error;
}
static void
bridge_add_bif_handler(netmsg_t msg)
{
struct netmsg_braddbif *amsg = (struct netmsg_braddbif *)msg;
struct bridge_softc *sc;
struct bridge_iflist *bif;
sc = amsg->br_softc;
bif = kmalloc(sizeof(*bif), M_DEVBUF, M_WAITOK | M_ZERO);
bif->bif_ifp = amsg->br_bif_ifp;
bif->bif_onlist = 1;
bif->bif_info = amsg->br_bif_info;
bif->bif_flags = IFBIF_LEARNING | IFBIF_DISCOVER;
TAILQ_INSERT_HEAD(&sc->sc_iflists[mycpuid], bif, bif_next);
netisr_forwardmsg(&amsg->base, mycpuid + 1);
}
static void
bridge_add_bif(struct bridge_softc *sc, struct bridge_ifinfo *bif_info,
struct ifnet *ifp)
{
struct netmsg_braddbif amsg;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
netmsg_init(&amsg.base, NULL, &curthread->td_msgport,
0, bridge_add_bif_handler);
amsg.br_softc = sc;
amsg.br_bif_info = bif_info;
amsg.br_bif_ifp = ifp;
netisr_domsg(&amsg.base, 0);
}
static void
bridge_del_bif_handler(netmsg_t msg)
{
struct netmsg_brdelbif *dmsg = (struct netmsg_brdelbif *)msg;
struct bridge_softc *sc;
struct bridge_iflist *bif;
sc = dmsg->br_softc;
bif = bridge_lookup_member_ifinfo(sc, dmsg->br_bif_info);
KKASSERT(bif != NULL && bif->bif_onlist);
bif->bif_onlist = 0;
TAILQ_REMOVE(dmsg->br_bif_list, bif, bif_next);
TAILQ_INSERT_HEAD(dmsg->br_bif_list, bif, bif_next);
netisr_forwardmsg(&dmsg->base, mycpuid + 1);
}
static void
bridge_del_bif(struct bridge_softc *sc, struct bridge_ifinfo *bif_info,
struct bridge_iflist_head *saved_bifs)
{
struct netmsg_brdelbif dmsg;
ASSERT_IFNET_NOT_SERIALIZED_ALL(sc->sc_ifp);
netmsg_init(&dmsg.base, NULL, &curthread->td_msgport,
0, bridge_del_bif_handler);
dmsg.br_softc = sc;
dmsg.br_bif_info = bif_info;
dmsg.br_bif_list = saved_bifs;
netisr_domsg(&dmsg.base, 0);
}