dp83932.c revision 1.36.12.1 1 /* $NetBSD: dp83932.c,v 1.36.12.1 2017/08/12 03:42:33 snj Exp $ */
2
3 /*-
4 * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Jason R. Thorpe.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 /*
33 * Device driver for the National Semiconductor DP83932
34 * Systems-Oriented Network Interface Controller (SONIC).
35 */
36
37 #include <sys/cdefs.h>
38 __KERNEL_RCSID(0, "$NetBSD: dp83932.c,v 1.36.12.1 2017/08/12 03:42:33 snj Exp $");
39
40
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/mbuf.h>
44 #include <sys/malloc.h>
45 #include <sys/kernel.h>
46 #include <sys/socket.h>
47 #include <sys/ioctl.h>
48 #include <sys/errno.h>
49 #include <sys/device.h>
50
51 #include <net/if.h>
52 #include <net/if_dl.h>
53 #include <net/if_ether.h>
54
55 #include <net/bpf.h>
56
57 #include <sys/bus.h>
58 #include <sys/intr.h>
59
60 #include <dev/ic/dp83932reg.h>
61 #include <dev/ic/dp83932var.h>
62
63 static void sonic_start(struct ifnet *);
64 static void sonic_watchdog(struct ifnet *);
65 static int sonic_ioctl(struct ifnet *, u_long, void *);
66 static int sonic_init(struct ifnet *);
67 static void sonic_stop(struct ifnet *, int);
68
69 static bool sonic_shutdown(device_t, int);
70
71 static void sonic_reset(struct sonic_softc *);
72 static void sonic_rxdrain(struct sonic_softc *);
73 static int sonic_add_rxbuf(struct sonic_softc *, int);
74 static void sonic_set_filter(struct sonic_softc *);
75
76 static uint16_t sonic_txintr(struct sonic_softc *);
77 static void sonic_rxintr(struct sonic_softc *);
78
79 int sonic_copy_small = 0;
80
81 #define ETHER_PAD_LEN (ETHER_MIN_LEN - ETHER_CRC_LEN)
82
83 /*
84 * sonic_attach:
85 *
86 * Attach a SONIC interface to the system.
87 */
88 void
89 sonic_attach(struct sonic_softc *sc, const uint8_t *enaddr)
90 {
91 struct ifnet *ifp = &sc->sc_ethercom.ec_if;
92 int i, rseg, error;
93 bus_dma_segment_t seg;
94 size_t cdatasize;
95 uint8_t *nullbuf;
96
97 /*
98 * Allocate the control data structures, and create and load the
99 * DMA map for it.
100 */
101 if (sc->sc_32bit)
102 cdatasize = sizeof(struct sonic_control_data32);
103 else
104 cdatasize = sizeof(struct sonic_control_data16);
105
106 if ((error = bus_dmamem_alloc(sc->sc_dmat, cdatasize + ETHER_PAD_LEN,
107 PAGE_SIZE, (64 * 1024), &seg, 1, &rseg,
108 BUS_DMA_NOWAIT)) != 0) {
109 aprint_error_dev(sc->sc_dev,
110 "unable to allocate control data, error = %d\n", error);
111 goto fail_0;
112 }
113
114 if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg,
115 cdatasize + ETHER_PAD_LEN, (void **) &sc->sc_cdata16,
116 BUS_DMA_NOWAIT|BUS_DMA_COHERENT)) != 0) {
117 aprint_error_dev(sc->sc_dev,
118 "unable to map control data, error = %d\n", error);
119 goto fail_1;
120 }
121 nullbuf = (uint8_t *)sc->sc_cdata16 + cdatasize;
122 memset(nullbuf, 0, ETHER_PAD_LEN);
123
124 if ((error = bus_dmamap_create(sc->sc_dmat,
125 cdatasize, 1, cdatasize, 0, BUS_DMA_NOWAIT,
126 &sc->sc_cddmamap)) != 0) {
127 aprint_error_dev(sc->sc_dev,
128 "unable to create control data DMA map, error = %d\n",
129 error);
130 goto fail_2;
131 }
132
133 if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_cddmamap,
134 sc->sc_cdata16, cdatasize, NULL, BUS_DMA_NOWAIT)) != 0) {
135 aprint_error_dev(sc->sc_dev,
136 "unable to load control data DMA map, error = %d\n", error);
137 goto fail_3;
138 }
139
140 /*
141 * Create the transmit buffer DMA maps.
142 */
143 for (i = 0; i < SONIC_NTXDESC; i++) {
144 if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
145 SONIC_NTXFRAGS, MCLBYTES, 0, BUS_DMA_NOWAIT,
146 &sc->sc_txsoft[i].ds_dmamap)) != 0) {
147 aprint_error_dev(sc->sc_dev,
148 "unable to create tx DMA map %d, error = %d\n",
149 i, error);
150 goto fail_4;
151 }
152 }
153
154 /*
155 * Create the receive buffer DMA maps.
156 */
157 for (i = 0; i < SONIC_NRXDESC; i++) {
158 if ((error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
159 MCLBYTES, 0, BUS_DMA_NOWAIT,
160 &sc->sc_rxsoft[i].ds_dmamap)) != 0) {
161 aprint_error_dev(sc->sc_dev,
162 "unable to create rx DMA map %d, error = %d\n",
163 i, error);
164 goto fail_5;
165 }
166 sc->sc_rxsoft[i].ds_mbuf = NULL;
167 }
168
169 /*
170 * create and map the pad buffer
171 */
172 if ((error = bus_dmamap_create(sc->sc_dmat, ETHER_PAD_LEN, 1,
173 ETHER_PAD_LEN, 0, BUS_DMA_NOWAIT, &sc->sc_nulldmamap)) != 0) {
174 aprint_error_dev(sc->sc_dev,
175 "unable to create pad buffer DMA map, error = %d\n", error);
176 goto fail_5;
177 }
178
179 if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_nulldmamap,
180 nullbuf, ETHER_PAD_LEN, NULL, BUS_DMA_NOWAIT)) != 0) {
181 aprint_error_dev(sc->sc_dev,
182 "unable to load pad buffer DMA map, error = %d\n", error);
183 goto fail_6;
184 }
185 bus_dmamap_sync(sc->sc_dmat, sc->sc_nulldmamap, 0, ETHER_PAD_LEN,
186 BUS_DMASYNC_PREWRITE);
187
188 /*
189 * Reset the chip to a known state.
190 */
191 sonic_reset(sc);
192
193 aprint_normal_dev(sc->sc_dev, "Ethernet address %s\n",
194 ether_sprintf(enaddr));
195
196 strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
197 ifp->if_softc = sc;
198 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
199 ifp->if_ioctl = sonic_ioctl;
200 ifp->if_start = sonic_start;
201 ifp->if_watchdog = sonic_watchdog;
202 ifp->if_init = sonic_init;
203 ifp->if_stop = sonic_stop;
204 IFQ_SET_READY(&ifp->if_snd);
205
206 /*
207 * We can support 802.1Q VLAN-sized frames.
208 */
209 sc->sc_ethercom.ec_capabilities |= ETHERCAP_VLAN_MTU;
210
211 /*
212 * Attach the interface.
213 */
214 if_attach(ifp);
215 ether_ifattach(ifp, enaddr);
216
217 /*
218 * Make sure the interface is shutdown during reboot.
219 */
220 if (pmf_device_register1(sc->sc_dev, NULL, NULL, sonic_shutdown))
221 pmf_class_network_register(sc->sc_dev, ifp);
222 else
223 aprint_error_dev(sc->sc_dev,
224 "couldn't establish power handler\n");
225
226 return;
227
228 /*
229 * Free any resources we've allocated during the failed attach
230 * attempt. Do this in reverse order and fall through.
231 */
232 fail_6:
233 bus_dmamap_destroy(sc->sc_dmat, sc->sc_nulldmamap);
234 fail_5:
235 for (i = 0; i < SONIC_NRXDESC; i++) {
236 if (sc->sc_rxsoft[i].ds_dmamap != NULL)
237 bus_dmamap_destroy(sc->sc_dmat,
238 sc->sc_rxsoft[i].ds_dmamap);
239 }
240 fail_4:
241 for (i = 0; i < SONIC_NTXDESC; i++) {
242 if (sc->sc_txsoft[i].ds_dmamap != NULL)
243 bus_dmamap_destroy(sc->sc_dmat,
244 sc->sc_txsoft[i].ds_dmamap);
245 }
246 bus_dmamap_unload(sc->sc_dmat, sc->sc_cddmamap);
247 fail_3:
248 bus_dmamap_destroy(sc->sc_dmat, sc->sc_cddmamap);
249 fail_2:
250 bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_cdata16, cdatasize);
251 fail_1:
252 bus_dmamem_free(sc->sc_dmat, &seg, rseg);
253 fail_0:
254 return;
255 }
256
257 /*
258 * sonic_shutdown:
259 *
260 * Make sure the interface is stopped at reboot.
261 */
262 bool
263 sonic_shutdown(device_t self, int howto)
264 {
265 struct sonic_softc *sc = device_private(self);
266
267 sonic_stop(&sc->sc_ethercom.ec_if, 1);
268
269 return true;
270 }
271
272 /*
273 * sonic_start: [ifnet interface function]
274 *
275 * Start packet transmission on the interface.
276 */
277 void
278 sonic_start(struct ifnet *ifp)
279 {
280 struct sonic_softc *sc = ifp->if_softc;
281 struct mbuf *m0, *m;
282 struct sonic_tda16 *tda16;
283 struct sonic_tda32 *tda32;
284 struct sonic_descsoft *ds;
285 bus_dmamap_t dmamap;
286 int error, olasttx, nexttx, opending, totlen, olseg;
287 int seg = 0; /* XXX: gcc */
288
289 if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
290 return;
291
292 /*
293 * Remember the previous txpending and the current "last txdesc
294 * used" index.
295 */
296 opending = sc->sc_txpending;
297 olasttx = sc->sc_txlast;
298
299 /*
300 * Loop through the send queue, setting up transmit descriptors
301 * until we drain the queue, or use up all available transmit
302 * descriptors. Leave one at the end for sanity's sake.
303 */
304 while (sc->sc_txpending < (SONIC_NTXDESC - 1)) {
305 /*
306 * Grab a packet off the queue.
307 */
308 IFQ_POLL(&ifp->if_snd, m0);
309 if (m0 == NULL)
310 break;
311 m = NULL;
312
313 /*
314 * Get the next available transmit descriptor.
315 */
316 nexttx = SONIC_NEXTTX(sc->sc_txlast);
317 ds = &sc->sc_txsoft[nexttx];
318 dmamap = ds->ds_dmamap;
319
320 /*
321 * Load the DMA map. If this fails, the packet either
322 * didn't fit in the allotted number of frags, or we were
323 * short on resources. In this case, we'll copy and try
324 * again.
325 */
326 if ((error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
327 BUS_DMA_WRITE|BUS_DMA_NOWAIT)) != 0 ||
328 (m0->m_pkthdr.len < ETHER_PAD_LEN &&
329 dmamap->dm_nsegs == SONIC_NTXFRAGS)) {
330 if (error == 0)
331 bus_dmamap_unload(sc->sc_dmat, dmamap);
332 MGETHDR(m, M_DONTWAIT, MT_DATA);
333 if (m == NULL) {
334 printf("%s: unable to allocate Tx mbuf\n",
335 device_xname(sc->sc_dev));
336 break;
337 }
338 if (m0->m_pkthdr.len > MHLEN) {
339 MCLGET(m, M_DONTWAIT);
340 if ((m->m_flags & M_EXT) == 0) {
341 printf("%s: unable to allocate Tx "
342 "cluster\n",
343 device_xname(sc->sc_dev));
344 m_freem(m);
345 break;
346 }
347 }
348 m_copydata(m0, 0, m0->m_pkthdr.len, mtod(m, void *));
349 m->m_pkthdr.len = m->m_len = m0->m_pkthdr.len;
350 error = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap,
351 m, BUS_DMA_WRITE|BUS_DMA_NOWAIT);
352 if (error) {
353 printf("%s: unable to load Tx buffer, "
354 "error = %d\n", device_xname(sc->sc_dev),
355 error);
356 m_freem(m);
357 break;
358 }
359 }
360 IFQ_DEQUEUE(&ifp->if_snd, m0);
361 if (m != NULL) {
362 m_freem(m0);
363 m0 = m;
364 }
365
366 /*
367 * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET.
368 */
369
370 /* Sync the DMA map. */
371 bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
372 BUS_DMASYNC_PREWRITE);
373
374 /*
375 * Store a pointer to the packet so we can free it later.
376 */
377 ds->ds_mbuf = m0;
378
379 /*
380 * Initialize the transmit descriptor.
381 */
382 totlen = 0;
383 if (sc->sc_32bit) {
384 tda32 = &sc->sc_tda32[nexttx];
385 for (seg = 0; seg < dmamap->dm_nsegs; seg++) {
386 tda32->tda_frags[seg].frag_ptr1 =
387 htosonic32(sc,
388 (dmamap->dm_segs[seg].ds_addr >> 16) &
389 0xffff);
390 tda32->tda_frags[seg].frag_ptr0 =
391 htosonic32(sc,
392 dmamap->dm_segs[seg].ds_addr & 0xffff);
393 tda32->tda_frags[seg].frag_size =
394 htosonic32(sc, dmamap->dm_segs[seg].ds_len);
395 totlen += dmamap->dm_segs[seg].ds_len;
396 }
397 if (totlen < ETHER_PAD_LEN) {
398 tda32->tda_frags[seg].frag_ptr1 =
399 htosonic32(sc,
400 (sc->sc_nulldma >> 16) & 0xffff);
401 tda32->tda_frags[seg].frag_ptr0 =
402 htosonic32(sc, sc->sc_nulldma & 0xffff);
403 tda32->tda_frags[seg].frag_size =
404 htosonic32(sc, ETHER_PAD_LEN - totlen);
405 totlen = ETHER_PAD_LEN;
406 seg++;
407 }
408
409 tda32->tda_status = 0;
410 tda32->tda_pktconfig = 0;
411 tda32->tda_pktsize = htosonic32(sc, totlen);
412 tda32->tda_fragcnt = htosonic32(sc, seg);
413
414 /* Link it up. */
415 tda32->tda_frags[seg].frag_ptr0 =
416 htosonic32(sc, SONIC_CDTXADDR32(sc,
417 SONIC_NEXTTX(nexttx)) & 0xffff);
418
419 /* Sync the Tx descriptor. */
420 SONIC_CDTXSYNC32(sc, nexttx,
421 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
422 } else {
423 tda16 = &sc->sc_tda16[nexttx];
424 for (seg = 0; seg < dmamap->dm_nsegs; seg++) {
425 tda16->tda_frags[seg].frag_ptr1 =
426 htosonic16(sc,
427 (dmamap->dm_segs[seg].ds_addr >> 16) &
428 0xffff);
429 tda16->tda_frags[seg].frag_ptr0 =
430 htosonic16(sc,
431 dmamap->dm_segs[seg].ds_addr & 0xffff);
432 tda16->tda_frags[seg].frag_size =
433 htosonic16(sc, dmamap->dm_segs[seg].ds_len);
434 totlen += dmamap->dm_segs[seg].ds_len;
435 }
436 if (totlen < ETHER_PAD_LEN) {
437 tda16->tda_frags[seg].frag_ptr1 =
438 htosonic16(sc,
439 (sc->sc_nulldma >> 16) & 0xffff);
440 tda16->tda_frags[seg].frag_ptr0 =
441 htosonic16(sc, sc->sc_nulldma & 0xffff);
442 tda16->tda_frags[seg].frag_size =
443 htosonic16(sc, ETHER_PAD_LEN - totlen);
444 totlen = ETHER_PAD_LEN;
445 seg++;
446 }
447
448 tda16->tda_status = 0;
449 tda16->tda_pktconfig = 0;
450 tda16->tda_pktsize = htosonic16(sc, totlen);
451 tda16->tda_fragcnt = htosonic16(sc, seg);
452
453 /* Link it up. */
454 tda16->tda_frags[seg].frag_ptr0 =
455 htosonic16(sc, SONIC_CDTXADDR16(sc,
456 SONIC_NEXTTX(nexttx)) & 0xffff);
457
458 /* Sync the Tx descriptor. */
459 SONIC_CDTXSYNC16(sc, nexttx,
460 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
461 }
462
463 /* Advance the Tx pointer. */
464 sc->sc_txpending++;
465 sc->sc_txlast = nexttx;
466
467 /*
468 * Pass the packet to any BPF listeners.
469 */
470 bpf_mtap(ifp, m0);
471 }
472
473 if (sc->sc_txpending == (SONIC_NTXDESC - 1)) {
474 /* No more slots left; notify upper layer. */
475 ifp->if_flags |= IFF_OACTIVE;
476 }
477
478 if (sc->sc_txpending != opending) {
479 /*
480 * We enqueued packets. If the transmitter was idle,
481 * reset the txdirty pointer.
482 */
483 if (opending == 0)
484 sc->sc_txdirty = SONIC_NEXTTX(olasttx);
485
486 /*
487 * Stop the SONIC on the last packet we've set up,
488 * and clear end-of-list on the descriptor previous
489 * to our new chain.
490 *
491 * NOTE: our `seg' variable should still be valid!
492 */
493 if (sc->sc_32bit) {
494 olseg =
495 sonic32toh(sc, sc->sc_tda32[olasttx].tda_fragcnt);
496 sc->sc_tda32[sc->sc_txlast].tda_frags[seg].frag_ptr0 |=
497 htosonic32(sc, TDA_LINK_EOL);
498 SONIC_CDTXSYNC32(sc, sc->sc_txlast,
499 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
500 sc->sc_tda32[olasttx].tda_frags[olseg].frag_ptr0 &=
501 htosonic32(sc, ~TDA_LINK_EOL);
502 SONIC_CDTXSYNC32(sc, olasttx,
503 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
504 } else {
505 olseg =
506 sonic16toh(sc, sc->sc_tda16[olasttx].tda_fragcnt);
507 sc->sc_tda16[sc->sc_txlast].tda_frags[seg].frag_ptr0 |=
508 htosonic16(sc, TDA_LINK_EOL);
509 SONIC_CDTXSYNC16(sc, sc->sc_txlast,
510 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
511 sc->sc_tda16[olasttx].tda_frags[olseg].frag_ptr0 &=
512 htosonic16(sc, ~TDA_LINK_EOL);
513 SONIC_CDTXSYNC16(sc, olasttx,
514 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
515 }
516
517 /* Start the transmitter. */
518 CSR_WRITE(sc, SONIC_CR, CR_TXP);
519
520 /* Set a watchdog timer in case the chip flakes out. */
521 ifp->if_timer = 5;
522 }
523 }
524
525 /*
526 * sonic_watchdog: [ifnet interface function]
527 *
528 * Watchdog timer handler.
529 */
530 void
531 sonic_watchdog(struct ifnet *ifp)
532 {
533 struct sonic_softc *sc = ifp->if_softc;
534
535 printf("%s: device timeout\n", device_xname(sc->sc_dev));
536 ifp->if_oerrors++;
537
538 (void)sonic_init(ifp);
539 }
540
541 /*
542 * sonic_ioctl: [ifnet interface function]
543 *
544 * Handle control requests from the operator.
545 */
546 int
547 sonic_ioctl(struct ifnet *ifp, u_long cmd, void *data)
548 {
549 int s, error;
550
551 s = splnet();
552
553 error = ether_ioctl(ifp, cmd, data);
554 if (error == ENETRESET) {
555 /*
556 * Multicast list has changed; set the hardware
557 * filter accordingly.
558 */
559 if (ifp->if_flags & IFF_RUNNING)
560 (void)sonic_init(ifp);
561 error = 0;
562 }
563
564 splx(s);
565 return error;
566 }
567
568 /*
569 * sonic_intr:
570 *
571 * Interrupt service routine.
572 */
573 int
574 sonic_intr(void *arg)
575 {
576 struct sonic_softc *sc = arg;
577 struct ifnet *ifp = &sc->sc_ethercom.ec_if;
578 uint16_t isr;
579 int handled = 0, wantinit;
580
581 for (wantinit = 0; wantinit == 0;) {
582 isr = CSR_READ(sc, SONIC_ISR) & sc->sc_imr;
583 if (isr == 0)
584 break;
585 CSR_WRITE(sc, SONIC_ISR, isr); /* ACK */
586
587 handled = 1;
588
589 if (isr & IMR_PRX)
590 sonic_rxintr(sc);
591
592 if (isr & (IMR_PTX|IMR_TXER)) {
593 if (sonic_txintr(sc) & TCR_FU) {
594 printf("%s: transmit FIFO underrun\n",
595 device_xname(sc->sc_dev));
596 wantinit = 1;
597 }
598 }
599
600 if (isr & (IMR_RFO|IMR_RBA|IMR_RBE|IMR_RDE)) {
601 #define PRINTERR(bit, str) \
602 if (isr & (bit)) \
603 printf("%s: %s\n",device_xname(sc->sc_dev), str)
604 PRINTERR(IMR_RFO, "receive FIFO overrun");
605 PRINTERR(IMR_RBA, "receive buffer exceeded");
606 PRINTERR(IMR_RBE, "receive buffers exhausted");
607 PRINTERR(IMR_RDE, "receive descriptors exhausted");
608 wantinit = 1;
609 }
610 }
611
612 if (handled) {
613 if (wantinit)
614 (void)sonic_init(ifp);
615 sonic_start(ifp);
616 }
617
618 return handled;
619 }
620
621 /*
622 * sonic_txintr:
623 *
624 * Helper; handle transmit complete interrupts.
625 */
626 uint16_t
627 sonic_txintr(struct sonic_softc *sc)
628 {
629 struct ifnet *ifp = &sc->sc_ethercom.ec_if;
630 struct sonic_descsoft *ds;
631 struct sonic_tda32 *tda32;
632 struct sonic_tda16 *tda16;
633 uint16_t status, totstat = 0;
634 int i;
635
636 ifp->if_flags &= ~IFF_OACTIVE;
637
638 for (i = sc->sc_txdirty; sc->sc_txpending != 0;
639 i = SONIC_NEXTTX(i), sc->sc_txpending--) {
640 ds = &sc->sc_txsoft[i];
641
642 if (sc->sc_32bit) {
643 SONIC_CDTXSYNC32(sc, i,
644 BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
645 tda32 = &sc->sc_tda32[i];
646 status = sonic32toh(sc, tda32->tda_status);
647 SONIC_CDTXSYNC32(sc, i, BUS_DMASYNC_PREREAD);
648 } else {
649 SONIC_CDTXSYNC16(sc, i,
650 BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
651 tda16 = &sc->sc_tda16[i];
652 status = sonic16toh(sc, tda16->tda_status);
653 SONIC_CDTXSYNC16(sc, i, BUS_DMASYNC_PREREAD);
654 }
655
656 if ((status & ~(TCR_EXDIS|TCR_CRCI|TCR_POWC|TCR_PINT)) == 0)
657 break;
658
659 totstat |= status;
660
661 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
662 ds->ds_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
663 bus_dmamap_unload(sc->sc_dmat, ds->ds_dmamap);
664 m_freem(ds->ds_mbuf);
665 ds->ds_mbuf = NULL;
666
667 /*
668 * Check for errors and collisions.
669 */
670 if (status & TCR_PTX)
671 ifp->if_opackets++;
672 else
673 ifp->if_oerrors++;
674 ifp->if_collisions += TDA_STATUS_NCOL(status);
675 }
676
677 /* Update the dirty transmit buffer pointer. */
678 sc->sc_txdirty = i;
679
680 /*
681 * Cancel the watchdog timer if there are no pending
682 * transmissions.
683 */
684 if (sc->sc_txpending == 0)
685 ifp->if_timer = 0;
686
687 return totstat;
688 }
689
690 /*
691 * sonic_rxintr:
692 *
693 * Helper; handle receive interrupts.
694 */
695 void
696 sonic_rxintr(struct sonic_softc *sc)
697 {
698 struct ifnet *ifp = &sc->sc_ethercom.ec_if;
699 struct sonic_descsoft *ds;
700 struct sonic_rda32 *rda32;
701 struct sonic_rda16 *rda16;
702 struct mbuf *m;
703 int i, len;
704 uint16_t status, bytecount /*, ptr0, ptr1, seqno */;
705
706 for (i = sc->sc_rxptr;; i = SONIC_NEXTRX(i)) {
707 ds = &sc->sc_rxsoft[i];
708
709 if (sc->sc_32bit) {
710 SONIC_CDRXSYNC32(sc, i,
711 BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
712 rda32 = &sc->sc_rda32[i];
713 SONIC_CDRXSYNC32(sc, i, BUS_DMASYNC_PREREAD);
714 if (rda32->rda_inuse != 0)
715 break;
716 status = sonic32toh(sc, rda32->rda_status);
717 bytecount = sonic32toh(sc, rda32->rda_bytecount);
718 /* ptr0 = sonic32toh(sc, rda32->rda_pkt_ptr0); */
719 /* ptr1 = sonic32toh(sc, rda32->rda_pkt_ptr1); */
720 /* seqno = sonic32toh(sc, rda32->rda_seqno); */
721 } else {
722 SONIC_CDRXSYNC16(sc, i,
723 BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
724 rda16 = &sc->sc_rda16[i];
725 SONIC_CDRXSYNC16(sc, i, BUS_DMASYNC_PREREAD);
726 if (rda16->rda_inuse != 0)
727 break;
728 status = sonic16toh(sc, rda16->rda_status);
729 bytecount = sonic16toh(sc, rda16->rda_bytecount);
730 /* ptr0 = sonic16toh(sc, rda16->rda_pkt_ptr0); */
731 /* ptr1 = sonic16toh(sc, rda16->rda_pkt_ptr1); */
732 /* seqno = sonic16toh(sc, rda16->rda_seqno); */
733 }
734
735 /*
736 * Make absolutely sure this is the only packet
737 * in this receive buffer. Our entire Rx buffer
738 * management scheme depends on this, and if the
739 * SONIC didn't follow our rule, it means we've
740 * misconfigured it.
741 */
742 KASSERT(status & RCR_LPKT);
743
744 /*
745 * Make sure the packet arrived OK. If an error occurred,
746 * update stats and reset the descriptor. The buffer will
747 * be reused the next time the descriptor comes up in the
748 * ring.
749 */
750 if ((status & RCR_PRX) == 0) {
751 if (status & RCR_FAER)
752 printf("%s: Rx frame alignment error\n",
753 device_xname(sc->sc_dev));
754 else if (status & RCR_CRCR)
755 printf("%s: Rx CRC error\n",
756 device_xname(sc->sc_dev));
757 ifp->if_ierrors++;
758 SONIC_INIT_RXDESC(sc, i);
759 continue;
760 }
761
762 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
763 ds->ds_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
764
765 /*
766 * The SONIC includes the CRC with every packet.
767 */
768 len = bytecount - ETHER_CRC_LEN;
769
770 /*
771 * Ok, if the chip is in 32-bit mode, then receive
772 * buffers must be aligned to 32-bit boundaries,
773 * which means the payload is misaligned. In this
774 * case, we must allocate a new mbuf, and copy the
775 * packet into it, scooted forward 2 bytes to ensure
776 * proper alignment.
777 *
778 * Note, in 16-bit mode, we can configure the SONIC
779 * to do what we want, and we have.
780 */
781 #ifndef __NO_STRICT_ALIGNMENT
782 if (sc->sc_32bit) {
783 MGETHDR(m, M_DONTWAIT, MT_DATA);
784 if (m == NULL)
785 goto dropit;
786 if (len > (MHLEN - 2)) {
787 MCLGET(m, M_DONTWAIT);
788 if ((m->m_flags & M_EXT) == 0) {
789 m_freem(m);
790 goto dropit;
791 }
792 }
793 m->m_data += 2;
794 /*
795 * Note that we use a cluster for incoming frames,
796 * so the buffer is virtually contiguous.
797 */
798 memcpy(mtod(m, void *), mtod(ds->ds_mbuf, void *),
799 len);
800 SONIC_INIT_RXDESC(sc, i);
801 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
802 ds->ds_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
803 } else
804 #endif /* ! __NO_STRICT_ALIGNMENT */
805 /*
806 * If the packet is small enough to fit in a single
807 * header mbuf, allocate one and copy the data into
808 * it. This greatly reduces memory consumption when
809 * we receive lots of small packets.
810 */
811 if (sonic_copy_small != 0 && len <= (MHLEN - 2)) {
812 MGETHDR(m, M_DONTWAIT, MT_DATA);
813 if (m == NULL)
814 goto dropit;
815 m->m_data += 2;
816 /*
817 * Note that we use a cluster for incoming frames,
818 * so the buffer is virtually contiguous.
819 */
820 memcpy(mtod(m, void *), mtod(ds->ds_mbuf, void *),
821 len);
822 SONIC_INIT_RXDESC(sc, i);
823 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
824 ds->ds_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
825 } else {
826 m = ds->ds_mbuf;
827 if (sonic_add_rxbuf(sc, i) != 0) {
828 dropit:
829 ifp->if_ierrors++;
830 SONIC_INIT_RXDESC(sc, i);
831 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
832 ds->ds_dmamap->dm_mapsize,
833 BUS_DMASYNC_PREREAD);
834 continue;
835 }
836 }
837
838 ifp->if_ipackets++;
839 m->m_pkthdr.rcvif = ifp;
840 m->m_pkthdr.len = m->m_len = len;
841
842 /*
843 * Pass this up to any BPF listeners.
844 */
845 bpf_mtap(ifp, m);
846
847 /* Pass it on. */
848 (*ifp->if_input)(ifp, m);
849 }
850
851 /* Update the receive pointer. */
852 sc->sc_rxptr = i;
853 CSR_WRITE(sc, SONIC_RWR, SONIC_CDRRADDR(sc, SONIC_PREVRX(i)));
854 }
855
856 /*
857 * sonic_reset:
858 *
859 * Perform a soft reset on the SONIC.
860 */
861 void
862 sonic_reset(struct sonic_softc *sc)
863 {
864
865 /* stop TX, RX and timer, and ensure RST is clear */
866 CSR_WRITE(sc, SONIC_CR, CR_STP | CR_RXDIS | CR_HTX);
867 delay(1000);
868
869 CSR_WRITE(sc, SONIC_CR, CR_RST);
870 delay(1000);
871
872 /* clear all interrupts */
873 CSR_WRITE(sc, SONIC_IMR, 0);
874 CSR_WRITE(sc, SONIC_ISR, IMR_ALL);
875
876 CSR_WRITE(sc, SONIC_CR, 0);
877 delay(1000);
878 }
879
880 /*
881 * sonic_init: [ifnet interface function]
882 *
883 * Initialize the interface. Must be called at splnet().
884 */
885 int
886 sonic_init(struct ifnet *ifp)
887 {
888 struct sonic_softc *sc = ifp->if_softc;
889 struct sonic_descsoft *ds;
890 int i, error = 0;
891 uint16_t reg;
892
893 /*
894 * Cancel any pending I/O.
895 */
896 sonic_stop(ifp, 0);
897
898 /*
899 * Reset the SONIC to a known state.
900 */
901 sonic_reset(sc);
902
903 /*
904 * Bring the SONIC into reset state, and program the DCR.
905 *
906 * Note: We don't bother optimizing the transmit and receive
907 * thresholds, here. TFT/RFT values should be set in MD attachments.
908 */
909 reg = sc->sc_dcr;
910 if (sc->sc_32bit)
911 reg |= DCR_DW;
912 CSR_WRITE(sc, SONIC_CR, CR_RST);
913 CSR_WRITE(sc, SONIC_DCR, reg);
914 CSR_WRITE(sc, SONIC_DCR2, sc->sc_dcr2);
915 CSR_WRITE(sc, SONIC_CR, 0);
916
917 /*
918 * Initialize the transmit descriptors.
919 */
920 if (sc->sc_32bit) {
921 for (i = 0; i < SONIC_NTXDESC; i++) {
922 memset(&sc->sc_tda32[i], 0, sizeof(struct sonic_tda32));
923 SONIC_CDTXSYNC32(sc, i,
924 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
925 }
926 } else {
927 for (i = 0; i < SONIC_NTXDESC; i++) {
928 memset(&sc->sc_tda16[i], 0, sizeof(struct sonic_tda16));
929 SONIC_CDTXSYNC16(sc, i,
930 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
931 }
932 }
933 sc->sc_txpending = 0;
934 sc->sc_txdirty = 0;
935 sc->sc_txlast = SONIC_NTXDESC - 1;
936
937 /*
938 * Initialize the receive descriptor ring.
939 */
940 for (i = 0; i < SONIC_NRXDESC; i++) {
941 ds = &sc->sc_rxsoft[i];
942 if (ds->ds_mbuf == NULL) {
943 if ((error = sonic_add_rxbuf(sc, i)) != 0) {
944 printf("%s: unable to allocate or map Rx "
945 "buffer %d, error = %d\n",
946 device_xname(sc->sc_dev), i, error);
947 /*
948 * XXX Should attempt to run with fewer receive
949 * XXX buffers instead of just failing.
950 */
951 sonic_rxdrain(sc);
952 goto out;
953 }
954 } else
955 SONIC_INIT_RXDESC(sc, i);
956 }
957 sc->sc_rxptr = 0;
958
959 /* Give the transmit ring to the SONIC. */
960 CSR_WRITE(sc, SONIC_UTDAR, (SONIC_CDTXADDR(sc, 0) >> 16) & 0xffff);
961 CSR_WRITE(sc, SONIC_CTDAR, SONIC_CDTXADDR(sc, 0) & 0xffff);
962
963 /* Give the receive descriptor ring to the SONIC. */
964 CSR_WRITE(sc, SONIC_URDAR, (SONIC_CDRXADDR(sc, 0) >> 16) & 0xffff);
965 CSR_WRITE(sc, SONIC_CRDAR, SONIC_CDRXADDR(sc, 0) & 0xffff);
966
967 /* Give the receive buffer ring to the SONIC. */
968 CSR_WRITE(sc, SONIC_URRAR, (SONIC_CDRRADDR(sc, 0) >> 16) & 0xffff);
969 CSR_WRITE(sc, SONIC_RSAR, SONIC_CDRRADDR(sc, 0) & 0xffff);
970 if (sc->sc_32bit)
971 CSR_WRITE(sc, SONIC_REAR,
972 (SONIC_CDRRADDR(sc, SONIC_NRXDESC - 1) +
973 sizeof(struct sonic_rra32)) & 0xffff);
974 else
975 CSR_WRITE(sc, SONIC_REAR,
976 (SONIC_CDRRADDR(sc, SONIC_NRXDESC - 1) +
977 sizeof(struct sonic_rra16)) & 0xffff);
978 CSR_WRITE(sc, SONIC_RRR, SONIC_CDRRADDR(sc, 0) & 0xffff);
979 CSR_WRITE(sc, SONIC_RWR, SONIC_CDRRADDR(sc, SONIC_NRXDESC - 1));
980
981 /*
982 * Set the End-Of-Buffer counter such that only one packet
983 * will be placed into each buffer we provide. Note we are
984 * following the recommendation of section 3.4.4 of the manual
985 * here, and have "lengthened" the receive buffers accordingly.
986 */
987 if (sc->sc_32bit)
988 CSR_WRITE(sc, SONIC_EOBC, (ETHER_MAX_LEN + 2) / 2);
989 else
990 CSR_WRITE(sc, SONIC_EOBC, (ETHER_MAX_LEN / 2));
991
992 /* Reset the receive sequence counter. */
993 CSR_WRITE(sc, SONIC_RSC, 0);
994
995 /* Clear the tally registers. */
996 CSR_WRITE(sc, SONIC_CRCETC, 0xffff);
997 CSR_WRITE(sc, SONIC_FAET, 0xffff);
998 CSR_WRITE(sc, SONIC_MPT, 0xffff);
999
1000 /* Set the receive filter. */
1001 sonic_set_filter(sc);
1002
1003 /*
1004 * Set the interrupt mask register.
1005 */
1006 sc->sc_imr = IMR_RFO | IMR_RBA | IMR_RBE | IMR_RDE |
1007 IMR_TXER | IMR_PTX | IMR_PRX;
1008 CSR_WRITE(sc, SONIC_IMR, sc->sc_imr);
1009
1010 /*
1011 * Start the receive process in motion. Note, we don't
1012 * start the transmit process until we actually try to
1013 * transmit packets.
1014 */
1015 CSR_WRITE(sc, SONIC_CR, CR_RXEN | CR_RRRA);
1016
1017 /*
1018 * ...all done!
1019 */
1020 ifp->if_flags |= IFF_RUNNING;
1021 ifp->if_flags &= ~IFF_OACTIVE;
1022
1023 out:
1024 if (error)
1025 printf("%s: interface not running\n", device_xname(sc->sc_dev));
1026 return error;
1027 }
1028
1029 /*
1030 * sonic_rxdrain:
1031 *
1032 * Drain the receive queue.
1033 */
1034 void
1035 sonic_rxdrain(struct sonic_softc *sc)
1036 {
1037 struct sonic_descsoft *ds;
1038 int i;
1039
1040 for (i = 0; i < SONIC_NRXDESC; i++) {
1041 ds = &sc->sc_rxsoft[i];
1042 if (ds->ds_mbuf != NULL) {
1043 bus_dmamap_unload(sc->sc_dmat, ds->ds_dmamap);
1044 m_freem(ds->ds_mbuf);
1045 ds->ds_mbuf = NULL;
1046 }
1047 }
1048 }
1049
1050 /*
1051 * sonic_stop: [ifnet interface function]
1052 *
1053 * Stop transmission on the interface.
1054 */
1055 void
1056 sonic_stop(struct ifnet *ifp, int disable)
1057 {
1058 struct sonic_softc *sc = ifp->if_softc;
1059 struct sonic_descsoft *ds;
1060 int i;
1061
1062 /*
1063 * Disable interrupts.
1064 */
1065 CSR_WRITE(sc, SONIC_IMR, 0);
1066
1067 /*
1068 * Stop the transmitter, receiver, and timer.
1069 */
1070 CSR_WRITE(sc, SONIC_CR, CR_HTX|CR_RXDIS|CR_STP);
1071 for (i = 0; i < 1000; i++) {
1072 if ((CSR_READ(sc, SONIC_CR) & (CR_TXP|CR_RXEN|CR_ST)) == 0)
1073 break;
1074 delay(2);
1075 }
1076 if ((CSR_READ(sc, SONIC_CR) & (CR_TXP|CR_RXEN|CR_ST)) != 0)
1077 printf("%s: SONIC failed to stop\n", device_xname(sc->sc_dev));
1078
1079 /*
1080 * Release any queued transmit buffers.
1081 */
1082 for (i = 0; i < SONIC_NTXDESC; i++) {
1083 ds = &sc->sc_txsoft[i];
1084 if (ds->ds_mbuf != NULL) {
1085 bus_dmamap_unload(sc->sc_dmat, ds->ds_dmamap);
1086 m_freem(ds->ds_mbuf);
1087 ds->ds_mbuf = NULL;
1088 }
1089 }
1090
1091 /*
1092 * Mark the interface down and cancel the watchdog timer.
1093 */
1094 ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
1095 ifp->if_timer = 0;
1096
1097 if (disable)
1098 sonic_rxdrain(sc);
1099 }
1100
1101 /*
1102 * sonic_add_rxbuf:
1103 *
1104 * Add a receive buffer to the indicated descriptor.
1105 */
1106 int
1107 sonic_add_rxbuf(struct sonic_softc *sc, int idx)
1108 {
1109 struct sonic_descsoft *ds = &sc->sc_rxsoft[idx];
1110 struct mbuf *m;
1111 int error;
1112
1113 MGETHDR(m, M_DONTWAIT, MT_DATA);
1114 if (m == NULL)
1115 return ENOBUFS;
1116
1117 MCLGET(m, M_DONTWAIT);
1118 if ((m->m_flags & M_EXT) == 0) {
1119 m_freem(m);
1120 return ENOBUFS;
1121 }
1122
1123 if (ds->ds_mbuf != NULL)
1124 bus_dmamap_unload(sc->sc_dmat, ds->ds_dmamap);
1125
1126 ds->ds_mbuf = m;
1127
1128 error = bus_dmamap_load(sc->sc_dmat, ds->ds_dmamap,
1129 m->m_ext.ext_buf, m->m_ext.ext_size, NULL,
1130 BUS_DMA_READ|BUS_DMA_NOWAIT);
1131 if (error) {
1132 printf("%s: can't load rx DMA map %d, error = %d\n",
1133 device_xname(sc->sc_dev), idx, error);
1134 panic("sonic_add_rxbuf"); /* XXX */
1135 }
1136
1137 bus_dmamap_sync(sc->sc_dmat, ds->ds_dmamap, 0,
1138 ds->ds_dmamap->dm_mapsize, BUS_DMASYNC_PREREAD);
1139
1140 SONIC_INIT_RXDESC(sc, idx);
1141
1142 return 0;
1143 }
1144
1145 static void
1146 sonic_set_camentry(struct sonic_softc *sc, int entry, const uint8_t *enaddr)
1147 {
1148
1149 if (sc->sc_32bit) {
1150 struct sonic_cda32 *cda = &sc->sc_cda32[entry];
1151
1152 cda->cda_entry = htosonic32(sc, entry);
1153 cda->cda_addr0 = htosonic32(sc, enaddr[0] | (enaddr[1] << 8));
1154 cda->cda_addr1 = htosonic32(sc, enaddr[2] | (enaddr[3] << 8));
1155 cda->cda_addr2 = htosonic32(sc, enaddr[4] | (enaddr[5] << 8));
1156 } else {
1157 struct sonic_cda16 *cda = &sc->sc_cda16[entry];
1158
1159 cda->cda_entry = htosonic16(sc, entry);
1160 cda->cda_addr0 = htosonic16(sc, enaddr[0] | (enaddr[1] << 8));
1161 cda->cda_addr1 = htosonic16(sc, enaddr[2] | (enaddr[3] << 8));
1162 cda->cda_addr2 = htosonic16(sc, enaddr[4] | (enaddr[5] << 8));
1163 }
1164 }
1165
1166 /*
1167 * sonic_set_filter:
1168 *
1169 * Set the SONIC receive filter.
1170 */
1171 void
1172 sonic_set_filter(struct sonic_softc *sc)
1173 {
1174 struct ethercom *ec = &sc->sc_ethercom;
1175 struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1176 struct ether_multi *enm;
1177 struct ether_multistep step;
1178 int i, entry = 0;
1179 uint16_t camvalid = 0;
1180 uint16_t rcr = 0;
1181
1182 if (ifp->if_flags & IFF_BROADCAST)
1183 rcr |= RCR_BRD;
1184
1185 if (ifp->if_flags & IFF_PROMISC) {
1186 rcr |= RCR_PRO;
1187 goto allmulti;
1188 }
1189
1190 /* Put our station address in the first CAM slot. */
1191 sonic_set_camentry(sc, entry, CLLADDR(ifp->if_sadl));
1192 camvalid |= (1U << entry);
1193 entry++;
1194
1195 /* Add the multicast addresses to the CAM. */
1196 ETHER_FIRST_MULTI(step, ec, enm);
1197 while (enm != NULL) {
1198 if (memcmp(enm->enm_addrlo, enm->enm_addrhi, ETHER_ADDR_LEN)) {
1199 /*
1200 * We must listen to a range of multicast addresses.
1201 * The only way to do this on the SONIC is to enable
1202 * reception of all multicast packets.
1203 */
1204 goto allmulti;
1205 }
1206
1207 if (entry == SONIC_NCAMENT) {
1208 /*
1209 * Out of CAM slots. Have to enable reception
1210 * of all multicast addresses.
1211 */
1212 goto allmulti;
1213 }
1214
1215 sonic_set_camentry(sc, entry, enm->enm_addrlo);
1216 camvalid |= (1U << entry);
1217 entry++;
1218
1219 ETHER_NEXT_MULTI(step, enm);
1220 }
1221
1222 ifp->if_flags &= ~IFF_ALLMULTI;
1223 goto setit;
1224
1225 allmulti:
1226 /* Use only the first CAM slot (station address). */
1227 camvalid = 0x0001;
1228 entry = 1;
1229 rcr |= RCR_AMC;
1230
1231 setit:
1232 /* set mask for the CAM Enable register */
1233 if (sc->sc_32bit) {
1234 if (entry == SONIC_NCAMENT)
1235 sc->sc_cdaenable32 = htosonic32(sc, camvalid);
1236 else
1237 sc->sc_cda32[entry].cda_entry =
1238 htosonic32(sc, camvalid);
1239 } else {
1240 if (entry == SONIC_NCAMENT)
1241 sc->sc_cdaenable16 = htosonic16(sc, camvalid);
1242 else
1243 sc->sc_cda16[entry].cda_entry =
1244 htosonic16(sc, camvalid);
1245 }
1246
1247 /* Load the CAM. */
1248 SONIC_CDCAMSYNC(sc, BUS_DMASYNC_PREWRITE);
1249 CSR_WRITE(sc, SONIC_CDP, SONIC_CDCAMADDR(sc) & 0xffff);
1250 CSR_WRITE(sc, SONIC_CDC, entry);
1251 CSR_WRITE(sc, SONIC_CR, CR_LCAM);
1252 for (i = 0; i < 10000; i++) {
1253 if ((CSR_READ(sc, SONIC_CR) & CR_LCAM) == 0)
1254 break;
1255 delay(2);
1256 }
1257 if (CSR_READ(sc, SONIC_CR) & CR_LCAM)
1258 printf("%s: CAM load failed\n", device_xname(sc->sc_dev));
1259 SONIC_CDCAMSYNC(sc, BUS_DMASYNC_POSTWRITE);
1260
1261 /* Set the receive control register. */
1262 CSR_WRITE(sc, SONIC_RCR, rcr);
1263 }
1264