if_eg.c revision 1.12 1 /* $NetBSD: if_eg.c,v 1.12 1995/04/17 12:08:53 cgd Exp $ */
2
3 /*
4 * Copyright (c) 1993 Dean Huxley <dean (at) fsa.ca>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Dean Huxley.
18 * 4. The name of Dean Huxley may not be used to endorse or promote products
19 * derived from this software without specific prior written permission.
20 *
21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33 /* To do:
34 * - multicast
35 * - promiscuous
36 */
37 #include "bpfilter.h"
38
39 #include <sys/types.h>
40 #include <sys/param.h>
41 #include <sys/mbuf.h>
42 #include <sys/socket.h>
43 #include <sys/ioctl.h>
44 #include <sys/errno.h>
45 #include <sys/syslog.h>
46 #include <sys/select.h>
47 #include <sys/device.h>
48
49 #include <net/if.h>
50 #include <net/netisr.h>
51 #include <net/if_dl.h>
52 #include <net/if_types.h>
53 #include <net/netisr.h>
54
55 #ifdef INET
56 #include <netinet/in.h>
57 #include <netinet/in_systm.h>
58 #include <netinet/in_var.h>
59 #include <netinet/ip.h>
60 #include <netinet/if_ether.h>
61 #endif
62
63 #ifdef NS
64 #include <netns/ns.h>
65 #include <netns/ns_if.h>
66 #endif
67
68 #if NBPFILTER > 0
69 #include <net/bpf.h>
70 #include <net/bpfdesc.h>
71 #endif
72
73 #include <machine/cpu.h>
74 #include <machine/pio.h>
75
76 #include <dev/isa/isavar.h>
77 #include <dev/isa/if_egreg.h>
78 #include <dev/isa/elink.h>
79
80 /* for debugging convenience */
81 #ifdef EGDEBUG
82 #define dprintf(x) printf x
83 #else
84 #define dprintf(x)
85 #endif
86
87 #define ETHER_MIN_LEN 64
88 #define ETHER_MAX_LEN 1518
89 #define ETHER_ADDR_LEN 6
90
91 #define EG_INLEN 10
92 #define EG_BUFLEN 0x0670
93
94 /*
95 * Ethernet software status per interface.
96 */
97 struct eg_softc {
98 struct device sc_dev;
99 void *sc_ih;
100 struct arpcom sc_arpcom; /* Ethernet common part */
101 int eg_cmd; /* Command register R/W */
102 int eg_ctl; /* Control register R/W (EG_CTL_*) */
103 int eg_stat; /* Status register R/O (EG_STAT_*) */
104 int eg_data; /* Data register R/W (16 bits) */
105 u_char eg_rom_major; /* Cards ROM version (major number) */
106 u_char eg_rom_minor; /* Cards ROM version (minor number) */
107 short eg_ram; /* Amount of RAM on the card */
108 u_char eg_pcb[64]; /* Primary Command Block buffer */
109 u_char eg_incount; /* Number of buffers currently used */
110 u_char *eg_inbuf; /* Incoming packet buffer */
111 u_char *eg_outbuf; /* Outgoing packet buffer */
112 };
113
114 int egprobe __P((struct device *, void *, void *));
115 void egattach __P((struct device *, struct device *, void *));
116
117 struct cfdriver egcd = {
118 NULL, "eg", egprobe, egattach, DV_IFNET, sizeof(struct eg_softc)
119 };
120
121 int egintr __P((void *));
122 static void eginit __P((struct eg_softc *));
123 static int egioctl __P((struct ifnet *, u_long, caddr_t));
124 static int egrecv __P((struct eg_softc *));
125 static void egstart __P((struct ifnet *));
126 static void egwatchdog __P((int));
127 static void egreset __P((struct eg_softc *));
128 static inline void egread __P((struct eg_softc *, caddr_t, int));
129 static struct mbuf *egget __P((caddr_t, int, struct ifnet *));
130 static void egstop __P((struct eg_softc *));
131
132 /*
133 * Support stuff
134 */
135
136 static inline void
137 egprintpcb(sc)
138 struct eg_softc *sc;
139 {
140 int i;
141
142 for (i = 0; i < sc->eg_pcb[1] + 2; i++)
143 dprintf(("pcb[%2d] = %x\n", i, sc->eg_pcb[i]));
144 }
145
146
147 static inline void
148 egprintstat(b)
149 u_char b;
150 {
151 dprintf(("%s %s %s %s %s %s %s\n",
152 (b & EG_STAT_HCRE)?"HCRE":"",
153 (b & EG_STAT_ACRF)?"ACRF":"",
154 (b & EG_STAT_DIR )?"DIR ":"",
155 (b & EG_STAT_DONE)?"DONE":"",
156 (b & EG_STAT_ASF3)?"ASF3":"",
157 (b & EG_STAT_ASF2)?"ASF2":"",
158 (b & EG_STAT_ASF1)?"ASF1":""));
159 }
160
161 static int
162 egoutPCB(sc, b)
163 struct eg_softc *sc;
164 u_char b;
165 {
166 int i;
167
168 for (i=0; i < 4000; i++) {
169 if (inb(sc->eg_stat) & EG_STAT_HCRE) {
170 outb(sc->eg_cmd, b);
171 return 0;
172 }
173 delay(10);
174 }
175 dprintf(("egoutPCB failed\n"));
176 return 1;
177 }
178
179 static int
180 egreadPCBstat(sc, statb)
181 struct eg_softc *sc;
182 u_char statb;
183 {
184 int i;
185
186 for (i=0; i < 5000; i++) {
187 if (EG_PCB_STAT(inb(sc->eg_stat)))
188 break;
189 delay(10);
190 }
191 if (EG_PCB_STAT(inb(sc->eg_stat)) == statb)
192 return 0;
193 return 1;
194 }
195
196 static int
197 egreadPCBready(sc)
198 struct eg_softc *sc;
199 {
200 int i;
201
202 for (i=0; i < 10000; i++) {
203 if (inb(sc->eg_stat) & EG_STAT_ACRF)
204 return 0;
205 delay(5);
206 }
207 dprintf(("PCB read not ready\n"));
208 return 1;
209 }
210
211 static int
212 egwritePCB(sc)
213 struct eg_softc *sc;
214 {
215 int i;
216 u_char len;
217
218 outb(sc->eg_ctl, EG_PCB_MASK(inb(sc->eg_ctl)));
219
220 len = sc->eg_pcb[1] + 2;
221 for (i = 0; i < len; i++)
222 egoutPCB(sc, sc->eg_pcb[i]);
223
224 for (i=0; i < 4000; i++) {
225 if (inb(sc->eg_stat) & EG_STAT_HCRE)
226 break;
227 delay(10);
228 }
229 outb(sc->eg_ctl, EG_PCB_MASK(inb(sc->eg_ctl)) | EG_PCB_DONE);
230 egoutPCB(sc, len);
231
232 if (egreadPCBstat(sc, EG_PCB_ACCEPT))
233 return 1;
234 return 0;
235 }
236
237 static int
238 egreadPCB(sc)
239 struct eg_softc *sc;
240 {
241 int i;
242 u_char b;
243
244 outb(sc->eg_ctl, EG_PCB_MASK(inb(sc->eg_ctl)));
245
246 bzero(sc->eg_pcb, sizeof(sc->eg_pcb));
247
248 if (egreadPCBready(sc))
249 return 1;
250
251 sc->eg_pcb[0] = inb(sc->eg_cmd);
252
253 if (egreadPCBready(sc))
254 return 1;
255
256 sc->eg_pcb[1] = inb(sc->eg_cmd);
257
258 if (sc->eg_pcb[1] > 62) {
259 dprintf(("len %d too large\n", sc->eg_pcb[1]));
260 return 1;
261 }
262
263 for (i = 0; i < sc->eg_pcb[1]; i++) {
264 if (egreadPCBready(sc))
265 return 1;
266 sc->eg_pcb[2+i] = inb(sc->eg_cmd);
267 }
268 if (egreadPCBready(sc))
269 return 1;
270 if (egreadPCBstat(sc, EG_PCB_DONE))
271 return 1;
272 if ((b = inb(sc->eg_cmd)) != sc->eg_pcb[1] + 2) {
273 dprintf(("%d != %d\n", b, sc->eg_pcb[1] + 2));
274 return 1;
275 }
276 outb(sc->eg_ctl, EG_PCB_MASK(inb(sc->eg_ctl)) | EG_PCB_ACCEPT);
277 return 0;
278 }
279
280 /*
281 * Real stuff
282 */
283
284 int
285 egprobe(parent, match, aux)
286 struct device *parent;
287 void *match, *aux;
288 {
289 struct eg_softc *sc = match;
290 struct isa_attach_args *ia = aux;
291 int i;
292
293 if (ia->ia_iobase & ~0x07f0 != 0) {
294 dprintf(("Weird iobase %x\n", ia->ia_iobase));
295 return 0;
296 }
297
298 sc->eg_cmd = ia->ia_iobase + EG_COMMAND;
299 sc->eg_ctl = ia->ia_iobase + EG_CONTROL;
300 sc->eg_stat = ia->ia_iobase + EG_STATUS;
301 sc->eg_data = ia->ia_iobase + EG_DATA;
302
303 /* hard reset card */
304 outb(sc->eg_ctl, EG_CTL_RESET);
305 outb(sc->eg_ctl, 0);
306 for (i = 0; i < 5000; i++) {
307 delay(1000);
308 if (EG_PCB_STAT(inb(sc->eg_stat)) == 0)
309 break;
310 }
311 if (EG_PCB_STAT(inb(sc->eg_stat)) != 0) {
312 dprintf(("eg: Reset failed\n"));
313 return 0;
314 }
315 sc->eg_pcb[0] = EG_CMD_GETINFO; /* Get Adapter Info */
316 sc->eg_pcb[1] = 0;
317 if (egwritePCB(sc) != 0)
318 return 0;
319
320 if (egreadPCB(sc) != 0) {
321 egprintpcb(sc);
322 return 0;
323 }
324
325 if (sc->eg_pcb[0] != EG_RSP_GETINFO || /* Get Adapter Info Response */
326 sc->eg_pcb[1] != 0x0a) {
327 egprintpcb(sc);
328 return 0;
329 }
330 sc->eg_rom_major = sc->eg_pcb[3];
331 sc->eg_rom_minor = sc->eg_pcb[2];
332 sc->eg_ram = sc->eg_pcb[6] | (sc->eg_pcb[7] << 8);
333
334 ia->ia_iosize = 0x08;
335 ia->ia_msize = 0;
336 return 1;
337 }
338
339 static void
340 egattach(parent, self, aux)
341 struct device *parent, *self;
342 void *aux;
343 {
344 struct eg_softc *sc = (void *)self;
345 struct isa_attach_args *ia = aux;
346 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
347 int i;
348
349 egstop(sc);
350
351 sc->eg_pcb[0] = EG_CMD_GETEADDR; /* Get Station address */
352 sc->eg_pcb[1] = 0;
353 if (egwritePCB(sc) != 0) {
354 dprintf(("write error\n"));
355 return;
356 }
357 if (egreadPCB(sc) != 0) {
358 dprintf(("read error\n"));
359 egprintpcb(sc);
360 return;
361 }
362
363 /* check Get station address response */
364 if (sc->eg_pcb[0] != EG_RSP_GETEADDR || sc->eg_pcb[1] != 0x06) {
365 dprintf(("parse error\n"));
366 egprintpcb(sc);
367 return;
368 }
369 bcopy(&sc->eg_pcb[2], sc->sc_arpcom.ac_enaddr, ETHER_ADDR_LEN);
370
371 printf(": ROM v%d.%02d %dk address %s\n",
372 sc->eg_rom_major, sc->eg_rom_minor, sc->eg_ram,
373 ether_sprintf(sc->sc_arpcom.ac_enaddr));
374
375 sc->eg_pcb[0] = EG_CMD_SETEADDR; /* Set station address */
376 if (egwritePCB(sc) != 0) {
377 dprintf(("write error2\n"));
378 return;
379 }
380 if (egreadPCB(sc) != 0) {
381 dprintf(("read error2\n"));
382 egprintpcb(sc);
383 return;
384 }
385 if (sc->eg_pcb[0] != EG_RSP_SETEADDR || sc->eg_pcb[1] != 0x02 ||
386 sc->eg_pcb[2] != 0 || sc->eg_pcb[3] != 0) {
387 dprintf(("parse error2\n"));
388 egprintpcb(sc);
389 return;
390 }
391
392 /* Initialize ifnet structure. */
393 ifp->if_unit = sc->sc_dev.dv_unit;
394 ifp->if_name = egcd.cd_name;
395 ifp->if_start = egstart;
396 ifp->if_ioctl = egioctl;
397 ifp->if_watchdog = egwatchdog;
398 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS;
399
400 /* Now we can attach the interface. */
401 if_attach(ifp);
402 ether_ifattach(ifp);
403
404 #if NBPFILTER > 0
405 bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
406 #endif
407
408 sc->sc_ih = isa_intr_establish(ia->ia_irq, ISA_IST_EDGE, ISA_IPL_NET,
409 egintr, sc);
410 }
411
412 static void
413 eginit(sc)
414 register struct eg_softc *sc;
415 {
416 register struct ifnet *ifp = &sc->sc_arpcom.ac_if;
417
418 /* Address not known. */
419 if (ifp->if_addrlist == 0)
420 return;
421
422 /* soft reset the board */
423 outb(sc->eg_ctl, EG_CTL_FLSH);
424 delay(100);
425 outb(sc->eg_ctl, EG_CTL_ATTN);
426 delay(100);
427 outb(sc->eg_ctl, 0);
428 delay(200);
429
430 sc->eg_pcb[0] = EG_CMD_CONFIG82586; /* Configure 82586 */
431 sc->eg_pcb[1] = 2;
432 sc->eg_pcb[2] = 3; /* receive broadcast & multicast */
433 sc->eg_pcb[3] = 0;
434 if (egwritePCB(sc) != 0)
435 dprintf(("write error3\n"));
436
437 if (egreadPCB(sc) != 0) {
438 dprintf(("read error\n"));
439 egprintpcb(sc);
440 } else if (sc->eg_pcb[2] != 0 || sc->eg_pcb[3] != 0)
441 printf("%s: configure card command failed\n",
442 sc->sc_dev.dv_xname);
443
444 if (sc->eg_inbuf == NULL)
445 sc->eg_inbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
446 sc->eg_incount = 0;
447
448 if (sc->eg_outbuf == NULL)
449 sc->eg_outbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
450
451 ifp->if_flags |= IFF_RUNNING;
452 ifp->if_flags &= ~IFF_OACTIVE;
453
454 outb(sc->eg_ctl, EG_CTL_CMDE);
455
456 egstart(ifp);
457 egrecv(sc);
458 }
459
460 static int
461 egrecv(sc)
462 struct eg_softc *sc;
463 {
464
465 while (sc->eg_incount < EG_INLEN) {
466 sc->eg_pcb[0] = EG_CMD_RECVPACKET;
467 sc->eg_pcb[1] = 0x08;
468 sc->eg_pcb[2] = 0; /* address not used.. we send zero */
469 sc->eg_pcb[3] = 0;
470 sc->eg_pcb[4] = 0;
471 sc->eg_pcb[5] = 0;
472 sc->eg_pcb[6] = EG_BUFLEN & 0xff; /* our buffer size */
473 sc->eg_pcb[7] = (EG_BUFLEN >> 8) & 0xff;
474 sc->eg_pcb[8] = 0; /* timeout, 0 == none */
475 sc->eg_pcb[9] = 0;
476 if (egwritePCB(sc) == 0)
477 sc->eg_incount++;
478 else
479 break;
480 }
481 }
482
483 static void
484 egstart(ifp)
485 struct ifnet *ifp;
486 {
487 register struct eg_softc *sc = egcd.cd_devs[ifp->if_unit];
488 struct mbuf *m0, *m;
489 int len;
490 short *ptr;
491
492 /* Don't transmit if interface is busy or not running */
493 if ((sc->sc_arpcom.ac_if.if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
494 return 0;
495
496 /* Dequeue the next datagram. */
497 IF_DEQUEUE(&sc->sc_arpcom.ac_if.if_snd, m0);
498 if (m0 == NULL)
499 return 0;
500
501 sc->sc_arpcom.ac_if.if_flags |= IFF_OACTIVE;
502
503 /* Copy the datagram to the buffer. */
504 len = 0;
505 for (m = m0; m; m = m->m_next) {
506 if (m->m_len == 0)
507 continue;
508 if (len + m->m_len > EG_BUFLEN) {
509 dprintf(("Packet too large to send\n"));
510 m_freem(m0);
511 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
512 sc->sc_arpcom.ac_if.if_oerrors++;
513 return 0;
514 }
515 bcopy(mtod(m, caddr_t), sc->eg_outbuf + len, m->m_len);
516 len += m->m_len;
517 }
518 #if NBPFILTER > 0
519 if (sc->sc_arpcom.ac_if.if_bpf)
520 bpf_mtap(sc->sc_arpcom.ac_if.if_bpf, m0);
521 #endif
522 m_freem(m0);
523
524 /* length must be a minimum of ETHER_MIN_LEN bytes */
525 len = max(len, ETHER_MIN_LEN);
526
527 /* set direction bit: host -> adapter */
528 outb(sc->eg_ctl, inb(sc->eg_ctl) & ~EG_CTL_DIR);
529
530 sc->eg_pcb[0] = EG_CMD_SENDPACKET;
531 sc->eg_pcb[1] = 0x06;
532 sc->eg_pcb[2] = 0; /* address not used, we send zero */
533 sc->eg_pcb[3] = 0;
534 sc->eg_pcb[4] = 0;
535 sc->eg_pcb[5] = 0;
536 sc->eg_pcb[6] = len & 0xff; /* length of packet */
537 sc->eg_pcb[7] = (len >> 8) & 0xff;
538 if (egwritePCB(sc) == 0) {
539 for (ptr = (short *) sc->eg_outbuf; len > 0; len -= 2) {
540 outw(sc->eg_data, *ptr++);
541 while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
542 ; /* XXX need timeout here */
543 }
544 } else {
545 dprintf(("egwritePCB in egstart failed\n"));
546 sc->sc_arpcom.ac_if.if_oerrors++;
547 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
548 }
549
550 /* Set direction bit : Adapter -> host */
551 outb(sc->eg_ctl, inb(sc->eg_ctl) | EG_CTL_DIR);
552
553 return 0;
554 }
555
556 int
557 egintr(arg)
558 void *arg;
559 {
560 register struct eg_softc *sc = arg;
561 int i, len;
562 short *ptr;
563
564 while (inb(sc->eg_stat) & EG_STAT_ACRF) {
565 egreadPCB(sc);
566 switch (sc->eg_pcb[0]) {
567 case EG_RSP_RECVPACKET:
568 len = sc->eg_pcb[6] | (sc->eg_pcb[7] << 8);
569 for (ptr = (short *) sc->eg_inbuf; len > 0; len -= 2) {
570 while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
571 ;
572 *ptr++ = inw(sc->eg_data);
573 }
574 len = sc->eg_pcb[8] | (sc->eg_pcb[9] << 8);
575 egrecv(sc);
576 sc->sc_arpcom.ac_if.if_ipackets++;
577 egread(sc, sc->eg_inbuf, len);
578 sc->eg_incount--;
579 break;
580
581 case EG_RSP_SENDPACKET:
582 if (sc->eg_pcb[6] || sc->eg_pcb[7]) {
583 dprintf(("packet dropped\n"));
584 sc->sc_arpcom.ac_if.if_oerrors++;
585 } else
586 sc->sc_arpcom.ac_if.if_opackets++;
587 sc->sc_arpcom.ac_if.if_collisions += sc->eg_pcb[8] & 0xf;
588 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
589 egstart(&sc->sc_arpcom.ac_if);
590 break;
591
592 case EG_RSP_GETSTATS:
593 dprintf(("Card Statistics\n"));
594 bcopy(&sc->eg_pcb[2], &i, sizeof(i));
595 dprintf(("Receive Packets %d\n", i));
596 bcopy(&sc->eg_pcb[6], &i, sizeof(i));
597 dprintf(("Transmit Packets %d\n", i));
598 dprintf(("CRC errors %d\n", *(short*) &sc->eg_pcb[10]));
599 dprintf(("alignment errors %d\n", *(short*) &sc->eg_pcb[12]));
600 dprintf(("no resources errors %d\n", *(short*) &sc->eg_pcb[14]));
601 dprintf(("overrun errors %d\n", *(short*) &sc->eg_pcb[16]));
602 break;
603
604 default:
605 dprintf(("egintr: Unknown response %x??\n",
606 sc->eg_pcb[0]));
607 egprintpcb(sc);
608 break;
609 }
610 }
611
612 return 0;
613 }
614
615 /*
616 * Pass a packet up to the higher levels.
617 */
618 static inline void
619 egread(sc, buf, len)
620 struct eg_softc *sc;
621 caddr_t buf;
622 int len;
623 {
624 struct ifnet *ifp;
625 struct mbuf *m;
626 struct ether_header *eh;
627
628 if (len <= sizeof(struct ether_header) ||
629 len > ETHER_MAX_LEN) {
630 dprintf(("Unacceptable packet size %d\n", len));
631 sc->sc_arpcom.ac_if.if_ierrors++;
632 return;
633 }
634
635 /* Pull packet off interface. */
636 ifp = &sc->sc_arpcom.ac_if;
637 m = egget(buf, len, ifp);
638 if (m == 0) {
639 dprintf(("egget returned 0\n"));
640 sc->sc_arpcom.ac_if.if_ierrors++;
641 return;
642 }
643
644 /* We assume the header fit entirely in one mbuf. */
645 eh = mtod(m, struct ether_header *);
646
647 #if NBPFILTER > 0
648 /*
649 * Check if there's a BPF listener on this interface.
650 * If so, hand off the raw packet to BPF.
651 */
652 if (ifp->if_bpf) {
653 bpf_mtap(ifp->if_bpf, m);
654
655 /*
656 * Note that the interface cannot be in promiscuous mode if
657 * there are no BPF listeners. And if we are in promiscuous
658 * mode, we have to check if this packet is really ours.
659 */
660 if ((ifp->if_flags & IFF_PROMISC) &&
661 (eh->ether_dhost[0] & 1) == 0 && /* !mcast and !bcast */
662 bcmp(eh->ether_dhost, sc->sc_arpcom.ac_enaddr,
663 sizeof(eh->ether_dhost)) != 0) {
664 m_freem(m);
665 return;
666 }
667 }
668 #endif
669
670 /* We assume the header fit entirely in one mbuf. */
671 m->m_pkthdr.len -= sizeof(*eh);
672 m->m_len -= sizeof(*eh);
673 m->m_data += sizeof(*eh);
674
675 ether_input(ifp, eh, m);
676 }
677
678 /*
679 * convert buf into mbufs
680 */
681 static struct mbuf *
682 egget(buf, totlen, ifp)
683 caddr_t buf;
684 int totlen;
685 struct ifnet *ifp;
686 {
687 struct mbuf *top, **mp, *m;
688 int len;
689
690 MGETHDR(m, M_DONTWAIT, MT_DATA);
691 if (m == 0) {
692 dprintf(("MGETHDR returns 0\n"));
693 return 0;
694 }
695 m->m_pkthdr.rcvif = ifp;
696 m->m_pkthdr.len = totlen;
697 len = MHLEN;
698 top = 0;
699 mp = ⊤
700
701 while (totlen > 0) {
702 if (top) {
703 MGET(m, M_DONTWAIT, MT_DATA);
704 if (m == 0) {
705 m_freem(top);
706 dprintf(("MGET returns 0\n"));
707 return 0;
708 }
709 len = MLEN;
710 }
711 if (totlen >= MINCLSIZE) {
712 MCLGET(m, M_DONTWAIT);
713 if (m->m_flags & M_EXT)
714 len = MCLBYTES;
715 }
716 m->m_len = len = min(totlen, len);
717 bcopy((caddr_t)buf, mtod(m, caddr_t), len);
718 buf += len;
719 totlen -= len;
720 *mp = m;
721 mp = &m->m_next;
722 }
723
724 return top;
725 }
726
727 static int
728 egioctl(ifp, command, data)
729 register struct ifnet *ifp;
730 u_long command;
731 caddr_t data;
732 {
733 struct eg_softc *sc = egcd.cd_devs[ifp->if_unit];
734 register struct ifaddr *ifa = (struct ifaddr *)data;
735 struct ifreq *ifr = (struct ifreq *)data;
736 int s, error = 0;
737
738 s = splimp();
739
740 switch (command) {
741
742 case SIOCSIFADDR:
743 ifp->if_flags |= IFF_UP;
744
745 switch (ifa->ifa_addr->sa_family) {
746 #ifdef INET
747 case AF_INET:
748 eginit(sc);
749 arp_ifinit(&sc->sc_arpcom, ifa);
750 break;
751 #endif
752 #ifdef NS
753 case AF_NS:
754 {
755 register struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
756
757 if (ns_nullhost(*ina))
758 ina->x_host =
759 *(union ns_host *)(sc->sc_arpcom.ac_enaddr);
760 else
761 bcopy(ina->x_host.c_host,
762 sc->sc_arpcom.ac_enaddr,
763 sizeof(sc->sc_arpcom.ac_enaddr));
764 /* Set new address. */
765 eginit(sc);
766 break;
767 }
768 #endif
769 default:
770 eginit(sc);
771 break;
772 }
773 break;
774
775 case SIOCSIFFLAGS:
776 if ((ifp->if_flags & IFF_UP) == 0 &&
777 (ifp->if_flags & IFF_RUNNING) != 0) {
778 /*
779 * If interface is marked down and it is running, then
780 * stop it.
781 */
782 egstop(sc);
783 ifp->if_flags &= ~IFF_RUNNING;
784 } else if ((ifp->if_flags & IFF_UP) != 0 &&
785 (ifp->if_flags & IFF_RUNNING) == 0) {
786 /*
787 * If interface is marked up and it is stopped, then
788 * start it.
789 */
790 eginit(sc);
791 } else {
792 sc->eg_pcb[0] = EG_CMD_GETSTATS;
793 sc->eg_pcb[1] = 0;
794 if (egwritePCB(sc) != 0)
795 dprintf(("write error\n"));
796 /*
797 * XXX deal with flags changes:
798 * IFF_MULTICAST, IFF_PROMISC,
799 * IFF_LINK0, IFF_LINK1,
800 */
801 }
802 break;
803
804 default:
805 error = EINVAL;
806 }
807
808 splx(s);
809 return error;
810 }
811
812 static void
813 egreset(sc)
814 struct eg_softc *sc;
815 {
816 int s;
817
818 dprintf(("egreset()\n"));
819 s = splimp();
820 egstop(sc);
821 eginit(sc);
822 splx(s);
823 }
824
825 static void
826 egwatchdog(unit)
827 int unit;
828 {
829 struct eg_softc *sc = egcd.cd_devs[unit];
830
831 log(LOG_ERR, "%s: device timeout\n", sc->sc_dev.dv_xname);
832 sc->sc_arpcom.ac_if.if_oerrors++;
833
834 egreset(sc);
835 return 0;
836 }
837
838 static void
839 egstop(sc)
840 register struct eg_softc *sc;
841 {
842
843 outb(sc->eg_ctl, 0);
844 }
845