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