]> CyberLeo.Net >> Repos - FreeBSD/releng/10.0.git/blob - sys/dev/tsec/if_tsec.c
- Copy stable/10 (r259064) to releng/10.0 as part of the
[FreeBSD/releng/10.0.git] / sys / dev / tsec / if_tsec.c
1 /*-
2  * Copyright (C) 2007-2008 Semihalf, Rafal Jaworowski
3  * Copyright (C) 2006-2007 Semihalf, Piotr Kruszynski
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  *
15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
18  * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
19  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
20  * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
21  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
22  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
23  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
24  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25  */
26
27 /*
28  * Freescale integrated Three-Speed Ethernet Controller (TSEC) driver.
29  */
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32
33 #ifdef HAVE_KERNEL_OPTION_HEADERS
34 #include "opt_device_polling.h"
35 #endif
36
37 #include <sys/param.h>
38 #include <sys/systm.h>
39 #include <sys/bus.h>
40 #include <sys/endian.h>
41 #include <sys/mbuf.h>
42 #include <sys/kernel.h>
43 #include <sys/module.h>
44 #include <sys/socket.h>
45 #include <sys/sockio.h>
46 #include <sys/sysctl.h>
47
48 #include <net/bpf.h>
49 #include <net/ethernet.h>
50 #include <net/if.h>
51 #include <net/if_arp.h>
52 #include <net/if_dl.h>
53 #include <net/if_media.h>
54 #include <net/if_types.h>
55 #include <net/if_vlan_var.h>
56
57 #include <netinet/in_systm.h>
58 #include <netinet/in.h>
59 #include <netinet/ip.h>
60
61 #include <machine/bus.h>
62
63 #include <dev/mii/mii.h>
64 #include <dev/mii/miivar.h>
65
66 #include <dev/tsec/if_tsec.h>
67 #include <dev/tsec/if_tsecreg.h>
68
69 static int      tsec_alloc_dma_desc(device_t dev, bus_dma_tag_t *dtag,
70     bus_dmamap_t *dmap, bus_size_t dsize, void **vaddr, void *raddr,
71     const char *dname);
72 static void     tsec_dma_ctl(struct tsec_softc *sc, int state);
73 static int      tsec_encap(struct tsec_softc *sc, struct mbuf *m_head,
74     int fcb_inserted);
75 static void     tsec_free_dma(struct tsec_softc *sc);
76 static void     tsec_free_dma_desc(bus_dma_tag_t dtag, bus_dmamap_t dmap, void *vaddr);
77 static int      tsec_ifmedia_upd(struct ifnet *ifp);
78 static void     tsec_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr);
79 static int      tsec_new_rxbuf(bus_dma_tag_t tag, bus_dmamap_t map,
80     struct mbuf **mbufp, uint32_t *paddr);
81 static void     tsec_map_dma_addr(void *arg, bus_dma_segment_t *segs,
82     int nseg, int error);
83 static void     tsec_intrs_ctl(struct tsec_softc *sc, int state);
84 static void     tsec_init(void *xsc);
85 static void     tsec_init_locked(struct tsec_softc *sc);
86 static int      tsec_ioctl(struct ifnet *ifp, u_long command, caddr_t data);
87 static void     tsec_reset_mac(struct tsec_softc *sc);
88 static void     tsec_setfilter(struct tsec_softc *sc);
89 static void     tsec_set_mac_address(struct tsec_softc *sc);
90 static void     tsec_start(struct ifnet *ifp);
91 static void     tsec_start_locked(struct ifnet *ifp);
92 static void     tsec_stop(struct tsec_softc *sc);
93 static void     tsec_tick(void *arg);
94 static void     tsec_watchdog(struct tsec_softc *sc);
95 static void     tsec_add_sysctls(struct tsec_softc *sc);
96 static int      tsec_sysctl_ic_time(SYSCTL_HANDLER_ARGS);
97 static int      tsec_sysctl_ic_count(SYSCTL_HANDLER_ARGS);
98 static void     tsec_set_rxic(struct tsec_softc *sc);
99 static void     tsec_set_txic(struct tsec_softc *sc);
100 static int      tsec_receive_intr_locked(struct tsec_softc *sc, int count);
101 static void     tsec_transmit_intr_locked(struct tsec_softc *sc);
102 static void     tsec_error_intr_locked(struct tsec_softc *sc, int count);
103 static void     tsec_offload_setup(struct tsec_softc *sc);
104 static void     tsec_offload_process_frame(struct tsec_softc *sc,
105     struct mbuf *m);
106 static void     tsec_setup_multicast(struct tsec_softc *sc);
107 static int      tsec_set_mtu(struct tsec_softc *sc, unsigned int mtu);
108
109 devclass_t tsec_devclass;
110 DRIVER_MODULE(miibus, tsec, miibus_driver, miibus_devclass, 0, 0);
111 MODULE_DEPEND(tsec, ether, 1, 1, 1);
112 MODULE_DEPEND(tsec, miibus, 1, 1, 1);
113
114 int
115 tsec_attach(struct tsec_softc *sc)
116 {
117         uint8_t hwaddr[ETHER_ADDR_LEN];
118         struct ifnet *ifp;
119         bus_dmamap_t *map_ptr;
120         bus_dmamap_t **map_pptr;
121         int error = 0;
122         int i;
123
124         /* Reset all TSEC counters */
125         TSEC_TX_RX_COUNTERS_INIT(sc);
126
127         /* Stop DMA engine if enabled by firmware */
128         tsec_dma_ctl(sc, 0);
129
130         /* Reset MAC */
131         tsec_reset_mac(sc);
132
133         /* Disable interrupts for now */
134         tsec_intrs_ctl(sc, 0);
135
136         /* Configure defaults for interrupts coalescing */
137         sc->rx_ic_time = 768;
138         sc->rx_ic_count = 16;
139         sc->tx_ic_time = 768;
140         sc->tx_ic_count = 16;
141         tsec_set_rxic(sc);
142         tsec_set_txic(sc);
143         tsec_add_sysctls(sc);
144
145         /* Allocate a busdma tag and DMA safe memory for TX descriptors. */
146         error = tsec_alloc_dma_desc(sc->dev, &sc->tsec_tx_dtag,
147             &sc->tsec_tx_dmap, sizeof(*sc->tsec_tx_vaddr) * TSEC_TX_NUM_DESC,
148             (void **)&sc->tsec_tx_vaddr, &sc->tsec_tx_raddr, "TX");
149
150         if (error) {
151                 tsec_detach(sc);
152                 return (ENXIO);
153         }
154
155         /* Allocate a busdma tag and DMA safe memory for RX descriptors. */
156         error = tsec_alloc_dma_desc(sc->dev, &sc->tsec_rx_dtag,
157             &sc->tsec_rx_dmap, sizeof(*sc->tsec_rx_vaddr) * TSEC_RX_NUM_DESC,
158             (void **)&sc->tsec_rx_vaddr, &sc->tsec_rx_raddr, "RX");
159         if (error) {
160                 tsec_detach(sc);
161                 return (ENXIO);
162         }
163
164         /* Allocate a busdma tag for TX mbufs. */
165         error = bus_dma_tag_create(NULL,        /* parent */
166             TSEC_TXBUFFER_ALIGNMENT, 0,         /* alignment, boundary */
167             BUS_SPACE_MAXADDR_32BIT,            /* lowaddr */
168             BUS_SPACE_MAXADDR,                  /* highaddr */
169             NULL, NULL,                         /* filtfunc, filtfuncarg */
170             MCLBYTES * (TSEC_TX_NUM_DESC - 1),  /* maxsize */
171             TSEC_TX_NUM_DESC - 1,               /* nsegments */
172             MCLBYTES, 0,                        /* maxsegsz, flags */
173             NULL, NULL,                         /* lockfunc, lockfuncarg */
174             &sc->tsec_tx_mtag);                 /* dmat */
175         if (error) {
176                 device_printf(sc->dev, "failed to allocate busdma tag "
177                     "(tx mbufs)\n");
178                 tsec_detach(sc);
179                 return (ENXIO);
180         }
181
182         /* Allocate a busdma tag for RX mbufs. */
183         error = bus_dma_tag_create(NULL,        /* parent */
184             TSEC_RXBUFFER_ALIGNMENT, 0,         /* alignment, boundary */
185             BUS_SPACE_MAXADDR_32BIT,            /* lowaddr */
186             BUS_SPACE_MAXADDR,                  /* highaddr */
187             NULL, NULL,                         /* filtfunc, filtfuncarg */
188             MCLBYTES,                           /* maxsize */
189             1,                                  /* nsegments */
190             MCLBYTES, 0,                        /* maxsegsz, flags */
191             NULL, NULL,                         /* lockfunc, lockfuncarg */
192             &sc->tsec_rx_mtag);                 /* dmat */
193         if (error) {
194                 device_printf(sc->dev, "failed to allocate busdma tag "
195                     "(rx mbufs)\n");
196                 tsec_detach(sc);
197                 return (ENXIO);
198         }
199
200         /* Create TX busdma maps */
201         map_ptr = sc->tx_map_data;
202         map_pptr = sc->tx_map_unused_data;
203
204         for (i = 0; i < TSEC_TX_NUM_DESC; i++) {
205                 map_pptr[i] = &map_ptr[i];
206                 error = bus_dmamap_create(sc->tsec_tx_mtag, 0, map_pptr[i]);
207                 if (error) {
208                         device_printf(sc->dev, "failed to init TX ring\n");
209                         tsec_detach(sc);
210                         return (ENXIO);
211                 }
212         }
213
214         /* Create RX busdma maps and zero mbuf handlers */
215         for (i = 0; i < TSEC_RX_NUM_DESC; i++) {
216                 error = bus_dmamap_create(sc->tsec_rx_mtag, 0,
217                     &sc->rx_data[i].map);
218                 if (error) {
219                         device_printf(sc->dev, "failed to init RX ring\n");
220                         tsec_detach(sc);
221                         return (ENXIO);
222                 }
223                 sc->rx_data[i].mbuf = NULL;
224         }
225
226         /* Create mbufs for RX buffers */
227         for (i = 0; i < TSEC_RX_NUM_DESC; i++) {
228                 error = tsec_new_rxbuf(sc->tsec_rx_mtag, sc->rx_data[i].map,
229                     &sc->rx_data[i].mbuf, &sc->rx_data[i].paddr);
230                 if (error) {
231                         device_printf(sc->dev, "can't load rx DMA map %d, "
232                             "error = %d\n", i, error);
233                         tsec_detach(sc);
234                         return (error);
235                 }
236         }
237
238         /* Create network interface for upper layers */
239         ifp = sc->tsec_ifp = if_alloc(IFT_ETHER);
240         if (ifp == NULL) {
241                 device_printf(sc->dev, "if_alloc() failed\n");
242                 tsec_detach(sc);
243                 return (ENOMEM);
244         }
245
246         ifp->if_softc = sc;
247         if_initname(ifp, device_get_name(sc->dev), device_get_unit(sc->dev));
248         ifp->if_flags = IFF_SIMPLEX | IFF_MULTICAST | IFF_BROADCAST;
249         ifp->if_init = tsec_init;
250         ifp->if_start = tsec_start;
251         ifp->if_ioctl = tsec_ioctl;
252
253         IFQ_SET_MAXLEN(&ifp->if_snd, TSEC_TX_NUM_DESC - 1);
254         ifp->if_snd.ifq_drv_maxlen = TSEC_TX_NUM_DESC - 1;
255         IFQ_SET_READY(&ifp->if_snd);
256
257         ifp->if_capabilities = IFCAP_VLAN_MTU;
258         if (sc->is_etsec)
259                 ifp->if_capabilities |= IFCAP_HWCSUM;
260
261         ifp->if_capenable = ifp->if_capabilities;
262
263 #ifdef DEVICE_POLLING
264         /* Advertise that polling is supported */
265         ifp->if_capabilities |= IFCAP_POLLING;
266 #endif
267         
268         /* Attach PHY(s) */
269         error = mii_attach(sc->dev, &sc->tsec_miibus, ifp, tsec_ifmedia_upd,
270             tsec_ifmedia_sts, BMSR_DEFCAPMASK, sc->phyaddr, MII_OFFSET_ANY,
271             0);
272         if (error) {
273                 device_printf(sc->dev, "attaching PHYs failed\n");
274                 if_free(ifp);
275                 sc->tsec_ifp = NULL;
276                 tsec_detach(sc);
277                 return (error);
278         }
279         sc->tsec_mii = device_get_softc(sc->tsec_miibus);
280
281         /* Set MAC address */
282         tsec_get_hwaddr(sc, hwaddr);
283         ether_ifattach(ifp, hwaddr);
284
285         return (0);
286 }
287
288 int
289 tsec_detach(struct tsec_softc *sc)
290 {
291
292         if (sc->tsec_ifp != NULL) {
293 #ifdef DEVICE_POLLING
294                 if (sc->tsec_ifp->if_capenable & IFCAP_POLLING)
295                         ether_poll_deregister(sc->tsec_ifp);
296 #endif
297
298                 /* Stop TSEC controller and free TX queue */
299                 if (sc->sc_rres)
300                         tsec_shutdown(sc->dev);
301
302                 /* Detach network interface */
303                 ether_ifdetach(sc->tsec_ifp);
304                 if_free(sc->tsec_ifp);
305                 sc->tsec_ifp = NULL;
306         }
307
308         /* Free DMA resources */
309         tsec_free_dma(sc);
310
311         return (0);
312 }
313
314 int
315 tsec_shutdown(device_t dev)
316 {
317         struct tsec_softc *sc;
318
319         sc = device_get_softc(dev);
320
321         TSEC_GLOBAL_LOCK(sc);
322         tsec_stop(sc);
323         TSEC_GLOBAL_UNLOCK(sc);
324         return (0);
325 }
326
327 int
328 tsec_suspend(device_t dev)
329 {
330
331         /* TODO not implemented! */
332         return (0);
333 }
334
335 int
336 tsec_resume(device_t dev)
337 {
338
339         /* TODO not implemented! */
340         return (0);
341 }
342
343 static void
344 tsec_init(void *xsc)
345 {
346         struct tsec_softc *sc = xsc;
347
348         TSEC_GLOBAL_LOCK(sc);
349         tsec_init_locked(sc);
350         TSEC_GLOBAL_UNLOCK(sc);
351 }
352
353 static void
354 tsec_init_locked(struct tsec_softc *sc)
355 {
356         struct tsec_desc *tx_desc = sc->tsec_tx_vaddr;
357         struct tsec_desc *rx_desc = sc->tsec_rx_vaddr;
358         struct ifnet *ifp = sc->tsec_ifp;
359         uint32_t timeout, val, i;
360
361         if (ifp->if_drv_flags & IFF_DRV_RUNNING)
362                 return;
363
364         TSEC_GLOBAL_LOCK_ASSERT(sc);
365         tsec_stop(sc);
366
367         /*
368          * These steps are according to the MPC8555E PowerQUICCIII RM:
369          * 14.7 Initialization/Application Information
370          */
371
372         /* Step 1: soft reset MAC */
373         tsec_reset_mac(sc);
374
375         /* Step 2: Initialize MACCFG2 */
376         TSEC_WRITE(sc, TSEC_REG_MACCFG2,
377             TSEC_MACCFG2_FULLDUPLEX |   /* Full Duplex = 1 */
378             TSEC_MACCFG2_PADCRC |       /* PAD/CRC append */
379             TSEC_MACCFG2_GMII |         /* I/F Mode bit */
380             TSEC_MACCFG2_PRECNT         /* Preamble count = 7 */
381         );
382
383         /* Step 3: Initialize ECNTRL
384          * While the documentation states that R100M is ignored if RPM is
385          * not set, it does seem to be needed to get the orange boxes to
386          * work (which have a Marvell 88E1111 PHY). Go figure.
387          */
388
389         /*
390          * XXX kludge - use circumstancial evidence to program ECNTRL
391          * correctly. Ideally we need some board information to guide
392          * us here.
393          */
394         i = TSEC_READ(sc, TSEC_REG_ID2);
395         val = (i & 0xffff)
396             ? (TSEC_ECNTRL_TBIM | TSEC_ECNTRL_SGMIIM)   /* Sumatra */
397             : TSEC_ECNTRL_R100M;                        /* Orange + CDS */
398         TSEC_WRITE(sc, TSEC_REG_ECNTRL, TSEC_ECNTRL_STEN | val);
399
400         /* Step 4: Initialize MAC station address */
401         tsec_set_mac_address(sc);
402
403         /*
404          * Step 5: Assign a Physical address to the TBI so as to not conflict
405          * with the external PHY physical address
406          */
407         TSEC_WRITE(sc, TSEC_REG_TBIPA, 5);
408
409         /* Step 6: Reset the management interface */
410         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMCFG, TSEC_MIIMCFG_RESETMGMT);
411
412         /* Step 7: Setup the MII Mgmt clock speed */
413         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMCFG, TSEC_MIIMCFG_CLKDIV28);
414
415         /* Step 8: Read MII Mgmt indicator register and check for Busy = 0 */
416         timeout = TSEC_READ_RETRY;
417         while (--timeout && (TSEC_READ(sc->phy_sc, TSEC_REG_MIIMIND) &
418             TSEC_MIIMIND_BUSY))
419                 DELAY(TSEC_READ_DELAY);
420         if (timeout == 0) {
421                 if_printf(ifp, "tsec_init_locked(): Mgmt busy timeout\n");
422                 return;
423         }
424
425         /* Step 9: Setup the MII Mgmt */
426         mii_mediachg(sc->tsec_mii);
427
428         /* Step 10: Clear IEVENT register */
429         TSEC_WRITE(sc, TSEC_REG_IEVENT, 0xffffffff);
430
431         /* Step 11: Enable interrupts */
432 #ifdef DEVICE_POLLING
433         /*
434          * ...only if polling is not turned on. Disable interrupts explicitly
435          * if polling is enabled.
436          */
437         if (ifp->if_capenable & IFCAP_POLLING )
438                 tsec_intrs_ctl(sc, 0);
439         else
440 #endif /* DEVICE_POLLING */
441         tsec_intrs_ctl(sc, 1);
442
443         /* Step 12: Initialize IADDRn */
444         TSEC_WRITE(sc, TSEC_REG_IADDR0, 0);
445         TSEC_WRITE(sc, TSEC_REG_IADDR1, 0);
446         TSEC_WRITE(sc, TSEC_REG_IADDR2, 0);
447         TSEC_WRITE(sc, TSEC_REG_IADDR3, 0);
448         TSEC_WRITE(sc, TSEC_REG_IADDR4, 0);
449         TSEC_WRITE(sc, TSEC_REG_IADDR5, 0);
450         TSEC_WRITE(sc, TSEC_REG_IADDR6, 0);
451         TSEC_WRITE(sc, TSEC_REG_IADDR7, 0);
452
453         /* Step 13: Initialize GADDRn */
454         TSEC_WRITE(sc, TSEC_REG_GADDR0, 0);
455         TSEC_WRITE(sc, TSEC_REG_GADDR1, 0);
456         TSEC_WRITE(sc, TSEC_REG_GADDR2, 0);
457         TSEC_WRITE(sc, TSEC_REG_GADDR3, 0);
458         TSEC_WRITE(sc, TSEC_REG_GADDR4, 0);
459         TSEC_WRITE(sc, TSEC_REG_GADDR5, 0);
460         TSEC_WRITE(sc, TSEC_REG_GADDR6, 0);
461         TSEC_WRITE(sc, TSEC_REG_GADDR7, 0);
462
463         /* Step 14: Initialize RCTRL */
464         TSEC_WRITE(sc, TSEC_REG_RCTRL, 0);
465
466         /* Step 15: Initialize DMACTRL */
467         tsec_dma_ctl(sc, 1);
468
469         /* Step 16: Initialize FIFO_PAUSE_CTRL */
470         TSEC_WRITE(sc, TSEC_REG_FIFO_PAUSE_CTRL, TSEC_FIFO_PAUSE_CTRL_EN);
471
472         /*
473          * Step 17: Initialize transmit/receive descriptor rings.
474          * Initialize TBASE and RBASE.
475          */
476         TSEC_WRITE(sc, TSEC_REG_TBASE, sc->tsec_tx_raddr);
477         TSEC_WRITE(sc, TSEC_REG_RBASE, sc->tsec_rx_raddr);
478
479         for (i = 0; i < TSEC_TX_NUM_DESC; i++) {
480                 tx_desc[i].bufptr = 0;
481                 tx_desc[i].length = 0;
482                 tx_desc[i].flags = ((i == TSEC_TX_NUM_DESC - 1) ?
483                     TSEC_TXBD_W : 0);
484         }
485         bus_dmamap_sync(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
486             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
487
488         for (i = 0; i < TSEC_RX_NUM_DESC; i++) {
489                 rx_desc[i].bufptr = sc->rx_data[i].paddr;
490                 rx_desc[i].length = 0;
491                 rx_desc[i].flags = TSEC_RXBD_E | TSEC_RXBD_I |
492                     ((i == TSEC_RX_NUM_DESC - 1) ? TSEC_RXBD_W : 0);
493         }
494         bus_dmamap_sync(sc->tsec_rx_dtag, sc->tsec_rx_dmap,
495             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
496
497         /* Step 18: Initialize the maximum receive buffer length */
498         TSEC_WRITE(sc, TSEC_REG_MRBLR, MCLBYTES);
499
500         /* Step 19: Configure ethernet frame sizes */
501         TSEC_WRITE(sc, TSEC_REG_MINFLR, TSEC_MIN_FRAME_SIZE);
502         tsec_set_mtu(sc, ifp->if_mtu);
503
504         /* Step 20: Enable Rx and RxBD sdata snooping */
505         TSEC_WRITE(sc, TSEC_REG_ATTR, TSEC_ATTR_RDSEN | TSEC_ATTR_RBDSEN);
506         TSEC_WRITE(sc, TSEC_REG_ATTRELI, 0);
507
508         /* Step 21: Reset collision counters in hardware */
509         TSEC_WRITE(sc, TSEC_REG_MON_TSCL, 0);
510         TSEC_WRITE(sc, TSEC_REG_MON_TMCL, 0);
511         TSEC_WRITE(sc, TSEC_REG_MON_TLCL, 0);
512         TSEC_WRITE(sc, TSEC_REG_MON_TXCL, 0);
513         TSEC_WRITE(sc, TSEC_REG_MON_TNCL, 0);
514
515         /* Step 22: Mask all CAM interrupts */
516         TSEC_WRITE(sc, TSEC_REG_MON_CAM1, 0xffffffff);
517         TSEC_WRITE(sc, TSEC_REG_MON_CAM2, 0xffffffff);
518
519         /* Step 23: Enable Rx and Tx */
520         val = TSEC_READ(sc, TSEC_REG_MACCFG1);
521         val |= (TSEC_MACCFG1_RX_EN | TSEC_MACCFG1_TX_EN);
522         TSEC_WRITE(sc, TSEC_REG_MACCFG1, val);
523
524         /* Step 24: Reset TSEC counters for Tx and Rx rings */
525         TSEC_TX_RX_COUNTERS_INIT(sc);
526
527         /* Step 25: Setup TCP/IP Off-Load engine */
528         if (sc->is_etsec)
529                 tsec_offload_setup(sc);
530
531         /* Step 26: Setup multicast filters */
532         tsec_setup_multicast(sc);
533         
534         /* Step 27: Activate network interface */
535         ifp->if_drv_flags |= IFF_DRV_RUNNING;
536         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
537         sc->tsec_if_flags = ifp->if_flags;
538         sc->tsec_watchdog = 0;
539
540         /* Schedule watchdog timeout */
541         callout_reset(&sc->tsec_callout, hz, tsec_tick, sc);
542 }
543
544 static void
545 tsec_set_mac_address(struct tsec_softc *sc)
546 {
547         uint32_t macbuf[2] = { 0, 0 };
548         char *macbufp, *curmac;
549         int i;
550
551         TSEC_GLOBAL_LOCK_ASSERT(sc);
552
553         KASSERT((ETHER_ADDR_LEN <= sizeof(macbuf)),
554             ("tsec_set_mac_address: (%d <= %d", ETHER_ADDR_LEN,
555             sizeof(macbuf)));
556
557         macbufp = (char *)macbuf;
558         curmac = (char *)IF_LLADDR(sc->tsec_ifp);
559
560         /* Correct order of MAC address bytes */
561         for (i = 1; i <= ETHER_ADDR_LEN; i++)
562                 macbufp[ETHER_ADDR_LEN-i] = curmac[i-1];
563
564         /* Initialize MAC station address MACSTNADDR2 and MACSTNADDR1 */
565         TSEC_WRITE(sc, TSEC_REG_MACSTNADDR2, macbuf[1]);
566         TSEC_WRITE(sc, TSEC_REG_MACSTNADDR1, macbuf[0]);
567 }
568
569 /*
570  * DMA control function, if argument state is:
571  * 0 - DMA engine will be disabled
572  * 1 - DMA engine will be enabled
573  */
574 static void
575 tsec_dma_ctl(struct tsec_softc *sc, int state)
576 {
577         device_t dev;
578         uint32_t dma_flags, timeout;
579
580         dev = sc->dev;
581
582         dma_flags = TSEC_READ(sc, TSEC_REG_DMACTRL);
583
584         switch (state) {
585         case 0:
586                 /* Temporarily clear stop graceful stop bits. */
587                 tsec_dma_ctl(sc, 1000);
588
589                 /* Set it again */
590                 dma_flags |= (TSEC_DMACTRL_GRS | TSEC_DMACTRL_GTS);
591                 break;
592         case 1000:
593         case 1:
594                 /* Set write with response (WWR), wait (WOP) and snoop bits */
595                 dma_flags |= (TSEC_DMACTRL_TDSEN | TSEC_DMACTRL_TBDSEN |
596                     DMACTRL_WWR | DMACTRL_WOP);
597
598                 /* Clear graceful stop bits */
599                 dma_flags &= ~(TSEC_DMACTRL_GRS | TSEC_DMACTRL_GTS);
600                 break;
601         default:
602                 device_printf(dev, "tsec_dma_ctl(): unknown state value: %d\n",
603                     state);
604         }
605
606         TSEC_WRITE(sc, TSEC_REG_DMACTRL, dma_flags);
607
608         switch (state) {
609         case 0:
610                 /* Wait for DMA stop */
611                 timeout = TSEC_READ_RETRY;
612                 while (--timeout && (!(TSEC_READ(sc, TSEC_REG_IEVENT) &
613                     (TSEC_IEVENT_GRSC | TSEC_IEVENT_GTSC))))
614                         DELAY(TSEC_READ_DELAY);
615
616                 if (timeout == 0)
617                         device_printf(dev, "tsec_dma_ctl(): timeout!\n");
618                 break;
619         case 1:
620                 /* Restart transmission function */
621                 TSEC_WRITE(sc, TSEC_REG_TSTAT, TSEC_TSTAT_THLT);
622         }
623 }
624
625 /*
626  * Interrupts control function, if argument state is:
627  * 0 - all TSEC interrupts will be masked
628  * 1 - all TSEC interrupts will be unmasked
629  */
630 static void
631 tsec_intrs_ctl(struct tsec_softc *sc, int state)
632 {
633         device_t dev;
634
635         dev = sc->dev;
636
637         switch (state) {
638         case 0:
639                 TSEC_WRITE(sc, TSEC_REG_IMASK, 0);
640                 break;
641         case 1:
642                 TSEC_WRITE(sc, TSEC_REG_IMASK, TSEC_IMASK_BREN |
643                     TSEC_IMASK_RXCEN | TSEC_IMASK_BSYEN | TSEC_IMASK_EBERREN |
644                     TSEC_IMASK_BTEN | TSEC_IMASK_TXEEN | TSEC_IMASK_TXBEN |
645                     TSEC_IMASK_TXFEN | TSEC_IMASK_XFUNEN | TSEC_IMASK_RXFEN);
646                 break;
647         default:
648                 device_printf(dev, "tsec_intrs_ctl(): unknown state value: %d\n",
649                     state);
650         }
651 }
652
653 static void
654 tsec_reset_mac(struct tsec_softc *sc)
655 {
656         uint32_t maccfg1_flags;
657
658         /* Set soft reset bit */
659         maccfg1_flags = TSEC_READ(sc, TSEC_REG_MACCFG1);
660         maccfg1_flags |= TSEC_MACCFG1_SOFT_RESET;
661         TSEC_WRITE(sc, TSEC_REG_MACCFG1, maccfg1_flags);
662
663         /* Clear soft reset bit */
664         maccfg1_flags = TSEC_READ(sc, TSEC_REG_MACCFG1);
665         maccfg1_flags &= ~TSEC_MACCFG1_SOFT_RESET;
666         TSEC_WRITE(sc, TSEC_REG_MACCFG1, maccfg1_flags);
667 }
668
669 static void
670 tsec_watchdog(struct tsec_softc *sc)
671 {
672         struct ifnet *ifp;
673
674         TSEC_GLOBAL_LOCK_ASSERT(sc);
675
676         if (sc->tsec_watchdog == 0 || --sc->tsec_watchdog > 0)
677                 return;
678
679         ifp = sc->tsec_ifp;
680         ifp->if_oerrors++;
681         if_printf(ifp, "watchdog timeout\n");
682
683         tsec_stop(sc);
684         tsec_init_locked(sc);
685 }
686
687 static void
688 tsec_start(struct ifnet *ifp)
689 {
690         struct tsec_softc *sc = ifp->if_softc;
691
692         TSEC_TRANSMIT_LOCK(sc);
693         tsec_start_locked(ifp);
694         TSEC_TRANSMIT_UNLOCK(sc);
695 }
696
697 static void
698 tsec_start_locked(struct ifnet *ifp)
699 {
700         struct tsec_softc *sc;
701         struct mbuf *m0, *mtmp;
702         struct tsec_tx_fcb *tx_fcb;
703         unsigned int queued = 0;
704         int csum_flags, fcb_inserted = 0;
705
706         sc = ifp->if_softc;
707
708         TSEC_TRANSMIT_LOCK_ASSERT(sc);
709
710         if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
711             IFF_DRV_RUNNING)
712                 return;
713
714         if (sc->tsec_link == 0)
715                 return;
716
717         bus_dmamap_sync(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
718             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
719
720         while (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) {
721                 /* Get packet from the queue */
722                 IFQ_DRV_DEQUEUE(&ifp->if_snd, m0);
723                 if (m0 == NULL)
724                         break;
725
726                 /* Insert TCP/IP Off-load frame control block */
727                 csum_flags = m0->m_pkthdr.csum_flags;
728                 if (csum_flags) {
729
730                         M_PREPEND(m0, sizeof(struct tsec_tx_fcb), M_NOWAIT);
731                         if (m0 == NULL)
732                                 break;
733
734                         tx_fcb = mtod(m0, struct tsec_tx_fcb *);
735                         tx_fcb->flags = 0;
736                         tx_fcb->l3_offset = ETHER_HDR_LEN;
737                         tx_fcb->l4_offset = sizeof(struct ip);
738
739                         if (csum_flags & CSUM_IP)
740                                 tx_fcb->flags |= TSEC_TX_FCB_IP4 |
741                                     TSEC_TX_FCB_CSUM_IP;
742
743                         if (csum_flags & CSUM_TCP)
744                                 tx_fcb->flags |= TSEC_TX_FCB_TCP |
745                                     TSEC_TX_FCB_CSUM_TCP_UDP;
746
747                         if (csum_flags & CSUM_UDP)
748                                 tx_fcb->flags |= TSEC_TX_FCB_UDP |
749                                     TSEC_TX_FCB_CSUM_TCP_UDP;
750
751                         fcb_inserted = 1;
752                 }
753
754                 mtmp = m_defrag(m0, M_NOWAIT);
755                 if (mtmp)
756                         m0 = mtmp;
757
758                 if (tsec_encap(sc, m0, fcb_inserted)) {
759                         IFQ_DRV_PREPEND(&ifp->if_snd, m0);
760                         ifp->if_drv_flags |= IFF_DRV_OACTIVE;
761                         break;
762                 }
763                 queued++;
764                 BPF_MTAP(ifp, m0);
765         }
766         bus_dmamap_sync(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
767             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
768
769         if (queued) {
770                 /* Enable transmitter and watchdog timer */
771                 TSEC_WRITE(sc, TSEC_REG_TSTAT, TSEC_TSTAT_THLT);
772                 sc->tsec_watchdog = 5;
773         }
774 }
775
776 static int
777 tsec_encap(struct tsec_softc *sc, struct mbuf *m0, int fcb_inserted)
778 {
779         struct tsec_desc *tx_desc = NULL;
780         struct ifnet *ifp;
781         bus_dma_segment_t segs[TSEC_TX_NUM_DESC];
782         bus_dmamap_t *mapp;
783         int csum_flag = 0, error, seg, nsegs;
784
785         TSEC_TRANSMIT_LOCK_ASSERT(sc);
786
787         ifp = sc->tsec_ifp;
788
789         if (TSEC_FREE_TX_DESC(sc) == 0) {
790                 /* No free descriptors */
791                 return (-1);
792         }
793
794         /* Fetch unused map */
795         mapp = TSEC_ALLOC_TX_MAP(sc);
796
797         /* Create mapping in DMA memory */
798         error = bus_dmamap_load_mbuf_sg(sc->tsec_tx_mtag,
799             *mapp, m0, segs, &nsegs, BUS_DMA_NOWAIT);
800         if (error != 0 || nsegs > TSEC_FREE_TX_DESC(sc) || nsegs <= 0) {
801                 bus_dmamap_unload(sc->tsec_tx_mtag, *mapp);
802                 TSEC_FREE_TX_MAP(sc, mapp);
803                 return ((error != 0) ? error : -1);
804         }
805         bus_dmamap_sync(sc->tsec_tx_mtag, *mapp, BUS_DMASYNC_PREWRITE);
806
807         if ((ifp->if_flags & IFF_DEBUG) && (nsegs > 1))
808                 if_printf(ifp, "TX buffer has %d segments\n", nsegs);
809
810         if (fcb_inserted)
811                 csum_flag = TSEC_TXBD_TOE;
812
813         /* Everything is ok, now we can send buffers */
814         for (seg = 0; seg < nsegs; seg++) {
815                 tx_desc = TSEC_GET_CUR_TX_DESC(sc);
816
817                 tx_desc->length = segs[seg].ds_len;
818                 tx_desc->bufptr = segs[seg].ds_addr;
819
820                 /*
821                  * Set flags:
822                  *   - wrap
823                  *   - checksum
824                  *   - ready to send
825                  *   - transmit the CRC sequence after the last data byte
826                  *   - interrupt after the last buffer
827                  */
828                 tx_desc->flags =
829                     (tx_desc->flags & TSEC_TXBD_W) |
830                     ((seg == 0) ? csum_flag : 0) | TSEC_TXBD_R | TSEC_TXBD_TC |
831                     ((seg == nsegs - 1) ? TSEC_TXBD_L | TSEC_TXBD_I : 0);
832         }
833
834         /* Save mbuf and DMA mapping for release at later stage */
835         TSEC_PUT_TX_MBUF(sc, m0);
836         TSEC_PUT_TX_MAP(sc, mapp);
837
838         return (0);
839 }
840
841 static void
842 tsec_setfilter(struct tsec_softc *sc)
843 {
844         struct ifnet *ifp;
845         uint32_t flags;
846
847         ifp = sc->tsec_ifp;
848         flags = TSEC_READ(sc, TSEC_REG_RCTRL);
849
850         /* Promiscuous mode */
851         if (ifp->if_flags & IFF_PROMISC)
852                 flags |= TSEC_RCTRL_PROM;
853         else
854                 flags &= ~TSEC_RCTRL_PROM;
855
856         TSEC_WRITE(sc, TSEC_REG_RCTRL, flags);
857 }
858
859 #ifdef DEVICE_POLLING
860 static poll_handler_t tsec_poll;
861
862 static int
863 tsec_poll(struct ifnet *ifp, enum poll_cmd cmd, int count)
864 {
865         uint32_t ie;
866         struct tsec_softc *sc = ifp->if_softc;
867         int rx_npkts;
868
869         rx_npkts = 0;
870
871         TSEC_GLOBAL_LOCK(sc);
872         if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
873                 TSEC_GLOBAL_UNLOCK(sc);
874                 return (rx_npkts);
875         }
876
877         if (cmd == POLL_AND_CHECK_STATUS) {
878                 tsec_error_intr_locked(sc, count);
879
880                 /* Clear all events reported */
881                 ie = TSEC_READ(sc, TSEC_REG_IEVENT);
882                 TSEC_WRITE(sc, TSEC_REG_IEVENT, ie);
883         }
884
885         tsec_transmit_intr_locked(sc);
886
887         TSEC_GLOBAL_TO_RECEIVE_LOCK(sc);
888
889         rx_npkts = tsec_receive_intr_locked(sc, count);
890
891         TSEC_RECEIVE_UNLOCK(sc);
892
893         return (rx_npkts);
894 }
895 #endif /* DEVICE_POLLING */
896
897 static int
898 tsec_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
899 {
900         struct tsec_softc *sc = ifp->if_softc;
901         struct ifreq *ifr = (struct ifreq *)data;
902         device_t dev;
903         int mask, error = 0;
904
905         dev = sc->dev;
906
907         switch (command) {
908         case SIOCSIFMTU:
909                 TSEC_GLOBAL_LOCK(sc);
910                 if (tsec_set_mtu(sc, ifr->ifr_mtu))
911                         ifp->if_mtu = ifr->ifr_mtu;
912                 else
913                         error = EINVAL;
914                 TSEC_GLOBAL_UNLOCK(sc);
915                 break;
916         case SIOCSIFFLAGS:
917                 TSEC_GLOBAL_LOCK(sc);
918                 if (ifp->if_flags & IFF_UP) {
919                         if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
920                                 if ((sc->tsec_if_flags ^ ifp->if_flags) &
921                                     IFF_PROMISC)
922                                         tsec_setfilter(sc);
923
924                                 if ((sc->tsec_if_flags ^ ifp->if_flags) &
925                                     IFF_ALLMULTI)
926                                         tsec_setup_multicast(sc);
927                         } else
928                                 tsec_init_locked(sc);
929                 } else if (ifp->if_drv_flags & IFF_DRV_RUNNING)
930                         tsec_stop(sc);
931
932                 sc->tsec_if_flags = ifp->if_flags;
933                 TSEC_GLOBAL_UNLOCK(sc);
934                 break;
935         case SIOCADDMULTI:
936         case SIOCDELMULTI:
937                 if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
938                         TSEC_GLOBAL_LOCK(sc);
939                         tsec_setup_multicast(sc);
940                         TSEC_GLOBAL_UNLOCK(sc);
941                 }
942         case SIOCGIFMEDIA:
943         case SIOCSIFMEDIA:
944                 error = ifmedia_ioctl(ifp, ifr, &sc->tsec_mii->mii_media,
945                     command);
946                 break;
947         case SIOCSIFCAP:
948                 mask = ifp->if_capenable ^ ifr->ifr_reqcap;
949                 if ((mask & IFCAP_HWCSUM) && sc->is_etsec) {
950                         TSEC_GLOBAL_LOCK(sc);
951                         ifp->if_capenable &= ~IFCAP_HWCSUM;
952                         ifp->if_capenable |= IFCAP_HWCSUM & ifr->ifr_reqcap;
953                         tsec_offload_setup(sc);
954                         TSEC_GLOBAL_UNLOCK(sc);
955                 }
956 #ifdef DEVICE_POLLING
957                 if (mask & IFCAP_POLLING) {
958                         if (ifr->ifr_reqcap & IFCAP_POLLING) {
959                                 error = ether_poll_register(tsec_poll, ifp);
960                                 if (error)
961                                         return (error);
962
963                                 TSEC_GLOBAL_LOCK(sc);
964                                 /* Disable interrupts */
965                                 tsec_intrs_ctl(sc, 0);
966                                 ifp->if_capenable |= IFCAP_POLLING;
967                                 TSEC_GLOBAL_UNLOCK(sc);
968                         } else {
969                                 error = ether_poll_deregister(ifp);
970                                 TSEC_GLOBAL_LOCK(sc);
971                                 /* Enable interrupts */
972                                 tsec_intrs_ctl(sc, 1);
973                                 ifp->if_capenable &= ~IFCAP_POLLING;
974                                 TSEC_GLOBAL_UNLOCK(sc);
975                         }
976                 }
977 #endif
978                 break;
979
980         default:
981                 error = ether_ioctl(ifp, command, data);
982         }
983
984         /* Flush buffers if not empty */
985         if (ifp->if_flags & IFF_UP)
986                 tsec_start(ifp);
987         return (error);
988 }
989
990 static int
991 tsec_ifmedia_upd(struct ifnet *ifp)
992 {
993         struct tsec_softc *sc = ifp->if_softc;
994         struct mii_data *mii;
995
996         TSEC_TRANSMIT_LOCK(sc);
997
998         mii = sc->tsec_mii;
999         mii_mediachg(mii);
1000
1001         TSEC_TRANSMIT_UNLOCK(sc);
1002         return (0);
1003 }
1004
1005 static void
1006 tsec_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
1007 {
1008         struct tsec_softc *sc = ifp->if_softc;
1009         struct mii_data *mii;
1010
1011         TSEC_TRANSMIT_LOCK(sc);
1012
1013         mii = sc->tsec_mii;
1014         mii_pollstat(mii);
1015
1016         ifmr->ifm_active = mii->mii_media_active;
1017         ifmr->ifm_status = mii->mii_media_status;
1018
1019         TSEC_TRANSMIT_UNLOCK(sc);
1020 }
1021
1022 static int
1023 tsec_new_rxbuf(bus_dma_tag_t tag, bus_dmamap_t map, struct mbuf **mbufp,
1024     uint32_t *paddr)
1025 {
1026         struct mbuf *new_mbuf;
1027         bus_dma_segment_t seg[1];
1028         int error, nsegs;
1029
1030         KASSERT(mbufp != NULL, ("NULL mbuf pointer!"));
1031
1032         new_mbuf = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, MCLBYTES);
1033         if (new_mbuf == NULL)
1034                 return (ENOBUFS);
1035         new_mbuf->m_len = new_mbuf->m_pkthdr.len = new_mbuf->m_ext.ext_size;
1036
1037         if (*mbufp) {
1038                 bus_dmamap_sync(tag, map, BUS_DMASYNC_POSTREAD);
1039                 bus_dmamap_unload(tag, map);
1040         }
1041
1042         error = bus_dmamap_load_mbuf_sg(tag, map, new_mbuf, seg, &nsegs,
1043             BUS_DMA_NOWAIT);
1044         KASSERT(nsegs == 1, ("Too many segments returned!"));
1045         if (nsegs != 1 || error)
1046                 panic("tsec_new_rxbuf(): nsegs(%d), error(%d)", nsegs, error);
1047
1048 #if 0
1049         if (error) {
1050                 printf("tsec: bus_dmamap_load_mbuf_sg() returned: %d!\n",
1051                         error);
1052                 m_freem(new_mbuf);
1053                 return (ENOBUFS);
1054         }
1055 #endif
1056
1057 #if 0
1058         KASSERT(((seg->ds_addr) & (TSEC_RXBUFFER_ALIGNMENT-1)) == 0,
1059                 ("Wrong alignment of RX buffer!"));
1060 #endif
1061         bus_dmamap_sync(tag, map, BUS_DMASYNC_PREREAD);
1062
1063         (*mbufp) = new_mbuf;
1064         (*paddr) = seg->ds_addr;
1065         return (0);
1066 }
1067
1068 static void
1069 tsec_map_dma_addr(void *arg, bus_dma_segment_t *segs, int nseg, int error)
1070 {
1071         u_int32_t *paddr;
1072
1073         KASSERT(nseg == 1, ("wrong number of segments, should be 1"));
1074         paddr = arg;
1075         *paddr = segs->ds_addr;
1076 }
1077
1078 static int
1079 tsec_alloc_dma_desc(device_t dev, bus_dma_tag_t *dtag, bus_dmamap_t *dmap,
1080     bus_size_t dsize, void **vaddr, void *raddr, const char *dname)
1081 {
1082         int error;
1083
1084         /* Allocate a busdma tag and DMA safe memory for TX/RX descriptors. */
1085         error = bus_dma_tag_create(NULL,        /* parent */
1086             PAGE_SIZE, 0,                       /* alignment, boundary */
1087             BUS_SPACE_MAXADDR_32BIT,            /* lowaddr */
1088             BUS_SPACE_MAXADDR,                  /* highaddr */
1089             NULL, NULL,                         /* filtfunc, filtfuncarg */
1090             dsize, 1,                           /* maxsize, nsegments */
1091             dsize, 0,                           /* maxsegsz, flags */
1092             NULL, NULL,                         /* lockfunc, lockfuncarg */
1093             dtag);                              /* dmat */
1094
1095         if (error) {
1096                 device_printf(dev, "failed to allocate busdma %s tag\n",
1097                     dname);
1098                 (*vaddr) = NULL;
1099                 return (ENXIO);
1100         }
1101
1102         error = bus_dmamem_alloc(*dtag, vaddr, BUS_DMA_NOWAIT | BUS_DMA_ZERO,
1103             dmap);
1104         if (error) {
1105                 device_printf(dev, "failed to allocate %s DMA safe memory\n",
1106                     dname);
1107                 bus_dma_tag_destroy(*dtag);
1108                 (*vaddr) = NULL;
1109                 return (ENXIO);
1110         }
1111
1112         error = bus_dmamap_load(*dtag, *dmap, *vaddr, dsize,
1113             tsec_map_dma_addr, raddr, BUS_DMA_NOWAIT);
1114         if (error) {
1115                 device_printf(dev, "cannot get address of the %s "
1116                     "descriptors\n", dname);
1117                 bus_dmamem_free(*dtag, *vaddr, *dmap);
1118                 bus_dma_tag_destroy(*dtag);
1119                 (*vaddr) = NULL;
1120                 return (ENXIO);
1121         }
1122
1123         return (0);
1124 }
1125
1126 static void
1127 tsec_free_dma_desc(bus_dma_tag_t dtag, bus_dmamap_t dmap, void *vaddr)
1128 {
1129
1130         if (vaddr == NULL)
1131                 return;
1132
1133         /* Unmap descriptors from DMA memory */
1134         bus_dmamap_sync(dtag, dmap, BUS_DMASYNC_POSTREAD |
1135             BUS_DMASYNC_POSTWRITE);
1136         bus_dmamap_unload(dtag, dmap);
1137
1138         /* Free descriptors memory */
1139         bus_dmamem_free(dtag, vaddr, dmap);
1140
1141         /* Destroy descriptors tag */
1142         bus_dma_tag_destroy(dtag);
1143 }
1144
1145 static void
1146 tsec_free_dma(struct tsec_softc *sc)
1147 {
1148         int i;
1149
1150         /* Free TX maps */
1151         for (i = 0; i < TSEC_TX_NUM_DESC; i++)
1152                 if (sc->tx_map_data[i] != NULL)
1153                         bus_dmamap_destroy(sc->tsec_tx_mtag,
1154                             sc->tx_map_data[i]);
1155         /* Destroy tag for TX mbufs */
1156         bus_dma_tag_destroy(sc->tsec_tx_mtag);
1157
1158         /* Free RX mbufs and maps */
1159         for (i = 0; i < TSEC_RX_NUM_DESC; i++) {
1160                 if (sc->rx_data[i].mbuf) {
1161                         /* Unload buffer from DMA */
1162                         bus_dmamap_sync(sc->tsec_rx_mtag, sc->rx_data[i].map,
1163                             BUS_DMASYNC_POSTREAD);
1164                         bus_dmamap_unload(sc->tsec_rx_mtag,
1165                             sc->rx_data[i].map);
1166
1167                         /* Free buffer */
1168                         m_freem(sc->rx_data[i].mbuf);
1169                 }
1170                 /* Destroy map for this buffer */
1171                 if (sc->rx_data[i].map != NULL)
1172                         bus_dmamap_destroy(sc->tsec_rx_mtag,
1173                             sc->rx_data[i].map);
1174         }
1175         /* Destroy tag for RX mbufs */
1176         bus_dma_tag_destroy(sc->tsec_rx_mtag);
1177
1178         /* Unload TX/RX descriptors */
1179         tsec_free_dma_desc(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
1180             sc->tsec_tx_vaddr);
1181         tsec_free_dma_desc(sc->tsec_rx_dtag, sc->tsec_rx_dmap,
1182             sc->tsec_rx_vaddr);
1183 }
1184
1185 static void
1186 tsec_stop(struct tsec_softc *sc)
1187 {
1188         struct ifnet *ifp;
1189         struct mbuf *m0;
1190         bus_dmamap_t *mapp;
1191         uint32_t tmpval;
1192
1193         TSEC_GLOBAL_LOCK_ASSERT(sc);
1194
1195         ifp = sc->tsec_ifp;
1196
1197         /* Disable interface and watchdog timer */
1198         callout_stop(&sc->tsec_callout);
1199         ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
1200         sc->tsec_watchdog = 0;
1201
1202         /* Disable all interrupts and stop DMA */
1203         tsec_intrs_ctl(sc, 0);
1204         tsec_dma_ctl(sc, 0);
1205
1206         /* Remove pending data from TX queue */
1207         while (!TSEC_EMPTYQ_TX_MBUF(sc)) {
1208                 m0 = TSEC_GET_TX_MBUF(sc);
1209                 mapp = TSEC_GET_TX_MAP(sc);
1210
1211                 bus_dmamap_sync(sc->tsec_tx_mtag, *mapp,
1212                     BUS_DMASYNC_POSTWRITE);
1213                 bus_dmamap_unload(sc->tsec_tx_mtag, *mapp);
1214
1215                 TSEC_FREE_TX_MAP(sc, mapp);
1216                 m_freem(m0);
1217         }
1218
1219         /* Disable RX and TX */
1220         tmpval = TSEC_READ(sc, TSEC_REG_MACCFG1);
1221         tmpval &= ~(TSEC_MACCFG1_RX_EN | TSEC_MACCFG1_TX_EN);
1222         TSEC_WRITE(sc, TSEC_REG_MACCFG1, tmpval);
1223         DELAY(10);
1224 }
1225
1226 static void
1227 tsec_tick(void *arg)
1228 {
1229         struct tsec_softc *sc = arg;
1230         struct ifnet *ifp;
1231         int link;
1232
1233         TSEC_GLOBAL_LOCK(sc);
1234
1235         tsec_watchdog(sc);
1236
1237         ifp = sc->tsec_ifp;
1238         link = sc->tsec_link;
1239
1240         mii_tick(sc->tsec_mii);
1241
1242         if (link == 0 && sc->tsec_link == 1 &&
1243             (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)))
1244                 tsec_start_locked(ifp);
1245
1246         /* Schedule another timeout one second from now. */
1247         callout_reset(&sc->tsec_callout, hz, tsec_tick, sc);
1248
1249         TSEC_GLOBAL_UNLOCK(sc);
1250 }
1251
1252 /*
1253  *  This is the core RX routine. It replenishes mbufs in the descriptor and
1254  *  sends data which have been dma'ed into host memory to upper layer.
1255  *
1256  *  Loops at most count times if count is > 0, or until done if count < 0.
1257  */
1258 static int
1259 tsec_receive_intr_locked(struct tsec_softc *sc, int count)
1260 {
1261         struct tsec_desc *rx_desc;
1262         struct ifnet *ifp;
1263         struct rx_data_type *rx_data;
1264         struct mbuf *m;
1265         device_t dev;
1266         uint32_t i;
1267         int c, rx_npkts;
1268         uint16_t flags;
1269
1270         TSEC_RECEIVE_LOCK_ASSERT(sc);
1271
1272         ifp = sc->tsec_ifp;
1273         rx_data = sc->rx_data;
1274         dev = sc->dev;
1275         rx_npkts = 0;
1276
1277         bus_dmamap_sync(sc->tsec_rx_dtag, sc->tsec_rx_dmap,
1278             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1279
1280         for (c = 0; ; c++) {
1281                 if (count >= 0 && count-- == 0)
1282                         break;
1283
1284                 rx_desc = TSEC_GET_CUR_RX_DESC(sc);
1285                 flags = rx_desc->flags;
1286
1287                 /* Check if there is anything to receive */
1288                 if ((flags & TSEC_RXBD_E) || (c >= TSEC_RX_NUM_DESC)) {
1289                         /*
1290                          * Avoid generating another interrupt
1291                          */
1292                         if (flags & TSEC_RXBD_E)
1293                                 TSEC_WRITE(sc, TSEC_REG_IEVENT,
1294                                     TSEC_IEVENT_RXB | TSEC_IEVENT_RXF);
1295                         /*
1296                          * We didn't consume current descriptor and have to
1297                          * return it to the queue
1298                          */
1299                         TSEC_BACK_CUR_RX_DESC(sc);
1300                         break;
1301                 }
1302
1303                 if (flags & (TSEC_RXBD_LG | TSEC_RXBD_SH | TSEC_RXBD_NO |
1304                     TSEC_RXBD_CR | TSEC_RXBD_OV | TSEC_RXBD_TR)) {
1305
1306                         rx_desc->length = 0;
1307                         rx_desc->flags = (rx_desc->flags &
1308                             ~TSEC_RXBD_ZEROONINIT) | TSEC_RXBD_E | TSEC_RXBD_I;
1309
1310                         if (sc->frame != NULL) {
1311                                 m_free(sc->frame);
1312                                 sc->frame = NULL;
1313                         }
1314
1315                         continue;
1316                 }
1317
1318                 /* Ok... process frame */
1319                 i = TSEC_GET_CUR_RX_DESC_CNT(sc);
1320                 m = rx_data[i].mbuf;
1321                 m->m_len = rx_desc->length;
1322
1323                 if (sc->frame != NULL) {
1324                         if ((flags & TSEC_RXBD_L) != 0)
1325                                 m->m_len -= m_length(sc->frame, NULL);
1326
1327                         m->m_flags &= ~M_PKTHDR;
1328                         m_cat(sc->frame, m);
1329                 } else {
1330                         sc->frame = m;
1331                 }
1332
1333                 m = NULL;
1334
1335                 if ((flags & TSEC_RXBD_L) != 0) {
1336                         m = sc->frame;
1337                         sc->frame = NULL;
1338                 }
1339
1340                 if (tsec_new_rxbuf(sc->tsec_rx_mtag, rx_data[i].map,
1341                     &rx_data[i].mbuf, &rx_data[i].paddr)) {
1342                         ifp->if_ierrors++;
1343                         /*
1344                          * We ran out of mbufs; didn't consume current
1345                          * descriptor and have to return it to the queue.
1346                          */
1347                         TSEC_BACK_CUR_RX_DESC(sc);
1348                         break;
1349                 }
1350
1351                 /* Attach new buffer to descriptor and clear flags */
1352                 rx_desc->bufptr = rx_data[i].paddr;
1353                 rx_desc->length = 0;
1354                 rx_desc->flags = (rx_desc->flags & ~TSEC_RXBD_ZEROONINIT) |
1355                     TSEC_RXBD_E | TSEC_RXBD_I;
1356
1357                 if (m != NULL) {
1358                         m->m_pkthdr.rcvif = ifp;
1359
1360                         m_fixhdr(m);
1361                         m_adj(m, -ETHER_CRC_LEN);
1362
1363                         if (sc->is_etsec)
1364                                 tsec_offload_process_frame(sc, m);
1365
1366                         TSEC_RECEIVE_UNLOCK(sc);
1367                         (*ifp->if_input)(ifp, m);
1368                         TSEC_RECEIVE_LOCK(sc);
1369                         rx_npkts++;
1370                 }
1371         }
1372
1373         bus_dmamap_sync(sc->tsec_rx_dtag, sc->tsec_rx_dmap,
1374             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1375
1376         /*
1377          * Make sure TSEC receiver is not halted.
1378          *
1379          * Various conditions can stop the TSEC receiver, but not all are
1380          * signaled and handled by error interrupt, so make sure the receiver
1381          * is running. Writing to TSEC_REG_RSTAT restarts the receiver when
1382          * halted, and is harmless if already running.
1383          */
1384         TSEC_WRITE(sc, TSEC_REG_RSTAT, TSEC_RSTAT_QHLT);
1385         return (rx_npkts);
1386 }
1387
1388 void
1389 tsec_receive_intr(void *arg)
1390 {
1391         struct tsec_softc *sc = arg;
1392
1393         TSEC_RECEIVE_LOCK(sc);
1394
1395 #ifdef DEVICE_POLLING
1396         if (sc->tsec_ifp->if_capenable & IFCAP_POLLING) {
1397                 TSEC_RECEIVE_UNLOCK(sc);
1398                 return;
1399         }
1400 #endif
1401
1402         /* Confirm the interrupt was received by driver */
1403         TSEC_WRITE(sc, TSEC_REG_IEVENT, TSEC_IEVENT_RXB | TSEC_IEVENT_RXF);
1404         tsec_receive_intr_locked(sc, -1);
1405
1406         TSEC_RECEIVE_UNLOCK(sc);
1407 }
1408
1409 static void
1410 tsec_transmit_intr_locked(struct tsec_softc *sc)
1411 {
1412         struct tsec_desc *tx_desc;
1413         struct ifnet *ifp;
1414         struct mbuf *m0;
1415         bus_dmamap_t *mapp;
1416         int send = 0;
1417
1418         TSEC_TRANSMIT_LOCK_ASSERT(sc);
1419
1420         ifp = sc->tsec_ifp;
1421
1422         /* Update collision statistics */
1423         ifp->if_collisions += TSEC_READ(sc, TSEC_REG_MON_TNCL);
1424
1425         /* Reset collision counters in hardware */
1426         TSEC_WRITE(sc, TSEC_REG_MON_TSCL, 0);
1427         TSEC_WRITE(sc, TSEC_REG_MON_TMCL, 0);
1428         TSEC_WRITE(sc, TSEC_REG_MON_TLCL, 0);
1429         TSEC_WRITE(sc, TSEC_REG_MON_TXCL, 0);
1430         TSEC_WRITE(sc, TSEC_REG_MON_TNCL, 0);
1431
1432         bus_dmamap_sync(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
1433             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1434
1435         while (TSEC_CUR_DIFF_DIRTY_TX_DESC(sc)) {
1436                 tx_desc = TSEC_GET_DIRTY_TX_DESC(sc);
1437                 if (tx_desc->flags & TSEC_TXBD_R) {
1438                         TSEC_BACK_DIRTY_TX_DESC(sc);
1439                         break;
1440                 }
1441
1442                 if ((tx_desc->flags & TSEC_TXBD_L) == 0)
1443                         continue;
1444
1445                 /*
1446                  * This is the last buf in this packet, so unmap and free it.
1447                  */
1448                 m0 = TSEC_GET_TX_MBUF(sc);
1449                 mapp = TSEC_GET_TX_MAP(sc);
1450
1451                 bus_dmamap_sync(sc->tsec_tx_mtag, *mapp,
1452                     BUS_DMASYNC_POSTWRITE);
1453                 bus_dmamap_unload(sc->tsec_tx_mtag, *mapp);
1454
1455                 TSEC_FREE_TX_MAP(sc, mapp);
1456                 m_freem(m0);
1457
1458                 ifp->if_opackets++;
1459                 send = 1;
1460         }
1461         bus_dmamap_sync(sc->tsec_tx_dtag, sc->tsec_tx_dmap,
1462             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1463
1464         if (send) {
1465                 /* Now send anything that was pending */
1466                 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1467                 tsec_start_locked(ifp);
1468
1469                 /* Stop wathdog if all sent */
1470                 if (TSEC_EMPTYQ_TX_MBUF(sc))
1471                         sc->tsec_watchdog = 0;
1472         }
1473 }
1474
1475 void
1476 tsec_transmit_intr(void *arg)
1477 {
1478         struct tsec_softc *sc = arg;
1479
1480         TSEC_TRANSMIT_LOCK(sc);
1481
1482 #ifdef DEVICE_POLLING
1483         if (sc->tsec_ifp->if_capenable & IFCAP_POLLING) {
1484                 TSEC_TRANSMIT_UNLOCK(sc);
1485                 return;
1486         }
1487 #endif
1488         /* Confirm the interrupt was received by driver */
1489         TSEC_WRITE(sc, TSEC_REG_IEVENT, TSEC_IEVENT_TXB | TSEC_IEVENT_TXF);
1490         tsec_transmit_intr_locked(sc);
1491
1492         TSEC_TRANSMIT_UNLOCK(sc);
1493 }
1494
1495 static void
1496 tsec_error_intr_locked(struct tsec_softc *sc, int count)
1497 {
1498         struct ifnet *ifp;
1499         uint32_t eflags;
1500
1501         TSEC_GLOBAL_LOCK_ASSERT(sc);
1502
1503         ifp = sc->tsec_ifp;
1504
1505         eflags = TSEC_READ(sc, TSEC_REG_IEVENT);
1506
1507         /* Clear events bits in hardware */
1508         TSEC_WRITE(sc, TSEC_REG_IEVENT, TSEC_IEVENT_RXC | TSEC_IEVENT_BSY |
1509             TSEC_IEVENT_EBERR | TSEC_IEVENT_MSRO | TSEC_IEVENT_BABT |
1510             TSEC_IEVENT_TXC | TSEC_IEVENT_TXE | TSEC_IEVENT_LC |
1511             TSEC_IEVENT_CRL | TSEC_IEVENT_XFUN);
1512
1513         /* Check transmitter errors */
1514         if (eflags & TSEC_IEVENT_TXE) {
1515                 ifp->if_oerrors++;
1516
1517                 if (eflags & TSEC_IEVENT_LC)
1518                         ifp->if_collisions++;
1519
1520                 TSEC_WRITE(sc, TSEC_REG_TSTAT, TSEC_TSTAT_THLT);
1521         }
1522
1523         /* Check receiver errors */
1524         if (eflags & TSEC_IEVENT_BSY) {
1525                 ifp->if_ierrors++;
1526                 ifp->if_iqdrops++;
1527
1528                 /* Get data from RX buffers */
1529                 tsec_receive_intr_locked(sc, count);
1530         }
1531
1532         if (ifp->if_flags & IFF_DEBUG)
1533                 if_printf(ifp, "tsec_error_intr(): event flags: 0x%x\n",
1534                     eflags);
1535
1536         if (eflags & TSEC_IEVENT_EBERR) {
1537                 if_printf(ifp, "System bus error occurred during"
1538                     "DMA transaction (flags: 0x%x)\n", eflags);
1539                 tsec_init_locked(sc);
1540         }
1541
1542         if (eflags & TSEC_IEVENT_BABT)
1543                 ifp->if_oerrors++;
1544
1545         if (eflags & TSEC_IEVENT_BABR)
1546                 ifp->if_ierrors++;
1547 }
1548
1549 void
1550 tsec_error_intr(void *arg)
1551 {
1552         struct tsec_softc *sc = arg;
1553
1554         TSEC_GLOBAL_LOCK(sc);
1555         tsec_error_intr_locked(sc, -1);
1556         TSEC_GLOBAL_UNLOCK(sc);
1557 }
1558
1559 int
1560 tsec_miibus_readreg(device_t dev, int phy, int reg)
1561 {
1562         struct tsec_softc *sc;
1563         uint32_t timeout;
1564
1565         sc = device_get_softc(dev);
1566
1567         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMADD, (phy << 8) | reg);
1568         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMCOM, 0);
1569         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMCOM, TSEC_MIIMCOM_READCYCLE);
1570
1571         timeout = TSEC_READ_RETRY;
1572         while (--timeout && TSEC_READ(sc->phy_sc, TSEC_REG_MIIMIND) &
1573             (TSEC_MIIMIND_NOTVALID | TSEC_MIIMIND_BUSY))
1574                 DELAY(TSEC_READ_DELAY);
1575
1576         if (timeout == 0)
1577                 device_printf(dev, "Timeout while reading from PHY!\n");
1578
1579         return (TSEC_READ(sc->phy_sc, TSEC_REG_MIIMSTAT));
1580 }
1581
1582 int
1583 tsec_miibus_writereg(device_t dev, int phy, int reg, int value)
1584 {
1585         struct tsec_softc *sc;
1586         uint32_t timeout;
1587
1588         sc = device_get_softc(dev);
1589
1590         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMADD, (phy << 8) | reg);
1591         TSEC_WRITE(sc->phy_sc, TSEC_REG_MIIMCON, value);
1592
1593         timeout = TSEC_READ_RETRY;
1594         while (--timeout && (TSEC_READ(sc->phy_sc, TSEC_REG_MIIMIND) &
1595             TSEC_MIIMIND_BUSY))
1596                 DELAY(TSEC_READ_DELAY);
1597
1598         if (timeout == 0)
1599                 device_printf(dev, "Timeout while writing to PHY!\n");
1600
1601         return (0);
1602 }
1603
1604 void
1605 tsec_miibus_statchg(device_t dev)
1606 {
1607         struct tsec_softc *sc;
1608         struct mii_data *mii;
1609         uint32_t ecntrl, id, tmp;
1610         int link;
1611
1612         sc = device_get_softc(dev);
1613         mii = sc->tsec_mii;
1614         link = ((mii->mii_media_status & IFM_ACTIVE) ? 1 : 0);
1615
1616         tmp = TSEC_READ(sc, TSEC_REG_MACCFG2) & ~TSEC_MACCFG2_IF;
1617
1618         if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
1619                 tmp |= TSEC_MACCFG2_FULLDUPLEX;
1620         else
1621                 tmp &= ~TSEC_MACCFG2_FULLDUPLEX;
1622
1623         switch (IFM_SUBTYPE(mii->mii_media_active)) {
1624         case IFM_1000_T:
1625         case IFM_1000_SX:
1626                 tmp |= TSEC_MACCFG2_GMII;
1627                 sc->tsec_link = link;
1628                 break;
1629         case IFM_100_TX:
1630         case IFM_10_T:
1631                 tmp |= TSEC_MACCFG2_MII;
1632                 sc->tsec_link = link;
1633                 break;
1634         case IFM_NONE:
1635                 if (link)
1636                         device_printf(dev, "No speed selected but link "
1637                             "active!\n");
1638                 sc->tsec_link = 0;
1639                 return;
1640         default:
1641                 sc->tsec_link = 0;
1642                 device_printf(dev, "Unknown speed (%d), link %s!\n",
1643                     IFM_SUBTYPE(mii->mii_media_active),
1644                         ((link) ? "up" : "down"));
1645                 return;
1646         }
1647         TSEC_WRITE(sc, TSEC_REG_MACCFG2, tmp);
1648
1649         /* XXX kludge - use circumstantial evidence for reduced mode. */
1650         id = TSEC_READ(sc, TSEC_REG_ID2);
1651         if (id & 0xffff) {
1652                 ecntrl = TSEC_READ(sc, TSEC_REG_ECNTRL) & ~TSEC_ECNTRL_R100M;
1653                 ecntrl |= (tmp & TSEC_MACCFG2_MII) ? TSEC_ECNTRL_R100M : 0;
1654                 TSEC_WRITE(sc, TSEC_REG_ECNTRL, ecntrl);
1655         }
1656 }
1657
1658 static void
1659 tsec_add_sysctls(struct tsec_softc *sc)
1660 {
1661         struct sysctl_ctx_list *ctx;
1662         struct sysctl_oid_list *children;
1663         struct sysctl_oid *tree;
1664
1665         ctx = device_get_sysctl_ctx(sc->dev);
1666         children = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->dev));
1667         tree = SYSCTL_ADD_NODE(ctx, children, OID_AUTO, "int_coal",
1668             CTLFLAG_RD, 0, "TSEC Interrupts coalescing");
1669         children = SYSCTL_CHILDREN(tree);
1670
1671         SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_time",
1672             CTLTYPE_UINT | CTLFLAG_RW, sc, TSEC_IC_RX, tsec_sysctl_ic_time,
1673             "I", "IC RX time threshold (0-65535)");
1674         SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "rx_count",
1675             CTLTYPE_UINT | CTLFLAG_RW, sc, TSEC_IC_RX, tsec_sysctl_ic_count,
1676             "I", "IC RX frame count threshold (0-255)");
1677
1678         SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_time",
1679             CTLTYPE_UINT | CTLFLAG_RW, sc, TSEC_IC_TX, tsec_sysctl_ic_time,
1680             "I", "IC TX time threshold (0-65535)");
1681         SYSCTL_ADD_PROC(ctx, children, OID_AUTO, "tx_count",
1682             CTLTYPE_UINT | CTLFLAG_RW, sc, TSEC_IC_TX, tsec_sysctl_ic_count,
1683             "I", "IC TX frame count threshold (0-255)");
1684 }
1685
1686 /*
1687  * With Interrupt Coalescing (IC) active, a transmit/receive frame
1688  * interrupt is raised either upon:
1689  *
1690  * - threshold-defined period of time elapsed, or
1691  * - threshold-defined number of frames is received/transmitted,
1692  *   whichever occurs first.
1693  *
1694  * The following sysctls regulate IC behaviour (for TX/RX separately):
1695  *
1696  * dev.tsec.<unit>.int_coal.rx_time
1697  * dev.tsec.<unit>.int_coal.rx_count
1698  * dev.tsec.<unit>.int_coal.tx_time
1699  * dev.tsec.<unit>.int_coal.tx_count
1700  *
1701  * Values:
1702  *
1703  * - 0 for either time or count disables IC on the given TX/RX path
1704  *
1705  * - count: 1-255 (expresses frame count number; note that value of 1 is
1706  *   effectively IC off)
1707  *
1708  * - time: 1-65535 (value corresponds to a real time period and is
1709  *   expressed in units equivalent to 64 TSEC interface clocks, i.e. one timer
1710  *   threshold unit is 26.5 us, 2.56 us, or 512 ns, corresponding to 10 Mbps,
1711  *   100 Mbps, or 1Gbps, respectively. For detailed discussion consult the
1712  *   TSEC reference manual.
1713  */
1714 static int
1715 tsec_sysctl_ic_time(SYSCTL_HANDLER_ARGS)
1716 {
1717         int error;
1718         uint32_t time;
1719         struct tsec_softc *sc = (struct tsec_softc *)arg1;
1720
1721         time = (arg2 == TSEC_IC_RX) ? sc->rx_ic_time : sc->tx_ic_time;
1722
1723         error = sysctl_handle_int(oidp, &time, 0, req);
1724         if (error != 0)
1725                 return (error);
1726
1727         if (time > 65535)
1728                 return (EINVAL);
1729
1730         TSEC_IC_LOCK(sc);
1731         if (arg2 == TSEC_IC_RX) {
1732                 sc->rx_ic_time = time;
1733                 tsec_set_rxic(sc);
1734         } else {
1735                 sc->tx_ic_time = time;
1736                 tsec_set_txic(sc);
1737         }
1738         TSEC_IC_UNLOCK(sc);
1739
1740         return (0);
1741 }
1742
1743 static int
1744 tsec_sysctl_ic_count(SYSCTL_HANDLER_ARGS)
1745 {
1746         int error;
1747         uint32_t count;
1748         struct tsec_softc *sc = (struct tsec_softc *)arg1;
1749
1750         count = (arg2 == TSEC_IC_RX) ? sc->rx_ic_count : sc->tx_ic_count;
1751
1752         error = sysctl_handle_int(oidp, &count, 0, req);
1753         if (error != 0)
1754                 return (error);
1755
1756         if (count > 255)
1757                 return (EINVAL);
1758
1759         TSEC_IC_LOCK(sc);
1760         if (arg2 == TSEC_IC_RX) {
1761                 sc->rx_ic_count = count;
1762                 tsec_set_rxic(sc);
1763         } else {
1764                 sc->tx_ic_count = count;
1765                 tsec_set_txic(sc);
1766         }
1767         TSEC_IC_UNLOCK(sc);
1768
1769         return (0);
1770 }
1771
1772 static void
1773 tsec_set_rxic(struct tsec_softc *sc)
1774 {
1775         uint32_t rxic_val;
1776
1777         if (sc->rx_ic_count == 0 || sc->rx_ic_time == 0)
1778                 /* Disable RX IC */
1779                 rxic_val = 0;
1780         else {
1781                 rxic_val = 0x80000000;
1782                 rxic_val |= (sc->rx_ic_count << 21);
1783                 rxic_val |= sc->rx_ic_time;
1784         }
1785
1786         TSEC_WRITE(sc, TSEC_REG_RXIC, rxic_val);
1787 }
1788
1789 static void
1790 tsec_set_txic(struct tsec_softc *sc)
1791 {
1792         uint32_t txic_val;
1793
1794         if (sc->tx_ic_count == 0 || sc->tx_ic_time == 0)
1795                 /* Disable TX IC */
1796                 txic_val = 0;
1797         else {
1798                 txic_val = 0x80000000;
1799                 txic_val |= (sc->tx_ic_count << 21);
1800                 txic_val |= sc->tx_ic_time;
1801         }
1802
1803         TSEC_WRITE(sc, TSEC_REG_TXIC, txic_val);
1804 }
1805
1806 static void
1807 tsec_offload_setup(struct tsec_softc *sc)
1808 {
1809         struct ifnet *ifp = sc->tsec_ifp;
1810         uint32_t reg;
1811
1812         TSEC_GLOBAL_LOCK_ASSERT(sc);
1813
1814         reg = TSEC_READ(sc, TSEC_REG_TCTRL);
1815         reg |= TSEC_TCTRL_IPCSEN | TSEC_TCTRL_TUCSEN;
1816
1817         if (ifp->if_capenable & IFCAP_TXCSUM)
1818                 ifp->if_hwassist = TSEC_CHECKSUM_FEATURES;
1819         else
1820                 ifp->if_hwassist = 0;
1821
1822         TSEC_WRITE(sc, TSEC_REG_TCTRL, reg);
1823
1824         reg = TSEC_READ(sc, TSEC_REG_RCTRL);
1825         reg &= ~(TSEC_RCTRL_IPCSEN | TSEC_RCTRL_TUCSEN | TSEC_RCTRL_PRSDEP);
1826         reg |= TSEC_RCTRL_PRSDEP_PARSE_L2 | TSEC_RCTRL_VLEX;
1827
1828         if (ifp->if_capenable & IFCAP_RXCSUM)
1829                 reg |= TSEC_RCTRL_IPCSEN | TSEC_RCTRL_TUCSEN |
1830                     TSEC_RCTRL_PRSDEP_PARSE_L234;
1831
1832         TSEC_WRITE(sc, TSEC_REG_RCTRL, reg);
1833 }
1834
1835
1836 static void
1837 tsec_offload_process_frame(struct tsec_softc *sc, struct mbuf *m)
1838 {
1839         struct tsec_rx_fcb rx_fcb;
1840         int csum_flags = 0;
1841         int protocol, flags;
1842
1843         TSEC_RECEIVE_LOCK_ASSERT(sc);
1844
1845         m_copydata(m, 0, sizeof(struct tsec_rx_fcb), (caddr_t)(&rx_fcb));
1846         flags = rx_fcb.flags;
1847         protocol = rx_fcb.protocol;
1848
1849         if (TSEC_RX_FCB_IP_CSUM_CHECKED(flags)) {
1850                 csum_flags |= CSUM_IP_CHECKED;
1851
1852                 if ((flags & TSEC_RX_FCB_IP_CSUM_ERROR) == 0)
1853                         csum_flags |= CSUM_IP_VALID;
1854         }
1855
1856         if ((protocol == IPPROTO_TCP || protocol == IPPROTO_UDP) &&
1857             TSEC_RX_FCB_TCP_UDP_CSUM_CHECKED(flags) &&
1858             (flags & TSEC_RX_FCB_TCP_UDP_CSUM_ERROR) == 0) {
1859
1860                 csum_flags |= CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
1861                 m->m_pkthdr.csum_data = 0xFFFF;
1862         }
1863
1864         m->m_pkthdr.csum_flags = csum_flags;
1865
1866         if (flags & TSEC_RX_FCB_VLAN) {
1867                 m->m_pkthdr.ether_vtag = rx_fcb.vlan;
1868                 m->m_flags |= M_VLANTAG;
1869         }
1870
1871         m_adj(m, sizeof(struct tsec_rx_fcb));
1872 }
1873
1874 static void
1875 tsec_setup_multicast(struct tsec_softc *sc)
1876 {
1877         uint32_t hashtable[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
1878         struct ifnet *ifp = sc->tsec_ifp;
1879         struct ifmultiaddr *ifma;
1880         uint32_t h;
1881         int i;
1882
1883         TSEC_GLOBAL_LOCK_ASSERT(sc);
1884
1885         if (ifp->if_flags & IFF_ALLMULTI) {
1886                 for (i = 0; i < 8; i++)
1887                         TSEC_WRITE(sc, TSEC_REG_GADDR(i), 0xFFFFFFFF);
1888
1889                 return;
1890         }
1891
1892         if_maddr_rlock(ifp);
1893         TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
1894
1895                 if (ifma->ifma_addr->sa_family != AF_LINK)
1896                         continue;
1897
1898                 h = (ether_crc32_be(LLADDR((struct sockaddr_dl *)
1899                     ifma->ifma_addr), ETHER_ADDR_LEN) >> 24) & 0xFF;
1900
1901                 hashtable[(h >> 5)] |= 1 << (0x1F - (h & 0x1F));
1902         }
1903         if_maddr_runlock(ifp);
1904
1905         for (i = 0; i < 8; i++)
1906                 TSEC_WRITE(sc, TSEC_REG_GADDR(i), hashtable[i]);
1907 }
1908
1909 static int
1910 tsec_set_mtu(struct tsec_softc *sc, unsigned int mtu)
1911 {
1912
1913         mtu += ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN + ETHER_CRC_LEN;
1914
1915         TSEC_GLOBAL_LOCK_ASSERT(sc);
1916
1917         if (mtu >= TSEC_MIN_FRAME_SIZE && mtu <= TSEC_MAX_FRAME_SIZE) {
1918                 TSEC_WRITE(sc, TSEC_REG_MAXFRM, mtu);
1919                 return (mtu);
1920         }
1921
1922         return (0);
1923 }