/* $OpenBSD: if_bm.c,v 1.2 2001/09/01 17:43:09 drahn Exp $ */ /* $NetBSD: if_bm.c,v 1.1 1999/01/01 01:27:52 tsubai Exp $ */ /*- * Copyright (C) 1998, 1999 Tsubai Masanari. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #ifdef __NetBSD__ #include "opt_inet.h" #include "opt_ns.h" #endif /* __NetBSD__ */ #include "bpfilter.h" #include #include #include #include #include #include #include #include #include #include #if NBPFILTER > 0 #include #include #endif #include #include #include #include #include #include #define BMAC_TXBUFS 2 #define BMAC_RXBUFS 16 #define BMAC_BUFLEN 2048 struct bmac_softc { struct device sc_dev; #ifdef __OpenBSD__ struct arpcom arpcom; /* per-instance network data */ #define sc_if arpcom.ac_if #define sc_enaddr arpcom.ac_enaddr #else struct ethercom sc_ethercom; #define sc_if sc_ethercom.ec_if u_char sc_enaddr[6]; #endif struct ifmedia sc_media; vaddr_t sc_regs; dbdma_regmap_t *sc_txdma; dbdma_regmap_t *sc_rxdma; dbdma_command_t *sc_txcmd; dbdma_command_t *sc_rxcmd; caddr_t sc_txbuf; caddr_t sc_rxbuf; int sc_rxlast; int sc_flags; int sc_debug; int txcnt_outstanding; }; #define BMAC_BMACPLUS 0x01 extern u_int *heathrow_FCR; static __inline int bmac_read_reg __P((struct bmac_softc *, int)); static __inline void bmac_write_reg __P((struct bmac_softc *, int, int)); static __inline void bmac_set_bits __P((struct bmac_softc *, int, int)); static __inline void bmac_reset_bits __P((struct bmac_softc *, int, int)); static int bmac_match __P((struct device *, void *, void *)); static void bmac_attach __P((struct device *, struct device *, void *)); static void bmac_reset_chip __P((struct bmac_softc *)); static void bmac_init __P((struct bmac_softc *)); static void bmac_init_dma __P((struct bmac_softc *)); static int bmac_intr __P((void *)); #ifdef WHY_IS_THIS_XXXX static int bmac_tx_intr __P((void *)); #endif /* WHY_IS_THIS_XXXX */ static int bmac_rint __P((void *)); static void bmac_reset __P((struct bmac_softc *)); static void bmac_stop __P((struct bmac_softc *)); static void bmac_start __P((struct ifnet *)); static void bmac_transmit_packet __P((struct bmac_softc *, void *, int)); static int bmac_put __P((struct bmac_softc *, caddr_t, struct mbuf *)); static struct mbuf *bmac_get __P((struct bmac_softc *, caddr_t, int)); static void bmac_watchdog __P((struct ifnet *)); static int bmac_ioctl __P((struct ifnet *, u_long, caddr_t)); static int bmac_mediachange __P((struct ifnet *)); static void bmac_mediastatus __P((struct ifnet *, struct ifmediareq *)); static void bmac_setladrf __P((struct bmac_softc *)); void bmac_init_mif __P((struct bmac_softc *sc)); u_int bmac_mif_readbits __P((struct bmac_softc *sc, int nb)); void bmac_mif_writebits __P((struct bmac_softc *sc, u_int val, int nb)); u_int bmac_mif_read __P((struct bmac_softc *sc, u_int addr)); void bmac_mif_write __P((struct bmac_softc *sc, u_int addr, u_int val)); struct cfattach bm_ca = { sizeof(struct bmac_softc), bmac_match, bmac_attach }; struct cfdriver bm_cd = { NULL, "bm", DV_IFNET }; int bmac_read_reg(sc, off) struct bmac_softc *sc; int off; { return in16rb(sc->sc_regs + off); } void bmac_write_reg(sc, off, val) struct bmac_softc *sc; int off, val; { out16rb(sc->sc_regs + off, val); } void bmac_set_bits(sc, off, val) struct bmac_softc *sc; int off, val; { val |= bmac_read_reg(sc, off); bmac_write_reg(sc, off, val); } void bmac_reset_bits(sc, off, val) struct bmac_softc *sc; int off, val; { bmac_write_reg(sc, off, bmac_read_reg(sc, off) & ~val); } int bmac_match(parent, cf, aux) struct device *parent; void *cf; void *aux; { struct confargs *ca = aux; if (ca->ca_nreg < 24 || ca->ca_nintr < 12) return 0; if (strcmp(ca->ca_name, "bmac") == 0) /* bmac */ return 1; if (strcmp(ca->ca_name, "ethernet") == 0) /* bmac+ */ return 1; return 0; } void bmac_attach(parent, self, aux) struct device *parent, *self; void *aux; { struct confargs *ca = aux; struct bmac_softc *sc = (void *)self; struct ifnet *ifp = &sc->sc_if; u_char laddr[6]; sc->sc_flags =0; if (strcmp(ca->ca_name, "ethernet") == 0) { sc->sc_flags |= BMAC_BMACPLUS; } ca->ca_reg[0] += ca->ca_baseaddr; ca->ca_reg[2] += ca->ca_baseaddr; ca->ca_reg[4] += ca->ca_baseaddr; sc->sc_regs = (vaddr_t)mapiodev(ca->ca_reg[0], NBPG); bmac_write_reg(sc, INTDISABLE, NoEventsMask); if (OF_getprop(ca->ca_node, "local-mac-address", laddr, 6) == -1 && OF_getprop(ca->ca_node, "mac-address", laddr, 6) == -1) { printf(": cannot get mac-address\n"); return; } bcopy(laddr, sc->arpcom.ac_enaddr, 6); sc->sc_txdma = mapiodev(ca->ca_reg[2], 0x100); sc->sc_rxdma = mapiodev(ca->ca_reg[4], 0x100); sc->sc_txcmd = dbdma_alloc(BMAC_TXBUFS * sizeof(dbdma_command_t)); sc->sc_rxcmd = dbdma_alloc((BMAC_RXBUFS + 1) * sizeof(dbdma_command_t)); sc->sc_txbuf = malloc(BMAC_BUFLEN * BMAC_TXBUFS, M_DEVBUF, M_NOWAIT); sc->sc_rxbuf = malloc(BMAC_BUFLEN * BMAC_RXBUFS, M_DEVBUF, M_NOWAIT); if (sc->sc_txbuf == NULL || sc->sc_rxbuf == NULL || sc->sc_txcmd == NULL || sc->sc_rxcmd == NULL) { printf("cannot allocate memory\n"); return; } printf(" irq %d,%d: address %s\n", ca->ca_intr[0], ca->ca_intr[2], ether_sprintf(laddr)); mac_intr_establish(parent, ca->ca_intr[0], IST_LEVEL, IPL_NET, bmac_intr, sc, "bmac intr"); #ifdef WHY_IS_THIS_XXXX mac_intr_establish(parent, ca->ca_intr[1], IST_LEVEL, IPL_NET, bmac_tx_intr, sc, "bmac_tx"); #endif /* WHY_IS_THIS_XXXX */ mac_intr_establish(parent, ca->ca_intr[2], IST_LEVEL, IPL_NET, bmac_rint, sc, "bmac rint"); bcopy(sc->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ); ifp->if_softc = sc; ifp->if_ioctl = bmac_ioctl; ifp->if_start = bmac_start; ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST; ifp->if_watchdog = bmac_watchdog; ifmedia_init(&sc->sc_media, 0, bmac_mediachange, bmac_mediastatus); ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_10_T, 0, NULL); ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_10_T); bmac_reset_chip(sc); if_attach(ifp); ether_ifattach(ifp); } /* * Reset and enable bmac by heathrow FCR. */ void bmac_reset_chip(sc) struct bmac_softc *sc; { u_int v; dbdma_reset(sc->sc_txdma); dbdma_reset(sc->sc_rxdma); v = in32rb(heathrow_FCR); v |= EnetEnable; out32rb(heathrow_FCR, v); delay(50000); /* assert reset */ v |= ResetEnetCell; out32rb(heathrow_FCR, v); delay(70000); /* deassert reset */ v &= ~ResetEnetCell; out32rb(heathrow_FCR, v); delay(50000); /* enable */ v |= EnetEnable; out32rb(heathrow_FCR, v); delay(50000); /* make certain they stay set? */ out32rb(heathrow_FCR, v); v = in32rb(heathrow_FCR); } void bmac_init(sc) struct bmac_softc *sc; { struct ifnet *ifp = &sc->sc_if; struct ether_header *eh; caddr_t data; int tb; u_short *p; bmac_init_mif(sc); bmac_reset_chip(sc); bmac_write_reg(sc, RXRST, RxResetValue); bmac_write_reg(sc, TXRST, TxResetBit); /* Wait for reset completion. */ do { delay(10000); } while (bmac_read_reg(sc, TXRST) & TxResetBit); if (! (sc->sc_flags & BMAC_BMACPLUS)) { bmac_set_bits(sc, XCVRIF, ClkBit|SerialMode|COLActiveLow); delay(100); } __asm __volatile ("mftb %0" : "=r"(tb)); bmac_write_reg(sc, RSEED, tb); bmac_set_bits(sc, XIFC, TxOutputEnable); bmac_read_reg(sc, PAREG); /* Reset various counters. */ bmac_write_reg(sc, NCCNT, 0); bmac_write_reg(sc, NTCNT, 0); bmac_write_reg(sc, EXCNT, 0); bmac_write_reg(sc, LTCNT, 0); bmac_write_reg(sc, FRCNT, 0); bmac_write_reg(sc, LECNT, 0); bmac_write_reg(sc, AECNT, 0); bmac_write_reg(sc, FECNT, 0); bmac_write_reg(sc, RXCV, 0); /* Set tx fifo information. */ bmac_write_reg(sc, TXTH, 4); /* 4 octets before tx starts */ bmac_write_reg(sc, TXFIFOCSR, 0); bmac_write_reg(sc, TXFIFOCSR, TxFIFOEnable); /* Set rx fifo information. */ bmac_write_reg(sc, RXFIFOCSR, 0); bmac_write_reg(sc, RXFIFOCSR, RxFIFOEnable); /* Clear status register. */ bmac_read_reg(sc, STATUS); bmac_write_reg(sc, HASH3, 0); bmac_write_reg(sc, HASH2, 0); bmac_write_reg(sc, HASH1, 0); bmac_write_reg(sc, HASH0, 0); /* Set MAC address. */ p = (u_short *)sc->sc_enaddr; bmac_write_reg(sc, MADD0, *p++); bmac_write_reg(sc, MADD1, *p++); bmac_write_reg(sc, MADD2, *p); bmac_write_reg(sc, RXCFG, RxCRCEnable | RxHashFilterEnable | RxRejectOwnPackets); if (ifp->if_flags & IFF_PROMISC) bmac_set_bits(sc, RXCFG, RxPromiscEnable); bmac_init_dma(sc); /* Enable TX/RX */ bmac_set_bits(sc, RXCFG, RxMACEnable); bmac_set_bits(sc, TXCFG, TxMACEnable); bmac_write_reg(sc, INTDISABLE, NormalIntEvents); ifp->if_flags |= IFF_RUNNING; ifp->if_flags &= ~IFF_OACTIVE; ifp->if_timer = 0; data = sc->sc_txbuf; eh = (struct ether_header *)data; bzero(data, sizeof(eh) + ETHERMIN); bcopy(sc->sc_enaddr, eh->ether_dhost, ETHER_ADDR_LEN); bcopy(sc->sc_enaddr, eh->ether_shost, ETHER_ADDR_LEN); bmac_transmit_packet(sc, data, sizeof(eh) + ETHERMIN); bmac_start(ifp); } void bmac_init_dma(sc) struct bmac_softc *sc; { dbdma_command_t *cmd = sc->sc_rxcmd; int i; dbdma_reset(sc->sc_txdma); dbdma_reset(sc->sc_rxdma); bzero(sc->sc_txcmd, BMAC_TXBUFS * sizeof(dbdma_command_t)); bzero(sc->sc_rxcmd, (BMAC_RXBUFS + 1) * sizeof(dbdma_command_t)); for (i = 0; i < BMAC_RXBUFS; i++) { DBDMA_BUILD(cmd, DBDMA_CMD_IN_LAST, 0, BMAC_BUFLEN, vtophys((vaddr_t)(sc->sc_rxbuf + BMAC_BUFLEN * i)), DBDMA_INT_ALWAYS, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); cmd++; } DBDMA_BUILD(cmd, DBDMA_CMD_NOP, 0, 0, 0, DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_ALWAYS); dbdma_st32(&cmd->d_cmddep, vtophys((vaddr_t)sc->sc_rxcmd)); sc->sc_rxlast = 0; dbdma_start(sc->sc_rxdma, sc->sc_rxcmd); } #ifdef WHY_IS_THIS_XXXX int bmac_tx_intr(v) void *v; { struct bmac_softc *sc = v; sc->sc_if.if_flags &= ~IFF_OACTIVE; sc->sc_if.if_timer = 0; sc->sc_if.if_opackets++; bmac_start(&sc->sc_if); #ifndef BMAC_DEBUG printf("bmac_tx_intr \n"); #endif #if 0 stat = bmac_read_reg(sc, STATUS); if (stat == 0) { printf("tx intr fired, but status 0\n"); return 0; } if (stat & IntFrameSent) { sc->sc_if.if_flags &= ~IFF_OACTIVE; sc->sc_if.if_timer = 0; sc->sc_if.if_opackets++; bmac_start(&sc->sc_if); } #endif return 1; } #endif /* WHY_IS_THIS_XXXX */ int bmac_intr(v) void *v; { struct bmac_softc *sc = v; int stat; #ifdef BMAC_DEBUG printf("bmac_intr called\n"); #endif stat = bmac_read_reg(sc, STATUS); if (stat == 0) return 0; #ifdef BMAC_DEBUG printf("bmac_intr status = 0x%x\n", stat); #endif if (stat & IntFrameSent) { sc->sc_if.if_flags &= ~IFF_OACTIVE; sc->sc_if.if_timer = 0; sc->sc_if.if_opackets++; bmac_start(&sc->sc_if); } /* XXX should do more! */ return 1; } int bmac_rint(v) void *v; { struct bmac_softc *sc = v; struct ifnet *ifp = &sc->sc_if; struct mbuf *m; dbdma_command_t *cmd; int status, resid, count, datalen; int i, n; void *data; #ifdef BMAC_DEBUG printf("bmac_rint() called\n"); #endif i = sc->sc_rxlast; for (n = 0; n < BMAC_RXBUFS; n++, i++) { if (i == BMAC_RXBUFS) i = 0; cmd = &sc->sc_rxcmd[i]; status = dbdma_ld16(&cmd->d_status); resid = dbdma_ld16(&cmd->d_resid); #ifdef BMAC_DEBUG if (status != 0 && status != 0x8440 && status != 0x9440) printf("bmac_rint status = 0x%x\n", status); #endif if ((status & DBDMA_CNTRL_ACTIVE) == 0) /* 0x9440 | 0x8440 */ continue; count = dbdma_ld16(&cmd->d_count); datalen = count - resid; if (datalen < sizeof(struct ether_header)) { printf("%s: short packet len = %d\n", ifp->if_xname, datalen); goto next; } DBDMA_BUILD_CMD(cmd, DBDMA_CMD_STOP, 0, 0, 0, 0); data = sc->sc_rxbuf + BMAC_BUFLEN * i; m = bmac_get(sc, data, datalen); if (m == NULL) { ifp->if_ierrors++; goto next; } #if NBPFILTER > 0 /* * Check if there's a BPF listener on this interface. * If so, hand off the raw packet to BPF. */ if (ifp->if_bpf) bpf_mtap(ifp->if_bpf, m); #endif #ifdef __OpenBSD__ ether_input_mbuf(ifp, m); #else m_adj(m, sizeof(struct ether_header)); ether_input(ifp, data, m); #endif ifp->if_ipackets++; next: DBDMA_BUILD_CMD(cmd, DBDMA_CMD_IN_LAST, 0, DBDMA_INT_ALWAYS, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); cmd->d_status = 0; cmd->d_resid = 0; sc->sc_rxlast = i + 1; } dbdma_continue(sc->sc_rxdma); return 1; } void bmac_reset(sc) struct bmac_softc *sc; { int s; s = splnet(); bmac_init(sc); splx(s); } void bmac_stop(sc) struct bmac_softc *sc; { struct ifnet *ifp = &sc->sc_if; int s; s = splnet(); /* Disable TX/RX. */ bmac_reset_bits(sc, TXCFG, TxMACEnable); bmac_reset_bits(sc, RXCFG, RxMACEnable); /* Disable all interrupts. */ bmac_write_reg(sc, INTDISABLE, NoEventsMask); dbdma_stop(sc->sc_txdma); dbdma_stop(sc->sc_rxdma); ifp->if_flags &= ~(IFF_UP | IFF_RUNNING); ifp->if_timer = 0; splx(s); } void bmac_start(ifp) struct ifnet *ifp; { struct bmac_softc *sc = ifp->if_softc; struct mbuf *m; int tlen; if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING) return; while (1) { if (ifp->if_flags & IFF_OACTIVE) return; IF_DEQUEUE(&ifp->if_snd, m); if (m == 0) break; #if NBPFILTER > 0 /* * If BPF is listening on this interface, let it see the * packet before we commit it to the wire. */ if (ifp->if_bpf) bpf_mtap(ifp->if_bpf, m); #endif ifp->if_flags |= IFF_OACTIVE; tlen = bmac_put(sc, sc->sc_txbuf, m); /* 5 seconds to watch for failing to transmit */ ifp->if_timer = 5; ifp->if_opackets++; /* # of pkts */ bmac_transmit_packet(sc, sc->sc_txbuf, tlen); } } void bmac_transmit_packet(sc, buff, len) struct bmac_softc *sc; void *buff; int len; { dbdma_command_t *cmd = sc->sc_txcmd; vaddr_t va = (vaddr_t)buff; #ifdef BMAC_DEBUG if (vtophys(va) + len - 1 != vtophys(va + len - 1)) panic("bmac_transmit_packet"); #endif DBDMA_BUILD(cmd, DBDMA_CMD_OUT_LAST, 0, len, vtophys(va), DBDMA_INT_NEVER, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); cmd++; DBDMA_BUILD(cmd, DBDMA_CMD_STOP, 0, 0, 0, DBDMA_INT_ALWAYS, DBDMA_WAIT_NEVER, DBDMA_BRANCH_NEVER); dbdma_start(sc->sc_txdma, sc->sc_txcmd); } int bmac_put(sc, buff, m) struct bmac_softc *sc; caddr_t buff; struct mbuf *m; { struct mbuf *n; int len, tlen = 0; for (; m; m = n) { len = m->m_len; if (len == 0) { MFREE(m, n); continue; } bcopy(mtod(m, caddr_t), buff, len); buff += len; tlen += len; MFREE(m, n); } if (tlen > NBPG) panic("%s: putpacket packet overflow", sc->sc_dev.dv_xname); return tlen; } struct mbuf * bmac_get(sc, pkt, totlen) struct bmac_softc *sc; caddr_t pkt; int totlen; { struct mbuf *m; struct mbuf *top, **mp; int len; MGETHDR(m, M_DONTWAIT, MT_DATA); if (m == 0) return 0; m->m_pkthdr.rcvif = &sc->sc_if; m->m_pkthdr.len = totlen; len = MHLEN; top = 0; mp = ⊤ while (totlen > 0) { if (top) { MGET(m, M_DONTWAIT, MT_DATA); if (m == 0) { m_freem(top); return 0; } len = MLEN; } if (totlen >= MINCLSIZE) { MCLGET(m, M_DONTWAIT); if ((m->m_flags & M_EXT) == 0) { m_free(m); m_freem(top); return 0; } len = MCLBYTES; } m->m_len = len = min(totlen, len); bcopy(pkt, mtod(m, caddr_t), len); pkt += len; totlen -= len; *mp = m; mp = &m->m_next; } return top; } void bmac_watchdog(ifp) struct ifnet *ifp; { struct bmac_softc *sc = ifp->if_softc; bmac_reset_bits(sc, RXCFG, RxMACEnable); bmac_reset_bits(sc, TXCFG, TxMACEnable); printf("%s: device timeout\n", ifp->if_xname); ifp->if_oerrors++; bmac_reset(sc); } int bmac_ioctl(ifp, cmd, data) struct ifnet *ifp; u_long cmd; caddr_t data; { struct bmac_softc *sc = ifp->if_softc; struct ifaddr *ifa = (struct ifaddr *)data; struct ifreq *ifr = (struct ifreq *)data; int s, error = 0; s = splnet(); switch (cmd) { case SIOCSIFADDR: ifp->if_flags |= IFF_UP; switch (ifa->ifa_addr->sa_family) { #ifdef INET case AF_INET: bmac_init(sc); #ifdef __OpenBSD__ arp_ifinit(&sc->arpcom, ifa); #else arp_ifinit(ifp, ifa); #endif break; #endif #ifdef NS case AF_NS: { struct ns_addr *ina = &IA_SNS(ifa)->sns_addr; if (ns_nullhost(*ina)) ina->x_host = *(union ns_host *)LLADDR(ifp->if_sadl); else { bcopy(ina->x_host.c_host, LLADDR(ifp->if_sadl), sizeof(sc->sc_enaddr)); } /* Set new address. */ bmac_init(sc); break; } #endif default: bmac_init(sc); break; } break; case SIOCSIFFLAGS: if ((ifp->if_flags & IFF_UP) == 0 && (ifp->if_flags & IFF_RUNNING) != 0) { /* * If interface is marked down and it is running, then * stop it. */ bmac_stop(sc); ifp->if_flags &= ~IFF_RUNNING; } else if ((ifp->if_flags & IFF_UP) != 0 && (ifp->if_flags & IFF_RUNNING) == 0) { /* * If interface is marked up and it is stopped, then * start it. */ bmac_init(sc); } else { /* * Reset the interface to pick up changes in any other * flags that affect hardware registers. */ /*bmac_stop(sc);*/ bmac_init(sc); } #ifdef BMAC_DEBUG if (ifp->if_flags & IFF_DEBUG) sc->sc_debug = 1; else sc->sc_debug = 0; #endif break; case SIOCADDMULTI: case SIOCDELMULTI: #if defined(__OpenBSD__) error = (cmd == SIOCADDMULTI) ? ether_addmulti(ifr, &sc->arpcom) : ether_delmulti(ifr, &sc->arpcom); #else error = (cmd == SIOCADDMULTI) ? ether_addmulti(ifr, &sc->sc_ethercom) : ether_delmulti(ifr, &sc->sc_ethercom); #endif if (error == ENETRESET) { /* * Multicast list has changed; set the hardware filter * accordingly. */ bmac_init(sc); bmac_setladrf(sc); error = 0; } break; case SIOCGIFMEDIA: case SIOCSIFMEDIA: error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd); break; default: error = EINVAL; } splx(s); return error; } int bmac_mediachange(ifp) struct ifnet *ifp; { return EINVAL; } void bmac_mediastatus(ifp, ifmr) struct ifnet *ifp; struct ifmediareq *ifmr; { if ((ifp->if_flags & IFF_UP) == 0) return; ifmr->ifm_status = IFM_AVALID; ifmr->ifm_status |= IFM_ACTIVE; } #define MC_POLY_BE 0x04c11db7UL /* mcast crc, big endian */ #define MC_POLY_LE 0xedb88320UL /* mcast crc, little endian */ /* * Set up the logical address filter. */ void bmac_setladrf(sc) struct bmac_softc *sc; { struct ifnet *ifp = &sc->sc_if; struct ether_multi *enm; struct ether_multistep step; int i, j; u_int32_t crc; u_int16_t hash[4]; u_int8_t octet; /* * Set up multicast address filter by passing all multicast addresses * through a crc generator, and then using the high order 6 bits as an * index into the 64 bit logical address filter. The high order bit * selects the word, while the rest of the bits select the bit within * the word. */ if (ifp->if_flags & IFF_ALLMULTI) goto allmulti; if (ifp->if_flags & IFF_PROMISC) { bmac_set_bits(sc, RXCFG, RxPromiscEnable); goto allmulti; } hash[3] = hash[2] = hash[1] = hash[0] = 0; #ifdef __OpenBSD__ ETHER_FIRST_MULTI(step, &sc->arpcom, enm); #else ETHER_FIRST_MULTI(step, &sc->sc_ethercom, enm); #endif while (enm != NULL) { if (bcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) { /* * We must listen to a range of multicast addresses. * For now, just accept all multicasts, rather than * trying to set only those filter bits needed to match * the range. (At this time, the only use of address * ranges is for IP multicast routing, for which the * range is big enough to require all bits set.) */ goto allmulti; } crc = 0xffffffff; for (i = 0; i < ETHER_ADDR_LEN; i++) { octet = enm->enm_addrlo[i]; for (j = 0; j < 8; j++) { if ((crc & 1) ^ (octet & 1)) { crc >>= 1; crc ^= MC_POLY_LE; } else crc >>= 1; octet >>= 1; } } /* Just want the 6 most significant bits. */ crc >>= 26; /* Set the corresponding bit in the filter. */ hash[crc >> 4] |= 1 << (crc & 0xf); ETHER_NEXT_MULTI(step, enm); } bmac_write_reg(sc, HASH3, hash[3]); bmac_write_reg(sc, HASH2, hash[2]); bmac_write_reg(sc, HASH1, hash[1]); bmac_write_reg(sc, HASH0, hash[0]); ifp->if_flags &= ~IFF_ALLMULTI; return; allmulti: ifp->if_flags |= IFF_ALLMULTI; bmac_write_reg(sc, HASH3, 0xffff); bmac_write_reg(sc, HASH2, 0xffff); bmac_write_reg(sc, HASH1, 0xffff); bmac_write_reg(sc, HASH0, 0xffff); } #define MIFDELAY delay(1) u_int bmac_mif_readbits(sc, nb) struct bmac_softc *sc; int nb; { unsigned int val = 0; while (--nb >= 0) { bmac_write_reg(sc, MIFCSR, 0); MIFDELAY; if (bmac_read_reg(sc, MIFCSR) & 8) val |= 1 << nb; bmac_write_reg(sc, MIFCSR, 1); MIFDELAY; } bmac_write_reg(sc, MIFCSR, 0); MIFDELAY; bmac_write_reg(sc, MIFCSR, 1); MIFDELAY; return val; } void bmac_mif_writebits(sc, val, nb) struct bmac_softc *sc; u_int val; int nb; { int b; while (--nb >= 0) { b = (val & (1 << nb))? 6: 4; bmac_write_reg(sc, MIFCSR, b); MIFDELAY; bmac_write_reg(sc, MIFCSR, b|1); MIFDELAY; } } u_int bmac_mif_read(sc, addr) struct bmac_softc *sc; u_int addr; { u_int val; bmac_write_reg(sc, MIFCSR, 4); MIFDELAY; bmac_mif_writebits(sc, ~0U, 32); bmac_mif_writebits(sc, 6, 4); bmac_mif_writebits(sc, addr, 10); bmac_write_reg(sc, MIFCSR, 2); MIFDELAY; bmac_write_reg(sc, MIFCSR, 1); MIFDELAY; val = bmac_mif_readbits(sc, 17); bmac_write_reg(sc, MIFCSR, 4); MIFDELAY; /* printk(KERN_DEBUG "bmac_mif_read(%x) -> %x\n", addr, val); */ return val; } void bmac_mif_write(sc, addr, val) struct bmac_softc *sc; u_int addr; u_int val; { bmac_write_reg(sc, MIFCSR, 4); MIFDELAY; bmac_mif_writebits(sc, ~0U, 32); bmac_mif_writebits(sc, 5, 4); bmac_mif_writebits(sc, addr, 10); bmac_mif_writebits(sc, 2, 2); bmac_mif_writebits(sc, val, 16); bmac_mif_writebits(sc, 3, 2); } void bmac_init_mif(sc) struct bmac_softc *sc; { int id; if (sc->sc_flags & BMAC_BMACPLUS) { id = bmac_mif_read(sc,2); switch (id) { case 0x7810: if (bmac_mif_read(sc,4) == 0xa1) { bmac_mif_write(sc, 0, 0x1000); } else { bmac_mif_write(sc, 4, 0xa1); bmac_mif_write(sc, 0, 0x1200); } #if 0 /* DEBUGGING */ printf("mif 0 %x\n", bmac_mif_read(sc, 0)); printf("mif 4 %x\n", bmac_mif_read(sc, 4)); #endif break; default: printf("bmac mif id %x not regcognized\n", id); /* nothing */ } } return; }