815 lines
20 KiB
C
815 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.3 1994/08/02 07:39:32 davidg 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 "param.h"
|
|
#include "systm.h"
|
|
#include "errno.h"
|
|
#include "ioctl.h"
|
|
#include "mbuf.h"
|
|
#include "socket.h"
|
|
#include "syslog.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 NS
|
|
#include "netns/ns.h"
|
|
#include "netns/ns_if.h"
|
|
#endif
|
|
|
|
#if NBPFILTER > 0
|
|
#include "net/bpf.h"
|
|
#include "net/bpfdesc.h"
|
|
#endif
|
|
|
|
#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);
|
|
void elintr(int);
|
|
int el_ioctl(struct ifnet *,int,caddr_t);
|
|
int el_probe(struct isa_device *);
|
|
void el_start(struct ifnet *);
|
|
void el_reset(int,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"
|
|
};
|
|
|
|
/* 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;
|
|
|
|
/* 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;
|
|
int t;
|
|
|
|
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 | IFF_NOTRAILERS);
|
|
|
|
/* Now we can attach the interface */
|
|
dprintf(("Attaching interface...\n"));
|
|
if_attach(ifp);
|
|
|
|
/* 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 uban)
|
|
{
|
|
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. Deal with trailer protocol. */
|
|
static inline void elread(struct el_softc *sc,caddr_t buf,int len)
|
|
{
|
|
register struct ether_header *eh;
|
|
struct mbuf *m;
|
|
int off, resid;
|
|
|
|
/* Deal with trailer protocol: if type is trailer type
|
|
* get true type from first 16-bit word past data.
|
|
* Remember that type was trailer by setting off.
|
|
*/
|
|
eh = (struct ether_header *)buf;
|
|
eh->ether_type = ntohs((u_short)eh->ether_type);
|
|
#define eldataaddr(eh,off,type) ((type)(((caddr_t)((eh)+1)+(off))))
|
|
if(eh->ether_type >= ETHERTYPE_TRAIL &&
|
|
eh->ether_type < ETHERTYPE_TRAIL+ETHERTYPE_NTRAILER) {
|
|
off = (eh->ether_type - ETHERTYPE_TRAIL) * 512;
|
|
if(off >= ETHERMTU)
|
|
return;
|
|
eh->ether_type = ntohs(*eldataaddr(eh,off,u_short *));
|
|
resid = ntohs(*(eldataaddr(eh,off+2,u_short *)));
|
|
if((off+resid) > len)
|
|
return;
|
|
len = off + resid;
|
|
}
|
|
else
|
|
off = 0;
|
|
|
|
if(len <= 0)
|
|
return;
|
|
|
|
#if NBPFILTER > 0
|
|
/*
|
|
* Check if there's a bpf filter listening on this interface.
|
|
* If so, hand off the raw packet to bpf, which must deal with
|
|
* trailers in its own way.
|
|
*/
|
|
if(sc->bpf) {
|
|
eh->ether_type = htons((u_short)eh->ether_type);
|
|
bpf_tap(sc->bpf,buf,len+sizeof(struct ether_header));
|
|
eh->ether_type = ntohs((u_short)eh->ether_type);
|
|
|
|
/*
|
|
* 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. Off is nonzero if packet
|
|
* has trailing header; neget will then force this header
|
|
* information to be at the front, but we still have to drop
|
|
* the type and length which are at the front of any trailer data.
|
|
*/
|
|
m = elget(buf,len,off,&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.
|
|
* Off is non-zero if a trailer protocol was used, and
|
|
* gives the offset of the trailer information.
|
|
* We copy the trailer information and then all the normal
|
|
* data into mbufs. When full cluster sized units are present
|
|
* we copy into clusters.
|
|
*/
|
|
struct mbuf *
|
|
elget(buf, totlen, off0, ifp)
|
|
caddr_t buf;
|
|
int totlen, off0;
|
|
struct ifnet *ifp;
|
|
{
|
|
struct mbuf *top, **mp, *m, *p;
|
|
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 */
|
|
/*
|
|
* See if another station has *our* IP address.
|
|
* i.e.: There is an address conflict! If a
|
|
* conflict exists, a message is sent to the
|
|
* console.
|
|
*/
|
|
((struct arpcom *)ifp)->ac_ipaddr = IA_SIN(ifa)->sin_addr;
|
|
arpwhohas((struct arpcom *)ifp, &IA_SIN(ifa)->sin_addr);
|
|
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);
|
|
}
|
|
|
|
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,0);
|
|
}
|
|
#endif
|