if_sq.c revision 1.28.2.1 1 1.28.2.1 yamt /* $NetBSD: if_sq.c,v 1.28.2.1 2006/12/30 20:46:53 yamt Exp $ */
2 1.1 thorpej
3 1.1 thorpej /*
4 1.1 thorpej * Copyright (c) 2001 Rafal K. Boni
5 1.1 thorpej * Copyright (c) 1998, 1999, 2000 The NetBSD Foundation, Inc.
6 1.1 thorpej * All rights reserved.
7 1.1 thorpej *
8 1.10 simonb * Portions of this code are derived from software contributed to The
9 1.10 simonb * NetBSD Foundation by Jason R. Thorpe of the Numerical Aerospace
10 1.1 thorpej * Simulation Facility, NASA Ames Research Center.
11 1.10 simonb *
12 1.1 thorpej * Redistribution and use in source and binary forms, with or without
13 1.1 thorpej * modification, are permitted provided that the following conditions
14 1.1 thorpej * are met:
15 1.1 thorpej * 1. Redistributions of source code must retain the above copyright
16 1.1 thorpej * notice, this list of conditions and the following disclaimer.
17 1.1 thorpej * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 thorpej * notice, this list of conditions and the following disclaimer in the
19 1.1 thorpej * documentation and/or other materials provided with the distribution.
20 1.1 thorpej * 3. The name of the author may not be used to endorse or promote products
21 1.1 thorpej * derived from this software without specific prior written permission.
22 1.10 simonb *
23 1.1 thorpej * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24 1.1 thorpej * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 thorpej * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 thorpej * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27 1.1 thorpej * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 1.1 thorpej * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 1.1 thorpej * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 1.1 thorpej * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 1.1 thorpej * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32 1.1 thorpej * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 thorpej */
34 1.17 lukem
35 1.17 lukem #include <sys/cdefs.h>
36 1.28.2.1 yamt __KERNEL_RCSID(0, "$NetBSD: if_sq.c,v 1.28.2.1 2006/12/30 20:46:53 yamt Exp $");
37 1.1 thorpej
38 1.1 thorpej #include "bpfilter.h"
39 1.1 thorpej
40 1.1 thorpej #include <sys/param.h>
41 1.10 simonb #include <sys/systm.h>
42 1.1 thorpej #include <sys/device.h>
43 1.1 thorpej #include <sys/callout.h>
44 1.10 simonb #include <sys/mbuf.h>
45 1.1 thorpej #include <sys/malloc.h>
46 1.1 thorpej #include <sys/kernel.h>
47 1.1 thorpej #include <sys/socket.h>
48 1.1 thorpej #include <sys/ioctl.h>
49 1.1 thorpej #include <sys/errno.h>
50 1.1 thorpej #include <sys/syslog.h>
51 1.1 thorpej
52 1.1 thorpej #include <uvm/uvm_extern.h>
53 1.1 thorpej
54 1.1 thorpej #include <machine/endian.h>
55 1.1 thorpej
56 1.1 thorpej #include <net/if.h>
57 1.1 thorpej #include <net/if_dl.h>
58 1.1 thorpej #include <net/if_media.h>
59 1.1 thorpej #include <net/if_ether.h>
60 1.1 thorpej
61 1.10 simonb #if NBPFILTER > 0
62 1.1 thorpej #include <net/bpf.h>
63 1.10 simonb #endif
64 1.1 thorpej
65 1.1 thorpej #include <machine/bus.h>
66 1.1 thorpej #include <machine/intr.h>
67 1.1 thorpej
68 1.1 thorpej #include <dev/ic/seeq8003reg.h>
69 1.1 thorpej
70 1.1 thorpej #include <sgimips/hpc/sqvar.h>
71 1.1 thorpej #include <sgimips/hpc/hpcvar.h>
72 1.1 thorpej #include <sgimips/hpc/hpcreg.h>
73 1.1 thorpej
74 1.5 thorpej #include <dev/arcbios/arcbios.h>
75 1.5 thorpej #include <dev/arcbios/arcbiosvar.h>
76 1.5 thorpej
77 1.1 thorpej #define static
78 1.1 thorpej
79 1.1 thorpej /*
80 1.1 thorpej * Short TODO list:
81 1.1 thorpej * (1) Do counters for bad-RX packets.
82 1.9 rafal * (2) Allow multi-segment transmits, instead of copying to a single,
83 1.1 thorpej * contiguous mbuf.
84 1.9 rafal * (3) Verify sq_stop() turns off enough stuff; I was still getting
85 1.1 thorpej * seeq interrupts after sq_stop().
86 1.20 sekiya * (4) Implement EDLC modes: especially packet auto-pad and simplex
87 1.1 thorpej * mode.
88 1.20 sekiya * (5) Should the driver filter out its own transmissions in non-EDLC
89 1.1 thorpej * mode?
90 1.20 sekiya * (6) Multicast support -- multicast filter, address management, ...
91 1.20 sekiya * (7) Deal with RB0 (recv buffer overflow) on reception. Will need
92 1.1 thorpej * to figure out if RB0 is read-only as stated in one spot in the
93 1.1 thorpej * HPC spec or read-write (ie, is the 'write a one to clear it')
94 1.1 thorpej * the correct thing?
95 1.1 thorpej */
96 1.1 thorpej
97 1.20 sekiya #if defined(SQ_DEBUG)
98 1.20 sekiya int sq_debug = 0;
99 1.20 sekiya #define SQ_DPRINTF(x) if (sq_debug) printf x
100 1.20 sekiya #else
101 1.20 sekiya #define SQ_DPRINTF(x)
102 1.20 sekiya #endif
103 1.20 sekiya
104 1.1 thorpej static int sq_match(struct device *, struct cfdata *, void *);
105 1.1 thorpej static void sq_attach(struct device *, struct device *, void *);
106 1.1 thorpej static int sq_init(struct ifnet *);
107 1.1 thorpej static void sq_start(struct ifnet *);
108 1.1 thorpej static void sq_stop(struct ifnet *, int);
109 1.1 thorpej static void sq_watchdog(struct ifnet *);
110 1.1 thorpej static int sq_ioctl(struct ifnet *, u_long, caddr_t);
111 1.1 thorpej
112 1.3 thorpej static void sq_set_filter(struct sq_softc *);
113 1.1 thorpej static int sq_intr(void *);
114 1.1 thorpej static int sq_rxintr(struct sq_softc *);
115 1.1 thorpej static int sq_txintr(struct sq_softc *);
116 1.23 rumble static void sq_txring_hpc1(struct sq_softc *);
117 1.23 rumble static void sq_txring_hpc3(struct sq_softc *);
118 1.1 thorpej static void sq_reset(struct sq_softc *);
119 1.1 thorpej static int sq_add_rxbuf(struct sq_softc *, int);
120 1.1 thorpej static void sq_dump_buffer(u_int32_t addr, u_int32_t len);
121 1.22 rumble static void sq_trace_dump(struct sq_softc *);
122 1.1 thorpej
123 1.1 thorpej static void enaddr_aton(const char*, u_int8_t*);
124 1.1 thorpej
125 1.14 thorpej CFATTACH_DECL(sq, sizeof(struct sq_softc),
126 1.14 thorpej sq_match, sq_attach, NULL, NULL);
127 1.1 thorpej
128 1.16 bouyer #define ETHER_PAD_LEN (ETHER_MIN_LEN - ETHER_CRC_LEN)
129 1.16 bouyer
130 1.24 rumble #define sq_seeq_read(sc, off) \
131 1.24 rumble bus_space_read_1(sc->sc_regt, sc->sc_regh, off)
132 1.24 rumble #define sq_seeq_write(sc, off, val) \
133 1.24 rumble bus_space_write_1(sc->sc_regt, sc->sc_regh, off, val)
134 1.24 rumble
135 1.24 rumble #define sq_hpc_read(sc, off) \
136 1.24 rumble bus_space_read_4(sc->sc_hpct, sc->sc_hpch, off)
137 1.24 rumble #define sq_hpc_write(sc, off, val) \
138 1.24 rumble bus_space_write_4(sc->sc_hpct, sc->sc_hpch, off, val)
139 1.24 rumble
140 1.28.2.1 yamt /* MAC address offset for non-onboard implementations */
141 1.28.2.1 yamt #define SQ_HPC_EEPROM_ENADDR 250
142 1.28.2.1 yamt
143 1.28.2.1 yamt #define SGI_OUI_0 0x08
144 1.28.2.1 yamt #define SGI_OUI_1 0x00
145 1.28.2.1 yamt #define SGI_OUI_2 0x69
146 1.28.2.1 yamt
147 1.1 thorpej static int
148 1.8 thorpej sq_match(struct device *parent, struct cfdata *cf, void *aux)
149 1.1 thorpej {
150 1.8 thorpej struct hpc_attach_args *ha = aux;
151 1.8 thorpej
152 1.12 thorpej if (strcmp(ha->ha_name, cf->cf_name) == 0)
153 1.8 thorpej return (1);
154 1.8 thorpej
155 1.8 thorpej return (0);
156 1.1 thorpej }
157 1.1 thorpej
158 1.1 thorpej static void
159 1.1 thorpej sq_attach(struct device *parent, struct device *self, void *aux)
160 1.1 thorpej {
161 1.1 thorpej int i, err;
162 1.28 martin const char* macaddr;
163 1.1 thorpej struct sq_softc *sc = (void *)self;
164 1.1 thorpej struct hpc_attach_args *haa = aux;
165 1.10 simonb struct ifnet *ifp = &sc->sc_ethercom.ec_if;
166 1.1 thorpej
167 1.8 thorpej sc->sc_hpct = haa->ha_st;
168 1.20 sekiya sc->hpc_regs = haa->hpc_regs; /* HPC register definitions */
169 1.20 sekiya
170 1.8 thorpej if ((err = bus_space_subregion(haa->ha_st, haa->ha_sh,
171 1.10 simonb haa->ha_dmaoff,
172 1.20 sekiya sc->hpc_regs->enet_regs_size,
173 1.1 thorpej &sc->sc_hpch)) != 0) {
174 1.1 thorpej printf(": unable to map HPC DMA registers, error = %d\n", err);
175 1.1 thorpej goto fail_0;
176 1.1 thorpej }
177 1.1 thorpej
178 1.8 thorpej sc->sc_regt = haa->ha_st;
179 1.8 thorpej if ((err = bus_space_subregion(haa->ha_st, haa->ha_sh,
180 1.10 simonb haa->ha_devoff,
181 1.20 sekiya sc->hpc_regs->enet_devregs_size,
182 1.1 thorpej &sc->sc_regh)) != 0) {
183 1.1 thorpej printf(": unable to map Seeq registers, error = %d\n", err);
184 1.1 thorpej goto fail_0;
185 1.1 thorpej }
186 1.1 thorpej
187 1.8 thorpej sc->sc_dmat = haa->ha_dmat;
188 1.1 thorpej
189 1.10 simonb if ((err = bus_dmamem_alloc(sc->sc_dmat, sizeof(struct sq_control),
190 1.10 simonb PAGE_SIZE, PAGE_SIZE, &sc->sc_cdseg,
191 1.1 thorpej 1, &sc->sc_ncdseg, BUS_DMA_NOWAIT)) != 0) {
192 1.1 thorpej printf(": unable to allocate control data, error = %d\n", err);
193 1.1 thorpej goto fail_0;
194 1.1 thorpej }
195 1.1 thorpej
196 1.1 thorpej if ((err = bus_dmamem_map(sc->sc_dmat, &sc->sc_cdseg, sc->sc_ncdseg,
197 1.10 simonb sizeof(struct sq_control),
198 1.10 simonb (caddr_t *)&sc->sc_control,
199 1.1 thorpej BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
200 1.1 thorpej printf(": unable to map control data, error = %d\n", err);
201 1.1 thorpej goto fail_1;
202 1.1 thorpej }
203 1.1 thorpej
204 1.1 thorpej if ((err = bus_dmamap_create(sc->sc_dmat, sizeof(struct sq_control),
205 1.1 thorpej 1, sizeof(struct sq_control), PAGE_SIZE,
206 1.1 thorpej BUS_DMA_NOWAIT, &sc->sc_cdmap)) != 0) {
207 1.1 thorpej printf(": unable to create DMA map for control data, error "
208 1.1 thorpej "= %d\n", err);
209 1.1 thorpej goto fail_2;
210 1.1 thorpej }
211 1.1 thorpej
212 1.1 thorpej if ((err = bus_dmamap_load(sc->sc_dmat, sc->sc_cdmap, sc->sc_control,
213 1.10 simonb sizeof(struct sq_control),
214 1.1 thorpej NULL, BUS_DMA_NOWAIT)) != 0) {
215 1.1 thorpej printf(": unable to load DMA map for control data, error "
216 1.1 thorpej "= %d\n", err);
217 1.1 thorpej goto fail_3;
218 1.1 thorpej }
219 1.1 thorpej
220 1.7 thorpej memset(sc->sc_control, 0, sizeof(struct sq_control));
221 1.1 thorpej
222 1.1 thorpej /* Create transmit buffer DMA maps */
223 1.1 thorpej for (i = 0; i < SQ_NTXDESC; i++) {
224 1.10 simonb if ((err = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES,
225 1.10 simonb 0, BUS_DMA_NOWAIT,
226 1.1 thorpej &sc->sc_txmap[i])) != 0) {
227 1.10 simonb printf(": unable to create tx DMA map %d, error = %d\n",
228 1.1 thorpej i, err);
229 1.1 thorpej goto fail_4;
230 1.1 thorpej }
231 1.1 thorpej }
232 1.1 thorpej
233 1.20 sekiya /* Create receive buffer DMA maps */
234 1.1 thorpej for (i = 0; i < SQ_NRXDESC; i++) {
235 1.10 simonb if ((err = bus_dmamap_create(sc->sc_dmat, MCLBYTES, 1, MCLBYTES,
236 1.10 simonb 0, BUS_DMA_NOWAIT,
237 1.1 thorpej &sc->sc_rxmap[i])) != 0) {
238 1.10 simonb printf(": unable to create rx DMA map %d, error = %d\n",
239 1.1 thorpej i, err);
240 1.1 thorpej goto fail_5;
241 1.1 thorpej }
242 1.1 thorpej }
243 1.1 thorpej
244 1.1 thorpej /* Pre-allocate the receive buffers. */
245 1.1 thorpej for (i = 0; i < SQ_NRXDESC; i++) {
246 1.1 thorpej if ((err = sq_add_rxbuf(sc, i)) != 0) {
247 1.1 thorpej printf(": unable to allocate or map rx buffer %d\n,"
248 1.1 thorpej " error = %d\n", i, err);
249 1.1 thorpej goto fail_6;
250 1.1 thorpej }
251 1.1 thorpej }
252 1.1 thorpej
253 1.28.2.1 yamt memcpy(sc->sc_enaddr, &haa->hpc_eeprom[SQ_HPC_EEPROM_ENADDR],
254 1.28.2.1 yamt ETHER_ADDR_LEN);
255 1.28.2.1 yamt
256 1.28.2.1 yamt /*
257 1.28.2.1 yamt * If our mac address is bogus, obtain it from ARCBIOS. This will
258 1.28.2.1 yamt * be true of the onboard HPC3 on IP22, since there is no eeprom,
259 1.28.2.1 yamt * but rather the DS1386 RTC's battery-backed ram is used.
260 1.28.2.1 yamt */
261 1.28.2.1 yamt if (sc->sc_enaddr[0] != SGI_OUI_0 || sc->sc_enaddr[1] != SGI_OUI_1 ||
262 1.28.2.1 yamt sc->sc_enaddr[2] != SGI_OUI_2) {
263 1.28.2.1 yamt macaddr = ARCBIOS->GetEnvironmentVariable("eaddr");
264 1.28.2.1 yamt if (macaddr == NULL) {
265 1.28.2.1 yamt printf(": unable to get MAC address!\n");
266 1.28.2.1 yamt goto fail_6;
267 1.28.2.1 yamt }
268 1.28.2.1 yamt enaddr_aton(macaddr, sc->sc_enaddr);
269 1.1 thorpej }
270 1.1 thorpej
271 1.11 rafal evcnt_attach_dynamic(&sc->sq_intrcnt, EVCNT_TYPE_INTR, NULL,
272 1.11 rafal self->dv_xname, "intr");
273 1.11 rafal
274 1.8 thorpej if ((cpu_intr_establish(haa->ha_irq, IPL_NET, sq_intr, sc)) == NULL) {
275 1.1 thorpej printf(": unable to establish interrupt!\n");
276 1.1 thorpej goto fail_6;
277 1.1 thorpej }
278 1.1 thorpej
279 1.3 thorpej /* Reset the chip to a known state. */
280 1.3 thorpej sq_reset(sc);
281 1.3 thorpej
282 1.3 thorpej /*
283 1.3 thorpej * Determine if we're an 8003 or 80c03 by setting the first
284 1.3 thorpej * MAC address register to non-zero, and then reading it back.
285 1.3 thorpej * If it's zero, we have an 80c03, because we will have read
286 1.3 thorpej * the TxCollLSB register.
287 1.3 thorpej */
288 1.24 rumble sq_seeq_write(sc, SEEQ_TXCOLLS0, 0xa5);
289 1.24 rumble if (sq_seeq_read(sc, SEEQ_TXCOLLS0) == 0)
290 1.3 thorpej sc->sc_type = SQ_TYPE_80C03;
291 1.3 thorpej else
292 1.3 thorpej sc->sc_type = SQ_TYPE_8003;
293 1.24 rumble sq_seeq_write(sc, SEEQ_TXCOLLS0, 0x00);
294 1.1 thorpej
295 1.3 thorpej printf(": SGI Seeq %s\n",
296 1.3 thorpej sc->sc_type == SQ_TYPE_80C03 ? "80c03" : "8003");
297 1.1 thorpej
298 1.10 simonb printf("%s: Ethernet address %s\n", sc->sc_dev.dv_xname,
299 1.1 thorpej ether_sprintf(sc->sc_enaddr));
300 1.1 thorpej
301 1.7 thorpej strcpy(ifp->if_xname, sc->sc_dev.dv_xname);
302 1.1 thorpej ifp->if_softc = sc;
303 1.1 thorpej ifp->if_mtu = ETHERMTU;
304 1.1 thorpej ifp->if_init = sq_init;
305 1.1 thorpej ifp->if_stop = sq_stop;
306 1.1 thorpej ifp->if_start = sq_start;
307 1.1 thorpej ifp->if_ioctl = sq_ioctl;
308 1.1 thorpej ifp->if_watchdog = sq_watchdog;
309 1.3 thorpej ifp->if_flags = IFF_BROADCAST | IFF_NOTRAILERS | IFF_MULTICAST;
310 1.1 thorpej IFQ_SET_READY(&ifp->if_snd);
311 1.1 thorpej
312 1.1 thorpej if_attach(ifp);
313 1.1 thorpej ether_ifattach(ifp, sc->sc_enaddr);
314 1.1 thorpej
315 1.22 rumble memset(&sc->sq_trace, 0, sizeof(sc->sq_trace));
316 1.1 thorpej /* Done! */
317 1.1 thorpej return;
318 1.1 thorpej
319 1.1 thorpej /*
320 1.1 thorpej * Free any resources we've allocated during the failed attach
321 1.1 thorpej * attempt. Do this in reverse order and fall through.
322 1.1 thorpej */
323 1.1 thorpej fail_6:
324 1.1 thorpej for (i = 0; i < SQ_NRXDESC; i++) {
325 1.1 thorpej if (sc->sc_rxmbuf[i] != NULL) {
326 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, sc->sc_rxmap[i]);
327 1.1 thorpej m_freem(sc->sc_rxmbuf[i]);
328 1.1 thorpej }
329 1.1 thorpej }
330 1.1 thorpej fail_5:
331 1.1 thorpej for (i = 0; i < SQ_NRXDESC; i++) {
332 1.10 simonb if (sc->sc_rxmap[i] != NULL)
333 1.1 thorpej bus_dmamap_destroy(sc->sc_dmat, sc->sc_rxmap[i]);
334 1.1 thorpej }
335 1.1 thorpej fail_4:
336 1.1 thorpej for (i = 0; i < SQ_NTXDESC; i++) {
337 1.1 thorpej if (sc->sc_txmap[i] != NULL)
338 1.1 thorpej bus_dmamap_destroy(sc->sc_dmat, sc->sc_txmap[i]);
339 1.1 thorpej }
340 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, sc->sc_cdmap);
341 1.1 thorpej fail_3:
342 1.1 thorpej bus_dmamap_destroy(sc->sc_dmat, sc->sc_cdmap);
343 1.1 thorpej fail_2:
344 1.10 simonb bus_dmamem_unmap(sc->sc_dmat, (caddr_t) sc->sc_control,
345 1.1 thorpej sizeof(struct sq_control));
346 1.1 thorpej fail_1:
347 1.1 thorpej bus_dmamem_free(sc->sc_dmat, &sc->sc_cdseg, sc->sc_ncdseg);
348 1.1 thorpej fail_0:
349 1.1 thorpej return;
350 1.1 thorpej }
351 1.1 thorpej
352 1.1 thorpej /* Set up data to get the interface up and running. */
353 1.1 thorpej int
354 1.1 thorpej sq_init(struct ifnet *ifp)
355 1.1 thorpej {
356 1.1 thorpej int i;
357 1.1 thorpej u_int32_t reg;
358 1.1 thorpej struct sq_softc *sc = ifp->if_softc;
359 1.1 thorpej
360 1.1 thorpej /* Cancel any in-progress I/O */
361 1.1 thorpej sq_stop(ifp, 0);
362 1.1 thorpej
363 1.1 thorpej sc->sc_nextrx = 0;
364 1.1 thorpej
365 1.1 thorpej sc->sc_nfreetx = SQ_NTXDESC;
366 1.1 thorpej sc->sc_nexttx = sc->sc_prevtx = 0;
367 1.1 thorpej
368 1.22 rumble SQ_TRACE(SQ_RESET, sc, 0, 0);
369 1.1 thorpej
370 1.1 thorpej /* Set into 8003 mode, bank 0 to program ethernet address */
371 1.24 rumble sq_seeq_write(sc, SEEQ_TXCMD, TXCMD_BANK0);
372 1.1 thorpej
373 1.1 thorpej /* Now write the address */
374 1.1 thorpej for (i = 0; i < ETHER_ADDR_LEN; i++)
375 1.24 rumble sq_seeq_write(sc, i, sc->sc_enaddr[i]);
376 1.3 thorpej
377 1.3 thorpej sc->sc_rxcmd = RXCMD_IE_CRC |
378 1.3 thorpej RXCMD_IE_DRIB |
379 1.3 thorpej RXCMD_IE_SHORT |
380 1.3 thorpej RXCMD_IE_END |
381 1.3 thorpej RXCMD_IE_GOOD;
382 1.3 thorpej
383 1.3 thorpej /*
384 1.3 thorpej * Set the receive filter -- this will add some bits to the
385 1.3 thorpej * prototype RXCMD register. Do this before setting the
386 1.3 thorpej * transmit config register, since we might need to switch
387 1.3 thorpej * banks.
388 1.3 thorpej */
389 1.3 thorpej sq_set_filter(sc);
390 1.1 thorpej
391 1.1 thorpej /* Set up Seeq transmit command register */
392 1.24 rumble sq_seeq_write(sc, SEEQ_TXCMD, TXCMD_IE_UFLOW |
393 1.24 rumble TXCMD_IE_COLL |
394 1.24 rumble TXCMD_IE_16COLL |
395 1.24 rumble TXCMD_IE_GOOD);
396 1.1 thorpej
397 1.3 thorpej /* Now write the receive command register. */
398 1.24 rumble sq_seeq_write(sc, SEEQ_RXCMD, sc->sc_rxcmd);
399 1.1 thorpej
400 1.1 thorpej /* Set up HPC ethernet DMA config */
401 1.20 sekiya if (sc->hpc_regs->revision == 3) {
402 1.26 rumble reg = sq_hpc_read(sc, HPC3_ENETR_DMACFG);
403 1.26 rumble sq_hpc_write(sc, HPC3_ENETR_DMACFG, reg |
404 1.26 rumble HPC3_ENETR_DMACFG_FIX_RXDC |
405 1.26 rumble HPC3_ENETR_DMACFG_FIX_INTR |
406 1.26 rumble HPC3_ENETR_DMACFG_FIX_EOP);
407 1.20 sekiya }
408 1.1 thorpej
409 1.1 thorpej /* Pass the start of the receive ring to the HPC */
410 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_ndbp, SQ_CDRXADDR(sc, 0));
411 1.1 thorpej
412 1.1 thorpej /* And turn on the HPC ethernet receive channel */
413 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_ctl,
414 1.24 rumble sc->hpc_regs->enetr_ctl_active);
415 1.1 thorpej
416 1.23 rumble /*
417 1.23 rumble * Turn off delayed receive interrupts on HPC1.
418 1.23 rumble * (see Hollywood HPC Specification 2.1.4.3)
419 1.23 rumble */
420 1.23 rumble if (sc->hpc_regs->revision != 3)
421 1.25 rumble sq_hpc_write(sc, HPC1_ENET_INTDELAY, HPC1_ENET_INTDELAY_OFF);
422 1.23 rumble
423 1.10 simonb ifp->if_flags |= IFF_RUNNING;
424 1.1 thorpej ifp->if_flags &= ~IFF_OACTIVE;
425 1.1 thorpej
426 1.1 thorpej return 0;
427 1.1 thorpej }
428 1.1 thorpej
429 1.3 thorpej static void
430 1.3 thorpej sq_set_filter(struct sq_softc *sc)
431 1.3 thorpej {
432 1.3 thorpej struct ethercom *ec = &sc->sc_ethercom;
433 1.3 thorpej struct ifnet *ifp = &sc->sc_ethercom.ec_if;
434 1.3 thorpej struct ether_multi *enm;
435 1.3 thorpej struct ether_multistep step;
436 1.3 thorpej
437 1.3 thorpej /*
438 1.3 thorpej * Check for promiscuous mode. Also implies
439 1.3 thorpej * all-multicast.
440 1.3 thorpej */
441 1.3 thorpej if (ifp->if_flags & IFF_PROMISC) {
442 1.3 thorpej sc->sc_rxcmd |= RXCMD_REC_ALL;
443 1.3 thorpej ifp->if_flags |= IFF_ALLMULTI;
444 1.3 thorpej return;
445 1.3 thorpej }
446 1.3 thorpej
447 1.3 thorpej /*
448 1.3 thorpej * The 8003 has no hash table. If we have any multicast
449 1.3 thorpej * addresses on the list, enable reception of all multicast
450 1.3 thorpej * frames.
451 1.3 thorpej *
452 1.3 thorpej * XXX The 80c03 has a hash table. We should use it.
453 1.3 thorpej */
454 1.3 thorpej
455 1.3 thorpej ETHER_FIRST_MULTI(step, ec, enm);
456 1.3 thorpej
457 1.3 thorpej if (enm == NULL) {
458 1.11 rafal sc->sc_rxcmd &= ~RXCMD_REC_MASK;
459 1.3 thorpej sc->sc_rxcmd |= RXCMD_REC_BROAD;
460 1.11 rafal
461 1.11 rafal ifp->if_flags &= ~IFF_ALLMULTI;
462 1.3 thorpej return;
463 1.3 thorpej }
464 1.3 thorpej
465 1.3 thorpej sc->sc_rxcmd |= RXCMD_REC_MULTI;
466 1.3 thorpej ifp->if_flags |= IFF_ALLMULTI;
467 1.3 thorpej }
468 1.3 thorpej
469 1.1 thorpej int
470 1.1 thorpej sq_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
471 1.1 thorpej {
472 1.1 thorpej int s, error = 0;
473 1.1 thorpej
474 1.22 rumble SQ_TRACE(SQ_IOCTL, (struct sq_softc *)ifp->if_softc, 0, 0);
475 1.22 rumble
476 1.1 thorpej s = splnet();
477 1.1 thorpej
478 1.1 thorpej error = ether_ioctl(ifp, cmd, data);
479 1.1 thorpej if (error == ENETRESET) {
480 1.1 thorpej /*
481 1.1 thorpej * Multicast list has changed; set the hardware filter
482 1.1 thorpej * accordingly.
483 1.1 thorpej */
484 1.21 thorpej if (ifp->if_flags & IFF_RUNNING)
485 1.21 thorpej error = sq_init(ifp);
486 1.21 thorpej else
487 1.21 thorpej error = 0;
488 1.1 thorpej }
489 1.1 thorpej
490 1.1 thorpej splx(s);
491 1.1 thorpej return (error);
492 1.1 thorpej }
493 1.1 thorpej
494 1.1 thorpej void
495 1.1 thorpej sq_start(struct ifnet *ifp)
496 1.1 thorpej {
497 1.1 thorpej struct sq_softc *sc = ifp->if_softc;
498 1.1 thorpej u_int32_t status;
499 1.1 thorpej struct mbuf *m0, *m;
500 1.1 thorpej bus_dmamap_t dmamap;
501 1.19 matt int err, totlen, nexttx, firsttx, lasttx = -1, ofree, seg;
502 1.1 thorpej
503 1.1 thorpej if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
504 1.1 thorpej return;
505 1.1 thorpej
506 1.1 thorpej /*
507 1.1 thorpej * Remember the previous number of free descriptors and
508 1.1 thorpej * the first descriptor we'll use.
509 1.1 thorpej */
510 1.1 thorpej ofree = sc->sc_nfreetx;
511 1.1 thorpej firsttx = sc->sc_nexttx;
512 1.1 thorpej
513 1.1 thorpej /*
514 1.1 thorpej * Loop through the send queue, setting up transmit descriptors
515 1.1 thorpej * until we drain the queue, or use up all available transmit
516 1.1 thorpej * descriptors.
517 1.1 thorpej */
518 1.1 thorpej while (sc->sc_nfreetx != 0) {
519 1.1 thorpej /*
520 1.1 thorpej * Grab a packet off the queue.
521 1.1 thorpej */
522 1.1 thorpej IFQ_POLL(&ifp->if_snd, m0);
523 1.1 thorpej if (m0 == NULL)
524 1.1 thorpej break;
525 1.1 thorpej m = NULL;
526 1.1 thorpej
527 1.1 thorpej dmamap = sc->sc_txmap[sc->sc_nexttx];
528 1.1 thorpej
529 1.1 thorpej /*
530 1.1 thorpej * Load the DMA map. If this fails, the packet either
531 1.1 thorpej * didn't fit in the alloted number of segments, or we were
532 1.1 thorpej * short on resources. In this case, we'll copy and try
533 1.1 thorpej * again.
534 1.16 bouyer * Also copy it if we need to pad, so that we are sure there
535 1.16 bouyer * is room for the pad buffer.
536 1.16 bouyer * XXX the right way of doing this is to use a static buffer
537 1.16 bouyer * for padding and adding it to the transmit descriptor (see
538 1.16 bouyer * sys/dev/pci/if_tl.c for example). We can't do this here yet
539 1.16 bouyer * because we can't send packets with more than one fragment.
540 1.1 thorpej */
541 1.16 bouyer if (m0->m_pkthdr.len < ETHER_PAD_LEN ||
542 1.16 bouyer bus_dmamap_load_mbuf(sc->sc_dmat, dmamap, m0,
543 1.1 thorpej BUS_DMA_NOWAIT) != 0) {
544 1.1 thorpej MGETHDR(m, M_DONTWAIT, MT_DATA);
545 1.1 thorpej if (m == NULL) {
546 1.1 thorpej printf("%s: unable to allocate Tx mbuf\n",
547 1.1 thorpej sc->sc_dev.dv_xname);
548 1.1 thorpej break;
549 1.1 thorpej }
550 1.1 thorpej if (m0->m_pkthdr.len > MHLEN) {
551 1.1 thorpej MCLGET(m, M_DONTWAIT);
552 1.1 thorpej if ((m->m_flags & M_EXT) == 0) {
553 1.1 thorpej printf("%s: unable to allocate Tx "
554 1.1 thorpej "cluster\n", sc->sc_dev.dv_xname);
555 1.1 thorpej m_freem(m);
556 1.1 thorpej break;
557 1.1 thorpej }
558 1.1 thorpej }
559 1.1 thorpej
560 1.1 thorpej m_copydata(m0, 0, m0->m_pkthdr.len, mtod(m, caddr_t));
561 1.16 bouyer if (m0->m_pkthdr.len < ETHER_PAD_LEN) {
562 1.16 bouyer memset(mtod(m, char *) + m0->m_pkthdr.len, 0,
563 1.16 bouyer ETHER_PAD_LEN - m0->m_pkthdr.len);
564 1.16 bouyer m->m_pkthdr.len = m->m_len = ETHER_PAD_LEN;
565 1.18 tsutsui } else
566 1.16 bouyer m->m_pkthdr.len = m->m_len = m0->m_pkthdr.len;
567 1.1 thorpej
568 1.10 simonb if ((err = bus_dmamap_load_mbuf(sc->sc_dmat, dmamap,
569 1.1 thorpej m, BUS_DMA_NOWAIT)) != 0) {
570 1.1 thorpej printf("%s: unable to load Tx buffer, "
571 1.1 thorpej "error = %d\n", sc->sc_dev.dv_xname, err);
572 1.1 thorpej break;
573 1.1 thorpej }
574 1.1 thorpej }
575 1.1 thorpej
576 1.1 thorpej /*
577 1.1 thorpej * Ensure we have enough descriptors free to describe
578 1.1 thorpej * the packet.
579 1.1 thorpej */
580 1.1 thorpej if (dmamap->dm_nsegs > sc->sc_nfreetx) {
581 1.1 thorpej /*
582 1.1 thorpej * Not enough free descriptors to transmit this
583 1.1 thorpej * packet. We haven't committed to anything yet,
584 1.1 thorpej * so just unload the DMA map, put the packet
585 1.1 thorpej * back on the queue, and punt. Notify the upper
586 1.1 thorpej * layer that there are no more slots left.
587 1.1 thorpej *
588 1.1 thorpej * XXX We could allocate an mbuf and copy, but
589 1.1 thorpej * XXX it is worth it?
590 1.1 thorpej */
591 1.1 thorpej ifp->if_flags |= IFF_OACTIVE;
592 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, dmamap);
593 1.1 thorpej if (m != NULL)
594 1.1 thorpej m_freem(m);
595 1.1 thorpej break;
596 1.1 thorpej }
597 1.1 thorpej
598 1.1 thorpej IFQ_DEQUEUE(&ifp->if_snd, m0);
599 1.16 bouyer #if NBPFILTER > 0
600 1.16 bouyer /*
601 1.16 bouyer * Pass the packet to any BPF listeners.
602 1.16 bouyer */
603 1.16 bouyer if (ifp->if_bpf)
604 1.16 bouyer bpf_mtap(ifp->if_bpf, m0);
605 1.16 bouyer #endif /* NBPFILTER > 0 */
606 1.1 thorpej if (m != NULL) {
607 1.1 thorpej m_freem(m0);
608 1.1 thorpej m0 = m;
609 1.1 thorpej }
610 1.1 thorpej
611 1.1 thorpej /*
612 1.1 thorpej * WE ARE NOW COMMITTED TO TRANSMITTING THE PACKET.
613 1.1 thorpej */
614 1.1 thorpej
615 1.22 rumble SQ_TRACE(SQ_ENQUEUE, sc, sc->sc_nexttx, 0);
616 1.22 rumble
617 1.1 thorpej /* Sync the DMA map. */
618 1.1 thorpej bus_dmamap_sync(sc->sc_dmat, dmamap, 0, dmamap->dm_mapsize,
619 1.1 thorpej BUS_DMASYNC_PREWRITE);
620 1.1 thorpej
621 1.1 thorpej /*
622 1.1 thorpej * Initialize the transmit descriptors.
623 1.1 thorpej */
624 1.1 thorpej for (nexttx = sc->sc_nexttx, seg = 0, totlen = 0;
625 1.1 thorpej seg < dmamap->dm_nsegs;
626 1.1 thorpej seg++, nexttx = SQ_NEXTTX(nexttx)) {
627 1.20 sekiya if (sc->hpc_regs->revision == 3) {
628 1.20 sekiya sc->sc_txdesc[nexttx].hpc3_hdd_bufptr =
629 1.20 sekiya dmamap->dm_segs[seg].ds_addr;
630 1.20 sekiya sc->sc_txdesc[nexttx].hpc3_hdd_ctl =
631 1.20 sekiya dmamap->dm_segs[seg].ds_len;
632 1.20 sekiya } else {
633 1.20 sekiya sc->sc_txdesc[nexttx].hpc1_hdd_bufptr =
634 1.1 thorpej dmamap->dm_segs[seg].ds_addr;
635 1.20 sekiya sc->sc_txdesc[nexttx].hpc1_hdd_ctl =
636 1.1 thorpej dmamap->dm_segs[seg].ds_len;
637 1.20 sekiya }
638 1.10 simonb sc->sc_txdesc[nexttx].hdd_descptr=
639 1.1 thorpej SQ_CDTXADDR(sc, SQ_NEXTTX(nexttx));
640 1.10 simonb lasttx = nexttx;
641 1.1 thorpej totlen += dmamap->dm_segs[seg].ds_len;
642 1.1 thorpej }
643 1.1 thorpej
644 1.1 thorpej /* Last descriptor gets end-of-packet */
645 1.19 matt KASSERT(lasttx != -1);
646 1.20 sekiya if (sc->hpc_regs->revision == 3)
647 1.26 rumble sc->sc_txdesc[lasttx].hpc3_hdd_ctl |=
648 1.26 rumble HPC3_HDD_CTL_EOPACKET;
649 1.20 sekiya else
650 1.20 sekiya sc->sc_txdesc[lasttx].hpc1_hdd_ctl |=
651 1.26 rumble HPC1_HDD_CTL_EOPACKET;
652 1.1 thorpej
653 1.20 sekiya SQ_DPRINTF(("%s: transmit %d-%d, len %d\n", sc->sc_dev.dv_xname,
654 1.1 thorpej sc->sc_nexttx, lasttx,
655 1.20 sekiya totlen));
656 1.1 thorpej
657 1.1 thorpej if (ifp->if_flags & IFF_DEBUG) {
658 1.1 thorpej printf(" transmit chain:\n");
659 1.1 thorpej for (seg = sc->sc_nexttx;; seg = SQ_NEXTTX(seg)) {
660 1.1 thorpej printf(" descriptor %d:\n", seg);
661 1.1 thorpej printf(" hdd_bufptr: 0x%08x\n",
662 1.20 sekiya (sc->hpc_regs->revision == 3) ?
663 1.20 sekiya sc->sc_txdesc[seg].hpc3_hdd_bufptr :
664 1.20 sekiya sc->sc_txdesc[seg].hpc1_hdd_bufptr);
665 1.1 thorpej printf(" hdd_ctl: 0x%08x\n",
666 1.20 sekiya (sc->hpc_regs->revision == 3) ?
667 1.20 sekiya sc->sc_txdesc[seg].hpc3_hdd_ctl:
668 1.20 sekiya sc->sc_txdesc[seg].hpc1_hdd_ctl);
669 1.1 thorpej printf(" hdd_descptr: 0x%08x\n",
670 1.1 thorpej sc->sc_txdesc[seg].hdd_descptr);
671 1.1 thorpej
672 1.1 thorpej if (seg == lasttx)
673 1.1 thorpej break;
674 1.1 thorpej }
675 1.1 thorpej }
676 1.1 thorpej
677 1.1 thorpej /* Sync the descriptors we're using. */
678 1.1 thorpej SQ_CDTXSYNC(sc, sc->sc_nexttx, dmamap->dm_nsegs,
679 1.1 thorpej BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
680 1.1 thorpej
681 1.1 thorpej /* Store a pointer to the packet so we can free it later */
682 1.1 thorpej sc->sc_txmbuf[sc->sc_nexttx] = m0;
683 1.1 thorpej
684 1.1 thorpej /* Advance the tx pointer. */
685 1.1 thorpej sc->sc_nfreetx -= dmamap->dm_nsegs;
686 1.1 thorpej sc->sc_nexttx = nexttx;
687 1.1 thorpej }
688 1.1 thorpej
689 1.1 thorpej /* All transmit descriptors used up, let upper layers know */
690 1.1 thorpej if (sc->sc_nfreetx == 0)
691 1.1 thorpej ifp->if_flags |= IFF_OACTIVE;
692 1.1 thorpej
693 1.1 thorpej if (sc->sc_nfreetx != ofree) {
694 1.20 sekiya SQ_DPRINTF(("%s: %d packets enqueued, first %d, INTR on %d\n",
695 1.1 thorpej sc->sc_dev.dv_xname, lasttx - firsttx + 1,
696 1.20 sekiya firsttx, lasttx));
697 1.1 thorpej
698 1.1 thorpej /*
699 1.1 thorpej * Cause a transmit interrupt to happen on the
700 1.1 thorpej * last packet we enqueued, mark it as the last
701 1.1 thorpej * descriptor.
702 1.20 sekiya *
703 1.26 rumble * HPC1_HDD_CTL_INTR will generate an interrupt on
704 1.26 rumble * HPC1. HPC3 requires HPC3_HDD_CTL_EOPACKET in
705 1.26 rumble * addition to HPC3_HDD_CTL_INTR to interrupt.
706 1.1 thorpej */
707 1.19 matt KASSERT(lasttx != -1);
708 1.20 sekiya if (sc->hpc_regs->revision == 3) {
709 1.26 rumble sc->sc_txdesc[lasttx].hpc3_hdd_ctl |=
710 1.26 rumble HPC3_HDD_CTL_INTR | HPC3_HDD_CTL_EOCHAIN;
711 1.20 sekiya } else {
712 1.20 sekiya sc->sc_txdesc[lasttx].hpc1_hdd_ctl |= HPC1_HDD_CTL_INTR;
713 1.20 sekiya sc->sc_txdesc[lasttx].hpc1_hdd_bufptr |=
714 1.26 rumble HPC1_HDD_CTL_EOCHAIN;
715 1.20 sekiya }
716 1.20 sekiya
717 1.10 simonb SQ_CDTXSYNC(sc, lasttx, 1,
718 1.1 thorpej BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
719 1.1 thorpej
720 1.10 simonb /*
721 1.1 thorpej * There is a potential race condition here if the HPC
722 1.10 simonb * DMA channel is active and we try and either update
723 1.10 simonb * the 'next descriptor' pointer in the HPC PIO space
724 1.1 thorpej * or the 'next descriptor' pointer in a previous desc-
725 1.1 thorpej * riptor.
726 1.1 thorpej *
727 1.10 simonb * To avoid this, if the channel is active, we rely on
728 1.1 thorpej * the transmit interrupt routine noticing that there
729 1.10 simonb * are more packets to send and restarting the HPC DMA
730 1.1 thorpej * engine, rather than mucking with the DMA state here.
731 1.1 thorpej */
732 1.24 rumble status = sq_hpc_read(sc, sc->hpc_regs->enetx_ctl);
733 1.1 thorpej
734 1.20 sekiya if ((status & sc->hpc_regs->enetx_ctl_active) != 0) {
735 1.22 rumble SQ_TRACE(SQ_ADD_TO_DMA, sc, firsttx, status);
736 1.20 sekiya
737 1.26 rumble /*
738 1.26 rumble * NB: hpc3_hdd_ctl == hpc1_hdd_bufptr, and
739 1.26 rumble * HPC1_HDD_CTL_EOCHAIN == HPC3_HDD_CTL_EOCHAIN
740 1.26 rumble */
741 1.20 sekiya sc->sc_txdesc[SQ_PREVTX(firsttx)].hpc3_hdd_ctl &=
742 1.26 rumble ~HPC3_HDD_CTL_EOCHAIN;
743 1.20 sekiya
744 1.23 rumble if (sc->hpc_regs->revision != 3)
745 1.23 rumble sc->sc_txdesc[SQ_PREVTX(firsttx)].hpc1_hdd_ctl
746 1.23 rumble &= ~HPC1_HDD_CTL_INTR;
747 1.23 rumble
748 1.6 thorpej SQ_CDTXSYNC(sc, SQ_PREVTX(firsttx), 1,
749 1.6 thorpej BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
750 1.23 rumble } else if (sc->hpc_regs->revision == 3) {
751 1.22 rumble SQ_TRACE(SQ_START_DMA, sc, firsttx, status);
752 1.1 thorpej
753 1.26 rumble sq_hpc_write(sc, HPC3_ENETX_NDBP, SQ_CDTXADDR(sc,
754 1.24 rumble firsttx));
755 1.23 rumble
756 1.23 rumble /* Kick DMA channel into life */
757 1.26 rumble sq_hpc_write(sc, HPC3_ENETX_CTL, HPC3_ENETX_CTL_ACTIVE);
758 1.23 rumble } else {
759 1.23 rumble /*
760 1.23 rumble * In the HPC1 case where transmit DMA is
761 1.23 rumble * inactive, we can either kick off if
762 1.23 rumble * the ring was previously empty, or call
763 1.23 rumble * our transmit interrupt handler to
764 1.23 rumble * figure out if the ring stopped short
765 1.23 rumble * and restart at the right place.
766 1.23 rumble */
767 1.23 rumble if (ofree == SQ_NTXDESC) {
768 1.23 rumble SQ_TRACE(SQ_START_DMA, sc, firsttx, status);
769 1.20 sekiya
770 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_NDBP,
771 1.24 rumble SQ_CDTXADDR(sc, firsttx));
772 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CFXBP,
773 1.24 rumble SQ_CDTXADDR(sc, firsttx));
774 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CBP,
775 1.23 rumble SQ_CDTXADDR(sc, firsttx));
776 1.1 thorpej
777 1.23 rumble /* Kick DMA channel into life */
778 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CTL,
779 1.24 rumble HPC1_ENETX_CTL_ACTIVE);
780 1.23 rumble } else
781 1.23 rumble sq_txring_hpc1(sc);
782 1.2 rafal }
783 1.1 thorpej
784 1.6 thorpej /* Set a watchdog timer in case the chip flakes out. */
785 1.6 thorpej ifp->if_timer = 5;
786 1.6 thorpej }
787 1.1 thorpej }
788 1.1 thorpej
789 1.1 thorpej void
790 1.1 thorpej sq_stop(struct ifnet *ifp, int disable)
791 1.1 thorpej {
792 1.1 thorpej int i;
793 1.1 thorpej struct sq_softc *sc = ifp->if_softc;
794 1.1 thorpej
795 1.1 thorpej for (i =0; i < SQ_NTXDESC; i++) {
796 1.1 thorpej if (sc->sc_txmbuf[i] != NULL) {
797 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, sc->sc_txmap[i]);
798 1.1 thorpej m_freem(sc->sc_txmbuf[i]);
799 1.1 thorpej sc->sc_txmbuf[i] = NULL;
800 1.1 thorpej }
801 1.1 thorpej }
802 1.1 thorpej
803 1.1 thorpej /* Clear Seeq transmit/receive command registers */
804 1.24 rumble sq_seeq_write(sc, SEEQ_TXCMD, 0);
805 1.24 rumble sq_seeq_write(sc, SEEQ_RXCMD, 0);
806 1.1 thorpej
807 1.1 thorpej sq_reset(sc);
808 1.1 thorpej
809 1.10 simonb ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
810 1.1 thorpej ifp->if_timer = 0;
811 1.1 thorpej }
812 1.1 thorpej
813 1.1 thorpej /* Device timeout/watchdog routine. */
814 1.1 thorpej void
815 1.1 thorpej sq_watchdog(struct ifnet *ifp)
816 1.1 thorpej {
817 1.1 thorpej u_int32_t status;
818 1.1 thorpej struct sq_softc *sc = ifp->if_softc;
819 1.1 thorpej
820 1.24 rumble status = sq_hpc_read(sc, sc->hpc_regs->enetx_ctl);
821 1.1 thorpej log(LOG_ERR, "%s: device timeout (prev %d, next %d, free %d, "
822 1.10 simonb "status %08x)\n", sc->sc_dev.dv_xname, sc->sc_prevtx,
823 1.1 thorpej sc->sc_nexttx, sc->sc_nfreetx, status);
824 1.1 thorpej
825 1.1 thorpej sq_trace_dump(sc);
826 1.1 thorpej
827 1.22 rumble memset(&sc->sq_trace, 0, sizeof(sc->sq_trace));
828 1.22 rumble sc->sq_trace_idx = 0;
829 1.1 thorpej
830 1.1 thorpej ++ifp->if_oerrors;
831 1.1 thorpej
832 1.1 thorpej sq_init(ifp);
833 1.1 thorpej }
834 1.1 thorpej
835 1.22 rumble static void
836 1.22 rumble sq_trace_dump(struct sq_softc *sc)
837 1.1 thorpej {
838 1.1 thorpej int i;
839 1.28 martin const char *act;
840 1.22 rumble
841 1.22 rumble for (i = 0; i < sc->sq_trace_idx; i++) {
842 1.22 rumble switch (sc->sq_trace[i].action) {
843 1.22 rumble case SQ_RESET: act = "SQ_RESET"; break;
844 1.22 rumble case SQ_ADD_TO_DMA: act = "SQ_ADD_TO_DMA"; break;
845 1.22 rumble case SQ_START_DMA: act = "SQ_START_DMA"; break;
846 1.22 rumble case SQ_DONE_DMA: act = "SQ_DONE_DMA"; break;
847 1.22 rumble case SQ_RESTART_DMA: act = "SQ_RESTART_DMA"; break;
848 1.22 rumble case SQ_TXINTR_ENTER: act = "SQ_TXINTR_ENTER"; break;
849 1.22 rumble case SQ_TXINTR_EXIT: act = "SQ_TXINTR_EXIT"; break;
850 1.22 rumble case SQ_TXINTR_BUSY: act = "SQ_TXINTR_BUSY"; break;
851 1.22 rumble case SQ_IOCTL: act = "SQ_IOCTL"; break;
852 1.22 rumble case SQ_ENQUEUE: act = "SQ_ENQUEUE"; break;
853 1.22 rumble default: act = "UNKNOWN";
854 1.22 rumble }
855 1.1 thorpej
856 1.22 rumble printf("%s: [%03d] action %-16s buf %03d free %03d "
857 1.22 rumble "status %08x line %d\n", sc->sc_dev.dv_xname, i, act,
858 1.22 rumble sc->sq_trace[i].bufno, sc->sq_trace[i].freebuf,
859 1.22 rumble sc->sq_trace[i].status, sc->sq_trace[i].line);
860 1.1 thorpej }
861 1.1 thorpej }
862 1.1 thorpej
863 1.1 thorpej static int
864 1.1 thorpej sq_intr(void * arg)
865 1.1 thorpej {
866 1.1 thorpej struct sq_softc *sc = arg;
867 1.1 thorpej struct ifnet *ifp = &sc->sc_ethercom.ec_if;
868 1.1 thorpej int handled = 0;
869 1.1 thorpej u_int32_t stat;
870 1.1 thorpej
871 1.24 rumble stat = sq_hpc_read(sc, sc->hpc_regs->enetr_reset);
872 1.1 thorpej
873 1.27 rumble if ((stat & 2) == 0)
874 1.27 rumble SQ_DPRINTF(("%s: Unexpected interrupt!\n",
875 1.27 rumble sc->sc_dev.dv_xname));
876 1.27 rumble else
877 1.27 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_reset, (stat | 2));
878 1.1 thorpej
879 1.1 thorpej /*
880 1.1 thorpej * If the interface isn't running, the interrupt couldn't
881 1.1 thorpej * possibly have come from us.
882 1.1 thorpej */
883 1.1 thorpej if ((ifp->if_flags & IFF_RUNNING) == 0)
884 1.1 thorpej return 0;
885 1.11 rafal
886 1.11 rafal sc->sq_intrcnt.ev_count++;
887 1.1 thorpej
888 1.1 thorpej /* Always check for received packets */
889 1.1 thorpej if (sq_rxintr(sc) != 0)
890 1.1 thorpej handled++;
891 1.1 thorpej
892 1.1 thorpej /* Only handle transmit interrupts if we actually sent something */
893 1.1 thorpej if (sc->sc_nfreetx < SQ_NTXDESC) {
894 1.1 thorpej sq_txintr(sc);
895 1.1 thorpej handled++;
896 1.1 thorpej }
897 1.1 thorpej
898 1.1 thorpej #if NRND > 0
899 1.1 thorpej if (handled)
900 1.3 thorpej rnd_add_uint32(&sc->rnd_source, stat);
901 1.1 thorpej #endif
902 1.1 thorpej return (handled);
903 1.1 thorpej }
904 1.1 thorpej
905 1.1 thorpej static int
906 1.1 thorpej sq_rxintr(struct sq_softc *sc)
907 1.1 thorpej {
908 1.1 thorpej int count = 0;
909 1.1 thorpej struct mbuf* m;
910 1.1 thorpej int i, framelen;
911 1.1 thorpej u_int8_t pktstat;
912 1.1 thorpej u_int32_t status;
913 1.20 sekiya u_int32_t ctl_reg;
914 1.1 thorpej int new_end, orig_end;
915 1.1 thorpej struct ifnet *ifp = &sc->sc_ethercom.ec_if;
916 1.1 thorpej
917 1.24 rumble for (i = sc->sc_nextrx;; i = SQ_NEXTRX(i)) {
918 1.24 rumble SQ_CDRXSYNC(sc, i, BUS_DMASYNC_POSTREAD |
919 1.24 rumble BUS_DMASYNC_POSTWRITE);
920 1.1 thorpej
921 1.24 rumble /*
922 1.24 rumble * If this is a CPU-owned buffer, we're at the end of the list.
923 1.24 rumble */
924 1.20 sekiya if (sc->hpc_regs->revision == 3)
925 1.26 rumble ctl_reg = sc->sc_rxdesc[i].hpc3_hdd_ctl &
926 1.26 rumble HPC3_HDD_CTL_OWN;
927 1.20 sekiya else
928 1.20 sekiya ctl_reg = sc->sc_rxdesc[i].hpc1_hdd_ctl &
929 1.26 rumble HPC1_HDD_CTL_OWN;
930 1.20 sekiya
931 1.20 sekiya if (ctl_reg) {
932 1.20 sekiya #if defined(SQ_DEBUG)
933 1.10 simonb u_int32_t reg;
934 1.1 thorpej
935 1.24 rumble reg = sq_hpc_read(sc, sc->hpc_regs->enetr_ctl);
936 1.20 sekiya SQ_DPRINTF(("%s: rxintr: done at %d (ctl %08x)\n",
937 1.20 sekiya sc->sc_dev.dv_xname, i, reg));
938 1.1 thorpej #endif
939 1.10 simonb break;
940 1.10 simonb }
941 1.1 thorpej
942 1.10 simonb count++;
943 1.1 thorpej
944 1.10 simonb m = sc->sc_rxmbuf[i];
945 1.20 sekiya framelen = m->m_ext.ext_size - 3;
946 1.20 sekiya if (sc->hpc_regs->revision == 3)
947 1.20 sekiya framelen -=
948 1.26 rumble HPC3_HDD_CTL_BYTECNT(sc->sc_rxdesc[i].hpc3_hdd_ctl);
949 1.20 sekiya else
950 1.20 sekiya framelen -=
951 1.20 sekiya HPC1_HDD_CTL_BYTECNT(sc->sc_rxdesc[i].hpc1_hdd_ctl);
952 1.1 thorpej
953 1.10 simonb /* Now sync the actual packet data */
954 1.10 simonb bus_dmamap_sync(sc->sc_dmat, sc->sc_rxmap[i], 0,
955 1.10 simonb sc->sc_rxmap[i]->dm_mapsize, BUS_DMASYNC_POSTREAD);
956 1.1 thorpej
957 1.10 simonb pktstat = *((u_int8_t*)m->m_data + framelen + 2);
958 1.1 thorpej
959 1.10 simonb if ((pktstat & RXSTAT_GOOD) == 0) {
960 1.10 simonb ifp->if_ierrors++;
961 1.2 rafal
962 1.10 simonb if (pktstat & RXSTAT_OFLOW)
963 1.10 simonb printf("%s: receive FIFO overflow\n",
964 1.10 simonb sc->sc_dev.dv_xname);
965 1.1 thorpej
966 1.10 simonb bus_dmamap_sync(sc->sc_dmat, sc->sc_rxmap[i], 0,
967 1.10 simonb sc->sc_rxmap[i]->dm_mapsize,
968 1.10 simonb BUS_DMASYNC_PREREAD);
969 1.10 simonb SQ_INIT_RXDESC(sc, i);
970 1.23 rumble SQ_DPRINTF(("%s: sq_rxintr: buf %d no RXSTAT_GOOD\n",
971 1.23 rumble sc->sc_dev.dv_xname, i));
972 1.10 simonb continue;
973 1.10 simonb }
974 1.1 thorpej
975 1.10 simonb if (sq_add_rxbuf(sc, i) != 0) {
976 1.10 simonb ifp->if_ierrors++;
977 1.10 simonb bus_dmamap_sync(sc->sc_dmat, sc->sc_rxmap[i], 0,
978 1.10 simonb sc->sc_rxmap[i]->dm_mapsize,
979 1.10 simonb BUS_DMASYNC_PREREAD);
980 1.10 simonb SQ_INIT_RXDESC(sc, i);
981 1.23 rumble SQ_DPRINTF(("%s: sq_rxintr: buf %d sq_add_rxbuf() "
982 1.23 rumble "failed\n", sc->sc_dev.dv_xname, i));
983 1.10 simonb continue;
984 1.10 simonb }
985 1.1 thorpej
986 1.1 thorpej
987 1.10 simonb m->m_data += 2;
988 1.10 simonb m->m_pkthdr.rcvif = ifp;
989 1.10 simonb m->m_pkthdr.len = m->m_len = framelen;
990 1.1 thorpej
991 1.10 simonb ifp->if_ipackets++;
992 1.1 thorpej
993 1.20 sekiya SQ_DPRINTF(("%s: sq_rxintr: buf %d len %d\n",
994 1.20 sekiya sc->sc_dev.dv_xname, i, framelen));
995 1.1 thorpej
996 1.1 thorpej #if NBPFILTER > 0
997 1.10 simonb if (ifp->if_bpf)
998 1.10 simonb bpf_mtap(ifp->if_bpf, m);
999 1.1 thorpej #endif
1000 1.10 simonb (*ifp->if_input)(ifp, m);
1001 1.1 thorpej }
1002 1.1 thorpej
1003 1.1 thorpej
1004 1.1 thorpej /* If anything happened, move ring start/end pointers to new spot */
1005 1.1 thorpej if (i != sc->sc_nextrx) {
1006 1.26 rumble /*
1007 1.26 rumble * NB: hpc3_hdd_ctl == hpc1_hdd_bufptr, and
1008 1.26 rumble * HPC1_HDD_CTL_EOCHAIN == HPC3_HDD_CTL_EOCHAIN
1009 1.26 rumble */
1010 1.20 sekiya
1011 1.10 simonb new_end = SQ_PREVRX(i);
1012 1.26 rumble sc->sc_rxdesc[new_end].hpc3_hdd_ctl |= HPC3_HDD_CTL_EOCHAIN;
1013 1.10 simonb SQ_CDRXSYNC(sc, new_end, BUS_DMASYNC_PREREAD |
1014 1.10 simonb BUS_DMASYNC_PREWRITE);
1015 1.1 thorpej
1016 1.10 simonb orig_end = SQ_PREVRX(sc->sc_nextrx);
1017 1.26 rumble sc->sc_rxdesc[orig_end].hpc3_hdd_ctl &= ~HPC3_HDD_CTL_EOCHAIN;
1018 1.10 simonb SQ_CDRXSYNC(sc, orig_end, BUS_DMASYNC_PREREAD |
1019 1.10 simonb BUS_DMASYNC_PREWRITE);
1020 1.1 thorpej
1021 1.10 simonb sc->sc_nextrx = i;
1022 1.1 thorpej }
1023 1.1 thorpej
1024 1.24 rumble status = sq_hpc_read(sc, sc->hpc_regs->enetr_ctl);
1025 1.1 thorpej
1026 1.1 thorpej /* If receive channel is stopped, restart it... */
1027 1.20 sekiya if ((status & sc->hpc_regs->enetr_ctl_active) == 0) {
1028 1.10 simonb /* Pass the start of the receive ring to the HPC */
1029 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_ndbp, SQ_CDRXADDR(sc,
1030 1.24 rumble sc->sc_nextrx));
1031 1.10 simonb
1032 1.10 simonb /* And turn on the HPC ethernet receive channel */
1033 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_ctl,
1034 1.24 rumble sc->hpc_regs->enetr_ctl_active);
1035 1.1 thorpej }
1036 1.1 thorpej
1037 1.1 thorpej return count;
1038 1.1 thorpej }
1039 1.1 thorpej
1040 1.1 thorpej static int
1041 1.1 thorpej sq_txintr(struct sq_softc *sc)
1042 1.1 thorpej {
1043 1.20 sekiya int shift = 0;
1044 1.24 rumble u_int32_t status, tmp;
1045 1.1 thorpej struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1046 1.1 thorpej
1047 1.20 sekiya if (sc->hpc_regs->revision != 3)
1048 1.20 sekiya shift = 16;
1049 1.24 rumble
1050 1.24 rumble status = sq_hpc_read(sc, sc->hpc_regs->enetx_ctl) >> shift;
1051 1.1 thorpej
1052 1.22 rumble SQ_TRACE(SQ_TXINTR_ENTER, sc, sc->sc_prevtx, status);
1053 1.24 rumble
1054 1.24 rumble tmp = (sc->hpc_regs->enetx_ctl_active >> shift) | TXSTAT_GOOD;
1055 1.24 rumble if ((status & tmp) == 0) {
1056 1.10 simonb if (status & TXSTAT_COLL)
1057 1.10 simonb ifp->if_collisions++;
1058 1.1 thorpej
1059 1.1 thorpej if (status & TXSTAT_UFLOW) {
1060 1.10 simonb printf("%s: transmit underflow\n", sc->sc_dev.dv_xname);
1061 1.10 simonb ifp->if_oerrors++;
1062 1.1 thorpej }
1063 1.1 thorpej
1064 1.1 thorpej if (status & TXSTAT_16COLL) {
1065 1.23 rumble printf("%s: max collisions reached\n",
1066 1.23 rumble sc->sc_dev.dv_xname);
1067 1.10 simonb ifp->if_oerrors++;
1068 1.10 simonb ifp->if_collisions += 16;
1069 1.1 thorpej }
1070 1.1 thorpej }
1071 1.1 thorpej
1072 1.23 rumble /* prevtx now points to next xmit packet not yet finished */
1073 1.23 rumble if (sc->hpc_regs->revision == 3)
1074 1.23 rumble sq_txring_hpc3(sc);
1075 1.23 rumble else
1076 1.23 rumble sq_txring_hpc1(sc);
1077 1.23 rumble
1078 1.23 rumble /* If we have buffers free, let upper layers know */
1079 1.23 rumble if (sc->sc_nfreetx > 0)
1080 1.23 rumble ifp->if_flags &= ~IFF_OACTIVE;
1081 1.23 rumble
1082 1.23 rumble /* If all packets have left the coop, cancel watchdog */
1083 1.23 rumble if (sc->sc_nfreetx == SQ_NTXDESC)
1084 1.23 rumble ifp->if_timer = 0;
1085 1.23 rumble
1086 1.23 rumble SQ_TRACE(SQ_TXINTR_EXIT, sc, sc->sc_prevtx, status);
1087 1.23 rumble sq_start(ifp);
1088 1.23 rumble
1089 1.23 rumble return 1;
1090 1.23 rumble }
1091 1.23 rumble
1092 1.23 rumble /*
1093 1.23 rumble * Reclaim used transmit descriptors and restart the transmit DMA
1094 1.23 rumble * engine if necessary.
1095 1.23 rumble */
1096 1.23 rumble static void
1097 1.23 rumble sq_txring_hpc1(struct sq_softc *sc)
1098 1.23 rumble {
1099 1.23 rumble /*
1100 1.23 rumble * HPC1 doesn't tag transmitted descriptors, however,
1101 1.23 rumble * the NDBP register points to the next descriptor that
1102 1.23 rumble * has not yet been processed. If DMA is not in progress,
1103 1.23 rumble * we can safely reclaim all descriptors up to NDBP, and,
1104 1.23 rumble * if necessary, restart DMA at NDBP. Otherwise, if DMA
1105 1.23 rumble * is active, we can only safely reclaim up to CBP.
1106 1.23 rumble *
1107 1.23 rumble * For now, we'll only reclaim on inactive DMA and assume
1108 1.23 rumble * that a sufficiently large ring keeps us out of trouble.
1109 1.23 rumble */
1110 1.23 rumble u_int32_t reclaimto, status;
1111 1.23 rumble int reclaimall, i = sc->sc_prevtx;
1112 1.23 rumble struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1113 1.23 rumble
1114 1.24 rumble status = sq_hpc_read(sc, HPC1_ENETX_CTL);
1115 1.23 rumble if (status & HPC1_ENETX_CTL_ACTIVE) {
1116 1.23 rumble SQ_TRACE(SQ_TXINTR_BUSY, sc, i, status);
1117 1.23 rumble return;
1118 1.24 rumble } else
1119 1.24 rumble reclaimto = sq_hpc_read(sc, HPC1_ENETX_NDBP);
1120 1.23 rumble
1121 1.23 rumble if (sc->sc_nfreetx == 0 && SQ_CDTXADDR(sc, i) == reclaimto)
1122 1.23 rumble reclaimall = 1;
1123 1.23 rumble else
1124 1.23 rumble reclaimall = 0;
1125 1.23 rumble
1126 1.23 rumble while (sc->sc_nfreetx < SQ_NTXDESC) {
1127 1.23 rumble if (SQ_CDTXADDR(sc, i) == reclaimto && !reclaimall)
1128 1.23 rumble break;
1129 1.23 rumble
1130 1.23 rumble SQ_CDTXSYNC(sc, i, sc->sc_txmap[i]->dm_nsegs,
1131 1.23 rumble BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1132 1.23 rumble
1133 1.23 rumble /* Sync the packet data, unload DMA map, free mbuf */
1134 1.23 rumble bus_dmamap_sync(sc->sc_dmat, sc->sc_txmap[i], 0,
1135 1.23 rumble sc->sc_txmap[i]->dm_mapsize,
1136 1.23 rumble BUS_DMASYNC_POSTWRITE);
1137 1.23 rumble bus_dmamap_unload(sc->sc_dmat, sc->sc_txmap[i]);
1138 1.23 rumble m_freem(sc->sc_txmbuf[i]);
1139 1.23 rumble sc->sc_txmbuf[i] = NULL;
1140 1.23 rumble
1141 1.23 rumble ifp->if_opackets++;
1142 1.23 rumble sc->sc_nfreetx++;
1143 1.23 rumble
1144 1.23 rumble SQ_TRACE(SQ_DONE_DMA, sc, i, status);
1145 1.23 rumble
1146 1.23 rumble i = SQ_NEXTTX(i);
1147 1.23 rumble }
1148 1.23 rumble
1149 1.23 rumble if (sc->sc_nfreetx < SQ_NTXDESC) {
1150 1.23 rumble SQ_TRACE(SQ_RESTART_DMA, sc, i, status);
1151 1.23 rumble
1152 1.23 rumble KASSERT(reclaimto == SQ_CDTXADDR(sc, i));
1153 1.23 rumble
1154 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CFXBP, reclaimto);
1155 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CBP, reclaimto);
1156 1.23 rumble
1157 1.23 rumble /* Kick DMA channel into life */
1158 1.24 rumble sq_hpc_write(sc, HPC1_ENETX_CTL, HPC1_ENETX_CTL_ACTIVE);
1159 1.23 rumble
1160 1.23 rumble /*
1161 1.23 rumble * Set a watchdog timer in case the chip
1162 1.23 rumble * flakes out.
1163 1.23 rumble */
1164 1.23 rumble ifp->if_timer = 5;
1165 1.23 rumble }
1166 1.23 rumble
1167 1.23 rumble sc->sc_prevtx = i;
1168 1.23 rumble }
1169 1.23 rumble
1170 1.23 rumble /*
1171 1.23 rumble * Reclaim used transmit descriptors and restart the transmit DMA
1172 1.23 rumble * engine if necessary.
1173 1.23 rumble */
1174 1.23 rumble static void
1175 1.23 rumble sq_txring_hpc3(struct sq_softc *sc)
1176 1.23 rumble {
1177 1.23 rumble /*
1178 1.23 rumble * HPC3 tags descriptors with a bit once they've been
1179 1.23 rumble * transmitted. We need only free each XMITDONE'd
1180 1.23 rumble * descriptor, and restart the DMA engine if any
1181 1.23 rumble * descriptors are left over.
1182 1.23 rumble */
1183 1.23 rumble int i;
1184 1.23 rumble u_int32_t status = 0;
1185 1.23 rumble struct ifnet *ifp = &sc->sc_ethercom.ec_if;
1186 1.23 rumble
1187 1.1 thorpej i = sc->sc_prevtx;
1188 1.1 thorpej while (sc->sc_nfreetx < SQ_NTXDESC) {
1189 1.10 simonb /*
1190 1.10 simonb * Check status first so we don't end up with a case of
1191 1.2 rafal * the buffer not being finished while the DMA channel
1192 1.2 rafal * has gone idle.
1193 1.2 rafal */
1194 1.26 rumble status = sq_hpc_read(sc, HPC3_ENETX_CTL);
1195 1.2 rafal
1196 1.1 thorpej SQ_CDTXSYNC(sc, i, sc->sc_txmap[i]->dm_nsegs,
1197 1.1 thorpej BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
1198 1.1 thorpej
1199 1.23 rumble /* Check for used descriptor and restart DMA chain if needed */
1200 1.26 rumble if (!(sc->sc_txdesc[i].hpc3_hdd_ctl & HPC3_HDD_CTL_XMITDONE)) {
1201 1.26 rumble if ((status & HPC3_ENETX_CTL_ACTIVE) == 0) {
1202 1.22 rumble SQ_TRACE(SQ_RESTART_DMA, sc, i, status);
1203 1.1 thorpej
1204 1.26 rumble sq_hpc_write(sc, HPC3_ENETX_NDBP,
1205 1.24 rumble SQ_CDTXADDR(sc, i));
1206 1.1 thorpej
1207 1.10 simonb /* Kick DMA channel into life */
1208 1.26 rumble sq_hpc_write(sc, HPC3_ENETX_CTL,
1209 1.26 rumble HPC3_ENETX_CTL_ACTIVE);
1210 1.1 thorpej
1211 1.10 simonb /*
1212 1.10 simonb * Set a watchdog timer in case the chip
1213 1.10 simonb * flakes out.
1214 1.10 simonb */
1215 1.10 simonb ifp->if_timer = 5;
1216 1.23 rumble } else
1217 1.22 rumble SQ_TRACE(SQ_TXINTR_BUSY, sc, i, status);
1218 1.10 simonb break;
1219 1.1 thorpej }
1220 1.1 thorpej
1221 1.1 thorpej /* Sync the packet data, unload DMA map, free mbuf */
1222 1.10 simonb bus_dmamap_sync(sc->sc_dmat, sc->sc_txmap[i], 0,
1223 1.10 simonb sc->sc_txmap[i]->dm_mapsize,
1224 1.1 thorpej BUS_DMASYNC_POSTWRITE);
1225 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, sc->sc_txmap[i]);
1226 1.1 thorpej m_freem(sc->sc_txmbuf[i]);
1227 1.1 thorpej sc->sc_txmbuf[i] = NULL;
1228 1.1 thorpej
1229 1.1 thorpej ifp->if_opackets++;
1230 1.1 thorpej sc->sc_nfreetx++;
1231 1.1 thorpej
1232 1.22 rumble SQ_TRACE(SQ_DONE_DMA, sc, i, status);
1233 1.1 thorpej i = SQ_NEXTTX(i);
1234 1.1 thorpej }
1235 1.1 thorpej
1236 1.23 rumble sc->sc_prevtx = i;
1237 1.1 thorpej }
1238 1.1 thorpej
1239 1.10 simonb void
1240 1.1 thorpej sq_reset(struct sq_softc *sc)
1241 1.1 thorpej {
1242 1.1 thorpej /* Stop HPC dma channels */
1243 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_ctl, 0);
1244 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetx_ctl, 0);
1245 1.1 thorpej
1246 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_reset, 3);
1247 1.10 simonb delay(20);
1248 1.24 rumble sq_hpc_write(sc, sc->hpc_regs->enetr_reset, 0);
1249 1.1 thorpej }
1250 1.1 thorpej
1251 1.10 simonb /* sq_add_rxbuf: Add a receive buffer to the indicated descriptor. */
1252 1.1 thorpej int
1253 1.1 thorpej sq_add_rxbuf(struct sq_softc *sc, int idx)
1254 1.1 thorpej {
1255 1.1 thorpej int err;
1256 1.1 thorpej struct mbuf *m;
1257 1.1 thorpej
1258 1.1 thorpej MGETHDR(m, M_DONTWAIT, MT_DATA);
1259 1.1 thorpej if (m == NULL)
1260 1.1 thorpej return (ENOBUFS);
1261 1.1 thorpej
1262 1.1 thorpej MCLGET(m, M_DONTWAIT);
1263 1.1 thorpej if ((m->m_flags & M_EXT) == 0) {
1264 1.1 thorpej m_freem(m);
1265 1.1 thorpej return (ENOBUFS);
1266 1.1 thorpej }
1267 1.1 thorpej
1268 1.1 thorpej if (sc->sc_rxmbuf[idx] != NULL)
1269 1.1 thorpej bus_dmamap_unload(sc->sc_dmat, sc->sc_rxmap[idx]);
1270 1.1 thorpej
1271 1.1 thorpej sc->sc_rxmbuf[idx] = m;
1272 1.1 thorpej
1273 1.10 simonb if ((err = bus_dmamap_load(sc->sc_dmat, sc->sc_rxmap[idx],
1274 1.10 simonb m->m_ext.ext_buf, m->m_ext.ext_size,
1275 1.1 thorpej NULL, BUS_DMA_NOWAIT)) != 0) {
1276 1.1 thorpej printf("%s: can't load rx DMA map %d, error = %d\n",
1277 1.1 thorpej sc->sc_dev.dv_xname, idx, err);
1278 1.1 thorpej panic("sq_add_rxbuf"); /* XXX */
1279 1.1 thorpej }
1280 1.1 thorpej
1281 1.10 simonb bus_dmamap_sync(sc->sc_dmat, sc->sc_rxmap[idx], 0,
1282 1.1 thorpej sc->sc_rxmap[idx]->dm_mapsize, BUS_DMASYNC_PREREAD);
1283 1.1 thorpej
1284 1.1 thorpej SQ_INIT_RXDESC(sc, idx);
1285 1.1 thorpej
1286 1.1 thorpej return 0;
1287 1.1 thorpej }
1288 1.1 thorpej
1289 1.10 simonb void
1290 1.1 thorpej sq_dump_buffer(u_int32_t addr, u_int32_t len)
1291 1.1 thorpej {
1292 1.15 thorpej u_int i;
1293 1.1 thorpej u_char* physaddr = (char*) MIPS_PHYS_TO_KSEG1((caddr_t)addr);
1294 1.1 thorpej
1295 1.10 simonb if (len == 0)
1296 1.1 thorpej return;
1297 1.1 thorpej
1298 1.1 thorpej printf("%p: ", physaddr);
1299 1.1 thorpej
1300 1.24 rumble for (i = 0; i < len; i++) {
1301 1.1 thorpej printf("%02x ", *(physaddr + i) & 0xff);
1302 1.1 thorpej if ((i % 16) == 15 && i != len - 1)
1303 1.1 thorpej printf("\n%p: ", physaddr + i);
1304 1.1 thorpej }
1305 1.1 thorpej
1306 1.1 thorpej printf("\n");
1307 1.1 thorpej }
1308 1.1 thorpej
1309 1.10 simonb void
1310 1.1 thorpej enaddr_aton(const char* str, u_int8_t* eaddr)
1311 1.1 thorpej {
1312 1.1 thorpej int i;
1313 1.1 thorpej char c;
1314 1.1 thorpej
1315 1.24 rumble for (i = 0; i < ETHER_ADDR_LEN; i++) {
1316 1.1 thorpej if (*str == ':')
1317 1.1 thorpej str++;
1318 1.1 thorpej
1319 1.1 thorpej c = *str++;
1320 1.1 thorpej if (isdigit(c)) {
1321 1.1 thorpej eaddr[i] = (c - '0');
1322 1.1 thorpej } else if (isxdigit(c)) {
1323 1.1 thorpej eaddr[i] = (toupper(c) + 10 - 'A');
1324 1.1 thorpej }
1325 1.1 thorpej
1326 1.1 thorpej c = *str++;
1327 1.1 thorpej if (isdigit(c)) {
1328 1.1 thorpej eaddr[i] = (eaddr[i] << 4) | (c - '0');
1329 1.1 thorpej } else if (isxdigit(c)) {
1330 1.1 thorpej eaddr[i] = (eaddr[i] << 4) | (toupper(c) + 10 - 'A');
1331 1.1 thorpej }
1332 1.1 thorpej }
1333 1.1 thorpej }
1334