FreeBSD/Linux Kernel Cross Reference
sys/dev/vr/if_vr.c
1 /*-
2 * SPDX-License-Identifier: BSD-4-Clause
3 *
4 * Copyright (c) 1997, 1998
5 * Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Bill Paul.
18 * 4. Neither the name of the author nor the names of any co-contributors
19 * may be used to endorse or promote products derived from this software
20 * without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
26 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32 * THE POSSIBILITY OF SUCH DAMAGE.
33 */
34
35 #include <sys/cdefs.h>
36 __FBSDID("$FreeBSD: releng/12.0/sys/dev/vr/if_vr.c 333813 2018-05-18 20:13:34Z mmacy $");
37
38 /*
39 * VIA Rhine fast ethernet PCI NIC driver
40 *
41 * Supports various network adapters based on the VIA Rhine
42 * and Rhine II PCI controllers, including the D-Link DFE530TX.
43 * Datasheets are available at http://www.via.com.tw.
44 *
45 * Written by Bill Paul <wpaul@ctr.columbia.edu>
46 * Electrical Engineering Department
47 * Columbia University, New York City
48 */
49
50 /*
51 * The VIA Rhine controllers are similar in some respects to the
52 * the DEC tulip chips, except less complicated. The controller
53 * uses an MII bus and an external physical layer interface. The
54 * receiver has a one entry perfect filter and a 64-bit hash table
55 * multicast filter. Transmit and receive descriptors are similar
56 * to the tulip.
57 *
58 * Some Rhine chips has a serious flaw in its transmit DMA mechanism:
59 * transmit buffers must be longword aligned. Unfortunately,
60 * FreeBSD doesn't guarantee that mbufs will be filled in starting
61 * at longword boundaries, so we have to do a buffer copy before
62 * transmission.
63 */
64
65 #ifdef HAVE_KERNEL_OPTION_HEADERS
66 #include "opt_device_polling.h"
67 #endif
68
69 #include <sys/param.h>
70 #include <sys/systm.h>
71 #include <sys/bus.h>
72 #include <sys/endian.h>
73 #include <sys/kernel.h>
74 #include <sys/malloc.h>
75 #include <sys/mbuf.h>
76 #include <sys/module.h>
77 #include <sys/rman.h>
78 #include <sys/socket.h>
79 #include <sys/sockio.h>
80 #include <sys/sysctl.h>
81 #include <sys/taskqueue.h>
82
83 #include <net/bpf.h>
84 #include <net/if.h>
85 #include <net/if_var.h>
86 #include <net/ethernet.h>
87 #include <net/if_dl.h>
88 #include <net/if_media.h>
89 #include <net/if_types.h>
90 #include <net/if_vlan_var.h>
91
92 #include <dev/mii/mii.h>
93 #include <dev/mii/miivar.h>
94
95 #include <dev/pci/pcireg.h>
96 #include <dev/pci/pcivar.h>
97
98 #include <machine/bus.h>
99
100 #include <dev/vr/if_vrreg.h>
101
102 /* "device miibus" required. See GENERIC if you get errors here. */
103 #include "miibus_if.h"
104
105 MODULE_DEPEND(vr, pci, 1, 1, 1);
106 MODULE_DEPEND(vr, ether, 1, 1, 1);
107 MODULE_DEPEND(vr, miibus, 1, 1, 1);
108
109 /* Define to show Rx/Tx error status. */
110 #undef VR_SHOW_ERRORS
111 #define VR_CSUM_FEATURES (CSUM_IP | CSUM_TCP | CSUM_UDP)
112
113 /*
114 * Various supported device vendors/types, their names & quirks.
115 */
116 #define VR_Q_NEEDALIGN (1<<0)
117 #define VR_Q_CSUM (1<<1)
118 #define VR_Q_CAM (1<<2)
119
120 static const struct vr_type {
121 u_int16_t vr_vid;
122 u_int16_t vr_did;
123 int vr_quirks;
124 const char *vr_name;
125 } vr_devs[] = {
126 { VIA_VENDORID, VIA_DEVICEID_RHINE,
127 VR_Q_NEEDALIGN,
128 "VIA VT3043 Rhine I 10/100BaseTX" },
129 { VIA_VENDORID, VIA_DEVICEID_RHINE_II,
130 VR_Q_NEEDALIGN,
131 "VIA VT86C100A Rhine II 10/100BaseTX" },
132 { VIA_VENDORID, VIA_DEVICEID_RHINE_II_2,
133 0,
134 "VIA VT6102 Rhine II 10/100BaseTX" },
135 { VIA_VENDORID, VIA_DEVICEID_RHINE_III,
136 0,
137 "VIA VT6105 Rhine III 10/100BaseTX" },
138 { VIA_VENDORID, VIA_DEVICEID_RHINE_III_M,
139 VR_Q_CSUM,
140 "VIA VT6105M Rhine III 10/100BaseTX" },
141 { DELTA_VENDORID, DELTA_DEVICEID_RHINE_II,
142 VR_Q_NEEDALIGN,
143 "Delta Electronics Rhine II 10/100BaseTX" },
144 { ADDTRON_VENDORID, ADDTRON_DEVICEID_RHINE_II,
145 VR_Q_NEEDALIGN,
146 "Addtron Technology Rhine II 10/100BaseTX" },
147 { 0, 0, 0, NULL }
148 };
149
150 static int vr_probe(device_t);
151 static int vr_attach(device_t);
152 static int vr_detach(device_t);
153 static int vr_shutdown(device_t);
154 static int vr_suspend(device_t);
155 static int vr_resume(device_t);
156
157 static void vr_dmamap_cb(void *, bus_dma_segment_t *, int, int);
158 static int vr_dma_alloc(struct vr_softc *);
159 static void vr_dma_free(struct vr_softc *);
160 static __inline void vr_discard_rxbuf(struct vr_rxdesc *);
161 static int vr_newbuf(struct vr_softc *, int);
162
163 #ifndef __NO_STRICT_ALIGNMENT
164 static __inline void vr_fixup_rx(struct mbuf *);
165 #endif
166 static int vr_rxeof(struct vr_softc *);
167 static void vr_txeof(struct vr_softc *);
168 static void vr_tick(void *);
169 static int vr_error(struct vr_softc *, uint16_t);
170 static void vr_tx_underrun(struct vr_softc *);
171 static int vr_intr(void *);
172 static void vr_int_task(void *, int);
173 static void vr_start(struct ifnet *);
174 static void vr_start_locked(struct ifnet *);
175 static int vr_encap(struct vr_softc *, struct mbuf **);
176 static int vr_ioctl(struct ifnet *, u_long, caddr_t);
177 static void vr_init(void *);
178 static void vr_init_locked(struct vr_softc *);
179 static void vr_tx_start(struct vr_softc *);
180 static void vr_rx_start(struct vr_softc *);
181 static int vr_tx_stop(struct vr_softc *);
182 static int vr_rx_stop(struct vr_softc *);
183 static void vr_stop(struct vr_softc *);
184 static void vr_watchdog(struct vr_softc *);
185 static int vr_ifmedia_upd(struct ifnet *);
186 static void vr_ifmedia_sts(struct ifnet *, struct ifmediareq *);
187
188 static int vr_miibus_readreg(device_t, int, int);
189 static int vr_miibus_writereg(device_t, int, int, int);
190 static void vr_miibus_statchg(device_t);
191
192 static void vr_cam_mask(struct vr_softc *, uint32_t, int);
193 static int vr_cam_data(struct vr_softc *, int, int, uint8_t *);
194 static void vr_set_filter(struct vr_softc *);
195 static void vr_reset(const struct vr_softc *);
196 static int vr_tx_ring_init(struct vr_softc *);
197 static int vr_rx_ring_init(struct vr_softc *);
198 static void vr_setwol(struct vr_softc *);
199 static void vr_clrwol(struct vr_softc *);
200 static int vr_sysctl_stats(SYSCTL_HANDLER_ARGS);
201
202 static const struct vr_tx_threshold_table {
203 int tx_cfg;
204 int bcr_cfg;
205 int value;
206 } vr_tx_threshold_tables[] = {
207 { VR_TXTHRESH_64BYTES, VR_BCR1_TXTHRESH64BYTES, 64 },
208 { VR_TXTHRESH_128BYTES, VR_BCR1_TXTHRESH128BYTES, 128 },
209 { VR_TXTHRESH_256BYTES, VR_BCR1_TXTHRESH256BYTES, 256 },
210 { VR_TXTHRESH_512BYTES, VR_BCR1_TXTHRESH512BYTES, 512 },
211 { VR_TXTHRESH_1024BYTES, VR_BCR1_TXTHRESH1024BYTES, 1024 },
212 { VR_TXTHRESH_STORENFWD, VR_BCR1_TXTHRESHSTORENFWD, 2048 }
213 };
214
215 static device_method_t vr_methods[] = {
216 /* Device interface */
217 DEVMETHOD(device_probe, vr_probe),
218 DEVMETHOD(device_attach, vr_attach),
219 DEVMETHOD(device_detach, vr_detach),
220 DEVMETHOD(device_shutdown, vr_shutdown),
221 DEVMETHOD(device_suspend, vr_suspend),
222 DEVMETHOD(device_resume, vr_resume),
223
224 /* MII interface */
225 DEVMETHOD(miibus_readreg, vr_miibus_readreg),
226 DEVMETHOD(miibus_writereg, vr_miibus_writereg),
227 DEVMETHOD(miibus_statchg, vr_miibus_statchg),
228
229 DEVMETHOD_END
230 };
231
232 static driver_t vr_driver = {
233 "vr",
234 vr_methods,
235 sizeof(struct vr_softc)
236 };
237
238 static devclass_t vr_devclass;
239
240 DRIVER_MODULE(vr, pci, vr_driver, vr_devclass, 0, 0);
241 DRIVER_MODULE(miibus, vr, miibus_driver, miibus_devclass, 0, 0);
242
243 static int
244 vr_miibus_readreg(device_t dev, int phy, int reg)
245 {
246 struct vr_softc *sc;
247 int i;
248
249 sc = device_get_softc(dev);
250
251 /* Set the register address. */
252 CSR_WRITE_1(sc, VR_MIIADDR, reg);
253 VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_READ_ENB);
254
255 for (i = 0; i < VR_MII_TIMEOUT; i++) {
256 DELAY(1);
257 if ((CSR_READ_1(sc, VR_MIICMD) & VR_MIICMD_READ_ENB) == 0)
258 break;
259 }
260 if (i == VR_MII_TIMEOUT)
261 device_printf(sc->vr_dev, "phy read timeout %d:%d\n", phy, reg);
262
263 return (CSR_READ_2(sc, VR_MIIDATA));
264 }
265
266 static int
267 vr_miibus_writereg(device_t dev, int phy, int reg, int data)
268 {
269 struct vr_softc *sc;
270 int i;
271
272 sc = device_get_softc(dev);
273
274 /* Set the register address and data to write. */
275 CSR_WRITE_1(sc, VR_MIIADDR, reg);
276 CSR_WRITE_2(sc, VR_MIIDATA, data);
277 VR_SETBIT(sc, VR_MIICMD, VR_MIICMD_WRITE_ENB);
278
279 for (i = 0; i < VR_MII_TIMEOUT; i++) {
280 DELAY(1);
281 if ((CSR_READ_1(sc, VR_MIICMD) & VR_MIICMD_WRITE_ENB) == 0)
282 break;
283 }
284 if (i == VR_MII_TIMEOUT)
285 device_printf(sc->vr_dev, "phy write timeout %d:%d\n", phy,
286 reg);
287
288 return (0);
289 }
290
291 /*
292 * In order to fiddle with the
293 * 'full-duplex' and '100Mbps' bits in the netconfig register, we
294 * first have to put the transmit and/or receive logic in the idle state.
295 */
296 static void
297 vr_miibus_statchg(device_t dev)
298 {
299 struct vr_softc *sc;
300 struct mii_data *mii;
301 struct ifnet *ifp;
302 int lfdx, mfdx;
303 uint8_t cr0, cr1, fc;
304
305 sc = device_get_softc(dev);
306 mii = device_get_softc(sc->vr_miibus);
307 ifp = sc->vr_ifp;
308 if (mii == NULL || ifp == NULL ||
309 (ifp->if_drv_flags & IFF_DRV_RUNNING) == 0)
310 return;
311
312 sc->vr_flags &= ~(VR_F_LINK | VR_F_TXPAUSE);
313 if ((mii->mii_media_status & (IFM_ACTIVE | IFM_AVALID)) ==
314 (IFM_ACTIVE | IFM_AVALID)) {
315 switch (IFM_SUBTYPE(mii->mii_media_active)) {
316 case IFM_10_T:
317 case IFM_100_TX:
318 sc->vr_flags |= VR_F_LINK;
319 break;
320 default:
321 break;
322 }
323 }
324
325 if ((sc->vr_flags & VR_F_LINK) != 0) {
326 cr0 = CSR_READ_1(sc, VR_CR0);
327 cr1 = CSR_READ_1(sc, VR_CR1);
328 mfdx = (cr1 & VR_CR1_FULLDUPLEX) != 0;
329 lfdx = (IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) != 0;
330 if (mfdx != lfdx) {
331 if ((cr0 & (VR_CR0_TX_ON | VR_CR0_RX_ON)) != 0) {
332 if (vr_tx_stop(sc) != 0 ||
333 vr_rx_stop(sc) != 0) {
334 device_printf(sc->vr_dev,
335 "%s: Tx/Rx shutdown error -- "
336 "resetting\n", __func__);
337 sc->vr_flags |= VR_F_RESTART;
338 VR_UNLOCK(sc);
339 return;
340 }
341 }
342 if (lfdx)
343 cr1 |= VR_CR1_FULLDUPLEX;
344 else
345 cr1 &= ~VR_CR1_FULLDUPLEX;
346 CSR_WRITE_1(sc, VR_CR1, cr1);
347 }
348 fc = 0;
349 /* Configure flow-control. */
350 if (sc->vr_revid >= REV_ID_VT6105_A0) {
351 fc = CSR_READ_1(sc, VR_FLOWCR1);
352 fc &= ~(VR_FLOWCR1_TXPAUSE | VR_FLOWCR1_RXPAUSE);
353 if ((IFM_OPTIONS(mii->mii_media_active) &
354 IFM_ETH_RXPAUSE) != 0)
355 fc |= VR_FLOWCR1_RXPAUSE;
356 if ((IFM_OPTIONS(mii->mii_media_active) &
357 IFM_ETH_TXPAUSE) != 0) {
358 fc |= VR_FLOWCR1_TXPAUSE;
359 sc->vr_flags |= VR_F_TXPAUSE;
360 }
361 CSR_WRITE_1(sc, VR_FLOWCR1, fc);
362 } else if (sc->vr_revid >= REV_ID_VT6102_A) {
363 /* No Tx puase capability available for Rhine II. */
364 fc = CSR_READ_1(sc, VR_MISC_CR0);
365 fc &= ~VR_MISCCR0_RXPAUSE;
366 if ((IFM_OPTIONS(mii->mii_media_active) &
367 IFM_ETH_RXPAUSE) != 0)
368 fc |= VR_MISCCR0_RXPAUSE;
369 CSR_WRITE_1(sc, VR_MISC_CR0, fc);
370 }
371 vr_rx_start(sc);
372 vr_tx_start(sc);
373 } else {
374 if (vr_tx_stop(sc) != 0 || vr_rx_stop(sc) != 0) {
375 device_printf(sc->vr_dev,
376 "%s: Tx/Rx shutdown error -- resetting\n",
377 __func__);
378 sc->vr_flags |= VR_F_RESTART;
379 }
380 }
381 }
382
383
384 static void
385 vr_cam_mask(struct vr_softc *sc, uint32_t mask, int type)
386 {
387
388 if (type == VR_MCAST_CAM)
389 CSR_WRITE_1(sc, VR_CAMCTL, VR_CAMCTL_ENA | VR_CAMCTL_MCAST);
390 else
391 CSR_WRITE_1(sc, VR_CAMCTL, VR_CAMCTL_ENA | VR_CAMCTL_VLAN);
392 CSR_WRITE_4(sc, VR_CAMMASK, mask);
393 CSR_WRITE_1(sc, VR_CAMCTL, 0);
394 }
395
396 static int
397 vr_cam_data(struct vr_softc *sc, int type, int idx, uint8_t *mac)
398 {
399 int i;
400
401 if (type == VR_MCAST_CAM) {
402 if (idx < 0 || idx >= VR_CAM_MCAST_CNT || mac == NULL)
403 return (EINVAL);
404 CSR_WRITE_1(sc, VR_CAMCTL, VR_CAMCTL_ENA | VR_CAMCTL_MCAST);
405 } else
406 CSR_WRITE_1(sc, VR_CAMCTL, VR_CAMCTL_ENA | VR_CAMCTL_VLAN);
407
408 /* Set CAM entry address. */
409 CSR_WRITE_1(sc, VR_CAMADDR, idx);
410 /* Set CAM entry data. */
411 if (type == VR_MCAST_CAM) {
412 for (i = 0; i < ETHER_ADDR_LEN; i++)
413 CSR_WRITE_1(sc, VR_MCAM0 + i, mac[i]);
414 } else {
415 CSR_WRITE_1(sc, VR_VCAM0, mac[0]);
416 CSR_WRITE_1(sc, VR_VCAM1, mac[1]);
417 }
418 DELAY(10);
419 /* Write CAM and wait for self-clear of VR_CAMCTL_WRITE bit. */
420 CSR_WRITE_1(sc, VR_CAMCTL, VR_CAMCTL_ENA | VR_CAMCTL_WRITE);
421 for (i = 0; i < VR_TIMEOUT; i++) {
422 DELAY(1);
423 if ((CSR_READ_1(sc, VR_CAMCTL) & VR_CAMCTL_WRITE) == 0)
424 break;
425 }
426
427 if (i == VR_TIMEOUT)
428 device_printf(sc->vr_dev, "%s: setting CAM filter timeout!\n",
429 __func__);
430 CSR_WRITE_1(sc, VR_CAMCTL, 0);
431
432 return (i == VR_TIMEOUT ? ETIMEDOUT : 0);
433 }
434
435 /*
436 * Program the 64-bit multicast hash filter.
437 */
438 static void
439 vr_set_filter(struct vr_softc *sc)
440 {
441 struct ifnet *ifp;
442 int h;
443 uint32_t hashes[2] = { 0, 0 };
444 struct ifmultiaddr *ifma;
445 uint8_t rxfilt;
446 int error, mcnt;
447 uint32_t cam_mask;
448
449 VR_LOCK_ASSERT(sc);
450
451 ifp = sc->vr_ifp;
452 rxfilt = CSR_READ_1(sc, VR_RXCFG);
453 rxfilt &= ~(VR_RXCFG_RX_PROMISC | VR_RXCFG_RX_BROAD |
454 VR_RXCFG_RX_MULTI);
455 if (ifp->if_flags & IFF_BROADCAST)
456 rxfilt |= VR_RXCFG_RX_BROAD;
457 if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
458 rxfilt |= VR_RXCFG_RX_MULTI;
459 if (ifp->if_flags & IFF_PROMISC)
460 rxfilt |= VR_RXCFG_RX_PROMISC;
461 CSR_WRITE_1(sc, VR_RXCFG, rxfilt);
462 CSR_WRITE_4(sc, VR_MAR0, 0xFFFFFFFF);
463 CSR_WRITE_4(sc, VR_MAR1, 0xFFFFFFFF);
464 return;
465 }
466
467 /* Now program new ones. */
468 error = 0;
469 mcnt = 0;
470 if_maddr_rlock(ifp);
471 if ((sc->vr_quirks & VR_Q_CAM) != 0) {
472 /*
473 * For hardwares that have CAM capability, use
474 * 32 entries multicast perfect filter.
475 */
476 cam_mask = 0;
477 CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
478 if (ifma->ifma_addr->sa_family != AF_LINK)
479 continue;
480 error = vr_cam_data(sc, VR_MCAST_CAM, mcnt,
481 LLADDR((struct sockaddr_dl *)ifma->ifma_addr));
482 if (error != 0) {
483 cam_mask = 0;
484 break;
485 }
486 cam_mask |= 1 << mcnt;
487 mcnt++;
488 }
489 vr_cam_mask(sc, VR_MCAST_CAM, cam_mask);
490 }
491
492 if ((sc->vr_quirks & VR_Q_CAM) == 0 || error != 0) {
493 /*
494 * If there are too many multicast addresses or
495 * setting multicast CAM filter failed, use hash
496 * table based filtering.
497 */
498 mcnt = 0;
499 CK_STAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
500 if (ifma->ifma_addr->sa_family != AF_LINK)
501 continue;
502 h = ether_crc32_be(LLADDR((struct sockaddr_dl *)
503 ifma->ifma_addr), ETHER_ADDR_LEN) >> 26;
504 if (h < 32)
505 hashes[0] |= (1 << h);
506 else
507 hashes[1] |= (1 << (h - 32));
508 mcnt++;
509 }
510 }
511 if_maddr_runlock(ifp);
512
513 if (mcnt > 0)
514 rxfilt |= VR_RXCFG_RX_MULTI;
515
516 CSR_WRITE_4(sc, VR_MAR0, hashes[0]);
517 CSR_WRITE_4(sc, VR_MAR1, hashes[1]);
518 CSR_WRITE_1(sc, VR_RXCFG, rxfilt);
519 }
520
521 static void
522 vr_reset(const struct vr_softc *sc)
523 {
524 int i;
525
526 /*VR_LOCK_ASSERT(sc);*/ /* XXX: Called during attach w/o lock. */
527
528 CSR_WRITE_1(sc, VR_CR1, VR_CR1_RESET);
529 if (sc->vr_revid < REV_ID_VT6102_A) {
530 /* VT86C100A needs more delay after reset. */
531 DELAY(100);
532 }
533 for (i = 0; i < VR_TIMEOUT; i++) {
534 DELAY(10);
535 if (!(CSR_READ_1(sc, VR_CR1) & VR_CR1_RESET))
536 break;
537 }
538 if (i == VR_TIMEOUT) {
539 if (sc->vr_revid < REV_ID_VT6102_A)
540 device_printf(sc->vr_dev, "reset never completed!\n");
541 else {
542 /* Use newer force reset command. */
543 device_printf(sc->vr_dev,
544 "Using force reset command.\n");
545 VR_SETBIT(sc, VR_MISC_CR1, VR_MISCCR1_FORSRST);
546 /*
547 * Wait a little while for the chip to get its brains
548 * in order.
549 */
550 DELAY(2000);
551 }
552 }
553
554 }
555
556 /*
557 * Probe for a VIA Rhine chip. Check the PCI vendor and device
558 * IDs against our list and return a match or NULL
559 */
560 static const struct vr_type *
561 vr_match(device_t dev)
562 {
563 const struct vr_type *t = vr_devs;
564
565 for (t = vr_devs; t->vr_name != NULL; t++)
566 if ((pci_get_vendor(dev) == t->vr_vid) &&
567 (pci_get_device(dev) == t->vr_did))
568 return (t);
569 return (NULL);
570 }
571
572 /*
573 * Probe for a VIA Rhine chip. Check the PCI vendor and device
574 * IDs against our list and return a device name if we find a match.
575 */
576 static int
577 vr_probe(device_t dev)
578 {
579 const struct vr_type *t;
580
581 t = vr_match(dev);
582 if (t != NULL) {
583 device_set_desc(dev, t->vr_name);
584 return (BUS_PROBE_DEFAULT);
585 }
586 return (ENXIO);
587 }
588
589 /*
590 * Attach the interface. Allocate softc structures, do ifmedia
591 * setup and ethernet/BPF attach.
592 */
593 static int
594 vr_attach(device_t dev)
595 {
596 struct vr_softc *sc;
597 struct ifnet *ifp;
598 const struct vr_type *t;
599 uint8_t eaddr[ETHER_ADDR_LEN];
600 int error, rid;
601 int i, phy, pmc;
602
603 sc = device_get_softc(dev);
604 sc->vr_dev = dev;
605 t = vr_match(dev);
606 KASSERT(t != NULL, ("Lost if_vr device match"));
607 sc->vr_quirks = t->vr_quirks;
608 device_printf(dev, "Quirks: 0x%x\n", sc->vr_quirks);
609
610 mtx_init(&sc->vr_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
611 MTX_DEF);
612 callout_init_mtx(&sc->vr_stat_callout, &sc->vr_mtx, 0);
613 SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
614 SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
615 OID_AUTO, "stats", CTLTYPE_INT | CTLFLAG_RW, sc, 0,
616 vr_sysctl_stats, "I", "Statistics");
617
618 error = 0;
619
620 /*
621 * Map control/status registers.
622 */
623 pci_enable_busmaster(dev);
624 sc->vr_revid = pci_get_revid(dev);
625 device_printf(dev, "Revision: 0x%x\n", sc->vr_revid);
626
627 sc->vr_res_id = PCIR_BAR(0);
628 sc->vr_res_type = SYS_RES_IOPORT;
629 sc->vr_res = bus_alloc_resource_any(dev, sc->vr_res_type,
630 &sc->vr_res_id, RF_ACTIVE);
631 if (sc->vr_res == NULL) {
632 device_printf(dev, "couldn't map ports\n");
633 error = ENXIO;
634 goto fail;
635 }
636
637 /* Allocate interrupt. */
638 rid = 0;
639 sc->vr_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
640 RF_SHAREABLE | RF_ACTIVE);
641
642 if (sc->vr_irq == NULL) {
643 device_printf(dev, "couldn't map interrupt\n");
644 error = ENXIO;
645 goto fail;
646 }
647
648 /* Allocate ifnet structure. */
649 ifp = sc->vr_ifp = if_alloc(IFT_ETHER);
650 if (ifp == NULL) {
651 device_printf(dev, "couldn't allocate ifnet structure\n");
652 error = ENOSPC;
653 goto fail;
654 }
655 ifp->if_softc = sc;
656 if_initname(ifp, device_get_name(dev), device_get_unit(dev));
657 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
658 ifp->if_ioctl = vr_ioctl;
659 ifp->if_start = vr_start;
660 ifp->if_init = vr_init;
661 IFQ_SET_MAXLEN(&ifp->if_snd, VR_TX_RING_CNT - 1);
662 ifp->if_snd.ifq_maxlen = VR_TX_RING_CNT - 1;
663 IFQ_SET_READY(&ifp->if_snd);
664
665 TASK_INIT(&sc->vr_inttask, 0, vr_int_task, sc);
666
667 /* Configure Tx FIFO threshold. */
668 sc->vr_txthresh = VR_TXTHRESH_MIN;
669 if (sc->vr_revid < REV_ID_VT6105_A0) {
670 /*
671 * Use store and forward mode for Rhine I/II.
672 * Otherwise they produce a lot of Tx underruns and
673 * it would take a while to get working FIFO threshold
674 * value.
675 */
676 sc->vr_txthresh = VR_TXTHRESH_MAX;
677 }
678 if ((sc->vr_quirks & VR_Q_CSUM) != 0) {
679 ifp->if_hwassist = VR_CSUM_FEATURES;
680 ifp->if_capabilities |= IFCAP_HWCSUM;
681 /*
682 * To update checksum field the hardware may need to
683 * store entire frames into FIFO before transmitting.
684 */
685 sc->vr_txthresh = VR_TXTHRESH_MAX;
686 }
687
688 if (sc->vr_revid >= REV_ID_VT6102_A &&
689 pci_find_cap(dev, PCIY_PMG, &pmc) == 0)
690 ifp->if_capabilities |= IFCAP_WOL_UCAST | IFCAP_WOL_MAGIC;
691
692 /* Rhine supports oversized VLAN frame. */
693 ifp->if_capabilities |= IFCAP_VLAN_MTU;
694 ifp->if_capenable = ifp->if_capabilities;
695 #ifdef DEVICE_POLLING
696 ifp->if_capabilities |= IFCAP_POLLING;
697 #endif
698
699 /*
700 * Windows may put the chip in suspend mode when it
701 * shuts down. Be sure to kick it in the head to wake it
702 * up again.
703 */
704 if (pci_find_cap(dev, PCIY_PMG, &pmc) == 0)
705 VR_CLRBIT(sc, VR_STICKHW, (VR_STICKHW_DS0|VR_STICKHW_DS1));
706
707 /*
708 * Get station address. The way the Rhine chips work,
709 * you're not allowed to directly access the EEPROM once
710 * they've been programmed a special way. Consequently,
711 * we need to read the node address from the PAR0 and PAR1
712 * registers.
713 * Reloading EEPROM also overwrites VR_CFGA, VR_CFGB,
714 * VR_CFGC and VR_CFGD such that memory mapped IO configured
715 * by driver is reset to default state.
716 */
717 VR_SETBIT(sc, VR_EECSR, VR_EECSR_LOAD);
718 for (i = VR_TIMEOUT; i > 0; i--) {
719 DELAY(1);
720 if ((CSR_READ_1(sc, VR_EECSR) & VR_EECSR_LOAD) == 0)
721 break;
722 }
723 if (i == 0)
724 device_printf(dev, "Reloading EEPROM timeout!\n");
725 for (i = 0; i < ETHER_ADDR_LEN; i++)
726 eaddr[i] = CSR_READ_1(sc, VR_PAR0 + i);
727
728 /* Reset the adapter. */
729 vr_reset(sc);
730 /* Ack intr & disable further interrupts. */
731 CSR_WRITE_2(sc, VR_ISR, 0xFFFF);
732 CSR_WRITE_2(sc, VR_IMR, 0);
733 if (sc->vr_revid >= REV_ID_VT6102_A)
734 CSR_WRITE_2(sc, VR_MII_IMR, 0);
735
736 if (sc->vr_revid < REV_ID_VT6102_A) {
737 pci_write_config(dev, VR_PCI_MODE2,
738 pci_read_config(dev, VR_PCI_MODE2, 1) |
739 VR_MODE2_MODE10T, 1);
740 } else {
741 /* Report error instead of retrying forever. */
742 pci_write_config(dev, VR_PCI_MODE2,
743 pci_read_config(dev, VR_PCI_MODE2, 1) |
744 VR_MODE2_PCEROPT, 1);
745 /* Detect MII coding error. */
746 pci_write_config(dev, VR_PCI_MODE3,
747 pci_read_config(dev, VR_PCI_MODE3, 1) |
748 VR_MODE3_MIION, 1);
749 if (sc->vr_revid >= REV_ID_VT6105_LOM &&
750 sc->vr_revid < REV_ID_VT6105M_A0)
751 pci_write_config(dev, VR_PCI_MODE2,
752 pci_read_config(dev, VR_PCI_MODE2, 1) |
753 VR_MODE2_MODE10T, 1);
754 /* Enable Memory-Read-Multiple. */
755 if (sc->vr_revid >= REV_ID_VT6107_A1 &&
756 sc->vr_revid < REV_ID_VT6105M_A0)
757 pci_write_config(dev, VR_PCI_MODE2,
758 pci_read_config(dev, VR_PCI_MODE2, 1) |
759 VR_MODE2_MRDPL, 1);
760 }
761 /* Disable MII AUTOPOLL. */
762 VR_CLRBIT(sc, VR_MIICMD, VR_MIICMD_AUTOPOLL);
763
764 if (vr_dma_alloc(sc) != 0) {
765 error = ENXIO;
766 goto fail;
767 }
768
769 /* Do MII setup. */
770 if (sc->vr_revid >= REV_ID_VT6105_A0)
771 phy = 1;
772 else
773 phy = CSR_READ_1(sc, VR_PHYADDR) & VR_PHYADDR_MASK;
774 error = mii_attach(dev, &sc->vr_miibus, ifp, vr_ifmedia_upd,
775 vr_ifmedia_sts, BMSR_DEFCAPMASK, phy, MII_OFFSET_ANY,
776 sc->vr_revid >= REV_ID_VT6102_A ? MIIF_DOPAUSE : 0);
777 if (error != 0) {
778 device_printf(dev, "attaching PHYs failed\n");
779 goto fail;
780 }
781
782 /* Call MI attach routine. */
783 ether_ifattach(ifp, eaddr);
784 /*
785 * Tell the upper layer(s) we support long frames.
786 * Must appear after the call to ether_ifattach() because
787 * ether_ifattach() sets ifi_hdrlen to the default value.
788 */
789 ifp->if_hdrlen = sizeof(struct ether_vlan_header);
790
791 /* Hook interrupt last to avoid having to lock softc. */
792 error = bus_setup_intr(dev, sc->vr_irq, INTR_TYPE_NET | INTR_MPSAFE,
793 vr_intr, NULL, sc, &sc->vr_intrhand);
794
795 if (error) {
796 device_printf(dev, "couldn't set up irq\n");
797 ether_ifdetach(ifp);
798 goto fail;
799 }
800
801 fail:
802 if (error)
803 vr_detach(dev);
804
805 return (error);
806 }
807
808 /*
809 * Shutdown hardware and free up resources. This can be called any
810 * time after the mutex has been initialized. It is called in both
811 * the error case in attach and the normal detach case so it needs
812 * to be careful about only freeing resources that have actually been
813 * allocated.
814 */
815 static int
816 vr_detach(device_t dev)
817 {
818 struct vr_softc *sc = device_get_softc(dev);
819 struct ifnet *ifp = sc->vr_ifp;
820
821 KASSERT(mtx_initialized(&sc->vr_mtx), ("vr mutex not initialized"));
822
823 #ifdef DEVICE_POLLING
824 if (ifp != NULL && ifp->if_capenable & IFCAP_POLLING)
825 ether_poll_deregister(ifp);
826 #endif
827
828 /* These should only be active if attach succeeded. */
829 if (device_is_attached(dev)) {
830 VR_LOCK(sc);
831 sc->vr_flags |= VR_F_DETACHED;
832 vr_stop(sc);
833 VR_UNLOCK(sc);
834 callout_drain(&sc->vr_stat_callout);
835 taskqueue_drain(taskqueue_fast, &sc->vr_inttask);
836 ether_ifdetach(ifp);
837 }
838 if (sc->vr_miibus)
839 device_delete_child(dev, sc->vr_miibus);
840 bus_generic_detach(dev);
841
842 if (sc->vr_intrhand)
843 bus_teardown_intr(dev, sc->vr_irq, sc->vr_intrhand);
844 if (sc->vr_irq)
845 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->vr_irq);
846 if (sc->vr_res)
847 bus_release_resource(dev, sc->vr_res_type, sc->vr_res_id,
848 sc->vr_res);
849
850 if (ifp)
851 if_free(ifp);
852
853 vr_dma_free(sc);
854
855 mtx_destroy(&sc->vr_mtx);
856
857 return (0);
858 }
859
860 struct vr_dmamap_arg {
861 bus_addr_t vr_busaddr;
862 };
863
864 static void
865 vr_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
866 {
867 struct vr_dmamap_arg *ctx;
868
869 if (error != 0)
870 return;
871 ctx = arg;
872 ctx->vr_busaddr = segs[0].ds_addr;
873 }
874
875 static int
876 vr_dma_alloc(struct vr_softc *sc)
877 {
878 struct vr_dmamap_arg ctx;
879 struct vr_txdesc *txd;
880 struct vr_rxdesc *rxd;
881 bus_size_t tx_alignment;
882 int error, i;
883
884 /* Create parent DMA tag. */
885 error = bus_dma_tag_create(
886 bus_get_dma_tag(sc->vr_dev), /* parent */
887 1, 0, /* alignment, boundary */
888 BUS_SPACE_MAXADDR_32BIT, /* lowaddr */
889 BUS_SPACE_MAXADDR, /* highaddr */
890 NULL, NULL, /* filter, filterarg */
891 BUS_SPACE_MAXSIZE_32BIT, /* maxsize */
892 0, /* nsegments */
893 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */
894 0, /* flags */
895 NULL, NULL, /* lockfunc, lockarg */
896 &sc->vr_cdata.vr_parent_tag);
897 if (error != 0) {
898 device_printf(sc->vr_dev, "failed to create parent DMA tag\n");
899 goto fail;
900 }
901 /* Create tag for Tx ring. */
902 error = bus_dma_tag_create(
903 sc->vr_cdata.vr_parent_tag, /* parent */
904 VR_RING_ALIGN, 0, /* alignment, boundary */
905 BUS_SPACE_MAXADDR, /* lowaddr */
906 BUS_SPACE_MAXADDR, /* highaddr */
907 NULL, NULL, /* filter, filterarg */
908 VR_TX_RING_SIZE, /* maxsize */
909 1, /* nsegments */
910 VR_TX_RING_SIZE, /* maxsegsize */
911 0, /* flags */
912 NULL, NULL, /* lockfunc, lockarg */
913 &sc->vr_cdata.vr_tx_ring_tag);
914 if (error != 0) {
915 device_printf(sc->vr_dev, "failed to create Tx ring DMA tag\n");
916 goto fail;
917 }
918
919 /* Create tag for Rx ring. */
920 error = bus_dma_tag_create(
921 sc->vr_cdata.vr_parent_tag, /* parent */
922 VR_RING_ALIGN, 0, /* alignment, boundary */
923 BUS_SPACE_MAXADDR, /* lowaddr */
924 BUS_SPACE_MAXADDR, /* highaddr */
925 NULL, NULL, /* filter, filterarg */
926 VR_RX_RING_SIZE, /* maxsize */
927 1, /* nsegments */
928 VR_RX_RING_SIZE, /* maxsegsize */
929 0, /* flags */
930 NULL, NULL, /* lockfunc, lockarg */
931 &sc->vr_cdata.vr_rx_ring_tag);
932 if (error != 0) {
933 device_printf(sc->vr_dev, "failed to create Rx ring DMA tag\n");
934 goto fail;
935 }
936
937 if ((sc->vr_quirks & VR_Q_NEEDALIGN) != 0)
938 tx_alignment = sizeof(uint32_t);
939 else
940 tx_alignment = 1;
941 /* Create tag for Tx buffers. */
942 error = bus_dma_tag_create(
943 sc->vr_cdata.vr_parent_tag, /* parent */
944 tx_alignment, 0, /* alignment, boundary */
945 BUS_SPACE_MAXADDR, /* lowaddr */
946 BUS_SPACE_MAXADDR, /* highaddr */
947 NULL, NULL, /* filter, filterarg */
948 MCLBYTES * VR_MAXFRAGS, /* maxsize */
949 VR_MAXFRAGS, /* nsegments */
950 MCLBYTES, /* maxsegsize */
951 0, /* flags */
952 NULL, NULL, /* lockfunc, lockarg */
953 &sc->vr_cdata.vr_tx_tag);
954 if (error != 0) {
955 device_printf(sc->vr_dev, "failed to create Tx DMA tag\n");
956 goto fail;
957 }
958
959 /* Create tag for Rx buffers. */
960 error = bus_dma_tag_create(
961 sc->vr_cdata.vr_parent_tag, /* parent */
962 VR_RX_ALIGN, 0, /* alignment, boundary */
963 BUS_SPACE_MAXADDR, /* lowaddr */
964 BUS_SPACE_MAXADDR, /* highaddr */
965 NULL, NULL, /* filter, filterarg */
966 MCLBYTES, /* maxsize */
967 1, /* nsegments */
968 MCLBYTES, /* maxsegsize */
969 0, /* flags */
970 NULL, NULL, /* lockfunc, lockarg */
971 &sc->vr_cdata.vr_rx_tag);
972 if (error != 0) {
973 device_printf(sc->vr_dev, "failed to create Rx DMA tag\n");
974 goto fail;
975 }
976
977 /* Allocate DMA'able memory and load the DMA map for Tx ring. */
978 error = bus_dmamem_alloc(sc->vr_cdata.vr_tx_ring_tag,
979 (void **)&sc->vr_rdata.vr_tx_ring, BUS_DMA_WAITOK |
980 BUS_DMA_COHERENT | BUS_DMA_ZERO, &sc->vr_cdata.vr_tx_ring_map);
981 if (error != 0) {
982 device_printf(sc->vr_dev,
983 "failed to allocate DMA'able memory for Tx ring\n");
984 goto fail;
985 }
986
987 ctx.vr_busaddr = 0;
988 error = bus_dmamap_load(sc->vr_cdata.vr_tx_ring_tag,
989 sc->vr_cdata.vr_tx_ring_map, sc->vr_rdata.vr_tx_ring,
990 VR_TX_RING_SIZE, vr_dmamap_cb, &ctx, 0);
991 if (error != 0 || ctx.vr_busaddr == 0) {
992 device_printf(sc->vr_dev,
993 "failed to load DMA'able memory for Tx ring\n");
994 goto fail;
995 }
996 sc->vr_rdata.vr_tx_ring_paddr = ctx.vr_busaddr;
997
998 /* Allocate DMA'able memory and load the DMA map for Rx ring. */
999 error = bus_dmamem_alloc(sc->vr_cdata.vr_rx_ring_tag,
1000 (void **)&sc->vr_rdata.vr_rx_ring, BUS_DMA_WAITOK |
1001 BUS_DMA_COHERENT | BUS_DMA_ZERO, &sc->vr_cdata.vr_rx_ring_map);
1002 if (error != 0) {
1003 device_printf(sc->vr_dev,
1004 "failed to allocate DMA'able memory for Rx ring\n");
1005 goto fail;
1006 }
1007
1008 ctx.vr_busaddr = 0;
1009 error = bus_dmamap_load(sc->vr_cdata.vr_rx_ring_tag,
1010 sc->vr_cdata.vr_rx_ring_map, sc->vr_rdata.vr_rx_ring,
1011 VR_RX_RING_SIZE, vr_dmamap_cb, &ctx, 0);
1012 if (error != 0 || ctx.vr_busaddr == 0) {
1013 device_printf(sc->vr_dev,
1014 "failed to load DMA'able memory for Rx ring\n");
1015 goto fail;
1016 }
1017 sc->vr_rdata.vr_rx_ring_paddr = ctx.vr_busaddr;
1018
1019 /* Create DMA maps for Tx buffers. */
1020 for (i = 0; i < VR_TX_RING_CNT; i++) {
1021 txd = &sc->vr_cdata.vr_txdesc[i];
1022 txd->tx_m = NULL;
1023 txd->tx_dmamap = NULL;
1024 error = bus_dmamap_create(sc->vr_cdata.vr_tx_tag, 0,
1025 &txd->tx_dmamap);
1026 if (error != 0) {
1027 device_printf(sc->vr_dev,
1028 "failed to create Tx dmamap\n");
1029 goto fail;
1030 }
1031 }
1032 /* Create DMA maps for Rx buffers. */
1033 if ((error = bus_dmamap_create(sc->vr_cdata.vr_rx_tag, 0,
1034 &sc->vr_cdata.vr_rx_sparemap)) != 0) {
1035 device_printf(sc->vr_dev,
1036 "failed to create spare Rx dmamap\n");
1037 goto fail;
1038 }
1039 for (i = 0; i < VR_RX_RING_CNT; i++) {
1040 rxd = &sc->vr_cdata.vr_rxdesc[i];
1041 rxd->rx_m = NULL;
1042 rxd->rx_dmamap = NULL;
1043 error = bus_dmamap_create(sc->vr_cdata.vr_rx_tag, 0,
1044 &rxd->rx_dmamap);
1045 if (error != 0) {
1046 device_printf(sc->vr_dev,
1047 "failed to create Rx dmamap\n");
1048 goto fail;
1049 }
1050 }
1051
1052 fail:
1053 return (error);
1054 }
1055
1056 static void
1057 vr_dma_free(struct vr_softc *sc)
1058 {
1059 struct vr_txdesc *txd;
1060 struct vr_rxdesc *rxd;
1061 int i;
1062
1063 /* Tx ring. */
1064 if (sc->vr_cdata.vr_tx_ring_tag) {
1065 if (sc->vr_rdata.vr_tx_ring_paddr)
1066 bus_dmamap_unload(sc->vr_cdata.vr_tx_ring_tag,
1067 sc->vr_cdata.vr_tx_ring_map);
1068 if (sc->vr_rdata.vr_tx_ring)
1069 bus_dmamem_free(sc->vr_cdata.vr_tx_ring_tag,
1070 sc->vr_rdata.vr_tx_ring,
1071 sc->vr_cdata.vr_tx_ring_map);
1072 sc->vr_rdata.vr_tx_ring = NULL;
1073 sc->vr_rdata.vr_tx_ring_paddr = 0;
1074 bus_dma_tag_destroy(sc->vr_cdata.vr_tx_ring_tag);
1075 sc->vr_cdata.vr_tx_ring_tag = NULL;
1076 }
1077 /* Rx ring. */
1078 if (sc->vr_cdata.vr_rx_ring_tag) {
1079 if (sc->vr_rdata.vr_rx_ring_paddr)
1080 bus_dmamap_unload(sc->vr_cdata.vr_rx_ring_tag,
1081 sc->vr_cdata.vr_rx_ring_map);
1082 if (sc->vr_rdata.vr_rx_ring)
1083 bus_dmamem_free(sc->vr_cdata.vr_rx_ring_tag,
1084 sc->vr_rdata.vr_rx_ring,
1085 sc->vr_cdata.vr_rx_ring_map);
1086 sc->vr_rdata.vr_rx_ring = NULL;
1087 sc->vr_rdata.vr_rx_ring_paddr = 0;
1088 bus_dma_tag_destroy(sc->vr_cdata.vr_rx_ring_tag);
1089 sc->vr_cdata.vr_rx_ring_tag = NULL;
1090 }
1091 /* Tx buffers. */
1092 if (sc->vr_cdata.vr_tx_tag) {
1093 for (i = 0; i < VR_TX_RING_CNT; i++) {
1094 txd = &sc->vr_cdata.vr_txdesc[i];
1095 if (txd->tx_dmamap) {
1096 bus_dmamap_destroy(sc->vr_cdata.vr_tx_tag,
1097 txd->tx_dmamap);
1098 txd->tx_dmamap = NULL;
1099 }
1100 }
1101 bus_dma_tag_destroy(sc->vr_cdata.vr_tx_tag);
1102 sc->vr_cdata.vr_tx_tag = NULL;
1103 }
1104 /* Rx buffers. */
1105 if (sc->vr_cdata.vr_rx_tag) {
1106 for (i = 0; i < VR_RX_RING_CNT; i++) {
1107 rxd = &sc->vr_cdata.vr_rxdesc[i];
1108 if (rxd->rx_dmamap) {
1109 bus_dmamap_destroy(sc->vr_cdata.vr_rx_tag,
1110 rxd->rx_dmamap);
1111 rxd->rx_dmamap = NULL;
1112 }
1113 }
1114 if (sc->vr_cdata.vr_rx_sparemap) {
1115 bus_dmamap_destroy(sc->vr_cdata.vr_rx_tag,
1116 sc->vr_cdata.vr_rx_sparemap);
1117 sc->vr_cdata.vr_rx_sparemap = 0;
1118 }
1119 bus_dma_tag_destroy(sc->vr_cdata.vr_rx_tag);
1120 sc->vr_cdata.vr_rx_tag = NULL;
1121 }
1122
1123 if (sc->vr_cdata.vr_parent_tag) {
1124 bus_dma_tag_destroy(sc->vr_cdata.vr_parent_tag);
1125 sc->vr_cdata.vr_parent_tag = NULL;
1126 }
1127 }
1128
1129 /*
1130 * Initialize the transmit descriptors.
1131 */
1132 static int
1133 vr_tx_ring_init(struct vr_softc *sc)
1134 {
1135 struct vr_ring_data *rd;
1136 struct vr_txdesc *txd;
1137 bus_addr_t addr;
1138 int i;
1139
1140 sc->vr_cdata.vr_tx_prod = 0;
1141 sc->vr_cdata.vr_tx_cons = 0;
1142 sc->vr_cdata.vr_tx_cnt = 0;
1143 sc->vr_cdata.vr_tx_pkts = 0;
1144
1145 rd = &sc->vr_rdata;
1146 bzero(rd->vr_tx_ring, VR_TX_RING_SIZE);
1147 for (i = 0; i < VR_TX_RING_CNT; i++) {
1148 if (i == VR_TX_RING_CNT - 1)
1149 addr = VR_TX_RING_ADDR(sc, 0);
1150 else
1151 addr = VR_TX_RING_ADDR(sc, i + 1);
1152 rd->vr_tx_ring[i].vr_nextphys = htole32(VR_ADDR_LO(addr));
1153 txd = &sc->vr_cdata.vr_txdesc[i];
1154 txd->tx_m = NULL;
1155 }
1156
1157 bus_dmamap_sync(sc->vr_cdata.vr_tx_ring_tag,
1158 sc->vr_cdata.vr_tx_ring_map,
1159 BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1160
1161 return (0);
1162 }
1163
1164 /*
1165 * Initialize the RX descriptors and allocate mbufs for them. Note that
1166 * we arrange the descriptors in a closed ring, so that the last descriptor
1167 * points back to the first.
1168 */
1169 static int
1170 vr_rx_ring_init(struct vr_softc *sc)
1171 {
1172 struct vr_ring_data *rd;
1173 struct vr_rxdesc *rxd;
1174 bus_addr_t addr;
1175 int i;
1176
1177 sc->vr_cdata.vr_rx_cons = 0;
1178
1179 rd = &sc->vr_rdata;
1180 bzero(rd->vr_rx_ring, VR_RX_RING_SIZE);
1181 for (i = 0; i < VR_RX_RING_CNT; i++) {
1182 rxd = &sc->vr_cdata.vr_rxdesc[i];
1183 rxd->rx_m = NULL;
1184 rxd->desc = &rd->vr_rx_ring[i];
1185 if (i == VR_RX_RING_CNT - 1)
1186 addr = VR_RX_RING_ADDR(sc, 0);
1187 else
1188 addr = VR_RX_RING_ADDR(sc, i + 1);
1189 rd->vr_rx_ring[i].vr_nextphys = htole32(VR_ADDR_LO(addr));
1190 if (vr_newbuf(sc, i) != 0)
1191 return (ENOBUFS);
1192 }
1193
1194 bus_dmamap_sync(sc->vr_cdata.vr_rx_ring_tag,
1195 sc->vr_cdata.vr_rx_ring_map,
1196 BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1197
1198 return (0);
1199 }
1200
1201 static __inline void
1202 vr_discard_rxbuf(struct vr_rxdesc *rxd)
1203 {
1204 struct vr_desc *desc;
1205
1206 desc = rxd->desc;
1207 desc->vr_ctl = htole32(VR_RXCTL | (MCLBYTES - sizeof(uint64_t)));
1208 desc->vr_status = htole32(VR_RXSTAT_OWN);
1209 }
1210
1211 /*
1212 * Initialize an RX descriptor and attach an MBUF cluster.
1213 * Note: the length fields are only 11 bits wide, which means the
1214 * largest size we can specify is 2047. This is important because
1215 * MCLBYTES is 2048, so we have to subtract one otherwise we'll
1216 * overflow the field and make a mess.
1217 */
1218 static int
1219 vr_newbuf(struct vr_softc *sc, int idx)
1220 {
1221 struct vr_desc *desc;
1222 struct vr_rxdesc *rxd;
1223 struct mbuf *m;
1224 bus_dma_segment_t segs[1];
1225 bus_dmamap_t map;
1226 int nsegs;
1227
1228 m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1229 if (m == NULL)
1230 return (ENOBUFS);
1231 m->m_len = m->m_pkthdr.len = MCLBYTES;
1232 m_adj(m, sizeof(uint64_t));
1233
1234 if (bus_dmamap_load_mbuf_sg(sc->vr_cdata.vr_rx_tag,
1235 sc->vr_cdata.vr_rx_sparemap, m, segs, &nsegs, 0) != 0) {
1236 m_freem(m);
1237 return (ENOBUFS);
1238 }
1239 KASSERT(nsegs == 1, ("%s: %d segments returned!", __func__, nsegs));
1240
1241 rxd = &sc->vr_cdata.vr_rxdesc[idx];
1242 if (rxd->rx_m != NULL) {
1243 bus_dmamap_sync(sc->vr_cdata.vr_rx_tag, rxd->rx_dmamap,
1244 BUS_DMASYNC_POSTREAD);
1245 bus_dmamap_unload(sc->vr_cdata.vr_rx_tag, rxd->rx_dmamap);
1246 }
1247 map = rxd->rx_dmamap;
1248 rxd->rx_dmamap = sc->vr_cdata.vr_rx_sparemap;
1249 sc->vr_cdata.vr_rx_sparemap = map;
1250 bus_dmamap_sync(sc->vr_cdata.vr_rx_tag, rxd->rx_dmamap,
1251 BUS_DMASYNC_PREREAD);
1252 rxd->rx_m = m;
1253 desc = rxd->desc;
1254 desc->vr_data = htole32(VR_ADDR_LO(segs[0].ds_addr));
1255 desc->vr_ctl = htole32(VR_RXCTL | segs[0].ds_len);
1256 desc->vr_status = htole32(VR_RXSTAT_OWN);
1257
1258 return (0);
1259 }
1260
1261 #ifndef __NO_STRICT_ALIGNMENT
1262 static __inline void
1263 vr_fixup_rx(struct mbuf *m)
1264 {
1265 uint16_t *src, *dst;
1266 int i;
1267
1268 src = mtod(m, uint16_t *);
1269 dst = src - 1;
1270
1271 for (i = 0; i < (m->m_len / sizeof(uint16_t) + 1); i++)
1272 *dst++ = *src++;
1273
1274 m->m_data -= ETHER_ALIGN;
1275 }
1276 #endif
1277
1278 /*
1279 * A frame has been uploaded: pass the resulting mbuf chain up to
1280 * the higher level protocols.
1281 */
1282 static int
1283 vr_rxeof(struct vr_softc *sc)
1284 {
1285 struct vr_rxdesc *rxd;
1286 struct mbuf *m;
1287 struct ifnet *ifp;
1288 struct vr_desc *cur_rx;
1289 int cons, prog, total_len, rx_npkts;
1290 uint32_t rxstat, rxctl;
1291
1292 VR_LOCK_ASSERT(sc);
1293 ifp = sc->vr_ifp;
1294 cons = sc->vr_cdata.vr_rx_cons;
1295 rx_npkts = 0;
1296
1297 bus_dmamap_sync(sc->vr_cdata.vr_rx_ring_tag,
1298 sc->vr_cdata.vr_rx_ring_map,
1299 BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1300
1301 for (prog = 0; prog < VR_RX_RING_CNT; VR_INC(cons, VR_RX_RING_CNT)) {
1302 #ifdef DEVICE_POLLING
1303 if (ifp->if_capenable & IFCAP_POLLING) {
1304 if (sc->rxcycles <= 0)
1305 break;
1306 sc->rxcycles--;
1307 }
1308 #endif
1309 cur_rx = &sc->vr_rdata.vr_rx_ring[cons];
1310 rxstat = le32toh(cur_rx->vr_status);
1311 rxctl = le32toh(cur_rx->vr_ctl);
1312 if ((rxstat & VR_RXSTAT_OWN) == VR_RXSTAT_OWN)
1313 break;
1314
1315 prog++;
1316 rxd = &sc->vr_cdata.vr_rxdesc[cons];
1317 m = rxd->rx_m;
1318
1319 /*
1320 * If an error occurs, update stats, clear the
1321 * status word and leave the mbuf cluster in place:
1322 * it should simply get re-used next time this descriptor
1323 * comes up in the ring.
1324 * We don't support SG in Rx path yet, so discard
1325 * partial frame.
1326 */
1327 if ((rxstat & VR_RXSTAT_RX_OK) == 0 ||
1328 (rxstat & (VR_RXSTAT_FIRSTFRAG | VR_RXSTAT_LASTFRAG)) !=
1329 (VR_RXSTAT_FIRSTFRAG | VR_RXSTAT_LASTFRAG)) {
1330 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
1331 sc->vr_stat.rx_errors++;
1332 if (rxstat & VR_RXSTAT_CRCERR)
1333 sc->vr_stat.rx_crc_errors++;
1334 if (rxstat & VR_RXSTAT_FRAMEALIGNERR)
1335 sc->vr_stat.rx_alignment++;
1336 if (rxstat & VR_RXSTAT_FIFOOFLOW)
1337 sc->vr_stat.rx_fifo_overflows++;
1338 if (rxstat & VR_RXSTAT_GIANT)
1339 sc->vr_stat.rx_giants++;
1340 if (rxstat & VR_RXSTAT_RUNT)
1341 sc->vr_stat.rx_runts++;
1342 if (rxstat & VR_RXSTAT_BUFFERR)
1343 sc->vr_stat.rx_no_buffers++;
1344 #ifdef VR_SHOW_ERRORS
1345 device_printf(sc->vr_dev, "%s: receive error = 0x%b\n",
1346 __func__, rxstat & 0xff, VR_RXSTAT_ERR_BITS);
1347 #endif
1348 vr_discard_rxbuf(rxd);
1349 continue;
1350 }
1351
1352 if (vr_newbuf(sc, cons) != 0) {
1353 if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
1354 sc->vr_stat.rx_errors++;
1355 sc->vr_stat.rx_no_mbufs++;
1356 vr_discard_rxbuf(rxd);
1357 continue;
1358 }
1359
1360 /*
1361 * XXX The VIA Rhine chip includes the CRC with every
1362 * received frame, and there's no way to turn this
1363 * behavior off (at least, I can't find anything in
1364 * the manual that explains how to do it) so we have
1365 * to trim off the CRC manually.
1366 */
1367 total_len = VR_RXBYTES(rxstat);
1368 total_len -= ETHER_CRC_LEN;
1369 m->m_pkthdr.len = m->m_len = total_len;
1370 #ifndef __NO_STRICT_ALIGNMENT
1371 /*
1372 * RX buffers must be 32-bit aligned.
1373 * Ignore the alignment problems on the non-strict alignment
1374 * platform. The performance hit incurred due to unaligned
1375 * accesses is much smaller than the hit produced by forcing
1376 * buffer copies all the time.
1377 */
1378 vr_fixup_rx(m);
1379 #endif
1380 m->m_pkthdr.rcvif = ifp;
1381 if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
1382 sc->vr_stat.rx_ok++;
1383 if ((ifp->if_capenable & IFCAP_RXCSUM) != 0 &&
1384 (rxstat & VR_RXSTAT_FRAG) == 0 &&
1385 (rxctl & VR_RXCTL_IP) != 0) {
1386 /* Checksum is valid for non-fragmented IP packets. */
1387 m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED;
1388 if ((rxctl & VR_RXCTL_IPOK) == VR_RXCTL_IPOK) {
1389 m->m_pkthdr.csum_flags |= CSUM_IP_VALID;
1390 if (rxctl & (VR_RXCTL_TCP | VR_RXCTL_UDP)) {
1391 m->m_pkthdr.csum_flags |=
1392 CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
1393 if ((rxctl & VR_RXCTL_TCPUDPOK) != 0)
1394 m->m_pkthdr.csum_data = 0xffff;
1395 }
1396 }
1397 }
1398 VR_UNLOCK(sc);
1399 (*ifp->if_input)(ifp, m);
1400 VR_LOCK(sc);
1401 rx_npkts++;
1402 }
1403
1404 if (prog > 0) {
1405 /*
1406 * Let controller know how many number of RX buffers
1407 * are posted but avoid expensive register access if
1408 * TX pause capability was not negotiated with link
1409 * partner.
1410 */
1411 if ((sc->vr_flags & VR_F_TXPAUSE) != 0) {
1412 if (prog >= VR_RX_RING_CNT)
1413 prog = VR_RX_RING_CNT - 1;
1414 CSR_WRITE_1(sc, VR_FLOWCR0, prog);
1415 }
1416 sc->vr_cdata.vr_rx_cons = cons;
1417 bus_dmamap_sync(sc->vr_cdata.vr_rx_ring_tag,
1418 sc->vr_cdata.vr_rx_ring_map,
1419 BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1420 }
1421 return (rx_npkts);
1422 }
1423
1424 /*
1425 * A frame was downloaded to the chip. It's safe for us to clean up
1426 * the list buffers.
1427 */
1428 static void
1429 vr_txeof(struct vr_softc *sc)
1430 {
1431 struct vr_txdesc *txd;
1432 struct vr_desc *cur_tx;
1433 struct ifnet *ifp;
1434 uint32_t txctl, txstat;
1435 int cons, prod;
1436
1437 VR_LOCK_ASSERT(sc);
1438
1439 cons = sc->vr_cdata.vr_tx_cons;
1440 prod = sc->vr_cdata.vr_tx_prod;
1441 if (cons == prod)
1442 return;
1443
1444 bus_dmamap_sync(sc->vr_cdata.vr_tx_ring_tag,
1445 sc->vr_cdata.vr_tx_ring_map,
1446 BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1447
1448 ifp = sc->vr_ifp;
1449 /*
1450 * Go through our tx list and free mbufs for those
1451 * frames that have been transmitted.
1452 */
1453 for (; cons != prod; VR_INC(cons, VR_TX_RING_CNT)) {
1454 cur_tx = &sc->vr_rdata.vr_tx_ring[cons];
1455 txctl = le32toh(cur_tx->vr_ctl);
1456 txstat = le32toh(cur_tx->vr_status);
1457 if ((txstat & VR_TXSTAT_OWN) == VR_TXSTAT_OWN)
1458 break;
1459
1460 sc->vr_cdata.vr_tx_cnt--;
1461 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1462 /* Only the first descriptor in the chain is valid. */
1463 if ((txctl & VR_TXCTL_FIRSTFRAG) == 0)
1464 continue;
1465
1466 txd = &sc->vr_cdata.vr_txdesc[cons];
1467 KASSERT(txd->tx_m != NULL, ("%s: accessing NULL mbuf!\n",
1468 __func__));
1469
1470 if ((txstat & VR_TXSTAT_ERRSUM) != 0) {
1471 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1472 sc->vr_stat.tx_errors++;
1473 if ((txstat & VR_TXSTAT_ABRT) != 0) {
1474 /* Give up and restart Tx. */
1475 sc->vr_stat.tx_abort++;
1476 bus_dmamap_sync(sc->vr_cdata.vr_tx_tag,
1477 txd->tx_dmamap, BUS_DMASYNC_POSTWRITE);
1478 bus_dmamap_unload(sc->vr_cdata.vr_tx_tag,
1479 txd->tx_dmamap);
1480 m_freem(txd->tx_m);
1481 txd->tx_m = NULL;
1482 VR_INC(cons, VR_TX_RING_CNT);
1483 sc->vr_cdata.vr_tx_cons = cons;
1484 if (vr_tx_stop(sc) != 0) {
1485 device_printf(sc->vr_dev,
1486 "%s: Tx shutdown error -- "
1487 "resetting\n", __func__);
1488 sc->vr_flags |= VR_F_RESTART;
1489 return;
1490 }
1491 vr_tx_start(sc);
1492 break;
1493 }
1494 if ((sc->vr_revid < REV_ID_VT3071_A &&
1495 (txstat & VR_TXSTAT_UNDERRUN)) ||
1496 (txstat & (VR_TXSTAT_UDF | VR_TXSTAT_TBUFF))) {
1497 sc->vr_stat.tx_underrun++;
1498 /* Retry and restart Tx. */
1499 sc->vr_cdata.vr_tx_cnt++;
1500 sc->vr_cdata.vr_tx_cons = cons;
1501 cur_tx->vr_status = htole32(VR_TXSTAT_OWN);
1502 bus_dmamap_sync(sc->vr_cdata.vr_tx_ring_tag,
1503 sc->vr_cdata.vr_tx_ring_map,
1504 BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1505 vr_tx_underrun(sc);
1506 return;
1507 }
1508 if ((txstat & VR_TXSTAT_DEFER) != 0) {
1509 if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1510 sc->vr_stat.tx_collisions++;
1511 }
1512 if ((txstat & VR_TXSTAT_LATECOLL) != 0) {
1513 if_inc_counter(ifp, IFCOUNTER_COLLISIONS, 1);
1514 sc->vr_stat.tx_late_collisions++;
1515 }
1516 } else {
1517 sc->vr_stat.tx_ok++;
1518 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1519 }
1520
1521 bus_dmamap_sync(sc->vr_cdata.vr_tx_tag, txd->tx_dmamap,
1522 BUS_DMASYNC_POSTWRITE);
1523 bus_dmamap_unload(sc->vr_cdata.vr_tx_tag, txd->tx_dmamap);
1524 if (sc->vr_revid < REV_ID_VT3071_A) {
1525 if_inc_counter(ifp, IFCOUNTER_COLLISIONS,
1526 (txstat & VR_TXSTAT_COLLCNT) >> 3);
1527 sc->vr_stat.tx_collisions +=
1528 (txstat & VR_TXSTAT_COLLCNT) >> 3;
1529 } else {
1530 if_inc_counter(ifp, IFCOUNTER_COLLISIONS, (txstat & 0x0f));
1531 sc->vr_stat.tx_collisions += (txstat & 0x0f);
1532 }
1533 m_freem(txd->tx_m);
1534 txd->tx_m = NULL;
1535 }
1536
1537 sc->vr_cdata.vr_tx_cons = cons;
1538 if (sc->vr_cdata.vr_tx_cnt == 0)
1539 sc->vr_watchdog_timer = 0;
1540 }
1541
1542 static void
1543 vr_tick(void *xsc)
1544 {
1545 struct vr_softc *sc;
1546 struct mii_data *mii;
1547
1548 sc = (struct vr_softc *)xsc;
1549
1550 VR_LOCK_ASSERT(sc);
1551
1552 if ((sc->vr_flags & VR_F_RESTART) != 0) {
1553 device_printf(sc->vr_dev, "restarting\n");
1554 sc->vr_stat.num_restart++;
1555 sc->vr_ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
1556 vr_init_locked(sc);
1557 sc->vr_flags &= ~VR_F_RESTART;
1558 }
1559
1560 mii = device_get_softc(sc->vr_miibus);
1561 mii_tick(mii);
1562 if ((sc->vr_flags & VR_F_LINK) == 0)
1563 vr_miibus_statchg(sc->vr_dev);
1564 vr_watchdog(sc);
1565 callout_reset(&sc->vr_stat_callout, hz, vr_tick, sc);
1566 }
1567
1568 #ifdef DEVICE_POLLING
1569 static poll_handler_t vr_poll;
1570 static poll_handler_t vr_poll_locked;
1571
1572 static int
1573 vr_poll(struct ifnet *ifp, enum poll_cmd cmd, int count)
1574 {
1575 struct vr_softc *sc;
1576 int rx_npkts;
1577
1578 sc = ifp->if_softc;
1579 rx_npkts = 0;
1580
1581 VR_LOCK(sc);
1582 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0)
1583 rx_npkts = vr_poll_locked(ifp, cmd, count);
1584 VR_UNLOCK(sc);
1585 return (rx_npkts);
1586 }
1587
1588 static int
1589 vr_poll_locked(struct ifnet *ifp, enum poll_cmd cmd, int count)
1590 {
1591 struct vr_softc *sc;
1592 int rx_npkts;
1593
1594 sc = ifp->if_softc;
1595
1596 VR_LOCK_ASSERT(sc);
1597
1598 sc->rxcycles = count;
1599 rx_npkts = vr_rxeof(sc);
1600 vr_txeof(sc);
1601 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1602 vr_start_locked(ifp);
1603
1604 if (cmd == POLL_AND_CHECK_STATUS) {
1605 uint16_t status;
1606
1607 /* Also check status register. */
1608 status = CSR_READ_2(sc, VR_ISR);
1609 if (status)
1610 CSR_WRITE_2(sc, VR_ISR, status);
1611
1612 if ((status & VR_INTRS) == 0)
1613 return (rx_npkts);
1614
1615 if ((status & (VR_ISR_BUSERR | VR_ISR_LINKSTAT2 |
1616 VR_ISR_STATSOFLOW)) != 0) {
1617 if (vr_error(sc, status) != 0)
1618 return (rx_npkts);
1619 }
1620 if ((status & (VR_ISR_RX_NOBUF | VR_ISR_RX_OFLOW)) != 0) {
1621 #ifdef VR_SHOW_ERRORS
1622 device_printf(sc->vr_dev, "%s: receive error : 0x%b\n",
1623 __func__, status, VR_ISR_ERR_BITS);
1624 #endif
1625 vr_rx_start(sc);
1626 }
1627 }
1628 return (rx_npkts);
1629 }
1630 #endif /* DEVICE_POLLING */
1631
1632 /* Back off the transmit threshold. */
1633 static void
1634 vr_tx_underrun(struct vr_softc *sc)
1635 {
1636 int thresh;
1637
1638 device_printf(sc->vr_dev, "Tx underrun -- ");
1639 if (sc->vr_txthresh < VR_TXTHRESH_MAX) {
1640 thresh = sc->vr_txthresh;
1641 sc->vr_txthresh++;
1642 if (sc->vr_txthresh >= VR_TXTHRESH_MAX) {
1643 sc->vr_txthresh = VR_TXTHRESH_MAX;
1644 printf("using store and forward mode\n");
1645 } else
1646 printf("increasing Tx threshold(%d -> %d)\n",
1647 vr_tx_threshold_tables[thresh].value,
1648 vr_tx_threshold_tables[thresh + 1].value);
1649 } else
1650 printf("\n");
1651 sc->vr_stat.tx_underrun++;
1652 if (vr_tx_stop(sc) != 0) {
1653 device_printf(sc->vr_dev, "%s: Tx shutdown error -- "
1654 "resetting\n", __func__);
1655 sc->vr_flags |= VR_F_RESTART;
1656 return;
1657 }
1658 vr_tx_start(sc);
1659 }
1660
1661 static int
1662 vr_intr(void *arg)
1663 {
1664 struct vr_softc *sc;
1665 uint16_t status;
1666
1667 sc = (struct vr_softc *)arg;
1668
1669 status = CSR_READ_2(sc, VR_ISR);
1670 if (status == 0 || status == 0xffff || (status & VR_INTRS) == 0)
1671 return (FILTER_STRAY);
1672
1673 /* Disable interrupts. */
1674 CSR_WRITE_2(sc, VR_IMR, 0x0000);
1675
1676 taskqueue_enqueue(taskqueue_fast, &sc->vr_inttask);
1677
1678 return (FILTER_HANDLED);
1679 }
1680
1681 static void
1682 vr_int_task(void *arg, int npending)
1683 {
1684 struct vr_softc *sc;
1685 struct ifnet *ifp;
1686 uint16_t status;
1687
1688 sc = (struct vr_softc *)arg;
1689
1690 VR_LOCK(sc);
1691
1692 if ((sc->vr_flags & VR_F_SUSPENDED) != 0)
1693 goto done_locked;
1694
1695 status = CSR_READ_2(sc, VR_ISR);
1696 ifp = sc->vr_ifp;
1697 #ifdef DEVICE_POLLING
1698 if ((ifp->if_capenable & IFCAP_POLLING) != 0)
1699 goto done_locked;
1700 #endif
1701
1702 /* Suppress unwanted interrupts. */
1703 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 ||
1704 (sc->vr_flags & VR_F_RESTART) != 0) {
1705 CSR_WRITE_2(sc, VR_IMR, 0);
1706 CSR_WRITE_2(sc, VR_ISR, status);
1707 goto done_locked;
1708 }
1709
1710 for (; (status & VR_INTRS) != 0;) {
1711 CSR_WRITE_2(sc, VR_ISR, status);
1712 if ((status & (VR_ISR_BUSERR | VR_ISR_LINKSTAT2 |
1713 VR_ISR_STATSOFLOW)) != 0) {
1714 if (vr_error(sc, status) != 0) {
1715 VR_UNLOCK(sc);
1716 return;
1717 }
1718 }
1719 vr_rxeof(sc);
1720 if ((status & (VR_ISR_RX_NOBUF | VR_ISR_RX_OFLOW)) != 0) {
1721 #ifdef VR_SHOW_ERRORS
1722 device_printf(sc->vr_dev, "%s: receive error = 0x%b\n",
1723 __func__, status, VR_ISR_ERR_BITS);
1724 #endif
1725 /* Restart Rx if RxDMA SM was stopped. */
1726 vr_rx_start(sc);
1727 }
1728 vr_txeof(sc);
1729
1730 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
1731 vr_start_locked(ifp);
1732
1733 status = CSR_READ_2(sc, VR_ISR);
1734 }
1735
1736 /* Re-enable interrupts. */
1737 CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
1738
1739 done_locked:
1740 VR_UNLOCK(sc);
1741 }
1742
1743 static int
1744 vr_error(struct vr_softc *sc, uint16_t status)
1745 {
1746 uint16_t pcis;
1747
1748 status &= VR_ISR_BUSERR | VR_ISR_LINKSTAT2 | VR_ISR_STATSOFLOW;
1749 if ((status & VR_ISR_BUSERR) != 0) {
1750 status &= ~VR_ISR_BUSERR;
1751 sc->vr_stat.bus_errors++;
1752 /* Disable further interrupts. */
1753 CSR_WRITE_2(sc, VR_IMR, 0);
1754 pcis = pci_read_config(sc->vr_dev, PCIR_STATUS, 2);
1755 device_printf(sc->vr_dev, "PCI bus error(0x%04x) -- "
1756 "resetting\n", pcis);
1757 pci_write_config(sc->vr_dev, PCIR_STATUS, pcis, 2);
1758 sc->vr_flags |= VR_F_RESTART;
1759 return (EAGAIN);
1760 }
1761 if ((status & VR_ISR_LINKSTAT2) != 0) {
1762 /* Link state change, duplex changes etc. */
1763 status &= ~VR_ISR_LINKSTAT2;
1764 }
1765 if ((status & VR_ISR_STATSOFLOW) != 0) {
1766 status &= ~VR_ISR_STATSOFLOW;
1767 if (sc->vr_revid >= REV_ID_VT6105M_A0) {
1768 /* Update MIB counters. */
1769 }
1770 }
1771
1772 if (status != 0)
1773 device_printf(sc->vr_dev,
1774 "unhandled interrupt, status = 0x%04x\n", status);
1775 return (0);
1776 }
1777
1778 /*
1779 * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1780 * pointers to the fragment pointers.
1781 */
1782 static int
1783 vr_encap(struct vr_softc *sc, struct mbuf **m_head)
1784 {
1785 struct vr_txdesc *txd;
1786 struct vr_desc *desc;
1787 struct mbuf *m;
1788 bus_dma_segment_t txsegs[VR_MAXFRAGS];
1789 uint32_t csum_flags, txctl;
1790 int error, i, nsegs, prod, si;
1791 int padlen;
1792
1793 VR_LOCK_ASSERT(sc);
1794
1795 M_ASSERTPKTHDR((*m_head));
1796
1797 /*
1798 * Some VIA Rhine wants packet buffers to be longword
1799 * aligned, but very often our mbufs aren't. Rather than
1800 * waste time trying to decide when to copy and when not
1801 * to copy, just do it all the time.
1802 */
1803 if ((sc->vr_quirks & VR_Q_NEEDALIGN) != 0) {
1804 m = m_defrag(*m_head, M_NOWAIT);
1805 if (m == NULL) {
1806 m_freem(*m_head);
1807 *m_head = NULL;
1808 return (ENOBUFS);
1809 }
1810 *m_head = m;
1811 }
1812
1813 /*
1814 * The Rhine chip doesn't auto-pad, so we have to make
1815 * sure to pad short frames out to the minimum frame length
1816 * ourselves.
1817 */
1818 if ((*m_head)->m_pkthdr.len < VR_MIN_FRAMELEN) {
1819 m = *m_head;
1820 padlen = VR_MIN_FRAMELEN - m->m_pkthdr.len;
1821 if (M_WRITABLE(m) == 0) {
1822 /* Get a writable copy. */
1823 m = m_dup(*m_head, M_NOWAIT);
1824 m_freem(*m_head);
1825 if (m == NULL) {
1826 *m_head = NULL;
1827 return (ENOBUFS);
1828 }
1829 *m_head = m;
1830 }
1831 if (m->m_next != NULL || M_TRAILINGSPACE(m) < padlen) {
1832 m = m_defrag(m, M_NOWAIT);
1833 if (m == NULL) {
1834 m_freem(*m_head);
1835 *m_head = NULL;
1836 return (ENOBUFS);
1837 }
1838 }
1839 /*
1840 * Manually pad short frames, and zero the pad space
1841 * to avoid leaking data.
1842 */
1843 bzero(mtod(m, char *) + m->m_pkthdr.len, padlen);
1844 m->m_pkthdr.len += padlen;
1845 m->m_len = m->m_pkthdr.len;
1846 *m_head = m;
1847 }
1848
1849 prod = sc->vr_cdata.vr_tx_prod;
1850 txd = &sc->vr_cdata.vr_txdesc[prod];
1851 error = bus_dmamap_load_mbuf_sg(sc->vr_cdata.vr_tx_tag, txd->tx_dmamap,
1852 *m_head, txsegs, &nsegs, BUS_DMA_NOWAIT);
1853 if (error == EFBIG) {
1854 m = m_collapse(*m_head, M_NOWAIT, VR_MAXFRAGS);
1855 if (m == NULL) {
1856 m_freem(*m_head);
1857 *m_head = NULL;
1858 return (ENOBUFS);
1859 }
1860 *m_head = m;
1861 error = bus_dmamap_load_mbuf_sg(sc->vr_cdata.vr_tx_tag,
1862 txd->tx_dmamap, *m_head, txsegs, &nsegs, BUS_DMA_NOWAIT);
1863 if (error != 0) {
1864 m_freem(*m_head);
1865 *m_head = NULL;
1866 return (error);
1867 }
1868 } else if (error != 0)
1869 return (error);
1870 if (nsegs == 0) {
1871 m_freem(*m_head);
1872 *m_head = NULL;
1873 return (EIO);
1874 }
1875
1876 /* Check number of available descriptors. */
1877 if (sc->vr_cdata.vr_tx_cnt + nsegs >= (VR_TX_RING_CNT - 1)) {
1878 bus_dmamap_unload(sc->vr_cdata.vr_tx_tag, txd->tx_dmamap);
1879 return (ENOBUFS);
1880 }
1881
1882 txd->tx_m = *m_head;
1883 bus_dmamap_sync(sc->vr_cdata.vr_tx_tag, txd->tx_dmamap,
1884 BUS_DMASYNC_PREWRITE);
1885
1886 /* Set checksum offload. */
1887 csum_flags = 0;
1888 if (((*m_head)->m_pkthdr.csum_flags & VR_CSUM_FEATURES) != 0) {
1889 if ((*m_head)->m_pkthdr.csum_flags & CSUM_IP)
1890 csum_flags |= VR_TXCTL_IPCSUM;
1891 if ((*m_head)->m_pkthdr.csum_flags & CSUM_TCP)
1892 csum_flags |= VR_TXCTL_TCPCSUM;
1893 if ((*m_head)->m_pkthdr.csum_flags & CSUM_UDP)
1894 csum_flags |= VR_TXCTL_UDPCSUM;
1895 }
1896
1897 /*
1898 * Quite contrary to datasheet for VIA Rhine, VR_TXCTL_TLINK bit
1899 * is required for all descriptors regardless of single or
1900 * multiple buffers. Also VR_TXSTAT_OWN bit is valid only for
1901 * the first descriptor for a multi-fragmented frames. Without
1902 * that VIA Rhine chip generates Tx underrun interrupts and can't
1903 * send any frames.
1904 */
1905 si = prod;
1906 for (i = 0; i < nsegs; i++) {
1907 desc = &sc->vr_rdata.vr_tx_ring[prod];
1908 desc->vr_status = 0;
1909 txctl = txsegs[i].ds_len | VR_TXCTL_TLINK | csum_flags;
1910 if (i == 0)
1911 txctl |= VR_TXCTL_FIRSTFRAG;
1912 desc->vr_ctl = htole32(txctl);
1913 desc->vr_data = htole32(VR_ADDR_LO(txsegs[i].ds_addr));
1914 sc->vr_cdata.vr_tx_cnt++;
1915 VR_INC(prod, VR_TX_RING_CNT);
1916 }
1917 /* Update producer index. */
1918 sc->vr_cdata.vr_tx_prod = prod;
1919
1920 prod = (prod + VR_TX_RING_CNT - 1) % VR_TX_RING_CNT;
1921 desc = &sc->vr_rdata.vr_tx_ring[prod];
1922
1923 /*
1924 * Set EOP on the last desciptor and reuqest Tx completion
1925 * interrupt for every VR_TX_INTR_THRESH-th frames.
1926 */
1927 VR_INC(sc->vr_cdata.vr_tx_pkts, VR_TX_INTR_THRESH);
1928 if (sc->vr_cdata.vr_tx_pkts == 0)
1929 desc->vr_ctl |= htole32(VR_TXCTL_LASTFRAG | VR_TXCTL_FINT);
1930 else
1931 desc->vr_ctl |= htole32(VR_TXCTL_LASTFRAG);
1932
1933 /* Lastly turn the first descriptor ownership to hardware. */
1934 desc = &sc->vr_rdata.vr_tx_ring[si];
1935 desc->vr_status |= htole32(VR_TXSTAT_OWN);
1936
1937 /* Sync descriptors. */
1938 bus_dmamap_sync(sc->vr_cdata.vr_tx_ring_tag,
1939 sc->vr_cdata.vr_tx_ring_map,
1940 BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1941
1942 return (0);
1943 }
1944
1945 static void
1946 vr_start(struct ifnet *ifp)
1947 {
1948 struct vr_softc *sc;
1949
1950 sc = ifp->if_softc;
1951 VR_LOCK(sc);
1952 vr_start_locked(ifp);
1953 VR_UNLOCK(sc);
1954 }
1955
1956 static void
1957 vr_start_locked(struct ifnet *ifp)
1958 {
1959 struct vr_softc *sc;
1960 struct mbuf *m_head;
1961 int enq;
1962
1963 sc = ifp->if_softc;
1964
1965 VR_LOCK_ASSERT(sc);
1966
1967 if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
1968 IFF_DRV_RUNNING || (sc->vr_flags & VR_F_LINK) == 0)
1969 return;
1970
1971 for (enq = 0; !IFQ_DRV_IS_EMPTY(&ifp->if_snd) &&
1972 sc->vr_cdata.vr_tx_cnt < VR_TX_RING_CNT - 2; ) {
1973 IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head);
1974 if (m_head == NULL)
1975 break;
1976 /*
1977 * Pack the data into the transmit ring. If we
1978 * don't have room, set the OACTIVE flag and wait
1979 * for the NIC to drain the ring.
1980 */
1981 if (vr_encap(sc, &m_head)) {
1982 if (m_head == NULL)
1983 break;
1984 IFQ_DRV_PREPEND(&ifp->if_snd, m_head);
1985 ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1986 break;
1987 }
1988
1989 enq++;
1990 /*
1991 * If there's a BPF listener, bounce a copy of this frame
1992 * to him.
1993 */
1994 ETHER_BPF_MTAP(ifp, m_head);
1995 }
1996
1997 if (enq > 0) {
1998 /* Tell the chip to start transmitting. */
1999 VR_SETBIT(sc, VR_CR0, VR_CR0_TX_GO);
2000 /* Set a timeout in case the chip goes out to lunch. */
2001 sc->vr_watchdog_timer = 5;
2002 }
2003 }
2004
2005 static void
2006 vr_init(void *xsc)
2007 {
2008 struct vr_softc *sc;
2009
2010 sc = (struct vr_softc *)xsc;
2011 VR_LOCK(sc);
2012 vr_init_locked(sc);
2013 VR_UNLOCK(sc);
2014 }
2015
2016 static void
2017 vr_init_locked(struct vr_softc *sc)
2018 {
2019 struct ifnet *ifp;
2020 struct mii_data *mii;
2021 bus_addr_t addr;
2022 int i;
2023
2024 VR_LOCK_ASSERT(sc);
2025
2026 ifp = sc->vr_ifp;
2027 mii = device_get_softc(sc->vr_miibus);
2028
2029 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0)
2030 return;
2031
2032 /* Cancel pending I/O and free all RX/TX buffers. */
2033 vr_stop(sc);
2034 vr_reset(sc);
2035
2036 /* Set our station address. */
2037 for (i = 0; i < ETHER_ADDR_LEN; i++)
2038 CSR_WRITE_1(sc, VR_PAR0 + i, IF_LLADDR(sc->vr_ifp)[i]);
2039
2040 /* Set DMA size. */
2041 VR_CLRBIT(sc, VR_BCR0, VR_BCR0_DMA_LENGTH);
2042 VR_SETBIT(sc, VR_BCR0, VR_BCR0_DMA_STORENFWD);
2043
2044 /*
2045 * BCR0 and BCR1 can override the RXCFG and TXCFG registers,
2046 * so we must set both.
2047 */
2048 VR_CLRBIT(sc, VR_BCR0, VR_BCR0_RX_THRESH);
2049 VR_SETBIT(sc, VR_BCR0, VR_BCR0_RXTHRESH128BYTES);
2050
2051 VR_CLRBIT(sc, VR_BCR1, VR_BCR1_TX_THRESH);
2052 VR_SETBIT(sc, VR_BCR1, vr_tx_threshold_tables[sc->vr_txthresh].bcr_cfg);
2053
2054 VR_CLRBIT(sc, VR_RXCFG, VR_RXCFG_RX_THRESH);
2055 VR_SETBIT(sc, VR_RXCFG, VR_RXTHRESH_128BYTES);
2056
2057 VR_CLRBIT(sc, VR_TXCFG, VR_TXCFG_TX_THRESH);
2058 VR_SETBIT(sc, VR_TXCFG, vr_tx_threshold_tables[sc->vr_txthresh].tx_cfg);
2059
2060 /* Init circular RX list. */
2061 if (vr_rx_ring_init(sc) != 0) {
2062 device_printf(sc->vr_dev,
2063 "initialization failed: no memory for rx buffers\n");
2064 vr_stop(sc);
2065 return;
2066 }
2067
2068 /* Init tx descriptors. */
2069 vr_tx_ring_init(sc);
2070
2071 if ((sc->vr_quirks & VR_Q_CAM) != 0) {
2072 uint8_t vcam[2] = { 0, 0 };
2073
2074 /* Disable VLAN hardware tag insertion/stripping. */
2075 VR_CLRBIT(sc, VR_TXCFG, VR_TXCFG_TXTAGEN | VR_TXCFG_RXTAGCTL);
2076 /* Disable VLAN hardware filtering. */
2077 VR_CLRBIT(sc, VR_BCR1, VR_BCR1_VLANFILT_ENB);
2078 /* Disable all CAM entries. */
2079 vr_cam_mask(sc, VR_MCAST_CAM, 0);
2080 vr_cam_mask(sc, VR_VLAN_CAM, 0);
2081 /* Enable the first VLAN CAM. */
2082 vr_cam_data(sc, VR_VLAN_CAM, 0, vcam);
2083 vr_cam_mask(sc, VR_VLAN_CAM, 1);
2084 }
2085
2086 /*
2087 * Set up receive filter.
2088 */
2089 vr_set_filter(sc);
2090
2091 /*
2092 * Load the address of the RX ring.
2093 */
2094 addr = VR_RX_RING_ADDR(sc, 0);
2095 CSR_WRITE_4(sc, VR_RXADDR, VR_ADDR_LO(addr));
2096 /*
2097 * Load the address of the TX ring.
2098 */
2099 addr = VR_TX_RING_ADDR(sc, 0);
2100 CSR_WRITE_4(sc, VR_TXADDR, VR_ADDR_LO(addr));
2101 /* Default : full-duplex, no Tx poll. */
2102 CSR_WRITE_1(sc, VR_CR1, VR_CR1_FULLDUPLEX | VR_CR1_TX_NOPOLL);
2103
2104 /* Set flow-control parameters for Rhine III. */
2105 if (sc->vr_revid >= REV_ID_VT6105_A0) {
2106 /*
2107 * Configure Rx buffer count available for incoming
2108 * packet.
2109 * Even though data sheet says almost nothing about
2110 * this register, this register should be updated
2111 * whenever driver adds new RX buffers to controller.
2112 * Otherwise, XON frame is not sent to link partner
2113 * even if controller has enough RX buffers and you
2114 * would be isolated from network.
2115 * The controller is not smart enough to know number
2116 * of available RX buffers so driver have to let
2117 * controller know how many RX buffers are posted.
2118 * In other words, this register works like a residue
2119 * counter for RX buffers and should be initialized
2120 * to the number of total RX buffers - 1 before
2121 * enabling RX MAC. Note, this register is 8bits so
2122 * it effectively limits the maximum number of RX
2123 * buffer to be configured by controller is 255.
2124 */
2125 CSR_WRITE_1(sc, VR_FLOWCR0, VR_RX_RING_CNT - 1);
2126 /*
2127 * Tx pause low threshold : 8 free receive buffers
2128 * Tx pause XON high threshold : 24 free receive buffers
2129 */
2130 CSR_WRITE_1(sc, VR_FLOWCR1,
2131 VR_FLOWCR1_TXLO8 | VR_FLOWCR1_TXHI24 | VR_FLOWCR1_XONXOFF);
2132 /* Set Tx pause timer. */
2133 CSR_WRITE_2(sc, VR_PAUSETIMER, 0xffff);
2134 }
2135
2136 /* Enable receiver and transmitter. */
2137 CSR_WRITE_1(sc, VR_CR0,
2138 VR_CR0_START | VR_CR0_TX_ON | VR_CR0_RX_ON | VR_CR0_RX_GO);
2139
2140 CSR_WRITE_2(sc, VR_ISR, 0xFFFF);
2141 #ifdef DEVICE_POLLING
2142 /*
2143 * Disable interrupts if we are polling.
2144 */
2145 if (ifp->if_capenable & IFCAP_POLLING)
2146 CSR_WRITE_2(sc, VR_IMR, 0);
2147 else
2148 #endif
2149 /*
2150 * Enable interrupts and disable MII intrs.
2151 */
2152 CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
2153 if (sc->vr_revid > REV_ID_VT6102_A)
2154 CSR_WRITE_2(sc, VR_MII_IMR, 0);
2155
2156 ifp->if_drv_flags |= IFF_DRV_RUNNING;
2157 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
2158
2159 sc->vr_flags &= ~(VR_F_LINK | VR_F_TXPAUSE);
2160 mii_mediachg(mii);
2161
2162 callout_reset(&sc->vr_stat_callout, hz, vr_tick, sc);
2163 }
2164
2165 /*
2166 * Set media options.
2167 */
2168 static int
2169 vr_ifmedia_upd(struct ifnet *ifp)
2170 {
2171 struct vr_softc *sc;
2172 struct mii_data *mii;
2173 struct mii_softc *miisc;
2174 int error;
2175
2176 sc = ifp->if_softc;
2177 VR_LOCK(sc);
2178 mii = device_get_softc(sc->vr_miibus);
2179 LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
2180 PHY_RESET(miisc);
2181 sc->vr_flags &= ~(VR_F_LINK | VR_F_TXPAUSE);
2182 error = mii_mediachg(mii);
2183 VR_UNLOCK(sc);
2184
2185 return (error);
2186 }
2187
2188 /*
2189 * Report current media status.
2190 */
2191 static void
2192 vr_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
2193 {
2194 struct vr_softc *sc;
2195 struct mii_data *mii;
2196
2197 sc = ifp->if_softc;
2198 mii = device_get_softc(sc->vr_miibus);
2199 VR_LOCK(sc);
2200 if ((ifp->if_flags & IFF_UP) == 0) {
2201 VR_UNLOCK(sc);
2202 return;
2203 }
2204 mii_pollstat(mii);
2205 ifmr->ifm_active = mii->mii_media_active;
2206 ifmr->ifm_status = mii->mii_media_status;
2207 VR_UNLOCK(sc);
2208 }
2209
2210 static int
2211 vr_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
2212 {
2213 struct vr_softc *sc;
2214 struct ifreq *ifr;
2215 struct mii_data *mii;
2216 int error, mask;
2217
2218 sc = ifp->if_softc;
2219 ifr = (struct ifreq *)data;
2220 error = 0;
2221
2222 switch (command) {
2223 case SIOCSIFFLAGS:
2224 VR_LOCK(sc);
2225 if (ifp->if_flags & IFF_UP) {
2226 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
2227 if ((ifp->if_flags ^ sc->vr_if_flags) &
2228 (IFF_PROMISC | IFF_ALLMULTI))
2229 vr_set_filter(sc);
2230 } else {
2231 if ((sc->vr_flags & VR_F_DETACHED) == 0)
2232 vr_init_locked(sc);
2233 }
2234 } else {
2235 if (ifp->if_drv_flags & IFF_DRV_RUNNING)
2236 vr_stop(sc);
2237 }
2238 sc->vr_if_flags = ifp->if_flags;
2239 VR_UNLOCK(sc);
2240 break;
2241 case SIOCADDMULTI:
2242 case SIOCDELMULTI:
2243 VR_LOCK(sc);
2244 vr_set_filter(sc);
2245 VR_UNLOCK(sc);
2246 break;
2247 case SIOCGIFMEDIA:
2248 case SIOCSIFMEDIA:
2249 mii = device_get_softc(sc->vr_miibus);
2250 error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
2251 break;
2252 case SIOCSIFCAP:
2253 mask = ifr->ifr_reqcap ^ ifp->if_capenable;
2254 #ifdef DEVICE_POLLING
2255 if (mask & IFCAP_POLLING) {
2256 if (ifr->ifr_reqcap & IFCAP_POLLING) {
2257 error = ether_poll_register(vr_poll, ifp);
2258 if (error != 0)
2259 break;
2260 VR_LOCK(sc);
2261 /* Disable interrupts. */
2262 CSR_WRITE_2(sc, VR_IMR, 0x0000);
2263 ifp->if_capenable |= IFCAP_POLLING;
2264 VR_UNLOCK(sc);
2265 } else {
2266 error = ether_poll_deregister(ifp);
2267 /* Enable interrupts. */
2268 VR_LOCK(sc);
2269 CSR_WRITE_2(sc, VR_IMR, VR_INTRS);
2270 ifp->if_capenable &= ~IFCAP_POLLING;
2271 VR_UNLOCK(sc);
2272 }
2273 }
2274 #endif /* DEVICE_POLLING */
2275 if ((mask & IFCAP_TXCSUM) != 0 &&
2276 (IFCAP_TXCSUM & ifp->if_capabilities) != 0) {
2277 ifp->if_capenable ^= IFCAP_TXCSUM;
2278 if ((IFCAP_TXCSUM & ifp->if_capenable) != 0)
2279 ifp->if_hwassist |= VR_CSUM_FEATURES;
2280 else
2281 ifp->if_hwassist &= ~VR_CSUM_FEATURES;
2282 }
2283 if ((mask & IFCAP_RXCSUM) != 0 &&
2284 (IFCAP_RXCSUM & ifp->if_capabilities) != 0)
2285 ifp->if_capenable ^= IFCAP_RXCSUM;
2286 if ((mask & IFCAP_WOL_UCAST) != 0 &&
2287 (ifp->if_capabilities & IFCAP_WOL_UCAST) != 0)
2288 ifp->if_capenable ^= IFCAP_WOL_UCAST;
2289 if ((mask & IFCAP_WOL_MAGIC) != 0 &&
2290 (ifp->if_capabilities & IFCAP_WOL_MAGIC) != 0)
2291 ifp->if_capenable ^= IFCAP_WOL_MAGIC;
2292 break;
2293 default:
2294 error = ether_ioctl(ifp, command, data);
2295 break;
2296 }
2297
2298 return (error);
2299 }
2300
2301 static void
2302 vr_watchdog(struct vr_softc *sc)
2303 {
2304 struct ifnet *ifp;
2305
2306 VR_LOCK_ASSERT(sc);
2307
2308 if (sc->vr_watchdog_timer == 0 || --sc->vr_watchdog_timer)
2309 return;
2310
2311 ifp = sc->vr_ifp;
2312 /*
2313 * Reclaim first as we don't request interrupt for every packets.
2314 */
2315 vr_txeof(sc);
2316 if (sc->vr_cdata.vr_tx_cnt == 0)
2317 return;
2318
2319 if ((sc->vr_flags & VR_F_LINK) == 0) {
2320 if (bootverbose)
2321 if_printf(sc->vr_ifp, "watchdog timeout "
2322 "(missed link)\n");
2323 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
2324 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
2325 vr_init_locked(sc);
2326 return;
2327 }
2328
2329 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
2330 if_printf(ifp, "watchdog timeout\n");
2331
2332 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
2333 vr_init_locked(sc);
2334
2335 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
2336 vr_start_locked(ifp);
2337 }
2338
2339 static void
2340 vr_tx_start(struct vr_softc *sc)
2341 {
2342 bus_addr_t addr;
2343 uint8_t cmd;
2344
2345 cmd = CSR_READ_1(sc, VR_CR0);
2346 if ((cmd & VR_CR0_TX_ON) == 0) {
2347 addr = VR_TX_RING_ADDR(sc, sc->vr_cdata.vr_tx_cons);
2348 CSR_WRITE_4(sc, VR_TXADDR, VR_ADDR_LO(addr));
2349 cmd |= VR_CR0_TX_ON;
2350 CSR_WRITE_1(sc, VR_CR0, cmd);
2351 }
2352 if (sc->vr_cdata.vr_tx_cnt != 0) {
2353 sc->vr_watchdog_timer = 5;
2354 VR_SETBIT(sc, VR_CR0, VR_CR0_TX_GO);
2355 }
2356 }
2357
2358 static void
2359 vr_rx_start(struct vr_softc *sc)
2360 {
2361 bus_addr_t addr;
2362 uint8_t cmd;
2363
2364 cmd = CSR_READ_1(sc, VR_CR0);
2365 if ((cmd & VR_CR0_RX_ON) == 0) {
2366 addr = VR_RX_RING_ADDR(sc, sc->vr_cdata.vr_rx_cons);
2367 CSR_WRITE_4(sc, VR_RXADDR, VR_ADDR_LO(addr));
2368 cmd |= VR_CR0_RX_ON;
2369 CSR_WRITE_1(sc, VR_CR0, cmd);
2370 }
2371 CSR_WRITE_1(sc, VR_CR0, cmd | VR_CR0_RX_GO);
2372 }
2373
2374 static int
2375 vr_tx_stop(struct vr_softc *sc)
2376 {
2377 int i;
2378 uint8_t cmd;
2379
2380 cmd = CSR_READ_1(sc, VR_CR0);
2381 if ((cmd & VR_CR0_TX_ON) != 0) {
2382 cmd &= ~VR_CR0_TX_ON;
2383 CSR_WRITE_1(sc, VR_CR0, cmd);
2384 for (i = VR_TIMEOUT; i > 0; i--) {
2385 DELAY(5);
2386 cmd = CSR_READ_1(sc, VR_CR0);
2387 if ((cmd & VR_CR0_TX_ON) == 0)
2388 break;
2389 }
2390 if (i == 0)
2391 return (ETIMEDOUT);
2392 }
2393 return (0);
2394 }
2395
2396 static int
2397 vr_rx_stop(struct vr_softc *sc)
2398 {
2399 int i;
2400 uint8_t cmd;
2401
2402 cmd = CSR_READ_1(sc, VR_CR0);
2403 if ((cmd & VR_CR0_RX_ON) != 0) {
2404 cmd &= ~VR_CR0_RX_ON;
2405 CSR_WRITE_1(sc, VR_CR0, cmd);
2406 for (i = VR_TIMEOUT; i > 0; i--) {
2407 DELAY(5);
2408 cmd = CSR_READ_1(sc, VR_CR0);
2409 if ((cmd & VR_CR0_RX_ON) == 0)
2410 break;
2411 }
2412 if (i == 0)
2413 return (ETIMEDOUT);
2414 }
2415 return (0);
2416 }
2417
2418 /*
2419 * Stop the adapter and free any mbufs allocated to the
2420 * RX and TX lists.
2421 */
2422 static void
2423 vr_stop(struct vr_softc *sc)
2424 {
2425 struct vr_txdesc *txd;
2426 struct vr_rxdesc *rxd;
2427 struct ifnet *ifp;
2428 int i;
2429
2430 VR_LOCK_ASSERT(sc);
2431
2432 ifp = sc->vr_ifp;
2433 sc->vr_watchdog_timer = 0;
2434
2435 callout_stop(&sc->vr_stat_callout);
2436 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2437
2438 CSR_WRITE_1(sc, VR_CR0, VR_CR0_STOP);
2439 if (vr_rx_stop(sc) != 0)
2440 device_printf(sc->vr_dev, "%s: Rx shutdown error\n", __func__);
2441 if (vr_tx_stop(sc) != 0)
2442 device_printf(sc->vr_dev, "%s: Tx shutdown error\n", __func__);
2443 /* Clear pending interrupts. */
2444 CSR_WRITE_2(sc, VR_ISR, 0xFFFF);
2445 CSR_WRITE_2(sc, VR_IMR, 0x0000);
2446 CSR_WRITE_4(sc, VR_TXADDR, 0x00000000);
2447 CSR_WRITE_4(sc, VR_RXADDR, 0x00000000);
2448
2449 /*
2450 * Free RX and TX mbufs still in the queues.
2451 */
2452 for (i = 0; i < VR_RX_RING_CNT; i++) {
2453 rxd = &sc->vr_cdata.vr_rxdesc[i];
2454 if (rxd->rx_m != NULL) {
2455 bus_dmamap_sync(sc->vr_cdata.vr_rx_tag,
2456 rxd->rx_dmamap, BUS_DMASYNC_POSTREAD);
2457 bus_dmamap_unload(sc->vr_cdata.vr_rx_tag,
2458 rxd->rx_dmamap);
2459 m_freem(rxd->rx_m);
2460 rxd->rx_m = NULL;
2461 }
2462 }
2463 for (i = 0; i < VR_TX_RING_CNT; i++) {
2464 txd = &sc->vr_cdata.vr_txdesc[i];
2465 if (txd->tx_m != NULL) {
2466 bus_dmamap_sync(sc->vr_cdata.vr_tx_tag,
2467 txd->tx_dmamap, BUS_DMASYNC_POSTWRITE);
2468 bus_dmamap_unload(sc->vr_cdata.vr_tx_tag,
2469 txd->tx_dmamap);
2470 m_freem(txd->tx_m);
2471 txd->tx_m = NULL;
2472 }
2473 }
2474 }
2475
2476 /*
2477 * Stop all chip I/O so that the kernel's probe routines don't
2478 * get confused by errant DMAs when rebooting.
2479 */
2480 static int
2481 vr_shutdown(device_t dev)
2482 {
2483
2484 return (vr_suspend(dev));
2485 }
2486
2487 static int
2488 vr_suspend(device_t dev)
2489 {
2490 struct vr_softc *sc;
2491
2492 sc = device_get_softc(dev);
2493
2494 VR_LOCK(sc);
2495 vr_stop(sc);
2496 vr_setwol(sc);
2497 sc->vr_flags |= VR_F_SUSPENDED;
2498 VR_UNLOCK(sc);
2499
2500 return (0);
2501 }
2502
2503 static int
2504 vr_resume(device_t dev)
2505 {
2506 struct vr_softc *sc;
2507 struct ifnet *ifp;
2508
2509 sc = device_get_softc(dev);
2510
2511 VR_LOCK(sc);
2512 ifp = sc->vr_ifp;
2513 vr_clrwol(sc);
2514 vr_reset(sc);
2515 if (ifp->if_flags & IFF_UP)
2516 vr_init_locked(sc);
2517
2518 sc->vr_flags &= ~VR_F_SUSPENDED;
2519 VR_UNLOCK(sc);
2520
2521 return (0);
2522 }
2523
2524 static void
2525 vr_setwol(struct vr_softc *sc)
2526 {
2527 struct ifnet *ifp;
2528 int pmc;
2529 uint16_t pmstat;
2530 uint8_t v;
2531
2532 VR_LOCK_ASSERT(sc);
2533
2534 if (sc->vr_revid < REV_ID_VT6102_A ||
2535 pci_find_cap(sc->vr_dev, PCIY_PMG, &pmc) != 0)
2536 return;
2537
2538 ifp = sc->vr_ifp;
2539
2540 /* Clear WOL configuration. */
2541 CSR_WRITE_1(sc, VR_WOLCR_CLR, 0xFF);
2542 CSR_WRITE_1(sc, VR_WOLCFG_CLR, VR_WOLCFG_SAB | VR_WOLCFG_SAM);
2543 CSR_WRITE_1(sc, VR_PWRCSR_CLR, 0xFF);
2544 CSR_WRITE_1(sc, VR_PWRCFG_CLR, VR_PWRCFG_WOLEN);
2545 if (sc->vr_revid > REV_ID_VT6105_B0) {
2546 /* Newer Rhine III supports two additional patterns. */
2547 CSR_WRITE_1(sc, VR_WOLCFG_CLR, VR_WOLCFG_PATTERN_PAGE);
2548 CSR_WRITE_1(sc, VR_TESTREG_CLR, 3);
2549 CSR_WRITE_1(sc, VR_PWRCSR1_CLR, 3);
2550 }
2551 if ((ifp->if_capenable & IFCAP_WOL_UCAST) != 0)
2552 CSR_WRITE_1(sc, VR_WOLCR_SET, VR_WOLCR_UCAST);
2553 if ((ifp->if_capenable & IFCAP_WOL_MAGIC) != 0)
2554 CSR_WRITE_1(sc, VR_WOLCR_SET, VR_WOLCR_MAGIC);
2555 /*
2556 * It seems that multicast wakeup frames require programming pattern
2557 * registers and valid CRC as well as pattern mask for each pattern.
2558 * While it's possible to setup such a pattern it would complicate
2559 * WOL configuration so ignore multicast wakeup frames.
2560 */
2561 if ((ifp->if_capenable & IFCAP_WOL) != 0) {
2562 CSR_WRITE_1(sc, VR_WOLCFG_SET, VR_WOLCFG_SAB | VR_WOLCFG_SAM);
2563 v = CSR_READ_1(sc, VR_STICKHW);
2564 CSR_WRITE_1(sc, VR_STICKHW, v | VR_STICKHW_WOL_ENB);
2565 CSR_WRITE_1(sc, VR_PWRCFG_SET, VR_PWRCFG_WOLEN);
2566 }
2567
2568 /* Put hardware into sleep. */
2569 v = CSR_READ_1(sc, VR_STICKHW);
2570 v |= VR_STICKHW_DS0 | VR_STICKHW_DS1;
2571 CSR_WRITE_1(sc, VR_STICKHW, v);
2572
2573 /* Request PME if WOL is requested. */
2574 pmstat = pci_read_config(sc->vr_dev, pmc + PCIR_POWER_STATUS, 2);
2575 pmstat &= ~(PCIM_PSTAT_PME | PCIM_PSTAT_PMEENABLE);
2576 if ((ifp->if_capenable & IFCAP_WOL) != 0)
2577 pmstat |= PCIM_PSTAT_PME | PCIM_PSTAT_PMEENABLE;
2578 pci_write_config(sc->vr_dev, pmc + PCIR_POWER_STATUS, pmstat, 2);
2579 }
2580
2581 static void
2582 vr_clrwol(struct vr_softc *sc)
2583 {
2584 uint8_t v;
2585
2586 VR_LOCK_ASSERT(sc);
2587
2588 if (sc->vr_revid < REV_ID_VT6102_A)
2589 return;
2590
2591 /* Take hardware out of sleep. */
2592 v = CSR_READ_1(sc, VR_STICKHW);
2593 v &= ~(VR_STICKHW_DS0 | VR_STICKHW_DS1 | VR_STICKHW_WOL_ENB);
2594 CSR_WRITE_1(sc, VR_STICKHW, v);
2595
2596 /* Clear WOL configuration as WOL may interfere normal operation. */
2597 CSR_WRITE_1(sc, VR_WOLCR_CLR, 0xFF);
2598 CSR_WRITE_1(sc, VR_WOLCFG_CLR,
2599 VR_WOLCFG_SAB | VR_WOLCFG_SAM | VR_WOLCFG_PMEOVR);
2600 CSR_WRITE_1(sc, VR_PWRCSR_CLR, 0xFF);
2601 CSR_WRITE_1(sc, VR_PWRCFG_CLR, VR_PWRCFG_WOLEN);
2602 if (sc->vr_revid > REV_ID_VT6105_B0) {
2603 /* Newer Rhine III supports two additional patterns. */
2604 CSR_WRITE_1(sc, VR_WOLCFG_CLR, VR_WOLCFG_PATTERN_PAGE);
2605 CSR_WRITE_1(sc, VR_TESTREG_CLR, 3);
2606 CSR_WRITE_1(sc, VR_PWRCSR1_CLR, 3);
2607 }
2608 }
2609
2610 static int
2611 vr_sysctl_stats(SYSCTL_HANDLER_ARGS)
2612 {
2613 struct vr_softc *sc;
2614 struct vr_statistics *stat;
2615 int error;
2616 int result;
2617
2618 result = -1;
2619 error = sysctl_handle_int(oidp, &result, 0, req);
2620
2621 if (error != 0 || req->newptr == NULL)
2622 return (error);
2623
2624 if (result == 1) {
2625 sc = (struct vr_softc *)arg1;
2626 stat = &sc->vr_stat;
2627
2628 printf("%s statistics:\n", device_get_nameunit(sc->vr_dev));
2629 printf("Outbound good frames : %ju\n",
2630 (uintmax_t)stat->tx_ok);
2631 printf("Inbound good frames : %ju\n",
2632 (uintmax_t)stat->rx_ok);
2633 printf("Outbound errors : %u\n", stat->tx_errors);
2634 printf("Inbound errors : %u\n", stat->rx_errors);
2635 printf("Inbound no buffers : %u\n", stat->rx_no_buffers);
2636 printf("Inbound no mbuf clusters: %d\n", stat->rx_no_mbufs);
2637 printf("Inbound FIFO overflows : %d\n",
2638 stat->rx_fifo_overflows);
2639 printf("Inbound CRC errors : %u\n", stat->rx_crc_errors);
2640 printf("Inbound frame alignment errors : %u\n",
2641 stat->rx_alignment);
2642 printf("Inbound giant frames : %u\n", stat->rx_giants);
2643 printf("Inbound runt frames : %u\n", stat->rx_runts);
2644 printf("Outbound aborted with excessive collisions : %u\n",
2645 stat->tx_abort);
2646 printf("Outbound collisions : %u\n", stat->tx_collisions);
2647 printf("Outbound late collisions : %u\n",
2648 stat->tx_late_collisions);
2649 printf("Outbound underrun : %u\n", stat->tx_underrun);
2650 printf("PCI bus errors : %u\n", stat->bus_errors);
2651 printf("driver restarted due to Rx/Tx shutdown failure : %u\n",
2652 stat->num_restart);
2653 }
2654
2655 return (error);
2656 }
Cache object: 98ba51be40d0da662538bf445c3932a6
|