if_le.c revision 1.20 1 1.20 cgd /* $NetBSD: if_le.c,v 1.20 1994/10/26 07:24:21 cgd Exp $ */
2 1.20 cgd
3 1.1 cgd /*
4 1.1 cgd * Copyright (c) 1982, 1990 The Regents of the University of California.
5 1.1 cgd * All rights reserved.
6 1.1 cgd *
7 1.1 cgd * Redistribution and use in source and binary forms, with or without
8 1.1 cgd * modification, are permitted provided that the following conditions
9 1.1 cgd * are met:
10 1.1 cgd * 1. Redistributions of source code must retain the above copyright
11 1.1 cgd * notice, this list of conditions and the following disclaimer.
12 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 cgd * notice, this list of conditions and the following disclaimer in the
14 1.1 cgd * documentation and/or other materials provided with the distribution.
15 1.1 cgd * 3. All advertising materials mentioning features or use of this software
16 1.1 cgd * must display the following acknowledgement:
17 1.1 cgd * This product includes software developed by the University of
18 1.1 cgd * California, Berkeley and its contributors.
19 1.1 cgd * 4. Neither the name of the University nor the names of its contributors
20 1.1 cgd * may be used to endorse or promote products derived from this software
21 1.1 cgd * without specific prior written permission.
22 1.1 cgd *
23 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 1.1 cgd * SUCH DAMAGE.
34 1.1 cgd *
35 1.20 cgd * @(#)if_le.c 7.6 (Berkeley) 5/8/91
36 1.1 cgd */
37 1.1 cgd
38 1.1 cgd #include "le.h"
39 1.1 cgd #if NLE > 0
40 1.1 cgd
41 1.1 cgd #include "bpfilter.h"
42 1.1 cgd
43 1.1 cgd /*
44 1.1 cgd * AMD 7990 LANCE
45 1.5 mycroft */
46 1.5 mycroft #include <sys/param.h>
47 1.5 mycroft #include <sys/systm.h>
48 1.5 mycroft #include <sys/kernel.h>
49 1.5 mycroft #include <sys/mbuf.h>
50 1.5 mycroft #include <sys/buf.h>
51 1.5 mycroft #include <sys/socket.h>
52 1.5 mycroft #include <sys/syslog.h>
53 1.5 mycroft #include <sys/ioctl.h>
54 1.5 mycroft #include <sys/malloc.h>
55 1.5 mycroft #include <sys/errno.h>
56 1.5 mycroft
57 1.5 mycroft #include <net/if.h>
58 1.5 mycroft #include <net/netisr.h>
59 1.5 mycroft #include <net/route.h>
60 1.5 mycroft #if NBPFILTER > 0
61 1.5 mycroft #include <net/bpf.h>
62 1.5 mycroft #include <net/bpfdesc.h>
63 1.5 mycroft #endif
64 1.1 cgd
65 1.1 cgd #ifdef INET
66 1.5 mycroft #include <netinet/in.h>
67 1.5 mycroft #include <netinet/in_systm.h>
68 1.5 mycroft #include <netinet/in_var.h>
69 1.5 mycroft #include <netinet/ip.h>
70 1.5 mycroft #include <netinet/if_ether.h>
71 1.1 cgd #endif
72 1.1 cgd
73 1.1 cgd #ifdef NS
74 1.5 mycroft #include <netns/ns.h>
75 1.5 mycroft #include <netns/ns_if.h>
76 1.1 cgd #endif
77 1.1 cgd
78 1.5 mycroft #include <machine/cpu.h>
79 1.18 mycroft #include <machine/mtpr.h>
80 1.5 mycroft #include <hp300/hp300/isr.h>
81 1.18 mycroft #ifdef USELEDS
82 1.18 mycroft #include <hp300/hp300/led.h>
83 1.18 mycroft #endif
84 1.1 cgd
85 1.5 mycroft #include <hp300/dev/device.h>
86 1.5 mycroft #include <hp300/dev/if_lereg.h>
87 1.1 cgd
88 1.13 mycroft
89 1.13 mycroft #define ETHER_MIN_LEN 64
90 1.13 mycroft #define ETHER_MAX_LEN 1518
91 1.13 mycroft #define ETHER_ADDR_LEN 6
92 1.13 mycroft
93 1.13 mycroft
94 1.1 cgd /* offsets for: ID, REGS, MEM, NVRAM */
95 1.1 cgd int lestd[] = { 0, 0x4000, 0x8000, 0xC008 };
96 1.1 cgd
97 1.1 cgd struct isr le_isr[NLE];
98 1.1 cgd
99 1.1 cgd /*
100 1.1 cgd * Ethernet software status per interface.
101 1.1 cgd *
102 1.1 cgd * Each interface is referenced by a network interface structure,
103 1.13 mycroft * arpcom.ac_if, which the routing code uses to locate the interface.
104 1.1 cgd * This structure contains the output queue for the interface, its address, ...
105 1.1 cgd */
106 1.1 cgd struct le_softc {
107 1.13 mycroft struct arpcom sc_arpcom; /* common Ethernet structures */
108 1.13 mycroft struct lereg0 *sc_r0; /* DIO registers */
109 1.13 mycroft struct lereg1 *sc_r1; /* LANCE registers */
110 1.13 mycroft void *sc_mem;
111 1.13 mycroft struct init_block *sc_init;
112 1.13 mycroft struct mds *sc_rd, *sc_td;
113 1.13 mycroft u_char *sc_rbuf, *sc_tbuf;
114 1.13 mycroft int sc_last_rd, sc_last_td;
115 1.13 mycroft int sc_no_td;
116 1.13 mycroft #ifdef LEDEBUG
117 1.13 mycroft int sc_debug;
118 1.13 mycroft #endif
119 1.1 cgd } le_softc[NLE];
120 1.1 cgd
121 1.13 mycroft int leintr __P((int));
122 1.13 mycroft int leioctl __P((struct ifnet *, int, caddr_t));
123 1.13 mycroft int lestart __P((struct ifnet *));
124 1.13 mycroft int lewatchdog __P((/* short */));
125 1.13 mycroft static inline void lewrcsr __P((/* struct le_softc *, u_short, u_short */));
126 1.13 mycroft static inline u_short lerdcsr __P((/* struct le_softc *, u_short */));
127 1.13 mycroft void leinit __P((struct le_softc *));
128 1.13 mycroft void lememinit __P((struct le_softc *));
129 1.13 mycroft void lereset __P((struct le_softc *));
130 1.13 mycroft void lestop __P((struct le_softc *));
131 1.13 mycroft void letint __P((int));
132 1.13 mycroft void lerint __P((int));
133 1.13 mycroft void leread __P((struct le_softc *, u_char *, int));
134 1.13 mycroft struct mbuf *leget __P((u_char *, int, struct ifnet *));
135 1.13 mycroft #ifdef LEDEBUG
136 1.13 mycroft void recv_print __P((struct le_softc *, int));
137 1.13 mycroft void xmit_print __P((struct le_softc *, int));
138 1.13 mycroft #endif
139 1.13 mycroft void lesetladrf __P((struct arpcom *, u_long *));
140 1.1 cgd
141 1.8 mycroft int leattach __P((struct hp_device *));
142 1.8 mycroft
143 1.8 mycroft struct driver ledriver = {
144 1.8 mycroft leattach, "le",
145 1.8 mycroft };
146 1.8 mycroft
147 1.13 mycroft static inline void
148 1.13 mycroft lewrcsr(sc, port, val)
149 1.13 mycroft struct le_softc *sc;
150 1.13 mycroft register u_short port;
151 1.13 mycroft register u_short val;
152 1.13 mycroft {
153 1.13 mycroft register struct lereg0 *ler0 = sc->sc_r0;
154 1.13 mycroft register struct lereg1 *ler1 = sc->sc_r1;
155 1.13 mycroft
156 1.13 mycroft do {
157 1.13 mycroft ler1->ler1_rap = port;
158 1.13 mycroft } while ((ler0->ler0_status & LE_ACK) == 0);
159 1.13 mycroft do {
160 1.13 mycroft ler1->ler1_rdp = val;
161 1.13 mycroft } while ((ler0->ler0_status & LE_ACK) == 0);
162 1.13 mycroft }
163 1.13 mycroft
164 1.13 mycroft static inline u_short
165 1.13 mycroft lerdcsr(sc, port)
166 1.13 mycroft struct le_softc *sc;
167 1.13 mycroft register u_short port;
168 1.13 mycroft {
169 1.13 mycroft register struct lereg0 *ler0 = sc->sc_r0;
170 1.13 mycroft register struct lereg1 *ler1 = sc->sc_r1;
171 1.13 mycroft register u_short val;
172 1.13 mycroft
173 1.13 mycroft do {
174 1.13 mycroft ler1->ler1_rap = port;
175 1.13 mycroft } while ((ler0->ler0_status & LE_ACK) == 0);
176 1.13 mycroft do {
177 1.13 mycroft val = ler1->ler1_rdp;
178 1.13 mycroft } while ((ler0->ler0_status & LE_ACK) == 0);
179 1.13 mycroft return (val);
180 1.13 mycroft }
181 1.13 mycroft
182 1.1 cgd /*
183 1.1 cgd * Interface exists: make available by filling in network interface
184 1.1 cgd * record. System will initialize the interface when it is ready
185 1.1 cgd * to accept packets.
186 1.1 cgd */
187 1.8 mycroft int
188 1.1 cgd leattach(hd)
189 1.1 cgd struct hp_device *hd;
190 1.1 cgd {
191 1.1 cgd register struct lereg0 *ler0;
192 1.5 mycroft struct le_softc *sc = &le_softc[hd->hp_unit];
193 1.13 mycroft struct ifnet *ifp = &sc->sc_arpcom.ac_if;
194 1.1 cgd char *cp;
195 1.1 cgd int i;
196 1.1 cgd
197 1.5 mycroft ler0 = sc->sc_r0 = (struct lereg0 *)(lestd[0] + (int)hd->hp_addr);
198 1.1 cgd if (ler0->ler0_id != LEID)
199 1.1 cgd return(0);
200 1.13 mycroft sc->sc_r1 = (struct lereg1 *)(lestd[1] + (int)hd->hp_addr);
201 1.13 mycroft sc->sc_mem = (void *)(lestd[2] + (int)hd->hp_addr);
202 1.1 cgd le_isr[hd->hp_unit].isr_intr = leintr;
203 1.1 cgd hd->hp_ipl = le_isr[hd->hp_unit].isr_ipl = LE_IPL(ler0->ler0_status);
204 1.1 cgd le_isr[hd->hp_unit].isr_arg = hd->hp_unit;
205 1.1 cgd ler0->ler0_id = 0xFF;
206 1.1 cgd DELAY(100);
207 1.1 cgd
208 1.1 cgd /*
209 1.1 cgd * Read the ethernet address off the board, one nibble at a time.
210 1.1 cgd */
211 1.1 cgd cp = (char *)(lestd[3] + (int)hd->hp_addr);
212 1.13 mycroft for (i = 0; i < sizeof(sc->sc_arpcom.ac_enaddr); i++) {
213 1.13 mycroft sc->sc_arpcom.ac_enaddr[i] = (*++cp & 0xF) << 4;
214 1.1 cgd cp++;
215 1.13 mycroft sc->sc_arpcom.ac_enaddr[i] |= *++cp & 0xF;
216 1.1 cgd cp++;
217 1.1 cgd }
218 1.1 cgd printf("le%d: hardware address %s\n", hd->hp_unit,
219 1.13 mycroft ether_sprintf(sc->sc_arpcom.ac_enaddr));
220 1.1 cgd
221 1.1 cgd isrlink(&le_isr[hd->hp_unit]);
222 1.1 cgd ler0->ler0_status = LE_IE;
223 1.1 cgd
224 1.1 cgd ifp->if_unit = hd->hp_unit;
225 1.1 cgd ifp->if_name = "le";
226 1.1 cgd ifp->if_output = ether_output;
227 1.1 cgd ifp->if_start = lestart;
228 1.13 mycroft ifp->if_ioctl = leioctl;
229 1.13 mycroft ifp->if_watchdog = lewatchdog;
230 1.10 mycroft ifp->if_flags =
231 1.10 mycroft IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS | IFF_MULTICAST;
232 1.13 mycroft
233 1.12 mycroft if_attach(ifp);
234 1.12 mycroft ether_ifattach(ifp);
235 1.13 mycroft
236 1.1 cgd #if NBPFILTER > 0
237 1.12 mycroft bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
238 1.1 cgd #endif
239 1.1 cgd return (1);
240 1.1 cgd }
241 1.1 cgd
242 1.5 mycroft void
243 1.13 mycroft lereset(sc)
244 1.13 mycroft struct le_softc *sc;
245 1.13 mycroft {
246 1.13 mycroft
247 1.13 mycroft leinit(sc);
248 1.13 mycroft }
249 1.13 mycroft
250 1.13 mycroft int
251 1.13 mycroft lewatchdog(unit)
252 1.13 mycroft short unit;
253 1.5 mycroft {
254 1.13 mycroft struct le_softc *sc = &le_softc[unit];
255 1.5 mycroft
256 1.13 mycroft log(LOG_ERR, "le%d: device timeout\n", unit);
257 1.13 mycroft ++sc->sc_arpcom.ac_if.if_oerrors;
258 1.13 mycroft lereset(sc);
259 1.13 mycroft }
260 1.5 mycroft
261 1.13 mycroft #define LANCE_ADDR(sc, a) \
262 1.13 mycroft ((u_long)(a) - (u_long)sc->sc_mem)
263 1.9 mycroft
264 1.13 mycroft /* LANCE initialization block set up. */
265 1.13 mycroft void
266 1.13 mycroft lememinit(sc)
267 1.13 mycroft register struct le_softc *sc;
268 1.13 mycroft {
269 1.13 mycroft struct ifnet *ifp = &sc->sc_arpcom.ac_if;
270 1.13 mycroft int i;
271 1.13 mycroft void *mem;
272 1.13 mycroft u_long a;
273 1.5 mycroft
274 1.13 mycroft /*
275 1.13 mycroft * At this point we assume that the memory allocated to the Lance is
276 1.13 mycroft * quadword aligned. If it isn't then the initialisation is going
277 1.13 mycroft * fail later on.
278 1.13 mycroft */
279 1.13 mycroft mem = sc->sc_mem;
280 1.5 mycroft
281 1.13 mycroft sc->sc_init = mem;
282 1.13 mycroft #if NBPFILTER > 0
283 1.13 mycroft if (ifp->if_flags & IFF_PROMISC)
284 1.13 mycroft sc->sc_init->mode = LE_NORMAL | LE_PROM;
285 1.13 mycroft else
286 1.13 mycroft #endif
287 1.13 mycroft sc->sc_init->mode = LE_NORMAL;
288 1.13 mycroft for (i = 0; i < ETHER_ADDR_LEN; i++)
289 1.13 mycroft sc->sc_init->padr[i] = sc->sc_arpcom.ac_enaddr[i^1];
290 1.13 mycroft lesetladrf(&sc->sc_arpcom, sc->sc_init->ladrf);
291 1.13 mycroft mem += sizeof(struct init_block);
292 1.13 mycroft
293 1.13 mycroft sc->sc_rd = mem;
294 1.13 mycroft a = LANCE_ADDR(sc, mem);
295 1.13 mycroft sc->sc_init->rdra = a;
296 1.13 mycroft sc->sc_init->rlen = ((a >> 16) & 0xff) | (RLEN << 13);
297 1.13 mycroft mem += NRBUF * sizeof(struct mds);
298 1.13 mycroft
299 1.13 mycroft sc->sc_td = mem;
300 1.13 mycroft a = LANCE_ADDR(sc, mem);
301 1.13 mycroft sc->sc_init->tdra = a;
302 1.13 mycroft sc->sc_init->tlen = ((a >> 16) & 0xff) | (TLEN << 13);
303 1.13 mycroft mem += NTBUF * sizeof(struct mds);
304 1.5 mycroft
305 1.13 mycroft /*
306 1.13 mycroft * Set up receive ring descriptors.
307 1.13 mycroft */
308 1.13 mycroft sc->sc_rbuf = mem;
309 1.13 mycroft for (i = 0; i < NRBUF; i++) {
310 1.13 mycroft a = LANCE_ADDR(sc, mem);
311 1.13 mycroft sc->sc_rd[i].addr = a;
312 1.13 mycroft sc->sc_rd[i].flags = ((a >> 16) & 0xff) | LE_OWN;
313 1.13 mycroft sc->sc_rd[i].bcnt = -BUFSIZE;
314 1.13 mycroft sc->sc_rd[i].mcnt = 0;
315 1.13 mycroft mem += BUFSIZE;
316 1.5 mycroft }
317 1.5 mycroft
318 1.13 mycroft /*
319 1.13 mycroft * Set up transmit ring descriptors.
320 1.13 mycroft */
321 1.13 mycroft sc->sc_tbuf = mem;
322 1.13 mycroft for (i = 0; i < NTBUF; i++) {
323 1.13 mycroft a = LANCE_ADDR(sc, mem);
324 1.13 mycroft sc->sc_td[i].addr = a;
325 1.13 mycroft sc->sc_td[i].flags= ((a >> 16) & 0xff);
326 1.13 mycroft sc->sc_td[i].bcnt = 0xf000;
327 1.13 mycroft sc->sc_td[i].mcnt = 0;
328 1.13 mycroft mem += BUFSIZE;
329 1.6 mycroft }
330 1.6 mycroft }
331 1.6 mycroft
332 1.8 mycroft void
333 1.13 mycroft lestop(sc)
334 1.13 mycroft struct le_softc *sc;
335 1.1 cgd {
336 1.1 cgd
337 1.13 mycroft lewrcsr(sc, 0, LE_STOP);
338 1.1 cgd }
339 1.1 cgd
340 1.1 cgd /*
341 1.13 mycroft * Initialization of interface; set up initialization block
342 1.13 mycroft * and transmit/receive descriptor rings.
343 1.1 cgd */
344 1.8 mycroft void
345 1.13 mycroft leinit(sc)
346 1.13 mycroft register struct le_softc *sc;
347 1.1 cgd {
348 1.13 mycroft struct ifnet *ifp = &sc->sc_arpcom.ac_if;
349 1.1 cgd int s;
350 1.13 mycroft register int timo;
351 1.13 mycroft u_long a;
352 1.1 cgd
353 1.13 mycroft /* Address not known. */
354 1.13 mycroft if (!ifp->if_addrlist)
355 1.1 cgd return;
356 1.13 mycroft
357 1.13 mycroft s = splimp();
358 1.13 mycroft
359 1.13 mycroft /* Don't want to get in a weird state. */
360 1.13 mycroft lewrcsr(sc, 0, LE_STOP);
361 1.13 mycroft DELAY(100);
362 1.13 mycroft
363 1.13 mycroft sc->sc_last_rd = sc->sc_last_td = sc->sc_no_td = 0;
364 1.13 mycroft
365 1.13 mycroft /* Set up LANCE init block. */
366 1.13 mycroft lememinit(sc);
367 1.13 mycroft
368 1.13 mycroft /* Turn on byte swapping. */
369 1.13 mycroft lewrcsr(sc, 3, LE_BSWP);
370 1.13 mycroft
371 1.13 mycroft /* Give LANCE the physical address of its init block. */
372 1.13 mycroft a = LANCE_ADDR(sc, sc->sc_init);
373 1.13 mycroft lewrcsr(sc, 1, a);
374 1.13 mycroft lewrcsr(sc, 2, (a >> 16) & 0xff);
375 1.13 mycroft
376 1.13 mycroft /* Try to initialize the LANCE. */
377 1.13 mycroft DELAY(100);
378 1.13 mycroft lewrcsr(sc, 0, LE_INIT);
379 1.13 mycroft
380 1.13 mycroft /* Wait for initialization to finish. */
381 1.13 mycroft for (timo = 100000; timo; timo--)
382 1.13 mycroft if (lerdcsr(sc, 0) & LE_IDON)
383 1.13 mycroft break;
384 1.13 mycroft
385 1.13 mycroft if (lerdcsr(sc, 0) & LE_IDON) {
386 1.13 mycroft /* Start the LANCE. */
387 1.13 mycroft lewrcsr(sc, 0, LE_INEA | LE_STRT | LE_IDON);
388 1.1 cgd ifp->if_flags |= IFF_RUNNING;
389 1.13 mycroft ifp->if_flags &= ~IFF_OACTIVE;
390 1.13 mycroft lestart(ifp);
391 1.13 mycroft } else
392 1.13 mycroft printf("le%d: card failed to initialize\n", ifp->if_unit);
393 1.13 mycroft
394 1.13 mycroft (void) splx(s);
395 1.1 cgd }
396 1.1 cgd
397 1.1 cgd /*
398 1.13 mycroft * Controller interrupt.
399 1.13 mycroft */
400 1.8 mycroft int
401 1.1 cgd leintr(unit)
402 1.13 mycroft int unit;
403 1.1 cgd {
404 1.5 mycroft register struct le_softc *sc = &le_softc[unit];
405 1.13 mycroft register u_short isr;
406 1.13 mycroft
407 1.13 mycroft isr = lerdcsr(sc, 0);
408 1.13 mycroft #ifdef LEDEBUG
409 1.13 mycroft if (sc->sc_debug)
410 1.13 mycroft printf("le%d: leintr entering with isr=%04x\n",
411 1.13 mycroft unit, isr);
412 1.13 mycroft #endif
413 1.13 mycroft if ((isr & LE_INTR) == 0)
414 1.13 mycroft return 0;
415 1.13 mycroft
416 1.13 mycroft do {
417 1.13 mycroft lewrcsr(sc, 0,
418 1.13 mycroft isr & (LE_INEA | LE_BABL | LE_MISS | LE_MERR |
419 1.13 mycroft LE_RINT | LE_TINT | LE_IDON));
420 1.13 mycroft if (isr & (LE_BABL | LE_CERR | LE_MISS | LE_MERR)) {
421 1.13 mycroft if (isr & LE_BABL) {
422 1.13 mycroft printf("le%d: BABL\n", unit);
423 1.13 mycroft sc->sc_arpcom.ac_if.if_oerrors++;
424 1.13 mycroft }
425 1.13 mycroft #if 0
426 1.13 mycroft if (isr & LE_CERR) {
427 1.13 mycroft printf("le%d: CERR\n", unit);
428 1.13 mycroft sc->sc_arpcom.ac_if.if_collisions++;
429 1.13 mycroft }
430 1.13 mycroft #endif
431 1.13 mycroft if (isr & LE_MISS) {
432 1.16 mycroft #if 0
433 1.13 mycroft printf("le%d: MISS\n", unit);
434 1.16 mycroft #endif
435 1.13 mycroft sc->sc_arpcom.ac_if.if_ierrors++;
436 1.13 mycroft }
437 1.13 mycroft if (isr & LE_MERR) {
438 1.13 mycroft printf("le%d: MERR\n", unit);
439 1.13 mycroft lereset(sc);
440 1.13 mycroft goto out;
441 1.13 mycroft }
442 1.13 mycroft }
443 1.1 cgd
444 1.13 mycroft if ((isr & LE_RXON) == 0) {
445 1.13 mycroft printf("le%d: receiver disabled\n", unit);
446 1.13 mycroft sc->sc_arpcom.ac_if.if_ierrors++;
447 1.13 mycroft lereset(sc);
448 1.13 mycroft goto out;
449 1.13 mycroft }
450 1.13 mycroft if ((isr & LE_TXON) == 0) {
451 1.13 mycroft printf("le%d: transmitter disabled\n", unit);
452 1.13 mycroft sc->sc_arpcom.ac_if.if_oerrors++;
453 1.5 mycroft lereset(sc);
454 1.13 mycroft goto out;
455 1.13 mycroft }
456 1.13 mycroft
457 1.13 mycroft if (isr & LE_RINT) {
458 1.13 mycroft /* Reset watchdog timer. */
459 1.13 mycroft sc->sc_arpcom.ac_if.if_timer = 0;
460 1.13 mycroft lerint(unit);
461 1.13 mycroft }
462 1.13 mycroft if (isr & LE_TINT) {
463 1.13 mycroft /* Reset watchdog timer. */
464 1.13 mycroft sc->sc_arpcom.ac_if.if_timer = 0;
465 1.13 mycroft letint(unit);
466 1.1 cgd }
467 1.13 mycroft
468 1.13 mycroft isr = lerdcsr(sc, 0);
469 1.13 mycroft } while ((isr & LE_INTR) != 0);
470 1.13 mycroft
471 1.13 mycroft #ifdef LEDEBUG
472 1.13 mycroft if (sc->sc_debug)
473 1.13 mycroft printf("le%d: leintr returning with isr=%04x\n",
474 1.13 mycroft unit, isr);
475 1.13 mycroft #endif
476 1.13 mycroft
477 1.13 mycroft out:
478 1.13 mycroft return 1;
479 1.1 cgd }
480 1.1 cgd
481 1.13 mycroft #define NEXTTDS \
482 1.13 mycroft if (++tmd == NTBUF) tmd=0, cdm=sc->sc_td; else ++cdm
483 1.13 mycroft
484 1.15 mycroft /*
485 1.15 mycroft * Setup output on interface.
486 1.15 mycroft * Get another datagram to send off of the interface queue, and map it to the
487 1.15 mycroft * interface before starting the output.
488 1.15 mycroft * Called only at splimp or interrupt level.
489 1.15 mycroft */
490 1.15 mycroft int
491 1.15 mycroft lestart(ifp)
492 1.15 mycroft struct ifnet *ifp;
493 1.15 mycroft {
494 1.15 mycroft register struct le_softc *sc = &le_softc[ifp->if_unit];
495 1.15 mycroft register int tmd;
496 1.15 mycroft struct mds *cdm;
497 1.15 mycroft struct mbuf *m0, *m;
498 1.15 mycroft u_char *buffer;
499 1.15 mycroft int len;
500 1.15 mycroft
501 1.15 mycroft if ((sc->sc_arpcom.ac_if.if_flags & (IFF_RUNNING | IFF_OACTIVE)) !=
502 1.15 mycroft IFF_RUNNING)
503 1.15 mycroft return;
504 1.15 mycroft
505 1.15 mycroft tmd = sc->sc_last_td;
506 1.15 mycroft cdm = &sc->sc_td[tmd];
507 1.15 mycroft
508 1.15 mycroft for (;;) {
509 1.15 mycroft if (sc->sc_no_td >= NTBUF) {
510 1.15 mycroft sc->sc_arpcom.ac_if.if_flags |= IFF_OACTIVE;
511 1.15 mycroft #ifdef LEDEBUG
512 1.15 mycroft if (sc->sc_debug)
513 1.15 mycroft printf("no_td = %d, last_td = %d\n", sc->sc_no_td,
514 1.15 mycroft sc->sc_last_td);
515 1.15 mycroft #endif
516 1.15 mycroft break;
517 1.15 mycroft }
518 1.15 mycroft
519 1.15 mycroft #ifdef LEDEBUG
520 1.15 mycroft if (cdm->flags & LE_OWN) {
521 1.15 mycroft sc->sc_arpcom.ac_if.if_flags |= IFF_OACTIVE;
522 1.15 mycroft printf("missing buffer, no_td = %d, last_td = %d\n",
523 1.15 mycroft sc->sc_no_td, sc->sc_last_td);
524 1.15 mycroft }
525 1.15 mycroft #endif
526 1.15 mycroft
527 1.15 mycroft IF_DEQUEUE(&sc->sc_arpcom.ac_if.if_snd, m);
528 1.15 mycroft if (!m)
529 1.15 mycroft break;
530 1.15 mycroft
531 1.15 mycroft ++sc->sc_no_td;
532 1.15 mycroft
533 1.15 mycroft /*
534 1.15 mycroft * Copy the mbuf chain into the transmit buffer.
535 1.15 mycroft */
536 1.15 mycroft buffer = sc->sc_tbuf + (BUFSIZE * sc->sc_last_td);
537 1.15 mycroft len = 0;
538 1.15 mycroft for (m0 = m; m; m = m->m_next) {
539 1.15 mycroft bcopy(mtod(m, caddr_t), buffer, m->m_len);
540 1.15 mycroft buffer += m->m_len;
541 1.15 mycroft len += m->m_len;
542 1.15 mycroft }
543 1.15 mycroft
544 1.15 mycroft #ifdef LEDEBUG
545 1.15 mycroft if (len > ETHER_MAX_LEN)
546 1.15 mycroft printf("packet length %d\n", len);
547 1.15 mycroft #endif
548 1.15 mycroft
549 1.15 mycroft #if NBPFILTER > 0
550 1.15 mycroft if (sc->sc_arpcom.ac_if.if_bpf)
551 1.15 mycroft bpf_mtap(sc->sc_arpcom.ac_if.if_bpf, m0);
552 1.15 mycroft #endif
553 1.15 mycroft
554 1.15 mycroft m_freem(m0);
555 1.15 mycroft len = max(len, ETHER_MIN_LEN);
556 1.15 mycroft
557 1.15 mycroft /*
558 1.15 mycroft * Init transmit registers, and set transmit start flag.
559 1.15 mycroft */
560 1.15 mycroft cdm->bcnt = -len;
561 1.15 mycroft cdm->mcnt = 0;
562 1.16 mycroft cdm->flags |= LE_OWN | LE_STP | LE_ENP;
563 1.15 mycroft
564 1.15 mycroft #ifdef LEDEBUG
565 1.15 mycroft if (sc->sc_debug)
566 1.15 mycroft xmit_print(sc, sc->sc_last_td);
567 1.15 mycroft #endif
568 1.15 mycroft
569 1.15 mycroft lewrcsr(sc, 0, LE_INEA | LE_TDMD);
570 1.15 mycroft
571 1.15 mycroft NEXTTDS;
572 1.15 mycroft }
573 1.15 mycroft
574 1.15 mycroft sc->sc_last_td = tmd;
575 1.15 mycroft }
576 1.15 mycroft
577 1.8 mycroft void
578 1.13 mycroft letint(unit)
579 1.13 mycroft int unit;
580 1.1 cgd {
581 1.13 mycroft register struct le_softc *sc = &le_softc[unit];
582 1.13 mycroft register int tmd = (sc->sc_last_td - sc->sc_no_td + NTBUF) % NTBUF;
583 1.13 mycroft struct mds *cdm = &sc->sc_td[tmd];
584 1.1 cgd
585 1.18 mycroft #ifdef USELEDS
586 1.18 mycroft if (inledcontrol == 0)
587 1.18 mycroft ledcontrol(0, 0, LED_LANXMT);
588 1.18 mycroft #endif
589 1.18 mycroft
590 1.13 mycroft if (cdm->flags & LE_OWN) {
591 1.13 mycroft /* Race condition with loop below. */
592 1.13 mycroft #ifdef LEDEBUG
593 1.13 mycroft if (sc->sc_debug)
594 1.13 mycroft printf("le%d: extra tint\n", unit);
595 1.13 mycroft #endif
596 1.1 cgd return;
597 1.1 cgd }
598 1.13 mycroft
599 1.13 mycroft sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
600 1.13 mycroft
601 1.6 mycroft do {
602 1.13 mycroft if (sc->sc_no_td <= 0)
603 1.13 mycroft break;
604 1.13 mycroft #ifdef LEDEBUG
605 1.13 mycroft if (sc->sc_debug)
606 1.13 mycroft printf("trans cdm = %x\n", cdm);
607 1.13 mycroft #endif
608 1.13 mycroft sc->sc_arpcom.ac_if.if_opackets++;
609 1.13 mycroft --sc->sc_no_td;
610 1.17 mycroft if (cdm->mcnt & (LE_TBUFF | LE_UFLO | LE_LCOL | LE_LCAR | LE_RTRY)) {
611 1.17 mycroft if (cdm->mcnt & LE_TBUFF)
612 1.13 mycroft printf("le%d: TBUFF\n", unit);
613 1.17 mycroft if ((cdm->mcnt & (LE_TBUFF | LE_UFLO)) == LE_UFLO)
614 1.13 mycroft printf("le%d: UFLO\n", unit);
615 1.17 mycroft if (cdm->mcnt & LE_UFLO) {
616 1.13 mycroft lereset(sc);
617 1.13 mycroft return;
618 1.13 mycroft }
619 1.13 mycroft #if 0
620 1.17 mycroft if (cdm->mcnt & LE_LCOL) {
621 1.13 mycroft printf("le%d: late collision\n", unit);
622 1.13 mycroft sc->sc_arpcom.ac_if.if_collisions++;
623 1.13 mycroft }
624 1.17 mycroft if (cdm->mcnt & LE_LCAR)
625 1.13 mycroft printf("le%d: lost carrier\n", unit);
626 1.17 mycroft if (cdm->mcnt & LE_RTRY) {
627 1.13 mycroft printf("le%d: excessive collisions, tdr %d\n",
628 1.17 mycroft unit, cdm->mcnt & 0x1ff);
629 1.17 mycroft sc->sc_arpcom.ac_if.if_collisions += 16;
630 1.13 mycroft }
631 1.13 mycroft #endif
632 1.17 mycroft } else if (cdm->flags & LE_ONE)
633 1.17 mycroft sc->sc_arpcom.ac_if.if_collisions++;
634 1.17 mycroft else if (cdm->flags & LE_MORE)
635 1.17 mycroft /* Real number is unknown. */
636 1.17 mycroft sc->sc_arpcom.ac_if.if_collisions += 2;
637 1.13 mycroft NEXTTDS;
638 1.13 mycroft } while ((cdm->flags & LE_OWN) == 0);
639 1.6 mycroft
640 1.13 mycroft lestart(&sc->sc_arpcom.ac_if);
641 1.13 mycroft }
642 1.6 mycroft
643 1.13 mycroft #define NEXTRDS \
644 1.13 mycroft if (++rmd == NRBUF) rmd=0, cdm=sc->sc_rd; else ++cdm
645 1.13 mycroft
646 1.13 mycroft /* only called from one place, so may as well integrate */
647 1.8 mycroft void
648 1.13 mycroft lerint(unit)
649 1.13 mycroft int unit;
650 1.1 cgd {
651 1.13 mycroft register struct le_softc *sc = &le_softc[unit];
652 1.13 mycroft register int rmd = sc->sc_last_rd;
653 1.13 mycroft struct mds *cdm = &sc->sc_rd[rmd];
654 1.18 mycroft
655 1.18 mycroft #ifdef USELEDS
656 1.18 mycroft if (inledcontrol == 0)
657 1.18 mycroft ledcontrol(0, 0, LED_LANRCV);
658 1.18 mycroft #endif
659 1.1 cgd
660 1.13 mycroft if (cdm->flags & LE_OWN) {
661 1.13 mycroft /* Race condition with loop below. */
662 1.13 mycroft #ifdef LEDEBUG
663 1.13 mycroft if (sc->sc_debug)
664 1.13 mycroft printf("le%d: extra rint\n", unit);
665 1.13 mycroft #endif
666 1.13 mycroft return;
667 1.1 cgd }
668 1.1 cgd
669 1.13 mycroft /* Process all buffers with valid data. */
670 1.13 mycroft do {
671 1.13 mycroft if (cdm->flags & (LE_FRAM | LE_OFLO | LE_CRC | LE_RBUFF)) {
672 1.13 mycroft if ((cdm->flags & (LE_FRAM | LE_OFLO | LE_ENP)) == (LE_FRAM | LE_ENP))
673 1.13 mycroft printf("le%d: FRAM\n", unit);
674 1.13 mycroft if ((cdm->flags & (LE_OFLO | LE_ENP)) == LE_OFLO)
675 1.13 mycroft printf("le%d: OFLO\n", unit);
676 1.13 mycroft if ((cdm->flags & (LE_CRC | LE_OFLO | LE_ENP)) == (LE_CRC | LE_ENP))
677 1.13 mycroft printf("le%d: CRC\n", unit);
678 1.13 mycroft if (cdm->flags & LE_RBUFF)
679 1.13 mycroft printf("le%d: RBUFF\n", unit);
680 1.13 mycroft } else if (cdm->flags & (LE_STP | LE_ENP) != (LE_STP | LE_ENP)) {
681 1.1 cgd do {
682 1.13 mycroft cdm->mcnt = 0;
683 1.16 mycroft cdm->flags |= LE_OWN;
684 1.13 mycroft NEXTRDS;
685 1.13 mycroft } while ((cdm->flags & (LE_OWN | LE_ERR | LE_STP | LE_ENP)) == 0);
686 1.13 mycroft sc->sc_last_rd = rmd;
687 1.13 mycroft printf("le%d: chained buffer\n", unit);
688 1.13 mycroft if ((cdm->flags & (LE_OWN | LE_ERR | LE_STP | LE_ENP)) != LE_ENP) {
689 1.5 mycroft lereset(sc);
690 1.1 cgd return;
691 1.1 cgd }
692 1.13 mycroft } else {
693 1.13 mycroft #ifdef LEDEBUG
694 1.13 mycroft if (sc->sc_debug)
695 1.13 mycroft recv_print(sc, sc->sc_last_rd);
696 1.13 mycroft #endif
697 1.13 mycroft leread(sc, sc->sc_rbuf + (BUFSIZE * rmd),
698 1.13 mycroft (int)cdm->mcnt);
699 1.13 mycroft sc->sc_arpcom.ac_if.if_ipackets++;
700 1.13 mycroft }
701 1.13 mycroft
702 1.13 mycroft cdm->mcnt = 0;
703 1.16 mycroft cdm->flags |= LE_OWN;
704 1.13 mycroft NEXTRDS;
705 1.13 mycroft #ifdef LEDEBUG
706 1.13 mycroft if (sc->sc_debug)
707 1.13 mycroft printf("sc->sc_last_rd = %x, cdm = %x\n",
708 1.13 mycroft sc->sc_last_rd, cdm);
709 1.13 mycroft #endif
710 1.13 mycroft } while ((cdm->flags & LE_OWN) == 0);
711 1.13 mycroft
712 1.13 mycroft sc->sc_last_rd = rmd;
713 1.1 cgd }
714 1.1 cgd
715 1.13 mycroft /*
716 1.13 mycroft * Pass a packet to the higher levels.
717 1.13 mycroft */
718 1.8 mycroft void
719 1.5 mycroft leread(sc, buf, len)
720 1.5 mycroft register struct le_softc *sc;
721 1.13 mycroft u_char *buf;
722 1.1 cgd int len;
723 1.1 cgd {
724 1.16 mycroft struct ifnet *ifp;
725 1.16 mycroft struct mbuf *m;
726 1.13 mycroft struct ether_header *eh;
727 1.13 mycroft
728 1.16 mycroft len -= 4;
729 1.13 mycroft if (len <= 0)
730 1.13 mycroft return;
731 1.1 cgd
732 1.13 mycroft /* Pull packet off interface. */
733 1.16 mycroft ifp = &sc->sc_arpcom.ac_if;
734 1.16 mycroft m = leget(buf, len, ifp);
735 1.13 mycroft if (m == 0)
736 1.1 cgd return;
737 1.5 mycroft
738 1.16 mycroft /* We assume that the header fit entirely in one mbuf. */
739 1.16 mycroft eh = mtod(m, struct ether_header *);
740 1.16 mycroft
741 1.1 cgd #if NBPFILTER > 0
742 1.1 cgd /*
743 1.13 mycroft * Check if there's a BPF listener on this interface.
744 1.13 mycroft * If so, hand off the raw packet to BPF.
745 1.1 cgd */
746 1.16 mycroft if (ifp->if_bpf) {
747 1.16 mycroft bpf_mtap(ifp->if_bpf, m);
748 1.13 mycroft
749 1.13 mycroft /*
750 1.13 mycroft * Note that the interface cannot be in promiscuous mode if
751 1.13 mycroft * there are no BPF listeners. And if we are in promiscuous
752 1.13 mycroft * mode, we have to check if this packet is really ours.
753 1.13 mycroft */
754 1.16 mycroft if ((ifp->if_flags & IFF_PROMISC) &&
755 1.13 mycroft (eh->ether_dhost[0] & 1) == 0 && /* !mcast and !bcast */
756 1.13 mycroft bcmp(eh->ether_dhost, sc->sc_arpcom.ac_enaddr,
757 1.13 mycroft sizeof(eh->ether_dhost)) != 0) {
758 1.13 mycroft m_freem(m);
759 1.1 cgd return;
760 1.13 mycroft }
761 1.1 cgd }
762 1.1 cgd #endif
763 1.5 mycroft
764 1.16 mycroft /* We assume that the header fit entirely in one mbuf. */
765 1.16 mycroft m->m_pkthdr.len -= sizeof(*eh);
766 1.16 mycroft m->m_len -= sizeof(*eh);
767 1.16 mycroft m->m_data += sizeof(*eh);
768 1.16 mycroft
769 1.16 mycroft ether_input(ifp, eh, m);
770 1.1 cgd }
771 1.1 cgd
772 1.1 cgd /*
773 1.13 mycroft * Supporting routines
774 1.1 cgd */
775 1.1 cgd
776 1.1 cgd /*
777 1.13 mycroft * Pull data off an interface.
778 1.13 mycroft * Len is length of data, with local net header stripped.
779 1.13 mycroft * We copy the data into mbufs. When full cluster sized units are present
780 1.13 mycroft * we copy into clusters.
781 1.1 cgd */
782 1.1 cgd struct mbuf *
783 1.13 mycroft leget(buf, totlen, ifp)
784 1.13 mycroft u_char *buf;
785 1.13 mycroft int totlen;
786 1.1 cgd struct ifnet *ifp;
787 1.1 cgd {
788 1.16 mycroft struct mbuf *top, **mp, *m;
789 1.13 mycroft int len;
790 1.1 cgd
791 1.1 cgd MGETHDR(m, M_DONTWAIT, MT_DATA);
792 1.1 cgd if (m == 0)
793 1.13 mycroft return 0;
794 1.1 cgd m->m_pkthdr.rcvif = ifp;
795 1.1 cgd m->m_pkthdr.len = totlen;
796 1.16 mycroft len = MHLEN;
797 1.13 mycroft top = 0;
798 1.13 mycroft mp = ⊤
799 1.1 cgd
800 1.1 cgd while (totlen > 0) {
801 1.1 cgd if (top) {
802 1.1 cgd MGET(m, M_DONTWAIT, MT_DATA);
803 1.1 cgd if (m == 0) {
804 1.1 cgd m_freem(top);
805 1.13 mycroft return 0;
806 1.1 cgd }
807 1.16 mycroft len = MLEN;
808 1.1 cgd }
809 1.16 mycroft if (totlen >= MINCLSIZE) {
810 1.1 cgd MCLGET(m, M_DONTWAIT);
811 1.1 cgd if (m->m_flags & M_EXT)
812 1.16 mycroft len = MCLBYTES;
813 1.1 cgd }
814 1.16 mycroft m->m_len = len = min(totlen, len);
815 1.16 mycroft bcopy((caddr_t)buf, mtod(m, caddr_t), len);
816 1.16 mycroft buf += len;
817 1.16 mycroft totlen -= len;
818 1.1 cgd *mp = m;
819 1.1 cgd mp = &m->m_next;
820 1.1 cgd }
821 1.13 mycroft
822 1.13 mycroft return top;
823 1.1 cgd }
824 1.1 cgd
825 1.1 cgd /*
826 1.1 cgd * Process an ioctl request.
827 1.1 cgd */
828 1.8 mycroft int
829 1.1 cgd leioctl(ifp, cmd, data)
830 1.1 cgd register struct ifnet *ifp;
831 1.1 cgd int cmd;
832 1.1 cgd caddr_t data;
833 1.1 cgd {
834 1.5 mycroft struct le_softc *sc = &le_softc[ifp->if_unit];
835 1.13 mycroft struct ifaddr *ifa = (struct ifaddr *)data;
836 1.13 mycroft struct ifreq *ifr = (struct ifreq *)data;
837 1.13 mycroft int s, error = 0;
838 1.13 mycroft
839 1.13 mycroft s = splimp();
840 1.1 cgd
841 1.1 cgd switch (cmd) {
842 1.1 cgd
843 1.1 cgd case SIOCSIFADDR:
844 1.1 cgd ifp->if_flags |= IFF_UP;
845 1.13 mycroft
846 1.1 cgd switch (ifa->ifa_addr->sa_family) {
847 1.1 cgd #ifdef INET
848 1.1 cgd case AF_INET:
849 1.13 mycroft leinit(sc); /* before arpwhohas */
850 1.13 mycroft /*
851 1.13 mycroft * See if another station has *our* IP address.
852 1.13 mycroft * i.e.: There is an address conflict! If a
853 1.13 mycroft * conflict exists, a message is sent to the
854 1.13 mycroft * console.
855 1.13 mycroft */
856 1.13 mycroft sc->sc_arpcom.ac_ipaddr = IA_SIN(ifa)->sin_addr;
857 1.13 mycroft arpwhohas(&sc->sc_arpcom, &IA_SIN(ifa)->sin_addr);
858 1.1 cgd break;
859 1.1 cgd #endif
860 1.1 cgd #ifdef NS
861 1.13 mycroft /* XXX - This code is probably wrong. */
862 1.1 cgd case AF_NS:
863 1.1 cgd {
864 1.13 mycroft register struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
865 1.1 cgd
866 1.1 cgd if (ns_nullhost(*ina))
867 1.13 mycroft ina->x_host =
868 1.13 mycroft *(union ns_host *)(sc->sc_arpcom.ac_enaddr);
869 1.13 mycroft else
870 1.13 mycroft bcopy(ina->x_host.c_host,
871 1.13 mycroft sc->sc_arpcom.ac_enaddr,
872 1.13 mycroft sizeof(sc->sc_arpcom.ac_enaddr));
873 1.13 mycroft /* Set new address. */
874 1.13 mycroft leinit(sc);
875 1.1 cgd break;
876 1.1 cgd }
877 1.1 cgd #endif
878 1.1 cgd default:
879 1.13 mycroft leinit(sc);
880 1.1 cgd break;
881 1.1 cgd }
882 1.1 cgd break;
883 1.1 cgd
884 1.1 cgd case SIOCSIFFLAGS:
885 1.13 mycroft /*
886 1.13 mycroft * If interface is marked down and it is running, then stop it
887 1.13 mycroft */
888 1.1 cgd if ((ifp->if_flags & IFF_UP) == 0 &&
889 1.13 mycroft (ifp->if_flags & IFF_RUNNING) != 0) {
890 1.13 mycroft /*
891 1.13 mycroft * If interface is marked down and it is running, then
892 1.13 mycroft * stop it.
893 1.13 mycroft */
894 1.13 mycroft lestop(sc);
895 1.6 mycroft ifp->if_flags &= ~IFF_RUNNING;
896 1.13 mycroft } else if ((ifp->if_flags & IFF_UP) != 0 &&
897 1.13 mycroft (ifp->if_flags & IFF_RUNNING) == 0) {
898 1.13 mycroft /*
899 1.13 mycroft * If interface is marked up and it is stopped, then
900 1.13 mycroft * start it.
901 1.13 mycroft */
902 1.13 mycroft leinit(sc);
903 1.13 mycroft } else {
904 1.13 mycroft /*
905 1.13 mycroft * Reset the interface to pick up changes in any other
906 1.13 mycroft * flags that affect hardware registers.
907 1.13 mycroft */
908 1.13 mycroft /*lestop(sc);*/
909 1.13 mycroft leinit(sc);
910 1.1 cgd }
911 1.13 mycroft #ifdef LEDEBUG
912 1.13 mycroft if (ifp->if_flags & IFF_DEBUG)
913 1.13 mycroft sc->sc_debug = 1;
914 1.13 mycroft else
915 1.13 mycroft sc->sc_debug = 0;
916 1.13 mycroft #endif
917 1.1 cgd break;
918 1.1 cgd
919 1.5 mycroft case SIOCADDMULTI:
920 1.13 mycroft case SIOCDELMULTI:
921 1.13 mycroft error = (cmd == SIOCADDMULTI) ?
922 1.13 mycroft ether_addmulti(ifr, &sc->sc_arpcom):
923 1.13 mycroft ether_delmulti(ifr, &sc->sc_arpcom);
924 1.5 mycroft
925 1.5 mycroft if (error == ENETRESET) {
926 1.5 mycroft /*
927 1.13 mycroft * Multicast list has changed; set the hardware filter
928 1.13 mycroft * accordingly.
929 1.5 mycroft */
930 1.13 mycroft leinit(sc);
931 1.5 mycroft error = 0;
932 1.5 mycroft }
933 1.5 mycroft break;
934 1.5 mycroft
935 1.1 cgd default:
936 1.1 cgd error = EINVAL;
937 1.1 cgd }
938 1.13 mycroft (void) splx(s);
939 1.13 mycroft return error;
940 1.1 cgd }
941 1.1 cgd
942 1.13 mycroft #ifdef LEDEBUG
943 1.8 mycroft void
944 1.13 mycroft recv_print(sc, no)
945 1.13 mycroft struct le_softc *sc;
946 1.13 mycroft int no;
947 1.13 mycroft {
948 1.13 mycroft struct mds *rmd;
949 1.13 mycroft int i, printed = 0;
950 1.13 mycroft u_short len;
951 1.13 mycroft
952 1.13 mycroft rmd = &sc->sc_rd[no];
953 1.13 mycroft len = rmd->mcnt;
954 1.13 mycroft printf("%s: receive buffer %d, len = %d\n", sc->sc_dev.dv_xname, no,
955 1.13 mycroft len);
956 1.13 mycroft printf("%s: status %x\n", sc->sc_dev.dv_xname, lerdcsr(sc, 0));
957 1.13 mycroft for (i = 0; i < len; i++) {
958 1.13 mycroft if (!printed) {
959 1.13 mycroft printed = 1;
960 1.13 mycroft printf("%s: data: ", sc->sc_dev.dv_xname);
961 1.13 mycroft }
962 1.13 mycroft printf("%x ", *(sc->sc_rbuf + (BUFSIZE*no) + i));
963 1.13 mycroft }
964 1.13 mycroft if (printed)
965 1.13 mycroft printf("\n");
966 1.13 mycroft }
967 1.13 mycroft
968 1.13 mycroft void
969 1.13 mycroft xmit_print(sc, no)
970 1.13 mycroft struct le_softc *sc;
971 1.13 mycroft int no;
972 1.13 mycroft {
973 1.13 mycroft struct mds *rmd;
974 1.13 mycroft int i, printed=0;
975 1.13 mycroft u_short len;
976 1.13 mycroft
977 1.13 mycroft rmd = &sc->sc_td[no];
978 1.13 mycroft len = -rmd->bcnt;
979 1.13 mycroft printf("%s: transmit buffer %d, len = %d\n", sc->sc_dev.dv_xname, no,
980 1.13 mycroft len);
981 1.13 mycroft printf("%s: status %x\n", sc->sc_dev.dv_xname, lerdcsr(sc, 0));
982 1.13 mycroft printf("%s: addr %x, flags %x, bcnt %x, mcnt %x\n",
983 1.13 mycroft sc->sc_dev.dv_xname, rmd->addr, rmd->flags, rmd->bcnt, rmd->mcnt);
984 1.13 mycroft for (i = 0; i < len; i++) {
985 1.13 mycroft if (!printed) {
986 1.13 mycroft printed = 1;
987 1.13 mycroft printf("%s: data: ", sc->sc_dev.dv_xname);
988 1.13 mycroft }
989 1.13 mycroft printf("%x ", *(sc->sc_tbuf + (BUFSIZE*no) + i));
990 1.13 mycroft }
991 1.13 mycroft if (printed)
992 1.13 mycroft printf("\n");
993 1.13 mycroft }
994 1.13 mycroft #endif /* LEDEBUG */
995 1.13 mycroft
996 1.13 mycroft /*
997 1.13 mycroft * Set up the logical address filter.
998 1.13 mycroft */
999 1.13 mycroft void
1000 1.13 mycroft lesetladrf(ac, af)
1001 1.13 mycroft struct arpcom *ac;
1002 1.13 mycroft u_long *af;
1003 1.1 cgd {
1004 1.13 mycroft struct ifnet *ifp = &ac->ac_if;
1005 1.13 mycroft struct ether_multi *enm;
1006 1.13 mycroft register u_char *cp, c;
1007 1.13 mycroft register u_long crc;
1008 1.13 mycroft register int i, len;
1009 1.13 mycroft struct ether_multistep step;
1010 1.1 cgd
1011 1.1 cgd /*
1012 1.13 mycroft * Set up multicast address filter by passing all multicast addresses
1013 1.13 mycroft * through a crc generator, and then using the high order 6 bits as an
1014 1.13 mycroft * index into the 64 bit logical address filter. The high order bit
1015 1.13 mycroft * selects the word, while the rest of the bits select the bit within
1016 1.13 mycroft * the word.
1017 1.1 cgd */
1018 1.1 cgd
1019 1.13 mycroft if (ifp->if_flags & IFF_PROMISC) {
1020 1.13 mycroft ifp->if_flags |= IFF_ALLMULTI;
1021 1.13 mycroft af[0] = af[1] = 0xffffffff;
1022 1.1 cgd return;
1023 1.13 mycroft }
1024 1.1 cgd
1025 1.13 mycroft af[0] = af[1] = 0;
1026 1.13 mycroft ETHER_FIRST_MULTI(step, ac, enm);
1027 1.13 mycroft while (enm != NULL) {
1028 1.13 mycroft if (bcmp(enm->enm_addrlo, enm->enm_addrhi,
1029 1.13 mycroft sizeof(enm->enm_addrlo)) != 0) {
1030 1.13 mycroft /*
1031 1.13 mycroft * We must listen to a range of multicast addresses.
1032 1.13 mycroft * For now, just accept all multicasts, rather than
1033 1.13 mycroft * trying to set only those filter bits needed to match
1034 1.13 mycroft * the range. (At this time, the only use of address
1035 1.13 mycroft * ranges is for IP multicast routing, for which the
1036 1.13 mycroft * range is big enough to require all bits set.)
1037 1.13 mycroft */
1038 1.13 mycroft ifp->if_flags |= IFF_ALLMULTI;
1039 1.13 mycroft af[0] = af[1] = 0xffffffff;
1040 1.13 mycroft return;
1041 1.13 mycroft }
1042 1.1 cgd
1043 1.13 mycroft cp = enm->enm_addrlo;
1044 1.13 mycroft crc = 0xffffffff;
1045 1.13 mycroft for (len = sizeof(enm->enm_addrlo); --len >= 0;) {
1046 1.13 mycroft c = *cp++;
1047 1.13 mycroft for (i = 8; --i >= 0;) {
1048 1.13 mycroft if ((crc & 0x01) ^ (c & 0x01)) {
1049 1.13 mycroft crc >>= 1;
1050 1.13 mycroft crc ^= 0x6db88320 | 0x80000000;
1051 1.13 mycroft } else
1052 1.13 mycroft crc >>= 1;
1053 1.13 mycroft c >>= 1;
1054 1.13 mycroft }
1055 1.13 mycroft }
1056 1.13 mycroft /* Just want the 6 most significant bits. */
1057 1.13 mycroft crc >>= 26;
1058 1.1 cgd
1059 1.13 mycroft /* Turn on the corresponding bit in the filter. */
1060 1.19 mycroft af[crc >> 5] |= 1 << ((crc & 0x1f) ^ 16);
1061 1.1 cgd
1062 1.13 mycroft ETHER_NEXT_MULTI(step, enm);
1063 1.13 mycroft }
1064 1.13 mycroft ifp->if_flags &= ~IFF_ALLMULTI;
1065 1.1 cgd }
1066 1.14 mycroft
1067 1.14 mycroft #endif /* NLE > 0 */
1068