#include <sys/param.h>
#include <sys/mbuf.h>
#include <sys/malloc.h>
#include <sys/systm.h>
#include <sys/socket.h>
#include <sys/kernel.h>
#include <sys/sysctl.h>
#include <net/if.h>
#include <net/if_types.h>
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/if_ether.h>
#include "opt_ipfw.h"
#include "opt_ipdn.h"
#if defined(IPFIREWALL) && defined(DUMMYNET)
#include <net/route.h>
#include <netinet/ip_fw.h>
#include <netinet/ip_dummynet.h>
#endif
#include <net/bridge.h>
#define DDB(x) x
#define DEB(x)
static void bdginit(void *);
static void flush_table(void);
SYSINIT(interfaces, SI_SUB_PROTO_IF, SI_ORDER_FIRST, bdginit, NULL)
static int bdg_ipfw = 0 ;
int do_bridge = 0;
bdg_hash_table *bdg_table = NULL ;
struct bdg_softc {
struct ifnet *ifp ;
int flags ;
int group ;
} ;
static struct bdg_softc **ifp2sc = NULL ;
#if 0
#define SAMEGROUP(ifp,src) (src == NULL || \
ifp2sc[ifp->if_index]->group == ifp2sc[src->if_index]->group )
#define MUTED(ifp) (ifp2sc[ifp->if_index]->flags & IFF_MUTE)
#define MUTE(ifp) ifp2sc[ifp->if_index]->flags |= IFF_MUTE
#define UNMUTE(ifp) ifp2sc[ifp->if_index]->flags &= ~IFF_MUTE
#else
#define SAMEGROUP(a,b) 1
#define MUTED(ifp) (ifp->if_flags & IFF_MUTE)
#define MUTE(ifp) ifp->if_flags |= IFF_MUTE
#define UNMUTE(ifp) ifp->if_flags &= ~IFF_MUTE
#endif
static int
sysctl_bdg SYSCTL_HANDLER_ARGS
{
int error, oldval = do_bridge ;
error = sysctl_handle_int(oidp,
oidp->oid_arg1, oidp->oid_arg2, req);
printf("called sysctl for bridge name %s arg2 %d val %d->%d\n",
oidp->oid_name, oidp->oid_arg2,
oldval, do_bridge);
if (bdg_table == NULL)
do_bridge = 0 ;
if (oldval != do_bridge) {
flush_table();
}
return error ;
}
SYSCTL_DECL(_net_link_ether);
SYSCTL_PROC(_net_link_ether, OID_AUTO, bridge, CTLTYPE_INT|CTLFLAG_RW,
&do_bridge, 0, &sysctl_bdg, "I", "Bridging");
SYSCTL_INT(_net_link_ether, OID_AUTO, bridge_ipfw, CTLFLAG_RW, &bdg_ipfw,0,"");
#if 1
int bdg_in_count = 0 , bdg_in_ticks = 0 , bdg_fw_count = 0, bdg_fw_ticks = 0 ;
SYSCTL_INT(_net_link_ether, OID_AUTO, bdginc, CTLFLAG_RW, &bdg_in_count,0,"");
SYSCTL_INT(_net_link_ether, OID_AUTO, bdgint, CTLFLAG_RW, &bdg_in_ticks,0,"");
SYSCTL_INT(_net_link_ether, OID_AUTO, bdgfwc, CTLFLAG_RW, &bdg_fw_count,0,"");
SYSCTL_INT(_net_link_ether, OID_AUTO, bdgfwt, CTLFLAG_RW, &bdg_fw_ticks,0,"");
#endif
static struct bdg_stats bdg_stats ;
SYSCTL_STRUCT(_net_link_ether, PF_BDG, bdgstats,
CTLFLAG_RD, &bdg_stats , bdg_stats, "bridge statistics");
static int bdg_loops ;
static void
flush_table()
{
int s,i;
if (bdg_table == NULL)
return ;
s = splimp();
for (i=0; i< HASH_SIZE; i++)
bdg_table[i].name= NULL;
splx(s);
}
void
bdg_timeout_funneled(void * dummy)
{
boolean_t funnel_state;
funnel_state = thread_funnel_set(network_flock, TRUE);
bdg_timeout(dummy);
funnel_state = thread_funnel_set(network_flock, FALSE);
}
static void
bdg_timeout(void *dummy)
{
struct ifnet *ifp ;
int s ;
static int slowtimer = 0 ;
boolean_t funnel_state;
if (do_bridge) {
static int age_index = 0 ;
int l = age_index + HASH_SIZE/4 ;
if (l > HASH_SIZE)
l = HASH_SIZE ;
for (; age_index < l ; age_index++)
if (bdg_table[age_index].used)
bdg_table[age_index].used = 0 ;
else if (bdg_table[age_index].name) {
bdg_table[age_index].name = NULL ;
}
if (age_index >= HASH_SIZE)
age_index = 0 ;
if (--slowtimer <= 0 ) {
slowtimer = 5 ;
for (ifp = ifnet.tqh_first; ifp; ifp = ifp->if_link.tqe_next) {
if (ifp->if_type != IFT_ETHER)
continue ;
if ( 0 == ( ifp->if_flags & IFF_UP) ) {
s = splimp();
if_up(ifp);
splx(s);
}
if ( 0 == ( ifp->if_flags & IFF_PROMISC) ) {
int ret ;
s = splimp();
ret = ifpromisc(ifp, 1);
splx(s);
printf(">> now %s%d flags 0x%x promisc %d\n",
ifp->if_name, ifp->if_unit,
ifp->if_flags, ret);
}
if (MUTED(ifp)) {
printf(">> unmuting %s%d\n", ifp->if_name, ifp->if_unit);
UNMUTE(ifp) ;
}
}
bdg_loops = 0 ;
}
}
timeout(bdg_timeout_funneled, (void *)0, 2*hz );
}
unsigned char bdg_addresses[6*BDG_MAX_PORTS];
int bdg_ports ;
static void
bdginit(dummy)
void *dummy;
{
int i ;
struct ifnet *ifp;
struct arpcom *ac ;
u_char *eth_addr ;
if (bdg_table == NULL)
bdg_table = (struct hash_table *)
_MALLOC(HASH_SIZE * sizeof(struct hash_table),
M_IFADDR, M_WAITOK);
if (bdg_table == NULL)
return (ENOBUFS);
flush_table();
ifp2sc = _MALLOC(if_index * sizeof(struct bdg_softc *), M_IFADDR, M_WAITOK );
if (ifp2sc == NULL)
return (ENOBUFS);
bzero(ifp2sc, if_index * sizeof(struct bdg_softc *) );
bzero(&bdg_stats, sizeof(bdg_stats) );
bdg_ports = 0 ;
eth_addr = bdg_addresses ;
printf("BRIDGE 981214, have %d interfaces\n", if_index);
for (i = 0 , ifp = ifnet.tqh_first ; i < if_index ;
i++, ifp = ifp->if_link.tqe_next)
if (ifp->if_type == IFT_ETHER) {
ac = (struct arpcom *)ifp;
sprintf(bdg_stats.s[ifp->if_index].name,
"%s%d", ifp->if_name, ifp->if_unit);
printf("-- index %d %s type %d phy %d addrl %d addr %6D\n",
ifp->if_index,
bdg_stats.s[ifp->if_index].name,
(int)ifp->if_type, (int) ifp->if_physical,
(int)ifp->if_addrlen,
ac->ac_enaddr, "." );
bcopy(ac->ac_enaddr, eth_addr, 6);
eth_addr += 6 ;
ifp2sc[bdg_ports] = _MALLOC(sizeof(struct bdg_softc),
M_IFADDR, M_WAITOK );
if (ifp2sc[bdg_ports] == NULL)
return (ENOBUFS);
ifp2sc[bdg_ports]->ifp = ifp ;
ifp2sc[bdg_ports]->flags = 0 ;
ifp2sc[bdg_ports]->group = 0 ;
bdg_ports ++ ;
}
bdg_timeout(0);
do_bridge=0;
}
struct ifnet *
bridge_in(struct mbuf *m)
{
int index;
struct ifnet *ifp = m->m_pkthdr.rcvif, *dst , *old ;
int dropit = MUTED(ifp) ;
struct ether_header *eh;
eh = mtod(m, struct ether_header *);
index= HASH_FN(eh->ether_shost);
bdg_table[index].used = 1 ;
old = bdg_table[index].name ;
if ( old ) {
if (!BDG_MATCH( eh->ether_shost, bdg_table[index].etheraddr) ) {
printf("collision at %d\n", index);
bdg_table[index].name = NULL ;
} else if (old != ifp) {
bdg_table[index].name = ifp ;
printf("-- loop (%d) %6D to %s%d from %s%d (%s)\n",
bdg_loops, eh->ether_shost, ".",
ifp->if_name, ifp->if_unit,
old->if_name, old->if_unit,
old->if_flags & IFF_MUTE ? "muted":"ignore");
dropit = 1 ;
if ( !MUTED(old) ) {
if (++bdg_loops > 10)
MUTE(old) ;
}
}
}
if (bdg_table[index].name == NULL) {
DEB(printf("new addr %6D at %d for %s%d\n",
eh->ether_shost, ".", index, ifp->if_name, ifp->if_unit);)
bcopy(eh->ether_shost, bdg_table[index].etheraddr, 6);
bdg_table[index].name = ifp ;
}
dst = bridge_dst_lookup(m);
BDG_STAT(ifp, BDG_IN);
switch ((int)dst) {
case (int)BDG_BCAST:
case (int)BDG_MCAST:
case (int)BDG_LOCAL:
case (int)BDG_UNKNOWN:
case (int)BDG_DROP:
BDG_STAT(ifp, dst);
break ;
default :
if (dst == ifp || dropit )
BDG_STAT(ifp, BDG_DROP);
else
BDG_STAT(ifp, BDG_FORWARD);
break ;
}
if ( dropit ) {
if (dst == BDG_BCAST || dst == BDG_MCAST || dst == BDG_LOCAL)
return BDG_LOCAL ;
else
return BDG_DROP ;
} else {
return (dst == ifp ? BDG_DROP : dst ) ;
}
}
int
bdg_forward (struct mbuf **m0, struct ifnet *dst)
{
struct ifnet *src = (*m0)->m_pkthdr.rcvif;
struct ifnet *ifp ;
struct ip *ip;
int error=0, s ;
int once = 0;
int canfree = 1 ;
struct mbuf *m ;
struct ether_header *eh = mtod(*m0, struct ether_header *);
if (dst == BDG_DROP) {
printf("xx bdg_forward for BDG_DROP)\n");
m_freem(*m0) ;
*m0 = NULL ;
return 0;
}
if (dst == BDG_LOCAL) {
printf("xx ouch, bdg_forward for local pkt\n");
return 0;
}
if (dst == BDG_BCAST || dst == BDG_MCAST || dst == BDG_UNKNOWN) {
ifp = ifnet.tqh_first ;
once = 0 ;
if (dst != BDG_UNKNOWN)
canfree = 0 ;
} else {
ifp = dst ;
once = 1 ;
}
#if IPFIREWALL
if (ip_fw_chk_ptr) {
u_int16_t dummy ;
struct ip_fw_chain *rule;
int off;
m = *m0 ;
if (m->m_type == MT_DUMMYNET) {
rule = (struct ip_fw_chain *)(m->m_data) ;
(*m0) = m = m->m_next ;
src = m->m_pkthdr.rcvif;
eh = mtod(m, struct ether_header *);
canfree = 1 ;
goto forward;
} else
rule = NULL ;
if (bdg_ipfw == 0)
goto forward ;
if (src == NULL)
goto forward ;
if (canfree == 0 )
m = m_copypacket(*m0, M_DONTWAIT);
if (m == NULL) {
return 0 ;
}
dummy = 0 ;
eh = mtod(m, struct ether_header *);
ip = (struct ip *)(eh + 1 ) ;
NTOHS(ip->ip_len);
NTOHS(ip->ip_id);
NTOHS(ip->ip_off);
off = (*ip_fw_chk_ptr)(NULL, 0, NULL, &dummy, &m, &rule, NULL) ;
if (m == NULL) {
if (canfree)
*m0 = NULL ;
return 0 ;
}
eh = mtod(m, struct ether_header *);
ip = (struct ip *)(eh + 1 ) ;
if (canfree)
*m0 = m ;
HTONS(ip->ip_len);
HTONS(ip->ip_id);
HTONS(ip->ip_off);
if (off == 0) {
if (canfree == 0)
m_freem(m);
goto forward ;
}
#if DUMMYNET
if (off & 0x10000) {
dummynet_io((off & 0xffff), DN_TO_BDG_FWD, m, dst, NULL, 0, rule);
if (canfree)
*m0 = NULL ;
return 0 ;
}
#endif
if (m)
m_freem(m);
if (canfree && m != *m0) {
m_freem(*m0);
*m0 = NULL ;
}
return 0 ;
}
forward:
#endif
if (canfree && once)
m = *m0 ;
else
m = NULL ;
for ( ; ifp ; ifp = ifp->if_link.tqe_next ) {
if (ifp != src && ifp->if_type == IFT_ETHER &&
(ifp->if_flags & (IFF_UP|IFF_RUNNING)) == (IFF_UP|IFF_RUNNING) &&
SAMEGROUP(ifp, src) && !MUTED(ifp) ) {
if (m == NULL) {
if (canfree && ifp->if_link.tqe_next == NULL)
m = *m0 ;
else
m = m_copypacket(*m0, M_DONTWAIT);
if (m == NULL) {
printf("bdg_forward: sorry, m_copy failed!\n");
return ENOBUFS ;
}
}
s = splimp();
if (IF_QFULL(&ifp->if_snd)) {
IF_DROP(&ifp->if_snd);
MUTE(ifp);
splx(s);
error = ENOBUFS ;
} else {
ifp->if_obytes += m->m_pkthdr.len ;
if (m->m_flags & M_MCAST)
ifp->if_omcasts++;
IF_ENQUEUE(&ifp->if_snd, m);
if ((ifp->if_flags & IFF_OACTIVE) == 0)
(*ifp->if_start)(ifp);
splx(s);
if (m == *m0)
*m0 = NULL ;
m = NULL ;
}
BDG_STAT(ifp, BDG_OUT);
}
if (once)
break ;
}
if (m)
m_freem(m);
if (m == *m0)
*m0 = NULL ;
if (canfree && *m0) {
m_freem(*m0);
*m0 = NULL ;
}
return error ;
}