Home | History | Annotate | Line # | Download | only in dev
am79c950.c revision 1.43
      1 /*	$NetBSD: am79c950.c,v 1.43 2019/04/26 06:33:33 msaitoh Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1997 David Huang <khym (at) bga.com>
      5  * All rights reserved.
      6  *
      7  * Portions of this code are based on code by Denton Gentry <denny1 (at) home.com>,
      8  * Charles M. Hannum, Yanagisawa Takeshi <yanagisw (at) aa.ap.titech.ac.jp>, and
      9  * Jason R. Thorpe.
     10  *
     11  * Redistribution and use in source and binary forms, with or without
     12  * modification, are permitted provided that the following conditions
     13  * are met:
     14  * 1. Redistributions of source code must retain the above copyright
     15  *    notice, this list of conditions and the following disclaimer.
     16  * 2. The name of the author may not be used to endorse or promote products
     17  *    derived from this software without specific prior written permission
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     20  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     21  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     22  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     23  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     24  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     25  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     26  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     27  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     28  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     29  *
     30  */
     31 
     32 /*
     33  * Driver for the AMD Am79C940 (MACE) ethernet chip, used for onboard
     34  * ethernet on the Centris/Quadra 660av and Quadra 840av.
     35  */
     36 
     37 #include <sys/cdefs.h>
     38 __KERNEL_RCSID(0, "$NetBSD: am79c950.c,v 1.43 2019/04/26 06:33:33 msaitoh Exp $");
     39 
     40 #include "opt_inet.h"
     41 
     42 #include <sys/param.h>
     43 #include <sys/systm.h>
     44 #include <sys/mbuf.h>
     45 #include <sys/buf.h>
     46 #include <sys/protosw.h>
     47 #include <sys/socket.h>
     48 #include <sys/syslog.h>
     49 #include <sys/ioctl.h>
     50 #include <sys/errno.h>
     51 #include <sys/device.h>
     52 #include <sys/bus.h>
     53 
     54 #include <net/if.h>
     55 #include <net/if_dl.h>
     56 #include <net/if_ether.h>
     57 #include <net/if_media.h>
     58 #include <net/bpf.h>
     59 
     60 #ifdef INET
     61 #include <netinet/in.h>
     62 #include <netinet/if_inarp.h>
     63 #include <netinet/in_systm.h>
     64 #include <netinet/in_var.h>
     65 #include <netinet/ip.h>
     66 #endif
     67 
     68 #include <macppc/dev/am79c950reg.h>
     69 #include <macppc/dev/if_mcvar.h>
     70 
     71 hide void	mcwatchdog(struct ifnet *);
     72 hide int	mcinit(struct mc_softc *);
     73 hide int	mcstop(struct mc_softc *);
     74 hide int	mcioctl(struct ifnet *, u_long, void *);
     75 hide void	mcstart(struct ifnet *);
     76 hide void	mcreset(struct mc_softc *);
     77 
     78 integrate u_int	maceput(struct mc_softc *, struct mbuf *);
     79 integrate void	mc_tint(struct mc_softc *);
     80 integrate void	mace_read(struct mc_softc *, uint8_t *, int);
     81 integrate struct mbuf *mace_get(struct mc_softc *, uint8_t *, int);
     82 static void	mace_calcladrf(struct ethercom *, uint8_t *);
     83 static inline uint16_t ether_cmp(void *, void *);
     84 static int	mc_mediachange(struct ifnet *);
     85 static void	mc_mediastatus(struct ifnet *, struct ifmediareq *);
     86 
     87 /*
     88  * Compare two Ether/802 addresses for equality, inlined and
     89  * unrolled for speed.  Use this like memcmp().
     90  *
     91  * XXX: Add <machine/inlines.h> for stuff like this?
     92  * XXX: or maybe add it to libkern.h instead?
     93  *
     94  * "I'd love to have an inline assembler version of this."
     95  * XXX: Who wanted that? mycroft?  I wrote one, but this
     96  * version in C is as good as hand-coded assembly. -gwr
     97  *
     98  * Please do NOT tweak this without looking at the actual
     99  * assembly code generated before and after your tweaks!
    100  */
    101 static inline uint16_t
    102 ether_cmp(void *one, void *two)
    103 {
    104 	register uint16_t *a = (u_short *) one;
    105 	register uint16_t *b = (u_short *) two;
    106 	register uint16_t diff;
    107 
    108 #ifdef	m68k
    109 	/*
    110 	 * The post-increment-pointer form produces the best
    111 	 * machine code for m68k.  This was carefully tuned
    112 	 * so it compiles to just 8 short (2-byte) op-codes!
    113 	 */
    114 	diff  = *a++ - *b++;
    115 	diff |= *a++ - *b++;
    116 	diff |= *a++ - *b++;
    117 #else
    118 	/*
    119 	 * Most modern CPUs do better with a single expresion.
    120 	 * Note that short-cut evaluation is NOT helpful here,
    121 	 * because it just makes the code longer, not faster!
    122 	 */
    123 	diff = (a[0] - b[0]) | (a[1] - b[1]) | (a[2] - b[2]);
    124 #endif
    125 
    126 	return diff;
    127 }
    128 
    129 #define ETHER_CMP	ether_cmp
    130 
    131 /*
    132  * Interface exists: make available by filling in network interface
    133  * record.  System will initialize the interface when it is ready
    134  * to accept packets.
    135  */
    136 int
    137 mcsetup(struct mc_softc *sc, uint8_t *lladdr)
    138 {
    139 	struct ifnet *ifp = &sc->sc_if;
    140 
    141 	/* Reset the chip and disable all interrupts */
    142 	NIC_PUT(sc, MACE_BIUCC, SWRST);
    143 	DELAY(100);
    144 	NIC_PUT(sc, MACE_IMR, ~0);
    145 
    146 	memcpy(sc->sc_enaddr, lladdr, ETHER_ADDR_LEN);
    147 	printf(": address %s\n", ether_sprintf(lladdr));
    148 
    149 	memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    150 	ifp->if_softc = sc;
    151 	ifp->if_ioctl = mcioctl;
    152 	ifp->if_start = mcstart;
    153 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    154 	ifp->if_watchdog = mcwatchdog;
    155 
    156 	/* Initialize ifmedia structures */
    157 	ifmedia_init(&sc->sc_media, 0, mc_mediachange, mc_mediastatus);
    158 	ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_MANUAL, 0, NULL);
    159 	ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_MANUAL);
    160 
    161 	if_attach(ifp);
    162 	if_deferred_start_init(ifp, NULL);
    163 	ether_ifattach(ifp, lladdr);
    164 
    165 	return 0;
    166 }
    167 
    168 hide int
    169 mcioctl(struct ifnet *ifp, u_long cmd, void *data)
    170 {
    171 	struct mc_softc *sc = ifp->if_softc;
    172 	struct ifaddr *ifa;
    173 	struct ifreq *ifr;
    174 
    175 	int	s = splnet(), err = 0;
    176 
    177 	switch (cmd) {
    178 
    179 	case SIOCINITIFADDR:
    180 		ifa = (struct ifaddr *)data;
    181 		ifp->if_flags |= IFF_UP;
    182 		mcinit(sc);
    183 		switch (ifa->ifa_addr->sa_family) {
    184 #ifdef INET
    185 		case AF_INET:
    186 			arp_ifinit(ifp, ifa);
    187 			break;
    188 #endif
    189 		default:
    190 			break;
    191 		}
    192 		break;
    193 
    194 	case SIOCSIFFLAGS:
    195 		if ((err = ifioctl_common(ifp, cmd, data)) != 0)
    196 			break;
    197 		/* XXX see the comment in ed_ioctl() about code re-use */
    198 		if ((ifp->if_flags & IFF_UP) == 0 &&
    199 		    (ifp->if_flags & IFF_RUNNING) != 0) {
    200 			/*
    201 			 * If interface is marked down and it is running,
    202 			 * then stop it.
    203 			 */
    204 			mcstop(sc);
    205 			ifp->if_flags &= ~IFF_RUNNING;
    206 		} else if ((ifp->if_flags & IFF_UP) != 0 &&
    207 		    (ifp->if_flags & IFF_RUNNING) == 0) {
    208 			/*
    209 			 * If interface is marked up and it is stopped,
    210 			 * then start it.
    211 			 */
    212 			(void)mcinit(sc);
    213 		} else {
    214 			/*
    215 			 * Reset the interface to pick up any other changes
    216 			 * in flags
    217 			 */
    218 			mcreset(sc);
    219 			mcstart(ifp);
    220 		}
    221 		break;
    222 
    223 	case SIOCADDMULTI:
    224 	case SIOCDELMULTI:
    225 		if ((err = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
    226 			/*
    227 			 * Multicast list has changed; set the hardware
    228 			 * filter accordingly. But remember UP flag!
    229 			 */
    230 			if (ifp->if_flags & IFF_RUNNING)
    231 				mcreset(sc);
    232 			err = 0;
    233 		}
    234 		break;
    235 
    236 	case SIOCGIFMEDIA:
    237 	case SIOCSIFMEDIA:
    238 		ifr = (struct ifreq *) data;
    239 		err = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
    240 		break;
    241 
    242 	default:
    243 		err = ether_ioctl(ifp, cmd, data);
    244 		break;
    245 	}
    246 	splx(s);
    247 	return err;
    248 }
    249 
    250 /*
    251  * Encapsulate a packet of type family for the local net.
    252  */
    253 hide void
    254 mcstart(struct ifnet *ifp)
    255 {
    256 	struct mc_softc	*sc = ifp->if_softc;
    257 	struct mbuf	*m;
    258 
    259 	if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
    260 		return;
    261 
    262 	while (1) {
    263 		if (ifp->if_flags & IFF_OACTIVE)
    264 			return;
    265 
    266 		IF_DEQUEUE(&ifp->if_snd, m);
    267 		if (m == 0)
    268 			return;
    269 
    270 		/*
    271 		 * If bpf is listening on this interface, let it
    272 		 * see the packet before we commit it to the wire.
    273 		 */
    274 		bpf_mtap(ifp, m, BPF_D_OUT);
    275 
    276 		/* Copy the mbuf chain into the transmit buffer. */
    277 		ifp->if_flags |= IFF_OACTIVE;
    278 		maceput(sc, m);
    279 
    280 		ifp->if_opackets++;		/* # of pkts */
    281 	}
    282 }
    283 
    284 /*
    285  * Reset and restart the MACE.  Called in case of fatal
    286  * hardware/software errors.
    287  */
    288 hide void
    289 mcreset(struct mc_softc *sc)
    290 {
    291 	mcstop(sc);
    292 	mcinit(sc);
    293 }
    294 
    295 hide int
    296 mcinit(struct mc_softc *sc)
    297 {
    298 	int s;
    299 	uint8_t maccc, ladrf[8];
    300 
    301 	if (sc->sc_if.if_flags & IFF_RUNNING)
    302 		/* already running */
    303 		return 0;
    304 
    305 	s = splnet();
    306 
    307 	NIC_PUT(sc, MACE_BIUCC, sc->sc_biucc);
    308 	NIC_PUT(sc, MACE_FIFOCC, sc->sc_fifocc);
    309 	NIC_PUT(sc, MACE_IMR, ~0); /* Disable all interrupts */
    310 	NIC_PUT(sc, MACE_PLSCC, sc->sc_plscc);
    311 
    312 	NIC_PUT(sc, MACE_UTR, RTRD); /* Disable reserved test registers */
    313 
    314 	/* Set MAC address */
    315 	NIC_PUT(sc, MACE_IAC, ADDRCHG);
    316 	while (NIC_GET(sc, MACE_IAC) & ADDRCHG)
    317 		;
    318 	NIC_PUT(sc, MACE_IAC, PHYADDR);
    319 	bus_space_write_multi_1(sc->sc_regt, sc->sc_regh, MACE_REG(MACE_PADR),
    320 	    sc->sc_enaddr, ETHER_ADDR_LEN);
    321 
    322 	/* Set logical address filter */
    323 	mace_calcladrf(&sc->sc_ethercom, ladrf);
    324 
    325 	NIC_PUT(sc, MACE_IAC, ADDRCHG);
    326 	while (NIC_GET(sc, MACE_IAC) & ADDRCHG)
    327 		;
    328 	NIC_PUT(sc, MACE_IAC, LOGADDR);
    329 	bus_space_write_multi_1(sc->sc_regt, sc->sc_regh, MACE_REG(MACE_LADRF),
    330 	    ladrf, 8);
    331 
    332 	NIC_PUT(sc, MACE_XMTFC, APADXMT);
    333 	/*
    334 	 * No need to autostrip padding on receive... Ethernet frames
    335 	 * don't have a length field, unlike 802.3 frames, so the MACE
    336 	 * can't figure out the length of the packet anyways.
    337 	 */
    338 	NIC_PUT(sc, MACE_RCVFC, 0);
    339 
    340 	maccc = ENXMT | ENRCV;
    341 	if (sc->sc_if.if_flags & IFF_PROMISC)
    342 		maccc |= PROM;
    343 
    344 	NIC_PUT(sc, MACE_MACCC, maccc);
    345 
    346 	if (sc->sc_bus_init)
    347 		(*sc->sc_bus_init)(sc);
    348 
    349 	/*
    350 	 * Enable all interrupts except receive, since we use the DMA
    351 	 * completion interrupt for that.
    352 	 */
    353 	NIC_PUT(sc, MACE_IMR, RCVINTM);
    354 
    355 	/* Flag interface as "running" */
    356 	sc->sc_if.if_flags |= IFF_RUNNING;
    357 	sc->sc_if.if_flags &= ~IFF_OACTIVE;
    358 
    359 	splx(s);
    360 	return 0;
    361 }
    362 
    363 /*
    364  * Close down an interface and free its buffers
    365  * Called on final close of device, or if mcinit() fails part way through.
    366  */
    367 hide int
    368 mcstop(struct mc_softc *sc)
    369 {
    370 	int	s = splnet();
    371 
    372 	NIC_PUT(sc, MACE_BIUCC, SWRST);
    373 	DELAY(100);
    374 
    375 	sc->sc_if.if_timer = 0;
    376 	sc->sc_if.if_flags &= ~IFF_RUNNING;
    377 
    378 	splx(s);
    379 	return 0;
    380 }
    381 
    382 /*
    383  * Called if any Tx packets remain unsent after 5 seconds,
    384  * In all cases we just reset the chip, and any retransmission
    385  * will be handled by higher level protocol timeouts.
    386  */
    387 hide void
    388 mcwatchdog(struct ifnet *ifp)
    389 {
    390 	struct mc_softc *sc = ifp->if_softc;
    391 
    392 	printf("mcwatchdog: resetting chip\n");
    393 	mcreset(sc);
    394 }
    395 
    396 /*
    397  * Stuff packet into MACE (at splnet)
    398  */
    399 integrate u_int
    400 maceput(struct mc_softc *sc, struct mbuf *m)
    401 {
    402 	struct mbuf *n;
    403 	u_int len, totlen = 0;
    404 	u_char *buff;
    405 
    406 	buff = sc->sc_txbuf;
    407 
    408 	for (; m; m = n) {
    409 		u_char *data = mtod(m, u_char *);
    410 		len = m->m_len;
    411 		totlen += len;
    412 		memcpy(buff, data, len);
    413 		buff += len;
    414 		n = m_free(m);
    415 	}
    416 
    417 	if (totlen > PAGE_SIZE)
    418 		panic("%s: maceput: packet overflow", device_xname(sc->sc_dev));
    419 
    420 #if 0
    421 	if (totlen < ETHERMIN + sizeof(struct ether_header)) {
    422 		int pad = ETHERMIN + sizeof(struct ether_header) - totlen;
    423 		memset(sc->sc_txbuf + totlen, 0, pad);
    424 		totlen = ETHERMIN + sizeof(struct ether_header);
    425 	}
    426 #endif
    427 
    428 	(*sc->sc_putpacket)(sc, totlen);
    429 
    430 	sc->sc_if.if_timer = 5;	/* 5 seconds to watch for failing to transmit */
    431 	return totlen;
    432 }
    433 
    434 int
    435 mcintr(void *arg)
    436 {
    437 	struct mc_softc *sc = arg;
    438 	uint8_t ir;
    439 
    440 	ir = NIC_GET(sc, MACE_IR) & ~NIC_GET(sc, MACE_IMR);
    441 	if (ir == 0)
    442 		return 0;
    443 
    444 	if (ir & JAB) {
    445 #ifdef MCDEBUG
    446 		printf("%s: jabber error\n", device_xname(sc->sc_dev));
    447 #endif
    448 		sc->sc_if.if_oerrors++;
    449 	}
    450 
    451 	if (ir & BABL) {
    452 #ifdef MCDEBUG
    453 		printf("%s: babble\n", device_xname(sc->sc_dev));
    454 #endif
    455 		sc->sc_if.if_oerrors++;
    456 	}
    457 
    458 	if (ir & CERR) {
    459 		printf("%s: collision error\n", device_xname(sc->sc_dev));
    460 		sc->sc_if.if_collisions++;
    461 	}
    462 
    463 	/*
    464 	 * Pretend we have carrier; if we don't this will be cleared
    465 	 * shortly.
    466 	 */
    467 	sc->sc_havecarrier = 1;
    468 
    469 	if (ir & XMTINT)
    470 		mc_tint(sc);
    471 
    472 	if (ir & RCVINT)
    473 		mc_rint(sc);
    474 
    475 	return 1;
    476 }
    477 
    478 integrate void
    479 mc_tint(struct mc_softc *sc)
    480 {
    481 	uint8_t xmtfs;
    482 
    483 	(void)NIC_GET(sc, MACE_XMTRC);
    484 	xmtfs = NIC_GET(sc, MACE_XMTFS);
    485 
    486 	if ((xmtfs & XMTSV) == 0)
    487 		return;
    488 
    489 	if (xmtfs & UFLO) {
    490 		printf("%s: underflow\n", device_xname(sc->sc_dev));
    491 		mcreset(sc);
    492 		return;
    493 	}
    494 
    495 	if (xmtfs & LCOL) {
    496 		printf("%s: late collision\n", device_xname(sc->sc_dev));
    497 		sc->sc_if.if_oerrors++;
    498 		sc->sc_if.if_collisions++;
    499 	}
    500 
    501 	if (xmtfs & MORE)
    502 		/* Real number is unknown. */
    503 		sc->sc_if.if_collisions += 2;
    504 	else if (xmtfs & ONE)
    505 		sc->sc_if.if_collisions++;
    506 	else if (xmtfs & RTRY) {
    507 		sc->sc_if.if_collisions += 16;
    508 		sc->sc_if.if_oerrors++;
    509 	}
    510 
    511 	if (xmtfs & LCAR) {
    512 		sc->sc_havecarrier = 0;
    513 		printf("%s: lost carrier\n", device_xname(sc->sc_dev));
    514 		sc->sc_if.if_oerrors++;
    515 	}
    516 
    517 	sc->sc_if.if_flags &= ~IFF_OACTIVE;
    518 	sc->sc_if.if_timer = 0;
    519 	if_schedule_deferred_start(&sc->sc_if);
    520 }
    521 
    522 void
    523 mc_rint(struct mc_softc *sc)
    524 {
    525 #define	rxf	sc->sc_rxframe
    526 	u_int len;
    527 
    528 	len = (rxf.rx_rcvcnt | ((rxf.rx_rcvsts & 0xf) << 8)) - 4;
    529 
    530 #ifdef MCDEBUG
    531 	if (rxf.rx_rcvsts & 0xf0)
    532 		printf("%s: rcvcnt %02x rcvsts %02x rntpc 0x%02x rcvcc 0x%02x\n",
    533 		    device_xname(sc->sc_dev), rxf.rx_rcvcnt, rxf.rx_rcvsts,
    534 		    rxf.rx_rntpc, rxf.rx_rcvcc);
    535 #endif
    536 
    537 	if (rxf.rx_rcvsts & OFLO) {
    538 		printf("%s: receive FIFO overflow\n", device_xname(sc->sc_dev));
    539 		sc->sc_if.if_ierrors++;
    540 		return;
    541 	}
    542 
    543 	if (rxf.rx_rcvsts & CLSN)
    544 		sc->sc_if.if_collisions++;
    545 
    546 	if (rxf.rx_rcvsts & FRAM) {
    547 #ifdef MCDEBUG
    548 		printf("%s: framing error\n", device_xname(sc->sc_dev));
    549 #endif
    550 		sc->sc_if.if_ierrors++;
    551 		return;
    552 	}
    553 
    554 	if (rxf.rx_rcvsts & FCS) {
    555 #ifdef MCDEBUG
    556 		printf("%s: frame control checksum error\n",
    557 		    device_xname(sc->sc_dev));
    558 #endif
    559 		sc->sc_if.if_ierrors++;
    560 		return;
    561 	}
    562 
    563 	mace_read(sc, rxf.rx_frame, len);
    564 #undef	rxf
    565 }
    566 
    567 integrate void
    568 mace_read(struct mc_softc *sc, uint8_t *pkt, int len)
    569 {
    570 	struct ifnet *ifp = &sc->sc_if;
    571 	struct mbuf *m;
    572 
    573 	if (len <= sizeof(struct ether_header) ||
    574 	    len > ETHERMTU + sizeof(struct ether_header)) {
    575 #ifdef MCDEBUG
    576 		printf("%s: invalid packet size %d; dropping\n",
    577 		    device_xname(sc->sc_dev), len);
    578 #endif
    579 		ifp->if_ierrors++;
    580 		return;
    581 	}
    582 
    583 	m = mace_get(sc, pkt, len);
    584 	if (m == NULL) {
    585 		ifp->if_ierrors++;
    586 		return;
    587 	}
    588 
    589 	/* Pass the packet up. */
    590 	if_percpuq_enqueue(ifp->if_percpuq, m);
    591 }
    592 
    593 /*
    594  * Pull data off an interface.
    595  * Len is length of data, with local net header stripped.
    596  * We copy the data into mbufs.  When full cluster sized units are present
    597  * we copy into clusters.
    598  */
    599 integrate struct mbuf *
    600 mace_get(struct mc_softc *sc, uint8_t *pkt, int totlen)
    601 {
    602 	register struct mbuf *m;
    603 	struct mbuf *top, **mp;
    604 	int len;
    605 
    606 	MGETHDR(m, M_DONTWAIT, MT_DATA);
    607 	if (m == 0)
    608 		return 0;
    609 	m_set_rcvif(m, &sc->sc_if);
    610 	m->m_pkthdr.len = totlen;
    611 	len = MHLEN;
    612 	top = 0;
    613 	mp = &top;
    614 
    615 	while (totlen > 0) {
    616 		if (top) {
    617 			MGET(m, M_DONTWAIT, MT_DATA);
    618 			if (m == 0) {
    619 				m_freem(top);
    620 				return 0;
    621 			}
    622 			len = MLEN;
    623 		}
    624 		if (totlen >= MINCLSIZE) {
    625 			MCLGET(m, M_DONTWAIT);
    626 			if ((m->m_flags & M_EXT) == 0) {
    627 				m_free(m);
    628 				m_freem(top);
    629 				return 0;
    630 			}
    631 			len = MCLBYTES;
    632 		}
    633 		m->m_len = len = uimin(totlen, len);
    634 		memcpy(mtod(m, void *), pkt, len);
    635 		pkt += len;
    636 		totlen -= len;
    637 		*mp = m;
    638 		mp = &m->m_next;
    639 	}
    640 
    641 	return top;
    642 }
    643 
    644 /*
    645  * Go through the list of multicast addresses and calculate the logical
    646  * address filter.
    647  */
    648 void
    649 mace_calcladrf(struct ethercom *ac, uint8_t *af)
    650 {
    651 	struct ifnet *ifp = &ac->ec_if;
    652 	struct ether_multi *enm;
    653 	register u_char *cp, c;
    654 	register uint32_t crc;
    655 	register int i, len;
    656 	struct ether_multistep step;
    657 
    658 	/*
    659 	 * Set up multicast address filter by passing all multicast addresses
    660 	 * through a crc generator, and then using the high order 6 bits as an
    661 	 * index into the 64 bit logical address filter.  The high order bit
    662 	 * selects the word, while the rest of the bits select the bit within
    663 	 * the word.
    664 	 */
    665 
    666 	*((uint32_t *)af) = *((uint32_t *)af + 1) = 0;
    667 
    668 	ETHER_FIRST_MULTI(step, ac, enm);
    669 	while (enm != NULL) {
    670 		if (ETHER_CMP(enm->enm_addrlo, enm->enm_addrhi)) {
    671 			/*
    672 			 * We must listen to a range of multicast addresses.
    673 			 * For now, just accept all multicasts, rather than
    674 			 * trying to set only those filter bits needed to match
    675 			 * the range.  (At this time, the only use of address
    676 			 * ranges is for IP multicast routing, for which the
    677 			 * range is big enough to require all bits set.)
    678 			 */
    679 			goto allmulti;
    680 		}
    681 
    682 		cp = enm->enm_addrlo;
    683 		crc = 0xffffffff;
    684 		for (len = sizeof(enm->enm_addrlo); --len >= 0;) {
    685 			c = *cp++;
    686 			for (i = 8; --i >= 0;) {
    687 				if ((crc & 0x01) ^ (c & 0x01)) {
    688 					crc >>= 1;
    689 					crc ^= 0xedb88320;
    690 				} else
    691 					crc >>= 1;
    692 				c >>= 1;
    693 			}
    694 		}
    695 		/* Just want the 6 most significant bits. */
    696 		crc >>= 26;
    697 
    698 		/* Set the corresponding bit in the filter. */
    699 		af[crc >> 3] |= 1 << (crc & 7);
    700 
    701 		ETHER_NEXT_MULTI(step, enm);
    702 	}
    703 	ifp->if_flags &= ~IFF_ALLMULTI;
    704 	return;
    705 
    706 allmulti:
    707 	ifp->if_flags |= IFF_ALLMULTI;
    708 	*((uint32_t *)af) = *((uint32_t *)af + 1) = 0xffffffff;
    709 }
    710 
    711 int
    712 mc_mediachange(struct ifnet *ifp)
    713 {
    714 	return EINVAL;
    715 }
    716 
    717 void
    718 mc_mediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
    719 {
    720 	struct mc_softc *sc = ifp->if_softc;
    721 
    722 	if ((ifp->if_flags & IFF_UP) == 0)
    723 		return;
    724 
    725 	if (sc->sc_havecarrier)
    726 		ifmr->ifm_status |= IFM_ACTIVE;
    727 }
    728