if_mc.c revision 1.56.2.1 1 /* $NetBSD: if_mc.c,v 1.56.2.1 2021/04/03 22:28:29 thorpej Exp $ */
2
3 /*-
4 * Copyright (c) 1997 David Huang <khym (at) azeotrope.org>
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: if_mc.c,v 1.56.2.1 2021/04/03 22:28:29 thorpej Exp $");
39
40 #include "opt_ddb.h"
41 #include "opt_inet.h"
42
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/mbuf.h>
46 #include <sys/buf.h>
47 #include <sys/protosw.h>
48 #include <sys/socket.h>
49 #include <sys/syslog.h>
50 #include <sys/ioctl.h>
51 #include <sys/errno.h>
52 #include <sys/device.h>
53
54 #include <sys/rndsource.h>
55
56 #include <uvm/uvm_extern.h>
57
58 #include <net/if.h>
59 #include <net/if_dl.h>
60 #include <net/if_ether.h>
61 #include <net/bpf.h>
62
63 #ifdef INET
64 #include <netinet/in.h>
65 #include <netinet/if_inarp.h>
66 #include <netinet/in_systm.h>
67 #include <netinet/in_var.h>
68 #include <netinet/ip.h>
69 #endif
70
71 #include <machine/bus.h>
72 #include <mac68k/dev/if_mcreg.h>
73 #include <mac68k/dev/if_mcvar.h>
74
75 hide void mcwatchdog(struct ifnet *);
76 hide int mcinit(struct mc_softc *);
77 hide int mcstop(struct mc_softc *);
78 hide int mcioctl(struct ifnet *, u_long, void *);
79 hide void mcstart(struct ifnet *);
80 hide void mcreset(struct mc_softc *);
81
82 integrate u_int maceput(struct mc_softc *, struct mbuf *);
83 integrate void mc_tint(struct mc_softc *);
84 integrate void mace_read(struct mc_softc *, void *, int);
85 integrate struct mbuf *mace_get(struct mc_softc *, void *, int);
86 static void mace_calcladrf(struct ethercom *, uint8_t *);
87 static inline uint16_t ether_cmp(void *, void *);
88
89
90 /*
91 * Compare two Ether/802 addresses for equality, inlined and
92 * unrolled for speed. Use this like memcmp().
93 *
94 * XXX: Add <machine/inlines.h> for stuff like this?
95 * XXX: or maybe add it to libkern.h instead?
96 *
97 * "I'd love to have an inline assembler version of this."
98 * XXX: Who wanted that? mycroft? I wrote one, but this
99 * version in C is as good as hand-coded assembly. -gwr
100 *
101 * Please do NOT tweak this without looking at the actual
102 * assembly code generated before and after your tweaks!
103 */
104 static inline uint16_t
105 ether_cmp(void *one, void *two)
106 {
107 uint16_t *a = (u_short *) one;
108 uint16_t *b = (u_short *) two;
109 uint16_t diff;
110
111 #ifdef m68k
112 /*
113 * The post-increment-pointer form produces the best
114 * machine code for m68k. This was carefully tuned
115 * so it compiles to just 8 short (2-byte) op-codes!
116 */
117 diff = *a++ - *b++;
118 diff |= *a++ - *b++;
119 diff |= *a++ - *b++;
120 #else
121 /*
122 * Most modern CPUs do better with a single expression.
123 * Note that short-cut evaluation is NOT helpful here,
124 * because it just makes the code longer, not faster!
125 */
126 diff = (a[0] - b[0]) | (a[1] - b[1]) | (a[2] - b[2]);
127 #endif
128
129 return diff;
130 }
131
132 #define ETHER_CMP ether_cmp
133
134 /*
135 * Interface exists: make available by filling in network interface
136 * record. System will initialize the interface when it is ready
137 * to accept packets.
138 */
139 int
140 mcsetup(struct mc_softc *sc, uint8_t *lladdr)
141 {
142 struct ifnet *ifp = &sc->sc_if;
143
144 /* reset the chip and disable all interrupts */
145 NIC_PUT(sc, MACE_BIUCC, SWRST);
146 DELAY(100);
147 NIC_PUT(sc, MACE_IMR, ~0);
148
149 memcpy(sc->sc_enaddr, lladdr, ETHER_ADDR_LEN);
150 printf(": address %s\n", ether_sprintf(lladdr));
151
152 memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
153 ifp->if_softc = sc;
154 ifp->if_ioctl = mcioctl;
155 ifp->if_start = mcstart;
156 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
157 ifp->if_watchdog = mcwatchdog;
158
159 if_attach(ifp);
160 if_deferred_start_init(ifp, NULL);
161 ether_ifattach(ifp, lladdr);
162
163 rnd_attach_source(&sc->rnd_source, ifp->if_xname, RND_TYPE_NET,
164 RND_FLAG_DEFAULT);
165
166 return 0;
167 }
168
169 hide int
170 mcioctl(struct ifnet *ifp, u_long cmd, void *data)
171 {
172 struct mc_softc *sc = ifp->if_softc;
173 struct ifaddr *ifa;
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 default:
236 err = ether_ioctl(ifp, cmd, data);
237 }
238 splx(s);
239 return err;
240 }
241
242 /*
243 * Encapsulate a packet of type family for the local net.
244 */
245 hide void
246 mcstart(struct ifnet *ifp)
247 {
248 struct mc_softc *sc = ifp->if_softc;
249 struct mbuf *m;
250
251 if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
252 return;
253
254 while (1) {
255 if (ifp->if_flags & IFF_OACTIVE)
256 return;
257
258 IF_DEQUEUE(&ifp->if_snd, m);
259 if (m == 0)
260 return;
261
262 /*
263 * If bpf is listening on this interface, let it
264 * see the packet before we commit it to the wire.
265 */
266 bpf_mtap(ifp, m, BPF_D_OUT);
267
268 /*
269 * Copy the mbuf chain into the transmit buffer.
270 */
271 ifp->if_flags |= IFF_OACTIVE;
272 maceput(sc, m);
273
274 if_statinc(ifp, if_opackets); /* # of pkts */
275 }
276 }
277
278 /*
279 * reset and restart the MACE. Called in case of fatal
280 * hardware/software errors.
281 */
282 hide void
283 mcreset(struct mc_softc *sc)
284 {
285 mcstop(sc);
286 mcinit(sc);
287 }
288
289 hide int
290 mcinit(struct mc_softc *sc)
291 {
292 int s;
293 uint8_t maccc, ladrf[8];
294
295 if (sc->sc_if.if_flags & IFF_RUNNING)
296 /* already running */
297 return 0;
298
299 s = splnet();
300
301 NIC_PUT(sc, MACE_BIUCC, sc->sc_biucc);
302 NIC_PUT(sc, MACE_FIFOCC, sc->sc_fifocc);
303 NIC_PUT(sc, MACE_IMR, ~0); /* disable all interrupts */
304 NIC_PUT(sc, MACE_PLSCC, sc->sc_plscc);
305
306 NIC_PUT(sc, MACE_UTR, RTRD); /* disable reserved test registers */
307
308 /* set MAC address */
309 NIC_PUT(sc, MACE_IAC, ADDRCHG);
310 while (NIC_GET(sc, MACE_IAC) & ADDRCHG)
311 ;
312 NIC_PUT(sc, MACE_IAC, PHYADDR);
313 bus_space_write_multi_1(sc->sc_regt, sc->sc_regh, MACE_REG(MACE_PADR),
314 sc->sc_enaddr, ETHER_ADDR_LEN);
315
316 /* set logical address filter */
317 mace_calcladrf(&sc->sc_ethercom, ladrf);
318
319 NIC_PUT(sc, MACE_IAC, ADDRCHG);
320 while (NIC_GET(sc, MACE_IAC) & ADDRCHG)
321 ;
322 NIC_PUT(sc, MACE_IAC, LOGADDR);
323 bus_space_write_multi_1(sc->sc_regt, sc->sc_regh, MACE_REG(MACE_LADRF),
324 ladrf, 8);
325
326 NIC_PUT(sc, MACE_XMTFC, APADXMT);
327 /*
328 * No need to autostrip padding on receive... Ethernet frames
329 * don't have a length field, unlike 802.3 frames, so the MACE
330 * can't figure out the length of the packet anyways.
331 */
332 NIC_PUT(sc, MACE_RCVFC, 0);
333
334 maccc = ENXMT | ENRCV;
335 if (sc->sc_if.if_flags & IFF_PROMISC)
336 maccc |= PROM;
337
338 NIC_PUT(sc, MACE_MACCC, maccc);
339
340 if (sc->sc_bus_init)
341 (*sc->sc_bus_init)(sc);
342
343 /*
344 * Enable all interrupts except receive, since we use the DMA
345 * completion interrupt for that.
346 */
347 NIC_PUT(sc, MACE_IMR, RCVINTM);
348
349 /* flag interface as "running" */
350 sc->sc_if.if_flags |= IFF_RUNNING;
351 sc->sc_if.if_flags &= ~IFF_OACTIVE;
352
353 splx(s);
354 return 0;
355 }
356
357 /*
358 * close down an interface and free its buffers
359 * Called on final close of device, or if mcinit() fails
360 * part way through.
361 */
362 hide int
363 mcstop(struct mc_softc *sc)
364 {
365 int s;
366
367 s = splnet();
368
369 NIC_PUT(sc, MACE_BIUCC, SWRST);
370 DELAY(100);
371
372 sc->sc_if.if_timer = 0;
373 sc->sc_if.if_flags &= ~IFF_RUNNING;
374
375 splx(s);
376 return 0;
377 }
378
379 /*
380 * Called if any Tx packets remain unsent after 5 seconds,
381 * In all cases we just reset the chip, and any retransmission
382 * will be handled by higher level protocol timeouts.
383 */
384 hide void
385 mcwatchdog(struct ifnet *ifp)
386 {
387 struct mc_softc *sc = ifp->if_softc;
388
389 printf("mcwatchdog: resetting chip\n");
390 mcreset(sc);
391 }
392
393 /*
394 * stuff packet into MACE (at splnet)
395 */
396 integrate u_int
397 maceput(struct mc_softc *sc, struct mbuf *m)
398 {
399 struct mbuf *n;
400 u_int len, totlen = 0;
401 u_char *buff;
402
403 buff = (u_char*)sc->sc_txbuf + (sc->sc_txset == 0 ? 0 : 0x800);
404
405 for (; m; m = n) {
406 u_char *data = mtod(m, u_char *);
407 len = m->m_len;
408 totlen += len;
409 memcpy(buff, data, len);
410 buff += len;
411 n = m_free(m);
412 }
413
414 if (totlen > PAGE_SIZE)
415 panic("%s: maceput: packet overflow", device_xname(sc->sc_dev));
416
417 #if 0
418 if (totlen < ETHERMIN + sizeof(struct ether_header)) {
419 int pad = ETHERMIN + sizeof(struct ether_header) - totlen;
420 memset(sc->sc_txbuf + totlen, 0, pad);
421 totlen = ETHERMIN + sizeof(struct ether_header);
422 }
423 #endif
424
425 (*sc->sc_putpacket)(sc, totlen);
426
427 sc->sc_if.if_timer = 5; /* 5 seconds to watch for failing to transmit */
428 return totlen;
429 }
430
431 void
432 mcintr(void *arg)
433 {
434 struct mc_softc *sc = arg;
435 uint8_t ir;
436
437 ir = NIC_GET(sc, MACE_IR) & ~NIC_GET(sc, MACE_IMR);
438 if (ir & JAB) {
439 #ifdef MCDEBUG
440 printf("%s: jabber error\n", device_xname(sc->sc_dev));
441 #endif
442 if_statinc(&sc->sc_if, if_oerrors);
443 }
444
445 if (ir & BABL) {
446 #ifdef MCDEBUG
447 printf("%s: babble\n", device_xname(sc->sc_dev));
448 #endif
449 if_statinc(&sc->sc_if, if_oerrors);
450 }
451
452 if (ir & CERR) {
453 #ifdef MCDEBUG
454 printf("%s: collision error\n", device_xname(sc->sc_dev));
455 #endif
456 if_statinc(&sc->sc_if, if_collisions);
457 }
458
459 /*
460 * Pretend we have carrier; if we don't this will be cleared
461 * shortly.
462 */
463 const int ocarrier = sc->sc_havecarrier;
464 sc->sc_havecarrier = 1;
465
466 if (ir & XMTINT)
467 mc_tint(sc);
468
469 if (ir & RCVINT)
470 mc_rint(sc);
471
472 if (sc->sc_havecarrier != ocarrier)
473 if_link_state_change(&sc->sc_if,
474 sc->sc_havecarrier ? LINK_STATE_UP : LINK_STATE_DOWN);
475 }
476
477 integrate void
478 mc_tint(struct mc_softc *sc)
479 {
480 uint8_t /* xmtrc,*/ xmtfs;
481
482 /* xmtrc = */ NIC_GET(sc, MACE_XMTRC);
483 xmtfs = NIC_GET(sc, MACE_XMTFS);
484
485 if ((xmtfs & XMTSV) == 0)
486 return;
487
488 if (xmtfs & UFLO) {
489 printf("%s: underflow\n", device_xname(sc->sc_dev));
490 mcreset(sc);
491 return;
492 }
493
494 net_stat_ref_t nsr = IF_STAT_GETREF(&sc->sc_if);
495
496 if (xmtfs & LCOL) {
497 printf("%s: late collision\n", device_xname(sc->sc_dev));
498 if_statinc_ref(nsr, if_oerrors);
499 if_statinc_ref(nsr, if_collisions);
500 }
501
502 if (xmtfs & MORE)
503 /* Real number is unknown. */
504 if_statadd_ref(nsr, if_collisions, 2);
505 else if (xmtfs & ONE)
506 if_statinc_ref(nsr, if_collisions);
507 else if (xmtfs & RTRY) {
508 printf("%s: excessive collisions\n", device_xname(sc->sc_dev));
509 if_statadd_ref(nsr, if_collisions, 16);
510 if_statinc_ref(nsr, if_oerrors);
511 }
512
513 if (xmtfs & LCAR) {
514 sc->sc_havecarrier = 0;
515 printf("%s: lost carrier\n", device_xname(sc->sc_dev));
516 if_statinc_ref(nsr, if_oerrors);
517 }
518
519 IF_STAT_PUTREF(&sc->sc_if);
520
521 sc->sc_if.if_flags &= ~IFF_OACTIVE;
522 sc->sc_if.if_timer = 0;
523 if_schedule_deferred_start(&sc->sc_if);
524
525 rnd_add_uint32(&sc->rnd_source, xmtfs);
526 }
527
528 void
529 mc_rint(struct mc_softc *sc)
530 {
531 #define rxf sc->sc_rxframe
532 u_int len;
533
534 len = (rxf.rx_rcvcnt | ((rxf.rx_rcvsts & 0xf) << 8)) - 4;
535
536 #ifdef MCDEBUG
537 if (rxf.rx_rcvsts & 0xf0)
538 printf("%s: rcvcnt %02x rcvsts %02x rntpc 0x%02x rcvcc 0x%02x\n",
539 device_xname(sc->sc_dev), rxf.rx_rcvcnt, rxf.rx_rcvsts,
540 rxf.rx_rntpc, rxf.rx_rcvcc);
541 #endif
542
543 if (rxf.rx_rcvsts & OFLO) {
544 printf("%s: receive FIFO overflow\n", device_xname(sc->sc_dev));
545 if_statinc(&sc->sc_if, if_ierrors);
546 return;
547 }
548
549 if (rxf.rx_rcvsts & CLSN)
550 if_statinc(&sc->sc_if, if_collisions);
551
552 if (rxf.rx_rcvsts & FRAM) {
553 #ifdef MCDEBUG
554 printf("%s: framing error\n", device_xname(sc->sc_dev));
555 #endif
556 if_statinc(&sc->sc_if, if_ierrors);
557 return;
558 }
559
560 if (rxf.rx_rcvsts & FCS) {
561 #ifdef MCDEBUG
562 printf("%s: frame control checksum error\n", device_xname(sc->sc_dev));
563 #endif
564 if_statinc(&sc->sc_if, if_ierrors);
565 return;
566 }
567
568 mace_read(sc, rxf.rx_frame, len);
569
570 rnd_add_uint32(&sc->rnd_source, rxf.rx_rcvsts);
571 #undef rxf
572 }
573
574 integrate void
575 mace_read(struct mc_softc *sc, void *pkt, int len)
576 {
577 struct ifnet *ifp = &sc->sc_if;
578 struct mbuf *m;
579
580 if (len <= sizeof(struct ether_header) ||
581 len > ETHERMTU + sizeof(struct ether_header)) {
582 #ifdef MCDEBUG
583 printf("%s: invalid packet size %d; dropping\n",
584 device_xname(sc->sc_dev), len);
585 #endif
586 if_statinc(ifp, if_ierrors);
587 return;
588 }
589
590 m = mace_get(sc, pkt, len);
591 if (m == NULL) {
592 if_statinc(ifp, if_ierrors);
593 return;
594 }
595
596 /* Pass the packet up. */
597 if_percpuq_enqueue(ifp->if_percpuq, m);
598 }
599
600 /*
601 * Pull data off an interface.
602 * Len is length of data, with local net header stripped.
603 * We copy the data into mbufs. When full cluster sized units are present
604 * we copy into clusters.
605 */
606 integrate struct mbuf *
607 mace_get(struct mc_softc *sc, void *pkt, int totlen)
608 {
609 struct mbuf *m;
610 struct mbuf *top, **mp;
611 int len;
612
613 MGETHDR(m, M_DONTWAIT, MT_DATA);
614 if (m == 0)
615 return 0;
616 m_set_rcvif(m, &sc->sc_if);
617 m->m_pkthdr.len = totlen;
618 len = MHLEN;
619 top = 0;
620 mp = ⊤
621
622 while (totlen > 0) {
623 if (top) {
624 MGET(m, M_DONTWAIT, MT_DATA);
625 if (m == 0) {
626 m_freem(top);
627 return 0;
628 }
629 len = MLEN;
630 }
631 if (totlen >= MINCLSIZE) {
632 MCLGET(m, M_DONTWAIT);
633 if ((m->m_flags & M_EXT) == 0) {
634 m_free(m);
635 m_freem(top);
636 return 0;
637 }
638 len = MCLBYTES;
639 }
640 m->m_len = len = uimin(totlen, len);
641 memcpy(mtod(m, void *), pkt, len);
642 pkt = (char*)pkt + len;
643 totlen -= len;
644 *mp = m;
645 mp = &m->m_next;
646 }
647
648 return top;
649 }
650
651 /*
652 * Go through the list of multicast addresses and calculate the logical
653 * address filter.
654 */
655 void
656 mace_calcladrf(struct ethercom *ec, uint8_t *af)
657 {
658 struct ifnet *ifp = &ec->ec_if;
659 struct ether_multi *enm;
660 u_char *cp;
661 uint32_t crc;
662 static const uint32_t crctab[] = {
663 0x00000000, 0x1db71064, 0x3b6e20c8, 0x26d930ac,
664 0x76dc4190, 0x6b6b51f4, 0x4db26158, 0x5005713c,
665 0xedb88320, 0xf00f9344, 0xd6d6a3e8, 0xcb61b38c,
666 0x9b64c2b0, 0x86d3d2d4, 0xa00ae278, 0xbdbdf21c
667 };
668 int len;
669 struct ether_multistep step;
670
671 /*
672 * Set up multicast address filter by passing all multicast addresses
673 * through a crc generator, and then using the high order 6 bits as an
674 * index into the 64 bit logical address filter. The high order bit
675 * selects the word, while the rest of the bits select the bit within
676 * the word.
677 */
678
679 *((uint32_t *)af) = *((uint32_t *)af + 1) = 0;
680 ETHER_LOCK(ec);
681 ETHER_FIRST_MULTI(step, ec, enm);
682 while (enm != NULL) {
683 if (ETHER_CMP(enm->enm_addrlo, enm->enm_addrhi)) {
684 /*
685 * We must listen to a range of multicast addresses.
686 * For now, just accept all multicasts, rather than
687 * trying to set only those filter bits needed to match
688 * the range. (At this time, the only use of address
689 * ranges is for IP multicast routing, for which the
690 * range is big enough to require all bits set.)
691 */
692 ETHER_UNLOCK(ec);
693 goto allmulti;
694 }
695
696 cp = enm->enm_addrlo;
697 crc = 0xffffffff;
698 for (len = sizeof(enm->enm_addrlo); --len >= 0;) {
699 crc ^= *cp++;
700 crc = (crc >> 4) ^ crctab[crc & 0xf];
701 crc = (crc >> 4) ^ crctab[crc & 0xf];
702 }
703 /* Just want the 6 most significant bits. */
704 crc >>= 26;
705
706 /* Set the corresponding bit in the filter. */
707 af[crc >> 3] |= 1 << (crc & 7);
708
709 ETHER_NEXT_MULTI(step, enm);
710 }
711 ETHER_UNLOCK(ec);
712 ifp->if_flags &= ~IFF_ALLMULTI;
713 return;
714
715 allmulti:
716 ifp->if_flags |= IFF_ALLMULTI;
717 *((uint32_t *)af) = *((uint32_t *)af + 1) = 0xffffffff;
718 }
719
720 static u_char bbr4[] = {0,8,4,12,2,10,6,14,1,9,5,13,3,11,7,15};
721 #define bbr(v) ((bbr4[(v)&0xf] << 4) | bbr4[((v)>>4) & 0xf])
722
723 u_char
724 mc_get_enaddr(bus_space_tag_t t, bus_space_handle_t h, bus_size_t o,
725 u_char *dst)
726 {
727 int i;
728 u_char b, csum;
729
730 /*
731 * The XOR of the 8 bytes of the ROM must be 0xff for it to be
732 * valid
733 */
734 for (i = 0, csum = 0; i < 8; i++) {
735 b = bus_space_read_1(t, h, o+16*i);
736 if (i < ETHER_ADDR_LEN)
737 dst[i] = bbr(b);
738 csum ^= b;
739 }
740
741 return csum;
742 }
743