if_eg.c revision 1.14 1 /* $NetBSD: if_eg.c,v 1.14 1995/07/23 19:45:42 mycroft 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 /* soft reset the board */
419 outb(sc->eg_ctl, EG_CTL_FLSH);
420 delay(100);
421 outb(sc->eg_ctl, EG_CTL_ATTN);
422 delay(100);
423 outb(sc->eg_ctl, 0);
424 delay(200);
425
426 sc->eg_pcb[0] = EG_CMD_CONFIG82586; /* Configure 82586 */
427 sc->eg_pcb[1] = 2;
428 sc->eg_pcb[2] = 3; /* receive broadcast & multicast */
429 sc->eg_pcb[3] = 0;
430 if (egwritePCB(sc) != 0)
431 dprintf(("write error3\n"));
432
433 if (egreadPCB(sc) != 0) {
434 dprintf(("read error\n"));
435 egprintpcb(sc);
436 } else if (sc->eg_pcb[2] != 0 || sc->eg_pcb[3] != 0)
437 printf("%s: configure card command failed\n",
438 sc->sc_dev.dv_xname);
439
440 if (sc->eg_inbuf == NULL)
441 sc->eg_inbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
442 sc->eg_incount = 0;
443
444 if (sc->eg_outbuf == NULL)
445 sc->eg_outbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
446
447 ifp->if_flags |= IFF_RUNNING;
448 ifp->if_flags &= ~IFF_OACTIVE;
449
450 outb(sc->eg_ctl, EG_CTL_CMDE);
451
452 egstart(ifp);
453 egrecv(sc);
454 }
455
456 static int
457 egrecv(sc)
458 struct eg_softc *sc;
459 {
460
461 while (sc->eg_incount < EG_INLEN) {
462 sc->eg_pcb[0] = EG_CMD_RECVPACKET;
463 sc->eg_pcb[1] = 0x08;
464 sc->eg_pcb[2] = 0; /* address not used.. we send zero */
465 sc->eg_pcb[3] = 0;
466 sc->eg_pcb[4] = 0;
467 sc->eg_pcb[5] = 0;
468 sc->eg_pcb[6] = EG_BUFLEN & 0xff; /* our buffer size */
469 sc->eg_pcb[7] = (EG_BUFLEN >> 8) & 0xff;
470 sc->eg_pcb[8] = 0; /* timeout, 0 == none */
471 sc->eg_pcb[9] = 0;
472 if (egwritePCB(sc) == 0)
473 sc->eg_incount++;
474 else
475 break;
476 }
477 }
478
479 static void
480 egstart(ifp)
481 struct ifnet *ifp;
482 {
483 register struct eg_softc *sc = egcd.cd_devs[ifp->if_unit];
484 struct mbuf *m0, *m;
485 int len;
486 short *ptr;
487
488 /* Don't transmit if interface is busy or not running */
489 if ((sc->sc_arpcom.ac_if.if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
490 return;
491
492 /* Dequeue the next datagram. */
493 IF_DEQUEUE(&sc->sc_arpcom.ac_if.if_snd, m0);
494 if (m0 == NULL)
495 return;
496
497 sc->sc_arpcom.ac_if.if_flags |= IFF_OACTIVE;
498
499 /* Copy the datagram to the buffer. */
500 len = 0;
501 for (m = m0; m; m = m->m_next) {
502 if (m->m_len == 0)
503 continue;
504 if (len + m->m_len > EG_BUFLEN) {
505 dprintf(("Packet too large to send\n"));
506 m_freem(m0);
507 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
508 sc->sc_arpcom.ac_if.if_oerrors++;
509 return;
510 }
511 bcopy(mtod(m, caddr_t), sc->eg_outbuf + len, m->m_len);
512 len += m->m_len;
513 }
514 #if NBPFILTER > 0
515 if (sc->sc_arpcom.ac_if.if_bpf)
516 bpf_mtap(sc->sc_arpcom.ac_if.if_bpf, m0);
517 #endif
518 m_freem(m0);
519
520 /* length must be a minimum of ETHER_MIN_LEN bytes */
521 len = max(len, ETHER_MIN_LEN);
522
523 /* set direction bit: host -> adapter */
524 outb(sc->eg_ctl, inb(sc->eg_ctl) & ~EG_CTL_DIR);
525
526 sc->eg_pcb[0] = EG_CMD_SENDPACKET;
527 sc->eg_pcb[1] = 0x06;
528 sc->eg_pcb[2] = 0; /* address not used, we send zero */
529 sc->eg_pcb[3] = 0;
530 sc->eg_pcb[4] = 0;
531 sc->eg_pcb[5] = 0;
532 sc->eg_pcb[6] = len & 0xff; /* length of packet */
533 sc->eg_pcb[7] = (len >> 8) & 0xff;
534 if (egwritePCB(sc) == 0) {
535 for (ptr = (short *) sc->eg_outbuf; len > 0; len -= 2) {
536 outw(sc->eg_data, *ptr++);
537 while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
538 ; /* XXX need timeout here */
539 }
540 } else {
541 dprintf(("egwritePCB in egstart failed\n"));
542 sc->sc_arpcom.ac_if.if_oerrors++;
543 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
544 }
545
546 /* Set direction bit : Adapter -> host */
547 outb(sc->eg_ctl, inb(sc->eg_ctl) | EG_CTL_DIR);
548 }
549
550 int
551 egintr(arg)
552 void *arg;
553 {
554 register struct eg_softc *sc = arg;
555 int i, len;
556 short *ptr;
557
558 while (inb(sc->eg_stat) & EG_STAT_ACRF) {
559 egreadPCB(sc);
560 switch (sc->eg_pcb[0]) {
561 case EG_RSP_RECVPACKET:
562 len = sc->eg_pcb[6] | (sc->eg_pcb[7] << 8);
563 for (ptr = (short *) sc->eg_inbuf; len > 0; len -= 2) {
564 while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
565 ;
566 *ptr++ = inw(sc->eg_data);
567 }
568 len = sc->eg_pcb[8] | (sc->eg_pcb[9] << 8);
569 egrecv(sc);
570 sc->sc_arpcom.ac_if.if_ipackets++;
571 egread(sc, sc->eg_inbuf, len);
572 sc->eg_incount--;
573 break;
574
575 case EG_RSP_SENDPACKET:
576 if (sc->eg_pcb[6] || sc->eg_pcb[7]) {
577 dprintf(("packet dropped\n"));
578 sc->sc_arpcom.ac_if.if_oerrors++;
579 } else
580 sc->sc_arpcom.ac_if.if_opackets++;
581 sc->sc_arpcom.ac_if.if_collisions += sc->eg_pcb[8] & 0xf;
582 sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
583 egstart(&sc->sc_arpcom.ac_if);
584 break;
585
586 case EG_RSP_GETSTATS:
587 dprintf(("Card Statistics\n"));
588 bcopy(&sc->eg_pcb[2], &i, sizeof(i));
589 dprintf(("Receive Packets %d\n", i));
590 bcopy(&sc->eg_pcb[6], &i, sizeof(i));
591 dprintf(("Transmit Packets %d\n", i));
592 dprintf(("CRC errors %d\n", *(short*) &sc->eg_pcb[10]));
593 dprintf(("alignment errors %d\n", *(short*) &sc->eg_pcb[12]));
594 dprintf(("no resources errors %d\n", *(short*) &sc->eg_pcb[14]));
595 dprintf(("overrun errors %d\n", *(short*) &sc->eg_pcb[16]));
596 break;
597
598 default:
599 dprintf(("egintr: Unknown response %x??\n",
600 sc->eg_pcb[0]));
601 egprintpcb(sc);
602 break;
603 }
604 }
605
606 return 0;
607 }
608
609 /*
610 * Pass a packet up to the higher levels.
611 */
612 static inline void
613 egread(sc, buf, len)
614 struct eg_softc *sc;
615 caddr_t buf;
616 int len;
617 {
618 struct ifnet *ifp;
619 struct mbuf *m;
620 struct ether_header *eh;
621
622 if (len <= sizeof(struct ether_header) ||
623 len > ETHER_MAX_LEN) {
624 dprintf(("Unacceptable packet size %d\n", len));
625 sc->sc_arpcom.ac_if.if_ierrors++;
626 return;
627 }
628
629 /* Pull packet off interface. */
630 ifp = &sc->sc_arpcom.ac_if;
631 m = egget(buf, len, ifp);
632 if (m == 0) {
633 dprintf(("egget returned 0\n"));
634 sc->sc_arpcom.ac_if.if_ierrors++;
635 return;
636 }
637
638 /* We assume the header fit entirely in one mbuf. */
639 eh = mtod(m, struct ether_header *);
640
641 #if NBPFILTER > 0
642 /*
643 * Check if there's a BPF listener on this interface.
644 * If so, hand off the raw packet to BPF.
645 */
646 if (ifp->if_bpf) {
647 bpf_mtap(ifp->if_bpf, m);
648
649 /*
650 * Note that the interface cannot be in promiscuous mode if
651 * there are no BPF listeners. And if we are in promiscuous
652 * mode, we have to check if this packet is really ours.
653 */
654 if ((ifp->if_flags & IFF_PROMISC) &&
655 (eh->ether_dhost[0] & 1) == 0 && /* !mcast and !bcast */
656 bcmp(eh->ether_dhost, sc->sc_arpcom.ac_enaddr,
657 sizeof(eh->ether_dhost)) != 0) {
658 m_freem(m);
659 return;
660 }
661 }
662 #endif
663
664 /* We assume the header fit entirely in one mbuf. */
665 m->m_pkthdr.len -= sizeof(*eh);
666 m->m_len -= sizeof(*eh);
667 m->m_data += sizeof(*eh);
668
669 ether_input(ifp, eh, m);
670 }
671
672 /*
673 * convert buf into mbufs
674 */
675 static struct mbuf *
676 egget(buf, totlen, ifp)
677 caddr_t buf;
678 int totlen;
679 struct ifnet *ifp;
680 {
681 struct mbuf *top, **mp, *m;
682 int len;
683
684 MGETHDR(m, M_DONTWAIT, MT_DATA);
685 if (m == 0) {
686 dprintf(("MGETHDR returns 0\n"));
687 return 0;
688 }
689 m->m_pkthdr.rcvif = ifp;
690 m->m_pkthdr.len = totlen;
691 len = MHLEN;
692 top = 0;
693 mp = ⊤
694
695 while (totlen > 0) {
696 if (top) {
697 MGET(m, M_DONTWAIT, MT_DATA);
698 if (m == 0) {
699 m_freem(top);
700 dprintf(("MGET returns 0\n"));
701 return 0;
702 }
703 len = MLEN;
704 }
705 if (totlen >= MINCLSIZE) {
706 MCLGET(m, M_DONTWAIT);
707 if (m->m_flags & M_EXT)
708 len = MCLBYTES;
709 }
710 m->m_len = len = min(totlen, len);
711 bcopy((caddr_t)buf, mtod(m, caddr_t), len);
712 buf += len;
713 totlen -= len;
714 *mp = m;
715 mp = &m->m_next;
716 }
717
718 return top;
719 }
720
721 static int
722 egioctl(ifp, command, data)
723 register struct ifnet *ifp;
724 u_long command;
725 caddr_t data;
726 {
727 struct eg_softc *sc = egcd.cd_devs[ifp->if_unit];
728 register struct ifaddr *ifa = (struct ifaddr *)data;
729 struct ifreq *ifr = (struct ifreq *)data;
730 int s, error = 0;
731
732 s = splimp();
733
734 switch (command) {
735
736 case SIOCSIFADDR:
737 ifp->if_flags |= IFF_UP;
738
739 switch (ifa->ifa_addr->sa_family) {
740 #ifdef INET
741 case AF_INET:
742 eginit(sc);
743 arp_ifinit(&sc->sc_arpcom, ifa);
744 break;
745 #endif
746 #ifdef NS
747 case AF_NS:
748 {
749 register struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
750
751 if (ns_nullhost(*ina))
752 ina->x_host =
753 *(union ns_host *)(sc->sc_arpcom.ac_enaddr);
754 else
755 bcopy(ina->x_host.c_host,
756 sc->sc_arpcom.ac_enaddr,
757 sizeof(sc->sc_arpcom.ac_enaddr));
758 /* Set new address. */
759 eginit(sc);
760 break;
761 }
762 #endif
763 default:
764 eginit(sc);
765 break;
766 }
767 break;
768
769 case SIOCSIFFLAGS:
770 if ((ifp->if_flags & IFF_UP) == 0 &&
771 (ifp->if_flags & IFF_RUNNING) != 0) {
772 /*
773 * If interface is marked down and it is running, then
774 * stop it.
775 */
776 egstop(sc);
777 ifp->if_flags &= ~IFF_RUNNING;
778 } else if ((ifp->if_flags & IFF_UP) != 0 &&
779 (ifp->if_flags & IFF_RUNNING) == 0) {
780 /*
781 * If interface is marked up and it is stopped, then
782 * start it.
783 */
784 eginit(sc);
785 } else {
786 sc->eg_pcb[0] = EG_CMD_GETSTATS;
787 sc->eg_pcb[1] = 0;
788 if (egwritePCB(sc) != 0)
789 dprintf(("write error\n"));
790 /*
791 * XXX deal with flags changes:
792 * IFF_MULTICAST, IFF_PROMISC,
793 * IFF_LINK0, IFF_LINK1,
794 */
795 }
796 break;
797
798 default:
799 error = EINVAL;
800 }
801
802 splx(s);
803 return error;
804 }
805
806 static void
807 egreset(sc)
808 struct eg_softc *sc;
809 {
810 int s;
811
812 dprintf(("egreset()\n"));
813 s = splimp();
814 egstop(sc);
815 eginit(sc);
816 splx(s);
817 }
818
819 static void
820 egwatchdog(unit)
821 int unit;
822 {
823 struct eg_softc *sc = egcd.cd_devs[unit];
824
825 log(LOG_ERR, "%s: device timeout\n", sc->sc_dev.dv_xname);
826 sc->sc_arpcom.ac_if.if_oerrors++;
827
828 egreset(sc);
829 return 0;
830 }
831
832 static void
833 egstop(sc)
834 register struct eg_softc *sc;
835 {
836
837 outb(sc->eg_ctl, 0);
838 }
839