4ff3de8e80
misplaced extern declarations (mostly prototypes of interrupt handlers) that this exposed. The prototypes should be moved back to the driver sources when the functions are staticalized. Added idempotency guards to <machine/conf.h>. "ioconf.h" can't be included when building LKMs so define a wart in bsd.kmod.mk to help guard against including it.
833 lines
20 KiB
C
833 lines
20 KiB
C
/* Copyright (c) 1994, Matthew E. Kimmel. Permission is hereby granted
|
|
* to use, copy, modify and distribute this software provided that both
|
|
* the copyright notice and this permission notice appear in all copies
|
|
* of the software, derivative works or modified versions, and any
|
|
* portions thereof.
|
|
*
|
|
* Questions, comments, bug reports and fixes to kimmel@cs.umass.edu.
|
|
*
|
|
* $Id: if_el.c,v 1.17 1995/10/28 15:39:02 phk Exp $
|
|
*/
|
|
/* Except of course for the portions of code lifted from other FreeBSD
|
|
* drivers (mainly elread, elget and el_ioctl)
|
|
*/
|
|
/* 3COM Etherlink 3C501 device driver for FreeBSD */
|
|
/* Yeah, I know these cards suck, but you can also get them for free
|
|
* really easily...
|
|
*/
|
|
/* Bugs/possible improvements:
|
|
* - Does not currently support DMA
|
|
* - Does not currently support multicasts
|
|
*/
|
|
#include "el.h"
|
|
#if NEL > 0
|
|
#include "bpfilter.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/syslog.h>
|
|
#include <sys/devconf.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_dl.h>
|
|
#include <net/if_types.h>
|
|
|
|
#ifdef INET
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_systm.h>
|
|
#include <netinet/in_var.h>
|
|
#include <netinet/ip.h>
|
|
#include <netinet/if_ether.h>
|
|
#endif
|
|
|
|
#ifdef IPX
|
|
#include <netipx/ipx.h>
|
|
#include <netipx/ipx_if.h>
|
|
#endif
|
|
|
|
#ifdef NS
|
|
#include <netns/ns.h>
|
|
#include <netns/ns_if.h>
|
|
#endif
|
|
|
|
#if NBPFILTER > 0
|
|
#include <net/bpf.h>
|
|
#include <net/bpfdesc.h>
|
|
#endif
|
|
|
|
#include <machine/clock.h>
|
|
|
|
#include <i386/isa/isa.h>
|
|
#include <i386/isa/isa_device.h>
|
|
#include <i386/isa/icu.h>
|
|
#include <i386/isa/if_elreg.h>
|
|
|
|
#define ETHER_MIN_LEN 64
|
|
#define ETHER_MAX_LEN 1518
|
|
|
|
/* For debugging convenience */
|
|
#ifdef EL_DEBUG
|
|
#define dprintf(x) printf x
|
|
#else
|
|
#define dprintf(x)
|
|
#endif
|
|
|
|
/* el_softc: per line info and status */
|
|
struct el_softc {
|
|
struct arpcom arpcom; /* Ethernet common */
|
|
u_short el_base; /* Base I/O addr */
|
|
caddr_t bpf; /* BPF magic cookie */
|
|
char el_pktbuf[EL_BUFSIZ]; /* Frame buffer */
|
|
} el_softc[NEL];
|
|
|
|
/* Prototypes */
|
|
int el_attach(struct isa_device *);
|
|
void el_init(int);
|
|
int el_ioctl(struct ifnet *,int,caddr_t);
|
|
int el_probe(struct isa_device *);
|
|
void el_start(struct ifnet *);
|
|
void el_reset(int);
|
|
void el_watchdog(int);
|
|
|
|
static void el_stop(int);
|
|
static int el_xmit(struct el_softc *,int);
|
|
static inline void elread(struct el_softc *,caddr_t,int);
|
|
static struct mbuf *elget(caddr_t,int,int,struct ifnet *);
|
|
static inline void el_hardreset(int);
|
|
|
|
/* isa_driver structure for autoconf */
|
|
struct isa_driver eldriver = {
|
|
el_probe, el_attach, "el"
|
|
};
|
|
|
|
static struct kern_devconf kdc_el[NEL] = { {
|
|
0, 0, 0, /* filled in by dev_attach */
|
|
"el", 0, { MDDT_ISA, 0, "net" },
|
|
isa_generic_externalize, 0, 0, ISA_EXTERNALLEN,
|
|
&kdc_isa0, /* parent */
|
|
0, /* parentdata */
|
|
DC_UNCONFIGURED, /* state */
|
|
"Ethernet adapter: 3Com 3C501",
|
|
DC_CLS_NETIF /* class */
|
|
} };
|
|
|
|
static inline void
|
|
el_registerdev(struct isa_device *id)
|
|
{
|
|
if(id->id_unit)
|
|
kdc_el[id->id_unit] = kdc_el[0];
|
|
kdc_el[id->id_unit].kdc_unit = id->id_unit;
|
|
kdc_el[id->id_unit].kdc_isa = id;
|
|
dev_attach(&kdc_el[id->id_unit]);
|
|
}
|
|
|
|
/* Probe routine. See if the card is there and at the right place. */
|
|
int el_probe(struct isa_device *idev)
|
|
{
|
|
struct el_softc *sc;
|
|
u_short base; /* Just for convenience */
|
|
u_char station_addr[ETHER_ADDR_LEN];
|
|
int i;
|
|
|
|
/* Grab some info for our structure */
|
|
sc = &el_softc[idev->id_unit];
|
|
sc->el_base = idev->id_iobase;
|
|
base = sc->el_base;
|
|
|
|
#ifndef DEV_LKM
|
|
el_registerdev(idev);
|
|
#endif
|
|
|
|
/* First check the base */
|
|
if((base < 0x280) || (base > 0x3f0)) {
|
|
printf("el%d: ioaddr must be between 0x280 and 0x3f0\n",
|
|
idev->id_unit);
|
|
return(0);
|
|
}
|
|
|
|
/* Now attempt to grab the station address from the PROM
|
|
* and see if it contains the 3com vendor code.
|
|
*/
|
|
dprintf(("Probing 3c501 at 0x%x...\n",base));
|
|
|
|
/* Reset the board */
|
|
dprintf(("Resetting board...\n"));
|
|
outb(base+EL_AC,EL_AC_RESET);
|
|
DELAY(5);
|
|
outb(base+EL_AC,0);
|
|
dprintf(("Reading station address...\n"));
|
|
/* Now read the address */
|
|
for(i=0;i<ETHER_ADDR_LEN;i++) {
|
|
outb(base+EL_GPBL,i);
|
|
station_addr[i] = inb(base+EL_EAW);
|
|
}
|
|
dprintf(("Address is %s\n",ether_sprintf(station_addr)));
|
|
|
|
/* If the vendor code is ok, return a 1. We'll assume that
|
|
* whoever configured this system is right about the IRQ.
|
|
*/
|
|
if((station_addr[0] != 0x02) || (station_addr[1] != 0x60)
|
|
|| (station_addr[2] != 0x8c)) {
|
|
dprintf(("Bad vendor code.\n"));
|
|
return(0);
|
|
} else {
|
|
dprintf(("Vendor code ok.\n"));
|
|
/* Copy the station address into the arpcom structure */
|
|
bcopy(station_addr,sc->arpcom.ac_enaddr,ETHER_ADDR_LEN);
|
|
return(1);
|
|
}
|
|
}
|
|
|
|
/* Attach the interface to the kernel data structures. By the time
|
|
* this is called, we know that the card exists at the given I/O address.
|
|
* We still assume that the IRQ given is correct.
|
|
*/
|
|
int el_attach(struct isa_device *idev)
|
|
{
|
|
struct el_softc *sc;
|
|
struct ifnet *ifp;
|
|
struct ifaddr *ifa;
|
|
struct sockaddr_dl *sdl;
|
|
u_short base;
|
|
|
|
dprintf(("Attaching el%d...\n",idev->id_unit));
|
|
|
|
/* Get things pointing to the right places. */
|
|
sc = &el_softc[idev->id_unit];
|
|
ifp = &sc->arpcom.ac_if;
|
|
base = sc->el_base;
|
|
|
|
/* Now reset the board */
|
|
dprintf(("Resetting board...\n"));
|
|
el_hardreset(idev->id_unit);
|
|
|
|
/* Initialize ifnet structure */
|
|
ifp->if_unit = idev->id_unit;
|
|
ifp->if_name = "el";
|
|
ifp->if_mtu = ETHERMTU;
|
|
ifp->if_init = el_init;
|
|
ifp->if_output = ether_output;
|
|
ifp->if_start = el_start;
|
|
ifp->if_ioctl = el_ioctl;
|
|
ifp->if_reset = el_reset;
|
|
ifp->if_watchdog = el_watchdog;
|
|
ifp->if_flags = (IFF_BROADCAST | IFF_SIMPLEX);
|
|
|
|
/* Now we can attach the interface */
|
|
dprintf(("Attaching interface...\n"));
|
|
if_attach(ifp);
|
|
kdc_el[idev->id_unit].kdc_state = DC_BUSY;
|
|
|
|
/* Put the station address in the ifa address list's AF_LINK
|
|
* entry, if any.
|
|
*/
|
|
ifa = ifp->if_addrlist;
|
|
while ((ifa != NULL) && (ifa->ifa_addr != NULL) &&
|
|
(ifa->ifa_addr->sa_family != AF_LINK))
|
|
ifa = ifa->ifa_next;
|
|
if((ifa != NULL) && (ifa->ifa_addr != NULL)) {
|
|
sdl = (struct sockaddr_dl *)ifa->ifa_addr;
|
|
sdl->sdl_type = IFT_ETHER;
|
|
sdl->sdl_alen = ETHER_ADDR_LEN;
|
|
sdl->sdl_slen = 0;
|
|
bcopy(sc->arpcom.ac_enaddr,LLADDR(sdl),ETHER_ADDR_LEN);
|
|
}
|
|
|
|
/* Print out some information for the user */
|
|
printf("el%d: 3c501 address %s\n",idev->id_unit,
|
|
ether_sprintf(sc->arpcom.ac_enaddr));
|
|
|
|
/* Finally, attach to bpf filter if it is present. */
|
|
#if NBPFILTER > 0
|
|
dprintf(("Attaching to BPF...\n"));
|
|
bpfattach(&sc->bpf,ifp,DLT_EN10MB,sizeof(struct ether_header));
|
|
#endif
|
|
|
|
dprintf(("el_attach() finished.\n"));
|
|
return(1);
|
|
}
|
|
|
|
/* This routine resets the interface. */
|
|
void el_reset(int unit)
|
|
{
|
|
int s;
|
|
|
|
dprintf(("elreset()\n"));
|
|
s = splimp();
|
|
el_stop(unit);
|
|
el_init(unit);
|
|
splx(s);
|
|
}
|
|
|
|
static void el_stop(int unit)
|
|
{
|
|
struct el_softc *sc;
|
|
|
|
sc = &el_softc[unit];
|
|
outb(sc->el_base+EL_AC,0);
|
|
}
|
|
|
|
/* Do a hardware reset of the 3c501. Do not call until after el_probe()! */
|
|
static inline void el_hardreset(int unit)
|
|
{
|
|
register struct el_softc *sc;
|
|
register int base;
|
|
register int j;
|
|
|
|
sc = &el_softc[unit];
|
|
base = sc->el_base;
|
|
|
|
/* First reset the board */
|
|
outb(base+EL_AC,EL_AC_RESET);
|
|
DELAY(5);
|
|
outb(base+EL_AC,0);
|
|
|
|
/* Then give it back its ethernet address. Thanks to the mach
|
|
* source code for this undocumented goodie...
|
|
*/
|
|
for(j=0;j<ETHER_ADDR_LEN;j++)
|
|
outb(base+j,sc->arpcom.ac_enaddr[j]);
|
|
}
|
|
|
|
/* Initialize interface. */
|
|
void el_init(int unit)
|
|
{
|
|
struct el_softc *sc;
|
|
struct ifnet *ifp;
|
|
int s;
|
|
u_short base;
|
|
|
|
/* Set up pointers */
|
|
sc = &el_softc[unit];
|
|
ifp = &sc->arpcom.ac_if;
|
|
base = sc->el_base;
|
|
|
|
/* If address not known, do nothing. */
|
|
if(ifp->if_addrlist == (struct ifaddr *)0)
|
|
return;
|
|
|
|
s = splimp();
|
|
|
|
/* First, reset the board. */
|
|
dprintf(("Resetting board...\n"));
|
|
el_hardreset(unit);
|
|
|
|
/* Configure rx */
|
|
dprintf(("Configuring rx...\n"));
|
|
if(ifp->if_flags & IFF_PROMISC)
|
|
outb(base+EL_RXC,(EL_RXC_PROMISC|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
else
|
|
outb(base+EL_RXC,(EL_RXC_ABROAD|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
outb(base+EL_RBC,0);
|
|
|
|
/* Configure TX */
|
|
dprintf(("Configuring tx...\n"));
|
|
outb(base+EL_TXC,0);
|
|
|
|
/* Start reception */
|
|
dprintf(("Starting reception...\n"));
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
|
|
/* Set flags appropriately */
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
|
|
|
/* And start output. */
|
|
el_start(ifp);
|
|
|
|
splx(s);
|
|
}
|
|
|
|
/* Start output on interface. Get datagrams from the queue and output
|
|
* them, giving the receiver a chance between datagrams. Call only
|
|
* from splimp or interrupt level!
|
|
*/
|
|
void el_start(struct ifnet *ifp)
|
|
{
|
|
struct el_softc *sc;
|
|
u_short base;
|
|
struct mbuf *m, *m0;
|
|
int s, i, len, retries, done;
|
|
|
|
/* Get things pointing in the right directions */
|
|
sc = &el_softc[ifp->if_unit];
|
|
base = sc->el_base;
|
|
|
|
dprintf(("el_start()...\n"));
|
|
s = splimp();
|
|
|
|
/* Don't do anything if output is active */
|
|
if(sc->arpcom.ac_if.if_flags & IFF_OACTIVE)
|
|
return;
|
|
sc->arpcom.ac_if.if_flags |= IFF_OACTIVE;
|
|
|
|
/* The main loop. They warned me against endless loops, but
|
|
* would I listen? NOOO....
|
|
*/
|
|
while(1) {
|
|
/* Dequeue the next datagram */
|
|
IF_DEQUEUE(&sc->arpcom.ac_if.if_snd,m0);
|
|
|
|
/* If there's nothing to send, return. */
|
|
if(m0 == NULL) {
|
|
sc->arpcom.ac_if.if_flags &= ~IFF_OACTIVE;
|
|
splx(s);
|
|
return;
|
|
}
|
|
|
|
/* Disable the receiver */
|
|
outb(base+EL_AC,EL_AC_HOST);
|
|
outb(base+EL_RBC,0);
|
|
|
|
/* Copy the datagram to the buffer. */
|
|
len = 0;
|
|
for(m = m0; m != NULL; m = m->m_next) {
|
|
if(m->m_len == 0)
|
|
continue;
|
|
bcopy(mtod(m,caddr_t),sc->el_pktbuf+len,m->m_len);
|
|
len += m->m_len;
|
|
}
|
|
m_freem(m0);
|
|
|
|
len = max(len,ETHER_MIN_LEN);
|
|
|
|
/* Give the packet to the bpf, if any */
|
|
#if NBPFILTER > 0
|
|
if(sc->bpf)
|
|
bpf_tap(sc->bpf,sc->el_pktbuf,len);
|
|
#endif
|
|
|
|
/* Transfer datagram to board */
|
|
dprintf(("el: xfr pkt length=%d...\n",len));
|
|
i = EL_BUFSIZ - len;
|
|
outb(base+EL_GPBL,(i & 0xff));
|
|
outb(base+EL_GPBH,((i>>8)&0xff));
|
|
outsb(base+EL_BUF,sc->el_pktbuf,len);
|
|
|
|
/* Now transmit the datagram */
|
|
retries=0;
|
|
done=0;
|
|
while(!done) {
|
|
if(el_xmit(sc,len)) { /* Something went wrong */
|
|
done = -1;
|
|
break;
|
|
}
|
|
/* Check out status */
|
|
i = inb(base+EL_TXS);
|
|
dprintf(("tx status=0x%x\n",i));
|
|
if(!(i & EL_TXS_READY)) {
|
|
dprintf(("el: err txs=%x\n",i));
|
|
sc->arpcom.ac_if.if_oerrors++;
|
|
if(i & (EL_TXS_COLL|EL_TXS_COLL16)) {
|
|
if((!(i & EL_TXC_DCOLL16)) && retries < 15) {
|
|
retries++;
|
|
outb(base+EL_AC,EL_AC_HOST);
|
|
}
|
|
}
|
|
else
|
|
done = 1;
|
|
}
|
|
else {
|
|
sc->arpcom.ac_if.if_opackets++;
|
|
done = 1;
|
|
}
|
|
}
|
|
if(done == -1) /* Packet not transmitted */
|
|
continue;
|
|
|
|
/* Now give the card a chance to receive.
|
|
* Gotta love 3c501s...
|
|
*/
|
|
(void)inb(base+EL_AS);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
splx(s);
|
|
/* Interrupt here */
|
|
s = splimp();
|
|
}
|
|
}
|
|
|
|
/* This function actually attempts to transmit a datagram downloaded
|
|
* to the board. Call at splimp or interrupt, after downloading data!
|
|
* Returns 0 on success, non-0 on failure
|
|
*/
|
|
static int el_xmit(struct el_softc *sc,int len)
|
|
{
|
|
int gpl;
|
|
int i;
|
|
|
|
gpl = EL_BUFSIZ - len;
|
|
dprintf(("el: xmit..."));
|
|
outb((sc->el_base)+EL_GPBL,(gpl & 0xff));
|
|
outb((sc->el_base)+EL_GPBH,((gpl>>8)&0xff));
|
|
outb((sc->el_base)+EL_AC,EL_AC_TXFRX);
|
|
i = 20000;
|
|
while((inb((sc->el_base)+EL_AS) & EL_AS_TXBUSY) && (i>0))
|
|
i--;
|
|
if(i == 0) {
|
|
dprintf(("tx not ready\n"));
|
|
sc->arpcom.ac_if.if_oerrors++;
|
|
return(-1);
|
|
}
|
|
dprintf(("%d cycles.\n",(20000-i)));
|
|
return(0);
|
|
}
|
|
|
|
/* controller interrupt */
|
|
void elintr(int unit)
|
|
{
|
|
register struct el_softc *sc;
|
|
register base;
|
|
int stat, rxstat, len, done;
|
|
|
|
/* Get things pointing properly */
|
|
sc = &el_softc[unit];
|
|
base = sc->el_base;
|
|
|
|
dprintf(("elintr: "));
|
|
|
|
/* Check board status */
|
|
stat = inb(base+EL_AS);
|
|
if(stat & EL_AS_RXBUSY) {
|
|
(void)inb(base+EL_RXC);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
return;
|
|
}
|
|
|
|
done = 0;
|
|
while(!done) {
|
|
rxstat = inb(base+EL_RXS);
|
|
if(rxstat & EL_RXS_STALE) {
|
|
(void)inb(base+EL_RXC);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
return;
|
|
}
|
|
|
|
/* If there's an overflow, reinit the board. */
|
|
if(!(rxstat & EL_RXS_NOFLOW)) {
|
|
dprintf(("overflow.\n"));
|
|
el_hardreset(unit);
|
|
/* Put board back into receive mode */
|
|
if(sc->arpcom.ac_if.if_flags & IFF_PROMISC)
|
|
outb(base+EL_RXC,(EL_RXC_PROMISC|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
else
|
|
outb(base+EL_RXC,(EL_RXC_ABROAD|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
(void)inb(base+EL_AS);
|
|
outb(base+EL_RBC,0);
|
|
(void)inb(base+EL_RXC);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
return;
|
|
}
|
|
|
|
/* Incoming packet */
|
|
len = inb(base+EL_RBL);
|
|
len |= inb(base+EL_RBH) << 8;
|
|
dprintf(("receive len=%d rxstat=%x ",len,rxstat));
|
|
outb(base+EL_AC,EL_AC_HOST);
|
|
|
|
/* If packet too short or too long, restore rx mode and return
|
|
*/
|
|
if((len <= sizeof(struct ether_header)) || (len > ETHER_MAX_LEN)) {
|
|
if(sc->arpcom.ac_if.if_flags & IFF_PROMISC)
|
|
outb(base+EL_RXC,(EL_RXC_PROMISC|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
else
|
|
outb(base+EL_RXC,(EL_RXC_ABROAD|EL_RXC_AGF|EL_RXC_DSHORT|EL_RXC_DDRIB|EL_RXC_DOFLOW));
|
|
(void)inb(base+EL_AS);
|
|
outb(base+EL_RBC,0);
|
|
(void)inb(base+EL_RXC);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
return;
|
|
}
|
|
|
|
sc->arpcom.ac_if.if_ipackets++;
|
|
|
|
/* Copy the data into our buffer */
|
|
outb(base+EL_GPBL,0);
|
|
outb(base+EL_GPBH,0);
|
|
insb(base+EL_BUF,sc->el_pktbuf,len);
|
|
outb(base+EL_RBC,0);
|
|
outb(base+EL_AC,EL_AC_RX);
|
|
dprintf(("%s-->",ether_sprintf(sc->el_pktbuf+6)));
|
|
dprintf(("%s\n",ether_sprintf(sc->el_pktbuf)));
|
|
|
|
/* Pass data up to upper levels */
|
|
len -= sizeof(struct ether_header);
|
|
elread(sc,(caddr_t)(sc->el_pktbuf),len);
|
|
|
|
/* Is there another packet? */
|
|
stat = inb(base+EL_AS);
|
|
|
|
/* If so, do it all again (i.e. don't set done to 1) */
|
|
if(!(stat & EL_AS_RXBUSY))
|
|
dprintf(("<rescan> "));
|
|
else
|
|
done = 1;
|
|
}
|
|
|
|
(void)inb(base+EL_RXC);
|
|
outb(base+EL_AC,(EL_AC_IRQE|EL_AC_RX));
|
|
return;
|
|
}
|
|
|
|
/* Pass a packet up to the higher levels. */
|
|
static inline void elread(struct el_softc *sc,caddr_t buf,int len)
|
|
{
|
|
register struct ether_header *eh;
|
|
struct mbuf *m;
|
|
|
|
eh = (struct ether_header *)buf;
|
|
|
|
#if NBPFILTER > 0
|
|
/*
|
|
* Check if there's a bpf filter listening on this interface.
|
|
* If so, hand off the raw packet to bpf.
|
|
*/
|
|
if(sc->bpf) {
|
|
bpf_tap(sc->bpf,buf,len+sizeof(struct ether_header));
|
|
|
|
/*
|
|
* Note that the interface cannot be in promiscuous mode if
|
|
* there are no bpf listeners. And if el are in promiscuous
|
|
* mode, el have to check if this packet is really ours.
|
|
*
|
|
* This test does not support multicasts.
|
|
*/
|
|
if((sc->arpcom.ac_if.if_flags & IFF_PROMISC)
|
|
&& bcmp(eh->ether_dhost,sc->arpcom.ac_enaddr,
|
|
sizeof(eh->ether_dhost)) != 0
|
|
&& bcmp(eh->ether_dhost,etherbroadcastaddr,
|
|
sizeof(eh->ether_dhost)) != 0)
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Pull packet off interface.
|
|
*/
|
|
m = elget(buf,len,0,&sc->arpcom.ac_if);
|
|
if(m == 0)
|
|
return;
|
|
|
|
ether_input(&sc->arpcom.ac_if,eh,m);
|
|
}
|
|
|
|
/*
|
|
* Pull read data off a interface.
|
|
* Len is length of data, with local net header stripped.
|
|
*/
|
|
struct mbuf *
|
|
elget(buf, totlen, off0, ifp)
|
|
caddr_t buf;
|
|
int totlen, off0;
|
|
struct ifnet *ifp;
|
|
{
|
|
struct mbuf *top, **mp, *m;
|
|
int off = off0, len;
|
|
register caddr_t cp = buf;
|
|
char *epkt;
|
|
|
|
buf += sizeof(struct ether_header);
|
|
cp = buf;
|
|
epkt = cp + totlen;
|
|
|
|
|
|
if (off) {
|
|
cp += off + 2 * sizeof(u_short);
|
|
totlen -= 2 * sizeof(u_short);
|
|
}
|
|
|
|
MGETHDR(m, M_DONTWAIT, MT_DATA);
|
|
if (m == 0)
|
|
return (0);
|
|
m->m_pkthdr.rcvif = ifp;
|
|
m->m_pkthdr.len = totlen;
|
|
m->m_len = MHLEN;
|
|
top = 0;
|
|
mp = ⊤
|
|
while (totlen > 0) {
|
|
if (top) {
|
|
MGET(m, M_DONTWAIT, MT_DATA);
|
|
if (m == 0) {
|
|
m_freem(top);
|
|
return (0);
|
|
}
|
|
m->m_len = MLEN;
|
|
}
|
|
len = min(totlen, epkt - cp);
|
|
if (len >= MINCLSIZE) {
|
|
MCLGET(m, M_DONTWAIT);
|
|
if (m->m_flags & M_EXT)
|
|
m->m_len = len = min(len, MCLBYTES);
|
|
else
|
|
len = m->m_len;
|
|
} else {
|
|
/*
|
|
* Place initial small packet/header at end of mbuf.
|
|
*/
|
|
if (len < m->m_len) {
|
|
if (top == 0 && len + max_linkhdr <= m->m_len)
|
|
m->m_data += max_linkhdr;
|
|
m->m_len = len;
|
|
} else
|
|
len = m->m_len;
|
|
}
|
|
bcopy(cp, mtod(m, caddr_t), (unsigned)len);
|
|
cp += len;
|
|
*mp = m;
|
|
mp = &m->m_next;
|
|
totlen -= len;
|
|
if (cp == epkt)
|
|
cp = buf;
|
|
}
|
|
return (top);
|
|
}
|
|
|
|
/*
|
|
* Process an ioctl request. This code needs some work - it looks
|
|
* pretty ugly.
|
|
*/
|
|
int
|
|
el_ioctl(ifp, command, data)
|
|
register struct ifnet *ifp;
|
|
int command;
|
|
caddr_t data;
|
|
{
|
|
register struct ifaddr *ifa = (struct ifaddr *)data;
|
|
struct el_softc *sc = &el_softc[ifp->if_unit];
|
|
struct ifreq *ifr = (struct ifreq *)data;
|
|
int s, error = 0;
|
|
|
|
s = splimp();
|
|
|
|
switch (command) {
|
|
|
|
case SIOCSIFADDR:
|
|
ifp->if_flags |= IFF_UP;
|
|
|
|
switch (ifa->ifa_addr->sa_family) {
|
|
#ifdef INET
|
|
case AF_INET:
|
|
el_init(ifp->if_unit); /* before arpwhohas */
|
|
arp_ifinit((struct arpcom *)ifp, ifa);
|
|
break;
|
|
#endif
|
|
#ifdef IPX
|
|
/*
|
|
* XXX - This code is probably wrong
|
|
*/
|
|
case AF_IPX:
|
|
{
|
|
register struct ipx_addr *ina = &(IA_SIPX(ifa)->sipx_addr);
|
|
|
|
if (ipx_nullhost(*ina))
|
|
ina->x_host =
|
|
*(union ipx_host *)(sc->arpcom.ac_enaddr);
|
|
else {
|
|
/*
|
|
*
|
|
*/
|
|
bcopy((caddr_t)ina->x_host.c_host,
|
|
(caddr_t)sc->arpcom.ac_enaddr,
|
|
sizeof(sc->arpcom.ac_enaddr));
|
|
}
|
|
/*
|
|
* Set new address
|
|
*/
|
|
el_init(ifp->if_unit);
|
|
break;
|
|
}
|
|
#endif
|
|
#ifdef NS
|
|
/*
|
|
* XXX - This code is probably wrong
|
|
*/
|
|
case AF_NS:
|
|
{
|
|
register struct ns_addr *ina = &(IA_SNS(ifa)->sns_addr);
|
|
|
|
if (ns_nullhost(*ina))
|
|
ina->x_host =
|
|
*(union ns_host *)(sc->arpcom.ac_enaddr);
|
|
else {
|
|
/*
|
|
*
|
|
*/
|
|
bcopy((caddr_t)ina->x_host.c_host,
|
|
(caddr_t)sc->arpcom.ac_enaddr,
|
|
sizeof(sc->arpcom.ac_enaddr));
|
|
}
|
|
/*
|
|
* Set new address
|
|
*/
|
|
el_init(ifp->if_unit);
|
|
break;
|
|
}
|
|
#endif
|
|
default:
|
|
el_init(ifp->if_unit);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case SIOCGIFADDR:
|
|
{
|
|
struct sockaddr *sa;
|
|
sa = (struct sockaddr *)&ifr->ifr_data;
|
|
bcopy((caddr_t)sc->arpcom.ac_enaddr,
|
|
(caddr_t) sa->sa_data, ETHER_ADDR_LEN);
|
|
}
|
|
break;
|
|
|
|
case SIOCSIFFLAGS:
|
|
/*
|
|
* If interface is marked down and it is running, then stop it
|
|
*/
|
|
if (((ifp->if_flags & IFF_UP) == 0) &&
|
|
(ifp->if_flags & IFF_RUNNING)) {
|
|
el_stop(ifp->if_unit);
|
|
ifp->if_flags &= ~IFF_RUNNING;
|
|
} else {
|
|
/*
|
|
* If interface is marked up and it is stopped, then start it
|
|
*/
|
|
if ((ifp->if_flags & IFF_UP) &&
|
|
((ifp->if_flags & IFF_RUNNING) == 0))
|
|
el_init(ifp->if_unit);
|
|
}
|
|
break;
|
|
|
|
case SIOCSIFMTU:
|
|
|
|
/*
|
|
* Set the interface MTU.
|
|
*/
|
|
if (ifr->ifr_mtu > ETHERMTU) {
|
|
error = EINVAL;
|
|
} else {
|
|
ifp->if_mtu = ifr->ifr_mtu;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
error = EINVAL;
|
|
}
|
|
(void) splx(s);
|
|
return (error);
|
|
}
|
|
|
|
/* Device timeout routine */
|
|
void el_watchdog(int unit)
|
|
{
|
|
struct el_softc *sc;
|
|
|
|
sc = &el_softc[unit];
|
|
|
|
log(LOG_ERR,"el%d: device timeout\n",unit);
|
|
sc->arpcom.ac_if.if_oerrors++;
|
|
el_reset(unit);
|
|
}
|
|
#endif
|