]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/dev/txp/if_txp.c
Update elftoolchain to upstream rev 3130
[FreeBSD/FreeBSD.git] / sys / dev / txp / if_txp.c
1 /*      $OpenBSD: if_txp.c,v 1.48 2001/06/27 06:34:50 kjc Exp $ */
2
3 /*-
4  * Copyright (c) 2001
5  *      Jason L. Wright <jason@thought.net>, Theo de Raadt, and
6  *      Aaron Campbell <aaron@monkey.org>.  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 Jason L. Wright,
19  *      Theo de Raadt and Aaron Campbell.
20  * 4. Neither the name of the author nor the names of any co-contributors
21  *    may be used to endorse or promote products derived from this software
22  *    without specific prior written permission.
23  *
24  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
25  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
26  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27  * ARE DISCLAIMED.  IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
28  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
34  * THE POSSIBILITY OF SUCH DAMAGE.
35  */
36
37 #include <sys/cdefs.h>
38 __FBSDID("$FreeBSD$");
39
40 /*
41  * Driver for 3c990 (Typhoon) Ethernet ASIC
42  */
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/bus.h>
46 #include <sys/endian.h>
47 #include <sys/kernel.h>
48 #include <sys/lock.h>
49 #include <sys/malloc.h>
50 #include <sys/mbuf.h>
51 #include <sys/module.h>
52 #include <sys/mutex.h>
53 #include <sys/queue.h>
54 #include <sys/rman.h>
55 #include <sys/socket.h>
56 #include <sys/sockio.h>
57 #include <sys/sysctl.h>
58 #include <sys/taskqueue.h>
59
60 #include <net/bpf.h>
61 #include <net/if.h>
62 #include <net/if_var.h>
63 #include <net/if_arp.h>
64 #include <net/ethernet.h>
65 #include <net/if_dl.h>
66 #include <net/if_media.h>
67 #include <net/if_types.h>
68 #include <net/if_vlan_var.h>
69
70 #include <netinet/in.h>
71 #include <netinet/in_systm.h>
72 #include <netinet/ip.h>
73
74 #include <dev/mii/mii.h>
75
76 #include <dev/pci/pcireg.h>
77 #include <dev/pci/pcivar.h>
78
79 #include <machine/bus.h>
80 #include <machine/in_cksum.h>
81
82 #include <dev/txp/if_txpreg.h>
83 #include <dev/txp/3c990img.h>
84
85 MODULE_DEPEND(txp, pci, 1, 1, 1);
86 MODULE_DEPEND(txp, ether, 1, 1, 1);
87
88 /*
89  * XXX Known Typhoon firmware issues.
90  *
91  * 1. It seems that firmware has Tx TCP/UDP checksum offloading bug.
92  *    The firmware hangs when it's told to compute TCP/UDP checksum.
93  *    I'm not sure whether the firmware requires special alignment to
94  *    do checksum offloading but datasheet says nothing about that.
95  * 2. Datasheet says nothing for maximum number of fragmented
96  *    descriptors supported. Experimentation shows up to 16 fragment
97  *    descriptors are supported in the firmware. For TSO case, upper
98  *    stack can send 64KB sized IP datagram plus link header size(
99  *    ethernet header + VLAN tag)  frame but controller can handle up
100  *    to 64KB frame given that PAGE_SIZE is 4KB(i.e. 16 * PAGE_SIZE).
101  *    Because frames that need TSO operation of hardware can be
102  *    larger than 64KB I disabled TSO capability. TSO operation for
103  *    less than or equal to 16 fragment descriptors works without
104  *    problems, though.
105  * 3. VLAN hardware tag stripping is always enabled in the firmware
106  *    even if it's explicitly told to not strip the tag. It's
107  *    possible to add the tag back in Rx handler if VLAN hardware
108  *    tag is not active but I didn't try that as it would be
109  *    layering violation.
110  * 4. TXP_CMD_RECV_BUFFER_CONTROL does not work as expected in
111  *    datasheet such that driver should handle the alignment
112  *    restriction by copying received frame to align the frame on
113  *    32bit boundary on strict-alignment architectures. This adds a
114  *    lot of CPU burden and it effectively reduce Rx performance on
115  *    strict-alignment architectures(e.g. sparc64, arm and mips).
116  *
117  * Unfortunately it seems that 3Com have no longer interests in
118  * releasing fixed firmware so we may have to live with these bugs.
119  */
120
121 #define TXP_CSUM_FEATURES       (CSUM_IP)
122
123 /*
124  * Various supported device vendors/types and their names.
125  */
126 static struct txp_type txp_devs[] = {
127         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990_TX_95,
128             "3Com 3cR990-TX-95 Etherlink with 3XP Processor" },
129         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990_TX_97,
130             "3Com 3cR990-TX-97 Etherlink with 3XP Processor" },
131         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990B_TXM,
132             "3Com 3cR990B-TXM Etherlink with 3XP Processor" },
133         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990_SRV_95,
134             "3Com 3cR990-SRV-95 Etherlink Server with 3XP Processor" },
135         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990_SRV_97,
136             "3Com 3cR990-SRV-97 Etherlink Server with 3XP Processor" },
137         { TXP_VENDORID_3COM, TXP_DEVICEID_3CR990B_SRV,
138             "3Com 3cR990B-SRV Etherlink Server with 3XP Processor" },
139         { 0, 0, NULL }
140 };
141
142 static int txp_probe(device_t);
143 static int txp_attach(device_t);
144 static int txp_detach(device_t);
145 static int txp_shutdown(device_t);
146 static int txp_suspend(device_t);
147 static int txp_resume(device_t);
148 static int txp_intr(void *);
149 static void txp_int_task(void *, int);
150 static void txp_tick(void *);
151 static int txp_ioctl(struct ifnet *, u_long, caddr_t);
152 static uint64_t txp_get_counter(struct ifnet *, ift_counter);
153 static void txp_start(struct ifnet *);
154 static void txp_start_locked(struct ifnet *);
155 static int txp_encap(struct txp_softc *, struct txp_tx_ring *, struct mbuf **);
156 static void txp_stop(struct txp_softc *);
157 static void txp_init(void *);
158 static void txp_init_locked(struct txp_softc *);
159 static void txp_watchdog(struct txp_softc *);
160
161 static int txp_reset(struct txp_softc *);
162 static int txp_boot(struct txp_softc *, uint32_t);
163 static int txp_sleep(struct txp_softc *, int);
164 static int txp_wait(struct txp_softc *, uint32_t);
165 static int txp_download_fw(struct txp_softc *);
166 static int txp_download_fw_wait(struct txp_softc *);
167 static int txp_download_fw_section(struct txp_softc *,
168     struct txp_fw_section_header *, int);
169 static int txp_alloc_rings(struct txp_softc *);
170 static void txp_init_rings(struct txp_softc *);
171 static int txp_dma_alloc(struct txp_softc *, char *, bus_dma_tag_t *,
172     bus_size_t, bus_size_t, bus_dmamap_t *, void **, bus_size_t, bus_addr_t *);
173 static void txp_dma_free(struct txp_softc *, bus_dma_tag_t *, bus_dmamap_t,
174     void **, bus_addr_t *);
175 static void txp_free_rings(struct txp_softc *);
176 static int txp_rxring_fill(struct txp_softc *);
177 static void txp_rxring_empty(struct txp_softc *);
178 static void txp_set_filter(struct txp_softc *);
179
180 static int txp_cmd_desc_numfree(struct txp_softc *);
181 static int txp_command(struct txp_softc *, uint16_t, uint16_t, uint32_t,
182     uint32_t, uint16_t *, uint32_t *, uint32_t *, int);
183 static int txp_ext_command(struct txp_softc *, uint16_t, uint16_t,
184     uint32_t, uint32_t, struct txp_ext_desc *, uint8_t,
185     struct txp_rsp_desc **, int);
186 static int txp_response(struct txp_softc *, uint16_t, uint16_t,
187     struct txp_rsp_desc **);
188 static void txp_rsp_fixup(struct txp_softc *, struct txp_rsp_desc *,
189     struct txp_rsp_desc *);
190 static int txp_set_capabilities(struct txp_softc *);
191
192 static void txp_ifmedia_sts(struct ifnet *, struct ifmediareq *);
193 static int txp_ifmedia_upd(struct ifnet *);
194 #ifdef TXP_DEBUG
195 static void txp_show_descriptor(void *);
196 #endif
197 static void txp_tx_reclaim(struct txp_softc *, struct txp_tx_ring *);
198 static void txp_rxbuf_reclaim(struct txp_softc *);
199 #ifndef __NO_STRICT_ALIGNMENT
200 static __inline void txp_fixup_rx(struct mbuf *);
201 #endif
202 static int txp_rx_reclaim(struct txp_softc *, struct txp_rx_ring *, int);
203 static void txp_stats_save(struct txp_softc *);
204 static void txp_stats_update(struct txp_softc *, struct txp_rsp_desc *);
205 static void txp_sysctl_node(struct txp_softc *);
206 static int sysctl_int_range(SYSCTL_HANDLER_ARGS, int, int);
207 static int sysctl_hw_txp_proc_limit(SYSCTL_HANDLER_ARGS);
208
209 static int prefer_iomap = 0;
210 TUNABLE_INT("hw.txp.prefer_iomap", &prefer_iomap);
211
212 static device_method_t txp_methods[] = {
213         /* Device interface */
214         DEVMETHOD(device_probe,         txp_probe),
215         DEVMETHOD(device_attach,        txp_attach),
216         DEVMETHOD(device_detach,        txp_detach),
217         DEVMETHOD(device_shutdown,      txp_shutdown),
218         DEVMETHOD(device_suspend,       txp_suspend),
219         DEVMETHOD(device_resume,        txp_resume),
220
221         { NULL, NULL }
222 };
223
224 static driver_t txp_driver = {
225         "txp",
226         txp_methods,
227         sizeof(struct txp_softc)
228 };
229
230 static devclass_t txp_devclass;
231
232 DRIVER_MODULE(txp, pci, txp_driver, txp_devclass, 0, 0);
233
234 static int
235 txp_probe(device_t dev)
236 {
237         struct txp_type *t;
238
239         t = txp_devs;
240
241         while (t->txp_name != NULL) {
242                 if ((pci_get_vendor(dev) == t->txp_vid) &&
243                     (pci_get_device(dev) == t->txp_did)) {
244                         device_set_desc(dev, t->txp_name);
245                         return (BUS_PROBE_DEFAULT);
246                 }
247                 t++;
248         }
249
250         return (ENXIO);
251 }
252
253 static int
254 txp_attach(device_t dev)
255 {
256         struct txp_softc *sc;
257         struct ifnet *ifp;
258         struct txp_rsp_desc *rsp;
259         uint16_t p1;
260         uint32_t p2, reg;
261         int error = 0, pmc, rid;
262         uint8_t eaddr[ETHER_ADDR_LEN], *ver;
263
264         sc = device_get_softc(dev);
265         sc->sc_dev = dev;
266
267         mtx_init(&sc->sc_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK,
268             MTX_DEF);
269         callout_init_mtx(&sc->sc_tick, &sc->sc_mtx, 0);
270         TASK_INIT(&sc->sc_int_task, 0, txp_int_task, sc);
271         TAILQ_INIT(&sc->sc_busy_list);
272         TAILQ_INIT(&sc->sc_free_list);
273
274         ifmedia_init(&sc->sc_ifmedia, 0, txp_ifmedia_upd, txp_ifmedia_sts);
275         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_10_T, 0, NULL);
276         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 0, NULL);
277         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 0, NULL);
278         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL);
279         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 0, NULL);
280         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 0, NULL);
281         ifmedia_add(&sc->sc_ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL);
282
283         pci_enable_busmaster(dev);
284         /* Prefer memory space register mapping over IO space. */
285         if (prefer_iomap == 0) {
286                 sc->sc_res_id = PCIR_BAR(1);
287                 sc->sc_res_type = SYS_RES_MEMORY;
288         } else {
289                 sc->sc_res_id = PCIR_BAR(0);
290                 sc->sc_res_type = SYS_RES_IOPORT;
291         }
292         sc->sc_res = bus_alloc_resource_any(dev, sc->sc_res_type,
293             &sc->sc_res_id, RF_ACTIVE);
294         if (sc->sc_res == NULL && prefer_iomap == 0) {
295                 sc->sc_res_id = PCIR_BAR(0);
296                 sc->sc_res_type = SYS_RES_IOPORT;
297                 sc->sc_res = bus_alloc_resource_any(dev, sc->sc_res_type,
298                     &sc->sc_res_id, RF_ACTIVE);
299         }
300         if (sc->sc_res == NULL) {
301                 device_printf(dev, "couldn't map ports/memory\n");
302                 ifmedia_removeall(&sc->sc_ifmedia);
303                 mtx_destroy(&sc->sc_mtx);
304                 return (ENXIO);
305         }
306
307         /* Enable MWI. */
308         reg = pci_read_config(dev, PCIR_COMMAND, 2);
309         reg |= PCIM_CMD_MWRICEN;
310         pci_write_config(dev, PCIR_COMMAND, reg, 2);
311         /* Check cache line size. */
312         reg = pci_read_config(dev, PCIR_CACHELNSZ, 1);
313         reg <<= 4;
314         if (reg == 0 || (reg % 16) != 0)
315                 device_printf(sc->sc_dev,
316                     "invalid cache line size : %u\n", reg);
317
318         /* Allocate interrupt */
319         rid = 0;
320         sc->sc_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
321             RF_SHAREABLE | RF_ACTIVE);
322
323         if (sc->sc_irq == NULL) {
324                 device_printf(dev, "couldn't map interrupt\n");
325                 error = ENXIO;
326                 goto fail;
327         }
328
329         if ((error = txp_alloc_rings(sc)) != 0)
330                 goto fail;
331         txp_init_rings(sc);
332         txp_sysctl_node(sc);
333         /* Reset controller and make it reload sleep image. */
334         if (txp_reset(sc) != 0) {
335                 error = ENXIO;
336                 goto fail;
337         }
338
339         /* Let controller boot from sleep image. */
340         if (txp_boot(sc, STAT_WAITING_FOR_HOST_REQUEST) != 0) {
341                 device_printf(sc->sc_dev, "could not boot sleep image\n");
342                 error = ENXIO;
343                 goto fail;
344         }
345
346         /* Get station address. */
347         if (txp_command(sc, TXP_CMD_STATION_ADDRESS_READ, 0, 0, 0,
348             &p1, &p2, NULL, TXP_CMD_WAIT)) {
349                 error = ENXIO;
350                 goto fail;
351         }
352
353         p1 = le16toh(p1);
354         eaddr[0] = ((uint8_t *)&p1)[1];
355         eaddr[1] = ((uint8_t *)&p1)[0];
356         p2 = le32toh(p2);
357         eaddr[2] = ((uint8_t *)&p2)[3];
358         eaddr[3] = ((uint8_t *)&p2)[2];
359         eaddr[4] = ((uint8_t *)&p2)[1];
360         eaddr[5] = ((uint8_t *)&p2)[0];
361
362         ifp = sc->sc_ifp = if_alloc(IFT_ETHER);
363         if (ifp == NULL) {
364                 device_printf(dev, "can not allocate ifnet structure\n");
365                 error = ENOSPC;
366                 goto fail;
367         }
368
369         /*
370          * Show sleep image version information which may help to
371          * diagnose sleep image specific issues.
372          */
373         rsp = NULL;
374         if (txp_ext_command(sc, TXP_CMD_READ_VERSION, 0, 0, 0, NULL, 0,
375             &rsp, TXP_CMD_WAIT)) {
376                 device_printf(dev, "can not read sleep image version\n");
377                 error = ENXIO;
378                 goto fail;
379         }
380         if (rsp->rsp_numdesc == 0) {
381                 p2 = le32toh(rsp->rsp_par2) & 0xFFFF;
382                 device_printf(dev, "Typhoon 1.0 sleep image (2000/%02u/%02u)\n",
383                     p2 >> 8, p2 & 0xFF);
384         } else if (rsp->rsp_numdesc == 2) {
385                 p2 = le32toh(rsp->rsp_par2);
386                 ver = (uint8_t *)(rsp + 1);
387                 /*
388                  * Even if datasheet says the command returns a NULL
389                  * terminated version string, explicitly terminate
390                  * the string. Given that several bugs of firmware
391                  * I can't trust this simple one.
392                  */
393                 ver[25] = '\0';
394                 device_printf(dev,
395                     "Typhoon 1.1+ sleep image %02u.%03u.%03u %s\n",
396                     p2 >> 24, (p2 >> 12) & 0xFFF, p2 & 0xFFF, ver);
397         } else {
398                 p2 = le32toh(rsp->rsp_par2);
399                 device_printf(dev,
400                     "Unknown Typhoon sleep image version: %u:0x%08x\n",
401                     rsp->rsp_numdesc, p2);
402         }
403         if (rsp != NULL)
404                 free(rsp, M_DEVBUF);
405
406         sc->sc_xcvr = TXP_XCVR_AUTO;
407         txp_command(sc, TXP_CMD_XCVR_SELECT, TXP_XCVR_AUTO, 0, 0,
408             NULL, NULL, NULL, TXP_CMD_NOWAIT);
409         ifmedia_set(&sc->sc_ifmedia, IFM_ETHER | IFM_AUTO);
410
411         ifp->if_softc = sc;
412         if_initname(ifp, device_get_name(dev), device_get_unit(dev));
413         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
414         ifp->if_ioctl = txp_ioctl;
415         ifp->if_start = txp_start;
416         ifp->if_init = txp_init;
417         ifp->if_get_counter = txp_get_counter;
418         ifp->if_snd.ifq_drv_maxlen = TX_ENTRIES - 1;
419         IFQ_SET_MAXLEN(&ifp->if_snd, ifp->if_snd.ifq_drv_maxlen);
420         IFQ_SET_READY(&ifp->if_snd);
421         /*
422          * It's possible to read firmware's offload capability but
423          * we have not downloaded the firmware yet so announce
424          * working capability here. We're not interested in IPSec
425          * capability and due to the lots of firmware bug we can't
426          * advertise the whole capability anyway.
427          */
428         ifp->if_capabilities = IFCAP_RXCSUM | IFCAP_TXCSUM;
429         if (pci_find_cap(dev, PCIY_PMG, &pmc) == 0)
430                 ifp->if_capabilities |= IFCAP_WOL_MAGIC;
431         /* Enable all capabilities. */
432         ifp->if_capenable = ifp->if_capabilities;
433
434         ether_ifattach(ifp, eaddr);
435
436         /* VLAN capability setup. */
437         ifp->if_capabilities |= IFCAP_VLAN_MTU;
438         ifp->if_capabilities |= IFCAP_VLAN_HWTAGGING | IFCAP_VLAN_HWCSUM;
439         ifp->if_capenable = ifp->if_capabilities;
440         /* Tell the upper layer(s) we support long frames. */
441         ifp->if_hdrlen = sizeof(struct ether_vlan_header);
442
443         WRITE_REG(sc, TXP_IER, TXP_INTR_NONE);
444         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
445
446         /* Create local taskq. */
447         sc->sc_tq = taskqueue_create_fast("txp_taskq", M_WAITOK,
448             taskqueue_thread_enqueue, &sc->sc_tq);
449         if (sc->sc_tq == NULL) {
450                 device_printf(dev, "could not create taskqueue.\n");
451                 ether_ifdetach(ifp);
452                 error = ENXIO;
453                 goto fail;
454         }
455         taskqueue_start_threads(&sc->sc_tq, 1, PI_NET, "%s taskq",
456             device_get_nameunit(sc->sc_dev));
457
458         /* Put controller into sleep. */
459         if (txp_sleep(sc, 0) != 0) {
460                 ether_ifdetach(ifp);
461                 error = ENXIO;
462                 goto fail;
463         }
464
465         error = bus_setup_intr(dev, sc->sc_irq, INTR_TYPE_NET | INTR_MPSAFE,
466             txp_intr, NULL, sc, &sc->sc_intrhand);
467
468         if (error != 0) {
469                 ether_ifdetach(ifp);
470                 device_printf(dev, "couldn't set up interrupt handler.\n");
471                 goto fail;
472         }
473
474         return (0);
475
476 fail:
477         if (error != 0)
478                 txp_detach(dev);
479         return (error);
480 }
481
482 static int
483 txp_detach(device_t dev)
484 {
485         struct txp_softc *sc;
486         struct ifnet *ifp;
487
488         sc = device_get_softc(dev);
489
490         ifp = sc->sc_ifp;
491         if (device_is_attached(dev)) {
492                 TXP_LOCK(sc);
493                 sc->sc_flags |= TXP_FLAG_DETACH;
494                 txp_stop(sc);
495                 TXP_UNLOCK(sc);
496                 callout_drain(&sc->sc_tick);
497                 taskqueue_drain(sc->sc_tq, &sc->sc_int_task);
498                 ether_ifdetach(ifp);
499         }
500         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
501
502         ifmedia_removeall(&sc->sc_ifmedia);
503         if (sc->sc_intrhand != NULL)
504                 bus_teardown_intr(dev, sc->sc_irq, sc->sc_intrhand);
505         if (sc->sc_irq != NULL)
506                 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->sc_irq);
507         if (sc->sc_res != NULL)
508                 bus_release_resource(dev, sc->sc_res_type, sc->sc_res_id,
509                     sc->sc_res);
510         if (sc->sc_ifp != NULL) {
511                 if_free(sc->sc_ifp);
512                 sc->sc_ifp = NULL;
513         }
514         txp_free_rings(sc);
515         mtx_destroy(&sc->sc_mtx);
516
517         return (0);
518 }
519
520 static int
521 txp_reset(struct txp_softc *sc)
522 {
523         uint32_t r;
524         int i;
525
526         /* Disable interrupts. */
527         WRITE_REG(sc, TXP_IER, TXP_INTR_NONE);
528         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
529         /* Ack all pending interrupts. */
530         WRITE_REG(sc, TXP_ISR, TXP_INTR_ALL);
531
532         r = 0;
533         WRITE_REG(sc, TXP_SRR, TXP_SRR_ALL);
534         DELAY(1000);
535         WRITE_REG(sc, TXP_SRR, 0);
536
537         /* Should wait max 6 seconds. */
538         for (i = 0; i < 6000; i++) {
539                 r = READ_REG(sc, TXP_A2H_0);
540                 if (r == STAT_WAITING_FOR_HOST_REQUEST)
541                         break;
542                 DELAY(1000);
543         }
544
545         if (r != STAT_WAITING_FOR_HOST_REQUEST)
546                 device_printf(sc->sc_dev, "reset hung\n");
547
548         WRITE_REG(sc, TXP_IER, TXP_INTR_NONE);
549         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
550         WRITE_REG(sc, TXP_ISR, TXP_INTR_ALL);
551
552         /*
553          * Give more time to complete loading sleep image before
554          * trying to boot from sleep image.
555          */
556         DELAY(5000);
557
558         return (0);
559 }
560
561 static int
562 txp_boot(struct txp_softc *sc, uint32_t state)
563 {
564
565         /* See if it's waiting for boot, and try to boot it. */
566         if (txp_wait(sc, state) != 0) {
567                 device_printf(sc->sc_dev, "not waiting for boot\n");
568                 return (ENXIO);
569         }
570
571         WRITE_REG(sc, TXP_H2A_2, TXP_ADDR_HI(sc->sc_ldata.txp_boot_paddr));
572         TXP_BARRIER(sc, TXP_H2A_2, 4, BUS_SPACE_BARRIER_WRITE);
573         WRITE_REG(sc, TXP_H2A_1, TXP_ADDR_LO(sc->sc_ldata.txp_boot_paddr));
574         TXP_BARRIER(sc, TXP_H2A_1, 4, BUS_SPACE_BARRIER_WRITE);
575         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_REGISTER_BOOT_RECORD);
576         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
577
578         /* See if it booted. */
579         if (txp_wait(sc, STAT_RUNNING) != 0) {
580                 device_printf(sc->sc_dev, "firmware not running\n");
581                 return (ENXIO);
582         }
583
584         /* Clear TX and CMD ring write registers. */
585         WRITE_REG(sc, TXP_H2A_1, TXP_BOOTCMD_NULL);
586         TXP_BARRIER(sc, TXP_H2A_1, 4, BUS_SPACE_BARRIER_WRITE);
587         WRITE_REG(sc, TXP_H2A_2, TXP_BOOTCMD_NULL);
588         TXP_BARRIER(sc, TXP_H2A_2, 4, BUS_SPACE_BARRIER_WRITE);
589         WRITE_REG(sc, TXP_H2A_3, TXP_BOOTCMD_NULL);
590         TXP_BARRIER(sc, TXP_H2A_3, 4, BUS_SPACE_BARRIER_WRITE);
591         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_NULL);
592         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
593
594         return (0);
595 }
596
597 static int
598 txp_download_fw(struct txp_softc *sc)
599 {
600         struct txp_fw_file_header *fileheader;
601         struct txp_fw_section_header *secthead;
602         int sect;
603         uint32_t error, ier, imr;
604
605         TXP_LOCK_ASSERT(sc);
606
607         error = 0;
608         ier = READ_REG(sc, TXP_IER);
609         WRITE_REG(sc, TXP_IER, ier | TXP_INT_A2H_0);
610
611         imr = READ_REG(sc, TXP_IMR);
612         WRITE_REG(sc, TXP_IMR, imr | TXP_INT_A2H_0);
613
614         if (txp_wait(sc, STAT_WAITING_FOR_HOST_REQUEST) != 0) {
615                 device_printf(sc->sc_dev, "not waiting for host request\n");
616                 error = ETIMEDOUT;
617                 goto fail;
618         }
619
620         /* Ack the status. */
621         WRITE_REG(sc, TXP_ISR, TXP_INT_A2H_0);
622
623         fileheader = (struct txp_fw_file_header *)tc990image;
624         if (bcmp("TYPHOON", fileheader->magicid, sizeof(fileheader->magicid))) {
625                 device_printf(sc->sc_dev, "firmware invalid magic\n");
626                 goto fail;
627         }
628
629         /* Tell boot firmware to get ready for image. */
630         WRITE_REG(sc, TXP_H2A_1, le32toh(fileheader->addr));
631         TXP_BARRIER(sc, TXP_H2A_1, 4, BUS_SPACE_BARRIER_WRITE);
632         WRITE_REG(sc, TXP_H2A_2, le32toh(fileheader->hmac[0]));
633         TXP_BARRIER(sc, TXP_H2A_2, 4, BUS_SPACE_BARRIER_WRITE);
634         WRITE_REG(sc, TXP_H2A_3, le32toh(fileheader->hmac[1]));
635         TXP_BARRIER(sc, TXP_H2A_3, 4, BUS_SPACE_BARRIER_WRITE);
636         WRITE_REG(sc, TXP_H2A_4, le32toh(fileheader->hmac[2]));
637         TXP_BARRIER(sc, TXP_H2A_4, 4, BUS_SPACE_BARRIER_WRITE);
638         WRITE_REG(sc, TXP_H2A_5, le32toh(fileheader->hmac[3]));
639         TXP_BARRIER(sc, TXP_H2A_5, 4, BUS_SPACE_BARRIER_WRITE);
640         WRITE_REG(sc, TXP_H2A_6, le32toh(fileheader->hmac[4]));
641         TXP_BARRIER(sc, TXP_H2A_6, 4, BUS_SPACE_BARRIER_WRITE);
642         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_RUNTIME_IMAGE);
643         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
644
645         if (txp_download_fw_wait(sc)) {
646                 device_printf(sc->sc_dev, "firmware wait failed, initial\n");
647                 error = ETIMEDOUT;
648                 goto fail;
649         }
650
651         secthead = (struct txp_fw_section_header *)(((uint8_t *)tc990image) +
652             sizeof(struct txp_fw_file_header));
653
654         for (sect = 0; sect < le32toh(fileheader->nsections); sect++) {
655                 if ((error = txp_download_fw_section(sc, secthead, sect)) != 0)
656                         goto fail;
657                 secthead = (struct txp_fw_section_header *)
658                     (((uint8_t *)secthead) + le32toh(secthead->nbytes) +
659                     sizeof(*secthead));
660         }
661
662         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_DOWNLOAD_COMPLETE);
663         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
664
665         if (txp_wait(sc, STAT_WAITING_FOR_BOOT) != 0) {
666                 device_printf(sc->sc_dev, "not waiting for boot\n");
667                 error = ETIMEDOUT;
668                 goto fail;
669         }
670
671 fail:
672         WRITE_REG(sc, TXP_IER, ier);
673         WRITE_REG(sc, TXP_IMR, imr);
674
675         return (error);
676 }
677
678 static int
679 txp_download_fw_wait(struct txp_softc *sc)
680 {
681         uint32_t i;
682
683         TXP_LOCK_ASSERT(sc);
684
685         for (i = 0; i < TXP_TIMEOUT; i++) {
686                 if ((READ_REG(sc, TXP_ISR) & TXP_INT_A2H_0) != 0)
687                         break;
688                 DELAY(50);
689         }
690
691         if (i == TXP_TIMEOUT) {
692                 device_printf(sc->sc_dev, "firmware wait failed comm0\n");
693                 return (ETIMEDOUT);
694         }
695
696         WRITE_REG(sc, TXP_ISR, TXP_INT_A2H_0);
697
698         if (READ_REG(sc, TXP_A2H_0) != STAT_WAITING_FOR_SEGMENT) {
699                 device_printf(sc->sc_dev, "firmware not waiting for segment\n");
700                 return (ETIMEDOUT);
701         }
702         return (0);
703 }
704
705 static int
706 txp_download_fw_section(struct txp_softc *sc,
707     struct txp_fw_section_header *sect, int sectnum)
708 {
709         bus_dma_tag_t sec_tag;
710         bus_dmamap_t sec_map;
711         bus_addr_t sec_paddr;
712         uint8_t *sec_buf;
713         int rseg, err = 0;
714         struct mbuf m;
715         uint16_t csum;
716
717         TXP_LOCK_ASSERT(sc);
718
719         /* Skip zero length sections. */
720         if (le32toh(sect->nbytes) == 0)
721                 return (0);
722
723         /* Make sure we aren't past the end of the image. */
724         rseg = ((uint8_t *)sect) - ((uint8_t *)tc990image);
725         if (rseg >= sizeof(tc990image)) {
726                 device_printf(sc->sc_dev,
727                     "firmware invalid section address, section %d\n", sectnum);
728                 return (EIO);
729         }
730
731         /* Make sure this section doesn't go past the end. */
732         rseg += le32toh(sect->nbytes);
733         if (rseg >= sizeof(tc990image)) {
734                 device_printf(sc->sc_dev, "firmware truncated section %d\n",
735                     sectnum);
736                 return (EIO);
737         }
738
739         sec_tag = NULL;
740         sec_map = NULL;
741         sec_buf = NULL;
742         /* XXX */
743         TXP_UNLOCK(sc);
744         err = txp_dma_alloc(sc, "firmware sections", &sec_tag, sizeof(uint32_t),
745             0, &sec_map, (void **)&sec_buf, le32toh(sect->nbytes), &sec_paddr);
746         TXP_LOCK(sc);
747         if (err != 0)
748                 goto bail;
749         bcopy(((uint8_t *)sect) + sizeof(*sect), sec_buf,
750             le32toh(sect->nbytes));
751
752         /*
753          * dummy up mbuf and verify section checksum
754          */
755         m.m_type = MT_DATA;
756         m.m_next = m.m_nextpkt = NULL;
757         m.m_len = le32toh(sect->nbytes);
758         m.m_data = sec_buf;
759         m.m_flags = 0;
760         csum = in_cksum(&m, le32toh(sect->nbytes));
761         if (csum != sect->cksum) {
762                 device_printf(sc->sc_dev,
763                     "firmware section %d, bad cksum (expected 0x%x got 0x%x)\n",
764                     sectnum, le16toh(sect->cksum), csum);
765                 err = EIO;
766                 goto bail;
767         }
768
769         bus_dmamap_sync(sec_tag, sec_map, BUS_DMASYNC_PREWRITE);
770
771         WRITE_REG(sc, TXP_H2A_1, le32toh(sect->nbytes));
772         TXP_BARRIER(sc, TXP_H2A_1, 4, BUS_SPACE_BARRIER_WRITE);
773         WRITE_REG(sc, TXP_H2A_2, le16toh(sect->cksum));
774         TXP_BARRIER(sc, TXP_H2A_2, 4, BUS_SPACE_BARRIER_WRITE);
775         WRITE_REG(sc, TXP_H2A_3, le32toh(sect->addr));
776         TXP_BARRIER(sc, TXP_H2A_3, 4, BUS_SPACE_BARRIER_WRITE);
777         WRITE_REG(sc, TXP_H2A_4, TXP_ADDR_HI(sec_paddr));
778         TXP_BARRIER(sc, TXP_H2A_4, 4, BUS_SPACE_BARRIER_WRITE);
779         WRITE_REG(sc, TXP_H2A_5, TXP_ADDR_LO(sec_paddr));
780         TXP_BARRIER(sc, TXP_H2A_5, 4, BUS_SPACE_BARRIER_WRITE);
781         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_SEGMENT_AVAILABLE);
782         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
783
784         if (txp_download_fw_wait(sc)) {
785                 device_printf(sc->sc_dev,
786                     "firmware wait failed, section %d\n", sectnum);
787                 err = ETIMEDOUT;
788         }
789
790         bus_dmamap_sync(sec_tag, sec_map, BUS_DMASYNC_POSTWRITE);
791 bail:
792         txp_dma_free(sc, &sec_tag, sec_map, (void **)&sec_buf, &sec_paddr);
793         return (err);
794 }
795
796 static int
797 txp_intr(void *vsc)
798 {
799         struct txp_softc *sc;
800         uint32_t status;
801
802         sc = vsc;
803         status = READ_REG(sc, TXP_ISR);
804         if ((status & TXP_INT_LATCH) == 0)
805                 return (FILTER_STRAY);
806         WRITE_REG(sc, TXP_ISR, status);
807         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
808         taskqueue_enqueue(sc->sc_tq, &sc->sc_int_task);
809
810         return (FILTER_HANDLED);
811 }
812
813 static void
814 txp_int_task(void *arg, int pending)
815 {
816         struct txp_softc *sc;
817         struct ifnet *ifp;
818         struct txp_hostvar *hv;
819         uint32_t isr;
820         int more;
821
822         sc = (struct txp_softc *)arg;
823
824         TXP_LOCK(sc);
825         ifp = sc->sc_ifp;
826         hv = sc->sc_hostvar;
827         isr = READ_REG(sc, TXP_ISR);
828         if ((isr & TXP_INT_LATCH) != 0)
829                 WRITE_REG(sc, TXP_ISR, isr);
830
831         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) {
832                 bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
833                     sc->sc_cdata.txp_hostvar_map,
834                     BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
835                 more = 0;
836                 if ((*sc->sc_rxhir.r_roff) != (*sc->sc_rxhir.r_woff))
837                         more += txp_rx_reclaim(sc, &sc->sc_rxhir,
838                             sc->sc_process_limit);
839                 if ((*sc->sc_rxlor.r_roff) != (*sc->sc_rxlor.r_woff))
840                         more += txp_rx_reclaim(sc, &sc->sc_rxlor,
841                             sc->sc_process_limit);
842                 /*
843                  * XXX
844                  * It seems controller is not smart enough to handle
845                  * FIFO overflow conditions under heavy network load.
846                  * No matter how often new Rx buffers are passed to
847                  * controller the situation didn't change. Maybe
848                  * flow-control would be the only way to mitigate the
849                  * issue but firmware does not have commands that
850                  * control the threshold of emitting pause frames.
851                  */
852                 if (hv->hv_rx_buf_write_idx == hv->hv_rx_buf_read_idx)
853                         txp_rxbuf_reclaim(sc);
854                 if (sc->sc_txhir.r_cnt && (sc->sc_txhir.r_cons !=
855                     TXP_OFFSET2IDX(le32toh(*(sc->sc_txhir.r_off)))))
856                         txp_tx_reclaim(sc, &sc->sc_txhir);
857                 if (sc->sc_txlor.r_cnt && (sc->sc_txlor.r_cons !=
858                     TXP_OFFSET2IDX(le32toh(*(sc->sc_txlor.r_off)))))
859                         txp_tx_reclaim(sc, &sc->sc_txlor);
860                 bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
861                     sc->sc_cdata.txp_hostvar_map,
862                     BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
863                 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd))
864                         txp_start_locked(sc->sc_ifp);
865                 if (more != 0 || READ_REG(sc, TXP_ISR & TXP_INT_LATCH) != 0) {
866                         taskqueue_enqueue(sc->sc_tq, &sc->sc_int_task);
867                         TXP_UNLOCK(sc);
868                         return;
869                 }
870         }
871
872         /* Re-enable interrupts. */
873         WRITE_REG(sc, TXP_IMR, TXP_INTR_NONE);
874         TXP_UNLOCK(sc);
875 }
876
877 #ifndef __NO_STRICT_ALIGNMENT
878 static __inline void
879 txp_fixup_rx(struct mbuf *m)
880 {
881         int i;
882         uint16_t *src, *dst;
883
884         src = mtod(m, uint16_t *);
885         dst = src - (TXP_RXBUF_ALIGN - ETHER_ALIGN) / sizeof *src;
886
887         for (i = 0; i < (m->m_len / sizeof(uint16_t) + 1); i++)
888                 *dst++ = *src++;
889
890         m->m_data -= TXP_RXBUF_ALIGN - ETHER_ALIGN;
891 }
892 #endif
893
894 static int
895 txp_rx_reclaim(struct txp_softc *sc, struct txp_rx_ring *r, int count)
896 {
897         struct ifnet *ifp;
898         struct txp_rx_desc *rxd;
899         struct mbuf *m;
900         struct txp_rx_swdesc *sd;
901         uint32_t roff, woff, rx_stat, prog;
902
903         TXP_LOCK_ASSERT(sc);
904
905         ifp = sc->sc_ifp;
906
907         bus_dmamap_sync(r->r_tag, r->r_map, BUS_DMASYNC_POSTREAD |
908             BUS_DMASYNC_POSTWRITE);
909
910         roff = le32toh(*r->r_roff);
911         woff = le32toh(*r->r_woff);
912         rxd = r->r_desc + roff / sizeof(struct txp_rx_desc);
913         for (prog = 0; roff != woff; prog++, count--) {
914                 if (count <= 0)
915                         break;
916                 bcopy((u_long *)&rxd->rx_vaddrlo, &sd, sizeof(sd));
917                 KASSERT(sd != NULL, ("%s: Rx desc ring corrupted", __func__));
918                 bus_dmamap_sync(sc->sc_cdata.txp_rx_tag, sd->sd_map,
919                     BUS_DMASYNC_POSTREAD);
920                 bus_dmamap_unload(sc->sc_cdata.txp_rx_tag, sd->sd_map);
921                 m = sd->sd_mbuf;
922                 KASSERT(m != NULL, ("%s: Rx buffer ring corrupted", __func__));
923                 sd->sd_mbuf = NULL;
924                 TAILQ_REMOVE(&sc->sc_busy_list, sd, sd_next);
925                 TAILQ_INSERT_TAIL(&sc->sc_free_list, sd, sd_next);
926                 if ((rxd->rx_flags & RX_FLAGS_ERROR) != 0) {
927                         if (bootverbose)
928                                 device_printf(sc->sc_dev, "Rx error %u\n",
929                                     le32toh(rxd->rx_stat) & RX_ERROR_MASK);
930                         m_freem(m);
931                         goto next;
932                 }
933
934                 m->m_pkthdr.len = m->m_len = le16toh(rxd->rx_len);
935                 m->m_pkthdr.rcvif = ifp;
936 #ifndef __NO_STRICT_ALIGNMENT
937                 txp_fixup_rx(m);
938 #endif
939                 rx_stat = le32toh(rxd->rx_stat);
940                 if ((ifp->if_capenable & IFCAP_RXCSUM) != 0) {
941                         if ((rx_stat & RX_STAT_IPCKSUMBAD) != 0)
942                                 m->m_pkthdr.csum_flags |= CSUM_IP_CHECKED;
943                         else if ((rx_stat & RX_STAT_IPCKSUMGOOD) != 0)
944                                 m->m_pkthdr.csum_flags |=
945                                     CSUM_IP_CHECKED|CSUM_IP_VALID;
946
947                         if ((rx_stat & RX_STAT_TCPCKSUMGOOD) != 0 ||
948                             (rx_stat & RX_STAT_UDPCKSUMGOOD) != 0) {
949                                 m->m_pkthdr.csum_flags |=
950                                     CSUM_DATA_VALID | CSUM_PSEUDO_HDR;
951                                 m->m_pkthdr.csum_data = 0xffff;
952                         }
953                 }
954
955                 /*
956                  * XXX
957                  * Typhoon has a firmware bug that VLAN tag is always
958                  * stripped out even if it is told to not remove the tag.
959                  * Therefore don't check if_capenable here.
960                  */
961                 if (/* (ifp->if_capenable & IFCAP_VLAN_HWTAGGING) != 0 && */
962                     (rx_stat & RX_STAT_VLAN) != 0) {
963                         m->m_pkthdr.ether_vtag =
964                             bswap16((le32toh(rxd->rx_vlan) >> 16));
965                         m->m_flags |= M_VLANTAG;
966                 }
967
968                 TXP_UNLOCK(sc);
969                 (*ifp->if_input)(ifp, m);
970                 TXP_LOCK(sc);
971
972 next:
973                 roff += sizeof(struct txp_rx_desc);
974                 if (roff == (RX_ENTRIES * sizeof(struct txp_rx_desc))) {
975                         roff = 0;
976                         rxd = r->r_desc;
977                 } else
978                         rxd++;
979                 prog++;
980         }
981
982         if (prog == 0)
983                 return (0);
984
985         bus_dmamap_sync(r->r_tag, r->r_map, BUS_DMASYNC_PREREAD |
986             BUS_DMASYNC_PREWRITE);
987         *r->r_roff = le32toh(roff);
988
989         return (count > 0 ? 0 : EAGAIN);
990 }
991
992 static void
993 txp_rxbuf_reclaim(struct txp_softc *sc)
994 {
995         struct txp_hostvar *hv;
996         struct txp_rxbuf_desc *rbd;
997         struct txp_rx_swdesc *sd;
998         bus_dma_segment_t segs[1];
999         int nsegs, prod, prog;
1000         uint32_t cons;
1001
1002         TXP_LOCK_ASSERT(sc);
1003
1004         hv = sc->sc_hostvar;
1005         cons = TXP_OFFSET2IDX(le32toh(hv->hv_rx_buf_read_idx));
1006         prod = sc->sc_rxbufprod;
1007         TXP_DESC_INC(prod, RXBUF_ENTRIES);
1008         if (prod == cons)
1009                 return;
1010
1011         bus_dmamap_sync(sc->sc_cdata.txp_rxbufs_tag,
1012             sc->sc_cdata.txp_rxbufs_map,
1013             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1014
1015         for (prog = 0; prod != cons; prog++) {
1016                 sd = TAILQ_FIRST(&sc->sc_free_list);
1017                 if (sd == NULL)
1018                         break;
1019                 rbd = sc->sc_rxbufs + prod;
1020                 bcopy((u_long *)&rbd->rb_vaddrlo, &sd, sizeof(sd));
1021                 sd->sd_mbuf = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1022                 if (sd->sd_mbuf == NULL)
1023                         break;
1024                 sd->sd_mbuf->m_pkthdr.len = sd->sd_mbuf->m_len = MCLBYTES;
1025 #ifndef __NO_STRICT_ALIGNMENT
1026                 m_adj(sd->sd_mbuf, TXP_RXBUF_ALIGN);
1027 #endif
1028                 if (bus_dmamap_load_mbuf_sg(sc->sc_cdata.txp_rx_tag,
1029                     sd->sd_map, sd->sd_mbuf, segs, &nsegs, 0) != 0) {
1030                         m_freem(sd->sd_mbuf);
1031                         sd->sd_mbuf = NULL;
1032                         break;
1033                 }
1034                 KASSERT(nsegs == 1, ("%s : %d segments returned!", __func__,
1035                     nsegs));
1036                 TAILQ_REMOVE(&sc->sc_free_list, sd, sd_next);
1037                 TAILQ_INSERT_TAIL(&sc->sc_busy_list, sd, sd_next);
1038                 bus_dmamap_sync(sc->sc_cdata.txp_rx_tag, sd->sd_map,
1039                     BUS_DMASYNC_PREREAD);
1040                 rbd->rb_paddrlo = htole32(TXP_ADDR_LO(segs[0].ds_addr));
1041                 rbd->rb_paddrhi = htole32(TXP_ADDR_HI(segs[0].ds_addr));
1042                 TXP_DESC_INC(prod, RXBUF_ENTRIES);
1043         }
1044
1045         if (prog == 0)
1046                 return;
1047         bus_dmamap_sync(sc->sc_cdata.txp_rxbufs_tag,
1048             sc->sc_cdata.txp_rxbufs_map,
1049             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1050         prod = (prod + RXBUF_ENTRIES - 1) % RXBUF_ENTRIES;
1051         sc->sc_rxbufprod = prod;
1052         hv->hv_rx_buf_write_idx = htole32(TXP_IDX2OFFSET(prod));
1053 }
1054
1055 /*
1056  * Reclaim mbufs and entries from a transmit ring.
1057  */
1058 static void
1059 txp_tx_reclaim(struct txp_softc *sc, struct txp_tx_ring *r)
1060 {
1061         struct ifnet *ifp;
1062         uint32_t idx;
1063         uint32_t cons, cnt;
1064         struct txp_tx_desc *txd;
1065         struct txp_swdesc *sd;
1066
1067         TXP_LOCK_ASSERT(sc);
1068
1069         bus_dmamap_sync(r->r_tag, r->r_map, BUS_DMASYNC_POSTREAD |
1070             BUS_DMASYNC_POSTWRITE);
1071         ifp = sc->sc_ifp;
1072         idx = TXP_OFFSET2IDX(le32toh(*(r->r_off)));
1073         cons = r->r_cons;
1074         cnt = r->r_cnt;
1075         txd = r->r_desc + cons;
1076         sd = sc->sc_txd + cons;
1077
1078         for (cnt = r->r_cnt; cons != idx && cnt > 0; cnt--) {
1079                 if ((txd->tx_flags & TX_FLAGS_TYPE_M) == TX_FLAGS_TYPE_DATA) {
1080                         if (sd->sd_mbuf != NULL) {
1081                                 bus_dmamap_sync(sc->sc_cdata.txp_tx_tag,
1082                                     sd->sd_map, BUS_DMASYNC_POSTWRITE);
1083                                 bus_dmamap_unload(sc->sc_cdata.txp_tx_tag,
1084                                     sd->sd_map);
1085                                 m_freem(sd->sd_mbuf);
1086                                 sd->sd_mbuf = NULL;
1087                                 txd->tx_addrlo = 0;
1088                                 txd->tx_addrhi = 0;
1089                                 txd->tx_flags = 0;
1090                         }
1091                 }
1092                 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1093
1094                 if (++cons == TX_ENTRIES) {
1095                         txd = r->r_desc;
1096                         cons = 0;
1097                         sd = sc->sc_txd;
1098                 } else {
1099                         txd++;
1100                         sd++;
1101                 }
1102         }
1103
1104         bus_dmamap_sync(r->r_tag, r->r_map, BUS_DMASYNC_PREREAD |
1105             BUS_DMASYNC_PREWRITE);
1106         r->r_cons = cons;
1107         r->r_cnt = cnt;
1108         if (cnt == 0)
1109                 sc->sc_watchdog_timer = 0;
1110 }
1111
1112 static int
1113 txp_shutdown(device_t dev)
1114 {
1115
1116         return (txp_suspend(dev));
1117 }
1118
1119 static int
1120 txp_suspend(device_t dev)
1121 {
1122         struct txp_softc *sc;
1123         struct ifnet *ifp;
1124         uint8_t *eaddr;
1125         uint16_t p1;
1126         uint32_t p2;
1127         int pmc;
1128         uint16_t pmstat;
1129
1130         sc = device_get_softc(dev);
1131
1132         TXP_LOCK(sc);
1133         ifp = sc->sc_ifp;
1134         txp_stop(sc);
1135         txp_init_rings(sc);
1136         /* Reset controller and make it reload sleep image. */
1137         txp_reset(sc);
1138         /* Let controller boot from sleep image. */
1139         if (txp_boot(sc, STAT_WAITING_FOR_HOST_REQUEST) != 0)
1140                 device_printf(sc->sc_dev, "couldn't boot sleep image\n");
1141
1142         /* Set station address. */
1143         eaddr = IF_LLADDR(sc->sc_ifp);
1144         p1 = 0;
1145         ((uint8_t *)&p1)[1] = eaddr[0];
1146         ((uint8_t *)&p1)[0] = eaddr[1];
1147         p1 = le16toh(p1);
1148         ((uint8_t *)&p2)[3] = eaddr[2];
1149         ((uint8_t *)&p2)[2] = eaddr[3];
1150         ((uint8_t *)&p2)[1] = eaddr[4];
1151         ((uint8_t *)&p2)[0] = eaddr[5];
1152         p2 = le32toh(p2);
1153         txp_command(sc, TXP_CMD_STATION_ADDRESS_WRITE, p1, p2, 0, NULL, NULL,
1154             NULL, TXP_CMD_WAIT);
1155         txp_set_filter(sc);
1156         WRITE_REG(sc, TXP_IER, TXP_INTR_NONE);
1157         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
1158         txp_sleep(sc, sc->sc_ifp->if_capenable);
1159         if (pci_find_cap(sc->sc_dev, PCIY_PMG, &pmc) == 0) {
1160                 /* Request PME. */
1161                 pmstat = pci_read_config(sc->sc_dev,
1162                     pmc + PCIR_POWER_STATUS, 2);
1163                 pmstat &= ~(PCIM_PSTAT_PME | PCIM_PSTAT_PMEENABLE);
1164                 if ((ifp->if_capenable & IFCAP_WOL) != 0)
1165                         pmstat |= PCIM_PSTAT_PME | PCIM_PSTAT_PMEENABLE;
1166                 pci_write_config(sc->sc_dev,
1167                     pmc + PCIR_POWER_STATUS, pmstat, 2);
1168         }
1169         TXP_UNLOCK(sc);
1170
1171         return (0);
1172 }
1173
1174 static int
1175 txp_resume(device_t dev)
1176 {
1177         struct txp_softc *sc;
1178         int pmc;
1179         uint16_t pmstat;
1180
1181         sc = device_get_softc(dev);
1182
1183         TXP_LOCK(sc);
1184         if (pci_find_cap(sc->sc_dev, PCIY_PMG, &pmc) == 0) {
1185                 /* Disable PME and clear PME status. */
1186                 pmstat = pci_read_config(sc->sc_dev,
1187                     pmc + PCIR_POWER_STATUS, 2);
1188                 if ((pmstat & PCIM_PSTAT_PMEENABLE) != 0) {
1189                         pmstat &= ~PCIM_PSTAT_PMEENABLE;
1190                         pci_write_config(sc->sc_dev,
1191                             pmc + PCIR_POWER_STATUS, pmstat, 2);
1192                 }
1193         }
1194         if ((sc->sc_ifp->if_flags & IFF_UP) != 0)
1195                 txp_init_locked(sc);
1196         TXP_UNLOCK(sc);
1197
1198         return (0);
1199 }
1200
1201 struct txp_dmamap_arg {
1202         bus_addr_t      txp_busaddr;
1203 };
1204
1205 static void
1206 txp_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
1207 {
1208         struct txp_dmamap_arg *ctx;
1209
1210         if (error != 0)
1211                 return;
1212
1213         KASSERT(nsegs == 1, ("%s: %d segments returned!", __func__, nsegs));
1214
1215         ctx = (struct txp_dmamap_arg *)arg;
1216         ctx->txp_busaddr = segs[0].ds_addr;
1217 }
1218
1219 static int
1220 txp_dma_alloc(struct txp_softc *sc, char *type, bus_dma_tag_t *tag,
1221     bus_size_t alignment, bus_size_t boundary, bus_dmamap_t *map, void **buf,
1222     bus_size_t size, bus_addr_t *paddr)
1223 {
1224         struct txp_dmamap_arg ctx;
1225         int error;
1226
1227         /* Create DMA block tag. */
1228         error = bus_dma_tag_create(
1229             sc->sc_cdata.txp_parent_tag,        /* parent */
1230             alignment, boundary,        /* algnmnt, boundary */
1231             BUS_SPACE_MAXADDR,          /* lowaddr */
1232             BUS_SPACE_MAXADDR,          /* highaddr */
1233             NULL, NULL,                 /* filter, filterarg */
1234             size,                       /* maxsize */
1235             1,                          /* nsegments */
1236             size,                       /* maxsegsize */
1237             0,                          /* flags */
1238             NULL, NULL,                 /* lockfunc, lockarg */
1239             tag);
1240         if (error != 0) {
1241                 device_printf(sc->sc_dev,
1242                     "could not create DMA tag for %s.\n", type);
1243                 return (error);
1244         }
1245
1246         *paddr = 0;
1247         /* Allocate DMA'able memory and load the DMA map. */
1248         error = bus_dmamem_alloc(*tag, buf, BUS_DMA_WAITOK | BUS_DMA_ZERO |
1249             BUS_DMA_COHERENT, map);
1250         if (error != 0) {
1251                 device_printf(sc->sc_dev,
1252                     "could not allocate DMA'able memory for %s.\n", type);
1253                 return (error);
1254         }
1255
1256         ctx.txp_busaddr = 0;
1257         error = bus_dmamap_load(*tag, *map, *(uint8_t **)buf,
1258             size, txp_dmamap_cb, &ctx, BUS_DMA_NOWAIT);
1259         if (error != 0 || ctx.txp_busaddr == 0) {
1260                 device_printf(sc->sc_dev,
1261                     "could not load DMA'able memory for %s.\n", type);
1262                 return (error);
1263         }
1264         *paddr = ctx.txp_busaddr;
1265
1266         return (0);
1267 }
1268
1269 static void
1270 txp_dma_free(struct txp_softc *sc, bus_dma_tag_t *tag, bus_dmamap_t map,
1271     void **buf, bus_addr_t *paddr)
1272 {
1273
1274         if (*tag != NULL) {
1275                 if (*paddr != 0)
1276                         bus_dmamap_unload(*tag, map);
1277                 if (buf != NULL)
1278                         bus_dmamem_free(*tag, *(uint8_t **)buf, map);
1279                 *(uint8_t **)buf = NULL;
1280                 *paddr = 0;
1281                 bus_dma_tag_destroy(*tag);
1282                 *tag = NULL;
1283         }
1284 }
1285
1286 static int
1287 txp_alloc_rings(struct txp_softc *sc)
1288 {
1289         struct txp_boot_record *boot;
1290         struct txp_ldata *ld;
1291         struct txp_swdesc *txd;
1292         struct txp_rxbuf_desc *rbd;
1293         struct txp_rx_swdesc *sd;
1294         int error, i;
1295
1296         ld = &sc->sc_ldata;
1297         boot = ld->txp_boot;
1298
1299         /* boot record */
1300         sc->sc_boot = boot;
1301
1302         /*
1303          * Create parent ring/DMA block tag.
1304          * Datasheet says that all ring addresses and descriptors
1305          * support 64bits addressing. However the controller is
1306          * known to have no support DAC so limit DMA address space
1307          * to 32bits.
1308          */
1309         error = bus_dma_tag_create(
1310             bus_get_dma_tag(sc->sc_dev), /* parent */
1311             1, 0,                       /* algnmnt, boundary */
1312             BUS_SPACE_MAXADDR_32BIT,    /* lowaddr */
1313             BUS_SPACE_MAXADDR,          /* highaddr */
1314             NULL, NULL,                 /* filter, filterarg */
1315             BUS_SPACE_MAXSIZE_32BIT,    /* maxsize */
1316             0,                          /* nsegments */
1317             BUS_SPACE_MAXSIZE_32BIT,    /* maxsegsize */
1318             0,                          /* flags */
1319             NULL, NULL,                 /* lockfunc, lockarg */
1320             &sc->sc_cdata.txp_parent_tag);
1321         if (error != 0) {
1322                 device_printf(sc->sc_dev, "could not create parent DMA tag.\n");
1323                 return (error);
1324         }
1325
1326         /* Boot record. */
1327         error = txp_dma_alloc(sc, "boot record",
1328             &sc->sc_cdata.txp_boot_tag, sizeof(uint32_t), 0,
1329             &sc->sc_cdata.txp_boot_map, (void **)&sc->sc_ldata.txp_boot,
1330             sizeof(struct txp_boot_record),
1331             &sc->sc_ldata.txp_boot_paddr);
1332         if (error != 0)
1333                 return (error);
1334         boot = sc->sc_ldata.txp_boot;
1335         sc->sc_boot = boot;
1336
1337         /* Host variables. */
1338         error = txp_dma_alloc(sc, "host variables",
1339             &sc->sc_cdata.txp_hostvar_tag, sizeof(uint32_t), 0,
1340             &sc->sc_cdata.txp_hostvar_map, (void **)&sc->sc_ldata.txp_hostvar,
1341             sizeof(struct txp_hostvar),
1342             &sc->sc_ldata.txp_hostvar_paddr);
1343         if (error != 0)
1344                 return (error);
1345         boot->br_hostvar_lo =
1346             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_hostvar_paddr));
1347         boot->br_hostvar_hi =
1348             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_hostvar_paddr));
1349         sc->sc_hostvar = sc->sc_ldata.txp_hostvar;
1350
1351         /* Hi priority tx ring. */
1352         error = txp_dma_alloc(sc, "hi priority tx ring",
1353             &sc->sc_cdata.txp_txhiring_tag, sizeof(struct txp_tx_desc), 0,
1354             &sc->sc_cdata.txp_txhiring_map, (void **)&sc->sc_ldata.txp_txhiring,
1355             sizeof(struct txp_tx_desc) * TX_ENTRIES,
1356             &sc->sc_ldata.txp_txhiring_paddr);
1357         if (error != 0)
1358                 return (error);
1359         boot->br_txhipri_lo =
1360             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_txhiring_paddr));
1361         boot->br_txhipri_hi =
1362             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_txhiring_paddr));
1363         boot->br_txhipri_siz =
1364             htole32(TX_ENTRIES * sizeof(struct txp_tx_desc));
1365         sc->sc_txhir.r_tag = sc->sc_cdata.txp_txhiring_tag;
1366         sc->sc_txhir.r_map = sc->sc_cdata.txp_txhiring_map;
1367         sc->sc_txhir.r_reg = TXP_H2A_1;
1368         sc->sc_txhir.r_desc = sc->sc_ldata.txp_txhiring;
1369         sc->sc_txhir.r_cons = sc->sc_txhir.r_prod = sc->sc_txhir.r_cnt = 0;
1370         sc->sc_txhir.r_off = &sc->sc_hostvar->hv_tx_hi_desc_read_idx;
1371
1372         /* Low priority tx ring. */
1373         error = txp_dma_alloc(sc, "low priority tx ring",
1374             &sc->sc_cdata.txp_txloring_tag, sizeof(struct txp_tx_desc), 0,
1375             &sc->sc_cdata.txp_txloring_map, (void **)&sc->sc_ldata.txp_txloring,
1376             sizeof(struct txp_tx_desc) * TX_ENTRIES,
1377             &sc->sc_ldata.txp_txloring_paddr);
1378         if (error != 0)
1379                 return (error);
1380         boot->br_txlopri_lo =
1381             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_txloring_paddr));
1382         boot->br_txlopri_hi =
1383             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_txloring_paddr));
1384         boot->br_txlopri_siz =
1385             htole32(TX_ENTRIES * sizeof(struct txp_tx_desc));
1386         sc->sc_txlor.r_tag = sc->sc_cdata.txp_txloring_tag;
1387         sc->sc_txlor.r_map = sc->sc_cdata.txp_txloring_map;
1388         sc->sc_txlor.r_reg = TXP_H2A_3;
1389         sc->sc_txlor.r_desc = sc->sc_ldata.txp_txloring;
1390         sc->sc_txlor.r_cons = sc->sc_txlor.r_prod = sc->sc_txlor.r_cnt = 0;
1391         sc->sc_txlor.r_off = &sc->sc_hostvar->hv_tx_lo_desc_read_idx;
1392
1393         /* High priority rx ring. */
1394         error = txp_dma_alloc(sc, "hi priority rx ring",
1395             &sc->sc_cdata.txp_rxhiring_tag,
1396             roundup(sizeof(struct txp_rx_desc), 16), 0,
1397             &sc->sc_cdata.txp_rxhiring_map, (void **)&sc->sc_ldata.txp_rxhiring,
1398             sizeof(struct txp_rx_desc) * RX_ENTRIES,
1399             &sc->sc_ldata.txp_rxhiring_paddr);
1400         if (error != 0)
1401                 return (error);
1402         boot->br_rxhipri_lo =
1403             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_rxhiring_paddr));
1404         boot->br_rxhipri_hi =
1405             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_rxhiring_paddr));
1406         boot->br_rxhipri_siz =
1407             htole32(RX_ENTRIES * sizeof(struct txp_rx_desc));
1408         sc->sc_rxhir.r_tag = sc->sc_cdata.txp_rxhiring_tag;
1409         sc->sc_rxhir.r_map = sc->sc_cdata.txp_rxhiring_map;
1410         sc->sc_rxhir.r_desc = sc->sc_ldata.txp_rxhiring;
1411         sc->sc_rxhir.r_roff = &sc->sc_hostvar->hv_rx_hi_read_idx;
1412         sc->sc_rxhir.r_woff = &sc->sc_hostvar->hv_rx_hi_write_idx;
1413
1414         /* Low priority rx ring. */
1415         error = txp_dma_alloc(sc, "low priority rx ring",
1416             &sc->sc_cdata.txp_rxloring_tag,
1417             roundup(sizeof(struct txp_rx_desc), 16), 0,
1418             &sc->sc_cdata.txp_rxloring_map, (void **)&sc->sc_ldata.txp_rxloring,
1419             sizeof(struct txp_rx_desc) * RX_ENTRIES,
1420             &sc->sc_ldata.txp_rxloring_paddr);
1421         if (error != 0)
1422                 return (error);
1423         boot->br_rxlopri_lo =
1424             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_rxloring_paddr));
1425         boot->br_rxlopri_hi =
1426             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_rxloring_paddr));
1427         boot->br_rxlopri_siz =
1428             htole32(RX_ENTRIES * sizeof(struct txp_rx_desc));
1429         sc->sc_rxlor.r_tag = sc->sc_cdata.txp_rxloring_tag;
1430         sc->sc_rxlor.r_map = sc->sc_cdata.txp_rxloring_map;
1431         sc->sc_rxlor.r_desc = sc->sc_ldata.txp_rxloring;
1432         sc->sc_rxlor.r_roff = &sc->sc_hostvar->hv_rx_lo_read_idx;
1433         sc->sc_rxlor.r_woff = &sc->sc_hostvar->hv_rx_lo_write_idx;
1434
1435         /* Command ring. */
1436         error = txp_dma_alloc(sc, "command ring",
1437             &sc->sc_cdata.txp_cmdring_tag, sizeof(struct txp_cmd_desc), 0,
1438             &sc->sc_cdata.txp_cmdring_map, (void **)&sc->sc_ldata.txp_cmdring,
1439             sizeof(struct txp_cmd_desc) * CMD_ENTRIES,
1440             &sc->sc_ldata.txp_cmdring_paddr);
1441         if (error != 0)
1442                 return (error);
1443         boot->br_cmd_lo = htole32(TXP_ADDR_LO(sc->sc_ldata.txp_cmdring_paddr));
1444         boot->br_cmd_hi = htole32(TXP_ADDR_HI(sc->sc_ldata.txp_cmdring_paddr));
1445         boot->br_cmd_siz = htole32(CMD_ENTRIES * sizeof(struct txp_cmd_desc));
1446         sc->sc_cmdring.base = sc->sc_ldata.txp_cmdring;
1447         sc->sc_cmdring.size = CMD_ENTRIES * sizeof(struct txp_cmd_desc);
1448         sc->sc_cmdring.lastwrite = 0;
1449
1450         /* Response ring. */
1451         error = txp_dma_alloc(sc, "response ring",
1452             &sc->sc_cdata.txp_rspring_tag, sizeof(struct txp_rsp_desc), 0,
1453             &sc->sc_cdata.txp_rspring_map, (void **)&sc->sc_ldata.txp_rspring,
1454             sizeof(struct txp_rsp_desc) * RSP_ENTRIES,
1455             &sc->sc_ldata.txp_rspring_paddr);
1456         if (error != 0)
1457                 return (error);
1458         boot->br_resp_lo = htole32(TXP_ADDR_LO(sc->sc_ldata.txp_rspring_paddr));
1459         boot->br_resp_hi = htole32(TXP_ADDR_HI(sc->sc_ldata.txp_rspring_paddr));
1460         boot->br_resp_siz = htole32(RSP_ENTRIES * sizeof(struct txp_rsp_desc));
1461         sc->sc_rspring.base = sc->sc_ldata.txp_rspring;
1462         sc->sc_rspring.size = RSP_ENTRIES * sizeof(struct txp_rsp_desc);
1463         sc->sc_rspring.lastwrite = 0;
1464
1465         /* Receive buffer ring. */
1466         error = txp_dma_alloc(sc, "receive buffer ring",
1467             &sc->sc_cdata.txp_rxbufs_tag, sizeof(struct txp_rxbuf_desc), 0,
1468             &sc->sc_cdata.txp_rxbufs_map, (void **)&sc->sc_ldata.txp_rxbufs,
1469             sizeof(struct txp_rxbuf_desc) * RXBUF_ENTRIES,
1470             &sc->sc_ldata.txp_rxbufs_paddr);
1471         if (error != 0)
1472                 return (error);
1473         boot->br_rxbuf_lo =
1474             htole32(TXP_ADDR_LO(sc->sc_ldata.txp_rxbufs_paddr));
1475         boot->br_rxbuf_hi =
1476             htole32(TXP_ADDR_HI(sc->sc_ldata.txp_rxbufs_paddr));
1477         boot->br_rxbuf_siz =
1478             htole32(RXBUF_ENTRIES * sizeof(struct txp_rxbuf_desc));
1479         sc->sc_rxbufs = sc->sc_ldata.txp_rxbufs;
1480
1481         /* Zero ring. */
1482         error = txp_dma_alloc(sc, "zero buffer",
1483             &sc->sc_cdata.txp_zero_tag, sizeof(uint32_t), 0,
1484             &sc->sc_cdata.txp_zero_map, (void **)&sc->sc_ldata.txp_zero,
1485             sizeof(uint32_t), &sc->sc_ldata.txp_zero_paddr);
1486         if (error != 0)
1487                 return (error);
1488         boot->br_zero_lo = htole32(TXP_ADDR_LO(sc->sc_ldata.txp_zero_paddr));
1489         boot->br_zero_hi = htole32(TXP_ADDR_HI(sc->sc_ldata.txp_zero_paddr));
1490
1491         bus_dmamap_sync(sc->sc_cdata.txp_boot_tag, sc->sc_cdata.txp_boot_map,
1492             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1493
1494         /* Create Tx buffers. */
1495         error = bus_dma_tag_create(
1496             sc->sc_cdata.txp_parent_tag,        /* parent */
1497             1, 0,                       /* algnmnt, boundary */
1498             BUS_SPACE_MAXADDR,          /* lowaddr */
1499             BUS_SPACE_MAXADDR,          /* highaddr */
1500             NULL, NULL,                 /* filter, filterarg */
1501             MCLBYTES * TXP_MAXTXSEGS,   /* maxsize */
1502             TXP_MAXTXSEGS,              /* nsegments */
1503             MCLBYTES,                   /* maxsegsize */
1504             0,                          /* flags */
1505             NULL, NULL,                 /* lockfunc, lockarg */
1506             &sc->sc_cdata.txp_tx_tag);
1507         if (error != 0) {
1508                 device_printf(sc->sc_dev, "could not create Tx DMA tag.\n");
1509                 goto fail;
1510         }
1511
1512         /* Create tag for Rx buffers. */
1513         error = bus_dma_tag_create(
1514             sc->sc_cdata.txp_parent_tag,        /* parent */
1515             TXP_RXBUF_ALIGN, 0,         /* algnmnt, boundary */
1516             BUS_SPACE_MAXADDR,          /* lowaddr */
1517             BUS_SPACE_MAXADDR,          /* highaddr */
1518             NULL, NULL,                 /* filter, filterarg */
1519             MCLBYTES,                   /* maxsize */
1520             1,                          /* nsegments */
1521             MCLBYTES,                   /* maxsegsize */
1522             0,                          /* flags */
1523             NULL, NULL,                 /* lockfunc, lockarg */
1524             &sc->sc_cdata.txp_rx_tag);
1525         if (error != 0) {
1526                 device_printf(sc->sc_dev, "could not create Rx DMA tag.\n");
1527                 goto fail;
1528         }
1529
1530         /* Create DMA maps for Tx buffers. */
1531         for (i = 0; i < TX_ENTRIES; i++) {
1532                 txd = &sc->sc_txd[i];
1533                 txd->sd_mbuf = NULL;
1534                 txd->sd_map = NULL;
1535                 error = bus_dmamap_create(sc->sc_cdata.txp_tx_tag, 0,
1536                     &txd->sd_map);
1537                 if (error != 0) {
1538                         device_printf(sc->sc_dev,
1539                             "could not create Tx dmamap.\n");
1540                         goto fail;
1541                 }
1542         }
1543
1544         /* Create DMA maps for Rx buffers. */
1545         for (i = 0; i < RXBUF_ENTRIES; i++) {
1546                 sd = malloc(sizeof(struct txp_rx_swdesc), M_DEVBUF,
1547                     M_NOWAIT | M_ZERO);
1548                 if (sd == NULL) {
1549                         error = ENOMEM;
1550                         goto fail;
1551                 }
1552                 /*
1553                  * The virtual address part of descriptor is not used
1554                  * by hardware so use that to save an ring entry. We
1555                  * need bcopy here otherwise the address wouldn't be
1556                  * valid on big-endian architectures.
1557                  */
1558                 rbd = sc->sc_rxbufs + i;
1559                 bcopy(&sd, (u_long *)&rbd->rb_vaddrlo, sizeof(sd));
1560                 sd->sd_mbuf = NULL;
1561                 sd->sd_map = NULL;
1562                 error = bus_dmamap_create(sc->sc_cdata.txp_rx_tag, 0,
1563                     &sd->sd_map);
1564                 if (error != 0) {
1565                         device_printf(sc->sc_dev,
1566                             "could not create Rx dmamap.\n");
1567                         goto fail;
1568                 }
1569                 TAILQ_INSERT_TAIL(&sc->sc_free_list, sd, sd_next);
1570         }
1571
1572 fail:
1573         return (error);
1574 }
1575
1576 static void
1577 txp_init_rings(struct txp_softc *sc)
1578 {
1579
1580         bzero(sc->sc_ldata.txp_hostvar, sizeof(struct txp_hostvar));
1581         bzero(sc->sc_ldata.txp_zero, sizeof(uint32_t));
1582         sc->sc_txhir.r_cons = 0;
1583         sc->sc_txhir.r_prod = 0;
1584         sc->sc_txhir.r_cnt = 0;
1585         sc->sc_txlor.r_cons = 0;
1586         sc->sc_txlor.r_prod = 0;
1587         sc->sc_txlor.r_cnt = 0;
1588         sc->sc_cmdring.lastwrite = 0;
1589         sc->sc_rspring.lastwrite = 0;
1590         sc->sc_rxbufprod = 0;
1591         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
1592             sc->sc_cdata.txp_hostvar_map,
1593             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1594 }
1595
1596 static int
1597 txp_wait(struct txp_softc *sc, uint32_t state)
1598 {
1599         uint32_t reg;
1600         int i;
1601
1602         for (i = 0; i < TXP_TIMEOUT; i++) {
1603                 reg = READ_REG(sc, TXP_A2H_0);
1604                 if (reg == state)
1605                         break;
1606                 DELAY(50);
1607         }
1608
1609         return (i == TXP_TIMEOUT ? ETIMEDOUT : 0);
1610 }
1611
1612 static void
1613 txp_free_rings(struct txp_softc *sc)
1614 {
1615         struct txp_swdesc *txd;
1616         struct txp_rx_swdesc *sd;
1617         int i;
1618
1619         /* Tx buffers. */
1620         if (sc->sc_cdata.txp_tx_tag != NULL) {
1621                 for (i = 0; i < TX_ENTRIES; i++) {
1622                         txd = &sc->sc_txd[i];
1623                         if (txd->sd_map != NULL) {
1624                                 bus_dmamap_destroy(sc->sc_cdata.txp_tx_tag,
1625                                     txd->sd_map);
1626                                 txd->sd_map = NULL;
1627                         }
1628                 }
1629                 bus_dma_tag_destroy(sc->sc_cdata.txp_tx_tag);
1630                 sc->sc_cdata.txp_tx_tag = NULL;
1631         }
1632         /* Rx buffers. */
1633         if (sc->sc_cdata.txp_rx_tag != NULL) {
1634                 if (sc->sc_rxbufs != NULL) {
1635                         KASSERT(TAILQ_FIRST(&sc->sc_busy_list) == NULL,
1636                             ("%s : still have busy Rx buffers", __func__));
1637                         while ((sd = TAILQ_FIRST(&sc->sc_free_list)) != NULL) {
1638                                 TAILQ_REMOVE(&sc->sc_free_list, sd, sd_next);
1639                                 if (sd->sd_map != NULL) {
1640                                         bus_dmamap_destroy(
1641                                             sc->sc_cdata.txp_rx_tag,
1642                                             sd->sd_map);
1643                                         sd->sd_map = NULL;
1644                                 }
1645                                 free(sd, M_DEVBUF);
1646                         }
1647                 }
1648                 bus_dma_tag_destroy(sc->sc_cdata.txp_rx_tag);
1649                 sc->sc_cdata.txp_rx_tag = NULL;
1650         }
1651
1652         /* Hi priority Tx ring. */
1653         txp_dma_free(sc, &sc->sc_cdata.txp_txhiring_tag,
1654             sc->sc_cdata.txp_txhiring_map,
1655             (void **)&sc->sc_ldata.txp_txhiring,
1656             &sc->sc_ldata.txp_txhiring_paddr);
1657         /* Low priority Tx ring. */
1658         txp_dma_free(sc, &sc->sc_cdata.txp_txloring_tag,
1659             sc->sc_cdata.txp_txloring_map,
1660             (void **)&sc->sc_ldata.txp_txloring,
1661             &sc->sc_ldata.txp_txloring_paddr);
1662         /* Hi priority Rx ring. */
1663         txp_dma_free(sc, &sc->sc_cdata.txp_rxhiring_tag,
1664             sc->sc_cdata.txp_rxhiring_map,
1665             (void **)&sc->sc_ldata.txp_rxhiring,
1666             &sc->sc_ldata.txp_rxhiring_paddr);
1667         /* Low priority Rx ring. */
1668         txp_dma_free(sc, &sc->sc_cdata.txp_rxloring_tag,
1669             sc->sc_cdata.txp_rxloring_map,
1670             (void **)&sc->sc_ldata.txp_rxloring,
1671             &sc->sc_ldata.txp_rxloring_paddr);
1672         /* Receive buffer ring. */
1673         txp_dma_free(sc, &sc->sc_cdata.txp_rxbufs_tag,
1674             sc->sc_cdata.txp_rxbufs_map, (void **)&sc->sc_ldata.txp_rxbufs,
1675             &sc->sc_ldata.txp_rxbufs_paddr);
1676         /* Command ring. */
1677         txp_dma_free(sc, &sc->sc_cdata.txp_cmdring_tag,
1678             sc->sc_cdata.txp_cmdring_map, (void **)&sc->sc_ldata.txp_cmdring,
1679             &sc->sc_ldata.txp_cmdring_paddr);
1680         /* Response ring. */
1681         txp_dma_free(sc, &sc->sc_cdata.txp_rspring_tag,
1682             sc->sc_cdata.txp_rspring_map, (void **)&sc->sc_ldata.txp_rspring,
1683             &sc->sc_ldata.txp_rspring_paddr);
1684         /* Zero ring. */
1685         txp_dma_free(sc, &sc->sc_cdata.txp_zero_tag,
1686             sc->sc_cdata.txp_zero_map, (void **)&sc->sc_ldata.txp_zero,
1687             &sc->sc_ldata.txp_zero_paddr);
1688         /* Host variables. */
1689         txp_dma_free(sc, &sc->sc_cdata.txp_hostvar_tag,
1690             sc->sc_cdata.txp_hostvar_map, (void **)&sc->sc_ldata.txp_hostvar,
1691             &sc->sc_ldata.txp_hostvar_paddr);
1692         /* Boot record. */
1693         txp_dma_free(sc, &sc->sc_cdata.txp_boot_tag,
1694             sc->sc_cdata.txp_boot_map, (void **)&sc->sc_ldata.txp_boot,
1695             &sc->sc_ldata.txp_boot_paddr);
1696
1697         if (sc->sc_cdata.txp_parent_tag != NULL) {
1698                 bus_dma_tag_destroy(sc->sc_cdata.txp_parent_tag);
1699                 sc->sc_cdata.txp_parent_tag = NULL;
1700         }
1701
1702 }
1703
1704 static int
1705 txp_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
1706 {
1707         struct txp_softc *sc = ifp->if_softc;
1708         struct ifreq *ifr = (struct ifreq *)data;
1709         int capenable, error = 0, mask;
1710
1711         switch(command) {
1712         case SIOCSIFFLAGS:
1713                 TXP_LOCK(sc);
1714                 if ((ifp->if_flags & IFF_UP) != 0) {
1715                         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0) {
1716                                 if (((ifp->if_flags ^ sc->sc_if_flags)
1717                                     & (IFF_PROMISC | IFF_ALLMULTI)) != 0)
1718                                         txp_set_filter(sc);
1719                         } else {
1720                                 if ((sc->sc_flags & TXP_FLAG_DETACH) == 0)
1721                                         txp_init_locked(sc);
1722                         }
1723                 } else {
1724                         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0)
1725                                 txp_stop(sc);
1726                 }
1727                 sc->sc_if_flags = ifp->if_flags;
1728                 TXP_UNLOCK(sc);
1729                 break;
1730         case SIOCADDMULTI:
1731         case SIOCDELMULTI:
1732                 /*
1733                  * Multicast list has changed; set the hardware
1734                  * filter accordingly.
1735                  */
1736                 TXP_LOCK(sc);
1737                 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0)
1738                         txp_set_filter(sc);
1739                 TXP_UNLOCK(sc);
1740                 break;
1741         case SIOCSIFCAP:
1742                 TXP_LOCK(sc);
1743                 capenable = ifp->if_capenable;
1744                 mask = ifr->ifr_reqcap ^ ifp->if_capenable;
1745                 if ((mask & IFCAP_TXCSUM) != 0 &&
1746                     (ifp->if_capabilities & IFCAP_TXCSUM) != 0) {
1747                         ifp->if_capenable ^= IFCAP_TXCSUM;
1748                         if ((ifp->if_capenable & IFCAP_TXCSUM) != 0)
1749                                 ifp->if_hwassist |= TXP_CSUM_FEATURES;
1750                         else
1751                                 ifp->if_hwassist &= ~TXP_CSUM_FEATURES;
1752                 }
1753                 if ((mask & IFCAP_RXCSUM) != 0 &&
1754                     (ifp->if_capabilities & IFCAP_RXCSUM) != 0)
1755                         ifp->if_capenable ^= IFCAP_RXCSUM;
1756                 if ((mask & IFCAP_WOL_MAGIC) != 0 &&
1757                     (ifp->if_capabilities & IFCAP_WOL_MAGIC) != 0)
1758                         ifp->if_capenable ^= IFCAP_WOL_MAGIC;
1759                 if ((mask & IFCAP_VLAN_HWTAGGING) != 0 &&
1760                     (ifp->if_capabilities & IFCAP_VLAN_HWTAGGING) != 0)
1761                         ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING;
1762                 if ((mask & IFCAP_VLAN_HWCSUM) != 0 &&
1763                     (ifp->if_capabilities & IFCAP_VLAN_HWCSUM) != 0)
1764                         ifp->if_capenable ^= IFCAP_VLAN_HWCSUM;
1765                 if ((ifp->if_capenable & IFCAP_TXCSUM) == 0)
1766                         ifp->if_capenable &= ~IFCAP_VLAN_HWCSUM;
1767                 if ((ifp->if_capenable & IFCAP_VLAN_HWTAGGING) == 0)
1768                         ifp->if_capenable &= ~IFCAP_VLAN_HWCSUM;
1769                 if (capenable != ifp->if_capenable)
1770                         txp_set_capabilities(sc);
1771                 TXP_UNLOCK(sc);
1772                 VLAN_CAPABILITIES(ifp);
1773                 break;
1774         case SIOCGIFMEDIA:
1775         case SIOCSIFMEDIA:
1776                 error = ifmedia_ioctl(ifp, ifr, &sc->sc_ifmedia, command);
1777                 break;
1778         default:
1779                 error = ether_ioctl(ifp, command, data);
1780                 break;
1781         }
1782
1783         return (error);
1784 }
1785
1786 static int
1787 txp_rxring_fill(struct txp_softc *sc)
1788 {
1789         struct txp_rxbuf_desc *rbd;
1790         struct txp_rx_swdesc *sd;
1791         bus_dma_segment_t segs[1];
1792         int error, i, nsegs;
1793
1794         TXP_LOCK_ASSERT(sc);
1795
1796         bus_dmamap_sync(sc->sc_cdata.txp_rxbufs_tag,
1797             sc->sc_cdata.txp_rxbufs_map,
1798             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1799
1800         for (i = 0; i < RXBUF_ENTRIES; i++) {
1801                 sd = TAILQ_FIRST(&sc->sc_free_list);
1802                 if (sd == NULL)
1803                         return (ENOMEM);
1804                 rbd = sc->sc_rxbufs + i;
1805                 bcopy(&sd, (u_long *)&rbd->rb_vaddrlo, sizeof(sd));
1806                 KASSERT(sd->sd_mbuf == NULL,
1807                     ("%s : Rx buffer ring corrupted", __func__));
1808                 sd->sd_mbuf = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1809                 if (sd->sd_mbuf == NULL)
1810                         return (ENOMEM);
1811                 sd->sd_mbuf->m_pkthdr.len = sd->sd_mbuf->m_len = MCLBYTES;
1812 #ifndef __NO_STRICT_ALIGNMENT
1813                 m_adj(sd->sd_mbuf, TXP_RXBUF_ALIGN);
1814 #endif
1815                 if ((error = bus_dmamap_load_mbuf_sg(sc->sc_cdata.txp_rx_tag,
1816                     sd->sd_map, sd->sd_mbuf, segs, &nsegs, 0)) != 0) {
1817                         m_freem(sd->sd_mbuf);
1818                         sd->sd_mbuf = NULL;
1819                         return (error);
1820                 }
1821                 KASSERT(nsegs == 1, ("%s : %d segments returned!", __func__,
1822                     nsegs));
1823                 TAILQ_REMOVE(&sc->sc_free_list, sd, sd_next);
1824                 TAILQ_INSERT_TAIL(&sc->sc_busy_list, sd, sd_next);
1825                 bus_dmamap_sync(sc->sc_cdata.txp_rx_tag, sd->sd_map,
1826                     BUS_DMASYNC_PREREAD);
1827                 rbd->rb_paddrlo = htole32(TXP_ADDR_LO(segs[0].ds_addr));
1828                 rbd->rb_paddrhi = htole32(TXP_ADDR_HI(segs[0].ds_addr));
1829         }
1830
1831         bus_dmamap_sync(sc->sc_cdata.txp_rxbufs_tag,
1832             sc->sc_cdata.txp_rxbufs_map,
1833             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1834         sc->sc_rxbufprod = RXBUF_ENTRIES - 1;
1835         sc->sc_hostvar->hv_rx_buf_write_idx =
1836             htole32(TXP_IDX2OFFSET(RXBUF_ENTRIES - 1));
1837
1838         return (0);
1839 }
1840
1841 static void
1842 txp_rxring_empty(struct txp_softc *sc)
1843 {
1844         struct txp_rx_swdesc *sd;
1845         int cnt;
1846
1847         TXP_LOCK_ASSERT(sc);
1848
1849         if (sc->sc_rxbufs == NULL)
1850                 return;
1851         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
1852             sc->sc_cdata.txp_hostvar_map,
1853             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1854
1855         /* Release allocated Rx buffers. */
1856         cnt = 0;
1857         while ((sd = TAILQ_FIRST(&sc->sc_busy_list)) != NULL) {
1858                 TAILQ_REMOVE(&sc->sc_busy_list, sd, sd_next);
1859                 KASSERT(sd->sd_mbuf != NULL,
1860                     ("%s : Rx buffer ring corrupted", __func__));
1861                 bus_dmamap_sync(sc->sc_cdata.txp_rx_tag, sd->sd_map,
1862                     BUS_DMASYNC_POSTREAD);
1863                 bus_dmamap_unload(sc->sc_cdata.txp_rx_tag, sd->sd_map);
1864                 m_freem(sd->sd_mbuf);
1865                 sd->sd_mbuf = NULL;
1866                 TAILQ_INSERT_TAIL(&sc->sc_free_list, sd, sd_next);
1867                 cnt++;
1868         }
1869 }
1870
1871 static void
1872 txp_init(void *xsc)
1873 {
1874         struct txp_softc *sc;
1875
1876         sc = xsc;
1877         TXP_LOCK(sc);
1878         txp_init_locked(sc);
1879         TXP_UNLOCK(sc);
1880 }
1881
1882 static void
1883 txp_init_locked(struct txp_softc *sc)
1884 {
1885         struct ifnet *ifp;
1886         uint8_t *eaddr;
1887         uint16_t p1;
1888         uint32_t p2;
1889         int error;
1890
1891         TXP_LOCK_ASSERT(sc);
1892         ifp = sc->sc_ifp;
1893
1894         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) != 0)
1895                 return;
1896
1897         /* Initialize ring structure. */
1898         txp_init_rings(sc);
1899         /* Wakeup controller. */
1900         WRITE_REG(sc, TXP_H2A_0, TXP_BOOTCMD_WAKEUP);
1901         TXP_BARRIER(sc, TXP_H2A_0, 4, BUS_SPACE_BARRIER_WRITE);
1902         /*
1903          * It seems that earlier NV image can go back to online from
1904          * wakeup command but newer ones require controller reset.
1905          * So jut reset controller again.
1906          */
1907         if (txp_reset(sc) != 0)
1908                 goto init_fail;
1909         /* Download firmware. */
1910         error = txp_download_fw(sc);
1911         if (error != 0) {
1912                 device_printf(sc->sc_dev, "could not download firmware.\n");
1913                 goto init_fail;
1914         }
1915         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
1916             sc->sc_cdata.txp_hostvar_map,
1917             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1918         if ((error = txp_rxring_fill(sc)) != 0) {
1919                 device_printf(sc->sc_dev, "no memory for Rx buffers.\n");
1920                 goto init_fail;
1921         }
1922         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
1923             sc->sc_cdata.txp_hostvar_map,
1924             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1925         if (txp_boot(sc, STAT_WAITING_FOR_BOOT) != 0) {
1926                 device_printf(sc->sc_dev, "could not boot firmware.\n");
1927                 goto init_fail;
1928         }
1929
1930         /*
1931          * Quite contrary to Typhoon T2 software functional specification,
1932          * it seems that TXP_CMD_RECV_BUFFER_CONTROL command is not
1933          * implemented in the firmware. This means driver should have to
1934          * handle misaligned frames on alignment architectures. AFAIK this
1935          * is the only controller manufactured by 3Com that has this stupid
1936          * bug. 3Com should fix this.
1937          */
1938         if (txp_command(sc, TXP_CMD_MAX_PKT_SIZE_WRITE, TXP_MAX_PKTLEN, 0, 0,
1939             NULL, NULL, NULL, TXP_CMD_NOWAIT) != 0)
1940                 goto init_fail;
1941         /* Undocumented command(interrupt coalescing disable?) - From Linux. */
1942         if (txp_command(sc, TXP_CMD_FILTER_DEFINE, 0, 0, 0, NULL, NULL, NULL,
1943             TXP_CMD_NOWAIT) != 0)
1944                 goto init_fail;
1945
1946         /* Set station address. */
1947         eaddr = IF_LLADDR(sc->sc_ifp);
1948         p1 = 0;
1949         ((uint8_t *)&p1)[1] = eaddr[0];
1950         ((uint8_t *)&p1)[0] = eaddr[1];
1951         p1 = le16toh(p1);
1952         ((uint8_t *)&p2)[3] = eaddr[2];
1953         ((uint8_t *)&p2)[2] = eaddr[3];
1954         ((uint8_t *)&p2)[1] = eaddr[4];
1955         ((uint8_t *)&p2)[0] = eaddr[5];
1956         p2 = le32toh(p2);
1957         if (txp_command(sc, TXP_CMD_STATION_ADDRESS_WRITE, p1, p2, 0,
1958             NULL, NULL, NULL, TXP_CMD_NOWAIT) != 0)
1959                 goto init_fail;
1960
1961         txp_set_filter(sc);
1962         txp_set_capabilities(sc);
1963
1964         if (txp_command(sc, TXP_CMD_CLEAR_STATISTICS, 0, 0, 0,
1965             NULL, NULL, NULL, TXP_CMD_NOWAIT))
1966                 goto init_fail;
1967         if (txp_command(sc, TXP_CMD_XCVR_SELECT, sc->sc_xcvr, 0, 0,
1968             NULL, NULL, NULL, TXP_CMD_NOWAIT) != 0)
1969                 goto init_fail;
1970         if (txp_command(sc, TXP_CMD_TX_ENABLE, 0, 0, 0, NULL, NULL, NULL,
1971             TXP_CMD_NOWAIT) != 0)
1972                 goto init_fail;
1973         if (txp_command(sc, TXP_CMD_RX_ENABLE, 0, 0, 0, NULL, NULL, NULL,
1974             TXP_CMD_NOWAIT) != 0)
1975                 goto init_fail;
1976
1977         /* Ack all pending interrupts and enable interrupts. */
1978         WRITE_REG(sc, TXP_ISR, TXP_INTR_ALL);
1979         WRITE_REG(sc, TXP_IER, TXP_INTRS);
1980         WRITE_REG(sc, TXP_IMR, TXP_INTR_NONE);
1981
1982         ifp->if_drv_flags |= IFF_DRV_RUNNING;
1983         ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1984
1985         callout_reset(&sc->sc_tick, hz, txp_tick, sc);
1986         return;
1987
1988 init_fail:
1989         txp_rxring_empty(sc);
1990         txp_init_rings(sc);
1991         txp_reset(sc);
1992         WRITE_REG(sc, TXP_IMR, TXP_INTR_ALL);
1993 }
1994
1995 static void
1996 txp_tick(void *vsc)
1997 {
1998         struct txp_softc *sc;
1999         struct ifnet *ifp;
2000         struct txp_rsp_desc *rsp;
2001         struct txp_ext_desc *ext;
2002         int link;
2003
2004         sc = vsc;
2005         TXP_LOCK_ASSERT(sc);
2006         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2007             sc->sc_cdata.txp_hostvar_map,
2008             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2009         txp_rxbuf_reclaim(sc);
2010         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2011             sc->sc_cdata.txp_hostvar_map,
2012             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2013
2014         ifp = sc->sc_ifp;
2015         rsp = NULL;
2016
2017         link = sc->sc_flags & TXP_FLAG_LINK;
2018         if (txp_ext_command(sc, TXP_CMD_READ_STATISTICS, 0, 0, 0, NULL, 0,
2019             &rsp, TXP_CMD_WAIT))
2020                 goto out;
2021         if (rsp->rsp_numdesc != 6)
2022                 goto out;
2023         txp_stats_update(sc, rsp);
2024         if (link == 0 && (sc->sc_flags & TXP_FLAG_LINK) != 0) {
2025                 ext = (struct txp_ext_desc *)(rsp + 1);
2026                 /* Update baudrate with resolved speed. */
2027                 if ((ext[5].ext_2 & 0x02) != 0)
2028                         ifp->if_baudrate = IF_Mbps(100);
2029                 else
2030                         ifp->if_baudrate = IF_Mbps(10);
2031         }
2032
2033 out:
2034         if (rsp != NULL)
2035                 free(rsp, M_DEVBUF);
2036         txp_watchdog(sc);
2037         callout_reset(&sc->sc_tick, hz, txp_tick, sc);
2038 }
2039
2040 static void
2041 txp_start(struct ifnet *ifp)
2042 {
2043         struct txp_softc *sc;
2044
2045         sc = ifp->if_softc;
2046         TXP_LOCK(sc);
2047         txp_start_locked(ifp);
2048         TXP_UNLOCK(sc);
2049 }
2050
2051 static void
2052 txp_start_locked(struct ifnet *ifp)
2053 {
2054         struct txp_softc *sc;
2055         struct mbuf *m_head;
2056         int enq;
2057
2058         sc = ifp->if_softc;
2059         TXP_LOCK_ASSERT(sc);
2060
2061         if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
2062            IFF_DRV_RUNNING || (sc->sc_flags & TXP_FLAG_LINK) == 0)
2063                 return;
2064
2065         for (enq = 0; !IFQ_DRV_IS_EMPTY(&ifp->if_snd); ) {
2066                 IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head);
2067                 if (m_head == NULL)
2068                         break;
2069                 /*
2070                  * Pack the data into the transmit ring. If we
2071                  * don't have room, set the OACTIVE flag and wait
2072                  * for the NIC to drain the ring.
2073                  * ATM only Hi-ring is used.
2074                  */
2075                 if (txp_encap(sc, &sc->sc_txhir, &m_head)) {
2076                         if (m_head == NULL)
2077                                 break;
2078                         IFQ_DRV_PREPEND(&ifp->if_snd, m_head);
2079                         ifp->if_drv_flags |= IFF_DRV_OACTIVE;
2080                         break;
2081                 }
2082
2083                 /*
2084                  * If there's a BPF listener, bounce a copy of this frame
2085                  * to him.
2086                  */
2087                 ETHER_BPF_MTAP(ifp, m_head);
2088
2089                 /* Send queued frame. */
2090                 WRITE_REG(sc, sc->sc_txhir.r_reg,
2091                     TXP_IDX2OFFSET(sc->sc_txhir.r_prod));
2092         }
2093
2094         if (enq > 0) {
2095                 /* Set a timeout in case the chip goes out to lunch. */
2096                 sc->sc_watchdog_timer = TXP_TX_TIMEOUT;
2097         }
2098 }
2099
2100 static int
2101 txp_encap(struct txp_softc *sc, struct txp_tx_ring *r, struct mbuf **m_head)
2102 {
2103         struct txp_tx_desc *first_txd;
2104         struct txp_frag_desc *fxd;
2105         struct txp_swdesc *sd;
2106         struct mbuf *m;
2107         bus_dma_segment_t txsegs[TXP_MAXTXSEGS];
2108         int error, i, nsegs;
2109
2110         TXP_LOCK_ASSERT(sc);
2111
2112         M_ASSERTPKTHDR((*m_head));
2113
2114         m = *m_head;
2115         first_txd = r->r_desc + r->r_prod;
2116         sd = sc->sc_txd + r->r_prod;
2117
2118         error = bus_dmamap_load_mbuf_sg(sc->sc_cdata.txp_tx_tag, sd->sd_map,
2119             *m_head, txsegs, &nsegs, 0);
2120         if (error == EFBIG) {
2121                 m = m_collapse(*m_head, M_NOWAIT, TXP_MAXTXSEGS);
2122                 if (m == NULL) {
2123                         m_freem(*m_head);
2124                         *m_head = NULL;
2125                         return (ENOMEM);
2126                 }
2127                 *m_head = m;
2128                 error = bus_dmamap_load_mbuf_sg(sc->sc_cdata.txp_tx_tag,
2129                     sd->sd_map, *m_head, txsegs, &nsegs, 0);
2130                 if (error != 0) {
2131                         m_freem(*m_head);
2132                         *m_head = NULL;
2133                         return (error);
2134                 }
2135         } else if (error != 0)
2136                 return (error);
2137         if (nsegs == 0) {
2138                 m_freem(*m_head);
2139                 *m_head = NULL;
2140                 return (EIO);
2141         }
2142
2143         /* Check descriptor overrun. */
2144         if (r->r_cnt + nsegs >= TX_ENTRIES - TXP_TXD_RESERVED) {
2145                 bus_dmamap_unload(sc->sc_cdata.txp_tx_tag, sd->sd_map);
2146                 return (ENOBUFS);
2147         }
2148         bus_dmamap_sync(sc->sc_cdata.txp_tx_tag, sd->sd_map,
2149             BUS_DMASYNC_PREWRITE);
2150         sd->sd_mbuf = m;
2151
2152         first_txd->tx_flags = TX_FLAGS_TYPE_DATA;
2153         first_txd->tx_numdesc = 0;
2154         first_txd->tx_addrlo = 0;
2155         first_txd->tx_addrhi = 0;
2156         first_txd->tx_totlen = 0;
2157         first_txd->tx_pflags = 0;
2158         r->r_cnt++;
2159         TXP_DESC_INC(r->r_prod, TX_ENTRIES);
2160
2161         /* Configure Tx IP/TCP/UDP checksum offload. */
2162         if ((m->m_pkthdr.csum_flags & CSUM_IP) != 0)
2163                 first_txd->tx_pflags |= htole32(TX_PFLAGS_IPCKSUM);
2164 #ifdef notyet
2165         /* XXX firmware bug. */
2166         if ((m->m_pkthdr.csum_flags & CSUM_TCP) != 0)
2167                 first_txd->tx_pflags |= htole32(TX_PFLAGS_TCPCKSUM);
2168         if ((m->m_pkthdr.csum_flags & CSUM_UDP) != 0)
2169                 first_txd->tx_pflags |= htole32(TX_PFLAGS_UDPCKSUM);
2170 #endif
2171
2172         /* Configure VLAN hardware tag insertion. */
2173         if ((m->m_flags & M_VLANTAG) != 0)
2174                 first_txd->tx_pflags |=
2175                     htole32(TX_PFLAGS_VLAN | TX_PFLAGS_PRIO |
2176                     (bswap16(m->m_pkthdr.ether_vtag) << TX_PFLAGS_VLANTAG_S));
2177
2178         for (i = 0; i < nsegs; i++) {
2179                 fxd = (struct txp_frag_desc *)(r->r_desc + r->r_prod);
2180                 fxd->frag_flags = FRAG_FLAGS_TYPE_FRAG | TX_FLAGS_VALID;
2181                 fxd->frag_rsvd1 = 0;
2182                 fxd->frag_len = htole16(txsegs[i].ds_len);
2183                 fxd->frag_addrhi = htole32(TXP_ADDR_HI(txsegs[i].ds_addr));
2184                 fxd->frag_addrlo = htole32(TXP_ADDR_LO(txsegs[i].ds_addr));
2185                 fxd->frag_rsvd2 = 0;
2186                 first_txd->tx_numdesc++;
2187                 r->r_cnt++;
2188                 TXP_DESC_INC(r->r_prod, TX_ENTRIES);
2189         }
2190
2191         /* Lastly set valid flag. */
2192         first_txd->tx_flags |= TX_FLAGS_VALID;
2193
2194         /* Sync descriptors. */
2195         bus_dmamap_sync(r->r_tag, r->r_map,
2196             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2197
2198         return (0);
2199 }
2200
2201 /*
2202  * Handle simple commands sent to the typhoon
2203  */
2204 static int
2205 txp_command(struct txp_softc *sc, uint16_t id, uint16_t in1, uint32_t in2,
2206     uint32_t in3, uint16_t *out1, uint32_t *out2, uint32_t *out3, int wait)
2207 {
2208         struct txp_rsp_desc *rsp;
2209
2210         rsp = NULL;
2211         if (txp_ext_command(sc, id, in1, in2, in3, NULL, 0, &rsp, wait) != 0) {
2212                 device_printf(sc->sc_dev, "command 0x%02x failed\n", id);
2213                 return (-1);
2214         }
2215
2216         if (wait == TXP_CMD_NOWAIT)
2217                 return (0);
2218
2219         KASSERT(rsp != NULL, ("rsp is NULL!\n"));
2220         if (out1 != NULL)
2221                 *out1 = le16toh(rsp->rsp_par1);
2222         if (out2 != NULL)
2223                 *out2 = le32toh(rsp->rsp_par2);
2224         if (out3 != NULL)
2225                 *out3 = le32toh(rsp->rsp_par3);
2226         free(rsp, M_DEVBUF);
2227         return (0);
2228 }
2229
2230 static int
2231 txp_ext_command(struct txp_softc *sc, uint16_t id, uint16_t in1, uint32_t in2,
2232     uint32_t in3, struct txp_ext_desc *in_extp, uint8_t in_extn,
2233     struct txp_rsp_desc **rspp, int wait)
2234 {
2235         struct txp_hostvar *hv;
2236         struct txp_cmd_desc *cmd;
2237         struct txp_ext_desc *ext;
2238         uint32_t idx, i;
2239         uint16_t seq;
2240         int error;
2241
2242         error = 0;
2243         hv = sc->sc_hostvar;
2244         if (txp_cmd_desc_numfree(sc) < (in_extn + 1)) {
2245                 device_printf(sc->sc_dev,
2246                     "%s : out of free cmd descriptors for command 0x%02x\n",
2247                     __func__, id);
2248                 return (ENOBUFS);
2249         }
2250
2251         bus_dmamap_sync(sc->sc_cdata.txp_cmdring_tag,
2252             sc->sc_cdata.txp_cmdring_map, BUS_DMASYNC_POSTWRITE);
2253         idx = sc->sc_cmdring.lastwrite;
2254         cmd = (struct txp_cmd_desc *)(((uint8_t *)sc->sc_cmdring.base) + idx);
2255         bzero(cmd, sizeof(*cmd));
2256
2257         cmd->cmd_numdesc = in_extn;
2258         seq = sc->sc_seq++;
2259         cmd->cmd_seq = htole16(seq);
2260         cmd->cmd_id = htole16(id);
2261         cmd->cmd_par1 = htole16(in1);
2262         cmd->cmd_par2 = htole32(in2);
2263         cmd->cmd_par3 = htole32(in3);
2264         cmd->cmd_flags = CMD_FLAGS_TYPE_CMD |
2265             (wait == TXP_CMD_WAIT ? CMD_FLAGS_RESP : 0) | CMD_FLAGS_VALID;
2266
2267         idx += sizeof(struct txp_cmd_desc);
2268         if (idx == sc->sc_cmdring.size)
2269                 idx = 0;
2270
2271         for (i = 0; i < in_extn; i++) {
2272                 ext = (struct txp_ext_desc *)(((uint8_t *)sc->sc_cmdring.base) + idx);
2273                 bcopy(in_extp, ext, sizeof(struct txp_ext_desc));
2274                 in_extp++;
2275                 idx += sizeof(struct txp_cmd_desc);
2276                 if (idx == sc->sc_cmdring.size)
2277                         idx = 0;
2278         }
2279
2280         sc->sc_cmdring.lastwrite = idx;
2281         bus_dmamap_sync(sc->sc_cdata.txp_cmdring_tag,
2282             sc->sc_cdata.txp_cmdring_map, BUS_DMASYNC_PREWRITE);
2283         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2284             sc->sc_cdata.txp_hostvar_map, BUS_DMASYNC_PREREAD |
2285             BUS_DMASYNC_PREWRITE);
2286         WRITE_REG(sc, TXP_H2A_2, sc->sc_cmdring.lastwrite);
2287         TXP_BARRIER(sc, TXP_H2A_2, 4, BUS_SPACE_BARRIER_WRITE);
2288
2289         if (wait == TXP_CMD_NOWAIT)
2290                 return (0);
2291
2292         for (i = 0; i < TXP_TIMEOUT; i++) {
2293                 bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2294                     sc->sc_cdata.txp_hostvar_map, BUS_DMASYNC_POSTREAD |
2295                     BUS_DMASYNC_POSTWRITE);
2296                 if (le32toh(hv->hv_resp_read_idx) !=
2297                     le32toh(hv->hv_resp_write_idx)) {
2298                         error = txp_response(sc, id, seq, rspp);
2299                         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2300                             sc->sc_cdata.txp_hostvar_map,
2301                             BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2302                         if (error != 0)
2303                                 return (error);
2304                         if (*rspp != NULL)
2305                                 break;
2306                 }
2307                 DELAY(50);
2308         }
2309         if (i == TXP_TIMEOUT) {
2310                 device_printf(sc->sc_dev, "command 0x%02x timedout\n", id);
2311                 error = ETIMEDOUT;
2312         }
2313
2314         return (error);
2315 }
2316
2317 static int
2318 txp_response(struct txp_softc *sc, uint16_t id, uint16_t seq,
2319     struct txp_rsp_desc **rspp)
2320 {
2321         struct txp_hostvar *hv;
2322         struct txp_rsp_desc *rsp;
2323         uint32_t ridx;
2324
2325         bus_dmamap_sync(sc->sc_cdata.txp_rspring_tag,
2326             sc->sc_cdata.txp_rspring_map, BUS_DMASYNC_POSTREAD);
2327         hv = sc->sc_hostvar;
2328         ridx = le32toh(hv->hv_resp_read_idx);
2329         while (ridx != le32toh(hv->hv_resp_write_idx)) {
2330                 rsp = (struct txp_rsp_desc *)(((uint8_t *)sc->sc_rspring.base) + ridx);
2331
2332                 if (id == le16toh(rsp->rsp_id) &&
2333                     le16toh(rsp->rsp_seq) == seq) {
2334                         *rspp = (struct txp_rsp_desc *)malloc(
2335                             sizeof(struct txp_rsp_desc) * (rsp->rsp_numdesc + 1),
2336                             M_DEVBUF, M_NOWAIT);
2337                         if (*rspp == NULL) {
2338                                 device_printf(sc->sc_dev,"%s : command 0x%02x "
2339                                     "memory allocation failure\n",
2340                                     __func__, id);
2341                                 return (ENOMEM);
2342                         }
2343                         txp_rsp_fixup(sc, rsp, *rspp);
2344                         return (0);
2345                 }
2346
2347                 if ((rsp->rsp_flags & RSP_FLAGS_ERROR) != 0) {
2348                         device_printf(sc->sc_dev,
2349                             "%s : command 0x%02x response error!\n", __func__,
2350                             le16toh(rsp->rsp_id));
2351                         txp_rsp_fixup(sc, rsp, NULL);
2352                         ridx = le32toh(hv->hv_resp_read_idx);
2353                         continue;
2354                 }
2355
2356                 /*
2357                  * The following unsolicited responses are handled during
2358                  * processing of TXP_CMD_READ_STATISTICS which requires
2359                  * response. Driver abuses the command to detect media
2360                  * status change.
2361                  * TXP_CMD_FILTER_DEFINE is not an unsolicited response
2362                  * but we don't process response ring in interrupt handler
2363                  * so we have to ignore this command here, otherwise
2364                  * unknown command message would be printed.
2365                  */
2366                 switch (le16toh(rsp->rsp_id)) {
2367                 case TXP_CMD_CYCLE_STATISTICS:
2368                 case TXP_CMD_FILTER_DEFINE:
2369                         break;
2370                 case TXP_CMD_MEDIA_STATUS_READ:
2371                         if ((le16toh(rsp->rsp_par1) & 0x0800) == 0) {
2372                                 sc->sc_flags |= TXP_FLAG_LINK;
2373                                 if_link_state_change(sc->sc_ifp,
2374                                     LINK_STATE_UP);
2375                         } else {
2376                                 sc->sc_flags &= ~TXP_FLAG_LINK;
2377                                 if_link_state_change(sc->sc_ifp,
2378                                     LINK_STATE_DOWN);
2379                         }
2380                         break;
2381                 case TXP_CMD_HELLO_RESPONSE:
2382                         /*
2383                          * Driver should repsond to hello message but
2384                          * TXP_CMD_READ_STATISTICS is issued for every
2385                          * hz, therefore there is no need to send an
2386                          * explicit command here.
2387                          */
2388                         device_printf(sc->sc_dev, "%s : hello\n", __func__);
2389                         break;
2390                 default:
2391                         device_printf(sc->sc_dev,
2392                             "%s : unknown command 0x%02x\n", __func__,
2393                             le16toh(rsp->rsp_id));
2394                 }
2395                 txp_rsp_fixup(sc, rsp, NULL);
2396                 ridx = le32toh(hv->hv_resp_read_idx);
2397         }
2398
2399         return (0);
2400 }
2401
2402 static void
2403 txp_rsp_fixup(struct txp_softc *sc, struct txp_rsp_desc *rsp,
2404     struct txp_rsp_desc *dst)
2405 {
2406         struct txp_rsp_desc *src;
2407         struct txp_hostvar *hv;
2408         uint32_t i, ridx;
2409
2410         src = rsp;
2411         hv = sc->sc_hostvar;
2412         ridx = le32toh(hv->hv_resp_read_idx);
2413
2414         for (i = 0; i < rsp->rsp_numdesc + 1; i++) {
2415                 if (dst != NULL)
2416                         bcopy(src, dst++, sizeof(struct txp_rsp_desc));
2417                 ridx += sizeof(struct txp_rsp_desc);
2418                 if (ridx == sc->sc_rspring.size) {
2419                         src = sc->sc_rspring.base;
2420                         ridx = 0;
2421                 } else
2422                         src++;
2423                 sc->sc_rspring.lastwrite = ridx;
2424         }
2425
2426         hv->hv_resp_read_idx = htole32(ridx);
2427 }
2428
2429 static int
2430 txp_cmd_desc_numfree(struct txp_softc *sc)
2431 {
2432         struct txp_hostvar *hv;
2433         struct txp_boot_record *br;
2434         uint32_t widx, ridx, nfree;
2435
2436         bus_dmamap_sync(sc->sc_cdata.txp_hostvar_tag,
2437             sc->sc_cdata.txp_hostvar_map,
2438             BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
2439         hv = sc->sc_hostvar;
2440         br = sc->sc_boot;
2441         widx = sc->sc_cmdring.lastwrite;
2442         ridx = le32toh(hv->hv_cmd_read_idx);
2443
2444         if (widx == ridx) {
2445                 /* Ring is completely free */
2446                 nfree = le32toh(br->br_cmd_siz) - sizeof(struct txp_cmd_desc);
2447         } else {
2448                 if (widx > ridx)
2449                         nfree = le32toh(br->br_cmd_siz) -
2450                             (widx - ridx + sizeof(struct txp_cmd_desc));
2451                 else
2452                         nfree = ridx - widx - sizeof(struct txp_cmd_desc);
2453         }
2454
2455         return (nfree / sizeof(struct txp_cmd_desc));
2456 }
2457
2458 static int
2459 txp_sleep(struct txp_softc *sc, int capenable)
2460 {
2461         uint16_t events;
2462         int error;
2463
2464         events = 0;
2465         if ((capenable & IFCAP_WOL_MAGIC) != 0)
2466                 events |= 0x01;
2467         error = txp_command(sc, TXP_CMD_ENABLE_WAKEUP_EVENTS, events, 0, 0,
2468             NULL, NULL, NULL, TXP_CMD_NOWAIT);
2469         if (error == 0) {
2470                 /* Goto sleep. */
2471                 error = txp_command(sc, TXP_CMD_GOTO_SLEEP, 0, 0, 0, NULL,
2472                     NULL, NULL, TXP_CMD_NOWAIT);
2473                 if (error == 0) {
2474                         error = txp_wait(sc, STAT_SLEEPING);
2475                         if (error != 0)
2476                                 device_printf(sc->sc_dev,
2477                                     "unable to enter into sleep\n");
2478                 }
2479         }
2480
2481         return (error);
2482 }
2483
2484 static void
2485 txp_stop(struct txp_softc *sc)
2486 {
2487         struct ifnet *ifp;
2488
2489         TXP_LOCK_ASSERT(sc);
2490         ifp = sc->sc_ifp;
2491
2492         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0)
2493                 return;
2494
2495         WRITE_REG(sc, TXP_IER, TXP_INTR_NONE);
2496         WRITE_REG(sc, TXP_ISR, TXP_INTR_ALL);
2497
2498         ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
2499         sc->sc_flags &= ~TXP_FLAG_LINK;
2500
2501         callout_stop(&sc->sc_tick);
2502
2503         txp_command(sc, TXP_CMD_TX_DISABLE, 0, 0, 0, NULL, NULL, NULL,
2504             TXP_CMD_NOWAIT);
2505         txp_command(sc, TXP_CMD_RX_DISABLE, 0, 0, 0, NULL, NULL, NULL,
2506             TXP_CMD_NOWAIT);
2507         /* Save statistics for later use. */
2508         txp_stats_save(sc);
2509         /* Halt controller. */
2510         txp_command(sc, TXP_CMD_HALT, 0, 0, 0, NULL, NULL, NULL,
2511             TXP_CMD_NOWAIT);
2512
2513         if (txp_wait(sc, STAT_HALTED) != 0)
2514                 device_printf(sc->sc_dev, "controller halt timedout!\n");
2515         /* Reclaim Tx/Rx buffers. */
2516         if (sc->sc_txhir.r_cnt && (sc->sc_txhir.r_cons !=
2517             TXP_OFFSET2IDX(le32toh(*(sc->sc_txhir.r_off)))))
2518                 txp_tx_reclaim(sc, &sc->sc_txhir);
2519         if (sc->sc_txlor.r_cnt && (sc->sc_txlor.r_cons !=
2520             TXP_OFFSET2IDX(le32toh(*(sc->sc_txlor.r_off)))))
2521                 txp_tx_reclaim(sc, &sc->sc_txlor);
2522         txp_rxring_empty(sc);
2523
2524         txp_init_rings(sc);
2525         /* Reset controller and make it reload sleep image. */
2526         txp_reset(sc);
2527         /* Let controller boot from sleep image. */
2528         if (txp_boot(sc, STAT_WAITING_FOR_HOST_REQUEST) != 0)
2529                 device_printf(sc->sc_dev, "could not boot sleep image\n");
2530         txp_sleep(sc, 0);
2531 }
2532
2533 static void
2534 txp_watchdog(struct txp_softc *sc)
2535 {
2536         struct ifnet *ifp;
2537
2538         TXP_LOCK_ASSERT(sc);
2539
2540         if (sc->sc_watchdog_timer == 0 || --sc->sc_watchdog_timer)
2541                 return;
2542
2543         ifp = sc->sc_ifp;
2544         if_printf(ifp, "watchdog timeout -- resetting\n");
2545         if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
2546         txp_stop(sc);
2547         txp_init_locked(sc);
2548 }
2549
2550 static int
2551 txp_ifmedia_upd(struct ifnet *ifp)
2552 {
2553         struct txp_softc *sc = ifp->if_softc;
2554         struct ifmedia *ifm = &sc->sc_ifmedia;
2555         uint16_t new_xcvr;
2556
2557         TXP_LOCK(sc);
2558         if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) {
2559                 TXP_UNLOCK(sc);
2560                 return (EINVAL);
2561         }
2562
2563         if (IFM_SUBTYPE(ifm->ifm_media) == IFM_10_T) {
2564                 if ((ifm->ifm_media & IFM_GMASK) == IFM_FDX)
2565                         new_xcvr = TXP_XCVR_10_FDX;
2566                 else
2567                         new_xcvr = TXP_XCVR_10_HDX;
2568         } else if (IFM_SUBTYPE(ifm->ifm_media) == IFM_100_TX) {
2569                 if ((ifm->ifm_media & IFM_GMASK) == IFM_FDX)
2570                         new_xcvr = TXP_XCVR_100_FDX;
2571                 else
2572                         new_xcvr = TXP_XCVR_100_HDX;
2573         } else if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) {
2574                 new_xcvr = TXP_XCVR_AUTO;
2575         } else {
2576                 TXP_UNLOCK(sc);
2577                 return (EINVAL);
2578         }
2579
2580         /* nothing to do */
2581         if (sc->sc_xcvr == new_xcvr) {
2582                 TXP_UNLOCK(sc);
2583                 return (0);
2584         }
2585
2586         txp_command(sc, TXP_CMD_XCVR_SELECT, new_xcvr, 0, 0,
2587             NULL, NULL, NULL, TXP_CMD_NOWAIT);
2588         sc->sc_xcvr = new_xcvr;
2589         TXP_UNLOCK(sc);
2590
2591         return (0);
2592 }
2593
2594 static void
2595 txp_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
2596 {
2597         struct txp_softc *sc = ifp->if_softc;
2598         struct ifmedia *ifm = &sc->sc_ifmedia;
2599         uint16_t bmsr, bmcr, anar, anlpar;
2600
2601         ifmr->ifm_status = IFM_AVALID;
2602         ifmr->ifm_active = IFM_ETHER;
2603
2604         TXP_LOCK(sc);
2605         /* Check whether firmware is running. */
2606         if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0)
2607                 goto bail;
2608         if (txp_command(sc, TXP_CMD_PHY_MGMT_READ, 0, MII_BMSR, 0,
2609             &bmsr, NULL, NULL, TXP_CMD_WAIT))
2610                 goto bail;
2611         if (txp_command(sc, TXP_CMD_PHY_MGMT_READ, 0, MII_BMSR, 0,
2612             &bmsr, NULL, NULL, TXP_CMD_WAIT))
2613                 goto bail;
2614
2615         if (txp_command(sc, TXP_CMD_PHY_MGMT_READ, 0, MII_BMCR, 0,
2616             &bmcr, NULL, NULL, TXP_CMD_WAIT))
2617                 goto bail;
2618
2619         if (txp_command(sc, TXP_CMD_PHY_MGMT_READ, 0, MII_ANLPAR, 0,
2620             &anlpar, NULL, NULL, TXP_CMD_WAIT))
2621                 goto bail;
2622
2623         if (txp_command(sc, TXP_CMD_PHY_MGMT_READ, 0, MII_ANAR, 0,
2624             &anar, NULL, NULL, TXP_CMD_WAIT))
2625                 goto bail;
2626         TXP_UNLOCK(sc);
2627
2628         if (bmsr & BMSR_LINK)
2629                 ifmr->ifm_status |= IFM_ACTIVE;
2630
2631         if (bmcr & BMCR_ISO) {
2632                 ifmr->ifm_active |= IFM_NONE;
2633                 ifmr->ifm_status = 0;
2634                 return;
2635         }
2636
2637         if (bmcr & BMCR_LOOP)
2638                 ifmr->ifm_active |= IFM_LOOP;
2639
2640         if (bmcr & BMCR_AUTOEN) {
2641                 if ((bmsr & BMSR_ACOMP) == 0) {
2642                         ifmr->ifm_active |= IFM_NONE;
2643                         return;
2644                 }
2645
2646                 anlpar &= anar;
2647                 if (anlpar & ANLPAR_TX_FD)
2648                         ifmr->ifm_active |= IFM_100_TX|IFM_FDX;
2649                 else if (anlpar & ANLPAR_T4)
2650                         ifmr->ifm_active |= IFM_100_T4;
2651                 else if (anlpar & ANLPAR_TX)
2652                         ifmr->ifm_active |= IFM_100_TX;
2653                 else if (anlpar & ANLPAR_10_FD)
2654                         ifmr->ifm_active |= IFM_10_T|IFM_FDX;
2655                 else if (anlpar & ANLPAR_10)
2656                         ifmr->ifm_active |= IFM_10_T;
2657                 else
2658                         ifmr->ifm_active |= IFM_NONE;
2659         } else
2660                 ifmr->ifm_active = ifm->ifm_cur->ifm_media;
2661         return;
2662
2663 bail:
2664         TXP_UNLOCK(sc);
2665         ifmr->ifm_active |= IFM_NONE;
2666         ifmr->ifm_status &= ~IFM_AVALID;
2667 }
2668
2669 #ifdef TXP_DEBUG
2670 static void
2671 txp_show_descriptor(void *d)
2672 {
2673         struct txp_cmd_desc *cmd = d;
2674         struct txp_rsp_desc *rsp = d;
2675         struct txp_tx_desc *txd = d;
2676         struct txp_frag_desc *frgd = d;
2677
2678         switch (cmd->cmd_flags & CMD_FLAGS_TYPE_M) {
2679         case CMD_FLAGS_TYPE_CMD:
2680                 /* command descriptor */
2681                 printf("[cmd flags 0x%x num %d id %d seq %d par1 0x%x par2 0x%x par3 0x%x]\n",
2682                     cmd->cmd_flags, cmd->cmd_numdesc, le16toh(cmd->cmd_id),
2683                     le16toh(cmd->cmd_seq), le16toh(cmd->cmd_par1),
2684                     le32toh(cmd->cmd_par2), le32toh(cmd->cmd_par3));
2685                 break;
2686         case CMD_FLAGS_TYPE_RESP:
2687                 /* response descriptor */
2688                 printf("[rsp flags 0x%x num %d id %d seq %d par1 0x%x par2 0x%x par3 0x%x]\n",
2689                     rsp->rsp_flags, rsp->rsp_numdesc, le16toh(rsp->rsp_id),
2690                     le16toh(rsp->rsp_seq), le16toh(rsp->rsp_par1),
2691                     le32toh(rsp->rsp_par2), le32toh(rsp->rsp_par3));
2692                 break;
2693         case CMD_FLAGS_TYPE_DATA:
2694                 /* data header (assuming tx for now) */
2695                 printf("[data flags 0x%x num %d totlen %d addr 0x%x/0x%x pflags 0x%x]",
2696                     txd->tx_flags, txd->tx_numdesc, le16toh(txd->tx_totlen),
2697                     le32toh(txd->tx_addrlo), le32toh(txd->tx_addrhi),
2698                     le32toh(txd->tx_pflags));
2699                 break;
2700         case CMD_FLAGS_TYPE_FRAG:
2701                 /* fragment descriptor */
2702                 printf("[frag flags 0x%x rsvd1 0x%x len %d addr 0x%x/0x%x rsvd2 0x%x]",
2703                     frgd->frag_flags, frgd->frag_rsvd1, le16toh(frgd->frag_len),
2704                     le32toh(frgd->frag_addrlo), le32toh(frgd->frag_addrhi),
2705                     le32toh(frgd->frag_rsvd2));
2706                 break;
2707         default:
2708                 printf("[unknown(%x) flags 0x%x num %d id %d seq %d par1 0x%x par2 0x%x par3 0x%x]\n",
2709                     cmd->cmd_flags & CMD_FLAGS_TYPE_M,
2710                     cmd->cmd_flags, cmd->cmd_numdesc, le16toh(cmd->cmd_id),
2711                     le16toh(cmd->cmd_seq), le16toh(cmd->cmd_par1),
2712                     le32toh(cmd->cmd_par2), le32toh(cmd->cmd_par3));
2713                 break;
2714         }
2715 }
2716 #endif
2717
2718 static void
2719 txp_set_filter(struct txp_softc *sc)
2720 {
2721         struct ifnet *ifp;
2722         uint32_t crc, mchash[2];
2723         uint16_t filter;
2724         struct ifmultiaddr *ifma;
2725         int mcnt;
2726
2727         TXP_LOCK_ASSERT(sc);
2728
2729         ifp = sc->sc_ifp;
2730         filter = TXP_RXFILT_DIRECT;
2731         if ((ifp->if_flags & IFF_BROADCAST) != 0)
2732                 filter |= TXP_RXFILT_BROADCAST;
2733         if ((ifp->if_flags & (IFF_PROMISC | IFF_ALLMULTI)) != 0) {
2734                 if ((ifp->if_flags & IFF_ALLMULTI) != 0)
2735                         filter |= TXP_RXFILT_ALLMULTI;
2736                 if ((ifp->if_flags & IFF_PROMISC) != 0)
2737                         filter = TXP_RXFILT_PROMISC;
2738                 goto setit;
2739         }
2740
2741         mchash[0] = mchash[1] = 0;
2742         mcnt = 0;
2743         if_maddr_rlock(ifp);
2744         TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
2745                 if (ifma->ifma_addr->sa_family != AF_LINK)
2746                         continue;
2747                 crc = ether_crc32_be(LLADDR((struct sockaddr_dl *)
2748                     ifma->ifma_addr), ETHER_ADDR_LEN);
2749                 crc &= 0x3f;
2750                 mchash[crc >> 5] |= 1 << (crc & 0x1f);
2751                 mcnt++;
2752         }
2753         if_maddr_runlock(ifp);
2754
2755         if (mcnt > 0) {
2756                 filter |= TXP_RXFILT_HASHMULTI;
2757                 txp_command(sc, TXP_CMD_MCAST_HASH_MASK_WRITE, 2, mchash[0],
2758                     mchash[1], NULL, NULL, NULL, TXP_CMD_NOWAIT);
2759         }
2760
2761 setit:
2762         txp_command(sc, TXP_CMD_RX_FILTER_WRITE, filter, 0, 0,
2763             NULL, NULL, NULL, TXP_CMD_NOWAIT);
2764 }
2765
2766 static int
2767 txp_set_capabilities(struct txp_softc *sc)
2768 {
2769         struct ifnet *ifp;
2770         uint32_t rxcap, txcap;
2771
2772         TXP_LOCK_ASSERT(sc);
2773
2774         rxcap = txcap = 0;
2775         ifp = sc->sc_ifp;
2776         if ((ifp->if_capenable & IFCAP_TXCSUM) != 0) {
2777                 if ((ifp->if_hwassist & CSUM_IP) != 0)
2778                         txcap |= OFFLOAD_IPCKSUM;
2779                 if ((ifp->if_hwassist & CSUM_TCP) != 0)
2780                         txcap |= OFFLOAD_TCPCKSUM;
2781                 if ((ifp->if_hwassist & CSUM_UDP) != 0)
2782                         txcap |= OFFLOAD_UDPCKSUM;
2783                 rxcap = txcap;
2784         }
2785         if ((ifp->if_capenable & IFCAP_RXCSUM) == 0)
2786                 rxcap &= ~(OFFLOAD_IPCKSUM | OFFLOAD_TCPCKSUM |
2787                     OFFLOAD_UDPCKSUM);
2788         if ((ifp->if_capabilities & IFCAP_VLAN_HWTAGGING) != 0) {
2789                 rxcap |= OFFLOAD_VLAN;
2790                 txcap |= OFFLOAD_VLAN;
2791         }
2792
2793         /* Tell firmware new offload configuration. */
2794         return (txp_command(sc, TXP_CMD_OFFLOAD_WRITE, 0, txcap, rxcap, NULL,
2795             NULL, NULL, TXP_CMD_NOWAIT));
2796 }
2797
2798 static void
2799 txp_stats_save(struct txp_softc *sc)
2800 {
2801         struct txp_rsp_desc *rsp;
2802
2803         TXP_LOCK_ASSERT(sc);
2804
2805         rsp = NULL;
2806         if (txp_ext_command(sc, TXP_CMD_READ_STATISTICS, 0, 0, 0, NULL, 0,
2807             &rsp, TXP_CMD_WAIT))
2808                 goto out;
2809         if (rsp->rsp_numdesc != 6)
2810                 goto out;
2811         txp_stats_update(sc, rsp);
2812 out:
2813         if (rsp != NULL)
2814                 free(rsp, M_DEVBUF);
2815         bcopy(&sc->sc_stats, &sc->sc_ostats, sizeof(struct txp_hw_stats));
2816 }
2817
2818 static void
2819 txp_stats_update(struct txp_softc *sc, struct txp_rsp_desc *rsp)
2820 {
2821         struct txp_hw_stats *ostats, *stats;
2822         struct txp_ext_desc *ext;
2823
2824         TXP_LOCK_ASSERT(sc);
2825
2826         ext = (struct txp_ext_desc *)(rsp + 1);
2827         ostats = &sc->sc_ostats;
2828         stats = &sc->sc_stats;
2829         stats->tx_frames = ostats->tx_frames + le32toh(rsp->rsp_par2);
2830         stats->tx_bytes = ostats->tx_bytes + (uint64_t)le32toh(rsp->rsp_par3) +
2831             ((uint64_t)le32toh(ext[0].ext_1) << 32);
2832         stats->tx_deferred = ostats->tx_deferred + le32toh(ext[0].ext_2);
2833         stats->tx_late_colls = ostats->tx_late_colls + le32toh(ext[0].ext_3);
2834         stats->tx_colls = ostats->tx_colls + le32toh(ext[0].ext_4);
2835         stats->tx_carrier_lost = ostats->tx_carrier_lost +
2836             le32toh(ext[1].ext_1);
2837         stats->tx_multi_colls = ostats->tx_multi_colls +
2838             le32toh(ext[1].ext_2);
2839         stats->tx_excess_colls = ostats->tx_excess_colls +
2840             le32toh(ext[1].ext_3);
2841         stats->tx_fifo_underruns = ostats->tx_fifo_underruns +
2842             le32toh(ext[1].ext_4);
2843         stats->tx_mcast_oflows = ostats->tx_mcast_oflows +
2844             le32toh(ext[2].ext_1);
2845         stats->tx_filtered = ostats->tx_filtered + le32toh(ext[2].ext_2);
2846         stats->rx_frames = ostats->rx_frames + le32toh(ext[2].ext_3);
2847         stats->rx_bytes = ostats->rx_bytes + (uint64_t)le32toh(ext[2].ext_4) +
2848             ((uint64_t)le32toh(ext[3].ext_1) << 32);
2849         stats->rx_fifo_oflows = ostats->rx_fifo_oflows + le32toh(ext[3].ext_2);
2850         stats->rx_badssd = ostats->rx_badssd + le32toh(ext[3].ext_3);
2851         stats->rx_crcerrs = ostats->rx_crcerrs + le32toh(ext[3].ext_4);
2852         stats->rx_lenerrs = ostats->rx_lenerrs + le32toh(ext[4].ext_1);
2853         stats->rx_bcast_frames = ostats->rx_bcast_frames +
2854             le32toh(ext[4].ext_2);
2855         stats->rx_mcast_frames = ostats->rx_mcast_frames +
2856             le32toh(ext[4].ext_3);
2857         stats->rx_oflows = ostats->rx_oflows + le32toh(ext[4].ext_4);
2858         stats->rx_filtered = ostats->rx_filtered + le32toh(ext[5].ext_1);
2859 }
2860
2861 static uint64_t
2862 txp_get_counter(struct ifnet *ifp, ift_counter cnt)
2863 {
2864         struct txp_softc *sc;
2865         struct txp_hw_stats *stats;
2866
2867         sc = if_getsoftc(ifp);
2868         stats = &sc->sc_stats;
2869
2870         switch (cnt) {
2871         case IFCOUNTER_IERRORS:
2872                 return (stats->rx_fifo_oflows + stats->rx_badssd +
2873                     stats->rx_crcerrs + stats->rx_lenerrs + stats->rx_oflows);
2874         case IFCOUNTER_OERRORS:
2875                 return (stats->tx_deferred + stats->tx_carrier_lost +
2876                     stats->tx_fifo_underruns + stats->tx_mcast_oflows);
2877         case IFCOUNTER_COLLISIONS:
2878                 return (stats->tx_late_colls + stats->tx_multi_colls +
2879                     stats->tx_excess_colls);
2880         case IFCOUNTER_OPACKETS:
2881                 return (stats->tx_frames);
2882         case IFCOUNTER_IPACKETS:
2883                 return (stats->rx_frames);
2884         default:
2885                 return (if_get_counter_default(ifp, cnt));
2886         }
2887 }
2888
2889 #define TXP_SYSCTL_STAT_ADD32(c, h, n, p, d)    \
2890             SYSCTL_ADD_UINT(c, h, OID_AUTO, n, CTLFLAG_RD, p, 0, d)
2891
2892 #if __FreeBSD_version >= 900030
2893 #define TXP_SYSCTL_STAT_ADD64(c, h, n, p, d)    \
2894             SYSCTL_ADD_UQUAD(c, h, OID_AUTO, n, CTLFLAG_RD, p, d)
2895 #elif __FreeBSD_version > 800000
2896 #define TXP_SYSCTL_STAT_ADD64(c, h, n, p, d)    \
2897             SYSCTL_ADD_QUAD(c, h, OID_AUTO, n, CTLFLAG_RD, p, d)
2898 #else
2899 #define TXP_SYSCTL_STAT_ADD64(c, h, n, p, d)    \
2900             SYSCTL_ADD_ULONG(c, h, OID_AUTO, n, CTLFLAG_RD, p, d)
2901 #endif
2902
2903 static void
2904 txp_sysctl_node(struct txp_softc *sc)
2905 {
2906         struct sysctl_ctx_list *ctx;
2907         struct sysctl_oid_list *child, *parent;
2908         struct sysctl_oid *tree;
2909         struct txp_hw_stats *stats;
2910         int error;
2911
2912         stats = &sc->sc_stats;
2913         ctx = device_get_sysctl_ctx(sc->sc_dev);
2914         child = SYSCTL_CHILDREN(device_get_sysctl_tree(sc->sc_dev));
2915         SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "process_limit",
2916             CTLTYPE_INT | CTLFLAG_RW, &sc->sc_process_limit, 0,
2917             sysctl_hw_txp_proc_limit, "I",
2918             "max number of Rx events to process");
2919         /* Pull in device tunables. */
2920         sc->sc_process_limit = TXP_PROC_DEFAULT;
2921         error = resource_int_value(device_get_name(sc->sc_dev),
2922             device_get_unit(sc->sc_dev), "process_limit",
2923             &sc->sc_process_limit);
2924         if (error == 0) {
2925                 if (sc->sc_process_limit < TXP_PROC_MIN ||
2926                     sc->sc_process_limit > TXP_PROC_MAX) {
2927                         device_printf(sc->sc_dev,
2928                             "process_limit value out of range; "
2929                             "using default: %d\n", TXP_PROC_DEFAULT);
2930                         sc->sc_process_limit = TXP_PROC_DEFAULT;
2931                 }
2932         }
2933         tree = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats", CTLFLAG_RD,
2934             NULL, "TXP statistics");
2935         parent = SYSCTL_CHILDREN(tree);
2936
2937         /* Tx statistics. */
2938         tree = SYSCTL_ADD_NODE(ctx, parent, OID_AUTO, "tx", CTLFLAG_RD,
2939             NULL, "Tx MAC statistics");
2940         child = SYSCTL_CHILDREN(tree);
2941
2942         TXP_SYSCTL_STAT_ADD32(ctx, child, "frames",
2943             &stats->tx_frames, "Frames");
2944         TXP_SYSCTL_STAT_ADD64(ctx, child, "octets",
2945             &stats->tx_bytes, "Octets");
2946         TXP_SYSCTL_STAT_ADD32(ctx, child, "deferred",
2947             &stats->tx_deferred, "Deferred frames");
2948         TXP_SYSCTL_STAT_ADD32(ctx, child, "late_colls",
2949             &stats->tx_late_colls, "Late collisions");
2950         TXP_SYSCTL_STAT_ADD32(ctx, child, "colls",
2951             &stats->tx_colls, "Collisions");
2952         TXP_SYSCTL_STAT_ADD32(ctx, child, "carrier_lost",
2953             &stats->tx_carrier_lost, "Carrier lost");
2954         TXP_SYSCTL_STAT_ADD32(ctx, child, "multi_colls",
2955             &stats->tx_multi_colls, "Multiple collisions");
2956         TXP_SYSCTL_STAT_ADD32(ctx, child, "excess_colls",
2957             &stats->tx_excess_colls, "Excessive collisions");
2958         TXP_SYSCTL_STAT_ADD32(ctx, child, "fifo_underruns",
2959             &stats->tx_fifo_underruns, "FIFO underruns");
2960         TXP_SYSCTL_STAT_ADD32(ctx, child, "mcast_oflows",
2961             &stats->tx_mcast_oflows, "Multicast overflows");
2962         TXP_SYSCTL_STAT_ADD32(ctx, child, "filtered",
2963             &stats->tx_filtered, "Filtered frames");
2964
2965         /* Rx statistics. */
2966         tree = SYSCTL_ADD_NODE(ctx, parent, OID_AUTO, "rx", CTLFLAG_RD,
2967             NULL, "Rx MAC statistics");
2968         child = SYSCTL_CHILDREN(tree);
2969
2970         TXP_SYSCTL_STAT_ADD32(ctx, child, "frames",
2971             &stats->rx_frames, "Frames");
2972         TXP_SYSCTL_STAT_ADD64(ctx, child, "octets",
2973             &stats->rx_bytes, "Octets");
2974         TXP_SYSCTL_STAT_ADD32(ctx, child, "fifo_oflows",
2975             &stats->rx_fifo_oflows, "FIFO overflows");
2976         TXP_SYSCTL_STAT_ADD32(ctx, child, "badssd",
2977             &stats->rx_badssd, "Bad SSD");
2978         TXP_SYSCTL_STAT_ADD32(ctx, child, "crcerrs",
2979             &stats->rx_crcerrs, "CRC errors");
2980         TXP_SYSCTL_STAT_ADD32(ctx, child, "lenerrs",
2981             &stats->rx_lenerrs, "Length errors");
2982         TXP_SYSCTL_STAT_ADD32(ctx, child, "bcast_frames",
2983             &stats->rx_bcast_frames, "Broadcast frames");
2984         TXP_SYSCTL_STAT_ADD32(ctx, child, "mcast_frames",
2985             &stats->rx_mcast_frames, "Multicast frames");
2986         TXP_SYSCTL_STAT_ADD32(ctx, child, "oflows",
2987             &stats->rx_oflows, "Overflows");
2988         TXP_SYSCTL_STAT_ADD32(ctx, child, "filtered",
2989             &stats->rx_filtered, "Filtered frames");
2990 }
2991
2992 #undef TXP_SYSCTL_STAT_ADD32
2993 #undef TXP_SYSCTL_STAT_ADD64
2994
2995 static int
2996 sysctl_int_range(SYSCTL_HANDLER_ARGS, int low, int high)
2997 {
2998         int error, value;
2999
3000         if (arg1 == NULL)
3001                 return (EINVAL);
3002         value = *(int *)arg1;
3003         error = sysctl_handle_int(oidp, &value, 0, req);
3004         if (error || req->newptr == NULL)
3005                 return (error);
3006         if (value < low || value > high)
3007                 return (EINVAL);
3008         *(int *)arg1 = value;
3009
3010         return (0);
3011 }
3012
3013 static int
3014 sysctl_hw_txp_proc_limit(SYSCTL_HANDLER_ARGS)
3015 {
3016         return (sysctl_int_range(oidp, arg1, arg2, req,
3017             TXP_PROC_MIN, TXP_PROC_MAX));
3018 }