#undef SN_DEBUG
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/interrupt.h>
#include <sys/errno.h>
#include <sys/sockio.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/syslog.h>
#include <sys/serialize.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <net/ethernet.h>
#include <net/if.h>
#include <net/ifq_var.h>
#include <net/if_arp.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/if_mib.h>
#include <net/bpf.h>
#include <net/bpfdesc.h>
#include <machine/clock.h>
#include "if_snreg.h"
#include "if_snvar.h"
devclass_t sn_devclass;
static int snioctl(struct ifnet * ifp, u_long, caddr_t, struct ucred *);
static void snresume(struct ifnet *);
void sninit(void *);
void snread(struct ifnet *);
void snreset(struct sn_softc *);
void snstart(struct ifnet *, struct ifaltq_subque *);
void snstop(struct sn_softc *);
void snwatchdog(struct ifnet *);
static void sn_setmcast(struct sn_softc *);
static int sn_getmcf(struct arpcom *ac, u_char *mcf);
static u_int smc_crc(u_char *);
DECLARE_DUMMY_MODULE(if_sn);
#define SW_PAD
static const char *chip_ids[15] = {
NULL, NULL, NULL,
"SMC91C90/91C92",
"SMC91C94",
"SMC91C95",
NULL,
"SMC91C100",
"SMC91C100FD",
NULL, NULL, NULL,
NULL, NULL, NULL
};
int
sn_attach(device_t dev)
{
struct sn_softc *sc = device_get_softc(dev);
struct ifnet *ifp = &sc->arpcom.ac_if;
u_short i;
u_char *p;
int rev;
u_short address;
int j;
int error;
sn_activate(dev);
snstop(sc);
sc->dev = dev;
sc->pages_wanted = -1;
device_printf(dev, " ");
SMC_SELECT_BANK(3);
rev = inw(BASE + REVISION_REG_W);
if (chip_ids[(rev >> 4) & 0xF])
kprintf("%s ", chip_ids[(rev >> 4) & 0xF]);
SMC_SELECT_BANK(1);
i = inw(BASE + CONFIG_REG_W);
kprintf("%s\n", i & CR_AUI_SELECT ? "AUI" : "UTP");
if (sc->pccard_enaddr)
for (j = 0; j < 3; j++) {
u_short w;
w = (u_short)sc->arpcom.ac_enaddr[j * 2] |
(((u_short)sc->arpcom.ac_enaddr[j * 2 + 1]) << 8);
outw(BASE + IAR_ADDR0_REG_W + j * 2, w);
}
SMC_SELECT_BANK(1);
p = (u_char *) & sc->arpcom.ac_enaddr;
for (i = 0; i < 6; i += 2) {
address = inw(BASE + IAR_ADDR0_REG_W + i);
p[i + 1] = address >> 8;
p[i] = address & 0xFF;
}
ifp->if_softc = sc;
if_initname(ifp, "sn", device_get_unit(dev));
ifp->if_mtu = ETHERMTU;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
ifp->if_start = snstart;
ifp->if_ioctl = snioctl;
ifp->if_watchdog = snwatchdog;
ifp->if_init = sninit;
ifq_set_maxlen(&ifp->if_snd, IFQ_MAXLEN);
ifq_set_ready(&ifp->if_snd);
ifp->if_timer = 0;
ether_ifattach(ifp, sc->arpcom.ac_enaddr, NULL);
ifq_set_cpuid(&ifp->if_snd, rman_get_cpuid(sc->irq_res));
error = bus_setup_intr(dev, sc->irq_res, INTR_MPSAFE,
sn_intr, sc, &sc->intrhand,
ifp->if_serializer);
if (error) {
ether_ifdetach(ifp);
sn_deactivate(dev);
return error;
}
return 0;
}
void
sninit(void *xsc)
{
struct sn_softc *sc = xsc;
struct ifnet *ifp = &sc->arpcom.ac_if;
int flags;
int mask;
SMC_SELECT_BANK(0);
outw(BASE + RECV_CONTROL_REG_W, RCR_SOFTRESET);
SMC_DELAY();
outw(BASE + RECV_CONTROL_REG_W, 0x0000);
SMC_DELAY();
SMC_DELAY();
outw(BASE + TXMIT_CONTROL_REG_W, 0x0000);
SMC_SELECT_BANK(1);
outw(BASE + CONTROL_REG_W, (CTR_AUTO_RELEASE | CTR_TE_ENABLE |
CTR_CR_ENABLE | CTR_LE_ENABLE));
flags = inw(BASE + CONFIG_REG_W);
flags |= CR_SET_SQLCH;
outw(BASE + CONFIG_REG_W, flags);
SMC_SELECT_BANK(2);
outw(BASE + MMU_CMD_REG_W, MMUCR_RESET);
while (inw(BASE + MMU_CMD_REG_W) & MMUCR_BUSY)
;
outb(BASE + INTR_MASK_REG_B, 0x00);
sn_setmcast(sc);
flags = TCR_ENABLE;
#ifndef SW_PAD
flags |= TCR_PAD_ENABLE;
#endif
outw(BASE + TXMIT_CONTROL_REG_W, flags);
SMC_SELECT_BANK(2);
mask = IM_EPH_INT |
IM_RX_OVRN_INT |
IM_RCV_INT |
IM_TX_INT;
outb(BASE + INTR_MASK_REG_B, mask);
sc->intr_mask = mask;
sc->pages_wanted = -1;
ifp->if_flags |= IFF_RUNNING;
ifq_clr_oactive(&ifp->if_snd);
if_devstart(ifp);
}
void
snstart(struct ifnet *ifp, struct ifaltq_subque *ifsq)
{
struct sn_softc *sc = ifp->if_softc;
u_int len;
struct mbuf *m;
struct mbuf *top;
int pad;
int mask;
u_short length;
u_short numPages;
u_char packet_no;
int time_out;
ASSERT_ALTQ_SQ_DEFAULT(ifp, ifsq);
if ((ifp->if_flags & IFF_RUNNING) == 0 || ifq_is_oactive(&ifp->if_snd))
return;
if (sc->pages_wanted != -1) {
kprintf("%s: snstart() while memory allocation pending\n",
ifp->if_xname);
ifq_set_oactive(&ifp->if_snd);
return;
}
startagain:
m = ifq_dequeue(&ifp->if_snd);
if (m == NULL)
return;
for (len = 0, top = m; m; m = m->m_next)
len += m->m_len;
pad = (len & 1);
if (len + pad > ETHER_MAX_LEN - ETHER_CRC_LEN) {
kprintf("%s: large packet discarded (A)\n", ifp->if_xname);
IFNET_STAT_INC(&sc->arpcom.ac_if, oerrors, 1);
m_freem(top);
goto readcheck;
}
#ifdef SW_PAD
if (len < ETHER_MIN_LEN - ETHER_CRC_LEN)
pad = ETHER_MIN_LEN - ETHER_CRC_LEN - len;
#endif
length = pad + len;
numPages = (length + 6) >> 8;
SMC_SELECT_BANK(2);
outw(BASE + MMU_CMD_REG_W, MMUCR_ALLOC | numPages);
time_out = MEMORY_WAIT_TIME;
do {
if (inb(BASE + INTR_STAT_REG_B) & IM_ALLOC_INT)
break;
} while (--time_out);
if (!time_out) {
mask = inb(BASE + INTR_MASK_REG_B) | IM_ALLOC_INT;
outb(BASE + INTR_MASK_REG_B, mask);
sc->intr_mask = mask;
ifp->if_timer = 1;
ifq_set_oactive(&ifp->if_snd);
sc->pages_wanted = numPages;
ifq_prepend(&ifp->if_snd, top);
return;
}
packet_no = inb(BASE + ALLOC_RESULT_REG_B);
if (packet_no & ARR_FAILED) {
kprintf("%s: Memory allocation failed\n", ifp->if_xname);
ifq_prepend(&ifp->if_snd, top);
goto startagain;
}
outb(BASE + PACKET_NUM_REG_B, packet_no);
outw(BASE + POINTER_REG_W, PTR_AUTOINC | 0x0000);
outw(BASE + DATA_REG_W, 0);
outb(BASE + DATA_REG_B, (length + 6) & 0xFF);
outb(BASE + DATA_REG_B, (length + 6) >> 8);
for (m = top; m != NULL; m = m->m_next) {
outsw(BASE + DATA_REG_W, mtod(m, caddr_t), m->m_len / 2);
if (m->m_len & 1)
outb(BASE + DATA_REG_B, *(mtod(m, caddr_t) + m->m_len - 1));
}
while (pad > 1) {
outw(BASE + DATA_REG_W, 0);
pad -= 2;
}
if (pad)
outb(BASE + DATA_REG_B, 0);
outw(BASE + DATA_REG_W, 0);
mask = inb(BASE + INTR_MASK_REG_B) | (IM_TX_INT | IM_TX_EMPTY_INT);
outb(BASE + INTR_MASK_REG_B, mask);
sc->intr_mask = mask;
outw(BASE + MMU_CMD_REG_W, MMUCR_ENQUEUE);
ifq_set_oactive(&ifp->if_snd);
ifp->if_timer = 1;
BPF_MTAP(ifp, top);
IFNET_STAT_INC(ifp, opackets, 1);
m_freem(top);
readcheck:
if (inw(BASE + FIFO_PORTS_REG_W) & FIFO_REMPTY)
goto startagain;
}
static void
snresume(struct ifnet *ifp)
{
struct sn_softc *sc = ifp->if_softc;
u_int len;
struct mbuf *m;
struct mbuf *top;
int pad;
int mask;
u_short length;
u_short numPages;
u_short pages_wanted;
u_char packet_no;
if (sc->pages_wanted < 0)
return;
pages_wanted = sc->pages_wanted;
sc->pages_wanted = -1;
m = ifq_dequeue(&ifp->if_snd);
if (m == NULL) {
kprintf("%s: snresume() with nothing to send\n",
ifp->if_xname);
return;
}
for (len = 0, top = m; m; m = m->m_next)
len += m->m_len;
pad = (len & 1);
if (len + pad > ETHER_MAX_LEN - ETHER_CRC_LEN) {
kprintf("%s: large packet discarded (B)\n", ifp->if_xname);
IFNET_STAT_INC(ifp, oerrors, 1);
m_freem(top);
return;
}
#ifdef SW_PAD
if (len < ETHER_MIN_LEN - ETHER_CRC_LEN)
pad = ETHER_MIN_LEN - ETHER_CRC_LEN - len;
#endif
length = pad + len;
numPages = (length + 6) >> 8;
SMC_SELECT_BANK(2);
packet_no = inb(BASE + ALLOC_RESULT_REG_B);
if (packet_no & ARR_FAILED) {
kprintf("%s: Memory allocation failed. Weird.\n", ifp->if_xname);
ifp->if_timer = 1;
ifq_prepend(&ifp->if_snd, top);
goto try_start;
}
outb(BASE + PACKET_NUM_REG_B, packet_no);
if (pages_wanted != numPages) {
kprintf("%s: memory allocation wrong size. Weird.\n", ifp->if_xname);
while (inw(BASE + MMU_CMD_REG_W) & MMUCR_BUSY)
;
outw(BASE + MMU_CMD_REG_W, MMUCR_FREEPKT);
ifq_prepend(&ifp->if_snd, top);
return;
}
outw(BASE + POINTER_REG_W, PTR_AUTOINC | 0x0000);
outw(BASE + DATA_REG_W, 0);
outb(BASE + DATA_REG_B, (length + 6) & 0xFF);
outb(BASE + DATA_REG_B, (length + 6) >> 8);
for (m = top; m != NULL; m = m->m_next) {
outsw(BASE + DATA_REG_W, mtod(m, caddr_t), m->m_len / 2);
if (m->m_len & 1)
outb(BASE + DATA_REG_B, *(mtod(m, caddr_t) + m->m_len - 1));
}
while (pad > 1) {
outw(BASE + DATA_REG_W, 0);
pad -= 2;
}
if (pad)
outb(BASE + DATA_REG_B, 0);
outw(BASE + DATA_REG_W, 0);
mask = inb(BASE + INTR_MASK_REG_B) | (IM_TX_INT | IM_TX_EMPTY_INT);
outb(BASE + INTR_MASK_REG_B, mask);
sc->intr_mask = mask;
outw(BASE + MMU_CMD_REG_W, MMUCR_ENQUEUE);
BPF_MTAP(ifp, top);
IFNET_STAT_INC(ifp, opackets, 1);
m_freem(top);
try_start:
ifq_clr_oactive(&ifp->if_snd);
if_devstart(ifp);
ifq_set_oactive(&ifp->if_snd);
ifp->if_timer = 1;
}
void
sn_intr(void *arg)
{
int status, interrupts;
struct sn_softc *sc = (struct sn_softc *) arg;
struct ifnet *ifp = &sc->arpcom.ac_if;
u_char mask;
u_char packet_no;
u_short tx_status;
u_short card_stats;
ifp->if_timer = 0;
SMC_SELECT_BANK(2);
mask = inb(BASE + INTR_MASK_REG_B);
outb(BASE + INTR_MASK_REG_B, 0x00);
interrupts = inb(BASE + INTR_STAT_REG_B);
status = interrupts & mask;
if (status & IM_RX_OVRN_INT) {
SMC_SELECT_BANK(2);
outb(BASE + INTR_ACK_REG_B, IM_RX_OVRN_INT);
IFNET_STAT_INC(&sc->arpcom.ac_if, ierrors, 1);
}
if (status & IM_RCV_INT) {
#if 1
int packet_number;
SMC_SELECT_BANK(2);
packet_number = inw(BASE + FIFO_PORTS_REG_W);
if (packet_number & FIFO_REMPTY) {
kprintf("sn: Receive interrupt with nothing on FIFO\n");
goto out;
}
#endif
snread(ifp);
}
if (status & IM_ALLOC_INT) {
mask &= ~IM_ALLOC_INT;
ifq_clr_oactive(&sc->arpcom.ac_if.if_snd);
snresume(&sc->arpcom.ac_if);
}
if (status & IM_TX_INT) {
SMC_SELECT_BANK(2);
outb(BASE + INTR_ACK_REG_B, IM_TX_INT);
packet_no = inw(BASE + FIFO_PORTS_REG_W);
packet_no &= FIFO_TX_MASK;
outb(BASE + PACKET_NUM_REG_B, packet_no);
outw(BASE + POINTER_REG_W, PTR_AUTOINC | PTR_READ | 0x0000);
tx_status = inw(BASE + DATA_REG_W);
if (tx_status & EPHSR_TX_SUC) {
device_printf(sc->dev,
"Successful packet caused interrupt\n");
} else {
IFNET_STAT_INC(&sc->arpcom.ac_if, oerrors, 1);
}
if (tx_status & EPHSR_LATCOL)
IFNET_STAT_INC(&sc->arpcom.ac_if, collisions, 1);
SMC_SELECT_BANK(0);
#ifdef SW_PAD
outw(BASE + TXMIT_CONTROL_REG_W, TCR_ENABLE);
#else
outw(BASE + TXMIT_CONTROL_REG_W, TCR_ENABLE | TCR_PAD_ENABLE);
#endif
SMC_SELECT_BANK(2);
while (inw(BASE + MMU_CMD_REG_W) & MMUCR_BUSY)
;
outw(BASE + MMU_CMD_REG_W, MMUCR_FREEPKT);
ifq_clr_oactive(&sc->arpcom.ac_if.if_snd);
if_devstart(&sc->arpcom.ac_if);
}
if (status & IM_TX_EMPTY_INT) {
SMC_SELECT_BANK(2);
outb(BASE + INTR_ACK_REG_B, IM_TX_EMPTY_INT);
mask &= ~IM_TX_EMPTY_INT;
SMC_SELECT_BANK(0);
card_stats = inw(BASE + COUNTER_REG_W);
IFNET_STAT_INC(&sc->arpcom.ac_if, collisions,
card_stats & ECR_COLN_MASK);
IFNET_STAT_INC(&sc->arpcom.ac_if, collisions,
(card_stats & ECR_MCOLN_MASK) >> 4);
SMC_SELECT_BANK(2);
ifq_clr_oactive(&sc->arpcom.ac_if.if_snd);
if_devstart(&sc->arpcom.ac_if);
}
if (status & IM_EPH_INT) {
snstop(sc);
sninit(sc);
}
out:
SMC_SELECT_BANK(2);
mask |= inb(BASE + INTR_MASK_REG_B);
outb(BASE + INTR_MASK_REG_B, mask);
sc->intr_mask = mask;
}
void
snread(struct ifnet *ifp)
{
struct sn_softc *sc = ifp->if_softc;
struct mbuf *m;
short status;
int packet_number;
u_short packet_length;
u_char *data;
SMC_SELECT_BANK(2);
#if 0
packet_number = inw(BASE + FIFO_PORTS_REG_W);
if (packet_number & FIFO_REMPTY) {
kprintf("sn: Receive interrupt with nothing on FIFO\n");
return;
}
#endif
read_another:
outw(BASE + POINTER_REG_W, PTR_READ | PTR_RCV | PTR_AUTOINC | 0x0000);
status = inw(BASE + DATA_REG_W);
packet_length = inw(BASE + DATA_REG_W) & RLEN_MASK;
packet_length -= 6;
if (status & RS_ERRORS) {
IFNET_STAT_INC(ifp, ierrors, 1);
goto out;
}
if (status & RS_ODDFRAME)
packet_length++;
MGETHDR(m, M_NOWAIT, MT_DATA);
if (m == NULL)
goto out;
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = m->m_len = packet_length;
MCLGET(m, M_NOWAIT);
if ((m->m_flags & M_EXT) == 0) {
m_freem(m);
IFNET_STAT_INC(ifp, ierrors, 1);
kprintf("sn: snread() kernel memory allocation problem\n");
goto out;
}
data = mtod(m, u_char *);
insw(BASE + DATA_REG_W, data, packet_length >> 1);
if (packet_length & 1) {
data += packet_length & ~1;
*data = inb(BASE + DATA_REG_B);
}
IFNET_STAT_INC(ifp, ipackets, 1);
m->m_pkthdr.len = m->m_len = packet_length;
ifp->if_input(ifp, m, NULL, -1);
out:
SMC_SELECT_BANK(2);
while (inw(BASE + MMU_CMD_REG_W) & MMUCR_BUSY)
;
outw(BASE + MMU_CMD_REG_W, MMUCR_RELEASE);
packet_number = inw(BASE + FIFO_PORTS_REG_W);
if (packet_number & FIFO_REMPTY) {
return;
}
goto read_another;
}
static int
snioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
{
struct sn_softc *sc = ifp->if_softc;
int error = 0;
switch (cmd) {
case SIOCSIFFLAGS:
if ((ifp->if_flags & IFF_UP) == 0 && ifp->if_flags & IFF_RUNNING) {
ifp->if_flags &= ~IFF_RUNNING;
snstop(sc);
break;
} else {
sninit(sc);
break;
}
break;
#ifdef notdef
case SIOCGHWADDR:
error = copyout((caddr_t)sc->sc_addr,
(caddr_t)&ifr->ifr_data,
sizeof(sc->sc_addr));
break;
#endif
case SIOCADDMULTI:
sn_setmcast(sc);
error = 0;
break;
case SIOCDELMULTI:
sn_setmcast(sc);
error = 0;
break;
default:
error = ether_ioctl(ifp, cmd, data);
break;
}
return (error);
}
void
snreset(struct sn_softc *sc)
{
snstop(sc);
sninit(sc);
}
void
snwatchdog(struct ifnet *ifp)
{
sn_intr(ifp->if_softc);
}
void
snstop(struct sn_softc *sc)
{
struct ifnet *ifp = &sc->arpcom.ac_if;
SMC_SELECT_BANK(2);
outb(BASE + INTR_MASK_REG_B, 0x00);
SMC_SELECT_BANK(0);
outw(BASE + RECV_CONTROL_REG_W, 0x0000);
outw(BASE + TXMIT_CONTROL_REG_W, 0x0000);
ifp->if_timer = 0;
}
int
sn_activate(device_t dev)
{
struct sn_softc *sc = device_get_softc(dev);
sc->port_rid = 0;
sc->port_res = bus_alloc_resource(dev, SYS_RES_IOPORT, &sc->port_rid,
0, ~0, SMC_IO_EXTENT, RF_ACTIVE);
if (!sc->port_res) {
#ifdef SN_DEBUG
device_printf(dev, "Cannot allocate ioport\n");
#endif
return ENOMEM;
}
sc->irq_rid = 0;
sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid,
RF_ACTIVE);
if (!sc->irq_res) {
#ifdef SN_DEBUG
device_printf(dev, "Cannot allocate irq\n");
#endif
sn_deactivate(dev);
return ENOMEM;
}
sc->sn_io_addr = rman_get_start(sc->port_res);
return (0);
}
void
sn_deactivate(device_t dev)
{
struct sn_softc *sc = device_get_softc(dev);
if (sc->port_res)
bus_release_resource(dev, SYS_RES_IOPORT, sc->port_rid,
sc->port_res);
sc->port_res = 0;
if (sc->irq_res)
bus_release_resource(dev, SYS_RES_IRQ, sc->irq_rid,
sc->irq_res);
sc->irq_res = 0;
return;
}
int
sn_probe(device_t dev, int pccard)
{
struct sn_softc *sc = device_get_softc(dev);
u_int bank;
u_short revision_register;
u_short base_address_register;
u_short ioaddr;
int err;
if ((err = sn_activate(dev)) != 0)
return err;
ioaddr = sc->sn_io_addr;
bank = inw(ioaddr + BANK_SELECT_REG_W);
if ((bank & BSR_DETECT_MASK) != BSR_DETECT_VALUE) {
#ifdef SN_DEBUG
device_printf(dev, "test1 failed\n");
#endif
goto error;
}
outw(ioaddr + BANK_SELECT_REG_W, 0x0000);
bank = inw(ioaddr + BANK_SELECT_REG_W);
if ((bank & BSR_DETECT_MASK) != BSR_DETECT_VALUE) {
#ifdef SN_DEBUG
device_printf(dev, "test2 failed\n");
#endif
goto error;
}
outw(ioaddr + BANK_SELECT_REG_W, 0x0001);
base_address_register = inw(ioaddr + BASE_ADDR_REG_W);
if (!pccard && (ioaddr != (base_address_register >> 3 & 0x3E0))) {
#ifdef SN_DEBUG
device_printf(dev, "test3 failed ioaddr = 0x%x, "
"base_address_register = 0x%x\n", ioaddr,
base_address_register >> 3 & 0x3E0);
#endif
goto error;
}
outw(ioaddr + BANK_SELECT_REG_W, 0x3);
revision_register = inw(ioaddr + REVISION_REG_W);
if (!chip_ids[(revision_register >> 4) & 0xF]) {
#ifdef SN_DEBUG
device_printf(dev, "test4 failed\n");
#endif
goto error;
}
sn_deactivate(dev);
return 0;
error:
sn_deactivate(dev);
return ENXIO;
}
#define MCFSZ 8
static void
sn_setmcast(struct sn_softc *sc)
{
struct ifnet *ifp = (struct ifnet *)sc;
int flags;
flags = RCR_ENABLE | RCR_STRIP_CRC;
if (ifp->if_flags & IFF_PROMISC) {
flags |= RCR_PROMISC | RCR_ALMUL;
} else if (ifp->if_flags & IFF_ALLMULTI) {
flags |= RCR_ALMUL;
} else {
u_char mcf[MCFSZ];
if (sn_getmcf(&sc->arpcom, mcf)) {
SMC_SELECT_BANK(3);
outw(BASE + MULTICAST1_REG_W,
((u_short)mcf[1] << 8) | mcf[0]);
outw(BASE + MULTICAST2_REG_W,
((u_short)mcf[3] << 8) | mcf[2]);
outw(BASE + MULTICAST3_REG_W,
((u_short)mcf[5] << 8) | mcf[4]);
outw(BASE + MULTICAST4_REG_W,
((u_short)mcf[7] << 8) | mcf[6]);
} else {
flags |= RCR_ALMUL;
}
}
SMC_SELECT_BANK(0);
outw(BASE + RECV_CONTROL_REG_W, flags);
}
static int
sn_getmcf(struct arpcom *ac, u_char *mcf)
{
int i;
u_int index, index2;
u_char *af = mcf;
struct ifmultiaddr *ifma;
bzero(mcf, MCFSZ);
TAILQ_FOREACH(ifma, &ac->ac_if.if_multiaddrs, ifma_link) {
if (ifma->ifma_addr->sa_family != AF_LINK)
return 0;
index = smc_crc(LLADDR((struct sockaddr_dl *)ifma->ifma_addr)) & 0x3f;
index2 = 0;
for (i = 0; i < 6; i++) {
index2 <<= 1;
index2 |= (index & 0x01);
index >>= 1;
}
af[index2 >> 3] |= 1 << (index2 & 7);
}
return 1;
}
static u_int
smc_crc(u_char *s)
{
int perByte;
int perBit;
const u_int poly = 0xedb88320;
u_int v = 0xffffffff;
u_char c;
for (perByte = 0; perByte < ETHER_ADDR_LEN; perByte++) {
c = s[perByte];
for (perBit = 0; perBit < 8; perBit++) {
v = (v >> 1)^(((v ^ c) & 0x01) ? poly : 0);
c >>= 1;
}
}
return v;
}