NetBSD/sys/arch/i386/isa/if_ep.c

952 lines
24 KiB
C
Raw Normal View History

/*
* Copyright (c) 1993 Herb Peyerl <hpeyerl@novatel.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. The name of the author may not be used to endorse or promote products
1994-01-29 02:43:26 +03:00
* 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.
*
1994-03-29 08:35:37 +04:00
* $Id: if_ep.c,v 1.25 1994/03/29 04:35:53 mycroft Exp $
*/
/*
* TODO:
* Multi-509 configs.
* deallocate mbufs when ifconfig'd down.
*/
#include "bpfilter.h"
#include <sys/param.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <sys/errno.h>
#include <sys/syslog.h>
#include <sys/select.h>
1994-03-29 08:35:37 +04:00
#include <sys/device.h>
#include <net/if.h>
#include <net/netisr.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/netisr.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 <machine/cpu.h>
#include <machine/pio.h>
1994-03-29 08:35:37 +04:00
#include <i386/isa/isavar.h>
#include <i386/isa/if_epreg.h>
#include <i386/isa/elink.h>
#define ETHER_MIN_LEN 64
#define ETHER_MAX_LEN 1518
#define ETHER_ADDR_LEN 6
/*
* Ethernet software status per interface.
*/
struct ep_softc {
1994-03-29 08:35:37 +04:00
struct device sc_dev;
struct intrhand sc_ih;
struct arpcom ep_ac; /* Ethernet common part */
1994-03-29 08:35:37 +04:00
short ep_iobase; /* i/o bus address */
char ep_connectors; /* Connectors on this card. */
#define MAX_MBS 4 /* # of mbufs we keep around */
struct mbuf *mb[MAX_MBS]; /* spare mbuf storage. */
1994-01-28 13:36:59 +03:00
int next_mb; /* Which mbuf to use next. */
int last_mb; /* Last mbuf. */
int tx_start_thresh; /* Current TX_start_thresh. */
caddr_t bpf; /* BPF "magic cookie" */
1994-03-29 08:35:37 +04:00
};
1994-03-29 08:35:37 +04:00
static int epprobe();
static void epattach();
1994-03-29 08:35:37 +04:00
struct cfdriver epcd = {
NULL, "ep", epprobe, epattach, DV_IFNET, sizeof(struct ep_softc)
};
1994-01-28 13:36:59 +03:00
int epintr __P((int));
1994-03-29 08:35:37 +04:00
static void epinit __P((struct ep_softc *));
static int epioctl __P((struct ifnet *, int, caddr_t));
1994-01-28 13:36:59 +03:00
static int epstart __P((struct ifnet *));
static int epwatchdog __P((int));
1994-03-29 08:35:37 +04:00
static void epreset __P((struct ep_softc *));
1994-01-28 13:36:59 +03:00
static void epread __P((struct ep_softc *));
static void epmbufqueue __P((struct ep_softc *));
1994-03-29 08:35:37 +04:00
static void epstop __P((struct ep_softc *));
1994-01-28 13:36:59 +03:00
static u_short epreadeeprom __P((int id_port, int offset));
1994-03-29 08:35:37 +04:00
static int epbusyeeprom __P((struct ep_softc *));
/*
* Eisa probe routine. If any part of this probe should fail to
* return the desired result, the isa_epprobe() is called. Astute
* readers will discover a problem that I don't feel inclined to address
* at the moment.
*/
int
1994-03-29 08:35:37 +04:00
epprobe(parent, self, aux)
struct device *parent, *self;
void *aux;
{
1994-03-29 08:35:37 +04:00
struct ep_softc *sc = (void *)self;
struct isa_attach_args *ia = aux;
int port;
int i;
int eisa_slot;
u_short k;
eisa_slot=1;
while (eisa_slot < 8) {
port = 0x1000 * eisa_slot;
outw(port + EP_COMMAND, GLOBAL_RESET);
delay(1000);
if (inw(port + EP_W0_MFG_ID) == MFG_ID)
break;
eisa_slot++;
}
k = inw(port + EP_W0_PRODUCT_ID);
if ((k & 0xf0ff) != (PROD_ID & 0xf0ff))
1994-03-29 08:35:37 +04:00
return isa_epprobe(sc, ia);
k = inw(port + EP_W0_ADDRESS_CFG);
k = (k & 0x1f) * 0x10 + 0x200; /* decode base addr. */
k = inw(port + EP_W0_RESOURCE_CFG);
k >>= 12;
1994-03-29 08:35:37 +04:00
if (ia->ia_irq != (1 << ((k == 2) ? 9 : k)))
return isa_epprobe(sc, ia);
1994-03-29 08:35:37 +04:00
ia->ia_iobase = port; /* Set the base addr for later */
ia->ia_iosize = 0x10;
ia->ia_msize = 0;
return 1;
}
/*
* Rudimentary support for multiple cards is here but is not
* currently handled. In the future we will have to add code
* for tagging the cards for later activation. We wanna do something
* about the ELINK_ID_PORT. We're limited due to current config procedure.
* Magnum config holds promise of a fix but we'll have to wait a bit.
*/
int
1994-03-29 08:35:37 +04:00
isa_epprobe(sc, ia)
struct ep_softc *sc;
struct isa_attach_args *ia;
{
u_short k;
outw(BASE + EP_COMMAND, GLOBAL_RESET);
delay(1000);
elink_reset(); /* global reset to ELINK_ID_PORT */
delay(1000);
outb(ELINK_ID_PORT, 0x00);
elink_idseq(ELINK_509_POLY);
delay(1000);
/*
* MFG_ID should have 0x6d50.
* PROD_ID should be 0x9[0-f]50
*/
k = epreadeeprom(ELINK_ID_PORT, EEPROM_MFG_ID);
if (k != MFG_ID)
return (0);
k = epreadeeprom(ELINK_ID_PORT, EEPROM_PROD_ID);
if ((k & 0xf0ff) != (PROD_ID & 0xf0ff))
return (0);
k = epreadeeprom(ELINK_ID_PORT, EEPROM_ADDR_CFG); /* get addr cfg */
k = (k & 0x1f) * 0x10 + 0x200; /* decode base addr. */
1994-03-29 08:35:37 +04:00
if (k != ia->ia_iobase)
return (0);
k = epreadeeprom(ELINK_ID_PORT, EEPROM_RESOURCE_CFG);
k >>= 12;
1994-03-29 08:35:37 +04:00
if (ia->ia_irq != (1 << ((k == 2) ? 9 : k)))
return (0);
outb(ELINK_ID_PORT, ACTIVATE_ADAPTER_TO_CONFIG);
return (0x10); /* 16 bytes of I/O space used. */
}
1994-03-29 08:35:37 +04:00
static void
epattach(parent, self, aux)
struct device *parent, *self;
void *aux;
{
1994-03-29 08:35:37 +04:00
struct ep_softc *sc = (void *)self;
struct isa_attach_args *ia = aux;
1994-03-09 20:19:10 +03:00
struct ifnet *ifp = &sc->ep_ac.ac_if;
struct ifaddr *ifa;
struct sockaddr_dl *sdl;
1994-03-29 08:35:37 +04:00
u_short i;
1994-03-29 08:35:37 +04:00
printf(": ");
1994-03-29 08:35:37 +04:00
sc->ep_iobase = ia->ia_iobase;
sc->ep_connectors = 0;
1994-03-29 08:35:37 +04:00
i = inw(ia->ia_iobase + EP_W0_CONFIG_CTRL);
if (i & IS_AUI) {
printf("aui");
sc->ep_connectors |= AUI;
}
if (i & IS_BNC) {
if (sc->ep_connectors)
printf("/");
printf("bnc");
sc->ep_connectors |= BNC;
}
if (i & IS_UTP) {
if (sc->ep_connectors)
printf("/");
printf("utp");
sc->ep_connectors |= UTP;
}
if (!sc->ep_connectors)
printf("no connectors!");
/*
* Read the station address from the eeprom
*/
for (i = 0; i < 3; i++) {
u_short *p;
GO_WINDOW(0);
1994-03-29 08:35:37 +04:00
if (epbusyeeprom(sc))
return;
outw(BASE + EP_W0_EEPROM_COMMAND, READ_EEPROM | i);
1994-03-29 08:35:37 +04:00
if (epbusyeeprom(sc))
return;
1994-03-09 20:19:10 +03:00
p = (u_short *) & sc->ep_ac.ac_enaddr[i * 2];
*p = htons(inw(BASE + EP_W0_EEPROM_DATA));
GO_WINDOW(2);
outw(BASE + EP_W2_ADDR_0 + (i * 2), ntohs(*p));
}
1994-03-09 20:19:10 +03:00
printf(" address %s\n", ether_sprintf(sc->ep_ac.ac_enaddr));
1994-03-29 08:35:37 +04:00
ifp->if_unit = sc->sc_dev.dv_unit;
ifp->if_name = epcd.cd_name;
ifp->if_mtu = ETHERMTU;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS;
ifp->if_output = ether_output;
ifp->if_start = epstart;
ifp->if_ioctl = epioctl;
ifp->if_watchdog = epwatchdog;
if_attach(ifp);
/*
1994-03-29 08:35:37 +04:00
* Search down the ifa address list looking for the AF_LINK type entry
* and initialize it.
*/
ifa = ifp->if_addrlist;
1994-03-29 08:35:37 +04:00
while (ifa && ifa->ifa_addr) {
if (ifa->ifa_addr->sa_family == AF_LINK) {
/*
* Fill in the link-level address for this interface.
*/
sdl = (struct sockaddr_dl *) ifa->ifa_addr;
sdl->sdl_type = IFT_ETHER;
sdl->sdl_alen = ETHER_ADDR_LEN;
sdl->sdl_slen = 0;
bcopy(sc->ep_ac.ac_enaddr, LLADDR(sdl), ETHER_ADDR_LEN);
break;
} else
ifa = ifa->ifa_next;
}
1994-03-29 08:35:37 +04:00
#if NBPFILTER > 0
bpfattach(&sc->bpf, ifp, DLT_EN10MB, sizeof(struct ether_header));
#endif
}
/*
* The order in here seems important. Otherwise we may not receive
* interrupts. ?!
*/
1994-03-29 08:35:37 +04:00
static void
epinit(sc)
register struct ep_softc *sc;
{
1994-03-09 20:19:10 +03:00
register struct ifnet *ifp = &sc->ep_ac.ac_if;
int s, i;
1994-03-29 08:35:37 +04:00
if (ifp->if_addrlist == 0)
return;
s = splimp();
while (inb(BASE + EP_STATUS) & S_COMMAND_IN_PROGRESS)
;
GO_WINDOW(0);
outw(BASE + EP_W0_CONFIG_CTRL, 0); /* Disable the card */
outw(BASE + EP_W0_CONFIG_CTRL, ENABLE_DRQ_IRQ); /* Enable the card */
GO_WINDOW(2);
for (i = 0; i < 6; i++) /* Reload the ether_addr. */
1994-03-09 20:19:10 +03:00
outb(BASE + EP_W2_ADDR_0 + i, sc->ep_ac.ac_enaddr[i]);
outw(BASE + EP_COMMAND, RX_RESET);
outw(BASE + EP_COMMAND, TX_RESET);
GO_WINDOW(1); /* Window 1 is operating window */
for (i = 0; i < 31; i++)
inb(BASE + EP_W1_TX_STATUS);
outw(BASE + EP_COMMAND, ACK_INTR | 0xff); /* get rid of stray intr's */
outw(BASE + EP_COMMAND, SET_RD_0_MASK | S_CARD_FAILURE | S_RX_COMPLETE |
S_TX_COMPLETE | S_TX_AVAIL);
outw(BASE + EP_COMMAND, SET_INTR_MASK | S_CARD_FAILURE | S_RX_COMPLETE |
S_TX_COMPLETE | S_TX_AVAIL);
outw(BASE + EP_COMMAND, SET_RX_FILTER | FIL_INDIVIDUAL |
FIL_GROUP | FIL_BRDCST);
/*
* you can `ifconfig (link0|-link0) ep0' to get the following
* behaviour:
* -link0 disable AUI/UTP. enable BNC.
1994-02-04 05:06:04 +03:00
* link0 disable BNC. enable AUI.
* link1 if the card has a UTP connector, and link0 is
* set too, then you get the UTP port.
*/
1994-02-04 05:06:04 +03:00
GO_WINDOW(4);
outw(BASE + EP_W4_MEDIA_TYPE, DISABLE_UTP);
GO_WINDOW(1);
if (!(ifp->if_flags & IFF_LINK0) && (sc->ep_connectors & BNC)) {
outw(BASE + EP_COMMAND, START_TRANSCEIVER);
delay(1000);
}
1994-02-04 05:06:04 +03:00
if (ifp->if_flags & IFF_LINK0) {
outw(BASE + EP_COMMAND, STOP_TRANSCEIVER);
delay(1000);
1994-02-04 05:06:04 +03:00
if((ifp->if_flags & IFF_LINK1) && (sc->ep_connectors & UTP)) {
GO_WINDOW(4);
outw(BASE + EP_W4_MEDIA_TYPE, ENABLE_UTP);
GO_WINDOW(1);
}
}
outw(BASE + EP_COMMAND, RX_ENABLE);
outw(BASE + EP_COMMAND, TX_ENABLE);
ifp->if_flags |= IFF_RUNNING;
ifp->if_flags &= ~IFF_OACTIVE; /* just in case */
sc->tx_start_thresh = 20; /* probably a good starting point. */
/*
* Store up a bunch of mbuf's for use later. (MAX_MBS). First we
* free up any that we had in case we're being called from intr or
* somewhere else.
*/
sc->last_mb = 0;
sc->next_mb = 0;
epmbufqueue(sc);
epstart(ifp);
splx(s);
}
static const char padmap[] = {0, 3, 2, 1};
static int
epstart(ifp)
struct ifnet *ifp;
{
1994-03-29 08:35:37 +04:00
register struct ep_softc *sc = epcd.cd_devs[ifp->if_unit];
struct mbuf *m, *top;
int s, len, pad;
s = splimp();
1994-03-09 20:19:10 +03:00
if (sc->ep_ac.ac_if.if_flags & IFF_OACTIVE) {
splx(s);
1994-01-28 13:36:59 +03:00
return (0);
}
startagain:
1994-03-09 20:19:10 +03:00
/* Sneak a peek at the next packet */
m = sc->ep_ac.ac_if.if_snd.ifq_head;
if (m == 0) {
splx(s);
1994-01-28 13:36:59 +03:00
return (0);
}
1994-01-25 13:46:29 +03:00
#if 0
len = m->m_pkthdr.len;
#else
for (len = 0, top = m; m; m = m->m_next)
len += m->m_len;
#endif
pad = padmap[len & 3];
/*
* The 3c509 automatically pads short packets to minimum ethernet
* length, but we drop packets that are too large. Perhaps we should
* truncate them instead?
*/
if (len + pad > ETHER_MAX_LEN) {
/* packet is obviously too large: toss it */
1994-03-09 20:19:10 +03:00
+sc->ep_ac.ac_if.if_oerrors;
IF_DEQUEUE(&sc->ep_ac.ac_if.if_snd, m);
m_freem(m);
goto readcheck;
}
if (inw(BASE + EP_W1_FREE_TX) < len + pad + 4) {
/* no room in FIFO */
outw(BASE + EP_COMMAND, SET_TX_AVAIL_THRESH | (len + pad + 4));
1994-03-09 20:19:10 +03:00
sc->ep_ac.ac_if.if_flags |= IFF_OACTIVE;
splx(s);
1994-01-28 13:36:59 +03:00
return (0);
}
1994-03-09 20:19:10 +03:00
IF_DEQUEUE(&sc->ep_ac.ac_if.if_snd, m);
if (m == 0) { /* not really needed */
splx(s);
1994-01-28 13:36:59 +03:00
return (0);
}
outw(BASE + EP_COMMAND, SET_TX_START_THRESH |
(len / 4 + sc->tx_start_thresh));
outw(BASE + EP_W1_TX_PIO_WR_1, len);
outw(BASE + EP_W1_TX_PIO_WR_1, 0xffff); /* Second dword meaningless */
for (top = m; m != 0; m = m->m_next) {
outsw(BASE + EP_W1_TX_PIO_WR_1, mtod(m, caddr_t), m->m_len/2);
if (m->m_len & 1)
outb(BASE + EP_W1_TX_PIO_WR_1,
*(mtod(m, caddr_t) + m->m_len - 1));
}
while (pad--)
outb(BASE + EP_W1_TX_PIO_WR_1, 0); /* Padding */
#if NBPFILTER > 0
if (sc->bpf) {
u_short etype;
int off, datasize, resid;
struct ether_header *eh;
struct trailer_header {
u_short ether_type;
u_short ether_residual;
} trailer_header;
char ether_packet[ETHER_MAX_LEN];
char *ep;
ep = ether_packet;
/*
* We handle trailers below:
* Copy ether header first, then residual data,
* then data. Put all this in a temporary buffer
* 'ether_packet' and send off to bpf. Since the
* system has generated this packet, we assume
* that all of the offsets in the packet are
* correct; if they're not, the system will almost
* certainly crash in m_copydata.
* We make no assumptions about how the data is
* arranged in the mbuf chain (i.e. how much
* data is in each mbuf, if mbuf clusters are
* used, etc.), which is why we use m_copydata
* to get the ether header rather than assume
* that this is located in the first mbuf.
*/
/* copy ether header */
m_copydata(top, 0, sizeof(struct ether_header), ep);
eh = (struct ether_header *) ep;
ep += sizeof(struct ether_header);
etype = ntohs(eh->ether_type);
if (etype >= ETHERTYPE_TRAIL &&
etype < ETHERTYPE_TRAIL + ETHERTYPE_NTRAILER) {
datasize = ((etype - ETHERTYPE_TRAIL) << 9);
off = datasize + sizeof(struct ether_header);
/* copy trailer_header into a data structure */
m_copydata(top, off, sizeof(struct trailer_header),
&trailer_header.ether_type);
/* copy residual data */
resid = trailer_header.ether_residual -
sizeof(struct trailer_header);
resid = ntohs(resid);
m_copydata(top, off + sizeof(struct trailer_header),
resid, ep);
ep += resid;
/* copy data */
m_copydata(top, sizeof(struct ether_header),
datasize, ep);
ep += datasize;
/* restore original ether packet type */
eh->ether_type = trailer_header.ether_type;
bpf_tap(sc->bpf, ether_packet, ep - ether_packet);
} else
bpf_mtap(sc->bpf, top);
}
#endif
m_freem(top);
1994-03-09 20:19:10 +03:00
++sc->ep_ac.ac_if.if_opackets;
/*
* Is another packet coming in? We don't want to overflow the
* tiny RX fifo.
*/
readcheck:
if (inw(BASE + EP_W1_RX_STATUS) & RX_BYTES_MASK) {
splx(s);
1994-01-28 13:36:59 +03:00
return (0);
}
goto startagain;
}
int
epintr(unit)
int unit;
{
int status, i;
1994-03-29 08:35:37 +04:00
register struct ep_softc *sc = epcd.cd_devs[unit];
1994-03-09 20:19:10 +03:00
struct ifnet *ifp = &sc->ep_ac.ac_if;
status = 0;
status = inw(BASE + EP_STATUS) &
(S_TX_COMPLETE | S_TX_AVAIL | S_RX_COMPLETE | S_CARD_FAILURE);
if (status == 0) {
/* No interrupts. */
outw(BASE + EP_COMMAND, C_INTR_LATCH);
1994-03-29 08:35:37 +04:00
return (0);
}
1994-03-29 08:35:37 +04:00
loop:
/* important that we do this first. */
outw(BASE + EP_COMMAND, ACK_INTR | status);
if (status & S_TX_AVAIL) {
status &= ~S_TX_AVAIL;
inw(BASE + EP_W1_FREE_TX);
1994-03-09 20:19:10 +03:00
sc->ep_ac.ac_if.if_flags &= ~IFF_OACTIVE;
epstart(&sc->ep_ac.ac_if);
}
if (status & S_RX_COMPLETE) {
status &= ~S_RX_COMPLETE;
epread(sc);
}
if (status & S_CARD_FAILURE) {
1994-03-29 08:35:37 +04:00
printf("%s: reset (status: %x)\n", sc->sc_dev.dv_xname, status);
outw(BASE + EP_COMMAND, C_INTR_LATCH);
1994-03-29 08:35:37 +04:00
epinit(sc);
1994-01-28 13:36:59 +03:00
return (1);
}
if (status & S_TX_COMPLETE) {
status &= ~S_TX_COMPLETE;
/*
* We need to read TX_STATUS until we get a 0 status in
* order to turn off the interrupt flag.
*/
while ((i = inb(BASE + EP_W1_TX_STATUS)) & TXS_COMPLETE) {
outw(BASE + EP_W1_TX_STATUS, 0x0);
if (i & (TXS_MAX_COLLISION | TXS_JABBER | TXS_UNDERRUN)) {
if (i & TXS_MAX_COLLISION)
1994-03-09 20:19:10 +03:00
++sc->ep_ac.ac_if.if_collisions;
if (i & (TXS_JABBER | TXS_UNDERRUN)) {
outw(BASE + EP_COMMAND, TX_RESET);
if (i & TXS_UNDERRUN) {
if (sc->tx_start_thresh < ETHER_MAX_LEN) {
sc->tx_start_thresh += 20;
outw(BASE + EP_COMMAND,
SET_TX_START_THRESH |
sc->tx_start_thresh);
}
}
}
outw(BASE + EP_COMMAND, TX_ENABLE);
1994-03-09 20:19:10 +03:00
++sc->ep_ac.ac_if.if_oerrors;
}
}
epstart(ifp);
}
1994-03-29 08:35:37 +04:00
status = inw(BASE + EP_STATUS) &
(S_TX_COMPLETE | S_TX_AVAIL | S_RX_COMPLETE | S_CARD_FAILURE);
if (status == 0) {
/* No interrupts. */
outw(BASE + EP_COMMAND, C_INTR_LATCH);
return (1);
}
goto loop;
}
1994-01-28 13:36:59 +03:00
static void
epread(sc)
register struct ep_softc *sc;
{
struct ether_header *eh;
struct mbuf *mcur, *m, *m0, *top;
int totlen, lenthisone;
1994-01-28 13:36:59 +03:00
int save_totlen, off;
u_short etype;
totlen = inw(BASE + EP_W1_RX_STATUS);
off = 0;
top = 0;
if (totlen & ERR_RX) {
1994-03-09 20:19:10 +03:00
++sc->ep_ac.ac_if.if_ierrors;
goto out;
}
save_totlen = totlen &= RX_BYTES_MASK; /* Lower 11 bits = RX bytes. */
m = sc->mb[sc->next_mb];
sc->mb[sc->next_mb] = 0;
if (m == 0) {
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == 0)
goto out;
} else { /* Convert one of our saved mbuf's */
sc->next_mb = (sc->next_mb + 1) % MAX_MBS;
m->m_data = m->m_pktdat;
m->m_flags = M_PKTHDR;
}
top = m0 = m; /* We assign top so we can "goto out" */
#define EROUND ((sizeof(struct ether_header) + 3) & ~3)
#define EOFF (EROUND - sizeof(struct ether_header))
m0->m_data += EOFF;
/* Read what should be the header. */
insw(BASE + EP_W1_RX_PIO_RD_1,
mtod(m0, caddr_t), sizeof(struct ether_header) / 2);
m->m_len = sizeof(struct ether_header);
totlen -= sizeof(struct ether_header);
/*
* mostly deal with trailer here. (untested)
* We do this in a couple of parts. First we check for a trailer, if
* we have one we convert the mbuf back to a regular mbuf and set the offset and
* subtract sizeof(struct ether_header) from the pktlen.
* After we've read the packet off the interface (all except for the trailer
* header, we then get a header mbuf, read the trailer into it, and fix up
* the mbuf pointer chain.
*/
eh = mtod(m, struct ether_header *);
etype = ntohs((u_short) eh->ether_type);
if (etype >= ETHERTYPE_TRAIL &&
etype < ETHERTYPE_TRAIL + ETHERTYPE_NTRAILER) {
m->m_data = m->m_dat; /* Convert back to regular mbuf. */
m->m_flags = 0; /* This sucks but non-trailers are the norm */
off = (etype - ETHERTYPE_TRAIL) * 512;
if (off >= ETHERMTU) {
m_freem(m);
return; /* sanity */
}
totlen -= sizeof(struct ether_header); /* We don't read the trailer */
m->m_data += 2 * sizeof(u_short); /* Get rid of type & len */
}
while (totlen > 0) {
lenthisone = min(totlen, M_TRAILINGSPACE(m));
if (lenthisone == 0) { /* no room in this one */
mcur = m;
m = sc->mb[sc->next_mb];
sc->mb[sc->next_mb] = 0;
if (!m) {
MGET(m, M_DONTWAIT, MT_DATA);
if (m == 0)
goto out;
} else {
timeout(epmbufqueue, sc, 1);
sc->next_mb = (sc->next_mb + 1) % MAX_MBS;
}
if (totlen >= MINCLSIZE)
MCLGET(m, M_DONTWAIT);
m->m_len = 0;
mcur->m_next = m;
lenthisone = min(totlen, M_TRAILINGSPACE(m));
}
insw(BASE + EP_W1_RX_PIO_RD_1, mtod(m, caddr_t) + m->m_len,
lenthisone / 2);
m->m_len += lenthisone;
if (lenthisone & 1)
*(mtod(m, caddr_t) + m->m_len - 1) = inb(BASE + EP_W1_RX_PIO_RD_1);
totlen -= lenthisone;
}
if (off) {
top = sc->mb[sc->next_mb];
sc->mb[sc->next_mb] = 0;
if (top == 0) {
MGETHDR(top, M_DONTWAIT, MT_DATA);
if (top == 0)
goto out;
} else { /* Convert one of our saved mbuf's */
sc->next_mb = (sc->next_mb + 1) % MAX_MBS;
top->m_data = top->m_pktdat;
top->m_flags = M_PKTHDR;
}
insw(BASE + EP_W1_RX_PIO_RD_1, mtod(top, caddr_t),
sizeof(struct ether_header));
top->m_next = m0;
top->m_len = sizeof(struct ether_header);
/* XXX Accomodate for type and len from beginning of trailer */
top->m_pkthdr.len = save_totlen - (2 * sizeof(u_short));
} else {
top = m0;
top->m_pkthdr.len = save_totlen;
}
1994-03-09 20:19:10 +03:00
top->m_pkthdr.rcvif = &sc->ep_ac.ac_if;
outw(BASE + EP_COMMAND, RX_DISCARD_TOP_PACK);
while (inb(BASE + EP_STATUS) & S_COMMAND_IN_PROGRESS)
;
1994-03-09 20:19:10 +03:00
++sc->ep_ac.ac_if.if_ipackets;
#if NBPFILTER > 0
if (sc->bpf) {
bpf_mtap(sc->bpf, top);
/*
* 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 ((sc->ep_ac.ac_if.if_flags & IFF_PROMISC) &&
(eh->ether_dhost[0] & 1) == 0 &&
bcmp(eh->ether_dhost, sc->ep_ac.ac_enaddr,
sizeof(eh->ether_dhost)) != 0 &&
bcmp(eh->ether_dhost, etherbroadcastaddr,
sizeof(eh->ether_dhost)) != 0) {
m_freem(top);
return;
}
}
#endif
m_adj(top, sizeof(struct ether_header));
1994-03-09 20:19:10 +03:00
ether_input(&sc->ep_ac.ac_if, eh, top);
return;
out: outw(BASE + EP_COMMAND, RX_DISCARD_TOP_PACK);
while (inb(BASE + EP_STATUS) & S_COMMAND_IN_PROGRESS)
;
if (top)
m_freem(top);
}
/*
* Look familiar?
*/
static int
epioctl(ifp, cmd, data)
register struct ifnet *ifp;
int cmd;
caddr_t data;
{
register struct ifaddr *ifa = (struct ifaddr *) data;
1994-03-29 08:35:37 +04:00
struct ep_softc *sc = epcd.cd_devs[ifp->if_unit];
struct ifreq *ifr = (struct ifreq *) data;
1994-01-28 13:36:59 +03:00
int error = 0;
switch (cmd) {
case SIOCSIFADDR:
ifp->if_flags |= IFF_UP;
switch (ifa->ifa_addr->sa_family) {
#ifdef INET
case AF_INET:
1994-03-29 08:35:37 +04:00
epinit(sc); /* before arpwhohas */
((struct arpcom *) ifp)->ac_ipaddr = IA_SIN(ifa)->sin_addr;
arpwhohas((struct arpcom *) ifp, &IA_SIN(ifa)->sin_addr);
break;
#endif
#ifdef NS
case AF_NS:
{
1994-03-09 20:19:10 +03:00
register struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
if (ns_nullhost(*ina))
1994-03-09 20:19:10 +03:00
ina->x_host =
*(union ns_host *)(sc->ep_ac.ac_enaddr);
else {
ifp->if_flags &= ~IFF_RUNNING;
1994-03-09 20:19:10 +03:00
bcopy(ina->x_host.c_host,
sc->ep_ac.ac_enaddr,
sizeof(sc->ep_ac.ac_enaddr));
}
1994-03-29 08:35:37 +04:00
epinit(sc);
break;
}
#endif
default:
1994-03-29 08:35:37 +04:00
epinit(sc);
break;
}
break;
case SIOCSIFFLAGS:
if ((ifp->if_flags & IFF_UP) == 0 && ifp->if_flags & IFF_RUNNING) {
ifp->if_flags &= ~IFF_RUNNING;
1994-03-29 08:35:37 +04:00
epstop(sc);
break;
}
if (ifp->if_flags & IFF_UP && (ifp->if_flags & IFF_RUNNING) == 0)
1994-03-29 08:35:37 +04:00
epinit(sc);
break;
#ifdef notdef
case SIOCGHWADDR:
bcopy((caddr_t) sc->sc_addr, (caddr_t) &ifr->ifr_data,
sizeof(sc->sc_addr));
break;
#endif
default:
error = EINVAL;
}
return (error);
}
1994-01-28 13:36:59 +03:00
static void
1994-03-29 08:35:37 +04:00
epreset(sc)
struct ep_softc *sc;
{
int s = splimp();
1994-03-29 08:35:37 +04:00
epstop(sc);
epinit(sc);
splx(s);
}
static int
epwatchdog(unit)
int unit;
{
1994-03-29 08:35:37 +04:00
register struct ep_softc *sc = epcd.cd_devs[unit];
log(LOG_ERR, "%s: watchdog\n", sc->sc_dev.dv_xname);
epreset(sc);
1994-01-28 13:36:59 +03:00
return 0;
}
1994-01-28 13:36:59 +03:00
static void
1994-03-29 08:35:37 +04:00
epstop(sc)
register struct ep_softc *sc;
{
outw(BASE + EP_COMMAND, RX_DISABLE);
outw(BASE + EP_COMMAND, RX_DISCARD_TOP_PACK);
while (inb(BASE + EP_STATUS) & S_COMMAND_IN_PROGRESS)
;
outw(BASE + EP_COMMAND, TX_DISABLE);
outw(BASE + EP_COMMAND, STOP_TRANSCEIVER);
outw(BASE + EP_COMMAND, RX_RESET);
outw(BASE + EP_COMMAND, TX_RESET);
outw(BASE + EP_COMMAND, C_INTR_LATCH);
outw(BASE + EP_COMMAND, SET_RD_0_MASK);
outw(BASE + EP_COMMAND, SET_INTR_MASK);
outw(BASE + EP_COMMAND, SET_RX_FILTER);
}
/*
* We get eeprom data from the id_port given an offset into the
* eeprom. Basically; after the ID_sequence is sent to all of
* the cards; they enter the ID_CMD state where they will accept
* command requests. 0x80-0xbf loads the eeprom data. We then
* read the port 16 times and with every read; the cards check
* for contention (ie: if one card writes a 0 bit and another
* writes a 1 bit then the host sees a 0. At the end of the cycle;
* each card compares the data on the bus; if there is a difference
* then that card goes into ID_WAIT state again). In the meantime;
* one bit of data is returned in the AX register which is conveniently
* returned to us by inb(). Hence; we read 16 times getting one
* bit of data with each read.
*/
static u_short
1994-01-28 13:36:59 +03:00
epreadeeprom(id_port, offset)
int id_port;
int offset;
{
int i, data = 0;
1994-03-29 08:35:37 +04:00
outb(id_port, 0x80 + offset);
delay(1000);
for (i = 0; i < 16; i++)
data = (data << 1) | (inw(id_port) & 1);
return (data);
}
static int
1994-03-29 08:35:37 +04:00
epbusyeeprom(sc)
struct ep_softc *sc;
{
1994-03-29 08:35:37 +04:00
int i = 100, j;
1994-03-29 08:35:37 +04:00
while (i--) {
j = inw(BASE + EP_W0_EEPROM_COMMAND);
if (j & EEPROM_BUSY)
delay(100);
else
break;
}
1994-03-29 08:35:37 +04:00
if (!i) {
printf("\n%s: eeprom failed to come ready.\n",
sc->sc_dev.dv_xname);
return (1);
}
if (j & EEPROM_TST_MODE) {
1994-03-29 08:35:37 +04:00
printf("\n%s: 3c509 in test mode. Erase pencil mark!\n",
sc->sc_dev.dv_xname);
return (1);
}
return (0);
}
1994-01-28 13:36:59 +03:00
static void
epmbufqueue(sc)
struct ep_softc *sc;
{
int i = 0;
1994-02-14 05:09:31 +03:00
int s;
1994-01-28 13:36:59 +03:00
s = splimp();
i = sc->last_mb;
1994-02-14 05:09:31 +03:00
if (sc->mb[i]) {
splx(s);
1994-01-28 13:36:59 +03:00
return;
1994-02-14 05:09:31 +03:00
}
do {
MGET(sc->mb[i], M_DONTWAIT, MT_DATA);
if (!sc->mb[i])
break;
i = (i + 1) % MAX_MBS;
} while (i != sc->next_mb);
sc->last_mb = i;
1994-02-14 05:09:31 +03:00
splx(s);
}