FreeBSD/Linux Kernel Cross Reference
sys/dev/lge/if_lge.c
1 /*-
2 * SPDX-License-Identifier: BSD-4-Clause
3 *
4 * Copyright (c) 2001 Wind River Systems
5 * Copyright (c) 1997, 1998, 1999, 2000, 2001
6 * Bill Paul <william.paul@windriver.com>. All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by Bill Paul.
19 * 4. Neither the name of the author nor the names of any co-contributors
20 * may be used to endorse or promote products derived from this software
21 * without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
27 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
33 * THE POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 #include <sys/cdefs.h>
37 __FBSDID("$FreeBSD$");
38
39 /*
40 * Level 1 LXT1001 gigabit ethernet driver for FreeBSD. Public
41 * documentation not available, but ask me nicely.
42 *
43 * The Level 1 chip is used on some D-Link, SMC and Addtron NICs.
44 * It's a 64-bit PCI part that supports TCP/IP checksum offload,
45 * VLAN tagging/insertion, GMII and TBI (1000baseX) ports. There
46 * are three supported methods for data transfer between host and
47 * NIC: programmed I/O, traditional scatter/gather DMA and Packet
48 * Propulsion Technology (tm) DMA. The latter mechanism is a form
49 * of double buffer DMA where the packet data is copied to a
50 * pre-allocated DMA buffer who's physical address has been loaded
51 * into a table at device initialization time. The rationale is that
52 * the virtual to physical address translation needed for normal
53 * scatter/gather DMA is more expensive than the data copy needed
54 * for double buffering. This may be true in Windows NT and the like,
55 * but it isn't true for us, at least on the x86 arch. This driver
56 * uses the scatter/gather I/O method for both TX and RX.
57 *
58 * The LXT1001 only supports TCP/IP checksum offload on receive.
59 * Also, the VLAN tagging is done using a 16-entry table which allows
60 * the chip to perform hardware filtering based on VLAN tags. Sadly,
61 * our vlan support doesn't currently play well with this kind of
62 * hardware support.
63 *
64 * Special thanks to:
65 * - Jeff James at Intel, for arranging to have the LXT1001 manual
66 * released (at long last)
67 * - Beny Chen at D-Link, for actually sending it to me
68 * - Brad Short and Keith Alexis at SMC, for sending me sample
69 * SMC9462SX and SMC9462TX adapters for testing
70 * - Paul Saab at Y!, for not killing me (though it remains to be seen
71 * if in fact he did me much of a favor)
72 */
73
74 #include <sys/param.h>
75 #include <sys/systm.h>
76 #include <sys/sockio.h>
77 #include <sys/mbuf.h>
78 #include <sys/malloc.h>
79 #include <sys/kernel.h>
80 #include <sys/module.h>
81 #include <sys/socket.h>
82
83 #include <net/if.h>
84 #include <net/if_var.h>
85 #include <net/if_arp.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
91 #include <net/bpf.h>
92
93 #include <vm/vm.h> /* for vtophys */
94 #include <vm/pmap.h> /* for vtophys */
95 #include <machine/bus.h>
96 #include <machine/resource.h>
97 #include <sys/bus.h>
98 #include <sys/rman.h>
99
100 #include <dev/mii/mii.h>
101 #include <dev/mii/miivar.h>
102
103 #include <dev/pci/pcireg.h>
104 #include <dev/pci/pcivar.h>
105
106 #define LGE_USEIOSPACE
107
108 #include <dev/lge/if_lgereg.h>
109
110 /* "device miibus" required. See GENERIC if you get errors here. */
111 #include "miibus_if.h"
112
113 /*
114 * Various supported device vendors/types and their names.
115 */
116 static const struct lge_type lge_devs[] = {
117 { LGE_VENDORID, LGE_DEVICEID, "Level 1 Gigabit Ethernet" },
118 { 0, 0, NULL }
119 };
120
121 static int lge_probe(device_t);
122 static int lge_attach(device_t);
123 static int lge_detach(device_t);
124
125 static int lge_alloc_jumbo_mem(struct lge_softc *);
126 static void lge_free_jumbo_mem(struct lge_softc *);
127 static void *lge_jalloc(struct lge_softc *);
128 static void lge_jfree(struct mbuf *);
129
130 static int lge_newbuf(struct lge_softc *, struct lge_rx_desc *, struct mbuf *);
131 static int lge_encap(struct lge_softc *, struct mbuf *, u_int32_t *);
132 static void lge_rxeof(struct lge_softc *, int);
133 static void lge_rxeoc(struct lge_softc *);
134 static void lge_txeof(struct lge_softc *);
135 static void lge_intr(void *);
136 static void lge_tick(void *);
137 static void lge_start(struct ifnet *);
138 static void lge_start_locked(struct ifnet *);
139 static int lge_ioctl(struct ifnet *, u_long, caddr_t);
140 static void lge_init(void *);
141 static void lge_init_locked(struct lge_softc *);
142 static void lge_stop(struct lge_softc *);
143 static void lge_watchdog(struct lge_softc *);
144 static int lge_shutdown(device_t);
145 static int lge_ifmedia_upd(struct ifnet *);
146 static void lge_ifmedia_upd_locked(struct ifnet *);
147 static void lge_ifmedia_sts(struct ifnet *, struct ifmediareq *);
148
149 static void lge_eeprom_getword(struct lge_softc *, int, u_int16_t *);
150 static void lge_read_eeprom(struct lge_softc *, caddr_t, int, int, int);
151
152 static int lge_miibus_readreg(device_t, int, int);
153 static int lge_miibus_writereg(device_t, int, int, int);
154 static void lge_miibus_statchg(device_t);
155
156 static void lge_setmulti(struct lge_softc *);
157 static void lge_reset(struct lge_softc *);
158 static int lge_list_rx_init(struct lge_softc *);
159 static int lge_list_tx_init(struct lge_softc *);
160
161 #ifdef LGE_USEIOSPACE
162 #define LGE_RES SYS_RES_IOPORT
163 #define LGE_RID LGE_PCI_LOIO
164 #else
165 #define LGE_RES SYS_RES_MEMORY
166 #define LGE_RID LGE_PCI_LOMEM
167 #endif
168
169 static device_method_t lge_methods[] = {
170 /* Device interface */
171 DEVMETHOD(device_probe, lge_probe),
172 DEVMETHOD(device_attach, lge_attach),
173 DEVMETHOD(device_detach, lge_detach),
174 DEVMETHOD(device_shutdown, lge_shutdown),
175
176 /* MII interface */
177 DEVMETHOD(miibus_readreg, lge_miibus_readreg),
178 DEVMETHOD(miibus_writereg, lge_miibus_writereg),
179 DEVMETHOD(miibus_statchg, lge_miibus_statchg),
180
181 DEVMETHOD_END
182 };
183
184 static driver_t lge_driver = {
185 "lge",
186 lge_methods,
187 sizeof(struct lge_softc)
188 };
189
190 DRIVER_MODULE(lge, pci, lge_driver, 0, 0);
191 DRIVER_MODULE(miibus, lge, miibus_driver, 0, 0);
192 MODULE_DEPEND(lge, pci, 1, 1, 1);
193 MODULE_DEPEND(lge, ether, 1, 1, 1);
194 MODULE_DEPEND(lge, miibus, 1, 1, 1);
195
196 #define LGE_SETBIT(sc, reg, x) \
197 CSR_WRITE_4(sc, reg, \
198 CSR_READ_4(sc, reg) | (x))
199
200 #define LGE_CLRBIT(sc, reg, x) \
201 CSR_WRITE_4(sc, reg, \
202 CSR_READ_4(sc, reg) & ~(x))
203
204 #define SIO_SET(x) \
205 CSR_WRITE_4(sc, LGE_MEAR, CSR_READ_4(sc, LGE_MEAR) | x)
206
207 #define SIO_CLR(x) \
208 CSR_WRITE_4(sc, LGE_MEAR, CSR_READ_4(sc, LGE_MEAR) & ~x)
209
210 /*
211 * Read a word of data stored in the EEPROM at address 'addr.'
212 */
213 static void
214 lge_eeprom_getword(sc, addr, dest)
215 struct lge_softc *sc;
216 int addr;
217 u_int16_t *dest;
218 {
219 int i;
220 u_int32_t val;
221
222 CSR_WRITE_4(sc, LGE_EECTL, LGE_EECTL_CMD_READ|
223 LGE_EECTL_SINGLEACCESS|((addr >> 1) << 8));
224
225 for (i = 0; i < LGE_TIMEOUT; i++)
226 if (!(CSR_READ_4(sc, LGE_EECTL) & LGE_EECTL_CMD_READ))
227 break;
228
229 if (i == LGE_TIMEOUT) {
230 device_printf(sc->lge_dev, "EEPROM read timed out\n");
231 return;
232 }
233
234 val = CSR_READ_4(sc, LGE_EEDATA);
235
236 if (addr & 1)
237 *dest = (val >> 16) & 0xFFFF;
238 else
239 *dest = val & 0xFFFF;
240
241 return;
242 }
243
244 /*
245 * Read a sequence of words from the EEPROM.
246 */
247 static void
248 lge_read_eeprom(sc, dest, off, cnt, swap)
249 struct lge_softc *sc;
250 caddr_t dest;
251 int off;
252 int cnt;
253 int swap;
254 {
255 int i;
256 u_int16_t word = 0, *ptr;
257
258 for (i = 0; i < cnt; i++) {
259 lge_eeprom_getword(sc, off + i, &word);
260 ptr = (u_int16_t *)(dest + (i * 2));
261 if (swap)
262 *ptr = ntohs(word);
263 else
264 *ptr = word;
265 }
266
267 return;
268 }
269
270 static int
271 lge_miibus_readreg(dev, phy, reg)
272 device_t dev;
273 int phy, reg;
274 {
275 struct lge_softc *sc;
276 int i;
277
278 sc = device_get_softc(dev);
279
280 /*
281 * If we have a non-PCS PHY, pretend that the internal
282 * autoneg stuff at PHY address 0 isn't there so that
283 * the miibus code will find only the GMII PHY.
284 */
285 if (sc->lge_pcs == 0 && phy == 0)
286 return(0);
287
288 CSR_WRITE_4(sc, LGE_GMIICTL, (phy << 8) | reg | LGE_GMIICMD_READ);
289
290 for (i = 0; i < LGE_TIMEOUT; i++)
291 if (!(CSR_READ_4(sc, LGE_GMIICTL) & LGE_GMIICTL_CMDBUSY))
292 break;
293
294 if (i == LGE_TIMEOUT) {
295 device_printf(sc->lge_dev, "PHY read timed out\n");
296 return(0);
297 }
298
299 return(CSR_READ_4(sc, LGE_GMIICTL) >> 16);
300 }
301
302 static int
303 lge_miibus_writereg(dev, phy, reg, data)
304 device_t dev;
305 int phy, reg, data;
306 {
307 struct lge_softc *sc;
308 int i;
309
310 sc = device_get_softc(dev);
311
312 CSR_WRITE_4(sc, LGE_GMIICTL,
313 (data << 16) | (phy << 8) | reg | LGE_GMIICMD_WRITE);
314
315 for (i = 0; i < LGE_TIMEOUT; i++)
316 if (!(CSR_READ_4(sc, LGE_GMIICTL) & LGE_GMIICTL_CMDBUSY))
317 break;
318
319 if (i == LGE_TIMEOUT) {
320 device_printf(sc->lge_dev, "PHY write timed out\n");
321 return(0);
322 }
323
324 return(0);
325 }
326
327 static void
328 lge_miibus_statchg(dev)
329 device_t dev;
330 {
331 struct lge_softc *sc;
332 struct mii_data *mii;
333
334 sc = device_get_softc(dev);
335 mii = device_get_softc(sc->lge_miibus);
336
337 LGE_CLRBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_SPEED);
338 switch (IFM_SUBTYPE(mii->mii_media_active)) {
339 case IFM_1000_T:
340 case IFM_1000_SX:
341 LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_1000);
342 break;
343 case IFM_100_TX:
344 LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_100);
345 break;
346 case IFM_10_T:
347 LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_10);
348 break;
349 default:
350 /*
351 * Choose something, even if it's wrong. Clearing
352 * all the bits will hose autoneg on the internal
353 * PHY.
354 */
355 LGE_SETBIT(sc, LGE_GMIIMODE, LGE_SPEED_1000);
356 break;
357 }
358
359 if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX) {
360 LGE_SETBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_FDX);
361 } else {
362 LGE_CLRBIT(sc, LGE_GMIIMODE, LGE_GMIIMODE_FDX);
363 }
364
365 return;
366 }
367
368 static u_int
369 lge_hash_maddr(void *arg, struct sockaddr_dl *sdl, u_int count)
370 {
371 uint32_t h, *hashes = arg;
372
373 h = ether_crc32_be(LLADDR(sdl), ETHER_ADDR_LEN) >> 26;
374 if (h < 32)
375 hashes[0] |= (1 << h);
376 else
377 hashes[1] |= (1 << (h - 32));
378 return (1);
379 }
380
381 static void
382 lge_setmulti(sc)
383 struct lge_softc *sc;
384 {
385 struct ifnet *ifp;
386 uint32_t hashes[2] = { 0, 0 };
387
388 ifp = sc->lge_ifp;
389 LGE_LOCK_ASSERT(sc);
390
391 /* Make sure multicast hash table is enabled. */
392 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_RX_MCAST);
393
394 if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) {
395 CSR_WRITE_4(sc, LGE_MAR0, 0xFFFFFFFF);
396 CSR_WRITE_4(sc, LGE_MAR1, 0xFFFFFFFF);
397 return;
398 }
399
400 /* first, zot all the existing hash bits */
401 CSR_WRITE_4(sc, LGE_MAR0, 0);
402 CSR_WRITE_4(sc, LGE_MAR1, 0);
403
404 /* now program new ones */
405 if_foreach_llmaddr(ifp, lge_hash_maddr, hashes);
406
407 CSR_WRITE_4(sc, LGE_MAR0, hashes[0]);
408 CSR_WRITE_4(sc, LGE_MAR1, hashes[1]);
409
410 return;
411 }
412
413 static void
414 lge_reset(sc)
415 struct lge_softc *sc;
416 {
417 int i;
418
419 LGE_SETBIT(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL0|LGE_MODE1_SOFTRST);
420
421 for (i = 0; i < LGE_TIMEOUT; i++) {
422 if (!(CSR_READ_4(sc, LGE_MODE1) & LGE_MODE1_SOFTRST))
423 break;
424 }
425
426 if (i == LGE_TIMEOUT)
427 device_printf(sc->lge_dev, "reset never completed\n");
428
429 /* Wait a little while for the chip to get its brains in order. */
430 DELAY(1000);
431
432 return;
433 }
434
435 /*
436 * Probe for a Level 1 chip. Check the PCI vendor and device
437 * IDs against our list and return a device name if we find a match.
438 */
439 static int
440 lge_probe(dev)
441 device_t dev;
442 {
443 const struct lge_type *t;
444
445 t = lge_devs;
446
447 while(t->lge_name != NULL) {
448 if ((pci_get_vendor(dev) == t->lge_vid) &&
449 (pci_get_device(dev) == t->lge_did)) {
450 device_set_desc(dev, t->lge_name);
451 return(BUS_PROBE_DEFAULT);
452 }
453 t++;
454 }
455
456 return(ENXIO);
457 }
458
459 /*
460 * Attach the interface. Allocate softc structures, do ifmedia
461 * setup and ethernet/BPF attach.
462 */
463 static int
464 lge_attach(dev)
465 device_t dev;
466 {
467 u_char eaddr[ETHER_ADDR_LEN];
468 struct lge_softc *sc;
469 struct ifnet *ifp = NULL;
470 int error = 0, rid;
471
472 sc = device_get_softc(dev);
473 sc->lge_dev = dev;
474
475 mtx_init(&sc->lge_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
476 MTX_DEF);
477 callout_init_mtx(&sc->lge_stat_callout, &sc->lge_mtx, 0);
478
479 /*
480 * Map control/status registers.
481 */
482 pci_enable_busmaster(dev);
483
484 rid = LGE_RID;
485 sc->lge_res = bus_alloc_resource_any(dev, LGE_RES, &rid, RF_ACTIVE);
486
487 if (sc->lge_res == NULL) {
488 device_printf(dev, "couldn't map ports/memory\n");
489 error = ENXIO;
490 goto fail;
491 }
492
493 sc->lge_btag = rman_get_bustag(sc->lge_res);
494 sc->lge_bhandle = rman_get_bushandle(sc->lge_res);
495
496 /* Allocate interrupt */
497 rid = 0;
498 sc->lge_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
499 RF_SHAREABLE | RF_ACTIVE);
500
501 if (sc->lge_irq == NULL) {
502 device_printf(dev, "couldn't map interrupt\n");
503 error = ENXIO;
504 goto fail;
505 }
506
507 /* Reset the adapter. */
508 lge_reset(sc);
509
510 /*
511 * Get station address from the EEPROM.
512 */
513 lge_read_eeprom(sc, (caddr_t)&eaddr[0], LGE_EE_NODEADDR_0, 1, 0);
514 lge_read_eeprom(sc, (caddr_t)&eaddr[2], LGE_EE_NODEADDR_1, 1, 0);
515 lge_read_eeprom(sc, (caddr_t)&eaddr[4], LGE_EE_NODEADDR_2, 1, 0);
516
517 sc->lge_ldata = contigmalloc(sizeof(struct lge_list_data), M_DEVBUF,
518 M_NOWAIT | M_ZERO, 0, 0xffffffff, PAGE_SIZE, 0);
519
520 if (sc->lge_ldata == NULL) {
521 device_printf(dev, "no memory for list buffers!\n");
522 error = ENXIO;
523 goto fail;
524 }
525
526 /* Try to allocate memory for jumbo buffers. */
527 if (lge_alloc_jumbo_mem(sc)) {
528 device_printf(dev, "jumbo buffer allocation failed\n");
529 error = ENXIO;
530 goto fail;
531 }
532
533 ifp = sc->lge_ifp = if_alloc(IFT_ETHER);
534 if (ifp == NULL) {
535 device_printf(dev, "can not if_alloc()\n");
536 error = ENOSPC;
537 goto fail;
538 }
539 ifp->if_softc = sc;
540 if_initname(ifp, device_get_name(dev), device_get_unit(dev));
541 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
542 ifp->if_ioctl = lge_ioctl;
543 ifp->if_start = lge_start;
544 ifp->if_init = lge_init;
545 ifp->if_snd.ifq_maxlen = LGE_TX_LIST_CNT - 1;
546 ifp->if_capabilities = IFCAP_RXCSUM;
547 ifp->if_capenable = ifp->if_capabilities;
548
549 if (CSR_READ_4(sc, LGE_GMIIMODE) & LGE_GMIIMODE_PCSENH)
550 sc->lge_pcs = 1;
551 else
552 sc->lge_pcs = 0;
553
554 /*
555 * Do MII setup.
556 */
557 error = mii_attach(dev, &sc->lge_miibus, ifp, lge_ifmedia_upd,
558 lge_ifmedia_sts, BMSR_DEFCAPMASK, MII_PHY_ANY, MII_OFFSET_ANY, 0);
559 if (error != 0) {
560 device_printf(dev, "attaching PHYs failed\n");
561 goto fail;
562 }
563
564 /*
565 * Call MI attach routine.
566 */
567 ether_ifattach(ifp, eaddr);
568
569 error = bus_setup_intr(dev, sc->lge_irq, INTR_TYPE_NET | INTR_MPSAFE,
570 NULL, lge_intr, sc, &sc->lge_intrhand);
571
572 if (error) {
573 ether_ifdetach(ifp);
574 device_printf(dev, "couldn't set up irq\n");
575 goto fail;
576 }
577 return (0);
578
579 fail:
580 lge_free_jumbo_mem(sc);
581 if (sc->lge_ldata)
582 contigfree(sc->lge_ldata,
583 sizeof(struct lge_list_data), M_DEVBUF);
584 if (ifp)
585 if_free(ifp);
586 if (sc->lge_irq)
587 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->lge_irq);
588 if (sc->lge_res)
589 bus_release_resource(dev, LGE_RES, LGE_RID, sc->lge_res);
590 mtx_destroy(&sc->lge_mtx);
591 return(error);
592 }
593
594 static int
595 lge_detach(dev)
596 device_t dev;
597 {
598 struct lge_softc *sc;
599 struct ifnet *ifp;
600
601 sc = device_get_softc(dev);
602 ifp = sc->lge_ifp;
603
604 LGE_LOCK(sc);
605 lge_reset(sc);
606 lge_stop(sc);
607 LGE_UNLOCK(sc);
608 callout_drain(&sc->lge_stat_callout);
609 ether_ifdetach(ifp);
610
611 bus_generic_detach(dev);
612 device_delete_child(dev, sc->lge_miibus);
613
614 bus_teardown_intr(dev, sc->lge_irq, sc->lge_intrhand);
615 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->lge_irq);
616 bus_release_resource(dev, LGE_RES, LGE_RID, sc->lge_res);
617
618 contigfree(sc->lge_ldata, sizeof(struct lge_list_data), M_DEVBUF);
619 if_free(ifp);
620 lge_free_jumbo_mem(sc);
621 mtx_destroy(&sc->lge_mtx);
622
623 return(0);
624 }
625
626 /*
627 * Initialize the transmit descriptors.
628 */
629 static int
630 lge_list_tx_init(sc)
631 struct lge_softc *sc;
632 {
633 struct lge_list_data *ld;
634 struct lge_ring_data *cd;
635 int i;
636
637 cd = &sc->lge_cdata;
638 ld = sc->lge_ldata;
639 for (i = 0; i < LGE_TX_LIST_CNT; i++) {
640 ld->lge_tx_list[i].lge_mbuf = NULL;
641 ld->lge_tx_list[i].lge_ctl = 0;
642 }
643
644 cd->lge_tx_prod = cd->lge_tx_cons = 0;
645
646 return(0);
647 }
648
649
650 /*
651 * Initialize the RX descriptors and allocate mbufs for them. Note that
652 * we arralge the descriptors in a closed ring, so that the last descriptor
653 * points back to the first.
654 */
655 static int
656 lge_list_rx_init(sc)
657 struct lge_softc *sc;
658 {
659 struct lge_list_data *ld;
660 struct lge_ring_data *cd;
661 int i;
662
663 ld = sc->lge_ldata;
664 cd = &sc->lge_cdata;
665
666 cd->lge_rx_prod = cd->lge_rx_cons = 0;
667
668 CSR_WRITE_4(sc, LGE_RXDESC_ADDR_HI, 0);
669
670 for (i = 0; i < LGE_RX_LIST_CNT; i++) {
671 if (CSR_READ_1(sc, LGE_RXCMDFREE_8BIT) == 0)
672 break;
673 if (lge_newbuf(sc, &ld->lge_rx_list[i], NULL) == ENOBUFS)
674 return(ENOBUFS);
675 }
676
677 /* Clear possible 'rx command queue empty' interrupt. */
678 CSR_READ_4(sc, LGE_ISR);
679
680 return(0);
681 }
682
683 /*
684 * Initialize an RX descriptor and attach an MBUF cluster.
685 */
686 static int
687 lge_newbuf(sc, c, m)
688 struct lge_softc *sc;
689 struct lge_rx_desc *c;
690 struct mbuf *m;
691 {
692 struct mbuf *m_new = NULL;
693 char *buf = NULL;
694
695 if (m == NULL) {
696 MGETHDR(m_new, M_NOWAIT, MT_DATA);
697 if (m_new == NULL) {
698 device_printf(sc->lge_dev, "no memory for rx list "
699 "-- packet dropped!\n");
700 return(ENOBUFS);
701 }
702
703 /* Allocate the jumbo buffer */
704 buf = lge_jalloc(sc);
705 if (buf == NULL) {
706 #ifdef LGE_VERBOSE
707 device_printf(sc->lge_dev, "jumbo allocation failed "
708 "-- packet dropped!\n");
709 #endif
710 m_freem(m_new);
711 return(ENOBUFS);
712 }
713 /* Attach the buffer to the mbuf */
714 m_new->m_len = m_new->m_pkthdr.len = LGE_JUMBO_FRAMELEN;
715 m_extadd(m_new, buf, LGE_JUMBO_FRAMELEN, lge_jfree, sc, NULL,
716 0, EXT_NET_DRV);
717 } else {
718 m_new = m;
719 m_new->m_len = m_new->m_pkthdr.len = LGE_JUMBO_FRAMELEN;
720 m_new->m_data = m_new->m_ext.ext_buf;
721 }
722
723 /*
724 * Adjust alignment so packet payload begins on a
725 * longword boundary. Mandatory for Alpha, useful on
726 * x86 too.
727 */
728 m_adj(m_new, ETHER_ALIGN);
729
730 c->lge_mbuf = m_new;
731 c->lge_fragptr_hi = 0;
732 c->lge_fragptr_lo = vtophys(mtod(m_new, caddr_t));
733 c->lge_fraglen = m_new->m_len;
734 c->lge_ctl = m_new->m_len | LGE_RXCTL_WANTINTR | LGE_FRAGCNT(1);
735 c->lge_sts = 0;
736
737 /*
738 * Put this buffer in the RX command FIFO. To do this,
739 * we just write the physical address of the descriptor
740 * into the RX descriptor address registers. Note that
741 * there are two registers, one high DWORD and one low
742 * DWORD, which lets us specify a 64-bit address if
743 * desired. We only use a 32-bit address for now.
744 * Writing to the low DWORD register is what actually
745 * causes the command to be issued, so we do that
746 * last.
747 */
748 CSR_WRITE_4(sc, LGE_RXDESC_ADDR_LO, vtophys(c));
749 LGE_INC(sc->lge_cdata.lge_rx_prod, LGE_RX_LIST_CNT);
750
751 return(0);
752 }
753
754 static int
755 lge_alloc_jumbo_mem(sc)
756 struct lge_softc *sc;
757 {
758 caddr_t ptr;
759 int i;
760 struct lge_jpool_entry *entry;
761
762 /* Grab a big chunk o' storage. */
763 sc->lge_cdata.lge_jumbo_buf = contigmalloc(LGE_JMEM, M_DEVBUF,
764 M_NOWAIT, 0, 0xffffffff, PAGE_SIZE, 0);
765
766 if (sc->lge_cdata.lge_jumbo_buf == NULL) {
767 device_printf(sc->lge_dev, "no memory for jumbo buffers!\n");
768 return(ENOBUFS);
769 }
770
771 SLIST_INIT(&sc->lge_jfree_listhead);
772 SLIST_INIT(&sc->lge_jinuse_listhead);
773
774 /*
775 * Now divide it up into 9K pieces and save the addresses
776 * in an array.
777 */
778 ptr = sc->lge_cdata.lge_jumbo_buf;
779 for (i = 0; i < LGE_JSLOTS; i++) {
780 sc->lge_cdata.lge_jslots[i] = ptr;
781 ptr += LGE_JLEN;
782 entry = malloc(sizeof(struct lge_jpool_entry),
783 M_DEVBUF, M_NOWAIT);
784 if (entry == NULL) {
785 device_printf(sc->lge_dev, "no memory for jumbo "
786 "buffer queue!\n");
787 return(ENOBUFS);
788 }
789 entry->slot = i;
790 SLIST_INSERT_HEAD(&sc->lge_jfree_listhead,
791 entry, jpool_entries);
792 }
793
794 return(0);
795 }
796
797 static void
798 lge_free_jumbo_mem(sc)
799 struct lge_softc *sc;
800 {
801 struct lge_jpool_entry *entry;
802
803 if (sc->lge_cdata.lge_jumbo_buf == NULL)
804 return;
805
806 while ((entry = SLIST_FIRST(&sc->lge_jinuse_listhead))) {
807 device_printf(sc->lge_dev,
808 "asked to free buffer that is in use!\n");
809 SLIST_REMOVE_HEAD(&sc->lge_jinuse_listhead, jpool_entries);
810 SLIST_INSERT_HEAD(&sc->lge_jfree_listhead, entry,
811 jpool_entries);
812 }
813 while (!SLIST_EMPTY(&sc->lge_jfree_listhead)) {
814 entry = SLIST_FIRST(&sc->lge_jfree_listhead);
815 SLIST_REMOVE_HEAD(&sc->lge_jfree_listhead, jpool_entries);
816 free(entry, M_DEVBUF);
817 }
818
819 contigfree(sc->lge_cdata.lge_jumbo_buf, LGE_JMEM, M_DEVBUF);
820
821 return;
822 }
823
824 /*
825 * Allocate a jumbo buffer.
826 */
827 static void *
828 lge_jalloc(sc)
829 struct lge_softc *sc;
830 {
831 struct lge_jpool_entry *entry;
832
833 entry = SLIST_FIRST(&sc->lge_jfree_listhead);
834
835 if (entry == NULL) {
836 #ifdef LGE_VERBOSE
837 device_printf(sc->lge_dev, "no free jumbo buffers\n");
838 #endif
839 return(NULL);
840 }
841
842 SLIST_REMOVE_HEAD(&sc->lge_jfree_listhead, jpool_entries);
843 SLIST_INSERT_HEAD(&sc->lge_jinuse_listhead, entry, jpool_entries);
844 return(sc->lge_cdata.lge_jslots[entry->slot]);
845 }
846
847 /*
848 * Release a jumbo buffer.
849 */
850 static void
851 lge_jfree(struct mbuf *m)
852 {
853 struct lge_softc *sc;
854 int i;
855 struct lge_jpool_entry *entry;
856
857 /* Extract the softc struct pointer. */
858 sc = m->m_ext.ext_arg1;
859
860 if (sc == NULL)
861 panic("lge_jfree: can't find softc pointer!");
862
863 /* calculate the slot this buffer belongs to */
864 i = ((vm_offset_t)m->m_ext.ext_buf
865 - (vm_offset_t)sc->lge_cdata.lge_jumbo_buf) / LGE_JLEN;
866
867 if ((i < 0) || (i >= LGE_JSLOTS))
868 panic("lge_jfree: asked to free buffer that we don't manage!");
869
870 entry = SLIST_FIRST(&sc->lge_jinuse_listhead);
871 if (entry == NULL)
872 panic("lge_jfree: buffer not in use!");
873 entry->slot = i;
874 SLIST_REMOVE_HEAD(&sc->lge_jinuse_listhead, jpool_entries);
875 SLIST_INSERT_HEAD(&sc->lge_jfree_listhead, entry, jpool_entries);
876 }
877
878 /*
879 * A frame has been uploaded: pass the resulting mbuf chain up to
880 * the higher level protocols.
881 */
882 static void
883 lge_rxeof(sc, cnt)
884 struct lge_softc *sc;
885 int cnt;
886 {
887 struct mbuf *m;
888 struct ifnet *ifp;
889 struct lge_rx_desc *cur_rx;
890 int c, i, total_len = 0;
891 u_int32_t rxsts, rxctl;
892
893 ifp = sc->lge_ifp;
894
895 /* Find out how many frames were processed. */
896 c = cnt;
897 i = sc->lge_cdata.lge_rx_cons;
898
899 /* Suck them in. */
900 while(c) {
901 struct mbuf *m0 = NULL;
902
903 cur_rx = &sc->lge_ldata->lge_rx_list[i];
904 rxctl = cur_rx->lge_ctl;
905 rxsts = cur_rx->lge_sts;
906 m = cur_rx->lge_mbuf;
907 cur_rx->lge_mbuf = NULL;
908 total_len = LGE_RXBYTES(cur_rx);
909 LGE_INC(i, LGE_RX_LIST_CNT);
910 c--;
911
912 /*
913 * If an error occurs, update stats, clear the
914 * status word and leave the mbuf cluster in place:
915 * it should simply get re-used next time this descriptor
916 * comes up in the ring.
917 */
918 if (rxctl & LGE_RXCTL_ERRMASK) {
919 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
920 lge_newbuf(sc, &LGE_RXTAIL(sc), m);
921 continue;
922 }
923
924 if (lge_newbuf(sc, &LGE_RXTAIL(sc), NULL) == ENOBUFS) {
925 m0 = m_devget(mtod(m, char *), total_len, ETHER_ALIGN,
926 ifp, NULL);
927 lge_newbuf(sc, &LGE_RXTAIL(sc), m);
928 if (m0 == NULL) {
929 device_printf(sc->lge_dev, "no receive buffers "
930 "available -- packet dropped!\n");
931 if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
932 continue;
933 }
934 m = m0;
935 } else {
936 m->m_pkthdr.rcvif = ifp;
937 m->m_pkthdr.len = m->m_len = total_len;
938 }
939
940 if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1);
941
942 /* Do IP checksum checking. */
943 if (rxsts & LGE_RXSTS_ISIP)
944 m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED;
945 if (!(rxsts & LGE_RXSTS_IPCSUMERR))
946 m->m_pkthdr.csum_flags |= CSUM_IP_VALID;
947 if ((rxsts & LGE_RXSTS_ISTCP &&
948 !(rxsts & LGE_RXSTS_TCPCSUMERR)) ||
949 (rxsts & LGE_RXSTS_ISUDP &&
950 !(rxsts & LGE_RXSTS_UDPCSUMERR))) {
951 m->m_pkthdr.csum_flags |=
952 CSUM_DATA_VALID|CSUM_PSEUDO_HDR;
953 m->m_pkthdr.csum_data = 0xffff;
954 }
955
956 LGE_UNLOCK(sc);
957 (*ifp->if_input)(ifp, m);
958 LGE_LOCK(sc);
959 }
960
961 sc->lge_cdata.lge_rx_cons = i;
962
963 return;
964 }
965
966 static void
967 lge_rxeoc(sc)
968 struct lge_softc *sc;
969 {
970 struct ifnet *ifp;
971
972 ifp = sc->lge_ifp;
973 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
974 lge_init_locked(sc);
975 return;
976 }
977
978 /*
979 * A frame was downloaded to the chip. It's safe for us to clean up
980 * the list buffers.
981 */
982
983 static void
984 lge_txeof(sc)
985 struct lge_softc *sc;
986 {
987 struct lge_tx_desc *cur_tx = NULL;
988 struct ifnet *ifp;
989 u_int32_t idx, txdone;
990
991 ifp = sc->lge_ifp;
992
993 /* Clear the timeout timer. */
994 sc->lge_timer = 0;
995
996 /*
997 * Go through our tx list and free mbufs for those
998 * frames that have been transmitted.
999 */
1000 idx = sc->lge_cdata.lge_tx_cons;
1001 txdone = CSR_READ_1(sc, LGE_TXDMADONE_8BIT);
1002
1003 while (idx != sc->lge_cdata.lge_tx_prod && txdone) {
1004 cur_tx = &sc->lge_ldata->lge_tx_list[idx];
1005
1006 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1);
1007 if (cur_tx->lge_mbuf != NULL) {
1008 m_freem(cur_tx->lge_mbuf);
1009 cur_tx->lge_mbuf = NULL;
1010 }
1011 cur_tx->lge_ctl = 0;
1012
1013 txdone--;
1014 LGE_INC(idx, LGE_TX_LIST_CNT);
1015 sc->lge_timer = 0;
1016 }
1017
1018 sc->lge_cdata.lge_tx_cons = idx;
1019
1020 if (cur_tx != NULL)
1021 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1022
1023 return;
1024 }
1025
1026 static void
1027 lge_tick(xsc)
1028 void *xsc;
1029 {
1030 struct lge_softc *sc;
1031 struct mii_data *mii;
1032 struct ifnet *ifp;
1033
1034 sc = xsc;
1035 ifp = sc->lge_ifp;
1036 LGE_LOCK_ASSERT(sc);
1037
1038 CSR_WRITE_4(sc, LGE_STATSIDX, LGE_STATS_SINGLE_COLL_PKTS);
1039 if_inc_counter(ifp, IFCOUNTER_COLLISIONS, CSR_READ_4(sc, LGE_STATSVAL));
1040 CSR_WRITE_4(sc, LGE_STATSIDX, LGE_STATS_MULTI_COLL_PKTS);
1041 if_inc_counter(ifp, IFCOUNTER_COLLISIONS, CSR_READ_4(sc, LGE_STATSVAL));
1042
1043 if (!sc->lge_link) {
1044 mii = device_get_softc(sc->lge_miibus);
1045 mii_tick(mii);
1046 if (mii->mii_media_status & IFM_ACTIVE &&
1047 IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
1048 sc->lge_link++;
1049 if (bootverbose &&
1050 (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_SX||
1051 IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T))
1052 device_printf(sc->lge_dev, "gigabit link up\n");
1053 if (ifp->if_snd.ifq_head != NULL)
1054 lge_start_locked(ifp);
1055 }
1056 }
1057
1058 if (sc->lge_timer != 0 && --sc->lge_timer == 0)
1059 lge_watchdog(sc);
1060 callout_reset(&sc->lge_stat_callout, hz, lge_tick, sc);
1061
1062 return;
1063 }
1064
1065 static void
1066 lge_intr(arg)
1067 void *arg;
1068 {
1069 struct lge_softc *sc;
1070 struct ifnet *ifp;
1071 u_int32_t status;
1072
1073 sc = arg;
1074 ifp = sc->lge_ifp;
1075 LGE_LOCK(sc);
1076
1077 /* Suppress unwanted interrupts */
1078 if (!(ifp->if_flags & IFF_UP)) {
1079 lge_stop(sc);
1080 LGE_UNLOCK(sc);
1081 return;
1082 }
1083
1084 for (;;) {
1085 /*
1086 * Reading the ISR register clears all interrupts, and
1087 * clears the 'interrupts enabled' bit in the IMR
1088 * register.
1089 */
1090 status = CSR_READ_4(sc, LGE_ISR);
1091
1092 if ((status & LGE_INTRS) == 0)
1093 break;
1094
1095 if ((status & (LGE_ISR_TXCMDFIFO_EMPTY|LGE_ISR_TXDMA_DONE)))
1096 lge_txeof(sc);
1097
1098 if (status & LGE_ISR_RXDMA_DONE)
1099 lge_rxeof(sc, LGE_RX_DMACNT(status));
1100
1101 if (status & LGE_ISR_RXCMDFIFO_EMPTY)
1102 lge_rxeoc(sc);
1103
1104 if (status & LGE_ISR_PHY_INTR) {
1105 sc->lge_link = 0;
1106 callout_stop(&sc->lge_stat_callout);
1107 lge_tick(sc);
1108 }
1109 }
1110
1111 /* Re-enable interrupts. */
1112 CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL0|LGE_IMR_INTR_ENB);
1113
1114 if (ifp->if_snd.ifq_head != NULL)
1115 lge_start_locked(ifp);
1116
1117 LGE_UNLOCK(sc);
1118 return;
1119 }
1120
1121 /*
1122 * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data
1123 * pointers to the fragment pointers.
1124 */
1125 static int
1126 lge_encap(sc, m_head, txidx)
1127 struct lge_softc *sc;
1128 struct mbuf *m_head;
1129 u_int32_t *txidx;
1130 {
1131 struct lge_frag *f = NULL;
1132 struct lge_tx_desc *cur_tx;
1133 struct mbuf *m;
1134 int frag = 0, tot_len = 0;
1135
1136 /*
1137 * Start packing the mbufs in this chain into
1138 * the fragment pointers. Stop when we run out
1139 * of fragments or hit the end of the mbuf chain.
1140 */
1141 m = m_head;
1142 cur_tx = &sc->lge_ldata->lge_tx_list[*txidx];
1143 frag = 0;
1144
1145 for (m = m_head; m != NULL; m = m->m_next) {
1146 if (m->m_len != 0) {
1147 tot_len += m->m_len;
1148 f = &cur_tx->lge_frags[frag];
1149 f->lge_fraglen = m->m_len;
1150 f->lge_fragptr_lo = vtophys(mtod(m, vm_offset_t));
1151 f->lge_fragptr_hi = 0;
1152 frag++;
1153 }
1154 }
1155
1156 if (m != NULL)
1157 return(ENOBUFS);
1158
1159 cur_tx->lge_mbuf = m_head;
1160 cur_tx->lge_ctl = LGE_TXCTL_WANTINTR|LGE_FRAGCNT(frag)|tot_len;
1161 LGE_INC((*txidx), LGE_TX_LIST_CNT);
1162
1163 /* Queue for transmit */
1164 CSR_WRITE_4(sc, LGE_TXDESC_ADDR_LO, vtophys(cur_tx));
1165
1166 return(0);
1167 }
1168
1169 /*
1170 * Main transmit routine. To avoid having to do mbuf copies, we put pointers
1171 * to the mbuf data regions directly in the transmit lists. We also save a
1172 * copy of the pointers since the transmit list fragment pointers are
1173 * physical addresses.
1174 */
1175
1176 static void
1177 lge_start(ifp)
1178 struct ifnet *ifp;
1179 {
1180 struct lge_softc *sc;
1181
1182 sc = ifp->if_softc;
1183 LGE_LOCK(sc);
1184 lge_start_locked(ifp);
1185 LGE_UNLOCK(sc);
1186 }
1187
1188 static void
1189 lge_start_locked(ifp)
1190 struct ifnet *ifp;
1191 {
1192 struct lge_softc *sc;
1193 struct mbuf *m_head = NULL;
1194 u_int32_t idx;
1195
1196 sc = ifp->if_softc;
1197
1198 if (!sc->lge_link)
1199 return;
1200
1201 idx = sc->lge_cdata.lge_tx_prod;
1202
1203 if (ifp->if_drv_flags & IFF_DRV_OACTIVE)
1204 return;
1205
1206 while(sc->lge_ldata->lge_tx_list[idx].lge_mbuf == NULL) {
1207 if (CSR_READ_1(sc, LGE_TXCMDFREE_8BIT) == 0)
1208 break;
1209
1210 IF_DEQUEUE(&ifp->if_snd, m_head);
1211 if (m_head == NULL)
1212 break;
1213
1214 if (lge_encap(sc, m_head, &idx)) {
1215 IF_PREPEND(&ifp->if_snd, m_head);
1216 ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1217 break;
1218 }
1219
1220 /*
1221 * If there's a BPF listener, bounce a copy of this frame
1222 * to him.
1223 */
1224 BPF_MTAP(ifp, m_head);
1225 }
1226
1227 sc->lge_cdata.lge_tx_prod = idx;
1228
1229 /*
1230 * Set a timeout in case the chip goes out to lunch.
1231 */
1232 sc->lge_timer = 5;
1233
1234 return;
1235 }
1236
1237 static void
1238 lge_init(xsc)
1239 void *xsc;
1240 {
1241 struct lge_softc *sc = xsc;
1242
1243 LGE_LOCK(sc);
1244 lge_init_locked(sc);
1245 LGE_UNLOCK(sc);
1246 }
1247
1248 static void
1249 lge_init_locked(sc)
1250 struct lge_softc *sc;
1251 {
1252 struct ifnet *ifp = sc->lge_ifp;
1253
1254 LGE_LOCK_ASSERT(sc);
1255 if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1256 return;
1257
1258 /*
1259 * Cancel pending I/O and free all RX/TX buffers.
1260 */
1261 lge_stop(sc);
1262 lge_reset(sc);
1263
1264 /* Set MAC address */
1265 CSR_WRITE_4(sc, LGE_PAR0, *(u_int32_t *)(&IF_LLADDR(sc->lge_ifp)[0]));
1266 CSR_WRITE_4(sc, LGE_PAR1, *(u_int32_t *)(&IF_LLADDR(sc->lge_ifp)[4]));
1267
1268 /* Init circular RX list. */
1269 if (lge_list_rx_init(sc) == ENOBUFS) {
1270 device_printf(sc->lge_dev, "initialization failed: no "
1271 "memory for rx buffers\n");
1272 lge_stop(sc);
1273 return;
1274 }
1275
1276 /*
1277 * Init tx descriptors.
1278 */
1279 lge_list_tx_init(sc);
1280
1281 /* Set initial value for MODE1 register. */
1282 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_UCAST|
1283 LGE_MODE1_TX_CRC|LGE_MODE1_TXPAD|
1284 LGE_MODE1_RX_FLOWCTL|LGE_MODE1_SETRST_CTL0|
1285 LGE_MODE1_SETRST_CTL1|LGE_MODE1_SETRST_CTL2);
1286
1287 /* If we want promiscuous mode, set the allframes bit. */
1288 if (ifp->if_flags & IFF_PROMISC) {
1289 CSR_WRITE_4(sc, LGE_MODE1,
1290 LGE_MODE1_SETRST_CTL1|LGE_MODE1_RX_PROMISC);
1291 } else {
1292 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_PROMISC);
1293 }
1294
1295 /*
1296 * Set the capture broadcast bit to capture broadcast frames.
1297 */
1298 if (ifp->if_flags & IFF_BROADCAST) {
1299 CSR_WRITE_4(sc, LGE_MODE1,
1300 LGE_MODE1_SETRST_CTL1|LGE_MODE1_RX_BCAST);
1301 } else {
1302 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_BCAST);
1303 }
1304
1305 /* Packet padding workaround? */
1306 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_RMVPAD);
1307
1308 /* No error frames */
1309 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_ERRPKTS);
1310
1311 /* Receive large frames */
1312 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_RX_GIANTS);
1313
1314 /* Workaround: disable RX/TX flow control */
1315 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_TX_FLOWCTL);
1316 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_FLOWCTL);
1317
1318 /* Make sure to strip CRC from received frames */
1319 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_CRC);
1320
1321 /* Turn off magic packet mode */
1322 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_MPACK_ENB);
1323
1324 /* Turn off all VLAN stuff */
1325 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_VLAN_RX|LGE_MODE1_VLAN_TX|
1326 LGE_MODE1_VLAN_STRIP|LGE_MODE1_VLAN_INSERT);
1327
1328 /* Workarond: FIFO overflow */
1329 CSR_WRITE_2(sc, LGE_RXFIFO_HIWAT, 0x3FFF);
1330 CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL1|LGE_IMR_RXFIFO_WAT);
1331
1332 /*
1333 * Load the multicast filter.
1334 */
1335 lge_setmulti(sc);
1336
1337 /*
1338 * Enable hardware checksum validation for all received IPv4
1339 * packets, do not reject packets with bad checksums.
1340 */
1341 CSR_WRITE_4(sc, LGE_MODE2, LGE_MODE2_RX_IPCSUM|
1342 LGE_MODE2_RX_TCPCSUM|LGE_MODE2_RX_UDPCSUM|
1343 LGE_MODE2_RX_ERRCSUM);
1344
1345 /*
1346 * Enable the delivery of PHY interrupts based on
1347 * link/speed/duplex status chalges.
1348 */
1349 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL0|LGE_MODE1_GMIIPOLL);
1350
1351 /* Enable receiver and transmitter. */
1352 CSR_WRITE_4(sc, LGE_RXDESC_ADDR_HI, 0);
1353 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_RX_ENB);
1354
1355 CSR_WRITE_4(sc, LGE_TXDESC_ADDR_HI, 0);
1356 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_SETRST_CTL1|LGE_MODE1_TX_ENB);
1357
1358 /*
1359 * Enable interrupts.
1360 */
1361 CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_SETRST_CTL0|
1362 LGE_IMR_SETRST_CTL1|LGE_IMR_INTR_ENB|LGE_INTRS);
1363
1364 lge_ifmedia_upd_locked(ifp);
1365
1366 ifp->if_drv_flags |= IFF_DRV_RUNNING;
1367 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1368
1369 callout_reset(&sc->lge_stat_callout, hz, lge_tick, sc);
1370
1371 return;
1372 }
1373
1374 /*
1375 * Set media options.
1376 */
1377 static int
1378 lge_ifmedia_upd(ifp)
1379 struct ifnet *ifp;
1380 {
1381 struct lge_softc *sc;
1382
1383 sc = ifp->if_softc;
1384 LGE_LOCK(sc);
1385 lge_ifmedia_upd_locked(ifp);
1386 LGE_UNLOCK(sc);
1387
1388 return(0);
1389 }
1390
1391 static void
1392 lge_ifmedia_upd_locked(ifp)
1393 struct ifnet *ifp;
1394 {
1395 struct lge_softc *sc;
1396 struct mii_data *mii;
1397 struct mii_softc *miisc;
1398
1399 sc = ifp->if_softc;
1400
1401 LGE_LOCK_ASSERT(sc);
1402 mii = device_get_softc(sc->lge_miibus);
1403 sc->lge_link = 0;
1404 LIST_FOREACH(miisc, &mii->mii_phys, mii_list)
1405 PHY_RESET(miisc);
1406 mii_mediachg(mii);
1407 }
1408
1409 /*
1410 * Report current media status.
1411 */
1412 static void
1413 lge_ifmedia_sts(ifp, ifmr)
1414 struct ifnet *ifp;
1415 struct ifmediareq *ifmr;
1416 {
1417 struct lge_softc *sc;
1418 struct mii_data *mii;
1419
1420 sc = ifp->if_softc;
1421
1422 LGE_LOCK(sc);
1423 mii = device_get_softc(sc->lge_miibus);
1424 mii_pollstat(mii);
1425 ifmr->ifm_active = mii->mii_media_active;
1426 ifmr->ifm_status = mii->mii_media_status;
1427 LGE_UNLOCK(sc);
1428
1429 return;
1430 }
1431
1432 static int
1433 lge_ioctl(ifp, command, data)
1434 struct ifnet *ifp;
1435 u_long command;
1436 caddr_t data;
1437 {
1438 struct lge_softc *sc = ifp->if_softc;
1439 struct ifreq *ifr = (struct ifreq *) data;
1440 struct mii_data *mii;
1441 int error = 0;
1442
1443 switch(command) {
1444 case SIOCSIFMTU:
1445 LGE_LOCK(sc);
1446 if (ifr->ifr_mtu > LGE_JUMBO_MTU)
1447 error = EINVAL;
1448 else
1449 ifp->if_mtu = ifr->ifr_mtu;
1450 LGE_UNLOCK(sc);
1451 break;
1452 case SIOCSIFFLAGS:
1453 LGE_LOCK(sc);
1454 if (ifp->if_flags & IFF_UP) {
1455 if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1456 ifp->if_flags & IFF_PROMISC &&
1457 !(sc->lge_if_flags & IFF_PROMISC)) {
1458 CSR_WRITE_4(sc, LGE_MODE1,
1459 LGE_MODE1_SETRST_CTL1|
1460 LGE_MODE1_RX_PROMISC);
1461 } else if (ifp->if_drv_flags & IFF_DRV_RUNNING &&
1462 !(ifp->if_flags & IFF_PROMISC) &&
1463 sc->lge_if_flags & IFF_PROMISC) {
1464 CSR_WRITE_4(sc, LGE_MODE1,
1465 LGE_MODE1_RX_PROMISC);
1466 } else {
1467 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
1468 lge_init_locked(sc);
1469 }
1470 } else {
1471 if (ifp->if_drv_flags & IFF_DRV_RUNNING)
1472 lge_stop(sc);
1473 }
1474 sc->lge_if_flags = ifp->if_flags;
1475 LGE_UNLOCK(sc);
1476 error = 0;
1477 break;
1478 case SIOCADDMULTI:
1479 case SIOCDELMULTI:
1480 LGE_LOCK(sc);
1481 lge_setmulti(sc);
1482 LGE_UNLOCK(sc);
1483 error = 0;
1484 break;
1485 case SIOCGIFMEDIA:
1486 case SIOCSIFMEDIA:
1487 mii = device_get_softc(sc->lge_miibus);
1488 error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
1489 break;
1490 default:
1491 error = ether_ioctl(ifp, command, data);
1492 break;
1493 }
1494
1495 return(error);
1496 }
1497
1498 static void
1499 lge_watchdog(sc)
1500 struct lge_softc *sc;
1501 {
1502 struct ifnet *ifp;
1503
1504 LGE_LOCK_ASSERT(sc);
1505 ifp = sc->lge_ifp;
1506
1507 if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
1508 if_printf(ifp, "watchdog timeout\n");
1509
1510 lge_stop(sc);
1511 lge_reset(sc);
1512 ifp->if_drv_flags &= ~IFF_DRV_RUNNING;
1513 lge_init_locked(sc);
1514
1515 if (ifp->if_snd.ifq_head != NULL)
1516 lge_start_locked(ifp);
1517 }
1518
1519 /*
1520 * Stop the adapter and free any mbufs allocated to the
1521 * RX and TX lists.
1522 */
1523 static void
1524 lge_stop(sc)
1525 struct lge_softc *sc;
1526 {
1527 int i;
1528 struct ifnet *ifp;
1529
1530 LGE_LOCK_ASSERT(sc);
1531 ifp = sc->lge_ifp;
1532 sc->lge_timer = 0;
1533 callout_stop(&sc->lge_stat_callout);
1534 CSR_WRITE_4(sc, LGE_IMR, LGE_IMR_INTR_ENB);
1535
1536 /* Disable receiver and transmitter. */
1537 CSR_WRITE_4(sc, LGE_MODE1, LGE_MODE1_RX_ENB|LGE_MODE1_TX_ENB);
1538 sc->lge_link = 0;
1539
1540 /*
1541 * Free data in the RX lists.
1542 */
1543 for (i = 0; i < LGE_RX_LIST_CNT; i++) {
1544 if (sc->lge_ldata->lge_rx_list[i].lge_mbuf != NULL) {
1545 m_freem(sc->lge_ldata->lge_rx_list[i].lge_mbuf);
1546 sc->lge_ldata->lge_rx_list[i].lge_mbuf = NULL;
1547 }
1548 }
1549 bzero((char *)&sc->lge_ldata->lge_rx_list,
1550 sizeof(sc->lge_ldata->lge_rx_list));
1551
1552 /*
1553 * Free the TX list buffers.
1554 */
1555 for (i = 0; i < LGE_TX_LIST_CNT; i++) {
1556 if (sc->lge_ldata->lge_tx_list[i].lge_mbuf != NULL) {
1557 m_freem(sc->lge_ldata->lge_tx_list[i].lge_mbuf);
1558 sc->lge_ldata->lge_tx_list[i].lge_mbuf = NULL;
1559 }
1560 }
1561
1562 bzero((char *)&sc->lge_ldata->lge_tx_list,
1563 sizeof(sc->lge_ldata->lge_tx_list));
1564
1565 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
1566
1567 return;
1568 }
1569
1570 /*
1571 * Stop all chip I/O so that the kernel's probe routines don't
1572 * get confused by errant DMAs when rebooting.
1573 */
1574 static int
1575 lge_shutdown(dev)
1576 device_t dev;
1577 {
1578 struct lge_softc *sc;
1579
1580 sc = device_get_softc(dev);
1581
1582 LGE_LOCK(sc);
1583 lge_reset(sc);
1584 lge_stop(sc);
1585 LGE_UNLOCK(sc);
1586
1587 return (0);
1588 }
Cache object: 21aa078ee020fee71868069c9bee9973
|