if_et.c revision 1.1.6.3 1 1.1.6.2 rmind /* $NetBSD: if_et.c,v 1.1.6.3 2011/05/31 03:04:40 rmind Exp $ */
2 1.1.6.2 rmind /* $OpenBSD: if_et.c,v 1.11 2008/06/08 06:18:07 jsg Exp $ */
3 1.1.6.2 rmind /*
4 1.1.6.2 rmind * Copyright (c) 2007 The DragonFly Project. All rights reserved.
5 1.1.6.2 rmind *
6 1.1.6.2 rmind * This code is derived from software contributed to The DragonFly Project
7 1.1.6.2 rmind * by Sepherosa Ziehau <sepherosa (at) gmail.com>
8 1.1.6.2 rmind *
9 1.1.6.2 rmind * Redistribution and use in source and binary forms, with or without
10 1.1.6.2 rmind * modification, are permitted provided that the following conditions
11 1.1.6.2 rmind * are met:
12 1.1.6.2 rmind *
13 1.1.6.2 rmind * 1. Redistributions of source code must retain the above copyright
14 1.1.6.2 rmind * notice, this list of conditions and the following disclaimer.
15 1.1.6.2 rmind * 2. Redistributions in binary form must reproduce the above copyright
16 1.1.6.2 rmind * notice, this list of conditions and the following disclaimer in
17 1.1.6.2 rmind * the documentation and/or other materials provided with the
18 1.1.6.2 rmind * distribution.
19 1.1.6.2 rmind * 3. Neither the name of The DragonFly Project nor the names of its
20 1.1.6.2 rmind * contributors may be used to endorse or promote products derived
21 1.1.6.2 rmind * from this software without specific, prior written permission.
22 1.1.6.2 rmind *
23 1.1.6.2 rmind * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
24 1.1.6.2 rmind * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
25 1.1.6.2 rmind * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
26 1.1.6.2 rmind * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
27 1.1.6.2 rmind * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
28 1.1.6.2 rmind * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
29 1.1.6.2 rmind * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
30 1.1.6.2 rmind * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
31 1.1.6.2 rmind * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
32 1.1.6.2 rmind * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
33 1.1.6.2 rmind * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 1.1.6.2 rmind * SUCH DAMAGE.
35 1.1.6.2 rmind *
36 1.1.6.2 rmind * $DragonFly: src/sys/dev/netif/et/if_et.c,v 1.1 2007/10/12 14:12:42 sephe Exp $
37 1.1.6.2 rmind */
38 1.1.6.2 rmind
39 1.1.6.2 rmind #include <sys/cdefs.h>
40 1.1.6.2 rmind __KERNEL_RCSID(0, "$NetBSD: if_et.c,v 1.1.6.3 2011/05/31 03:04:40 rmind Exp $");
41 1.1.6.2 rmind
42 1.1.6.2 rmind #include "opt_inet.h"
43 1.1.6.2 rmind #include "vlan.h"
44 1.1.6.2 rmind
45 1.1.6.2 rmind #include <sys/param.h>
46 1.1.6.2 rmind #include <sys/endian.h>
47 1.1.6.2 rmind #include <sys/systm.h>
48 1.1.6.2 rmind #include <sys/types.h>
49 1.1.6.2 rmind #include <sys/sockio.h>
50 1.1.6.2 rmind #include <sys/mbuf.h>
51 1.1.6.2 rmind #include <sys/queue.h>
52 1.1.6.2 rmind #include <sys/kernel.h>
53 1.1.6.2 rmind #include <sys/device.h>
54 1.1.6.2 rmind #include <sys/callout.h>
55 1.1.6.2 rmind #include <sys/socket.h>
56 1.1.6.2 rmind
57 1.1.6.3 rmind #include <sys/bus.h>
58 1.1.6.2 rmind
59 1.1.6.2 rmind #include <net/if.h>
60 1.1.6.2 rmind #include <net/if_dl.h>
61 1.1.6.2 rmind #include <net/if_media.h>
62 1.1.6.2 rmind #include <net/if_ether.h>
63 1.1.6.2 rmind #include <net/if_arp.h>
64 1.1.6.2 rmind
65 1.1.6.2 rmind #ifdef INET
66 1.1.6.2 rmind #include <netinet/in.h>
67 1.1.6.2 rmind #include <netinet/in_systm.h>
68 1.1.6.2 rmind #include <netinet/in_var.h>
69 1.1.6.2 rmind #include <netinet/ip.h>
70 1.1.6.2 rmind #include <netinet/if_inarp.h>
71 1.1.6.2 rmind #endif
72 1.1.6.2 rmind
73 1.1.6.2 rmind #if NBPFILTER > 0
74 1.1.6.2 rmind #include <net/bpf.h>
75 1.1.6.2 rmind #endif
76 1.1.6.2 rmind
77 1.1.6.2 rmind #include <dev/mii/mii.h>
78 1.1.6.2 rmind #include <dev/mii/miivar.h>
79 1.1.6.2 rmind
80 1.1.6.2 rmind #include <dev/pci/pcireg.h>
81 1.1.6.2 rmind #include <dev/pci/pcivar.h>
82 1.1.6.2 rmind #include <dev/pci/pcidevs.h>
83 1.1.6.2 rmind
84 1.1.6.2 rmind #include <dev/pci/if_etreg.h>
85 1.1.6.2 rmind
86 1.1.6.2 rmind /* XXX temporary porting goop */
87 1.1.6.2 rmind #define KKASSERT(cond) if (!(cond)) panic("KKASSERT: %s in %s", #cond, __func__)
88 1.1.6.2 rmind #undef KASSERT
89 1.1.6.2 rmind #define KASSERT(cond, complaint) if (!(cond)) panic complaint
90 1.1.6.2 rmind
91 1.1.6.2 rmind /* these macros in particular need to die, so gross */
92 1.1.6.2 rmind #define __LOWEST_SET_BIT(__mask) ((((__mask) - 1) & (__mask)) ^ (__mask))
93 1.1.6.2 rmind #define __SHIFTOUT(__x, __mask) (((__x) & (__mask)) / __LOWEST_SET_BIT(__mask))
94 1.1.6.2 rmind #define __SHIFTIN(__x, __mask) ((__x) * __LOWEST_SET_BIT(__mask))
95 1.1.6.2 rmind /* XXX end porting goop */
96 1.1.6.2 rmind
97 1.1.6.2 rmind int et_match(device_t, cfdata_t, void *);
98 1.1.6.2 rmind void et_attach(device_t, device_t, void *);
99 1.1.6.2 rmind int et_detach(device_t, int flags);
100 1.1.6.2 rmind int et_shutdown(device_t);
101 1.1.6.2 rmind
102 1.1.6.2 rmind int et_miibus_readreg(device_t, int, int);
103 1.1.6.2 rmind void et_miibus_writereg(device_t, int, int, int);
104 1.1.6.2 rmind void et_miibus_statchg(device_t);
105 1.1.6.2 rmind
106 1.1.6.2 rmind int et_init(struct ifnet *ifp);
107 1.1.6.2 rmind int et_ioctl(struct ifnet *, u_long, void *);
108 1.1.6.2 rmind void et_start(struct ifnet *);
109 1.1.6.2 rmind void et_watchdog(struct ifnet *);
110 1.1.6.2 rmind
111 1.1.6.2 rmind int et_intr(void *);
112 1.1.6.2 rmind void et_enable_intrs(struct et_softc *, uint32_t);
113 1.1.6.2 rmind void et_disable_intrs(struct et_softc *);
114 1.1.6.2 rmind void et_rxeof(struct et_softc *);
115 1.1.6.2 rmind void et_txeof(struct et_softc *);
116 1.1.6.2 rmind void et_txtick(void *);
117 1.1.6.2 rmind
118 1.1.6.2 rmind int et_dma_alloc(struct et_softc *);
119 1.1.6.2 rmind void et_dma_free(struct et_softc *);
120 1.1.6.2 rmind int et_dma_mem_create(struct et_softc *, bus_size_t,
121 1.1.6.2 rmind void **, bus_addr_t *, bus_dmamap_t *, bus_dma_segment_t *);
122 1.1.6.2 rmind void et_dma_mem_destroy(struct et_softc *, void *, bus_dmamap_t);
123 1.1.6.2 rmind int et_dma_mbuf_create(struct et_softc *);
124 1.1.6.2 rmind void et_dma_mbuf_destroy(struct et_softc *, int, const int[]);
125 1.1.6.2 rmind void et_dma_ring_addr(void *, bus_dma_segment_t *, int, int);
126 1.1.6.2 rmind
127 1.1.6.2 rmind int et_init_tx_ring(struct et_softc *);
128 1.1.6.2 rmind int et_init_rx_ring(struct et_softc *);
129 1.1.6.2 rmind void et_free_tx_ring(struct et_softc *);
130 1.1.6.2 rmind void et_free_rx_ring(struct et_softc *);
131 1.1.6.2 rmind int et_encap(struct et_softc *, struct mbuf **);
132 1.1.6.2 rmind int et_newbuf(struct et_rxbuf_data *, int, int, int);
133 1.1.6.2 rmind int et_newbuf_cluster(struct et_rxbuf_data *, int, int);
134 1.1.6.2 rmind int et_newbuf_hdr(struct et_rxbuf_data *, int, int);
135 1.1.6.2 rmind
136 1.1.6.2 rmind void et_stop(struct et_softc *);
137 1.1.6.2 rmind int et_chip_init(struct et_softc *);
138 1.1.6.2 rmind void et_chip_attach(struct et_softc *);
139 1.1.6.2 rmind void et_init_mac(struct et_softc *);
140 1.1.6.2 rmind void et_init_rxmac(struct et_softc *);
141 1.1.6.2 rmind void et_init_txmac(struct et_softc *);
142 1.1.6.2 rmind int et_init_rxdma(struct et_softc *);
143 1.1.6.2 rmind int et_init_txdma(struct et_softc *);
144 1.1.6.2 rmind int et_start_rxdma(struct et_softc *);
145 1.1.6.2 rmind int et_start_txdma(struct et_softc *);
146 1.1.6.2 rmind int et_stop_rxdma(struct et_softc *);
147 1.1.6.2 rmind int et_stop_txdma(struct et_softc *);
148 1.1.6.2 rmind int et_enable_txrx(struct et_softc *);
149 1.1.6.2 rmind void et_reset(struct et_softc *);
150 1.1.6.2 rmind int et_bus_config(struct et_softc *);
151 1.1.6.2 rmind void et_get_eaddr(struct et_softc *, uint8_t[]);
152 1.1.6.2 rmind void et_setmulti(struct et_softc *);
153 1.1.6.2 rmind void et_tick(void *);
154 1.1.6.2 rmind
155 1.1.6.2 rmind static int et_rx_intr_npkts = 32;
156 1.1.6.2 rmind static int et_rx_intr_delay = 20; /* x10 usec */
157 1.1.6.2 rmind static int et_tx_intr_nsegs = 128;
158 1.1.6.2 rmind static uint32_t et_timer = 1000 * 1000 * 1000; /* nanosec */
159 1.1.6.2 rmind
160 1.1.6.2 rmind struct et_bsize {
161 1.1.6.2 rmind int bufsize;
162 1.1.6.2 rmind et_newbuf_t newbuf;
163 1.1.6.2 rmind };
164 1.1.6.2 rmind
165 1.1.6.2 rmind static const struct et_bsize et_bufsize[ET_RX_NRING] = {
166 1.1.6.2 rmind { .bufsize = 0, .newbuf = et_newbuf_hdr },
167 1.1.6.2 rmind { .bufsize = 0, .newbuf = et_newbuf_cluster },
168 1.1.6.2 rmind };
169 1.1.6.2 rmind
170 1.1.6.2 rmind const struct et_product {
171 1.1.6.2 rmind pci_vendor_id_t vendor;
172 1.1.6.2 rmind pci_product_id_t product;
173 1.1.6.2 rmind } et_devices[] = {
174 1.1.6.2 rmind { PCI_VENDOR_LUCENT, PCI_PRODUCT_LUCENT_ET1310 },
175 1.1.6.2 rmind { PCI_VENDOR_LUCENT, PCI_PRODUCT_LUCENT_ET1301 }
176 1.1.6.2 rmind };
177 1.1.6.2 rmind
178 1.1.6.2 rmind CFATTACH_DECL_NEW(et, sizeof(struct et_softc), et_match, et_attach, et_detach,
179 1.1.6.2 rmind NULL);
180 1.1.6.2 rmind
181 1.1.6.2 rmind int
182 1.1.6.2 rmind et_match(device_t dev, cfdata_t match, void *aux)
183 1.1.6.2 rmind {
184 1.1.6.2 rmind struct pci_attach_args *pa = aux;
185 1.1.6.2 rmind const struct et_product *ep;
186 1.1.6.2 rmind int i;
187 1.1.6.2 rmind
188 1.1.6.2 rmind for (i = 0; i < sizeof(et_devices) / sizeof(et_devices[0]); i++) {
189 1.1.6.2 rmind ep = &et_devices[i];
190 1.1.6.2 rmind if (PCI_VENDOR(pa->pa_id) == ep->vendor &&
191 1.1.6.2 rmind PCI_PRODUCT(pa->pa_id) == ep->product)
192 1.1.6.2 rmind return 1;
193 1.1.6.2 rmind }
194 1.1.6.2 rmind return 0;
195 1.1.6.2 rmind }
196 1.1.6.2 rmind
197 1.1.6.2 rmind void
198 1.1.6.2 rmind et_attach(device_t parent, device_t self, void *aux)
199 1.1.6.2 rmind {
200 1.1.6.2 rmind struct et_softc *sc = device_private(self);
201 1.1.6.2 rmind struct pci_attach_args *pa = aux;
202 1.1.6.2 rmind pci_chipset_tag_t pc = pa->pa_pc;
203 1.1.6.2 rmind pci_intr_handle_t ih;
204 1.1.6.2 rmind const char *intrstr;
205 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
206 1.1.6.2 rmind pcireg_t memtype;
207 1.1.6.2 rmind int error;
208 1.1.6.2 rmind char devinfo[256];
209 1.1.6.2 rmind
210 1.1.6.2 rmind aprint_naive(": Ethernet controller\n");
211 1.1.6.2 rmind
212 1.1.6.2 rmind sc->sc_dev = self;
213 1.1.6.2 rmind pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
214 1.1.6.2 rmind aprint_normal(": %s (rev. 0x%02x)\n", devinfo, PCI_REVISION(pa->pa_class));
215 1.1.6.2 rmind
216 1.1.6.2 rmind /*
217 1.1.6.2 rmind * Initialize tunables
218 1.1.6.2 rmind */
219 1.1.6.2 rmind sc->sc_rx_intr_npkts = et_rx_intr_npkts;
220 1.1.6.2 rmind sc->sc_rx_intr_delay = et_rx_intr_delay;
221 1.1.6.2 rmind sc->sc_tx_intr_nsegs = et_tx_intr_nsegs;
222 1.1.6.2 rmind sc->sc_timer = et_timer;
223 1.1.6.2 rmind
224 1.1.6.2 rmind memtype = pci_mapreg_type(pa->pa_pc, pa->pa_tag, ET_PCIR_BAR);
225 1.1.6.2 rmind if (pci_mapreg_map(pa, ET_PCIR_BAR, memtype, 0, &sc->sc_mem_bt,
226 1.1.6.2 rmind &sc->sc_mem_bh, NULL, &sc->sc_mem_size)) {
227 1.1.6.2 rmind aprint_error_dev(self, "could not map mem space\n");
228 1.1.6.2 rmind return;
229 1.1.6.2 rmind }
230 1.1.6.2 rmind
231 1.1.6.2 rmind if (pci_intr_map(pa, &ih) != 0) {
232 1.1.6.2 rmind aprint_error_dev(self, "could not map interrupt\n");
233 1.1.6.2 rmind goto fail;
234 1.1.6.2 rmind }
235 1.1.6.2 rmind
236 1.1.6.2 rmind intrstr = pci_intr_string(pc, ih);
237 1.1.6.2 rmind sc->sc_irq_handle = pci_intr_establish(pc, ih, IPL_NET, et_intr, sc);
238 1.1.6.2 rmind if (sc->sc_irq_handle == NULL) {
239 1.1.6.2 rmind aprint_error_dev(self, "could not establish interrupt");
240 1.1.6.2 rmind if (intrstr != NULL)
241 1.1.6.2 rmind aprint_error(" at %s", intrstr);
242 1.1.6.2 rmind aprint_error("\n");
243 1.1.6.2 rmind goto fail;
244 1.1.6.2 rmind }
245 1.1.6.2 rmind aprint_normal_dev(self, "interrupting at %s\n", intrstr);
246 1.1.6.2 rmind
247 1.1.6.2 rmind sc->sc_dmat = pa->pa_dmat;
248 1.1.6.2 rmind sc->sc_pct = pa->pa_pc;
249 1.1.6.2 rmind sc->sc_pcitag = pa->pa_tag;
250 1.1.6.2 rmind
251 1.1.6.2 rmind error = et_bus_config(sc);
252 1.1.6.2 rmind if (error)
253 1.1.6.2 rmind goto fail;
254 1.1.6.2 rmind
255 1.1.6.2 rmind et_get_eaddr(sc, sc->sc_enaddr);
256 1.1.6.2 rmind
257 1.1.6.2 rmind aprint_normal_dev(self, "Ethernet address %s\n",
258 1.1.6.2 rmind ether_sprintf(sc->sc_enaddr));
259 1.1.6.2 rmind
260 1.1.6.2 rmind CSR_WRITE_4(sc, ET_PM,
261 1.1.6.2 rmind ET_PM_SYSCLK_GATE | ET_PM_TXCLK_GATE | ET_PM_RXCLK_GATE);
262 1.1.6.2 rmind
263 1.1.6.2 rmind et_reset(sc);
264 1.1.6.2 rmind
265 1.1.6.2 rmind et_disable_intrs(sc);
266 1.1.6.2 rmind
267 1.1.6.2 rmind error = et_dma_alloc(sc);
268 1.1.6.2 rmind if (error)
269 1.1.6.2 rmind goto fail;
270 1.1.6.2 rmind
271 1.1.6.2 rmind ifp->if_softc = sc;
272 1.1.6.2 rmind ifp->if_mtu = ETHERMTU;
273 1.1.6.2 rmind ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
274 1.1.6.2 rmind ifp->if_init = et_init;
275 1.1.6.2 rmind ifp->if_ioctl = et_ioctl;
276 1.1.6.2 rmind ifp->if_start = et_start;
277 1.1.6.2 rmind ifp->if_watchdog = et_watchdog;
278 1.1.6.2 rmind IFQ_SET_MAXLEN(&ifp->if_snd, ET_TX_NDESC);
279 1.1.6.2 rmind IFQ_SET_READY(&ifp->if_snd);
280 1.1.6.2 rmind strlcpy(ifp->if_xname, device_xname(self), IFNAMSIZ);
281 1.1.6.2 rmind
282 1.1.6.2 rmind et_chip_attach(sc);
283 1.1.6.2 rmind
284 1.1.6.2 rmind sc->sc_miibus.mii_ifp = ifp;
285 1.1.6.2 rmind sc->sc_miibus.mii_readreg = et_miibus_readreg;
286 1.1.6.2 rmind sc->sc_miibus.mii_writereg = et_miibus_writereg;
287 1.1.6.2 rmind sc->sc_miibus.mii_statchg = et_miibus_statchg;
288 1.1.6.2 rmind
289 1.1.6.2 rmind sc->sc_ethercom.ec_mii = &sc->sc_miibus;
290 1.1.6.2 rmind ifmedia_init(&sc->sc_miibus.mii_media, 0, ether_mediachange,
291 1.1.6.2 rmind ether_mediastatus);
292 1.1.6.2 rmind mii_attach(self, &sc->sc_miibus, 0xffffffff, MII_PHY_ANY,
293 1.1.6.2 rmind MII_OFFSET_ANY, 0);
294 1.1.6.2 rmind if (LIST_FIRST(&sc->sc_miibus.mii_phys) == NULL) {
295 1.1.6.2 rmind aprint_error_dev(self, "no PHY found!\n");
296 1.1.6.2 rmind ifmedia_add(&sc->sc_miibus.mii_media, IFM_ETHER | IFM_MANUAL,
297 1.1.6.2 rmind 0, NULL);
298 1.1.6.2 rmind ifmedia_set(&sc->sc_miibus.mii_media, IFM_ETHER | IFM_MANUAL);
299 1.1.6.2 rmind } else
300 1.1.6.2 rmind ifmedia_set(&sc->sc_miibus.mii_media, IFM_ETHER | IFM_AUTO);
301 1.1.6.2 rmind
302 1.1.6.2 rmind if_attach(ifp);
303 1.1.6.2 rmind ether_ifattach(ifp, sc->sc_enaddr);
304 1.1.6.2 rmind
305 1.1.6.2 rmind callout_init(&sc->sc_tick, 0);
306 1.1.6.2 rmind callout_setfunc(&sc->sc_tick, et_tick, sc);
307 1.1.6.2 rmind callout_init(&sc->sc_txtick, 0);
308 1.1.6.2 rmind callout_setfunc(&sc->sc_txtick, et_txtick, sc);
309 1.1.6.2 rmind
310 1.1.6.2 rmind if (pmf_device_register(self, NULL, NULL))
311 1.1.6.2 rmind pmf_class_network_register(self, ifp);
312 1.1.6.2 rmind else
313 1.1.6.2 rmind aprint_error_dev(self, "couldn't establish power handler\n");
314 1.1.6.2 rmind
315 1.1.6.2 rmind return;
316 1.1.6.2 rmind
317 1.1.6.2 rmind fail:
318 1.1.6.2 rmind et_dma_free(sc);
319 1.1.6.2 rmind if (sc->sc_irq_handle != NULL) {
320 1.1.6.2 rmind pci_intr_disestablish(sc->sc_pct, sc->sc_irq_handle);
321 1.1.6.2 rmind sc->sc_irq_handle = NULL;
322 1.1.6.2 rmind }
323 1.1.6.2 rmind if (sc->sc_mem_size) {
324 1.1.6.2 rmind bus_space_unmap(sc->sc_mem_bt, sc->sc_mem_bh, sc->sc_mem_size);
325 1.1.6.2 rmind sc->sc_mem_size = 0;
326 1.1.6.2 rmind }
327 1.1.6.2 rmind }
328 1.1.6.2 rmind
329 1.1.6.2 rmind int
330 1.1.6.2 rmind et_detach(device_t self, int flags)
331 1.1.6.2 rmind {
332 1.1.6.2 rmind struct et_softc *sc = device_private(self);
333 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
334 1.1.6.2 rmind int s;
335 1.1.6.2 rmind
336 1.1.6.2 rmind pmf_device_deregister(self);
337 1.1.6.2 rmind s = splnet();
338 1.1.6.2 rmind et_stop(sc);
339 1.1.6.2 rmind splx(s);
340 1.1.6.2 rmind
341 1.1.6.2 rmind mii_detach(&sc->sc_miibus, MII_PHY_ANY, MII_OFFSET_ANY);
342 1.1.6.2 rmind
343 1.1.6.2 rmind /* Delete all remaining media. */
344 1.1.6.2 rmind ifmedia_delete_instance(&sc->sc_miibus.mii_media, IFM_INST_ANY);
345 1.1.6.2 rmind
346 1.1.6.2 rmind ether_ifdetach(ifp);
347 1.1.6.2 rmind if_detach(ifp);
348 1.1.6.2 rmind et_dma_free(sc);
349 1.1.6.2 rmind
350 1.1.6.2 rmind if (sc->sc_irq_handle != NULL) {
351 1.1.6.2 rmind pci_intr_disestablish(sc->sc_pct, sc->sc_irq_handle);
352 1.1.6.2 rmind sc->sc_irq_handle = NULL;
353 1.1.6.2 rmind }
354 1.1.6.2 rmind
355 1.1.6.2 rmind if (sc->sc_mem_size) {
356 1.1.6.2 rmind bus_space_unmap(sc->sc_mem_bt, sc->sc_mem_bh, sc->sc_mem_size);
357 1.1.6.2 rmind sc->sc_mem_size = 0;
358 1.1.6.2 rmind }
359 1.1.6.2 rmind
360 1.1.6.2 rmind return 0;
361 1.1.6.2 rmind }
362 1.1.6.2 rmind
363 1.1.6.2 rmind int
364 1.1.6.2 rmind et_shutdown(device_t self)
365 1.1.6.2 rmind {
366 1.1.6.2 rmind struct et_softc *sc = device_private(self);
367 1.1.6.2 rmind int s;
368 1.1.6.2 rmind
369 1.1.6.2 rmind s = splnet();
370 1.1.6.2 rmind et_stop(sc);
371 1.1.6.2 rmind splx(s);
372 1.1.6.2 rmind
373 1.1.6.2 rmind return 0;
374 1.1.6.2 rmind }
375 1.1.6.2 rmind
376 1.1.6.2 rmind int
377 1.1.6.2 rmind et_miibus_readreg(device_t dev, int phy, int reg)
378 1.1.6.2 rmind {
379 1.1.6.2 rmind struct et_softc *sc = device_private(dev);
380 1.1.6.2 rmind uint32_t val;
381 1.1.6.2 rmind int i, ret;
382 1.1.6.2 rmind
383 1.1.6.2 rmind /* Stop any pending operations */
384 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CMD, 0);
385 1.1.6.2 rmind
386 1.1.6.2 rmind val = __SHIFTIN(phy, ET_MII_ADDR_PHY) |
387 1.1.6.2 rmind __SHIFTIN(reg, ET_MII_ADDR_REG);
388 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_ADDR, val);
389 1.1.6.2 rmind
390 1.1.6.2 rmind /* Start reading */
391 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CMD, ET_MII_CMD_READ);
392 1.1.6.2 rmind
393 1.1.6.2 rmind #define NRETRY 50
394 1.1.6.2 rmind
395 1.1.6.2 rmind for (i = 0; i < NRETRY; ++i) {
396 1.1.6.2 rmind val = CSR_READ_4(sc, ET_MII_IND);
397 1.1.6.2 rmind if ((val & (ET_MII_IND_BUSY | ET_MII_IND_INVALID)) == 0)
398 1.1.6.2 rmind break;
399 1.1.6.2 rmind DELAY(50);
400 1.1.6.2 rmind }
401 1.1.6.2 rmind if (i == NRETRY) {
402 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "read phy %d, reg %d timed out\n",
403 1.1.6.2 rmind phy, reg);
404 1.1.6.2 rmind ret = 0;
405 1.1.6.2 rmind goto back;
406 1.1.6.2 rmind }
407 1.1.6.2 rmind
408 1.1.6.2 rmind #undef NRETRY
409 1.1.6.2 rmind
410 1.1.6.2 rmind val = CSR_READ_4(sc, ET_MII_STAT);
411 1.1.6.2 rmind ret = __SHIFTOUT(val, ET_MII_STAT_VALUE);
412 1.1.6.2 rmind
413 1.1.6.2 rmind back:
414 1.1.6.2 rmind /* Make sure that the current operation is stopped */
415 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CMD, 0);
416 1.1.6.2 rmind return ret;
417 1.1.6.2 rmind }
418 1.1.6.2 rmind
419 1.1.6.2 rmind void
420 1.1.6.2 rmind et_miibus_writereg(device_t dev, int phy, int reg, int val0)
421 1.1.6.2 rmind {
422 1.1.6.2 rmind struct et_softc *sc = device_private(dev);
423 1.1.6.2 rmind uint32_t val;
424 1.1.6.2 rmind int i;
425 1.1.6.2 rmind
426 1.1.6.2 rmind /* Stop any pending operations */
427 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CMD, 0);
428 1.1.6.2 rmind
429 1.1.6.2 rmind val = __SHIFTIN(phy, ET_MII_ADDR_PHY) |
430 1.1.6.2 rmind __SHIFTIN(reg, ET_MII_ADDR_REG);
431 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_ADDR, val);
432 1.1.6.2 rmind
433 1.1.6.2 rmind /* Start writing */
434 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CTRL, __SHIFTIN(val0, ET_MII_CTRL_VALUE));
435 1.1.6.2 rmind
436 1.1.6.2 rmind #define NRETRY 100
437 1.1.6.2 rmind
438 1.1.6.2 rmind for (i = 0; i < NRETRY; ++i) {
439 1.1.6.2 rmind val = CSR_READ_4(sc, ET_MII_IND);
440 1.1.6.2 rmind if ((val & ET_MII_IND_BUSY) == 0)
441 1.1.6.2 rmind break;
442 1.1.6.2 rmind DELAY(50);
443 1.1.6.2 rmind }
444 1.1.6.2 rmind if (i == NRETRY) {
445 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "write phy %d, reg %d timed out\n",
446 1.1.6.2 rmind phy, reg);
447 1.1.6.2 rmind et_miibus_readreg(dev, phy, reg);
448 1.1.6.2 rmind }
449 1.1.6.2 rmind
450 1.1.6.2 rmind #undef NRETRY
451 1.1.6.2 rmind
452 1.1.6.2 rmind /* Make sure that the current operation is stopped */
453 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CMD, 0);
454 1.1.6.2 rmind }
455 1.1.6.2 rmind
456 1.1.6.2 rmind void
457 1.1.6.2 rmind et_miibus_statchg(device_t dev)
458 1.1.6.2 rmind {
459 1.1.6.2 rmind struct et_softc *sc = device_private(dev);
460 1.1.6.2 rmind struct mii_data *mii = &sc->sc_miibus;
461 1.1.6.2 rmind uint32_t cfg2, ctrl;
462 1.1.6.2 rmind
463 1.1.6.2 rmind cfg2 = CSR_READ_4(sc, ET_MAC_CFG2);
464 1.1.6.2 rmind cfg2 &= ~(ET_MAC_CFG2_MODE_MII | ET_MAC_CFG2_MODE_GMII |
465 1.1.6.2 rmind ET_MAC_CFG2_FDX | ET_MAC_CFG2_BIGFRM);
466 1.1.6.2 rmind cfg2 |= ET_MAC_CFG2_LENCHK | ET_MAC_CFG2_CRC | ET_MAC_CFG2_PADCRC |
467 1.1.6.2 rmind __SHIFTIN(7, ET_MAC_CFG2_PREAMBLE_LEN);
468 1.1.6.2 rmind
469 1.1.6.2 rmind ctrl = CSR_READ_4(sc, ET_MAC_CTRL);
470 1.1.6.2 rmind ctrl &= ~(ET_MAC_CTRL_GHDX | ET_MAC_CTRL_MODE_MII);
471 1.1.6.2 rmind
472 1.1.6.2 rmind if (IFM_SUBTYPE(mii->mii_media_active) == IFM_1000_T) {
473 1.1.6.2 rmind cfg2 |= ET_MAC_CFG2_MODE_GMII;
474 1.1.6.2 rmind } else {
475 1.1.6.2 rmind cfg2 |= ET_MAC_CFG2_MODE_MII;
476 1.1.6.2 rmind ctrl |= ET_MAC_CTRL_MODE_MII;
477 1.1.6.2 rmind }
478 1.1.6.2 rmind
479 1.1.6.2 rmind if ((mii->mii_media_active & IFM_GMASK) == IFM_FDX)
480 1.1.6.2 rmind cfg2 |= ET_MAC_CFG2_FDX;
481 1.1.6.2 rmind else
482 1.1.6.2 rmind ctrl |= ET_MAC_CTRL_GHDX;
483 1.1.6.2 rmind
484 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CTRL, ctrl);
485 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG2, cfg2);
486 1.1.6.2 rmind }
487 1.1.6.2 rmind
488 1.1.6.2 rmind void
489 1.1.6.2 rmind et_stop(struct et_softc *sc)
490 1.1.6.2 rmind {
491 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
492 1.1.6.2 rmind
493 1.1.6.2 rmind callout_stop(&sc->sc_tick);
494 1.1.6.2 rmind callout_stop(&sc->sc_txtick);
495 1.1.6.2 rmind
496 1.1.6.2 rmind et_stop_rxdma(sc);
497 1.1.6.2 rmind et_stop_txdma(sc);
498 1.1.6.2 rmind
499 1.1.6.2 rmind et_disable_intrs(sc);
500 1.1.6.2 rmind
501 1.1.6.2 rmind et_free_tx_ring(sc);
502 1.1.6.2 rmind et_free_rx_ring(sc);
503 1.1.6.2 rmind
504 1.1.6.2 rmind et_reset(sc);
505 1.1.6.2 rmind
506 1.1.6.2 rmind sc->sc_tx = 0;
507 1.1.6.2 rmind sc->sc_tx_intr = 0;
508 1.1.6.2 rmind
509 1.1.6.2 rmind ifp->if_timer = 0;
510 1.1.6.2 rmind ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
511 1.1.6.2 rmind }
512 1.1.6.2 rmind
513 1.1.6.2 rmind int
514 1.1.6.2 rmind et_bus_config(struct et_softc *sc)
515 1.1.6.2 rmind {
516 1.1.6.2 rmind uint32_t val; //, max_plsz;
517 1.1.6.2 rmind // uint16_t ack_latency, replay_timer;
518 1.1.6.2 rmind
519 1.1.6.2 rmind /*
520 1.1.6.2 rmind * Test whether EEPROM is valid
521 1.1.6.2 rmind * NOTE: Read twice to get the correct value
522 1.1.6.2 rmind */
523 1.1.6.2 rmind pci_conf_read(sc->sc_pct, sc->sc_pcitag, ET_PCIR_EEPROM_MISC);
524 1.1.6.2 rmind val = pci_conf_read(sc->sc_pct, sc->sc_pcitag, ET_PCIR_EEPROM_MISC);
525 1.1.6.2 rmind
526 1.1.6.2 rmind if (val & ET_PCIM_EEPROM_STATUS_ERROR) {
527 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "EEPROM status error 0x%02x\n", val);
528 1.1.6.2 rmind return ENXIO;
529 1.1.6.2 rmind }
530 1.1.6.2 rmind
531 1.1.6.2 rmind /* TODO: LED */
532 1.1.6.2 rmind #if 0
533 1.1.6.2 rmind /*
534 1.1.6.2 rmind * Configure ACK latency and replay timer according to
535 1.1.6.2 rmind * max playload size
536 1.1.6.2 rmind */
537 1.1.6.2 rmind val = pci_conf_read(sc->sc_pct, sc->sc_pcitag, ET_PCIR_DEVICE_CAPS);
538 1.1.6.2 rmind max_plsz = val & ET_PCIM_DEVICE_CAPS_MAX_PLSZ;
539 1.1.6.2 rmind
540 1.1.6.2 rmind switch (max_plsz) {
541 1.1.6.2 rmind case ET_PCIV_DEVICE_CAPS_PLSZ_128:
542 1.1.6.2 rmind ack_latency = ET_PCIV_ACK_LATENCY_128;
543 1.1.6.2 rmind replay_timer = ET_PCIV_REPLAY_TIMER_128;
544 1.1.6.2 rmind break;
545 1.1.6.2 rmind
546 1.1.6.2 rmind case ET_PCIV_DEVICE_CAPS_PLSZ_256:
547 1.1.6.2 rmind ack_latency = ET_PCIV_ACK_LATENCY_256;
548 1.1.6.2 rmind replay_timer = ET_PCIV_REPLAY_TIMER_256;
549 1.1.6.2 rmind break;
550 1.1.6.2 rmind
551 1.1.6.2 rmind default:
552 1.1.6.2 rmind ack_latency = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
553 1.1.6.2 rmind ET_PCIR_ACK_LATENCY) >> 16;
554 1.1.6.2 rmind replay_timer = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
555 1.1.6.2 rmind ET_PCIR_REPLAY_TIMER) >> 16;
556 1.1.6.2 rmind aprint_normal_dev(sc->sc_dev, "ack latency %u, replay timer %u\n",
557 1.1.6.2 rmind ack_latency, replay_timer);
558 1.1.6.2 rmind break;
559 1.1.6.2 rmind }
560 1.1.6.2 rmind if (ack_latency != 0) {
561 1.1.6.2 rmind pci_conf_write(sc->sc_pct, sc->sc_pcitag,
562 1.1.6.2 rmind ET_PCIR_ACK_LATENCY, ack_latency << 16);
563 1.1.6.2 rmind pci_conf_write(sc->sc_pct, sc->sc_pcitag,
564 1.1.6.2 rmind ET_PCIR_REPLAY_TIMER, replay_timer << 16);
565 1.1.6.2 rmind }
566 1.1.6.2 rmind
567 1.1.6.2 rmind /*
568 1.1.6.2 rmind * Set L0s and L1 latency timer to 2us
569 1.1.6.2 rmind */
570 1.1.6.2 rmind val = ET_PCIV_L0S_LATENCY(2) | ET_PCIV_L1_LATENCY(2);
571 1.1.6.2 rmind pci_conf_write(sc->sc_pct, sc->sc_pcitag, ET_PCIR_L0S_L1_LATENCY,
572 1.1.6.2 rmind val << 24);
573 1.1.6.2 rmind
574 1.1.6.2 rmind /*
575 1.1.6.2 rmind * Set max read request size to 2048 bytes
576 1.1.6.2 rmind */
577 1.1.6.2 rmind val = pci_conf_read(sc->sc_pct, sc->sc_pcitag,
578 1.1.6.2 rmind ET_PCIR_DEVICE_CTRL) >> 16;
579 1.1.6.2 rmind val &= ~ET_PCIM_DEVICE_CTRL_MAX_RRSZ;
580 1.1.6.2 rmind val |= ET_PCIV_DEVICE_CTRL_RRSZ_2K;
581 1.1.6.2 rmind pci_conf_write(sc->sc_pct, sc->sc_pcitag, ET_PCIR_DEVICE_CTRL,
582 1.1.6.2 rmind val << 16);
583 1.1.6.2 rmind #endif
584 1.1.6.2 rmind
585 1.1.6.2 rmind return 0;
586 1.1.6.2 rmind }
587 1.1.6.2 rmind
588 1.1.6.2 rmind void
589 1.1.6.2 rmind et_get_eaddr(struct et_softc *sc, uint8_t eaddr[])
590 1.1.6.2 rmind {
591 1.1.6.2 rmind uint32_t r;
592 1.1.6.2 rmind
593 1.1.6.2 rmind r = pci_conf_read(sc->sc_pct, sc->sc_pcitag, ET_PCIR_MACADDR_LO);
594 1.1.6.2 rmind eaddr[0] = r & 0xff;
595 1.1.6.2 rmind eaddr[1] = (r >> 8) & 0xff;
596 1.1.6.2 rmind eaddr[2] = (r >> 16) & 0xff;
597 1.1.6.2 rmind eaddr[3] = (r >> 24) & 0xff;
598 1.1.6.2 rmind r = pci_conf_read(sc->sc_pct, sc->sc_pcitag, ET_PCIR_MACADDR_HI);
599 1.1.6.2 rmind eaddr[4] = r & 0xff;
600 1.1.6.2 rmind eaddr[5] = (r >> 8) & 0xff;
601 1.1.6.2 rmind }
602 1.1.6.2 rmind
603 1.1.6.2 rmind void
604 1.1.6.2 rmind et_reset(struct et_softc *sc)
605 1.1.6.2 rmind {
606 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1,
607 1.1.6.2 rmind ET_MAC_CFG1_RST_TXFUNC | ET_MAC_CFG1_RST_RXFUNC |
608 1.1.6.2 rmind ET_MAC_CFG1_RST_TXMC | ET_MAC_CFG1_RST_RXMC |
609 1.1.6.2 rmind ET_MAC_CFG1_SIM_RST | ET_MAC_CFG1_SOFT_RST);
610 1.1.6.2 rmind
611 1.1.6.2 rmind CSR_WRITE_4(sc, ET_SWRST,
612 1.1.6.2 rmind ET_SWRST_TXDMA | ET_SWRST_RXDMA |
613 1.1.6.2 rmind ET_SWRST_TXMAC | ET_SWRST_RXMAC |
614 1.1.6.2 rmind ET_SWRST_MAC | ET_SWRST_MAC_STAT | ET_SWRST_MMC);
615 1.1.6.2 rmind
616 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1,
617 1.1.6.2 rmind ET_MAC_CFG1_RST_TXFUNC | ET_MAC_CFG1_RST_RXFUNC |
618 1.1.6.2 rmind ET_MAC_CFG1_RST_TXMC | ET_MAC_CFG1_RST_RXMC);
619 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1, 0);
620 1.1.6.2 rmind }
621 1.1.6.2 rmind
622 1.1.6.2 rmind void
623 1.1.6.2 rmind et_disable_intrs(struct et_softc *sc)
624 1.1.6.2 rmind {
625 1.1.6.2 rmind CSR_WRITE_4(sc, ET_INTR_MASK, 0xffffffff);
626 1.1.6.2 rmind }
627 1.1.6.2 rmind
628 1.1.6.2 rmind void
629 1.1.6.2 rmind et_enable_intrs(struct et_softc *sc, uint32_t intrs)
630 1.1.6.2 rmind {
631 1.1.6.2 rmind CSR_WRITE_4(sc, ET_INTR_MASK, ~intrs);
632 1.1.6.2 rmind }
633 1.1.6.2 rmind
634 1.1.6.2 rmind int
635 1.1.6.2 rmind et_dma_alloc(struct et_softc *sc)
636 1.1.6.2 rmind {
637 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
638 1.1.6.2 rmind struct et_txstatus_data *txsd = &sc->sc_tx_status;
639 1.1.6.2 rmind struct et_rxstat_ring *rxst_ring = &sc->sc_rxstat_ring;
640 1.1.6.2 rmind struct et_rxstatus_data *rxsd = &sc->sc_rx_status;
641 1.1.6.2 rmind int i, error;
642 1.1.6.2 rmind
643 1.1.6.2 rmind /*
644 1.1.6.2 rmind * Create TX ring DMA stuffs
645 1.1.6.2 rmind */
646 1.1.6.2 rmind error = et_dma_mem_create(sc, ET_TX_RING_SIZE,
647 1.1.6.2 rmind (void **)&tx_ring->tr_desc, &tx_ring->tr_paddr, &tx_ring->tr_dmap,
648 1.1.6.2 rmind &tx_ring->tr_seg);
649 1.1.6.2 rmind if (error) {
650 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create TX ring DMA stuffs\n");
651 1.1.6.2 rmind return error;
652 1.1.6.2 rmind }
653 1.1.6.2 rmind
654 1.1.6.2 rmind /*
655 1.1.6.2 rmind * Create TX status DMA stuffs
656 1.1.6.2 rmind */
657 1.1.6.2 rmind error = et_dma_mem_create(sc, sizeof(uint32_t),
658 1.1.6.2 rmind (void **)&txsd->txsd_status,
659 1.1.6.2 rmind &txsd->txsd_paddr, &txsd->txsd_dmap, &txsd->txsd_seg);
660 1.1.6.2 rmind if (error) {
661 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create TX status DMA stuffs\n");
662 1.1.6.2 rmind return error;
663 1.1.6.2 rmind }
664 1.1.6.2 rmind
665 1.1.6.2 rmind /*
666 1.1.6.2 rmind * Create DMA stuffs for RX rings
667 1.1.6.2 rmind */
668 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i) {
669 1.1.6.2 rmind static const uint32_t rx_ring_posreg[ET_RX_NRING] =
670 1.1.6.2 rmind { ET_RX_RING0_POS, ET_RX_RING1_POS };
671 1.1.6.2 rmind
672 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring = &sc->sc_rx_ring[i];
673 1.1.6.2 rmind
674 1.1.6.2 rmind error = et_dma_mem_create(sc, ET_RX_RING_SIZE,
675 1.1.6.2 rmind (void **)&rx_ring->rr_desc,
676 1.1.6.2 rmind &rx_ring->rr_paddr, &rx_ring->rr_dmap, &rx_ring->rr_seg);
677 1.1.6.2 rmind if (error) {
678 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create DMA stuffs for "
679 1.1.6.2 rmind "the %d RX ring\n", i);
680 1.1.6.2 rmind return error;
681 1.1.6.2 rmind }
682 1.1.6.2 rmind rx_ring->rr_posreg = rx_ring_posreg[i];
683 1.1.6.2 rmind }
684 1.1.6.2 rmind
685 1.1.6.2 rmind /*
686 1.1.6.2 rmind * Create RX stat ring DMA stuffs
687 1.1.6.2 rmind */
688 1.1.6.2 rmind error = et_dma_mem_create(sc, ET_RXSTAT_RING_SIZE,
689 1.1.6.2 rmind (void **)&rxst_ring->rsr_stat,
690 1.1.6.2 rmind &rxst_ring->rsr_paddr, &rxst_ring->rsr_dmap, &rxst_ring->rsr_seg);
691 1.1.6.2 rmind if (error) {
692 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create RX stat ring DMA stuffs\n");
693 1.1.6.2 rmind return error;
694 1.1.6.2 rmind }
695 1.1.6.2 rmind
696 1.1.6.2 rmind /*
697 1.1.6.2 rmind * Create RX status DMA stuffs
698 1.1.6.2 rmind */
699 1.1.6.2 rmind error = et_dma_mem_create(sc, sizeof(struct et_rxstatus),
700 1.1.6.2 rmind (void **)&rxsd->rxsd_status,
701 1.1.6.2 rmind &rxsd->rxsd_paddr, &rxsd->rxsd_dmap, &rxsd->rxsd_seg);
702 1.1.6.2 rmind if (error) {
703 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create RX status DMA stuffs\n");
704 1.1.6.2 rmind return error;
705 1.1.6.2 rmind }
706 1.1.6.2 rmind
707 1.1.6.2 rmind /*
708 1.1.6.2 rmind * Create mbuf DMA stuffs
709 1.1.6.2 rmind */
710 1.1.6.2 rmind error = et_dma_mbuf_create(sc);
711 1.1.6.2 rmind if (error)
712 1.1.6.2 rmind return error;
713 1.1.6.2 rmind
714 1.1.6.2 rmind return 0;
715 1.1.6.2 rmind }
716 1.1.6.2 rmind
717 1.1.6.2 rmind void
718 1.1.6.2 rmind et_dma_free(struct et_softc *sc)
719 1.1.6.2 rmind {
720 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
721 1.1.6.2 rmind struct et_txstatus_data *txsd = &sc->sc_tx_status;
722 1.1.6.2 rmind struct et_rxstat_ring *rxst_ring = &sc->sc_rxstat_ring;
723 1.1.6.2 rmind struct et_rxstatus_data *rxsd = &sc->sc_rx_status;
724 1.1.6.2 rmind int i, rx_done[ET_RX_NRING];
725 1.1.6.2 rmind
726 1.1.6.2 rmind /*
727 1.1.6.2 rmind * Destroy TX ring DMA stuffs
728 1.1.6.2 rmind */
729 1.1.6.2 rmind et_dma_mem_destroy(sc, tx_ring->tr_desc, tx_ring->tr_dmap);
730 1.1.6.2 rmind
731 1.1.6.2 rmind /*
732 1.1.6.2 rmind * Destroy TX status DMA stuffs
733 1.1.6.2 rmind */
734 1.1.6.2 rmind et_dma_mem_destroy(sc, txsd->txsd_status, txsd->txsd_dmap);
735 1.1.6.2 rmind
736 1.1.6.2 rmind /*
737 1.1.6.2 rmind * Destroy DMA stuffs for RX rings
738 1.1.6.2 rmind */
739 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i) {
740 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring = &sc->sc_rx_ring[i];
741 1.1.6.2 rmind
742 1.1.6.2 rmind et_dma_mem_destroy(sc, rx_ring->rr_desc, rx_ring->rr_dmap);
743 1.1.6.2 rmind }
744 1.1.6.2 rmind
745 1.1.6.2 rmind /*
746 1.1.6.2 rmind * Destroy RX stat ring DMA stuffs
747 1.1.6.2 rmind */
748 1.1.6.2 rmind et_dma_mem_destroy(sc, rxst_ring->rsr_stat, rxst_ring->rsr_dmap);
749 1.1.6.2 rmind
750 1.1.6.2 rmind /*
751 1.1.6.2 rmind * Destroy RX status DMA stuffs
752 1.1.6.2 rmind */
753 1.1.6.2 rmind et_dma_mem_destroy(sc, rxsd->rxsd_status, rxsd->rxsd_dmap);
754 1.1.6.2 rmind
755 1.1.6.2 rmind /*
756 1.1.6.2 rmind * Destroy mbuf DMA stuffs
757 1.1.6.2 rmind */
758 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i)
759 1.1.6.2 rmind rx_done[i] = ET_RX_NDESC;
760 1.1.6.2 rmind et_dma_mbuf_destroy(sc, ET_TX_NDESC, rx_done);
761 1.1.6.2 rmind }
762 1.1.6.2 rmind
763 1.1.6.2 rmind int
764 1.1.6.2 rmind et_dma_mbuf_create(struct et_softc *sc)
765 1.1.6.2 rmind {
766 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
767 1.1.6.2 rmind int i, error, rx_done[ET_RX_NRING];
768 1.1.6.2 rmind
769 1.1.6.2 rmind /*
770 1.1.6.2 rmind * Create spare DMA map for RX mbufs
771 1.1.6.2 rmind */
772 1.1.6.2 rmind error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES, 0,
773 1.1.6.2 rmind BUS_DMA_NOWAIT, &sc->sc_mbuf_tmp_dmap);
774 1.1.6.2 rmind if (error) {
775 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create spare mbuf DMA map\n");
776 1.1.6.2 rmind return error;
777 1.1.6.2 rmind }
778 1.1.6.2 rmind
779 1.1.6.2 rmind /*
780 1.1.6.2 rmind * Create DMA maps for RX mbufs
781 1.1.6.2 rmind */
782 1.1.6.2 rmind bzero(rx_done, sizeof(rx_done));
783 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i) {
784 1.1.6.2 rmind struct et_rxbuf_data *rbd = &sc->sc_rx_data[i];
785 1.1.6.2 rmind int j;
786 1.1.6.2 rmind
787 1.1.6.2 rmind for (j = 0; j < ET_RX_NDESC; ++j) {
788 1.1.6.2 rmind error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
789 1.1.6.2 rmind MCLBYTES, 0, BUS_DMA_NOWAIT,
790 1.1.6.2 rmind &rbd->rbd_buf[j].rb_dmap);
791 1.1.6.2 rmind if (error) {
792 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create %d RX mbuf "
793 1.1.6.2 rmind "for %d RX ring\n", j, i);
794 1.1.6.2 rmind rx_done[i] = j;
795 1.1.6.2 rmind et_dma_mbuf_destroy(sc, 0, rx_done);
796 1.1.6.2 rmind return error;
797 1.1.6.2 rmind }
798 1.1.6.2 rmind }
799 1.1.6.2 rmind rx_done[i] = ET_RX_NDESC;
800 1.1.6.2 rmind
801 1.1.6.2 rmind rbd->rbd_softc = sc;
802 1.1.6.2 rmind rbd->rbd_ring = &sc->sc_rx_ring[i];
803 1.1.6.2 rmind }
804 1.1.6.2 rmind
805 1.1.6.2 rmind /*
806 1.1.6.2 rmind * Create DMA maps for TX mbufs
807 1.1.6.2 rmind */
808 1.1.6.2 rmind for (i = 0; i < ET_TX_NDESC; ++i) {
809 1.1.6.2 rmind error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES,
810 1.1.6.2 rmind 0, BUS_DMA_NOWAIT, &tbd->tbd_buf[i].tb_dmap);
811 1.1.6.2 rmind if (error) {
812 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create %d TX mbuf "
813 1.1.6.2 rmind "DMA map\n", i);
814 1.1.6.2 rmind et_dma_mbuf_destroy(sc, i, rx_done);
815 1.1.6.2 rmind return error;
816 1.1.6.2 rmind }
817 1.1.6.2 rmind }
818 1.1.6.2 rmind
819 1.1.6.2 rmind return 0;
820 1.1.6.2 rmind }
821 1.1.6.2 rmind
822 1.1.6.2 rmind void
823 1.1.6.2 rmind et_dma_mbuf_destroy(struct et_softc *sc, int tx_done, const int rx_done[])
824 1.1.6.2 rmind {
825 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
826 1.1.6.2 rmind int i;
827 1.1.6.2 rmind
828 1.1.6.2 rmind /*
829 1.1.6.2 rmind * Destroy DMA maps for RX mbufs
830 1.1.6.2 rmind */
831 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i) {
832 1.1.6.2 rmind struct et_rxbuf_data *rbd = &sc->sc_rx_data[i];
833 1.1.6.2 rmind int j;
834 1.1.6.2 rmind
835 1.1.6.2 rmind for (j = 0; j < rx_done[i]; ++j) {
836 1.1.6.2 rmind struct et_rxbuf *rb = &rbd->rbd_buf[j];
837 1.1.6.2 rmind
838 1.1.6.2 rmind KASSERT(rb->rb_mbuf == NULL,
839 1.1.6.2 rmind ("RX mbuf in %d RX ring is not freed yet\n", i));
840 1.1.6.2 rmind bus_dmamap_destroy(sc->sc_dmat, rb->rb_dmap);
841 1.1.6.2 rmind }
842 1.1.6.2 rmind }
843 1.1.6.2 rmind
844 1.1.6.2 rmind /*
845 1.1.6.2 rmind * Destroy DMA maps for TX mbufs
846 1.1.6.2 rmind */
847 1.1.6.2 rmind for (i = 0; i < tx_done; ++i) {
848 1.1.6.2 rmind struct et_txbuf *tb = &tbd->tbd_buf[i];
849 1.1.6.2 rmind
850 1.1.6.2 rmind KASSERT(tb->tb_mbuf == NULL, ("TX mbuf is not freed yet\n"));
851 1.1.6.2 rmind bus_dmamap_destroy(sc->sc_dmat, tb->tb_dmap);
852 1.1.6.2 rmind }
853 1.1.6.2 rmind
854 1.1.6.2 rmind /*
855 1.1.6.2 rmind * Destroy spare mbuf DMA map
856 1.1.6.2 rmind */
857 1.1.6.2 rmind bus_dmamap_destroy(sc->sc_dmat, sc->sc_mbuf_tmp_dmap);
858 1.1.6.2 rmind }
859 1.1.6.2 rmind
860 1.1.6.2 rmind int
861 1.1.6.2 rmind et_dma_mem_create(struct et_softc *sc, bus_size_t size,
862 1.1.6.2 rmind void **addr, bus_addr_t *paddr, bus_dmamap_t *dmap, bus_dma_segment_t *seg)
863 1.1.6.2 rmind {
864 1.1.6.2 rmind int error, nsegs;
865 1.1.6.2 rmind
866 1.1.6.2 rmind error = bus_dmamap_create(sc->sc_dmat, size, 1, size, 0, BUS_DMA_NOWAIT,
867 1.1.6.2 rmind dmap);
868 1.1.6.2 rmind if (error) {
869 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't create DMA map\n");
870 1.1.6.2 rmind return error;
871 1.1.6.2 rmind }
872 1.1.6.2 rmind
873 1.1.6.2 rmind error = bus_dmamem_alloc(sc->sc_dmat, size, ET_ALIGN, 0, seg,
874 1.1.6.2 rmind 1, &nsegs, BUS_DMA_WAITOK);
875 1.1.6.2 rmind if (error) {
876 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't allocate DMA mem\n");
877 1.1.6.2 rmind return error;
878 1.1.6.2 rmind }
879 1.1.6.2 rmind
880 1.1.6.2 rmind error = bus_dmamem_map(sc->sc_dmat, seg, nsegs,
881 1.1.6.2 rmind size, (void **)addr, BUS_DMA_NOWAIT);
882 1.1.6.2 rmind if (error) {
883 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't map DMA mem\n");
884 1.1.6.2 rmind return (error);
885 1.1.6.2 rmind }
886 1.1.6.2 rmind
887 1.1.6.2 rmind error = bus_dmamap_load(sc->sc_dmat, *dmap, *addr, size, NULL,
888 1.1.6.2 rmind BUS_DMA_WAITOK);
889 1.1.6.2 rmind if (error) {
890 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't load DMA mem\n");
891 1.1.6.2 rmind bus_dmamem_free(sc->sc_dmat, (bus_dma_segment_t *)addr, 1);
892 1.1.6.2 rmind return error;
893 1.1.6.2 rmind }
894 1.1.6.2 rmind
895 1.1.6.2 rmind memset(*addr, 0, size);
896 1.1.6.2 rmind
897 1.1.6.2 rmind *paddr = (*dmap)->dm_segs[0].ds_addr;
898 1.1.6.2 rmind
899 1.1.6.2 rmind return 0;
900 1.1.6.2 rmind }
901 1.1.6.2 rmind
902 1.1.6.2 rmind void
903 1.1.6.2 rmind et_dma_mem_destroy(struct et_softc *sc, void *addr, bus_dmamap_t dmap)
904 1.1.6.2 rmind {
905 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, dmap);
906 1.1.6.2 rmind bus_dmamem_free(sc->sc_dmat, (bus_dma_segment_t *)&addr, 1);
907 1.1.6.2 rmind }
908 1.1.6.2 rmind
909 1.1.6.2 rmind void
910 1.1.6.2 rmind et_dma_ring_addr(void *arg, bus_dma_segment_t *seg, int nseg, int error)
911 1.1.6.2 rmind {
912 1.1.6.2 rmind KASSERT(nseg == 1, ("too many segments\n"));
913 1.1.6.2 rmind *((bus_addr_t *)arg) = seg->ds_addr;
914 1.1.6.2 rmind }
915 1.1.6.2 rmind
916 1.1.6.2 rmind void
917 1.1.6.2 rmind et_chip_attach(struct et_softc *sc)
918 1.1.6.2 rmind {
919 1.1.6.2 rmind uint32_t val;
920 1.1.6.2 rmind
921 1.1.6.2 rmind /*
922 1.1.6.2 rmind * Perform minimal initialization
923 1.1.6.2 rmind */
924 1.1.6.2 rmind
925 1.1.6.2 rmind /* Disable loopback */
926 1.1.6.2 rmind CSR_WRITE_4(sc, ET_LOOPBACK, 0);
927 1.1.6.2 rmind
928 1.1.6.2 rmind /* Reset MAC */
929 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1,
930 1.1.6.2 rmind ET_MAC_CFG1_RST_TXFUNC | ET_MAC_CFG1_RST_RXFUNC |
931 1.1.6.2 rmind ET_MAC_CFG1_RST_TXMC | ET_MAC_CFG1_RST_RXMC |
932 1.1.6.2 rmind ET_MAC_CFG1_SIM_RST | ET_MAC_CFG1_SOFT_RST);
933 1.1.6.2 rmind
934 1.1.6.2 rmind /*
935 1.1.6.2 rmind * Setup half duplex mode
936 1.1.6.2 rmind */
937 1.1.6.2 rmind val = __SHIFTIN(10, ET_MAC_HDX_ALT_BEB_TRUNC) |
938 1.1.6.2 rmind __SHIFTIN(15, ET_MAC_HDX_REXMIT_MAX) |
939 1.1.6.2 rmind __SHIFTIN(55, ET_MAC_HDX_COLLWIN) |
940 1.1.6.2 rmind ET_MAC_HDX_EXC_DEFER;
941 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_HDX, val);
942 1.1.6.2 rmind
943 1.1.6.2 rmind /* Clear MAC control */
944 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CTRL, 0);
945 1.1.6.2 rmind
946 1.1.6.2 rmind /* Reset MII */
947 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CFG, ET_MII_CFG_CLKRST);
948 1.1.6.2 rmind
949 1.1.6.2 rmind /* Bring MAC out of reset state */
950 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1, 0);
951 1.1.6.2 rmind
952 1.1.6.2 rmind /* Enable memory controllers */
953 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MMC_CTRL, ET_MMC_CTRL_ENABLE);
954 1.1.6.2 rmind }
955 1.1.6.2 rmind
956 1.1.6.2 rmind int
957 1.1.6.2 rmind et_intr(void *xsc)
958 1.1.6.2 rmind {
959 1.1.6.2 rmind struct et_softc *sc = xsc;
960 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
961 1.1.6.2 rmind uint32_t intrs;
962 1.1.6.2 rmind
963 1.1.6.2 rmind if ((ifp->if_flags & IFF_RUNNING) == 0)
964 1.1.6.2 rmind return (0);
965 1.1.6.2 rmind
966 1.1.6.2 rmind intrs = CSR_READ_4(sc, ET_INTR_STATUS);
967 1.1.6.2 rmind if (intrs == 0 || intrs == 0xffffffff)
968 1.1.6.2 rmind return (0);
969 1.1.6.2 rmind
970 1.1.6.2 rmind et_disable_intrs(sc);
971 1.1.6.2 rmind intrs &= ET_INTRS;
972 1.1.6.2 rmind if (intrs == 0) /* Not interested */
973 1.1.6.2 rmind goto back;
974 1.1.6.2 rmind
975 1.1.6.2 rmind if (intrs & ET_INTR_RXEOF)
976 1.1.6.2 rmind et_rxeof(sc);
977 1.1.6.2 rmind if (intrs & (ET_INTR_TXEOF | ET_INTR_TIMER))
978 1.1.6.2 rmind et_txeof(sc);
979 1.1.6.2 rmind if (intrs & ET_INTR_TIMER)
980 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TIMER, sc->sc_timer);
981 1.1.6.2 rmind back:
982 1.1.6.2 rmind et_enable_intrs(sc, ET_INTRS);
983 1.1.6.2 rmind
984 1.1.6.2 rmind return (1);
985 1.1.6.2 rmind }
986 1.1.6.2 rmind
987 1.1.6.2 rmind int
988 1.1.6.2 rmind et_init(struct ifnet *ifp)
989 1.1.6.2 rmind {
990 1.1.6.2 rmind struct et_softc *sc = ifp->if_softc;
991 1.1.6.2 rmind int error, i, s;
992 1.1.6.2 rmind
993 1.1.6.2 rmind if (ifp->if_flags & IFF_RUNNING)
994 1.1.6.2 rmind return 0;
995 1.1.6.2 rmind
996 1.1.6.2 rmind s = splnet();
997 1.1.6.2 rmind
998 1.1.6.2 rmind et_stop(sc);
999 1.1.6.2 rmind
1000 1.1.6.2 rmind for (i = 0; i < ET_RX_NRING; ++i) {
1001 1.1.6.2 rmind sc->sc_rx_data[i].rbd_bufsize = et_bufsize[i].bufsize;
1002 1.1.6.2 rmind sc->sc_rx_data[i].rbd_newbuf = et_bufsize[i].newbuf;
1003 1.1.6.2 rmind }
1004 1.1.6.2 rmind
1005 1.1.6.2 rmind error = et_init_tx_ring(sc);
1006 1.1.6.2 rmind if (error)
1007 1.1.6.2 rmind goto back;
1008 1.1.6.2 rmind
1009 1.1.6.2 rmind error = et_init_rx_ring(sc);
1010 1.1.6.2 rmind if (error)
1011 1.1.6.2 rmind goto back;
1012 1.1.6.2 rmind
1013 1.1.6.2 rmind error = et_chip_init(sc);
1014 1.1.6.2 rmind if (error)
1015 1.1.6.2 rmind goto back;
1016 1.1.6.2 rmind
1017 1.1.6.2 rmind error = et_enable_txrx(sc);
1018 1.1.6.2 rmind if (error)
1019 1.1.6.2 rmind goto back;
1020 1.1.6.2 rmind
1021 1.1.6.2 rmind error = et_start_rxdma(sc);
1022 1.1.6.2 rmind if (error)
1023 1.1.6.2 rmind goto back;
1024 1.1.6.2 rmind
1025 1.1.6.2 rmind error = et_start_txdma(sc);
1026 1.1.6.2 rmind if (error)
1027 1.1.6.2 rmind goto back;
1028 1.1.6.2 rmind
1029 1.1.6.2 rmind et_enable_intrs(sc, ET_INTRS);
1030 1.1.6.2 rmind
1031 1.1.6.2 rmind callout_schedule(&sc->sc_tick, hz);
1032 1.1.6.2 rmind
1033 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TIMER, sc->sc_timer);
1034 1.1.6.2 rmind
1035 1.1.6.2 rmind ifp->if_flags |= IFF_RUNNING;
1036 1.1.6.2 rmind ifp->if_flags &= ~IFF_OACTIVE;
1037 1.1.6.2 rmind back:
1038 1.1.6.2 rmind if (error)
1039 1.1.6.2 rmind et_stop(sc);
1040 1.1.6.2 rmind
1041 1.1.6.2 rmind splx(s);
1042 1.1.6.2 rmind
1043 1.1.6.2 rmind return (0);
1044 1.1.6.2 rmind }
1045 1.1.6.2 rmind
1046 1.1.6.2 rmind int
1047 1.1.6.2 rmind et_ioctl(struct ifnet *ifp, u_long cmd, void *data)
1048 1.1.6.2 rmind {
1049 1.1.6.2 rmind struct et_softc *sc = ifp->if_softc;
1050 1.1.6.2 rmind struct ifreq *ifr = (struct ifreq *)data;
1051 1.1.6.2 rmind int s, error = 0;
1052 1.1.6.2 rmind
1053 1.1.6.2 rmind s = splnet();
1054 1.1.6.2 rmind
1055 1.1.6.2 rmind switch (cmd) {
1056 1.1.6.2 rmind case SIOCSIFFLAGS:
1057 1.1.6.2 rmind if (ifp->if_flags & IFF_UP) {
1058 1.1.6.2 rmind /*
1059 1.1.6.2 rmind * If only the PROMISC or ALLMULTI flag changes, then
1060 1.1.6.2 rmind * don't do a full re-init of the chip, just update
1061 1.1.6.2 rmind * the Rx filter.
1062 1.1.6.2 rmind */
1063 1.1.6.2 rmind if ((ifp->if_flags & IFF_RUNNING) &&
1064 1.1.6.2 rmind ((ifp->if_flags ^ sc->sc_if_flags) &
1065 1.1.6.2 rmind (IFF_ALLMULTI | IFF_PROMISC)) != 0) {
1066 1.1.6.2 rmind et_setmulti(sc);
1067 1.1.6.2 rmind } else {
1068 1.1.6.2 rmind if (!(ifp->if_flags & IFF_RUNNING))
1069 1.1.6.2 rmind et_init(ifp);
1070 1.1.6.2 rmind }
1071 1.1.6.2 rmind } else {
1072 1.1.6.2 rmind if (ifp->if_flags & IFF_RUNNING)
1073 1.1.6.2 rmind et_stop(sc);
1074 1.1.6.2 rmind }
1075 1.1.6.2 rmind sc->sc_if_flags = ifp->if_flags;
1076 1.1.6.2 rmind break;
1077 1.1.6.2 rmind case SIOCSIFMEDIA:
1078 1.1.6.2 rmind case SIOCGIFMEDIA:
1079 1.1.6.2 rmind error = ifmedia_ioctl(ifp, ifr, &sc->sc_miibus.mii_media, cmd);
1080 1.1.6.2 rmind break;
1081 1.1.6.2 rmind default:
1082 1.1.6.2 rmind error = ether_ioctl(ifp, cmd, data);
1083 1.1.6.2 rmind if (error == ENETRESET) {
1084 1.1.6.2 rmind if (ifp->if_flags & IFF_RUNNING)
1085 1.1.6.2 rmind et_setmulti(sc);
1086 1.1.6.2 rmind error = 0;
1087 1.1.6.2 rmind }
1088 1.1.6.2 rmind break;
1089 1.1.6.2 rmind
1090 1.1.6.2 rmind }
1091 1.1.6.2 rmind
1092 1.1.6.2 rmind splx(s);
1093 1.1.6.2 rmind
1094 1.1.6.2 rmind return error;
1095 1.1.6.2 rmind }
1096 1.1.6.2 rmind
1097 1.1.6.2 rmind void
1098 1.1.6.2 rmind et_start(struct ifnet *ifp)
1099 1.1.6.2 rmind {
1100 1.1.6.2 rmind struct et_softc *sc = ifp->if_softc;
1101 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
1102 1.1.6.2 rmind int trans;
1103 1.1.6.2 rmind struct mbuf *m;
1104 1.1.6.2 rmind
1105 1.1.6.2 rmind if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
1106 1.1.6.2 rmind return;
1107 1.1.6.2 rmind
1108 1.1.6.2 rmind trans = 0;
1109 1.1.6.2 rmind for (;;) {
1110 1.1.6.2 rmind IFQ_DEQUEUE(&ifp->if_snd, m);
1111 1.1.6.2 rmind if (m == NULL)
1112 1.1.6.2 rmind break;
1113 1.1.6.2 rmind
1114 1.1.6.2 rmind if ((tbd->tbd_used + ET_NSEG_SPARE) > ET_TX_NDESC) {
1115 1.1.6.2 rmind ifp->if_flags |= IFF_OACTIVE;
1116 1.1.6.2 rmind break;
1117 1.1.6.2 rmind }
1118 1.1.6.2 rmind
1119 1.1.6.2 rmind if (et_encap(sc, &m)) {
1120 1.1.6.2 rmind ifp->if_oerrors++;
1121 1.1.6.2 rmind ifp->if_flags |= IFF_OACTIVE;
1122 1.1.6.2 rmind break;
1123 1.1.6.2 rmind }
1124 1.1.6.2 rmind
1125 1.1.6.2 rmind trans = 1;
1126 1.1.6.2 rmind
1127 1.1.6.2 rmind #if NBPFILTER > 0
1128 1.1.6.2 rmind if (ifp->if_bpf != NULL)
1129 1.1.6.2 rmind bpf_mtap(ifp->if_bpf, m);
1130 1.1.6.2 rmind #endif
1131 1.1.6.2 rmind }
1132 1.1.6.2 rmind
1133 1.1.6.2 rmind if (trans) {
1134 1.1.6.2 rmind callout_schedule(&sc->sc_txtick, hz);
1135 1.1.6.2 rmind ifp->if_timer = 5;
1136 1.1.6.2 rmind }
1137 1.1.6.2 rmind }
1138 1.1.6.2 rmind
1139 1.1.6.2 rmind void
1140 1.1.6.2 rmind et_watchdog(struct ifnet *ifp)
1141 1.1.6.2 rmind {
1142 1.1.6.2 rmind struct et_softc *sc = ifp->if_softc;
1143 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "watchdog timed out\n");
1144 1.1.6.2 rmind
1145 1.1.6.2 rmind ifp->if_flags &= ~IFF_RUNNING;
1146 1.1.6.2 rmind et_init(ifp);
1147 1.1.6.2 rmind et_start(ifp);
1148 1.1.6.2 rmind }
1149 1.1.6.2 rmind
1150 1.1.6.2 rmind int
1151 1.1.6.2 rmind et_stop_rxdma(struct et_softc *sc)
1152 1.1.6.2 rmind {
1153 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXDMA_CTRL,
1154 1.1.6.2 rmind ET_RXDMA_CTRL_HALT | ET_RXDMA_CTRL_RING1_ENABLE);
1155 1.1.6.2 rmind
1156 1.1.6.2 rmind DELAY(5);
1157 1.1.6.2 rmind if ((CSR_READ_4(sc, ET_RXDMA_CTRL) & ET_RXDMA_CTRL_HALTED) == 0) {
1158 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't stop RX DMA engine\n");
1159 1.1.6.2 rmind return ETIMEDOUT;
1160 1.1.6.2 rmind }
1161 1.1.6.2 rmind return 0;
1162 1.1.6.2 rmind }
1163 1.1.6.2 rmind
1164 1.1.6.2 rmind int
1165 1.1.6.2 rmind et_stop_txdma(struct et_softc *sc)
1166 1.1.6.2 rmind {
1167 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXDMA_CTRL,
1168 1.1.6.2 rmind ET_TXDMA_CTRL_HALT | ET_TXDMA_CTRL_SINGLE_EPKT);
1169 1.1.6.2 rmind return 0;
1170 1.1.6.2 rmind }
1171 1.1.6.2 rmind
1172 1.1.6.2 rmind void
1173 1.1.6.2 rmind et_free_tx_ring(struct et_softc *sc)
1174 1.1.6.2 rmind {
1175 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
1176 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
1177 1.1.6.2 rmind int i;
1178 1.1.6.2 rmind
1179 1.1.6.2 rmind for (i = 0; i < ET_TX_NDESC; ++i) {
1180 1.1.6.2 rmind struct et_txbuf *tb = &tbd->tbd_buf[i];
1181 1.1.6.2 rmind
1182 1.1.6.2 rmind if (tb->tb_mbuf != NULL) {
1183 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, tb->tb_dmap);
1184 1.1.6.2 rmind m_freem(tb->tb_mbuf);
1185 1.1.6.2 rmind tb->tb_mbuf = NULL;
1186 1.1.6.2 rmind }
1187 1.1.6.2 rmind }
1188 1.1.6.2 rmind
1189 1.1.6.2 rmind bzero(tx_ring->tr_desc, ET_TX_RING_SIZE);
1190 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, tx_ring->tr_dmap, 0,
1191 1.1.6.2 rmind tx_ring->tr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1192 1.1.6.2 rmind }
1193 1.1.6.2 rmind
1194 1.1.6.2 rmind void
1195 1.1.6.2 rmind et_free_rx_ring(struct et_softc *sc)
1196 1.1.6.2 rmind {
1197 1.1.6.2 rmind int n;
1198 1.1.6.2 rmind
1199 1.1.6.2 rmind for (n = 0; n < ET_RX_NRING; ++n) {
1200 1.1.6.2 rmind struct et_rxbuf_data *rbd = &sc->sc_rx_data[n];
1201 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring = &sc->sc_rx_ring[n];
1202 1.1.6.2 rmind int i;
1203 1.1.6.2 rmind
1204 1.1.6.2 rmind for (i = 0; i < ET_RX_NDESC; ++i) {
1205 1.1.6.2 rmind struct et_rxbuf *rb = &rbd->rbd_buf[i];
1206 1.1.6.2 rmind
1207 1.1.6.2 rmind if (rb->rb_mbuf != NULL) {
1208 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, rb->rb_dmap);
1209 1.1.6.2 rmind m_freem(rb->rb_mbuf);
1210 1.1.6.2 rmind rb->rb_mbuf = NULL;
1211 1.1.6.2 rmind }
1212 1.1.6.2 rmind }
1213 1.1.6.2 rmind
1214 1.1.6.2 rmind bzero(rx_ring->rr_desc, ET_RX_RING_SIZE);
1215 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rx_ring->rr_dmap, 0,
1216 1.1.6.2 rmind rx_ring->rr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1217 1.1.6.2 rmind }
1218 1.1.6.2 rmind }
1219 1.1.6.2 rmind
1220 1.1.6.2 rmind void
1221 1.1.6.2 rmind et_setmulti(struct et_softc *sc)
1222 1.1.6.2 rmind {
1223 1.1.6.2 rmind struct ethercom *ec = &sc->sc_ethercom;
1224 1.1.6.2 rmind struct ifnet *ifp = &ec->ec_if;
1225 1.1.6.2 rmind uint32_t hash[4] = { 0, 0, 0, 0 };
1226 1.1.6.2 rmind uint32_t rxmac_ctrl, pktfilt;
1227 1.1.6.2 rmind struct ether_multi *enm;
1228 1.1.6.2 rmind struct ether_multistep step;
1229 1.1.6.2 rmind uint8_t addr[ETHER_ADDR_LEN];
1230 1.1.6.2 rmind int i, count;
1231 1.1.6.2 rmind
1232 1.1.6.2 rmind pktfilt = CSR_READ_4(sc, ET_PKTFILT);
1233 1.1.6.2 rmind rxmac_ctrl = CSR_READ_4(sc, ET_RXMAC_CTRL);
1234 1.1.6.2 rmind
1235 1.1.6.2 rmind pktfilt &= ~(ET_PKTFILT_BCAST | ET_PKTFILT_MCAST | ET_PKTFILT_UCAST);
1236 1.1.6.2 rmind if (ifp->if_flags & (IFF_PROMISC | IFF_ALLMULTI)) {
1237 1.1.6.2 rmind rxmac_ctrl |= ET_RXMAC_CTRL_NO_PKTFILT;
1238 1.1.6.2 rmind goto back;
1239 1.1.6.2 rmind }
1240 1.1.6.2 rmind
1241 1.1.6.2 rmind bcopy(etherbroadcastaddr, addr, ETHER_ADDR_LEN);
1242 1.1.6.2 rmind
1243 1.1.6.2 rmind count = 0;
1244 1.1.6.2 rmind ETHER_FIRST_MULTI(step, ec, enm);
1245 1.1.6.2 rmind while (enm != NULL) {
1246 1.1.6.2 rmind uint32_t *hp, h;
1247 1.1.6.2 rmind
1248 1.1.6.2 rmind for (i = 0; i < ETHER_ADDR_LEN; i++) {
1249 1.1.6.2 rmind addr[i] &= enm->enm_addrlo[i];
1250 1.1.6.2 rmind }
1251 1.1.6.2 rmind
1252 1.1.6.2 rmind h = ether_crc32_be(LLADDR((struct sockaddr_dl *)addr),
1253 1.1.6.2 rmind ETHER_ADDR_LEN);
1254 1.1.6.2 rmind h = (h & 0x3f800000) >> 23;
1255 1.1.6.2 rmind
1256 1.1.6.2 rmind hp = &hash[0];
1257 1.1.6.2 rmind if (h >= 32 && h < 64) {
1258 1.1.6.2 rmind h -= 32;
1259 1.1.6.2 rmind hp = &hash[1];
1260 1.1.6.2 rmind } else if (h >= 64 && h < 96) {
1261 1.1.6.2 rmind h -= 64;
1262 1.1.6.2 rmind hp = &hash[2];
1263 1.1.6.2 rmind } else if (h >= 96) {
1264 1.1.6.2 rmind h -= 96;
1265 1.1.6.2 rmind hp = &hash[3];
1266 1.1.6.2 rmind }
1267 1.1.6.2 rmind *hp |= (1 << h);
1268 1.1.6.2 rmind
1269 1.1.6.2 rmind ++count;
1270 1.1.6.2 rmind ETHER_NEXT_MULTI(step, enm);
1271 1.1.6.2 rmind }
1272 1.1.6.2 rmind
1273 1.1.6.2 rmind for (i = 0; i < 4; ++i)
1274 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MULTI_HASH + (i * 4), hash[i]);
1275 1.1.6.2 rmind
1276 1.1.6.2 rmind if (count > 0)
1277 1.1.6.2 rmind pktfilt |= ET_PKTFILT_MCAST;
1278 1.1.6.2 rmind rxmac_ctrl &= ~ET_RXMAC_CTRL_NO_PKTFILT;
1279 1.1.6.2 rmind back:
1280 1.1.6.2 rmind CSR_WRITE_4(sc, ET_PKTFILT, pktfilt);
1281 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_CTRL, rxmac_ctrl);
1282 1.1.6.2 rmind }
1283 1.1.6.2 rmind
1284 1.1.6.2 rmind int
1285 1.1.6.2 rmind et_chip_init(struct et_softc *sc)
1286 1.1.6.2 rmind {
1287 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1288 1.1.6.2 rmind uint32_t rxq_end;
1289 1.1.6.2 rmind int error;
1290 1.1.6.2 rmind
1291 1.1.6.2 rmind /*
1292 1.1.6.2 rmind * Split internal memory between TX and RX according to MTU
1293 1.1.6.2 rmind */
1294 1.1.6.2 rmind if (ifp->if_mtu < 2048)
1295 1.1.6.2 rmind rxq_end = 0x2bc;
1296 1.1.6.2 rmind else if (ifp->if_mtu < 8192)
1297 1.1.6.2 rmind rxq_end = 0x1ff;
1298 1.1.6.2 rmind else
1299 1.1.6.2 rmind rxq_end = 0x1b3;
1300 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXQ_START, 0);
1301 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXQ_END, rxq_end);
1302 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXQ_START, rxq_end + 1);
1303 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXQ_END, ET_INTERN_MEM_END);
1304 1.1.6.2 rmind
1305 1.1.6.2 rmind /* No loopback */
1306 1.1.6.2 rmind CSR_WRITE_4(sc, ET_LOOPBACK, 0);
1307 1.1.6.2 rmind
1308 1.1.6.2 rmind /* Clear MSI configure */
1309 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MSI_CFG, 0);
1310 1.1.6.2 rmind
1311 1.1.6.2 rmind /* Disable timer */
1312 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TIMER, 0);
1313 1.1.6.2 rmind
1314 1.1.6.2 rmind /* Initialize MAC */
1315 1.1.6.2 rmind et_init_mac(sc);
1316 1.1.6.2 rmind
1317 1.1.6.2 rmind /* Enable memory controllers */
1318 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MMC_CTRL, ET_MMC_CTRL_ENABLE);
1319 1.1.6.2 rmind
1320 1.1.6.2 rmind /* Initialize RX MAC */
1321 1.1.6.2 rmind et_init_rxmac(sc);
1322 1.1.6.2 rmind
1323 1.1.6.2 rmind /* Initialize TX MAC */
1324 1.1.6.2 rmind et_init_txmac(sc);
1325 1.1.6.2 rmind
1326 1.1.6.2 rmind /* Initialize RX DMA engine */
1327 1.1.6.2 rmind error = et_init_rxdma(sc);
1328 1.1.6.2 rmind if (error)
1329 1.1.6.2 rmind return error;
1330 1.1.6.2 rmind
1331 1.1.6.2 rmind /* Initialize TX DMA engine */
1332 1.1.6.2 rmind error = et_init_txdma(sc);
1333 1.1.6.2 rmind if (error)
1334 1.1.6.2 rmind return error;
1335 1.1.6.2 rmind
1336 1.1.6.2 rmind return 0;
1337 1.1.6.2 rmind }
1338 1.1.6.2 rmind
1339 1.1.6.2 rmind int
1340 1.1.6.2 rmind et_init_tx_ring(struct et_softc *sc)
1341 1.1.6.2 rmind {
1342 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
1343 1.1.6.2 rmind struct et_txstatus_data *txsd = &sc->sc_tx_status;
1344 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
1345 1.1.6.2 rmind
1346 1.1.6.2 rmind bzero(tx_ring->tr_desc, ET_TX_RING_SIZE);
1347 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, tx_ring->tr_dmap, 0,
1348 1.1.6.2 rmind tx_ring->tr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1349 1.1.6.2 rmind
1350 1.1.6.2 rmind tbd->tbd_start_index = 0;
1351 1.1.6.2 rmind tbd->tbd_start_wrap = 0;
1352 1.1.6.2 rmind tbd->tbd_used = 0;
1353 1.1.6.2 rmind
1354 1.1.6.2 rmind bzero(txsd->txsd_status, sizeof(uint32_t));
1355 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, txsd->txsd_dmap, 0,
1356 1.1.6.2 rmind txsd->txsd_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1357 1.1.6.2 rmind return 0;
1358 1.1.6.2 rmind }
1359 1.1.6.2 rmind
1360 1.1.6.2 rmind int
1361 1.1.6.2 rmind et_init_rx_ring(struct et_softc *sc)
1362 1.1.6.2 rmind {
1363 1.1.6.2 rmind struct et_rxstatus_data *rxsd = &sc->sc_rx_status;
1364 1.1.6.2 rmind struct et_rxstat_ring *rxst_ring = &sc->sc_rxstat_ring;
1365 1.1.6.2 rmind int n;
1366 1.1.6.2 rmind
1367 1.1.6.2 rmind for (n = 0; n < ET_RX_NRING; ++n) {
1368 1.1.6.2 rmind struct et_rxbuf_data *rbd = &sc->sc_rx_data[n];
1369 1.1.6.2 rmind int i, error;
1370 1.1.6.2 rmind
1371 1.1.6.2 rmind for (i = 0; i < ET_RX_NDESC; ++i) {
1372 1.1.6.2 rmind error = rbd->rbd_newbuf(rbd, i, 1);
1373 1.1.6.2 rmind if (error) {
1374 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "%d ring %d buf, newbuf failed: "
1375 1.1.6.2 rmind "%d\n", n, i, error);
1376 1.1.6.2 rmind return error;
1377 1.1.6.2 rmind }
1378 1.1.6.2 rmind }
1379 1.1.6.2 rmind }
1380 1.1.6.2 rmind
1381 1.1.6.2 rmind bzero(rxsd->rxsd_status, sizeof(struct et_rxstatus));
1382 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rxsd->rxsd_dmap, 0,
1383 1.1.6.2 rmind rxsd->rxsd_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1384 1.1.6.2 rmind
1385 1.1.6.2 rmind bzero(rxst_ring->rsr_stat, ET_RXSTAT_RING_SIZE);
1386 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rxst_ring->rsr_dmap, 0,
1387 1.1.6.2 rmind rxst_ring->rsr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1388 1.1.6.2 rmind
1389 1.1.6.2 rmind return 0;
1390 1.1.6.2 rmind }
1391 1.1.6.2 rmind
1392 1.1.6.2 rmind int
1393 1.1.6.2 rmind et_init_rxdma(struct et_softc *sc)
1394 1.1.6.2 rmind {
1395 1.1.6.2 rmind struct et_rxstatus_data *rxsd = &sc->sc_rx_status;
1396 1.1.6.2 rmind struct et_rxstat_ring *rxst_ring = &sc->sc_rxstat_ring;
1397 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring;
1398 1.1.6.2 rmind int error;
1399 1.1.6.2 rmind
1400 1.1.6.2 rmind error = et_stop_rxdma(sc);
1401 1.1.6.2 rmind if (error) {
1402 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't init RX DMA engine\n");
1403 1.1.6.2 rmind return error;
1404 1.1.6.2 rmind }
1405 1.1.6.2 rmind
1406 1.1.6.2 rmind /*
1407 1.1.6.2 rmind * Install RX status
1408 1.1.6.2 rmind */
1409 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_STATUS_HI, ET_ADDR_HI(rxsd->rxsd_paddr));
1410 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_STATUS_LO, ET_ADDR_LO(rxsd->rxsd_paddr));
1411 1.1.6.2 rmind
1412 1.1.6.2 rmind /*
1413 1.1.6.2 rmind * Install RX stat ring
1414 1.1.6.2 rmind */
1415 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_HI, ET_ADDR_HI(rxst_ring->rsr_paddr));
1416 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_LO, ET_ADDR_LO(rxst_ring->rsr_paddr));
1417 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_CNT, ET_RX_NSTAT - 1);
1418 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_POS, 0);
1419 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_MINCNT, ((ET_RX_NSTAT * 15) / 100) - 1);
1420 1.1.6.2 rmind
1421 1.1.6.2 rmind /* Match ET_RXSTAT_POS */
1422 1.1.6.2 rmind rxst_ring->rsr_index = 0;
1423 1.1.6.2 rmind rxst_ring->rsr_wrap = 0;
1424 1.1.6.2 rmind
1425 1.1.6.2 rmind /*
1426 1.1.6.2 rmind * Install the 2nd RX descriptor ring
1427 1.1.6.2 rmind */
1428 1.1.6.2 rmind rx_ring = &sc->sc_rx_ring[1];
1429 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING1_HI, ET_ADDR_HI(rx_ring->rr_paddr));
1430 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING1_LO, ET_ADDR_LO(rx_ring->rr_paddr));
1431 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING1_CNT, ET_RX_NDESC - 1);
1432 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING1_POS, ET_RX_RING1_POS_WRAP);
1433 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING1_MINCNT, ((ET_RX_NDESC * 15) / 100) - 1);
1434 1.1.6.2 rmind
1435 1.1.6.2 rmind /* Match ET_RX_RING1_POS */
1436 1.1.6.2 rmind rx_ring->rr_index = 0;
1437 1.1.6.2 rmind rx_ring->rr_wrap = 1;
1438 1.1.6.2 rmind
1439 1.1.6.2 rmind /*
1440 1.1.6.2 rmind * Install the 1st RX descriptor ring
1441 1.1.6.2 rmind */
1442 1.1.6.2 rmind rx_ring = &sc->sc_rx_ring[0];
1443 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING0_HI, ET_ADDR_HI(rx_ring->rr_paddr));
1444 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING0_LO, ET_ADDR_LO(rx_ring->rr_paddr));
1445 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING0_CNT, ET_RX_NDESC - 1);
1446 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING0_POS, ET_RX_RING0_POS_WRAP);
1447 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_RING0_MINCNT, ((ET_RX_NDESC * 15) / 100) - 1);
1448 1.1.6.2 rmind
1449 1.1.6.2 rmind /* Match ET_RX_RING0_POS */
1450 1.1.6.2 rmind rx_ring->rr_index = 0;
1451 1.1.6.2 rmind rx_ring->rr_wrap = 1;
1452 1.1.6.2 rmind
1453 1.1.6.2 rmind /*
1454 1.1.6.2 rmind * RX intr moderation
1455 1.1.6.2 rmind */
1456 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_INTR_NPKTS, sc->sc_rx_intr_npkts);
1457 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RX_INTR_DELAY, sc->sc_rx_intr_delay);
1458 1.1.6.2 rmind
1459 1.1.6.2 rmind return 0;
1460 1.1.6.2 rmind }
1461 1.1.6.2 rmind
1462 1.1.6.2 rmind int
1463 1.1.6.2 rmind et_init_txdma(struct et_softc *sc)
1464 1.1.6.2 rmind {
1465 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
1466 1.1.6.2 rmind struct et_txstatus_data *txsd = &sc->sc_tx_status;
1467 1.1.6.2 rmind int error;
1468 1.1.6.2 rmind
1469 1.1.6.2 rmind error = et_stop_txdma(sc);
1470 1.1.6.2 rmind if (error) {
1471 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't init TX DMA engine\n");
1472 1.1.6.2 rmind return error;
1473 1.1.6.2 rmind }
1474 1.1.6.2 rmind
1475 1.1.6.2 rmind /*
1476 1.1.6.2 rmind * Install TX descriptor ring
1477 1.1.6.2 rmind */
1478 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_RING_HI, ET_ADDR_HI(tx_ring->tr_paddr));
1479 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_RING_LO, ET_ADDR_LO(tx_ring->tr_paddr));
1480 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_RING_CNT, ET_TX_NDESC - 1);
1481 1.1.6.2 rmind
1482 1.1.6.2 rmind /*
1483 1.1.6.2 rmind * Install TX status
1484 1.1.6.2 rmind */
1485 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_STATUS_HI, ET_ADDR_HI(txsd->txsd_paddr));
1486 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_STATUS_LO, ET_ADDR_LO(txsd->txsd_paddr));
1487 1.1.6.2 rmind
1488 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_READY_POS, 0);
1489 1.1.6.2 rmind
1490 1.1.6.2 rmind /* Match ET_TX_READY_POS */
1491 1.1.6.2 rmind tx_ring->tr_ready_index = 0;
1492 1.1.6.2 rmind tx_ring->tr_ready_wrap = 0;
1493 1.1.6.2 rmind
1494 1.1.6.2 rmind return 0;
1495 1.1.6.2 rmind }
1496 1.1.6.2 rmind
1497 1.1.6.2 rmind void
1498 1.1.6.2 rmind et_init_mac(struct et_softc *sc)
1499 1.1.6.2 rmind {
1500 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1501 1.1.6.2 rmind const uint8_t *eaddr = CLLADDR(ifp->if_sadl);
1502 1.1.6.2 rmind uint32_t val;
1503 1.1.6.2 rmind
1504 1.1.6.2 rmind /* Reset MAC */
1505 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1,
1506 1.1.6.2 rmind ET_MAC_CFG1_RST_TXFUNC | ET_MAC_CFG1_RST_RXFUNC |
1507 1.1.6.2 rmind ET_MAC_CFG1_RST_TXMC | ET_MAC_CFG1_RST_RXMC |
1508 1.1.6.2 rmind ET_MAC_CFG1_SIM_RST | ET_MAC_CFG1_SOFT_RST);
1509 1.1.6.2 rmind
1510 1.1.6.2 rmind /*
1511 1.1.6.2 rmind * Setup inter packet gap
1512 1.1.6.2 rmind */
1513 1.1.6.2 rmind val = __SHIFTIN(56, ET_IPG_NONB2B_1) |
1514 1.1.6.2 rmind __SHIFTIN(88, ET_IPG_NONB2B_2) |
1515 1.1.6.2 rmind __SHIFTIN(80, ET_IPG_MINIFG) |
1516 1.1.6.2 rmind __SHIFTIN(96, ET_IPG_B2B);
1517 1.1.6.2 rmind CSR_WRITE_4(sc, ET_IPG, val);
1518 1.1.6.2 rmind
1519 1.1.6.2 rmind /*
1520 1.1.6.2 rmind * Setup half duplex mode
1521 1.1.6.2 rmind */
1522 1.1.6.2 rmind val = __SHIFTIN(10, ET_MAC_HDX_ALT_BEB_TRUNC) |
1523 1.1.6.2 rmind __SHIFTIN(15, ET_MAC_HDX_REXMIT_MAX) |
1524 1.1.6.2 rmind __SHIFTIN(55, ET_MAC_HDX_COLLWIN) |
1525 1.1.6.2 rmind ET_MAC_HDX_EXC_DEFER;
1526 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_HDX, val);
1527 1.1.6.2 rmind
1528 1.1.6.2 rmind /* Clear MAC control */
1529 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CTRL, 0);
1530 1.1.6.2 rmind
1531 1.1.6.2 rmind /* Reset MII */
1532 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MII_CFG, ET_MII_CFG_CLKRST);
1533 1.1.6.2 rmind
1534 1.1.6.2 rmind /*
1535 1.1.6.2 rmind * Set MAC address
1536 1.1.6.2 rmind */
1537 1.1.6.2 rmind val = eaddr[2] | (eaddr[3] << 8) | (eaddr[4] << 16) | (eaddr[5] << 24);
1538 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_ADDR1, val);
1539 1.1.6.2 rmind val = (eaddr[0] << 16) | (eaddr[1] << 24);
1540 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_ADDR2, val);
1541 1.1.6.2 rmind
1542 1.1.6.2 rmind /* Set max frame length */
1543 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAX_FRMLEN,
1544 1.1.6.2 rmind ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN + ifp->if_mtu + ETHER_CRC_LEN);
1545 1.1.6.2 rmind
1546 1.1.6.2 rmind /* Bring MAC out of reset state */
1547 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1, 0);
1548 1.1.6.2 rmind }
1549 1.1.6.2 rmind
1550 1.1.6.2 rmind void
1551 1.1.6.2 rmind et_init_rxmac(struct et_softc *sc)
1552 1.1.6.2 rmind {
1553 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1554 1.1.6.2 rmind const uint8_t *eaddr = CLLADDR(ifp->if_sadl);
1555 1.1.6.2 rmind uint32_t val;
1556 1.1.6.2 rmind int i;
1557 1.1.6.2 rmind
1558 1.1.6.2 rmind /* Disable RX MAC and WOL */
1559 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_CTRL, ET_RXMAC_CTRL_WOL_DISABLE);
1560 1.1.6.2 rmind
1561 1.1.6.2 rmind /*
1562 1.1.6.2 rmind * Clear all WOL related registers
1563 1.1.6.2 rmind */
1564 1.1.6.2 rmind for (i = 0; i < 3; ++i)
1565 1.1.6.2 rmind CSR_WRITE_4(sc, ET_WOL_CRC + (i * 4), 0);
1566 1.1.6.2 rmind for (i = 0; i < 20; ++i)
1567 1.1.6.2 rmind CSR_WRITE_4(sc, ET_WOL_MASK + (i * 4), 0);
1568 1.1.6.2 rmind
1569 1.1.6.2 rmind /*
1570 1.1.6.2 rmind * Set WOL source address. XXX is this necessary?
1571 1.1.6.2 rmind */
1572 1.1.6.2 rmind val = (eaddr[2] << 24) | (eaddr[3] << 16) | (eaddr[4] << 8) | eaddr[5];
1573 1.1.6.2 rmind CSR_WRITE_4(sc, ET_WOL_SA_LO, val);
1574 1.1.6.2 rmind val = (eaddr[0] << 8) | eaddr[1];
1575 1.1.6.2 rmind CSR_WRITE_4(sc, ET_WOL_SA_HI, val);
1576 1.1.6.2 rmind
1577 1.1.6.2 rmind /* Clear packet filters */
1578 1.1.6.2 rmind CSR_WRITE_4(sc, ET_PKTFILT, 0);
1579 1.1.6.2 rmind
1580 1.1.6.2 rmind /* No ucast filtering */
1581 1.1.6.2 rmind CSR_WRITE_4(sc, ET_UCAST_FILTADDR1, 0);
1582 1.1.6.2 rmind CSR_WRITE_4(sc, ET_UCAST_FILTADDR2, 0);
1583 1.1.6.2 rmind CSR_WRITE_4(sc, ET_UCAST_FILTADDR3, 0);
1584 1.1.6.2 rmind
1585 1.1.6.2 rmind if (ifp->if_mtu > 8192) {
1586 1.1.6.2 rmind /*
1587 1.1.6.2 rmind * In order to transmit jumbo packets greater than 8k,
1588 1.1.6.2 rmind * the FIFO between RX MAC and RX DMA needs to be reduced
1589 1.1.6.2 rmind * in size to (16k - MTU). In order to implement this, we
1590 1.1.6.2 rmind * must use "cut through" mode in the RX MAC, which chops
1591 1.1.6.2 rmind * packets down into segments which are (max_size * 16).
1592 1.1.6.2 rmind * In this case we selected 256 bytes, since this is the
1593 1.1.6.2 rmind * size of the PCI-Express TLP's that the 1310 uses.
1594 1.1.6.2 rmind */
1595 1.1.6.2 rmind val = __SHIFTIN(16, ET_RXMAC_MC_SEGSZ_MAX) |
1596 1.1.6.2 rmind ET_RXMAC_MC_SEGSZ_ENABLE;
1597 1.1.6.2 rmind } else {
1598 1.1.6.2 rmind val = 0;
1599 1.1.6.2 rmind }
1600 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_MC_SEGSZ, val);
1601 1.1.6.2 rmind
1602 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_MC_WATERMARK, 0);
1603 1.1.6.2 rmind
1604 1.1.6.2 rmind /* Initialize RX MAC management register */
1605 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_MGT, 0);
1606 1.1.6.2 rmind
1607 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_SPACE_AVL, 0);
1608 1.1.6.2 rmind
1609 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_MGT,
1610 1.1.6.2 rmind ET_RXMAC_MGT_PASS_ECRC |
1611 1.1.6.2 rmind ET_RXMAC_MGT_PASS_ELEN |
1612 1.1.6.2 rmind ET_RXMAC_MGT_PASS_ETRUNC |
1613 1.1.6.2 rmind ET_RXMAC_MGT_CHECK_PKT);
1614 1.1.6.2 rmind
1615 1.1.6.2 rmind /*
1616 1.1.6.2 rmind * Configure runt filtering (may not work on certain chip generation)
1617 1.1.6.2 rmind */
1618 1.1.6.2 rmind val = __SHIFTIN(ETHER_MIN_LEN, ET_PKTFILT_MINLEN) | ET_PKTFILT_FRAG;
1619 1.1.6.2 rmind CSR_WRITE_4(sc, ET_PKTFILT, val);
1620 1.1.6.2 rmind
1621 1.1.6.2 rmind /* Enable RX MAC but leave WOL disabled */
1622 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXMAC_CTRL,
1623 1.1.6.2 rmind ET_RXMAC_CTRL_WOL_DISABLE | ET_RXMAC_CTRL_ENABLE);
1624 1.1.6.2 rmind
1625 1.1.6.2 rmind /*
1626 1.1.6.2 rmind * Setup multicast hash and allmulti/promisc mode
1627 1.1.6.2 rmind */
1628 1.1.6.2 rmind et_setmulti(sc);
1629 1.1.6.2 rmind }
1630 1.1.6.2 rmind
1631 1.1.6.2 rmind void
1632 1.1.6.2 rmind et_init_txmac(struct et_softc *sc)
1633 1.1.6.2 rmind {
1634 1.1.6.2 rmind /* Disable TX MAC and FC(?) */
1635 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXMAC_CTRL, ET_TXMAC_CTRL_FC_DISABLE);
1636 1.1.6.2 rmind
1637 1.1.6.2 rmind /* No flow control yet */
1638 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXMAC_FLOWCTRL, 0);
1639 1.1.6.2 rmind
1640 1.1.6.2 rmind /* Enable TX MAC but leave FC(?) diabled */
1641 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXMAC_CTRL,
1642 1.1.6.2 rmind ET_TXMAC_CTRL_ENABLE | ET_TXMAC_CTRL_FC_DISABLE);
1643 1.1.6.2 rmind }
1644 1.1.6.2 rmind
1645 1.1.6.2 rmind int
1646 1.1.6.2 rmind et_start_rxdma(struct et_softc *sc)
1647 1.1.6.2 rmind {
1648 1.1.6.2 rmind uint32_t val = 0;
1649 1.1.6.2 rmind
1650 1.1.6.2 rmind val |= __SHIFTIN(sc->sc_rx_data[0].rbd_bufsize,
1651 1.1.6.2 rmind ET_RXDMA_CTRL_RING0_SIZE) |
1652 1.1.6.2 rmind ET_RXDMA_CTRL_RING0_ENABLE;
1653 1.1.6.2 rmind val |= __SHIFTIN(sc->sc_rx_data[1].rbd_bufsize,
1654 1.1.6.2 rmind ET_RXDMA_CTRL_RING1_SIZE) |
1655 1.1.6.2 rmind ET_RXDMA_CTRL_RING1_ENABLE;
1656 1.1.6.2 rmind
1657 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXDMA_CTRL, val);
1658 1.1.6.2 rmind
1659 1.1.6.2 rmind DELAY(5);
1660 1.1.6.2 rmind
1661 1.1.6.2 rmind if (CSR_READ_4(sc, ET_RXDMA_CTRL) & ET_RXDMA_CTRL_HALTED) {
1662 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't start RX DMA engine\n");
1663 1.1.6.2 rmind return ETIMEDOUT;
1664 1.1.6.2 rmind }
1665 1.1.6.2 rmind return 0;
1666 1.1.6.2 rmind }
1667 1.1.6.2 rmind
1668 1.1.6.2 rmind int
1669 1.1.6.2 rmind et_start_txdma(struct et_softc *sc)
1670 1.1.6.2 rmind {
1671 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TXDMA_CTRL, ET_TXDMA_CTRL_SINGLE_EPKT);
1672 1.1.6.2 rmind return 0;
1673 1.1.6.2 rmind }
1674 1.1.6.2 rmind
1675 1.1.6.2 rmind int
1676 1.1.6.2 rmind et_enable_txrx(struct et_softc *sc)
1677 1.1.6.2 rmind {
1678 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1679 1.1.6.2 rmind uint32_t val;
1680 1.1.6.2 rmind int i, rc = 0;
1681 1.1.6.2 rmind
1682 1.1.6.2 rmind val = CSR_READ_4(sc, ET_MAC_CFG1);
1683 1.1.6.2 rmind val |= ET_MAC_CFG1_TXEN | ET_MAC_CFG1_RXEN;
1684 1.1.6.2 rmind val &= ~(ET_MAC_CFG1_TXFLOW | ET_MAC_CFG1_RXFLOW |
1685 1.1.6.2 rmind ET_MAC_CFG1_LOOPBACK);
1686 1.1.6.2 rmind CSR_WRITE_4(sc, ET_MAC_CFG1, val);
1687 1.1.6.2 rmind
1688 1.1.6.2 rmind if ((rc = ether_mediachange(ifp)) != 0)
1689 1.1.6.2 rmind goto out;
1690 1.1.6.2 rmind
1691 1.1.6.2 rmind #define NRETRY 100
1692 1.1.6.2 rmind
1693 1.1.6.2 rmind for (i = 0; i < NRETRY; ++i) {
1694 1.1.6.2 rmind val = CSR_READ_4(sc, ET_MAC_CFG1);
1695 1.1.6.2 rmind if ((val & (ET_MAC_CFG1_SYNC_TXEN | ET_MAC_CFG1_SYNC_RXEN)) ==
1696 1.1.6.2 rmind (ET_MAC_CFG1_SYNC_TXEN | ET_MAC_CFG1_SYNC_RXEN))
1697 1.1.6.2 rmind break;
1698 1.1.6.2 rmind
1699 1.1.6.2 rmind DELAY(10);
1700 1.1.6.2 rmind }
1701 1.1.6.2 rmind if (i == NRETRY) {
1702 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't enable RX/TX\n");
1703 1.1.6.2 rmind return ETIMEDOUT;
1704 1.1.6.2 rmind }
1705 1.1.6.2 rmind
1706 1.1.6.2 rmind #undef NRETRY
1707 1.1.6.2 rmind return 0;
1708 1.1.6.2 rmind out:
1709 1.1.6.2 rmind return rc;
1710 1.1.6.2 rmind }
1711 1.1.6.2 rmind
1712 1.1.6.2 rmind void
1713 1.1.6.2 rmind et_rxeof(struct et_softc *sc)
1714 1.1.6.2 rmind {
1715 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1716 1.1.6.2 rmind struct et_rxstatus_data *rxsd = &sc->sc_rx_status;
1717 1.1.6.2 rmind struct et_rxstat_ring *rxst_ring = &sc->sc_rxstat_ring;
1718 1.1.6.2 rmind uint32_t rxs_stat_ring;
1719 1.1.6.2 rmind int rxst_wrap, rxst_index;
1720 1.1.6.2 rmind
1721 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rxsd->rxsd_dmap, 0,
1722 1.1.6.2 rmind rxsd->rxsd_dmap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1723 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rxst_ring->rsr_dmap, 0,
1724 1.1.6.2 rmind rxst_ring->rsr_dmap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1725 1.1.6.2 rmind
1726 1.1.6.2 rmind rxs_stat_ring = rxsd->rxsd_status->rxs_stat_ring;
1727 1.1.6.2 rmind rxst_wrap = (rxs_stat_ring & ET_RXS_STATRING_WRAP) ? 1 : 0;
1728 1.1.6.2 rmind rxst_index = __SHIFTOUT(rxs_stat_ring, ET_RXS_STATRING_INDEX);
1729 1.1.6.2 rmind
1730 1.1.6.2 rmind while (rxst_index != rxst_ring->rsr_index ||
1731 1.1.6.2 rmind rxst_wrap != rxst_ring->rsr_wrap) {
1732 1.1.6.2 rmind struct et_rxbuf_data *rbd;
1733 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring;
1734 1.1.6.2 rmind struct et_rxstat *st;
1735 1.1.6.2 rmind struct et_rxbuf *rb;
1736 1.1.6.2 rmind struct mbuf *m;
1737 1.1.6.2 rmind int buflen, buf_idx, ring_idx;
1738 1.1.6.2 rmind uint32_t rxstat_pos, rxring_pos;
1739 1.1.6.2 rmind
1740 1.1.6.2 rmind KKASSERT(rxst_ring->rsr_index < ET_RX_NSTAT);
1741 1.1.6.2 rmind st = &rxst_ring->rsr_stat[rxst_ring->rsr_index];
1742 1.1.6.2 rmind
1743 1.1.6.2 rmind buflen = __SHIFTOUT(st->rxst_info2, ET_RXST_INFO2_LEN);
1744 1.1.6.2 rmind buf_idx = __SHIFTOUT(st->rxst_info2, ET_RXST_INFO2_BUFIDX);
1745 1.1.6.2 rmind ring_idx = __SHIFTOUT(st->rxst_info2, ET_RXST_INFO2_RINGIDX);
1746 1.1.6.2 rmind
1747 1.1.6.2 rmind if (++rxst_ring->rsr_index == ET_RX_NSTAT) {
1748 1.1.6.2 rmind rxst_ring->rsr_index = 0;
1749 1.1.6.2 rmind rxst_ring->rsr_wrap ^= 1;
1750 1.1.6.2 rmind }
1751 1.1.6.2 rmind rxstat_pos = __SHIFTIN(rxst_ring->rsr_index,
1752 1.1.6.2 rmind ET_RXSTAT_POS_INDEX);
1753 1.1.6.2 rmind if (rxst_ring->rsr_wrap)
1754 1.1.6.2 rmind rxstat_pos |= ET_RXSTAT_POS_WRAP;
1755 1.1.6.2 rmind CSR_WRITE_4(sc, ET_RXSTAT_POS, rxstat_pos);
1756 1.1.6.2 rmind
1757 1.1.6.2 rmind if (ring_idx >= ET_RX_NRING) {
1758 1.1.6.2 rmind ifp->if_ierrors++;
1759 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "invalid ring index %d\n",
1760 1.1.6.2 rmind ring_idx);
1761 1.1.6.2 rmind continue;
1762 1.1.6.2 rmind }
1763 1.1.6.2 rmind if (buf_idx >= ET_RX_NDESC) {
1764 1.1.6.2 rmind ifp->if_ierrors++;
1765 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "invalid buf index %d\n",
1766 1.1.6.2 rmind buf_idx);
1767 1.1.6.2 rmind continue;
1768 1.1.6.2 rmind }
1769 1.1.6.2 rmind
1770 1.1.6.2 rmind rbd = &sc->sc_rx_data[ring_idx];
1771 1.1.6.2 rmind rb = &rbd->rbd_buf[buf_idx];
1772 1.1.6.2 rmind m = rb->rb_mbuf;
1773 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rb->rb_dmap, 0,
1774 1.1.6.2 rmind rb->rb_dmap->dm_mapsize, BUS_DMASYNC_POSTREAD);
1775 1.1.6.2 rmind
1776 1.1.6.2 rmind if (rbd->rbd_newbuf(rbd, buf_idx, 0) == 0) {
1777 1.1.6.2 rmind if (buflen < ETHER_CRC_LEN) {
1778 1.1.6.2 rmind m_freem(m);
1779 1.1.6.2 rmind ifp->if_ierrors++;
1780 1.1.6.2 rmind } else {
1781 1.1.6.2 rmind m->m_pkthdr.len = m->m_len = buflen -
1782 1.1.6.2 rmind ETHER_CRC_LEN;
1783 1.1.6.2 rmind m->m_pkthdr.rcvif = ifp;
1784 1.1.6.2 rmind
1785 1.1.6.2 rmind #if NBPFILTER > 0
1786 1.1.6.2 rmind if (ifp->if_bpf != NULL)
1787 1.1.6.2 rmind bpf_mtap(ifp->if_bpf, m);
1788 1.1.6.2 rmind #endif
1789 1.1.6.2 rmind
1790 1.1.6.2 rmind ifp->if_ipackets++;
1791 1.1.6.2 rmind (*ifp->if_input)(ifp, m);
1792 1.1.6.2 rmind }
1793 1.1.6.2 rmind } else {
1794 1.1.6.2 rmind ifp->if_ierrors++;
1795 1.1.6.2 rmind }
1796 1.1.6.2 rmind
1797 1.1.6.2 rmind rx_ring = &sc->sc_rx_ring[ring_idx];
1798 1.1.6.2 rmind
1799 1.1.6.2 rmind if (buf_idx != rx_ring->rr_index) {
1800 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "WARNING!! ring %d, "
1801 1.1.6.2 rmind "buf_idx %d, rr_idx %d\n",
1802 1.1.6.2 rmind ring_idx, buf_idx, rx_ring->rr_index);
1803 1.1.6.2 rmind }
1804 1.1.6.2 rmind
1805 1.1.6.2 rmind KKASSERT(rx_ring->rr_index < ET_RX_NDESC);
1806 1.1.6.2 rmind if (++rx_ring->rr_index == ET_RX_NDESC) {
1807 1.1.6.2 rmind rx_ring->rr_index = 0;
1808 1.1.6.2 rmind rx_ring->rr_wrap ^= 1;
1809 1.1.6.2 rmind }
1810 1.1.6.2 rmind rxring_pos = __SHIFTIN(rx_ring->rr_index, ET_RX_RING_POS_INDEX);
1811 1.1.6.2 rmind if (rx_ring->rr_wrap)
1812 1.1.6.2 rmind rxring_pos |= ET_RX_RING_POS_WRAP;
1813 1.1.6.2 rmind CSR_WRITE_4(sc, rx_ring->rr_posreg, rxring_pos);
1814 1.1.6.2 rmind }
1815 1.1.6.2 rmind }
1816 1.1.6.2 rmind
1817 1.1.6.2 rmind int
1818 1.1.6.2 rmind et_encap(struct et_softc *sc, struct mbuf **m0)
1819 1.1.6.2 rmind {
1820 1.1.6.2 rmind struct mbuf *m = *m0;
1821 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
1822 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
1823 1.1.6.2 rmind struct et_txdesc *td;
1824 1.1.6.2 rmind bus_dmamap_t map;
1825 1.1.6.2 rmind int error, maxsegs, first_idx, last_idx, i;
1826 1.1.6.2 rmind uint32_t tx_ready_pos, last_td_ctrl2;
1827 1.1.6.2 rmind
1828 1.1.6.2 rmind maxsegs = ET_TX_NDESC - tbd->tbd_used;
1829 1.1.6.2 rmind if (maxsegs > ET_NSEG_MAX)
1830 1.1.6.2 rmind maxsegs = ET_NSEG_MAX;
1831 1.1.6.2 rmind KASSERT(maxsegs >= ET_NSEG_SPARE,
1832 1.1.6.2 rmind ("not enough spare TX desc (%d)\n", maxsegs));
1833 1.1.6.2 rmind
1834 1.1.6.2 rmind KKASSERT(tx_ring->tr_ready_index < ET_TX_NDESC);
1835 1.1.6.2 rmind first_idx = tx_ring->tr_ready_index;
1836 1.1.6.2 rmind map = tbd->tbd_buf[first_idx].tb_dmap;
1837 1.1.6.2 rmind
1838 1.1.6.2 rmind error = bus_dmamap_load_mbuf(sc->sc_dmat, map, m,
1839 1.1.6.2 rmind BUS_DMA_NOWAIT);
1840 1.1.6.2 rmind if (!error && map->dm_nsegs == 0) {
1841 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, map);
1842 1.1.6.2 rmind error = EFBIG;
1843 1.1.6.2 rmind }
1844 1.1.6.2 rmind if (error && error != EFBIG) {
1845 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't load TX mbuf");
1846 1.1.6.2 rmind goto back;
1847 1.1.6.2 rmind }
1848 1.1.6.2 rmind if (error) { /* error == EFBIG */
1849 1.1.6.2 rmind struct mbuf *m_new;
1850 1.1.6.2 rmind
1851 1.1.6.2 rmind error = 0;
1852 1.1.6.2 rmind
1853 1.1.6.2 rmind MGETHDR(m_new, M_DONTWAIT, MT_DATA);
1854 1.1.6.2 rmind if (m_new == NULL) {
1855 1.1.6.2 rmind m_freem(m);
1856 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't defrag TX mbuf\n");
1857 1.1.6.2 rmind error = ENOBUFS;
1858 1.1.6.2 rmind goto back;
1859 1.1.6.2 rmind }
1860 1.1.6.2 rmind
1861 1.1.6.2 rmind M_COPY_PKTHDR(m_new, m);
1862 1.1.6.2 rmind if (m->m_pkthdr.len > MHLEN) {
1863 1.1.6.2 rmind MCLGET(m_new, M_DONTWAIT);
1864 1.1.6.2 rmind if (!(m_new->m_flags & M_EXT)) {
1865 1.1.6.2 rmind m_freem(m);
1866 1.1.6.2 rmind m_freem(m_new);
1867 1.1.6.2 rmind error = ENOBUFS;
1868 1.1.6.2 rmind }
1869 1.1.6.2 rmind }
1870 1.1.6.2 rmind
1871 1.1.6.2 rmind if (error) {
1872 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't defrag TX buffer\n");
1873 1.1.6.2 rmind goto back;
1874 1.1.6.2 rmind }
1875 1.1.6.2 rmind
1876 1.1.6.2 rmind m_copydata(m, 0, m->m_pkthdr.len, mtod(m_new, void *));
1877 1.1.6.2 rmind m_freem(m);
1878 1.1.6.2 rmind m_new->m_len = m_new->m_pkthdr.len;
1879 1.1.6.2 rmind *m0 = m = m_new;
1880 1.1.6.2 rmind
1881 1.1.6.2 rmind error = bus_dmamap_load_mbuf(sc->sc_dmat, map, m,
1882 1.1.6.2 rmind BUS_DMA_NOWAIT);
1883 1.1.6.2 rmind if (error || map->dm_nsegs == 0) {
1884 1.1.6.2 rmind if (map->dm_nsegs == 0) {
1885 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, map);
1886 1.1.6.2 rmind error = EFBIG;
1887 1.1.6.2 rmind }
1888 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't load defraged TX mbuf\n");
1889 1.1.6.2 rmind goto back;
1890 1.1.6.2 rmind }
1891 1.1.6.2 rmind }
1892 1.1.6.2 rmind
1893 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize,
1894 1.1.6.2 rmind BUS_DMASYNC_PREWRITE);
1895 1.1.6.2 rmind
1896 1.1.6.2 rmind last_td_ctrl2 = ET_TDCTRL2_LAST_FRAG;
1897 1.1.6.2 rmind sc->sc_tx += map->dm_nsegs;
1898 1.1.6.2 rmind if (sc->sc_tx / sc->sc_tx_intr_nsegs != sc->sc_tx_intr) {
1899 1.1.6.2 rmind sc->sc_tx_intr = sc->sc_tx / sc->sc_tx_intr_nsegs;
1900 1.1.6.2 rmind last_td_ctrl2 |= ET_TDCTRL2_INTR;
1901 1.1.6.2 rmind }
1902 1.1.6.2 rmind
1903 1.1.6.2 rmind last_idx = -1;
1904 1.1.6.2 rmind for (i = 0; i < map->dm_nsegs; ++i) {
1905 1.1.6.2 rmind int idx;
1906 1.1.6.2 rmind
1907 1.1.6.2 rmind idx = (first_idx + i) % ET_TX_NDESC;
1908 1.1.6.2 rmind td = &tx_ring->tr_desc[idx];
1909 1.1.6.2 rmind td->td_addr_hi = ET_ADDR_HI(map->dm_segs[i].ds_addr);
1910 1.1.6.2 rmind td->td_addr_lo = ET_ADDR_LO(map->dm_segs[i].ds_addr);
1911 1.1.6.2 rmind td->td_ctrl1 =
1912 1.1.6.2 rmind __SHIFTIN(map->dm_segs[i].ds_len, ET_TDCTRL1_LEN);
1913 1.1.6.2 rmind
1914 1.1.6.2 rmind if (i == map->dm_nsegs - 1) { /* Last frag */
1915 1.1.6.2 rmind td->td_ctrl2 = last_td_ctrl2;
1916 1.1.6.2 rmind last_idx = idx;
1917 1.1.6.2 rmind }
1918 1.1.6.2 rmind
1919 1.1.6.2 rmind KKASSERT(tx_ring->tr_ready_index < ET_TX_NDESC);
1920 1.1.6.2 rmind if (++tx_ring->tr_ready_index == ET_TX_NDESC) {
1921 1.1.6.2 rmind tx_ring->tr_ready_index = 0;
1922 1.1.6.2 rmind tx_ring->tr_ready_wrap ^= 1;
1923 1.1.6.2 rmind }
1924 1.1.6.2 rmind }
1925 1.1.6.2 rmind td = &tx_ring->tr_desc[first_idx];
1926 1.1.6.2 rmind td->td_ctrl2 |= ET_TDCTRL2_FIRST_FRAG; /* First frag */
1927 1.1.6.2 rmind
1928 1.1.6.2 rmind KKASSERT(last_idx >= 0);
1929 1.1.6.2 rmind tbd->tbd_buf[first_idx].tb_dmap = tbd->tbd_buf[last_idx].tb_dmap;
1930 1.1.6.2 rmind tbd->tbd_buf[last_idx].tb_dmap = map;
1931 1.1.6.2 rmind tbd->tbd_buf[last_idx].tb_mbuf = m;
1932 1.1.6.2 rmind
1933 1.1.6.2 rmind tbd->tbd_used += map->dm_nsegs;
1934 1.1.6.2 rmind KKASSERT(tbd->tbd_used <= ET_TX_NDESC);
1935 1.1.6.2 rmind
1936 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, tx_ring->tr_dmap, 0,
1937 1.1.6.2 rmind tx_ring->tr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1938 1.1.6.2 rmind
1939 1.1.6.2 rmind
1940 1.1.6.2 rmind tx_ready_pos = __SHIFTIN(tx_ring->tr_ready_index,
1941 1.1.6.2 rmind ET_TX_READY_POS_INDEX);
1942 1.1.6.2 rmind if (tx_ring->tr_ready_wrap)
1943 1.1.6.2 rmind tx_ready_pos |= ET_TX_READY_POS_WRAP;
1944 1.1.6.2 rmind CSR_WRITE_4(sc, ET_TX_READY_POS, tx_ready_pos);
1945 1.1.6.2 rmind
1946 1.1.6.2 rmind error = 0;
1947 1.1.6.2 rmind back:
1948 1.1.6.2 rmind if (error) {
1949 1.1.6.2 rmind m_freem(m);
1950 1.1.6.2 rmind *m0 = NULL;
1951 1.1.6.2 rmind }
1952 1.1.6.2 rmind return error;
1953 1.1.6.2 rmind }
1954 1.1.6.2 rmind
1955 1.1.6.2 rmind void
1956 1.1.6.2 rmind et_txeof(struct et_softc *sc)
1957 1.1.6.2 rmind {
1958 1.1.6.2 rmind struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1959 1.1.6.2 rmind struct et_txdesc_ring *tx_ring = &sc->sc_tx_ring;
1960 1.1.6.2 rmind struct et_txbuf_data *tbd = &sc->sc_tx_data;
1961 1.1.6.2 rmind uint32_t tx_done;
1962 1.1.6.2 rmind int end, wrap;
1963 1.1.6.2 rmind
1964 1.1.6.2 rmind if (tbd->tbd_used == 0)
1965 1.1.6.2 rmind return;
1966 1.1.6.2 rmind
1967 1.1.6.2 rmind tx_done = CSR_READ_4(sc, ET_TX_DONE_POS);
1968 1.1.6.2 rmind end = __SHIFTOUT(tx_done, ET_TX_DONE_POS_INDEX);
1969 1.1.6.2 rmind wrap = (tx_done & ET_TX_DONE_POS_WRAP) ? 1 : 0;
1970 1.1.6.2 rmind
1971 1.1.6.2 rmind while (tbd->tbd_start_index != end || tbd->tbd_start_wrap != wrap) {
1972 1.1.6.2 rmind struct et_txbuf *tb;
1973 1.1.6.2 rmind
1974 1.1.6.2 rmind KKASSERT(tbd->tbd_start_index < ET_TX_NDESC);
1975 1.1.6.2 rmind tb = &tbd->tbd_buf[tbd->tbd_start_index];
1976 1.1.6.2 rmind
1977 1.1.6.2 rmind bzero(&tx_ring->tr_desc[tbd->tbd_start_index],
1978 1.1.6.2 rmind sizeof(struct et_txdesc));
1979 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, tx_ring->tr_dmap, 0,
1980 1.1.6.2 rmind tx_ring->tr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
1981 1.1.6.2 rmind
1982 1.1.6.2 rmind if (tb->tb_mbuf != NULL) {
1983 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, tb->tb_dmap);
1984 1.1.6.2 rmind m_freem(tb->tb_mbuf);
1985 1.1.6.2 rmind tb->tb_mbuf = NULL;
1986 1.1.6.2 rmind ifp->if_opackets++;
1987 1.1.6.2 rmind }
1988 1.1.6.2 rmind
1989 1.1.6.2 rmind if (++tbd->tbd_start_index == ET_TX_NDESC) {
1990 1.1.6.2 rmind tbd->tbd_start_index = 0;
1991 1.1.6.2 rmind tbd->tbd_start_wrap ^= 1;
1992 1.1.6.2 rmind }
1993 1.1.6.2 rmind
1994 1.1.6.2 rmind KKASSERT(tbd->tbd_used > 0);
1995 1.1.6.2 rmind tbd->tbd_used--;
1996 1.1.6.2 rmind }
1997 1.1.6.2 rmind
1998 1.1.6.2 rmind if (tbd->tbd_used == 0) {
1999 1.1.6.2 rmind callout_stop(&sc->sc_txtick);
2000 1.1.6.2 rmind ifp->if_timer = 0;
2001 1.1.6.2 rmind }
2002 1.1.6.2 rmind if (tbd->tbd_used + ET_NSEG_SPARE <= ET_TX_NDESC)
2003 1.1.6.2 rmind ifp->if_flags &= ~IFF_OACTIVE;
2004 1.1.6.2 rmind
2005 1.1.6.2 rmind et_start(ifp);
2006 1.1.6.2 rmind }
2007 1.1.6.2 rmind
2008 1.1.6.2 rmind void
2009 1.1.6.2 rmind et_txtick(void *xsc)
2010 1.1.6.2 rmind {
2011 1.1.6.2 rmind struct et_softc *sc = xsc;
2012 1.1.6.2 rmind int s;
2013 1.1.6.2 rmind
2014 1.1.6.2 rmind s = splnet();
2015 1.1.6.2 rmind et_txeof(sc);
2016 1.1.6.2 rmind splx(s);
2017 1.1.6.2 rmind }
2018 1.1.6.2 rmind
2019 1.1.6.2 rmind void
2020 1.1.6.2 rmind et_tick(void *xsc)
2021 1.1.6.2 rmind {
2022 1.1.6.2 rmind struct et_softc *sc = xsc;
2023 1.1.6.2 rmind int s;
2024 1.1.6.2 rmind
2025 1.1.6.2 rmind s = splnet();
2026 1.1.6.2 rmind mii_tick(&sc->sc_miibus);
2027 1.1.6.2 rmind callout_schedule(&sc->sc_tick, hz);
2028 1.1.6.2 rmind splx(s);
2029 1.1.6.2 rmind }
2030 1.1.6.2 rmind
2031 1.1.6.2 rmind int
2032 1.1.6.2 rmind et_newbuf_cluster(struct et_rxbuf_data *rbd, int buf_idx, int init)
2033 1.1.6.2 rmind {
2034 1.1.6.2 rmind return et_newbuf(rbd, buf_idx, init, MCLBYTES);
2035 1.1.6.2 rmind }
2036 1.1.6.2 rmind
2037 1.1.6.2 rmind int
2038 1.1.6.2 rmind et_newbuf_hdr(struct et_rxbuf_data *rbd, int buf_idx, int init)
2039 1.1.6.2 rmind {
2040 1.1.6.2 rmind return et_newbuf(rbd, buf_idx, init, MHLEN);
2041 1.1.6.2 rmind }
2042 1.1.6.2 rmind
2043 1.1.6.2 rmind int
2044 1.1.6.2 rmind et_newbuf(struct et_rxbuf_data *rbd, int buf_idx, int init, int len0)
2045 1.1.6.2 rmind {
2046 1.1.6.2 rmind struct et_softc *sc = rbd->rbd_softc;
2047 1.1.6.2 rmind struct et_rxdesc_ring *rx_ring;
2048 1.1.6.2 rmind struct et_rxdesc *desc;
2049 1.1.6.2 rmind struct et_rxbuf *rb;
2050 1.1.6.2 rmind struct mbuf *m;
2051 1.1.6.2 rmind bus_dmamap_t dmap;
2052 1.1.6.2 rmind int error, len;
2053 1.1.6.2 rmind
2054 1.1.6.2 rmind KKASSERT(buf_idx < ET_RX_NDESC);
2055 1.1.6.2 rmind rb = &rbd->rbd_buf[buf_idx];
2056 1.1.6.2 rmind
2057 1.1.6.2 rmind if (len0 >= MINCLSIZE) {
2058 1.1.6.2 rmind MGETHDR(m, init ? M_WAITOK : M_DONTWAIT, MT_DATA);
2059 1.1.6.2 rmind if (m == NULL)
2060 1.1.6.2 rmind return (ENOBUFS);
2061 1.1.6.2 rmind MCLGET(m, init ? M_WAITOK : M_DONTWAIT);
2062 1.1.6.2 rmind len = MCLBYTES;
2063 1.1.6.2 rmind } else {
2064 1.1.6.2 rmind MGETHDR(m, init ? M_WAITOK : M_DONTWAIT, MT_DATA);
2065 1.1.6.2 rmind len = MHLEN;
2066 1.1.6.2 rmind }
2067 1.1.6.2 rmind
2068 1.1.6.2 rmind if (m == NULL) {
2069 1.1.6.2 rmind error = ENOBUFS;
2070 1.1.6.2 rmind
2071 1.1.6.2 rmind /* XXX for debug */
2072 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "M_CLGET failed, size %d\n", len0);
2073 1.1.6.2 rmind if (init) {
2074 1.1.6.2 rmind return error;
2075 1.1.6.2 rmind } else {
2076 1.1.6.2 rmind goto back;
2077 1.1.6.2 rmind }
2078 1.1.6.2 rmind }
2079 1.1.6.2 rmind m->m_len = m->m_pkthdr.len = len;
2080 1.1.6.2 rmind
2081 1.1.6.2 rmind /*
2082 1.1.6.2 rmind * Try load RX mbuf into temporary DMA tag
2083 1.1.6.2 rmind */
2084 1.1.6.2 rmind error = bus_dmamap_load_mbuf(sc->sc_dmat, sc->sc_mbuf_tmp_dmap, m,
2085 1.1.6.2 rmind init ? BUS_DMA_WAITOK : BUS_DMA_NOWAIT);
2086 1.1.6.2 rmind if (error) {
2087 1.1.6.2 rmind if (!error) {
2088 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, sc->sc_mbuf_tmp_dmap);
2089 1.1.6.2 rmind error = EFBIG;
2090 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "too many segments?!\n");
2091 1.1.6.2 rmind }
2092 1.1.6.2 rmind m_freem(m);
2093 1.1.6.2 rmind
2094 1.1.6.2 rmind /* XXX for debug */
2095 1.1.6.2 rmind aprint_error_dev(sc->sc_dev, "can't load RX mbuf\n");
2096 1.1.6.2 rmind if (init) {
2097 1.1.6.2 rmind return error;
2098 1.1.6.2 rmind } else {
2099 1.1.6.2 rmind goto back;
2100 1.1.6.2 rmind }
2101 1.1.6.2 rmind }
2102 1.1.6.2 rmind
2103 1.1.6.2 rmind if (!init)
2104 1.1.6.2 rmind bus_dmamap_unload(sc->sc_dmat, rb->rb_dmap);
2105 1.1.6.2 rmind rb->rb_mbuf = m;
2106 1.1.6.2 rmind
2107 1.1.6.2 rmind /*
2108 1.1.6.2 rmind * Swap RX buf's DMA map with the loaded temporary one
2109 1.1.6.2 rmind */
2110 1.1.6.2 rmind dmap = rb->rb_dmap;
2111 1.1.6.2 rmind rb->rb_dmap = sc->sc_mbuf_tmp_dmap;
2112 1.1.6.2 rmind rb->rb_paddr = rb->rb_dmap->dm_segs[0].ds_addr;
2113 1.1.6.2 rmind sc->sc_mbuf_tmp_dmap = dmap;
2114 1.1.6.2 rmind
2115 1.1.6.2 rmind error = 0;
2116 1.1.6.2 rmind back:
2117 1.1.6.2 rmind rx_ring = rbd->rbd_ring;
2118 1.1.6.2 rmind desc = &rx_ring->rr_desc[buf_idx];
2119 1.1.6.2 rmind
2120 1.1.6.2 rmind desc->rd_addr_hi = ET_ADDR_HI(rb->rb_paddr);
2121 1.1.6.2 rmind desc->rd_addr_lo = ET_ADDR_LO(rb->rb_paddr);
2122 1.1.6.2 rmind desc->rd_ctrl = __SHIFTIN(buf_idx, ET_RDCTRL_BUFIDX);
2123 1.1.6.2 rmind
2124 1.1.6.2 rmind bus_dmamap_sync(sc->sc_dmat, rx_ring->rr_dmap, 0,
2125 1.1.6.2 rmind rx_ring->rr_dmap->dm_mapsize, BUS_DMASYNC_PREWRITE);
2126 1.1.6.2 rmind return error;
2127 1.1.6.2 rmind }
2128