freebsd-dev/sys/i386/isa/if_eg.c

797 lines
18 KiB
C
Raw Normal View History

/*
* Copyright (c) 1993 Dean Huxley <dean@fsa.ca>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by Dean Huxley.
* 4. The name of Dean Huxley may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
1997-07-20 14:10:18 +00:00
* $Id: if_eg.c,v 1.23 1997/03/24 11:32:41 bde Exp $
1996-08-04 10:58:17 +00:00
*
* Support for 3Com 3c505 Etherlink+ card.
*/
/* To do:
* - multicast
* - promiscuous
*/
#include "eg.h"
#include "bpfilter.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/sockio.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/syslog.h>
#include <net/if.h>
#ifdef INET
#include <netinet/in.h>
#include <netinet/if_ether.h>
#endif
#ifdef NS
#include <netns/ns.h>
#include <netns/ns_if.h>
#endif
#if NBPFILTER > 0
#include <net/bpf.h>
#endif
#include <machine/clock.h>
#include <i386/isa/isa_device.h>
#include <i386/isa/if_egreg.h>
/* for debugging convenience */
#ifdef EGDEBUG
#define dprintf(x) printf x
#else
#define dprintf(x)
#endif
#define EG_INLEN 10
#define EG_BUFLEN 0x0670
/*
* Ethernet software status per interface.
*/
1995-12-10 13:40:44 +00:00
static struct eg_softc {
struct arpcom sc_arpcom; /* Ethernet common part */
int eg_cmd; /* Command register R/W */
int eg_ctl; /* Control register R/W (EG_CTL_*) */
int eg_stat; /* Status register R/O (EG_STAT_*) */
int eg_data; /* Data register R/W (16 bits) */
1995-05-30 08:16:23 +00:00
u_char eg_rom_major; /* Cards ROM version (major number) */
u_char eg_rom_minor; /* Cards ROM version (minor number) */
short eg_ram; /* Amount of RAM on the card */
u_char eg_pcb[64]; /* Primary Command Block buffer */
u_char eg_incount; /* Number of buffers currently used */
u_char *eg_inbuf; /* Incoming packet buffer */
1996-08-04 10:58:17 +00:00
u_char *eg_outbuf; /* Outgoing packet buffer */
} eg_softc[NEG];
1995-12-10 13:40:44 +00:00
static int egprobe (struct isa_device *);
static int egattach (struct isa_device *);
struct isa_driver egdriver = {
egprobe, egattach, "eg", 0
};
static void egprintpcb __P((struct eg_softc *sc));
static void egprintstat __P((int b));
static int egoutPCB __P((struct eg_softc *sc, int b));
static int egreadPCBstat __P((struct eg_softc *sc, int statb));
static int egreadPCBready __P((struct eg_softc *sc));
static int egwritePCB __P((struct eg_softc *sc));
static int egreadPCB __P((struct eg_softc *sc));
1996-08-04 10:58:17 +00:00
static void eginit __P((struct eg_softc *sc));
static int egioctl (struct ifnet *, int, caddr_t);
static void egrecv(struct eg_softc *);
static void egstart(struct ifnet *);
1996-08-04 10:58:17 +00:00
static void egread __P((struct eg_softc *, caddr_t, int));
static void egstop __P((struct eg_softc *));
1996-08-04 10:58:17 +00:00
static void egwatchdog __P((struct ifnet *));
static void egreset __P((struct eg_softc *));
static struct mbuf *egget __P((struct eg_softc *, caddr_t, int));
/*
* Support stuff
*/
1996-08-04 10:58:17 +00:00
static void
egprintpcb(sc)
struct eg_softc *sc;
{
int i;
1996-08-04 10:58:17 +00:00
for (i = 0; i < sc->eg_pcb[1] + 2; i++)
dprintf(("eg#: pcb[%2d] = %x\n", i, sc->eg_pcb[i]));
}
1996-08-04 10:58:17 +00:00
static void
egprintstat(b)
u_char b;
{
1996-08-04 10:58:17 +00:00
dprintf(("eg#: %s %s %s %s %s %s %s\n",
(b & EG_STAT_HCRE)?"HCRE":"",
(b & EG_STAT_ACRF)?"ACRF":"",
(b & EG_STAT_DIR )?"DIR ":"",
(b & EG_STAT_DONE)?"DONE":"",
(b & EG_STAT_ASF3)?"ASF3":"",
(b & EG_STAT_ASF2)?"ASF2":"",
(b & EG_STAT_ASF1)?"ASF1":""));
}
static int
egoutPCB(sc, b)
struct eg_softc *sc;
u_char b;
{
int i;
for (i=0; i < 4000; i++) {
if (inb(sc->eg_stat) & EG_STAT_HCRE) {
outb(sc->eg_cmd, b);
return 0;
}
DELAY(10);
}
dprintf(("eg#: egoutPCB failed\n"));
return 1;
}
1996-08-04 10:58:17 +00:00
static int
egreadPCBstat(sc, statb)
struct eg_softc *sc;
u_char statb;
{
int i;
for (i=0; i < 5000; i++) {
1996-08-04 10:58:17 +00:00
if ((inb(sc->eg_stat) & EG_PCB_STAT) != EG_PCB_NULL)
break;
DELAY(10);
}
1996-08-04 10:58:17 +00:00
if ((inb(sc->eg_stat) & EG_PCB_STAT) == statb)
return 0;
return 1;
}
static int
egreadPCBready(sc)
struct eg_softc *sc;
{
int i;
for (i=0; i < 10000; i++) {
if (inb(sc->eg_stat) & EG_STAT_ACRF)
return 0;
DELAY(5);
}
dprintf(("eg#: PCB read not ready\n"));
return 1;
}
1996-08-04 10:58:17 +00:00
static int
egwritePCB(sc)
struct eg_softc *sc;
{
int i;
u_char len;
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, (inb(sc->eg_ctl) & ~EG_PCB_STAT) | EG_PCB_NULL);
len = sc->eg_pcb[1] + 2;
for (i = 0; i < len; i++)
egoutPCB(sc, sc->eg_pcb[i]);
1996-08-04 10:58:17 +00:00
for (i=0; i < 4000; i++) {
if (inb(sc->eg_stat) & EG_STAT_HCRE)
break;
DELAY(10);
}
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, (inb(sc->eg_ctl) & ~EG_PCB_STAT) | EG_PCB_DONE);
egoutPCB(sc, len);
if (egreadPCBstat(sc, EG_PCB_ACCEPT))
return 1;
return 0;
1996-08-04 10:58:17 +00:00
}
static int
egreadPCB(sc)
struct eg_softc *sc;
{
int i;
u_char b;
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, (inb(sc->eg_ctl) & ~EG_PCB_STAT) | EG_PCB_NULL);
bzero(sc->eg_pcb, sizeof(sc->eg_pcb));
if (egreadPCBready(sc))
return 1;
sc->eg_pcb[0] = inb(sc->eg_cmd);
1996-08-04 10:58:17 +00:00
if (egreadPCBready(sc))
return 1;
sc->eg_pcb[1] = inb(sc->eg_cmd);
if (sc->eg_pcb[1] > 62) {
dprintf(("eg#: len %d too large\n", sc->eg_pcb[1]));
return 1;
}
1996-08-04 10:58:17 +00:00
for (i = 0; i < sc->eg_pcb[1]; i++) {
if (egreadPCBready(sc))
return 1;
sc->eg_pcb[2+i] = inb(sc->eg_cmd);
}
if (egreadPCBready(sc))
return 1;
if (egreadPCBstat(sc, EG_PCB_DONE))
return 1;
if ((b = inb(sc->eg_cmd)) != sc->eg_pcb[1] + 2) {
dprintf(("eg#: %d != %d\n", b, sc->eg_pcb[1] + 2));
return 1;
}
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, (inb(sc->eg_ctl) & ~EG_PCB_STAT) | EG_PCB_ACCEPT);
return 0;
1996-08-04 10:58:17 +00:00
}
/*
* Real stuff
*/
1995-12-10 13:40:44 +00:00
static int
egprobe(struct isa_device * id)
{
struct eg_softc *sc = &eg_softc[id->id_unit];
int i;
if (id->id_iobase & ~0x07f0 != 0) {
1996-08-04 10:58:17 +00:00
dprintf(("eg#: Weird iobase %x\n", ia->ia_iobase));
return 0;
}
1996-08-04 10:58:17 +00:00
sc->eg_cmd = id->id_iobase + EG_COMMAND;
sc->eg_ctl = id->id_iobase + EG_CONTROL;
sc->eg_stat = id->id_iobase + EG_STATUS;
sc->eg_data = id->id_iobase + EG_DATA;
/* hard reset card */
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, EG_CTL_RESET);
outb(sc->eg_ctl, 0);
for (i = 0; i < 1600; i++) {
1996-08-04 10:58:17 +00:00
DELAY(10000);
if ((inb(sc->eg_stat) & EG_PCB_STAT) == EG_PCB_NULL)
break;
}
1996-08-04 10:58:17 +00:00
if ((inb(sc->eg_stat) & EG_PCB_STAT) != EG_PCB_NULL) {
dprintf(("eg#: eg: Reset failed\n"));
return 0;
}
sc->eg_pcb[0] = EG_CMD_GETINFO; /* Get Adapter Info */
sc->eg_pcb[1] = 0;
if (egwritePCB(sc) != 0)
return 0;
1996-08-04 10:58:17 +00:00
if (egreadPCB(sc) != 0) {
egprintpcb(sc);
return 0;
}
if (sc->eg_pcb[0] != EG_RSP_GETINFO || /* Get Adapter Info Response */
sc->eg_pcb[1] != 0x0a) {
egprintpcb(sc);
return 0;
}
sc->eg_rom_major = sc->eg_pcb[3];
sc->eg_rom_minor = sc->eg_pcb[2];
sc->eg_ram = sc->eg_pcb[6] | (sc->eg_pcb[7] << 8);
1996-08-04 10:58:17 +00:00
return 8;
}
1996-08-04 10:58:17 +00:00
static int
egattach(struct isa_device *id)
{
struct eg_softc *sc = &eg_softc[id->id_unit];
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
1996-08-04 10:58:17 +00:00
egstop(sc);
sc->eg_pcb[0] = EG_CMD_GETEADDR; /* Get Station address */
sc->eg_pcb[1] = 0;
if (egwritePCB(sc) != 0) {
dprintf(("eg#: write error\n"));
return 0;
1996-08-04 10:58:17 +00:00
}
if (egreadPCB(sc) != 0) {
dprintf(("eg#: read error\n"));
egprintpcb(sc);
return 0;
}
/* check Get station address response */
1996-08-04 10:58:17 +00:00
if (sc->eg_pcb[0] != EG_RSP_GETEADDR || sc->eg_pcb[1] != 0x06) {
dprintf(("eg#: parse error\n"));
egprintpcb(sc);
return 0;
}
bcopy(&sc->eg_pcb[2], sc->sc_arpcom.ac_enaddr, ETHER_ADDR_LEN);
printf("eg%d: address %6D, type=3COM 3c505 (v%d.%02d, %dk)\n",
id->id_unit, sc->sc_arpcom.ac_enaddr, ":",
sc->eg_rom_major, sc->eg_rom_minor, sc->eg_ram);
sc->eg_pcb[0] = EG_CMD_SETEADDR; /* Set station address */
if (egwritePCB(sc) != 0) {
dprintf(("eg#: write error2\n"));
return 0;
}
if (egreadPCB(sc) != 0) {
dprintf(("eg#: read error2\n"));
egprintpcb(sc);
return 0;
}
if (sc->eg_pcb[0] != EG_RSP_SETEADDR || sc->eg_pcb[1] != 0x02 ||
sc->eg_pcb[2] != 0 || sc->eg_pcb[3] != 0) {
dprintf(("eg#: parse error2\n"));
egprintpcb(sc);
return 0;
}
/* Initialize ifnet structure. */
ifp->if_softc = sc;
ifp->if_unit = id->id_unit;
ifp->if_name = "eg";
ifp->if_output = ether_output;
ifp->if_start = egstart;
ifp->if_ioctl = egioctl;
1996-08-04 10:58:17 +00:00
ifp->if_init = (if_init_f_t*)eginit;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX;
1996-08-04 10:58:17 +00:00
ifp->if_watchdog = egwatchdog;
/* Now we can attach the interface. */
if_attach(ifp);
ether_ifattach(ifp);
#if NBPFILTER > 0
bpfattach(ifp, DLT_EN10MB, sizeof(struct ether_header));
#endif
1995-05-30 08:16:23 +00:00
return 1;
}
static void
1996-08-04 10:58:17 +00:00
eginit(struct eg_softc *sc)
{
1996-08-04 10:58:17 +00:00
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
/* soft reset the board */
outb(sc->eg_ctl, EG_CTL_FLSH);
DELAY(100);
outb(sc->eg_ctl, EG_CTL_ATTN);
DELAY(100);
outb(sc->eg_ctl, 0);
DELAY(200);
sc->eg_pcb[0] = EG_CMD_CONFIG82586; /* Configure 82586 */
sc->eg_pcb[1] = 2;
sc->eg_pcb[2] = 3; /* receive broadcast & multicast */
sc->eg_pcb[3] = 0;
#ifdef EGDEBUG
if (egwritePCB(sc) != 0)
dprintf(("eg#: write error3\n"));
#endif
if (egreadPCB(sc) != 0) {
dprintf(("eg#: read error\n"));
egprintpcb(sc);
} else if (sc->eg_pcb[2] != 0 || sc->eg_pcb[3] != 0)
printf("eg%d: configure card command failed\n", ifp->if_unit);
if (sc->eg_inbuf == NULL)
sc->eg_inbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
sc->eg_incount = 0;
if (sc->eg_outbuf == NULL)
sc->eg_outbuf = malloc(EG_BUFLEN, M_TEMP, M_NOWAIT);
1995-05-30 08:16:23 +00:00
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, EG_CTL_CMDE);
sc->eg_incount = 0;
egrecv(sc);
/* Interface is now `running', with no output active. */
ifp->if_flags |= IFF_RUNNING;
ifp->if_flags &= ~IFF_OACTIVE;
1996-08-04 10:58:17 +00:00
/* Attempt to start output, if any. */
egstart(ifp);
}
static void
1996-08-04 10:58:17 +00:00
egrecv(sc)
struct eg_softc *sc;
{
while (sc->eg_incount < EG_INLEN) {
sc->eg_pcb[0] = EG_CMD_RECVPACKET;
sc->eg_pcb[1] = 0x08;
sc->eg_pcb[2] = 0; /* address not used.. we send zero */
sc->eg_pcb[3] = 0;
sc->eg_pcb[4] = 0;
sc->eg_pcb[5] = 0;
sc->eg_pcb[6] = EG_BUFLEN & 0xff; /* our buffer size */
sc->eg_pcb[7] = (EG_BUFLEN >> 8) & 0xff;
sc->eg_pcb[8] = 0; /* timeout, 0 == none */
sc->eg_pcb[9] = 0;
1996-08-04 10:58:17 +00:00
if (egwritePCB(sc) != 0)
break;
1996-08-04 10:58:17 +00:00
sc->eg_incount++;
}
}
static void
egstart(ifp)
struct ifnet *ifp;
{
register struct eg_softc *sc = ifp->if_softc;
struct mbuf *m0, *m;
1996-08-04 10:58:17 +00:00
caddr_t buffer;
int len;
1996-08-04 10:58:17 +00:00
u_short *ptr;
/* Don't transmit if interface is busy or not running */
1996-08-04 10:58:17 +00:00
if ((ifp->if_flags & (IFF_RUNNING|IFF_OACTIVE)) != IFF_RUNNING)
return;
1996-08-04 10:58:17 +00:00
loop:
/* Dequeue the next datagram. */
1996-08-04 10:58:17 +00:00
IF_DEQUEUE(&ifp->if_snd, m0);
if (m0 == 0)
return;
1996-08-04 10:58:17 +00:00
ifp->if_flags |= IFF_OACTIVE;
1995-05-30 08:16:23 +00:00
1996-08-04 10:58:17 +00:00
/* We need to use m->m_pkthdr.len, so require the header */
if ((m0->m_flags & M_PKTHDR) == 0)
panic("egstart: no header mbuf");
len = max(m0->m_pkthdr.len, ETHER_MIN_LEN);
#if NBPFILTER > 0
1996-08-04 10:58:17 +00:00
if (ifp->if_bpf)
1996-10-30 08:50:26 +00:00
bpf_mtap(ifp, m0);
#endif
1995-05-30 08:16:23 +00:00
sc->eg_pcb[0] = EG_CMD_SENDPACKET;
sc->eg_pcb[1] = 0x06;
sc->eg_pcb[2] = 0; /* address not used, we send zero */
sc->eg_pcb[3] = 0;
sc->eg_pcb[4] = 0;
sc->eg_pcb[5] = 0;
1996-08-04 10:58:17 +00:00
sc->eg_pcb[6] = len; /* length of packet */
sc->eg_pcb[7] = len >> 8;
if (egwritePCB(sc) != 0) {
dprintf(("eg#: egwritePCB in egstart failed\n"));
1996-08-04 10:58:17 +00:00
ifp->if_oerrors++;
ifp->if_flags &= ~IFF_OACTIVE;
goto loop;
}
1995-05-30 08:16:23 +00:00
1996-08-04 10:58:17 +00:00
buffer = sc->eg_outbuf;
for (m = m0; m != 0; m = m->m_next) {
bcopy(mtod(m, caddr_t), buffer, m->m_len);
buffer += m->m_len;
}
1996-08-04 10:58:17 +00:00
/* set direction bit: host -> adapter */
outb(sc->eg_ctl, inb(sc->eg_ctl) & ~EG_CTL_DIR);
for (ptr = (u_short *) sc->eg_outbuf; len > 0; len -= 2) {
outw(sc->eg_data, *ptr++);
while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
; /* XXX need timeout here */
}
m_freem(m0);
}
void
egintr(int unit)
{
register struct eg_softc *sc = &eg_softc[unit];
int i, len;
1996-08-04 10:58:17 +00:00
u_short *ptr;
while (inb(sc->eg_stat) & EG_STAT_ACRF) {
egreadPCB(sc);
switch (sc->eg_pcb[0]) {
case EG_RSP_RECVPACKET:
len = sc->eg_pcb[6] | (sc->eg_pcb[7] << 8);
1996-08-04 10:58:17 +00:00
/* Set direction bit : Adapter -> host */
outb(sc->eg_ctl, inb(sc->eg_ctl) | EG_CTL_DIR);
for (ptr = (u_short *) sc->eg_inbuf; len > 0; len -= 2) {
while (!(inb(sc->eg_stat) & EG_STAT_HRDY))
;
*ptr++ = inw(sc->eg_data);
}
1996-08-04 10:58:17 +00:00
len = sc->eg_pcb[8] | (sc->eg_pcb[9] << 8);
egread(sc, sc->eg_inbuf, len);
1996-08-04 10:58:17 +00:00
sc->eg_incount--;
1996-08-04 10:58:17 +00:00
egrecv(sc);
break;
case EG_RSP_SENDPACKET:
if (sc->eg_pcb[6] || sc->eg_pcb[7]) {
dprintf(("eg#: packet dropped\n"));
sc->sc_arpcom.ac_if.if_oerrors++;
} else
sc->sc_arpcom.ac_if.if_opackets++;
sc->sc_arpcom.ac_if.if_collisions += sc->eg_pcb[8] & 0xf;
sc->sc_arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
egstart(&sc->sc_arpcom.ac_if);
break;
case EG_RSP_GETSTATS:
1996-08-04 10:58:17 +00:00
dprintf(("eg#: Card Statistics\n"));
bcopy(&sc->eg_pcb[2], &i, sizeof(i));
1996-08-04 10:58:17 +00:00
dprintf(("eg#: Receive Packets %d\n", i));
bcopy(&sc->eg_pcb[6], &i, sizeof(i));
1996-08-04 10:58:17 +00:00
dprintf(("eg#: Transmit Packets %d\n", i));
dprintf(("eg#: CRC errors %d\n", *(short*) &sc->eg_pcb[10]));
dprintf(("eg#: alignment errors %d\n", *(short*) &sc->eg_pcb[12]));
dprintf(("eg#: no resources errors %d\n", *(short*) &sc->eg_pcb[14]));
dprintf(("eg#: overrun errors %d\n", *(short*) &sc->eg_pcb[16]));
break;
1996-08-04 10:58:17 +00:00
default:
dprintf(("eg#: egintr: Unknown response %x??\n",
sc->eg_pcb[0]));
egprintpcb(sc);
break;
}
}
return;
}
/*
* Pass a packet up to the higher levels.
*/
1996-08-04 10:58:17 +00:00
static void
egread(sc, buf, len)
struct eg_softc *sc;
caddr_t buf;
int len;
{
1996-08-04 10:58:17 +00:00
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
struct mbuf *m;
struct ether_header *eh;
1996-08-04 10:58:17 +00:00
if (len <= sizeof(struct ether_header) ||
len > ETHER_MAX_LEN) {
1996-08-04 10:58:17 +00:00
printf("eg#: invalid packet size %d; dropping\n", len);
ifp->if_ierrors++;
return;
}
/* Pull packet off interface. */
1996-08-04 10:58:17 +00:00
m = egget(sc, buf, len);
if (m == 0) {
1996-08-04 10:58:17 +00:00
ifp->if_ierrors++;
return;
}
1996-08-04 10:58:17 +00:00
ifp->if_ipackets++;
/* We assume the header fit entirely in one mbuf. */
eh = mtod(m, struct ether_header *);
#if NBPFILTER > 0
/*
* Check if there's a BPF listener on this interface.
* If so, hand off the raw packet to BPF.
*/
if (ifp->if_bpf) {
1996-10-30 08:50:26 +00:00
bpf_mtap(ifp, m);
/*
* Note that the interface cannot be in promiscuous mode if
* there are no BPF listeners. And if we are in promiscuous
* mode, we have to check if this packet is really ours.
*/
if ((ifp->if_flags & IFF_PROMISC) &&
(eh->ether_dhost[0] & 1) == 0 && /* !mcast and !bcast */
bcmp(eh->ether_dhost, sc->sc_arpcom.ac_enaddr,
sizeof(eh->ether_dhost)) != 0) {
m_freem(m);
return;
}
}
#endif
/* We assume the header fit entirely in one mbuf. */
1996-08-04 10:58:17 +00:00
m_adj(m, sizeof(struct ether_header));
ether_input(ifp, eh, m);
}
1996-08-04 10:58:17 +00:00
/*
* convert buf into mbufs
*/
static struct mbuf *
egget(sc, buf, totlen)
struct eg_softc *sc;
caddr_t buf;
int totlen;
{
struct ifnet *ifp = &sc->sc_arpcom.ac_if;
struct mbuf *top, **mp, *m;
int len;
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == 0)
return 0;
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = totlen;
len = MHLEN;
top = 0;
mp = &top;
while (totlen > 0) {
if (top) {
MGET(m, M_DONTWAIT, MT_DATA);
if (m == 0) {
m_freem(top);
return 0;
}
len = MLEN;
}
if (totlen >= MINCLSIZE) {
MCLGET(m, M_DONTWAIT);
if (m->m_flags & M_EXT)
len = MCLBYTES;
}
m->m_len = len = min(totlen, len);
bcopy((caddr_t)buf, mtod(m, caddr_t), len);
buf += len;
totlen -= len;
*mp = m;
mp = &m->m_next;
}
return top;
}
static int
egioctl(ifp, command, data)
register struct ifnet *ifp;
int command;
caddr_t data;
{
struct eg_softc *sc = ifp->if_softc;
int s, error = 0;
1996-08-04 10:58:17 +00:00
s = splnet();
switch (command) {
case SIOCSIFADDR:
1996-08-04 10:58:17 +00:00
case SIOCGIFADDR:
case SIOCSIFMTU:
error = ether_ioctl(ifp, command, data);
break;
case SIOCSIFFLAGS:
if ((ifp->if_flags & IFF_UP) == 0 &&
(ifp->if_flags & IFF_RUNNING) != 0) {
/*
* If interface is marked down and it is running, then
* stop it.
*/
egstop(sc);
ifp->if_flags &= ~IFF_RUNNING;
} else if ((ifp->if_flags & IFF_UP) != 0 &&
(ifp->if_flags & IFF_RUNNING) == 0) {
/*
* If interface is marked up and it is stopped, then
* start it.
*/
eginit(sc);
} else {
sc->eg_pcb[0] = EG_CMD_GETSTATS;
sc->eg_pcb[1] = 0;
#ifdef EGDEBUG
if (egwritePCB(sc) != 0)
dprintf(("eg#: write error\n"));
#endif
/*
* XXX deal with flags changes:
* IFF_MULTICAST, IFF_PROMISC,
* IFF_LINK0, IFF_LINK1,
*/
}
break;
default:
error = EINVAL;
1996-08-04 10:58:17 +00:00
break;
}
splx(s);
return error;
}
1996-08-04 10:58:17 +00:00
static void
egreset(sc)
struct eg_softc *sc;
{
int s;
dprintf(("eg#: egreset()\n"));
s = splnet();
egstop(sc);
eginit(sc);
splx(s);
}
static void
egwatchdog(ifp)
struct ifnet *ifp;
{
struct eg_softc *sc = ifp->if_softc;
log(LOG_ERR, "%s: device timeout\n", "eg#");
sc->sc_arpcom.ac_if.if_oerrors++;
egreset(sc);
}
static void
egstop(sc)
register struct eg_softc *sc;
{
1996-08-04 10:58:17 +00:00
outb(sc->eg_ctl, 0);
}