dwc_gmac.c revision 1.32 1 1.32 martin /* $NetBSD: dwc_gmac.c,v 1.32 2015/02/23 19:05:17 martin Exp $ */
2 1.18 jmcneill
3 1.1 martin /*-
4 1.1 martin * Copyright (c) 2013, 2014 The NetBSD Foundation, Inc.
5 1.1 martin * All rights reserved.
6 1.1 martin *
7 1.1 martin * This code is derived from software contributed to The NetBSD Foundation
8 1.1 martin * by Matt Thomas of 3am Software Foundry and Martin Husemann.
9 1.1 martin *
10 1.1 martin * Redistribution and use in source and binary forms, with or without
11 1.1 martin * modification, are permitted provided that the following conditions
12 1.1 martin * are met:
13 1.1 martin * 1. Redistributions of source code must retain the above copyright
14 1.1 martin * notice, this list of conditions and the following disclaimer.
15 1.1 martin * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 martin * notice, this list of conditions and the following disclaimer in the
17 1.1 martin * documentation and/or other materials provided with the distribution.
18 1.1 martin *
19 1.1 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 martin * POSSIBILITY OF SUCH DAMAGE.
30 1.1 martin */
31 1.1 martin
32 1.1 martin /*
33 1.1 martin * This driver supports the Synopsis Designware GMAC core, as found
34 1.1 martin * on Allwinner A20 cores and others.
35 1.1 martin *
36 1.1 martin * Real documentation seems to not be available, the marketing product
37 1.1 martin * documents could be found here:
38 1.1 martin *
39 1.1 martin * http://www.synopsys.com/dw/ipdir.php?ds=dwc_ether_mac10_100_1000_unive
40 1.1 martin */
41 1.1 martin
42 1.1 martin #include <sys/cdefs.h>
43 1.1 martin
44 1.32 martin __KERNEL_RCSID(1, "$NetBSD: dwc_gmac.c,v 1.32 2015/02/23 19:05:17 martin Exp $");
45 1.7 martin
46 1.7 martin /* #define DWC_GMAC_DEBUG 1 */
47 1.1 martin
48 1.1 martin #include "opt_inet.h"
49 1.1 martin
50 1.1 martin #include <sys/param.h>
51 1.1 martin #include <sys/bus.h>
52 1.1 martin #include <sys/device.h>
53 1.1 martin #include <sys/intr.h>
54 1.1 martin #include <sys/systm.h>
55 1.1 martin #include <sys/sockio.h>
56 1.29 jmcneill #include <sys/cprng.h>
57 1.1 martin
58 1.1 martin #include <net/if.h>
59 1.1 martin #include <net/if_ether.h>
60 1.1 martin #include <net/if_media.h>
61 1.1 martin #include <net/bpf.h>
62 1.1 martin #ifdef INET
63 1.1 martin #include <netinet/if_inarp.h>
64 1.1 martin #endif
65 1.1 martin
66 1.1 martin #include <dev/mii/miivar.h>
67 1.1 martin
68 1.1 martin #include <dev/ic/dwc_gmac_reg.h>
69 1.1 martin #include <dev/ic/dwc_gmac_var.h>
70 1.1 martin
71 1.1 martin static int dwc_gmac_miibus_read_reg(device_t, int, int);
72 1.1 martin static void dwc_gmac_miibus_write_reg(device_t, int, int, int);
73 1.1 martin static void dwc_gmac_miibus_statchg(struct ifnet *);
74 1.1 martin
75 1.1 martin static int dwc_gmac_reset(struct dwc_gmac_softc *sc);
76 1.1 martin static void dwc_gmac_write_hwaddr(struct dwc_gmac_softc *sc,
77 1.1 martin uint8_t enaddr[ETHER_ADDR_LEN]);
78 1.1 martin static int dwc_gmac_alloc_dma_rings(struct dwc_gmac_softc *sc);
79 1.1 martin static void dwc_gmac_free_dma_rings(struct dwc_gmac_softc *sc);
80 1.1 martin static int dwc_gmac_alloc_rx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_rx_ring *);
81 1.1 martin static void dwc_gmac_reset_rx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_rx_ring *);
82 1.1 martin static void dwc_gmac_free_rx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_rx_ring *);
83 1.1 martin static int dwc_gmac_alloc_tx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_tx_ring *);
84 1.1 martin static void dwc_gmac_reset_tx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_tx_ring *);
85 1.1 martin static void dwc_gmac_free_tx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_tx_ring *);
86 1.1 martin static void dwc_gmac_txdesc_sync(struct dwc_gmac_softc *sc, int start, int end, int ops);
87 1.1 martin static int dwc_gmac_init(struct ifnet *ifp);
88 1.1 martin static void dwc_gmac_stop(struct ifnet *ifp, int disable);
89 1.1 martin static void dwc_gmac_start(struct ifnet *ifp);
90 1.1 martin static int dwc_gmac_queue(struct dwc_gmac_softc *sc, struct mbuf *m0);
91 1.1 martin static int dwc_gmac_ioctl(struct ifnet *, u_long, void *);
92 1.8 martin static void dwc_gmac_tx_intr(struct dwc_gmac_softc *sc);
93 1.8 martin static void dwc_gmac_rx_intr(struct dwc_gmac_softc *sc);
94 1.20 jmcneill static void dwc_gmac_setmulti(struct dwc_gmac_softc *sc);
95 1.22 martin static int dwc_gmac_ifflags_cb(struct ethercom *);
96 1.22 martin static uint32_t bitrev32(uint32_t x);
97 1.1 martin
98 1.1 martin #define TX_DESC_OFFSET(N) ((AWGE_RX_RING_COUNT+(N)) \
99 1.1 martin *sizeof(struct dwc_gmac_dev_dmadesc))
100 1.8 martin #define TX_NEXT(N) (((N)+1) & (AWGE_TX_RING_COUNT-1))
101 1.1 martin
102 1.1 martin #define RX_DESC_OFFSET(N) ((N)*sizeof(struct dwc_gmac_dev_dmadesc))
103 1.8 martin #define RX_NEXT(N) (((N)+1) & (AWGE_RX_RING_COUNT-1))
104 1.8 martin
105 1.8 martin
106 1.8 martin
107 1.11 martin #define GMAC_DEF_DMA_INT_MASK (GMAC_DMA_INT_TIE|GMAC_DMA_INT_RIE| \
108 1.8 martin GMAC_DMA_INT_NIE|GMAC_DMA_INT_AIE| \
109 1.8 martin GMAC_DMA_INT_FBE|GMAC_DMA_INT_UNE)
110 1.8 martin
111 1.8 martin #define GMAC_DMA_INT_ERRORS (GMAC_DMA_INT_AIE|GMAC_DMA_INT_ERE| \
112 1.10 martin GMAC_DMA_INT_FBE| \
113 1.8 martin GMAC_DMA_INT_RWE|GMAC_DMA_INT_RUE| \
114 1.8 martin GMAC_DMA_INT_UNE|GMAC_DMA_INT_OVE| \
115 1.10 martin GMAC_DMA_INT_TJE)
116 1.8 martin
117 1.8 martin #define AWIN_DEF_MAC_INTRMASK \
118 1.8 martin (AWIN_GMAC_MAC_INT_TSI | AWIN_GMAC_MAC_INT_ANEG | \
119 1.8 martin AWIN_GMAC_MAC_INT_LINKCHG | AWIN_GMAC_MAC_INT_RGSMII)
120 1.1 martin
121 1.7 martin
122 1.7 martin #ifdef DWC_GMAC_DEBUG
123 1.7 martin static void dwc_gmac_dump_dma(struct dwc_gmac_softc *sc);
124 1.7 martin static void dwc_gmac_dump_tx_desc(struct dwc_gmac_softc *sc);
125 1.11 martin static void dwc_gmac_dump_rx_desc(struct dwc_gmac_softc *sc);
126 1.8 martin static void dwc_dump_and_abort(struct dwc_gmac_softc *sc, const char *msg);
127 1.10 martin static void dwc_dump_status(struct dwc_gmac_softc *sc);
128 1.22 martin static void dwc_gmac_dump_ffilt(struct dwc_gmac_softc *sc, uint32_t ffilt);
129 1.7 martin #endif
130 1.7 martin
131 1.1 martin void
132 1.5 martin dwc_gmac_attach(struct dwc_gmac_softc *sc, uint32_t mii_clk)
133 1.1 martin {
134 1.1 martin uint8_t enaddr[ETHER_ADDR_LEN];
135 1.1 martin uint32_t maclo, machi;
136 1.1 martin struct mii_data * const mii = &sc->sc_mii;
137 1.1 martin struct ifnet * const ifp = &sc->sc_ec.ec_if;
138 1.5 martin prop_dictionary_t dict;
139 1.17 martin int s;
140 1.1 martin
141 1.1 martin mutex_init(&sc->sc_mdio_lock, MUTEX_DEFAULT, IPL_NET);
142 1.3 martin sc->sc_mii_clk = mii_clk & 7;
143 1.1 martin
144 1.5 martin dict = device_properties(sc->sc_dev);
145 1.5 martin prop_data_t ea = dict ? prop_dictionary_get(dict, "mac-address") : NULL;
146 1.5 martin if (ea != NULL) {
147 1.5 martin /*
148 1.5 martin * If the MAC address is overriden by a device property,
149 1.5 martin * use that.
150 1.5 martin */
151 1.5 martin KASSERT(prop_object_type(ea) == PROP_TYPE_DATA);
152 1.5 martin KASSERT(prop_data_size(ea) == ETHER_ADDR_LEN);
153 1.5 martin memcpy(enaddr, prop_data_data_nocopy(ea), ETHER_ADDR_LEN);
154 1.5 martin } else {
155 1.5 martin /*
156 1.5 martin * If we did not get an externaly configure address,
157 1.5 martin * try to read one from the current filter setup,
158 1.5 martin * before resetting the chip.
159 1.5 martin */
160 1.8 martin maclo = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
161 1.8 martin AWIN_GMAC_MAC_ADDR0LO);
162 1.8 martin machi = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
163 1.8 martin AWIN_GMAC_MAC_ADDR0HI);
164 1.14 jmcneill
165 1.14 jmcneill if (maclo == 0xffffffff && (machi & 0xffff) == 0xffff) {
166 1.29 jmcneill /* fake MAC address */
167 1.29 jmcneill maclo = 0x00f2 | (cprng_strong32() << 16);
168 1.29 jmcneill machi = cprng_strong32();
169 1.14 jmcneill }
170 1.14 jmcneill
171 1.1 martin enaddr[0] = maclo & 0x0ff;
172 1.1 martin enaddr[1] = (maclo >> 8) & 0x0ff;
173 1.1 martin enaddr[2] = (maclo >> 16) & 0x0ff;
174 1.1 martin enaddr[3] = (maclo >> 24) & 0x0ff;
175 1.1 martin enaddr[4] = machi & 0x0ff;
176 1.1 martin enaddr[5] = (machi >> 8) & 0x0ff;
177 1.1 martin }
178 1.1 martin
179 1.1 martin /*
180 1.21 joerg * Init chip and do initial setup
181 1.1 martin */
182 1.1 martin if (dwc_gmac_reset(sc) != 0)
183 1.1 martin return; /* not much to cleanup, haven't attached yet */
184 1.5 martin dwc_gmac_write_hwaddr(sc, enaddr);
185 1.1 martin aprint_normal_dev(sc->sc_dev, "Ethernet address: %s\n",
186 1.1 martin ether_sprintf(enaddr));
187 1.1 martin
188 1.1 martin /*
189 1.1 martin * Allocate Tx and Rx rings
190 1.1 martin */
191 1.1 martin if (dwc_gmac_alloc_dma_rings(sc) != 0) {
192 1.1 martin aprint_error_dev(sc->sc_dev, "could not allocate DMA rings\n");
193 1.1 martin goto fail;
194 1.1 martin }
195 1.1 martin
196 1.1 martin if (dwc_gmac_alloc_tx_ring(sc, &sc->sc_txq) != 0) {
197 1.1 martin aprint_error_dev(sc->sc_dev, "could not allocate Tx ring\n");
198 1.1 martin goto fail;
199 1.1 martin }
200 1.1 martin
201 1.1 martin mutex_init(&sc->sc_rxq.r_mtx, MUTEX_DEFAULT, IPL_NET);
202 1.1 martin if (dwc_gmac_alloc_rx_ring(sc, &sc->sc_rxq) != 0) {
203 1.1 martin aprint_error_dev(sc->sc_dev, "could not allocate Rx ring\n");
204 1.1 martin goto fail;
205 1.1 martin }
206 1.1 martin
207 1.1 martin /*
208 1.1 martin * Prepare interface data
209 1.1 martin */
210 1.1 martin ifp->if_softc = sc;
211 1.1 martin strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
212 1.1 martin ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
213 1.1 martin ifp->if_ioctl = dwc_gmac_ioctl;
214 1.1 martin ifp->if_start = dwc_gmac_start;
215 1.1 martin ifp->if_init = dwc_gmac_init;
216 1.1 martin ifp->if_stop = dwc_gmac_stop;
217 1.1 martin IFQ_SET_MAXLEN(&ifp->if_snd, IFQ_MAXLEN);
218 1.1 martin IFQ_SET_READY(&ifp->if_snd);
219 1.1 martin
220 1.1 martin /*
221 1.1 martin * Attach MII subdevices
222 1.1 martin */
223 1.2 martin sc->sc_ec.ec_mii = &sc->sc_mii;
224 1.1 martin ifmedia_init(&mii->mii_media, 0, ether_mediachange, ether_mediastatus);
225 1.1 martin mii->mii_ifp = ifp;
226 1.1 martin mii->mii_readreg = dwc_gmac_miibus_read_reg;
227 1.1 martin mii->mii_writereg = dwc_gmac_miibus_write_reg;
228 1.1 martin mii->mii_statchg = dwc_gmac_miibus_statchg;
229 1.25 jmcneill mii_attach(sc->sc_dev, mii, 0xffffffff, MII_PHY_ANY, MII_OFFSET_ANY,
230 1.25 jmcneill MIIF_DOPAUSE);
231 1.1 martin
232 1.1 martin if (LIST_EMPTY(&mii->mii_phys)) {
233 1.1 martin aprint_error_dev(sc->sc_dev, "no PHY found!\n");
234 1.1 martin ifmedia_add(&mii->mii_media, IFM_ETHER|IFM_MANUAL, 0, NULL);
235 1.1 martin ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_MANUAL);
236 1.1 martin } else {
237 1.1 martin ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO);
238 1.1 martin }
239 1.1 martin
240 1.1 martin /*
241 1.1 martin * Ready, attach interface
242 1.1 martin */
243 1.1 martin if_attach(ifp);
244 1.1 martin ether_ifattach(ifp, enaddr);
245 1.22 martin ether_set_ifflags_cb(&sc->sc_ec, dwc_gmac_ifflags_cb);
246 1.1 martin
247 1.1 martin /*
248 1.1 martin * Enable interrupts
249 1.1 martin */
250 1.17 martin s = splnet();
251 1.25 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_INTMASK,
252 1.8 martin AWIN_DEF_MAC_INTRMASK);
253 1.8 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_INTENABLE,
254 1.8 martin GMAC_DEF_DMA_INT_MASK);
255 1.17 martin splx(s);
256 1.1 martin
257 1.1 martin return;
258 1.1 martin
259 1.1 martin fail:
260 1.1 martin dwc_gmac_free_rx_ring(sc, &sc->sc_rxq);
261 1.1 martin dwc_gmac_free_tx_ring(sc, &sc->sc_txq);
262 1.1 martin }
263 1.1 martin
264 1.1 martin
265 1.1 martin
266 1.1 martin static int
267 1.1 martin dwc_gmac_reset(struct dwc_gmac_softc *sc)
268 1.1 martin {
269 1.1 martin size_t cnt;
270 1.1 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_BUSMODE,
271 1.1 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_BUSMODE) | GMAC_BUSMODE_RESET);
272 1.1 martin for (cnt = 0; cnt < 3000; cnt++) {
273 1.1 martin if ((bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_BUSMODE)
274 1.1 martin & GMAC_BUSMODE_RESET) == 0)
275 1.1 martin return 0;
276 1.1 martin delay(10);
277 1.1 martin }
278 1.1 martin
279 1.1 martin aprint_error_dev(sc->sc_dev, "reset timed out\n");
280 1.1 martin return EIO;
281 1.1 martin }
282 1.1 martin
283 1.1 martin static void
284 1.1 martin dwc_gmac_write_hwaddr(struct dwc_gmac_softc *sc,
285 1.1 martin uint8_t enaddr[ETHER_ADDR_LEN])
286 1.1 martin {
287 1.1 martin uint32_t lo, hi;
288 1.1 martin
289 1.1 martin lo = enaddr[0] | (enaddr[1] << 8) | (enaddr[2] << 16)
290 1.1 martin | (enaddr[3] << 24);
291 1.1 martin hi = enaddr[4] | (enaddr[5] << 8);
292 1.1 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_ADDR0LO, lo);
293 1.1 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_ADDR0HI, hi);
294 1.1 martin }
295 1.1 martin
296 1.1 martin static int
297 1.1 martin dwc_gmac_miibus_read_reg(device_t self, int phy, int reg)
298 1.1 martin {
299 1.1 martin struct dwc_gmac_softc * const sc = device_private(self);
300 1.6 martin uint16_t mii;
301 1.1 martin size_t cnt;
302 1.1 martin int rv = 0;
303 1.1 martin
304 1.6 martin mii = __SHIFTIN(phy,GMAC_MII_PHY_MASK)
305 1.6 martin | __SHIFTIN(reg,GMAC_MII_REG_MASK)
306 1.6 martin | __SHIFTIN(sc->sc_mii_clk,GMAC_MII_CLKMASK)
307 1.6 martin | GMAC_MII_BUSY;
308 1.1 martin
309 1.1 martin mutex_enter(&sc->sc_mdio_lock);
310 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_MIIADDR, mii);
311 1.1 martin
312 1.1 martin for (cnt = 0; cnt < 1000; cnt++) {
313 1.3 martin if (!(bus_space_read_4(sc->sc_bst, sc->sc_bsh,
314 1.3 martin AWIN_GMAC_MAC_MIIADDR) & GMAC_MII_BUSY)) {
315 1.3 martin rv = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
316 1.3 martin AWIN_GMAC_MAC_MIIDATA);
317 1.1 martin break;
318 1.1 martin }
319 1.1 martin delay(10);
320 1.1 martin }
321 1.1 martin
322 1.1 martin mutex_exit(&sc->sc_mdio_lock);
323 1.1 martin
324 1.1 martin return rv;
325 1.1 martin }
326 1.1 martin
327 1.1 martin static void
328 1.1 martin dwc_gmac_miibus_write_reg(device_t self, int phy, int reg, int val)
329 1.1 martin {
330 1.1 martin struct dwc_gmac_softc * const sc = device_private(self);
331 1.6 martin uint16_t mii;
332 1.1 martin size_t cnt;
333 1.1 martin
334 1.6 martin mii = __SHIFTIN(phy,GMAC_MII_PHY_MASK)
335 1.6 martin | __SHIFTIN(reg,GMAC_MII_REG_MASK)
336 1.6 martin | __SHIFTIN(sc->sc_mii_clk,GMAC_MII_CLKMASK)
337 1.6 martin | GMAC_MII_BUSY | GMAC_MII_WRITE;
338 1.1 martin
339 1.1 martin mutex_enter(&sc->sc_mdio_lock);
340 1.1 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_MIIDATA, val);
341 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_MIIADDR, mii);
342 1.1 martin
343 1.1 martin for (cnt = 0; cnt < 1000; cnt++) {
344 1.3 martin if (!(bus_space_read_4(sc->sc_bst, sc->sc_bsh,
345 1.3 martin AWIN_GMAC_MAC_MIIADDR) & GMAC_MII_BUSY))
346 1.1 martin break;
347 1.1 martin delay(10);
348 1.1 martin }
349 1.1 martin
350 1.1 martin mutex_exit(&sc->sc_mdio_lock);
351 1.1 martin }
352 1.1 martin
353 1.1 martin static int
354 1.1 martin dwc_gmac_alloc_rx_ring(struct dwc_gmac_softc *sc,
355 1.1 martin struct dwc_gmac_rx_ring *ring)
356 1.1 martin {
357 1.1 martin struct dwc_gmac_rx_data *data;
358 1.1 martin bus_addr_t physaddr;
359 1.6 martin const size_t descsize = AWGE_RX_RING_COUNT * sizeof(*ring->r_desc);
360 1.1 martin int error, i, next;
361 1.1 martin
362 1.1 martin ring->r_cur = ring->r_next = 0;
363 1.1 martin memset(ring->r_desc, 0, descsize);
364 1.1 martin
365 1.1 martin /*
366 1.1 martin * Pre-allocate Rx buffers and populate Rx ring.
367 1.1 martin */
368 1.1 martin for (i = 0; i < AWGE_RX_RING_COUNT; i++) {
369 1.1 martin struct dwc_gmac_dev_dmadesc *desc;
370 1.1 martin
371 1.1 martin data = &sc->sc_rxq.r_data[i];
372 1.1 martin
373 1.1 martin MGETHDR(data->rd_m, M_DONTWAIT, MT_DATA);
374 1.1 martin if (data->rd_m == NULL) {
375 1.1 martin aprint_error_dev(sc->sc_dev,
376 1.1 martin "could not allocate rx mbuf #%d\n", i);
377 1.1 martin error = ENOMEM;
378 1.1 martin goto fail;
379 1.1 martin }
380 1.1 martin error = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1,
381 1.1 martin MCLBYTES, 0, BUS_DMA_NOWAIT, &data->rd_map);
382 1.1 martin if (error != 0) {
383 1.1 martin aprint_error_dev(sc->sc_dev,
384 1.1 martin "could not create DMA map\n");
385 1.1 martin data->rd_map = NULL;
386 1.1 martin goto fail;
387 1.1 martin }
388 1.1 martin MCLGET(data->rd_m, M_DONTWAIT);
389 1.1 martin if (!(data->rd_m->m_flags & M_EXT)) {
390 1.1 martin aprint_error_dev(sc->sc_dev,
391 1.1 martin "could not allocate mbuf cluster #%d\n", i);
392 1.1 martin error = ENOMEM;
393 1.1 martin goto fail;
394 1.1 martin }
395 1.1 martin
396 1.1 martin error = bus_dmamap_load(sc->sc_dmat, data->rd_map,
397 1.1 martin mtod(data->rd_m, void *), MCLBYTES, NULL,
398 1.1 martin BUS_DMA_READ | BUS_DMA_NOWAIT);
399 1.1 martin if (error != 0) {
400 1.1 martin aprint_error_dev(sc->sc_dev,
401 1.1 martin "could not load rx buf DMA map #%d", i);
402 1.1 martin goto fail;
403 1.1 martin }
404 1.1 martin physaddr = data->rd_map->dm_segs[0].ds_addr;
405 1.1 martin
406 1.1 martin desc = &sc->sc_rxq.r_desc[i];
407 1.1 martin desc->ddesc_data = htole32(physaddr);
408 1.8 martin next = RX_NEXT(i);
409 1.1 martin desc->ddesc_next = htole32(ring->r_physaddr
410 1.1 martin + next * sizeof(*desc));
411 1.1 martin desc->ddesc_cntl = htole32(
412 1.11 martin __SHIFTIN(AWGE_MAX_PACKET,DDESC_CNTL_SIZE1MASK) |
413 1.16 martin DDESC_CNTL_RXCHAIN);
414 1.1 martin desc->ddesc_status = htole32(DDESC_STATUS_OWNEDBYDEV);
415 1.1 martin }
416 1.1 martin
417 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map, 0,
418 1.1 martin AWGE_RX_RING_COUNT*sizeof(struct dwc_gmac_dev_dmadesc),
419 1.27 matt BUS_DMASYNC_PREWRITE|BUS_DMASYNC_PREREAD);
420 1.1 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_RX_ADDR,
421 1.6 martin ring->r_physaddr);
422 1.1 martin
423 1.1 martin return 0;
424 1.1 martin
425 1.1 martin fail:
426 1.1 martin dwc_gmac_free_rx_ring(sc, ring);
427 1.1 martin return error;
428 1.1 martin }
429 1.1 martin
430 1.1 martin static void
431 1.1 martin dwc_gmac_reset_rx_ring(struct dwc_gmac_softc *sc,
432 1.1 martin struct dwc_gmac_rx_ring *ring)
433 1.1 martin {
434 1.1 martin struct dwc_gmac_dev_dmadesc *desc;
435 1.1 martin int i;
436 1.1 martin
437 1.1 martin for (i = 0; i < AWGE_RX_RING_COUNT; i++) {
438 1.1 martin desc = &sc->sc_rxq.r_desc[i];
439 1.1 martin desc->ddesc_cntl = htole32(
440 1.16 martin __SHIFTIN(AWGE_MAX_PACKET,DDESC_CNTL_SIZE1MASK) |
441 1.16 martin DDESC_CNTL_RXCHAIN);
442 1.1 martin desc->ddesc_status = htole32(DDESC_STATUS_OWNEDBYDEV);
443 1.1 martin }
444 1.1 martin
445 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map, 0,
446 1.1 martin AWGE_RX_RING_COUNT*sizeof(struct dwc_gmac_dev_dmadesc),
447 1.27 matt BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
448 1.1 martin
449 1.1 martin ring->r_cur = ring->r_next = 0;
450 1.11 martin /* reset DMA address to start of ring */
451 1.11 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_RX_ADDR,
452 1.11 martin sc->sc_rxq.r_physaddr);
453 1.1 martin }
454 1.1 martin
455 1.1 martin static int
456 1.1 martin dwc_gmac_alloc_dma_rings(struct dwc_gmac_softc *sc)
457 1.1 martin {
458 1.1 martin const size_t descsize = AWGE_TOTAL_RING_COUNT *
459 1.1 martin sizeof(struct dwc_gmac_dev_dmadesc);
460 1.1 martin int error, nsegs;
461 1.1 martin void *rings;
462 1.1 martin
463 1.1 martin error = bus_dmamap_create(sc->sc_dmat, descsize, 1, descsize, 0,
464 1.1 martin BUS_DMA_NOWAIT, &sc->sc_dma_ring_map);
465 1.1 martin if (error != 0) {
466 1.1 martin aprint_error_dev(sc->sc_dev,
467 1.1 martin "could not create desc DMA map\n");
468 1.1 martin sc->sc_dma_ring_map = NULL;
469 1.1 martin goto fail;
470 1.1 martin }
471 1.1 martin
472 1.1 martin error = bus_dmamem_alloc(sc->sc_dmat, descsize, PAGE_SIZE, 0,
473 1.1 martin &sc->sc_dma_ring_seg, 1, &nsegs, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
474 1.1 martin if (error != 0) {
475 1.1 martin aprint_error_dev(sc->sc_dev,
476 1.1 martin "could not map DMA memory\n");
477 1.1 martin goto fail;
478 1.1 martin }
479 1.1 martin
480 1.1 martin error = bus_dmamem_map(sc->sc_dmat, &sc->sc_dma_ring_seg, nsegs,
481 1.1 martin descsize, &rings, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
482 1.1 martin if (error != 0) {
483 1.1 martin aprint_error_dev(sc->sc_dev,
484 1.1 martin "could not allocate DMA memory\n");
485 1.1 martin goto fail;
486 1.1 martin }
487 1.1 martin
488 1.1 martin error = bus_dmamap_load(sc->sc_dmat, sc->sc_dma_ring_map, rings,
489 1.1 martin descsize, NULL, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
490 1.1 martin if (error != 0) {
491 1.1 martin aprint_error_dev(sc->sc_dev,
492 1.1 martin "could not load desc DMA map\n");
493 1.1 martin goto fail;
494 1.1 martin }
495 1.1 martin
496 1.1 martin /* give first AWGE_RX_RING_COUNT to the RX side */
497 1.1 martin sc->sc_rxq.r_desc = rings;
498 1.1 martin sc->sc_rxq.r_physaddr = sc->sc_dma_ring_map->dm_segs[0].ds_addr;
499 1.1 martin
500 1.1 martin /* and next rings to the TX side */
501 1.1 martin sc->sc_txq.t_desc = sc->sc_rxq.r_desc + AWGE_RX_RING_COUNT;
502 1.1 martin sc->sc_txq.t_physaddr = sc->sc_rxq.r_physaddr +
503 1.1 martin AWGE_RX_RING_COUNT*sizeof(struct dwc_gmac_dev_dmadesc);
504 1.1 martin
505 1.1 martin return 0;
506 1.1 martin
507 1.1 martin fail:
508 1.1 martin dwc_gmac_free_dma_rings(sc);
509 1.1 martin return error;
510 1.1 martin }
511 1.1 martin
512 1.1 martin static void
513 1.1 martin dwc_gmac_free_dma_rings(struct dwc_gmac_softc *sc)
514 1.1 martin {
515 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map, 0,
516 1.1 martin sc->sc_dma_ring_map->dm_mapsize, BUS_DMASYNC_POSTWRITE);
517 1.1 martin bus_dmamap_unload(sc->sc_dmat, sc->sc_dma_ring_map);
518 1.1 martin bus_dmamem_unmap(sc->sc_dmat, sc->sc_rxq.r_desc,
519 1.1 martin AWGE_TOTAL_RING_COUNT * sizeof(struct dwc_gmac_dev_dmadesc));
520 1.1 martin bus_dmamem_free(sc->sc_dmat, &sc->sc_dma_ring_seg, 1);
521 1.1 martin }
522 1.1 martin
523 1.1 martin static void
524 1.1 martin dwc_gmac_free_rx_ring(struct dwc_gmac_softc *sc, struct dwc_gmac_rx_ring *ring)
525 1.1 martin {
526 1.1 martin struct dwc_gmac_rx_data *data;
527 1.1 martin int i;
528 1.1 martin
529 1.1 martin if (ring->r_desc == NULL)
530 1.1 martin return;
531 1.1 martin
532 1.1 martin
533 1.1 martin for (i = 0; i < AWGE_RX_RING_COUNT; i++) {
534 1.1 martin data = &ring->r_data[i];
535 1.1 martin
536 1.1 martin if (data->rd_map != NULL) {
537 1.1 martin bus_dmamap_sync(sc->sc_dmat, data->rd_map, 0,
538 1.1 martin AWGE_RX_RING_COUNT
539 1.1 martin *sizeof(struct dwc_gmac_dev_dmadesc),
540 1.1 martin BUS_DMASYNC_POSTREAD);
541 1.1 martin bus_dmamap_unload(sc->sc_dmat, data->rd_map);
542 1.1 martin bus_dmamap_destroy(sc->sc_dmat, data->rd_map);
543 1.1 martin }
544 1.1 martin if (data->rd_m != NULL)
545 1.1 martin m_freem(data->rd_m);
546 1.1 martin }
547 1.1 martin }
548 1.1 martin
549 1.1 martin static int
550 1.1 martin dwc_gmac_alloc_tx_ring(struct dwc_gmac_softc *sc,
551 1.1 martin struct dwc_gmac_tx_ring *ring)
552 1.1 martin {
553 1.1 martin int i, error = 0;
554 1.1 martin
555 1.1 martin ring->t_queued = 0;
556 1.1 martin ring->t_cur = ring->t_next = 0;
557 1.1 martin
558 1.1 martin memset(ring->t_desc, 0, AWGE_TX_RING_COUNT*sizeof(*ring->t_desc));
559 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
560 1.1 martin TX_DESC_OFFSET(0),
561 1.1 martin AWGE_TX_RING_COUNT*sizeof(struct dwc_gmac_dev_dmadesc),
562 1.1 martin BUS_DMASYNC_POSTWRITE);
563 1.1 martin
564 1.1 martin for (i = 0; i < AWGE_TX_RING_COUNT; i++) {
565 1.1 martin error = bus_dmamap_create(sc->sc_dmat, MCLBYTES,
566 1.1 martin AWGE_TX_RING_COUNT, MCLBYTES, 0,
567 1.1 martin BUS_DMA_NOWAIT|BUS_DMA_COHERENT,
568 1.1 martin &ring->t_data[i].td_map);
569 1.1 martin if (error != 0) {
570 1.1 martin aprint_error_dev(sc->sc_dev,
571 1.1 martin "could not create TX DMA map #%d\n", i);
572 1.1 martin ring->t_data[i].td_map = NULL;
573 1.1 martin goto fail;
574 1.1 martin }
575 1.1 martin ring->t_desc[i].ddesc_next = htole32(
576 1.1 martin ring->t_physaddr + sizeof(struct dwc_gmac_dev_dmadesc)
577 1.8 martin *TX_NEXT(i));
578 1.1 martin }
579 1.1 martin
580 1.1 martin return 0;
581 1.1 martin
582 1.1 martin fail:
583 1.1 martin dwc_gmac_free_tx_ring(sc, ring);
584 1.1 martin return error;
585 1.1 martin }
586 1.1 martin
587 1.1 martin static void
588 1.1 martin dwc_gmac_txdesc_sync(struct dwc_gmac_softc *sc, int start, int end, int ops)
589 1.1 martin {
590 1.1 martin /* 'end' is pointing one descriptor beyound the last we want to sync */
591 1.1 martin if (end > start) {
592 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
593 1.1 martin TX_DESC_OFFSET(start),
594 1.1 martin TX_DESC_OFFSET(end)-TX_DESC_OFFSET(start),
595 1.1 martin ops);
596 1.1 martin return;
597 1.1 martin }
598 1.1 martin /* sync from 'start' to end of ring */
599 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
600 1.1 martin TX_DESC_OFFSET(start),
601 1.31 jmcneill TX_DESC_OFFSET(AWGE_TX_RING_COUNT)-TX_DESC_OFFSET(start),
602 1.1 martin ops);
603 1.1 martin /* sync from start of ring to 'end' */
604 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
605 1.1 martin TX_DESC_OFFSET(0),
606 1.1 martin TX_DESC_OFFSET(end)-TX_DESC_OFFSET(0),
607 1.1 martin ops);
608 1.1 martin }
609 1.1 martin
610 1.1 martin static void
611 1.1 martin dwc_gmac_reset_tx_ring(struct dwc_gmac_softc *sc,
612 1.1 martin struct dwc_gmac_tx_ring *ring)
613 1.1 martin {
614 1.1 martin int i;
615 1.1 martin
616 1.1 martin for (i = 0; i < AWGE_TX_RING_COUNT; i++) {
617 1.1 martin struct dwc_gmac_tx_data *data = &ring->t_data[i];
618 1.1 martin
619 1.1 martin if (data->td_m != NULL) {
620 1.1 martin bus_dmamap_sync(sc->sc_dmat, data->td_active,
621 1.1 martin 0, data->td_active->dm_mapsize,
622 1.1 martin BUS_DMASYNC_POSTWRITE);
623 1.1 martin bus_dmamap_unload(sc->sc_dmat, data->td_active);
624 1.1 martin m_freem(data->td_m);
625 1.1 martin data->td_m = NULL;
626 1.1 martin }
627 1.1 martin }
628 1.1 martin
629 1.1 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
630 1.1 martin TX_DESC_OFFSET(0),
631 1.1 martin AWGE_TX_RING_COUNT*sizeof(struct dwc_gmac_dev_dmadesc),
632 1.27 matt BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
633 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_TX_ADDR,
634 1.6 martin sc->sc_txq.t_physaddr);
635 1.1 martin
636 1.1 martin ring->t_queued = 0;
637 1.1 martin ring->t_cur = ring->t_next = 0;
638 1.1 martin }
639 1.1 martin
640 1.1 martin static void
641 1.1 martin dwc_gmac_free_tx_ring(struct dwc_gmac_softc *sc,
642 1.1 martin struct dwc_gmac_tx_ring *ring)
643 1.1 martin {
644 1.1 martin int i;
645 1.1 martin
646 1.1 martin /* unload the maps */
647 1.1 martin for (i = 0; i < AWGE_TX_RING_COUNT; i++) {
648 1.1 martin struct dwc_gmac_tx_data *data = &ring->t_data[i];
649 1.1 martin
650 1.1 martin if (data->td_m != NULL) {
651 1.1 martin bus_dmamap_sync(sc->sc_dmat, data->td_active,
652 1.1 martin 0, data->td_map->dm_mapsize,
653 1.1 martin BUS_DMASYNC_POSTWRITE);
654 1.1 martin bus_dmamap_unload(sc->sc_dmat, data->td_active);
655 1.1 martin m_freem(data->td_m);
656 1.1 martin data->td_m = NULL;
657 1.1 martin }
658 1.1 martin }
659 1.1 martin
660 1.1 martin /* and actually free them */
661 1.1 martin for (i = 0; i < AWGE_TX_RING_COUNT; i++) {
662 1.1 martin struct dwc_gmac_tx_data *data = &ring->t_data[i];
663 1.1 martin
664 1.1 martin bus_dmamap_destroy(sc->sc_dmat, data->td_map);
665 1.1 martin }
666 1.1 martin }
667 1.1 martin
668 1.1 martin static void
669 1.1 martin dwc_gmac_miibus_statchg(struct ifnet *ifp)
670 1.1 martin {
671 1.1 martin struct dwc_gmac_softc * const sc = ifp->if_softc;
672 1.1 martin struct mii_data * const mii = &sc->sc_mii;
673 1.25 jmcneill uint32_t conf, flow;
674 1.1 martin
675 1.1 martin /*
676 1.1 martin * Set MII or GMII interface based on the speed
677 1.1 martin * negotiated by the PHY.
678 1.9 martin */
679 1.9 martin conf = bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_CONF);
680 1.9 martin conf &= ~(AWIN_GMAC_MAC_CONF_FES100|AWIN_GMAC_MAC_CONF_MIISEL
681 1.9 martin |AWIN_GMAC_MAC_CONF_FULLDPLX);
682 1.11 martin conf |= AWIN_GMAC_MAC_CONF_FRAMEBURST
683 1.11 martin | AWIN_GMAC_MAC_CONF_DISABLERXOWN
684 1.25 jmcneill | AWIN_GMAC_MAC_CONF_DISABLEJABBER
685 1.25 jmcneill | AWIN_GMAC_MAC_CONF_ACS
686 1.11 martin | AWIN_GMAC_MAC_CONF_RXENABLE
687 1.11 martin | AWIN_GMAC_MAC_CONF_TXENABLE;
688 1.1 martin switch (IFM_SUBTYPE(mii->mii_media_active)) {
689 1.1 martin case IFM_10_T:
690 1.12 jmcneill conf |= AWIN_GMAC_MAC_CONF_MIISEL;
691 1.9 martin break;
692 1.1 martin case IFM_100_TX:
693 1.12 jmcneill conf |= AWIN_GMAC_MAC_CONF_FES100 |
694 1.12 jmcneill AWIN_GMAC_MAC_CONF_MIISEL;
695 1.1 martin break;
696 1.1 martin case IFM_1000_T:
697 1.1 martin break;
698 1.1 martin }
699 1.25 jmcneill
700 1.25 jmcneill flow = 0;
701 1.25 jmcneill if (IFM_OPTIONS(mii->mii_media_active) & IFM_FDX) {
702 1.9 martin conf |= AWIN_GMAC_MAC_CONF_FULLDPLX;
703 1.25 jmcneill flow |= __SHIFTIN(0x200, AWIN_GMAC_MAC_FLOWCTRL_PAUSE);
704 1.25 jmcneill }
705 1.25 jmcneill if (mii->mii_media_active & IFM_ETH_TXPAUSE) {
706 1.25 jmcneill flow |= AWIN_GMAC_MAC_FLOWCTRL_TFE;
707 1.25 jmcneill }
708 1.25 jmcneill if (mii->mii_media_active & IFM_ETH_RXPAUSE) {
709 1.25 jmcneill flow |= AWIN_GMAC_MAC_FLOWCTRL_RFE;
710 1.25 jmcneill }
711 1.25 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh,
712 1.25 jmcneill AWIN_GMAC_MAC_FLOWCTRL, flow);
713 1.9 martin
714 1.9 martin #ifdef DWC_GMAC_DEBUG
715 1.9 martin aprint_normal_dev(sc->sc_dev,
716 1.9 martin "setting MAC conf register: %08x\n", conf);
717 1.9 martin #endif
718 1.9 martin
719 1.9 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
720 1.9 martin AWIN_GMAC_MAC_CONF, conf);
721 1.1 martin }
722 1.1 martin
723 1.1 martin static int
724 1.1 martin dwc_gmac_init(struct ifnet *ifp)
725 1.1 martin {
726 1.1 martin struct dwc_gmac_softc *sc = ifp->if_softc;
727 1.13 jmcneill uint32_t ffilt;
728 1.1 martin
729 1.1 martin if (ifp->if_flags & IFF_RUNNING)
730 1.1 martin return 0;
731 1.1 martin
732 1.1 martin dwc_gmac_stop(ifp, 0);
733 1.1 martin
734 1.1 martin /*
735 1.11 martin * Configure DMA burst/transfer mode and RX/TX priorities.
736 1.11 martin * XXX - the GMAC_BUSMODE_PRIORXTX bits are undocumented.
737 1.11 martin */
738 1.11 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_BUSMODE,
739 1.25 jmcneill GMAC_BUSMODE_FIXEDBURST | GMAC_BUSMODE_4PBL |
740 1.25 jmcneill __SHIFTIN(2, GMAC_BUSMODE_RPBL) |
741 1.25 jmcneill __SHIFTIN(2, GMAC_BUSMODE_PBL));
742 1.11 martin
743 1.11 martin /*
744 1.13 jmcneill * Set up address filter
745 1.11 martin */
746 1.20 jmcneill ffilt = bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT);
747 1.20 jmcneill if (ifp->if_flags & IFF_PROMISC) {
748 1.13 jmcneill ffilt |= AWIN_GMAC_MAC_FFILT_PR;
749 1.20 jmcneill } else {
750 1.20 jmcneill ffilt &= ~AWIN_GMAC_MAC_FFILT_PR;
751 1.20 jmcneill }
752 1.20 jmcneill if (ifp->if_flags & IFF_BROADCAST) {
753 1.20 jmcneill ffilt &= ~AWIN_GMAC_MAC_FFILT_DBF;
754 1.20 jmcneill } else {
755 1.20 jmcneill ffilt |= AWIN_GMAC_MAC_FFILT_DBF;
756 1.20 jmcneill }
757 1.13 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT, ffilt);
758 1.11 martin
759 1.11 martin /*
760 1.20 jmcneill * Set up multicast filter
761 1.20 jmcneill */
762 1.20 jmcneill dwc_gmac_setmulti(sc);
763 1.20 jmcneill
764 1.20 jmcneill /*
765 1.6 martin * Set up dma pointer for RX and TX ring
766 1.1 martin */
767 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_RX_ADDR,
768 1.6 martin sc->sc_rxq.r_physaddr);
769 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_TX_ADDR,
770 1.6 martin sc->sc_txq.t_physaddr);
771 1.6 martin
772 1.6 martin /*
773 1.10 martin * Start RX/TX part
774 1.6 martin */
775 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
776 1.11 martin AWIN_GMAC_DMA_OPMODE, GMAC_DMA_OP_RXSTART | GMAC_DMA_OP_TXSTART |
777 1.25 jmcneill GMAC_DMA_OP_RXSTOREFORWARD | GMAC_DMA_OP_TXSTOREFORWARD);
778 1.1 martin
779 1.1 martin ifp->if_flags |= IFF_RUNNING;
780 1.1 martin ifp->if_flags &= ~IFF_OACTIVE;
781 1.1 martin
782 1.1 martin return 0;
783 1.1 martin }
784 1.1 martin
785 1.1 martin static void
786 1.1 martin dwc_gmac_start(struct ifnet *ifp)
787 1.1 martin {
788 1.1 martin struct dwc_gmac_softc *sc = ifp->if_softc;
789 1.1 martin int old = sc->sc_txq.t_queued;
790 1.30 martin int start = sc->sc_txq.t_cur;
791 1.1 martin struct mbuf *m0;
792 1.1 martin
793 1.1 martin if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
794 1.1 martin return;
795 1.1 martin
796 1.1 martin for (;;) {
797 1.1 martin IFQ_POLL(&ifp->if_snd, m0);
798 1.1 martin if (m0 == NULL)
799 1.1 martin break;
800 1.1 martin if (dwc_gmac_queue(sc, m0) != 0) {
801 1.1 martin ifp->if_flags |= IFF_OACTIVE;
802 1.1 martin break;
803 1.1 martin }
804 1.1 martin IFQ_DEQUEUE(&ifp->if_snd, m0);
805 1.1 martin bpf_mtap(ifp, m0);
806 1.32 martin if (sc->sc_txq.t_queued == AWGE_TX_RING_COUNT) {
807 1.32 martin ifp->if_flags |= IFF_OACTIVE;
808 1.32 martin break;
809 1.32 martin }
810 1.1 martin }
811 1.1 martin
812 1.1 martin if (sc->sc_txq.t_queued != old) {
813 1.1 martin /* packets have been queued, kick it off */
814 1.30 martin dwc_gmac_txdesc_sync(sc, start, sc->sc_txq.t_cur,
815 1.1 martin BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
816 1.10 martin
817 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
818 1.10 martin AWIN_GMAC_DMA_TXPOLL, ~0U);
819 1.10 martin #ifdef DWC_GMAC_DEBUG
820 1.10 martin dwc_dump_status(sc);
821 1.10 martin #endif
822 1.1 martin }
823 1.1 martin }
824 1.1 martin
825 1.1 martin static void
826 1.1 martin dwc_gmac_stop(struct ifnet *ifp, int disable)
827 1.1 martin {
828 1.1 martin struct dwc_gmac_softc *sc = ifp->if_softc;
829 1.1 martin
830 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
831 1.6 martin AWIN_GMAC_DMA_OPMODE,
832 1.6 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh,
833 1.6 martin AWIN_GMAC_DMA_OPMODE)
834 1.6 martin & ~(GMAC_DMA_OP_TXSTART|GMAC_DMA_OP_RXSTART));
835 1.6 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
836 1.6 martin AWIN_GMAC_DMA_OPMODE,
837 1.6 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh,
838 1.6 martin AWIN_GMAC_DMA_OPMODE) | GMAC_DMA_OP_FLUSHTX);
839 1.6 martin
840 1.1 martin mii_down(&sc->sc_mii);
841 1.1 martin dwc_gmac_reset_tx_ring(sc, &sc->sc_txq);
842 1.1 martin dwc_gmac_reset_rx_ring(sc, &sc->sc_rxq);
843 1.1 martin }
844 1.1 martin
845 1.1 martin /*
846 1.1 martin * Add m0 to the TX ring
847 1.1 martin */
848 1.1 martin static int
849 1.1 martin dwc_gmac_queue(struct dwc_gmac_softc *sc, struct mbuf *m0)
850 1.1 martin {
851 1.1 martin struct dwc_gmac_dev_dmadesc *desc = NULL;
852 1.1 martin struct dwc_gmac_tx_data *data = NULL;
853 1.1 martin bus_dmamap_t map;
854 1.32 martin uint32_t flags, len, status;
855 1.1 martin int error, i, first;
856 1.1 martin
857 1.8 martin #ifdef DWC_GMAC_DEBUG
858 1.8 martin aprint_normal_dev(sc->sc_dev,
859 1.8 martin "dwc_gmac_queue: adding mbuf chain %p\n", m0);
860 1.8 martin #endif
861 1.8 martin
862 1.1 martin first = sc->sc_txq.t_cur;
863 1.1 martin map = sc->sc_txq.t_data[first].td_map;
864 1.1 martin
865 1.1 martin error = bus_dmamap_load_mbuf(sc->sc_dmat, map, m0,
866 1.1 martin BUS_DMA_WRITE|BUS_DMA_NOWAIT);
867 1.1 martin if (error != 0) {
868 1.1 martin aprint_error_dev(sc->sc_dev, "could not map mbuf "
869 1.1 martin "(len: %d, error %d)\n", m0->m_pkthdr.len, error);
870 1.1 martin return error;
871 1.1 martin }
872 1.1 martin
873 1.32 martin if (sc->sc_txq.t_queued + map->dm_nsegs > AWGE_TX_RING_COUNT) {
874 1.1 martin bus_dmamap_unload(sc->sc_dmat, map);
875 1.1 martin return ENOBUFS;
876 1.1 martin }
877 1.1 martin
878 1.8 martin flags = DDESC_CNTL_TXFIRST|DDESC_CNTL_TXCHAIN;
879 1.32 martin status = 0;
880 1.1 martin for (i = 0; i < map->dm_nsegs; i++) {
881 1.1 martin data = &sc->sc_txq.t_data[sc->sc_txq.t_cur];
882 1.8 martin desc = &sc->sc_txq.t_desc[sc->sc_txq.t_cur];
883 1.8 martin
884 1.8 martin desc->ddesc_data = htole32(map->dm_segs[i].ds_addr);
885 1.32 martin len = __SHIFTIN(map->dm_segs[i].ds_len, DDESC_CNTL_SIZE1MASK);
886 1.7 martin
887 1.7 martin #ifdef DWC_GMAC_DEBUG
888 1.7 martin aprint_normal_dev(sc->sc_dev, "enqueing desc #%d data %08lx "
889 1.8 martin "len %lu (flags: %08x, len: %08x)\n", sc->sc_txq.t_cur,
890 1.7 martin (unsigned long)map->dm_segs[i].ds_addr,
891 1.8 martin (unsigned long)map->dm_segs[i].ds_len,
892 1.8 martin flags, len);
893 1.7 martin #endif
894 1.7 martin
895 1.6 martin desc->ddesc_cntl = htole32(len|flags);
896 1.6 martin flags &= ~DDESC_CNTL_TXFIRST;
897 1.1 martin
898 1.1 martin /*
899 1.1 martin * Defer passing ownership of the first descriptor
900 1.23 joerg * until we are done.
901 1.1 martin */
902 1.32 martin desc->ddesc_status = htole32(status);
903 1.32 martin status |= DDESC_STATUS_OWNEDBYDEV;
904 1.8 martin
905 1.6 martin sc->sc_txq.t_queued++;
906 1.8 martin sc->sc_txq.t_cur = TX_NEXT(sc->sc_txq.t_cur);
907 1.1 martin }
908 1.1 martin
909 1.32 martin desc->ddesc_cntl |= htole32(DDESC_CNTL_TXLAST|DDESC_CNTL_TXINT);
910 1.1 martin
911 1.1 martin data->td_m = m0;
912 1.1 martin data->td_active = map;
913 1.1 martin
914 1.1 martin bus_dmamap_sync(sc->sc_dmat, map, 0, map->dm_mapsize,
915 1.27 matt BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
916 1.1 martin
917 1.32 martin /* Pass first to device */
918 1.32 martin sc->sc_txq.t_desc[first].ddesc_status =
919 1.32 martin htole32(DDESC_STATUS_OWNEDBYDEV);
920 1.32 martin
921 1.1 martin return 0;
922 1.1 martin }
923 1.1 martin
924 1.22 martin /*
925 1.22 martin * If the interface is up and running, only modify the receive
926 1.22 martin * filter when setting promiscuous or debug mode. Otherwise fall
927 1.22 martin * through to ether_ioctl, which will reset the chip.
928 1.22 martin */
929 1.22 martin static int
930 1.22 martin dwc_gmac_ifflags_cb(struct ethercom *ec)
931 1.22 martin {
932 1.22 martin struct ifnet *ifp = &ec->ec_if;
933 1.22 martin struct dwc_gmac_softc *sc = ifp->if_softc;
934 1.22 martin int change = ifp->if_flags ^ sc->sc_if_flags;
935 1.22 martin
936 1.22 martin if ((change & ~(IFF_CANTCHANGE|IFF_DEBUG)) != 0)
937 1.22 martin return ENETRESET;
938 1.22 martin if ((change & IFF_PROMISC) != 0)
939 1.22 martin dwc_gmac_setmulti(sc);
940 1.22 martin return 0;
941 1.22 martin }
942 1.22 martin
943 1.1 martin static int
944 1.1 martin dwc_gmac_ioctl(struct ifnet *ifp, u_long cmd, void *data)
945 1.1 martin {
946 1.20 jmcneill struct dwc_gmac_softc *sc = ifp->if_softc;
947 1.1 martin int s, error = 0;
948 1.1 martin
949 1.1 martin s = splnet();
950 1.1 martin
951 1.22 martin if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
952 1.1 martin error = 0;
953 1.1 martin if (cmd != SIOCADDMULTI && cmd != SIOCDELMULTI)
954 1.1 martin ;
955 1.22 martin else if (ifp->if_flags & IFF_RUNNING) {
956 1.22 martin /*
957 1.22 martin * Multicast list has changed; set the hardware filter
958 1.22 martin * accordingly.
959 1.22 martin */
960 1.20 jmcneill dwc_gmac_setmulti(sc);
961 1.22 martin }
962 1.1 martin }
963 1.1 martin
964 1.22 martin /* Try to get things going again */
965 1.22 martin if (ifp->if_flags & IFF_UP)
966 1.22 martin dwc_gmac_start(ifp);
967 1.22 martin sc->sc_if_flags = sc->sc_ec.ec_if.if_flags;
968 1.1 martin splx(s);
969 1.1 martin return error;
970 1.1 martin }
971 1.1 martin
972 1.8 martin static void
973 1.8 martin dwc_gmac_tx_intr(struct dwc_gmac_softc *sc)
974 1.8 martin {
975 1.32 martin struct ifnet *ifp = &sc->sc_ec.ec_if;
976 1.8 martin struct dwc_gmac_tx_data *data;
977 1.8 martin struct dwc_gmac_dev_dmadesc *desc;
978 1.32 martin uint32_t status;
979 1.32 martin int i, nsegs;
980 1.8 martin
981 1.32 martin for (i = sc->sc_txq.t_next; sc->sc_txq.t_queued > 0; i = TX_NEXT(i)) {
982 1.8 martin #ifdef DWC_GMAC_DEBUG
983 1.8 martin aprint_normal_dev(sc->sc_dev,
984 1.8 martin "dwc_gmac_tx_intr: checking desc #%d (t_queued: %d)\n",
985 1.8 martin i, sc->sc_txq.t_queued);
986 1.8 martin #endif
987 1.8 martin
988 1.26 martin /*
989 1.26 martin * i+1 does not need to be a valid descriptor,
990 1.26 martin * this is just a special notion to just sync
991 1.26 martin * a single tx descriptor (i)
992 1.26 martin */
993 1.26 martin dwc_gmac_txdesc_sync(sc, i, i+1,
994 1.8 martin BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
995 1.11 martin
996 1.32 martin desc = &sc->sc_txq.t_desc[i];
997 1.32 martin status = le32toh(desc->ddesc_status);
998 1.32 martin if (status & DDESC_STATUS_OWNEDBYDEV)
999 1.8 martin break;
1000 1.11 martin
1001 1.8 martin data = &sc->sc_txq.t_data[i];
1002 1.8 martin if (data->td_m == NULL)
1003 1.8 martin continue;
1004 1.32 martin
1005 1.32 martin ifp->if_opackets++;
1006 1.32 martin nsegs = data->td_active->dm_nsegs;
1007 1.8 martin bus_dmamap_sync(sc->sc_dmat, data->td_active, 0,
1008 1.8 martin data->td_active->dm_mapsize, BUS_DMASYNC_POSTWRITE);
1009 1.8 martin bus_dmamap_unload(sc->sc_dmat, data->td_active);
1010 1.8 martin
1011 1.8 martin #ifdef DWC_GMAC_DEBUG
1012 1.8 martin aprint_normal_dev(sc->sc_dev,
1013 1.8 martin "dwc_gmac_tx_intr: done with packet at desc #%d, "
1014 1.8 martin "freeing mbuf %p\n", i, data->td_m);
1015 1.8 martin #endif
1016 1.8 martin
1017 1.8 martin m_freem(data->td_m);
1018 1.8 martin data->td_m = NULL;
1019 1.32 martin
1020 1.32 martin sc->sc_txq.t_queued -= nsegs;
1021 1.8 martin }
1022 1.8 martin
1023 1.8 martin sc->sc_txq.t_next = i;
1024 1.8 martin
1025 1.8 martin if (sc->sc_txq.t_queued < AWGE_TX_RING_COUNT) {
1026 1.32 martin ifp->if_flags &= ~IFF_OACTIVE;
1027 1.8 martin }
1028 1.8 martin }
1029 1.8 martin
1030 1.8 martin static void
1031 1.8 martin dwc_gmac_rx_intr(struct dwc_gmac_softc *sc)
1032 1.8 martin {
1033 1.11 martin struct ifnet *ifp = &sc->sc_ec.ec_if;
1034 1.11 martin struct dwc_gmac_dev_dmadesc *desc;
1035 1.11 martin struct dwc_gmac_rx_data *data;
1036 1.11 martin bus_addr_t physaddr;
1037 1.11 martin uint32_t status;
1038 1.11 martin struct mbuf *m, *mnew;
1039 1.11 martin int i, len, error;
1040 1.11 martin
1041 1.11 martin for (i = sc->sc_rxq.r_cur; ; i = RX_NEXT(i)) {
1042 1.11 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
1043 1.11 martin RX_DESC_OFFSET(i), sizeof(*desc),
1044 1.11 martin BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1045 1.11 martin desc = &sc->sc_rxq.r_desc[i];
1046 1.11 martin data = &sc->sc_rxq.r_data[i];
1047 1.11 martin
1048 1.11 martin status = le32toh(desc->ddesc_status);
1049 1.15 martin if (status & DDESC_STATUS_OWNEDBYDEV)
1050 1.11 martin break;
1051 1.11 martin
1052 1.11 martin if (status & (DDESC_STATUS_RXERROR|DDESC_STATUS_RXTRUNCATED)) {
1053 1.11 martin #ifdef DWC_GMAC_DEBUG
1054 1.15 martin aprint_normal_dev(sc->sc_dev,
1055 1.15 martin "RX error: descriptor status %08x, skipping\n",
1056 1.15 martin status);
1057 1.11 martin #endif
1058 1.11 martin ifp->if_ierrors++;
1059 1.11 martin goto skip;
1060 1.11 martin }
1061 1.11 martin
1062 1.11 martin len = __SHIFTOUT(status, DDESC_STATUS_FRMLENMSK);
1063 1.11 martin
1064 1.11 martin #ifdef DWC_GMAC_DEBUG
1065 1.15 martin aprint_normal_dev(sc->sc_dev,
1066 1.15 martin "rx int: device is done with descriptor #%d, len: %d\n",
1067 1.15 martin i, len);
1068 1.11 martin #endif
1069 1.11 martin
1070 1.11 martin /*
1071 1.11 martin * Try to get a new mbuf before passing this one
1072 1.11 martin * up, if that fails, drop the packet and reuse
1073 1.11 martin * the existing one.
1074 1.11 martin */
1075 1.11 martin MGETHDR(mnew, M_DONTWAIT, MT_DATA);
1076 1.11 martin if (mnew == NULL) {
1077 1.11 martin ifp->if_ierrors++;
1078 1.11 martin goto skip;
1079 1.11 martin }
1080 1.11 martin MCLGET(mnew, M_DONTWAIT);
1081 1.11 martin if ((mnew->m_flags & M_EXT) == 0) {
1082 1.11 martin m_freem(mnew);
1083 1.11 martin ifp->if_ierrors++;
1084 1.11 martin goto skip;
1085 1.11 martin }
1086 1.11 martin
1087 1.11 martin /* unload old DMA map */
1088 1.11 martin bus_dmamap_sync(sc->sc_dmat, data->rd_map, 0,
1089 1.11 martin data->rd_map->dm_mapsize, BUS_DMASYNC_POSTREAD);
1090 1.11 martin bus_dmamap_unload(sc->sc_dmat, data->rd_map);
1091 1.11 martin
1092 1.11 martin /* and reload with new mbuf */
1093 1.11 martin error = bus_dmamap_load(sc->sc_dmat, data->rd_map,
1094 1.11 martin mtod(mnew, void*), MCLBYTES, NULL,
1095 1.11 martin BUS_DMA_READ | BUS_DMA_NOWAIT);
1096 1.11 martin if (error != 0) {
1097 1.11 martin m_freem(mnew);
1098 1.11 martin /* try to reload old mbuf */
1099 1.11 martin error = bus_dmamap_load(sc->sc_dmat, data->rd_map,
1100 1.11 martin mtod(data->rd_m, void*), MCLBYTES, NULL,
1101 1.11 martin BUS_DMA_READ | BUS_DMA_NOWAIT);
1102 1.11 martin if (error != 0) {
1103 1.11 martin panic("%s: could not load old rx mbuf",
1104 1.11 martin device_xname(sc->sc_dev));
1105 1.11 martin }
1106 1.11 martin ifp->if_ierrors++;
1107 1.11 martin goto skip;
1108 1.11 martin }
1109 1.11 martin physaddr = data->rd_map->dm_segs[0].ds_addr;
1110 1.11 martin
1111 1.11 martin /*
1112 1.11 martin * New mbuf loaded, update RX ring and continue
1113 1.11 martin */
1114 1.11 martin m = data->rd_m;
1115 1.11 martin data->rd_m = mnew;
1116 1.11 martin desc->ddesc_data = htole32(physaddr);
1117 1.11 martin
1118 1.11 martin /* finalize mbuf */
1119 1.11 martin m->m_pkthdr.len = m->m_len = len;
1120 1.11 martin m->m_pkthdr.rcvif = ifp;
1121 1.19 matt m->m_flags |= M_HASFCS;
1122 1.11 martin
1123 1.11 martin bpf_mtap(ifp, m);
1124 1.11 martin ifp->if_ipackets++;
1125 1.11 martin (*ifp->if_input)(ifp, m);
1126 1.11 martin
1127 1.11 martin skip:
1128 1.27 matt bus_dmamap_sync(sc->sc_dmat, data->rd_map, 0,
1129 1.27 matt data->rd_map->dm_mapsize, BUS_DMASYNC_PREREAD);
1130 1.11 martin desc->ddesc_cntl = htole32(
1131 1.16 martin __SHIFTIN(AWGE_MAX_PACKET,DDESC_CNTL_SIZE1MASK) |
1132 1.16 martin DDESC_CNTL_RXCHAIN);
1133 1.11 martin desc->ddesc_status = htole32(DDESC_STATUS_OWNEDBYDEV);
1134 1.11 martin bus_dmamap_sync(sc->sc_dmat, sc->sc_dma_ring_map,
1135 1.11 martin RX_DESC_OFFSET(i), sizeof(*desc),
1136 1.11 martin BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1137 1.11 martin }
1138 1.11 martin
1139 1.11 martin /* update RX pointer */
1140 1.11 martin sc->sc_rxq.r_cur = i;
1141 1.11 martin
1142 1.8 martin }
1143 1.8 martin
1144 1.22 martin /*
1145 1.24 skrll * Reverse order of bits - http://aggregate.org/MAGIC/#Bit%20Reversal
1146 1.22 martin */
1147 1.22 martin static uint32_t
1148 1.22 martin bitrev32(uint32_t x)
1149 1.22 martin {
1150 1.22 martin x = (((x & 0xaaaaaaaa) >> 1) | ((x & 0x55555555) << 1));
1151 1.22 martin x = (((x & 0xcccccccc) >> 2) | ((x & 0x33333333) << 2));
1152 1.22 martin x = (((x & 0xf0f0f0f0) >> 4) | ((x & 0x0f0f0f0f) << 4));
1153 1.22 martin x = (((x & 0xff00ff00) >> 8) | ((x & 0x00ff00ff) << 8));
1154 1.22 martin
1155 1.22 martin return (x >> 16) | (x << 16);
1156 1.22 martin }
1157 1.22 martin
1158 1.20 jmcneill static void
1159 1.20 jmcneill dwc_gmac_setmulti(struct dwc_gmac_softc *sc)
1160 1.20 jmcneill {
1161 1.20 jmcneill struct ifnet * const ifp = &sc->sc_ec.ec_if;
1162 1.20 jmcneill struct ether_multi *enm;
1163 1.20 jmcneill struct ether_multistep step;
1164 1.20 jmcneill uint32_t hashes[2] = { 0, 0 };
1165 1.22 martin uint32_t ffilt, h;
1166 1.22 martin int mcnt, s;
1167 1.22 martin
1168 1.22 martin s = splnet();
1169 1.20 jmcneill
1170 1.20 jmcneill ffilt = bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT);
1171 1.20 jmcneill
1172 1.20 jmcneill if (ifp->if_flags & IFF_PROMISC) {
1173 1.22 martin ffilt |= AWIN_GMAC_MAC_FFILT_PR;
1174 1.22 martin goto special_filter;
1175 1.20 jmcneill }
1176 1.20 jmcneill
1177 1.20 jmcneill ifp->if_flags &= ~IFF_ALLMULTI;
1178 1.22 martin ffilt &= ~(AWIN_GMAC_MAC_FFILT_PM|AWIN_GMAC_MAC_FFILT_PR);
1179 1.20 jmcneill
1180 1.20 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTLOW, 0);
1181 1.20 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTHIGH, 0);
1182 1.20 jmcneill
1183 1.20 jmcneill ETHER_FIRST_MULTI(step, &sc->sc_ec, enm);
1184 1.20 jmcneill mcnt = 0;
1185 1.20 jmcneill while (enm != NULL) {
1186 1.20 jmcneill if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
1187 1.22 martin ETHER_ADDR_LEN) != 0) {
1188 1.22 martin ffilt |= AWIN_GMAC_MAC_FFILT_PM;
1189 1.22 martin ifp->if_flags |= IFF_ALLMULTI;
1190 1.22 martin goto special_filter;
1191 1.22 martin }
1192 1.20 jmcneill
1193 1.22 martin h = bitrev32(
1194 1.22 martin ~ether_crc32_le(enm->enm_addrlo, ETHER_ADDR_LEN)
1195 1.22 martin ) >> 26;
1196 1.20 jmcneill hashes[h >> 5] |= (1 << (h & 0x1f));
1197 1.20 jmcneill
1198 1.20 jmcneill mcnt++;
1199 1.20 jmcneill ETHER_NEXT_MULTI(step, enm);
1200 1.20 jmcneill }
1201 1.20 jmcneill
1202 1.20 jmcneill if (mcnt)
1203 1.20 jmcneill ffilt |= AWIN_GMAC_MAC_FFILT_HMC;
1204 1.20 jmcneill else
1205 1.20 jmcneill ffilt &= ~AWIN_GMAC_MAC_FFILT_HMC;
1206 1.20 jmcneill
1207 1.20 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT, ffilt);
1208 1.20 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTLOW,
1209 1.20 jmcneill hashes[0]);
1210 1.20 jmcneill bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTHIGH,
1211 1.20 jmcneill hashes[1]);
1212 1.22 martin sc->sc_if_flags = sc->sc_ec.ec_if.if_flags;
1213 1.22 martin
1214 1.22 martin splx(s);
1215 1.22 martin
1216 1.22 martin #ifdef DWC_GMAC_DEBUG
1217 1.22 martin dwc_gmac_dump_ffilt(sc, ffilt);
1218 1.22 martin #endif
1219 1.22 martin return;
1220 1.22 martin
1221 1.22 martin special_filter:
1222 1.22 martin #ifdef DWC_GMAC_DEBUG
1223 1.22 martin dwc_gmac_dump_ffilt(sc, ffilt);
1224 1.22 martin #endif
1225 1.22 martin /* no MAC hashes, ALLMULTI or PROMISC */
1226 1.22 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT,
1227 1.22 martin ffilt);
1228 1.22 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTLOW,
1229 1.22 martin 0xffffffff);
1230 1.22 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_HTHIGH,
1231 1.22 martin 0xffffffff);
1232 1.22 martin sc->sc_if_flags = sc->sc_ec.ec_if.if_flags;
1233 1.22 martin splx(s);
1234 1.20 jmcneill }
1235 1.20 jmcneill
1236 1.1 martin int
1237 1.1 martin dwc_gmac_intr(struct dwc_gmac_softc *sc)
1238 1.1 martin {
1239 1.1 martin uint32_t status, dma_status;
1240 1.8 martin int rv = 0;
1241 1.1 martin
1242 1.1 martin status = bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_INTR);
1243 1.2 martin if (status & AWIN_GMAC_MII_IRQ) {
1244 1.1 martin (void)bus_space_read_4(sc->sc_bst, sc->sc_bsh,
1245 1.1 martin AWIN_GMAC_MII_STATUS);
1246 1.8 martin rv = 1;
1247 1.2 martin mii_pollstat(&sc->sc_mii);
1248 1.2 martin }
1249 1.1 martin
1250 1.1 martin dma_status = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
1251 1.1 martin AWIN_GMAC_DMA_STATUS);
1252 1.1 martin
1253 1.8 martin if (dma_status & (GMAC_DMA_INT_NIE|GMAC_DMA_INT_AIE))
1254 1.8 martin rv = 1;
1255 1.1 martin
1256 1.8 martin if (dma_status & GMAC_DMA_INT_TIE)
1257 1.8 martin dwc_gmac_tx_intr(sc);
1258 1.1 martin
1259 1.8 martin if (dma_status & GMAC_DMA_INT_RIE)
1260 1.8 martin dwc_gmac_rx_intr(sc);
1261 1.8 martin
1262 1.8 martin /*
1263 1.8 martin * Check error conditions
1264 1.8 martin */
1265 1.8 martin if (dma_status & GMAC_DMA_INT_ERRORS) {
1266 1.8 martin sc->sc_ec.ec_if.if_oerrors++;
1267 1.8 martin #ifdef DWC_GMAC_DEBUG
1268 1.8 martin dwc_dump_and_abort(sc, "interrupt error condition");
1269 1.8 martin #endif
1270 1.8 martin }
1271 1.8 martin
1272 1.8 martin /* ack interrupt */
1273 1.8 martin if (dma_status)
1274 1.8 martin bus_space_write_4(sc->sc_bst, sc->sc_bsh,
1275 1.8 martin AWIN_GMAC_DMA_STATUS, dma_status & GMAC_DMA_INT_MASK);
1276 1.8 martin
1277 1.28 martin /*
1278 1.28 martin * Get more packets
1279 1.28 martin */
1280 1.28 martin if (rv)
1281 1.28 martin sc->sc_ec.ec_if.if_start(&sc->sc_ec.ec_if);
1282 1.28 martin
1283 1.8 martin return rv;
1284 1.1 martin }
1285 1.7 martin
1286 1.7 martin #ifdef DWC_GMAC_DEBUG
1287 1.7 martin static void
1288 1.7 martin dwc_gmac_dump_dma(struct dwc_gmac_softc *sc)
1289 1.7 martin {
1290 1.7 martin aprint_normal_dev(sc->sc_dev, "busmode: %08x\n",
1291 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_BUSMODE));
1292 1.7 martin aprint_normal_dev(sc->sc_dev, "tx poll: %08x\n",
1293 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_TXPOLL));
1294 1.7 martin aprint_normal_dev(sc->sc_dev, "rx poll: %08x\n",
1295 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_RXPOLL));
1296 1.7 martin aprint_normal_dev(sc->sc_dev, "rx descriptors: %08x\n",
1297 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_RX_ADDR));
1298 1.7 martin aprint_normal_dev(sc->sc_dev, "tx descriptors: %08x\n",
1299 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_TX_ADDR));
1300 1.7 martin aprint_normal_dev(sc->sc_dev, "status: %08x\n",
1301 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_STATUS));
1302 1.7 martin aprint_normal_dev(sc->sc_dev, "op mode: %08x\n",
1303 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_OPMODE));
1304 1.7 martin aprint_normal_dev(sc->sc_dev, "int enable: %08x\n",
1305 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_INTENABLE));
1306 1.7 martin aprint_normal_dev(sc->sc_dev, "cur tx: %08x\n",
1307 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_CUR_TX_DESC));
1308 1.7 martin aprint_normal_dev(sc->sc_dev, "cur rx: %08x\n",
1309 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_CUR_RX_DESC));
1310 1.7 martin aprint_normal_dev(sc->sc_dev, "cur tx buffer: %08x\n",
1311 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_CUR_TX_BUFADDR));
1312 1.7 martin aprint_normal_dev(sc->sc_dev, "cur rx buffer: %08x\n",
1313 1.7 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_DMA_CUR_RX_BUFADDR));
1314 1.7 martin }
1315 1.7 martin
1316 1.7 martin static void
1317 1.7 martin dwc_gmac_dump_tx_desc(struct dwc_gmac_softc *sc)
1318 1.7 martin {
1319 1.7 martin int i;
1320 1.7 martin
1321 1.8 martin aprint_normal_dev(sc->sc_dev, "TX queue: cur=%d, next=%d, queued=%d\n",
1322 1.8 martin sc->sc_txq.t_cur, sc->sc_txq.t_next, sc->sc_txq.t_queued);
1323 1.8 martin aprint_normal_dev(sc->sc_dev, "TX DMA descriptors:\n");
1324 1.7 martin for (i = 0; i < AWGE_TX_RING_COUNT; i++) {
1325 1.7 martin struct dwc_gmac_dev_dmadesc *desc = &sc->sc_txq.t_desc[i];
1326 1.15 martin aprint_normal("#%d (%08lx): status: %08x cntl: %08x "
1327 1.15 martin "data: %08x next: %08x\n",
1328 1.15 martin i, sc->sc_txq.t_physaddr +
1329 1.15 martin i*sizeof(struct dwc_gmac_dev_dmadesc),
1330 1.7 martin le32toh(desc->ddesc_status), le32toh(desc->ddesc_cntl),
1331 1.7 martin le32toh(desc->ddesc_data), le32toh(desc->ddesc_next));
1332 1.7 martin }
1333 1.7 martin }
1334 1.8 martin
1335 1.8 martin static void
1336 1.11 martin dwc_gmac_dump_rx_desc(struct dwc_gmac_softc *sc)
1337 1.11 martin {
1338 1.11 martin int i;
1339 1.11 martin
1340 1.11 martin aprint_normal_dev(sc->sc_dev, "RX queue: cur=%d, next=%d\n",
1341 1.11 martin sc->sc_rxq.r_cur, sc->sc_rxq.r_next);
1342 1.11 martin aprint_normal_dev(sc->sc_dev, "RX DMA descriptors:\n");
1343 1.11 martin for (i = 0; i < AWGE_RX_RING_COUNT; i++) {
1344 1.11 martin struct dwc_gmac_dev_dmadesc *desc = &sc->sc_rxq.r_desc[i];
1345 1.15 martin aprint_normal("#%d (%08lx): status: %08x cntl: %08x "
1346 1.15 martin "data: %08x next: %08x\n",
1347 1.15 martin i, sc->sc_rxq.r_physaddr +
1348 1.15 martin i*sizeof(struct dwc_gmac_dev_dmadesc),
1349 1.11 martin le32toh(desc->ddesc_status), le32toh(desc->ddesc_cntl),
1350 1.11 martin le32toh(desc->ddesc_data), le32toh(desc->ddesc_next));
1351 1.11 martin }
1352 1.11 martin }
1353 1.11 martin
1354 1.11 martin static void
1355 1.10 martin dwc_dump_status(struct dwc_gmac_softc *sc)
1356 1.8 martin {
1357 1.8 martin uint32_t status = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
1358 1.8 martin AWIN_GMAC_MAC_INTR);
1359 1.8 martin uint32_t dma_status = bus_space_read_4(sc->sc_bst, sc->sc_bsh,
1360 1.8 martin AWIN_GMAC_DMA_STATUS);
1361 1.8 martin char buf[200];
1362 1.8 martin
1363 1.8 martin /* print interrupt state */
1364 1.8 martin snprintb(buf, sizeof(buf), "\177\20"
1365 1.10 martin "b\x10""NI\0"
1366 1.10 martin "b\x0f""AI\0"
1367 1.10 martin "b\x0e""ER\0"
1368 1.10 martin "b\x0d""FB\0"
1369 1.10 martin "b\x0a""ET\0"
1370 1.10 martin "b\x09""RW\0"
1371 1.10 martin "b\x08""RS\0"
1372 1.10 martin "b\x07""RU\0"
1373 1.10 martin "b\x06""RI\0"
1374 1.10 martin "b\x05""UN\0"
1375 1.10 martin "b\x04""OV\0"
1376 1.10 martin "b\x03""TJ\0"
1377 1.10 martin "b\x02""TU\0"
1378 1.10 martin "b\x01""TS\0"
1379 1.10 martin "b\x00""TI\0"
1380 1.8 martin "\0", dma_status);
1381 1.10 martin aprint_normal_dev(sc->sc_dev, "INTR status: %08x, DMA status: %s\n",
1382 1.8 martin status, buf);
1383 1.10 martin }
1384 1.8 martin
1385 1.10 martin static void
1386 1.10 martin dwc_dump_and_abort(struct dwc_gmac_softc *sc, const char *msg)
1387 1.10 martin {
1388 1.10 martin dwc_dump_status(sc);
1389 1.22 martin dwc_gmac_dump_ffilt(sc,
1390 1.22 martin bus_space_read_4(sc->sc_bst, sc->sc_bsh, AWIN_GMAC_MAC_FFILT));
1391 1.8 martin dwc_gmac_dump_dma(sc);
1392 1.8 martin dwc_gmac_dump_tx_desc(sc);
1393 1.11 martin dwc_gmac_dump_rx_desc(sc);
1394 1.8 martin
1395 1.21 joerg panic("%s", msg);
1396 1.8 martin }
1397 1.22 martin
1398 1.22 martin static void dwc_gmac_dump_ffilt(struct dwc_gmac_softc *sc, uint32_t ffilt)
1399 1.22 martin {
1400 1.22 martin char buf[200];
1401 1.22 martin
1402 1.22 martin /* print filter setup */
1403 1.22 martin snprintb(buf, sizeof(buf), "\177\20"
1404 1.22 martin "b\x1f""RA\0"
1405 1.22 martin "b\x0a""HPF\0"
1406 1.22 martin "b\x09""SAF\0"
1407 1.22 martin "b\x08""SAIF\0"
1408 1.22 martin "b\x05""DBF\0"
1409 1.22 martin "b\x04""PM\0"
1410 1.22 martin "b\x03""DAIF\0"
1411 1.22 martin "b\x02""HMC\0"
1412 1.22 martin "b\x01""HUC\0"
1413 1.22 martin "b\x00""PR\0"
1414 1.22 martin "\0", ffilt);
1415 1.22 martin aprint_normal_dev(sc->sc_dev, "FFILT: %s\n", buf);
1416 1.22 martin }
1417 1.7 martin #endif
1418