NetBSD/sys/arch/amiga/dev/if_es.c
ozaki-r dd8638eea5 Move bpf_mtap and if_ipackets++ on Rx of each driver to percpuq if_input
The benefits of the change are:
- We can reduce codes
- We can provide the same behavior between drivers
  - Where/When if_ipackets is counted up
  - Note that some drivers still update packet statistics in their own
    way (periodical update)
- Moved bpf_mtap run in softint
  - This makes it easy to MP-ify bpf

Proposed on tech-kern and tech-net
2016-12-15 09:28:02 +00:00

1072 lines
27 KiB
C

/* $NetBSD: if_es.c,v 1.56 2016/12/15 09:28:02 ozaki-r Exp $ */
/*
* Copyright (c) 1995 Michael L. Hitch
* 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.
*
* 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.
*/
/*
* SMC 91C90 Single-Chip Ethernet Controller
*/
#include "opt_ddb.h"
#include "opt_inet.h"
#include "opt_ns.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: if_es.c,v 1.56 2016/12/15 09:28:02 ozaki-r Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/buf.h>
#include <sys/protosw.h>
#include <sys/socket.h>
#include <sys/syslog.h>
#include <sys/ioctl.h>
#include <sys/errno.h>
#include <sys/device.h>
#include <net/if.h>
#include <net/if_dl.h>
#include <net/if_ether.h>
#include <net/if_media.h>
#ifdef INET
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#include <netinet/if_inarp.h>
#endif
#include <machine/cpu.h>
#include <amiga/amiga/device.h>
#include <amiga/amiga/isr.h>
#include <amiga/dev/zbusvar.h>
#include <amiga/dev/if_esreg.h>
#define SWAP(x) (((x & 0xff) << 8) | ((x >> 8) & 0xff))
#define USEPKTBUF
/*
* Ethernet software status per interface.
*
* Each interface is referenced by a network interface structure,
* es_if, which the routing code uses to locate the interface.
* This structure contains the output queue for the interface, its address, ...
*/
struct es_softc {
device_t sc_dev;
struct isr sc_isr;
struct ethercom sc_ethercom; /* common Ethernet structures */
struct ifmedia sc_media; /* our supported media */
void *sc_base; /* base address of board */
short sc_iflags;
unsigned short sc_intctl;
#ifdef ESDEBUG
int sc_debug;
short sc_intbusy; /* counter for interrupt rentered */
short sc_smcbusy; /* counter for other rentry checks */
#endif
};
#include <net/bpf.h>
#include <net/bpfdesc.h>
#ifdef ESDEBUG
/* console error messages */
int esdebug = 0;
int estxints = 0; /* IST_TX with TX enabled */
int estxint2 = 0; /* IST_TX active after IST_TX_EMPTY */
int estxint3 = 0; /* IST_TX interrupt processed */
int estxint4 = 0; /* ~TEMPTY counts */
int estxint5 = 0; /* IST_TX_EMPTY interrupts */
void es_dump_smcregs(char *, union smcregs *);
#endif
int esintr(void *);
void esstart(struct ifnet *);
void eswatchdog(struct ifnet *);
int esioctl(struct ifnet *, u_long, void *);
void esrint(struct es_softc *);
void estint(struct es_softc *);
void esinit(struct es_softc *);
void esreset(struct es_softc *);
void esstop(struct es_softc *);
int esmediachange(struct ifnet *);
void esmediastatus(struct ifnet *, struct ifmediareq *);
int esmatch(device_t, cfdata_t, void *);
void esattach(device_t, device_t, void *);
CFATTACH_DECL_NEW(es, sizeof(struct es_softc),
esmatch, esattach, NULL, NULL);
int
esmatch(device_t parent, cfdata_t cf, void *aux)
{
struct zbus_args *zap = aux;
/* Ameristar A4066 ethernet card */
if (zap->manid == 1053 && zap->prodid == 10)
return(1);
return (0);
}
/*
* Interface exists: make available by filling in network interface
* record. System will initialize the interface when it is ready
* to accept packets.
*/
void
esattach(device_t parent, device_t self, void *aux)
{
struct es_softc *sc = device_private(self);
struct zbus_args *zap = aux;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
unsigned long ser;
u_int8_t myaddr[ETHER_ADDR_LEN];
sc->sc_dev = self;
sc->sc_base = zap->va;
/*
* Manufacturer decides the 3 first bytes, i.e. ethernet vendor ID.
* (Currently only Ameristar.)
*/
myaddr[0] = 0x00;
myaddr[1] = 0x00;
myaddr[2] = 0x9f;
/*
* Serial number for board contains last 3 bytes.
*/
ser = (unsigned long) zap->serno;
myaddr[3] = (ser >> 16) & 0xff;
myaddr[4] = (ser >> 8) & 0xff;
myaddr[5] = (ser ) & 0xff;
/* Initialize ifnet structure. */
memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
ifp->if_softc = sc;
ifp->if_ioctl = esioctl;
ifp->if_start = esstart;
ifp->if_watchdog = eswatchdog;
ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS |
IFF_MULTICAST;
ifmedia_init(&sc->sc_media, 0, esmediachange, esmediastatus);
ifmedia_add(&sc->sc_media, IFM_ETHER|IFM_MANUAL, 0, NULL);
ifmedia_set(&sc->sc_media, IFM_ETHER|IFM_MANUAL);
/* Attach the interface. */
if_attach(ifp);
ether_ifattach(ifp, myaddr);
/* Print additional info when attached. */
printf(": address %s\n", ether_sprintf(myaddr));
sc->sc_isr.isr_intr = esintr;
sc->sc_isr.isr_arg = sc;
sc->sc_isr.isr_ipl = 2;
add_isr(&sc->sc_isr);
}
#ifdef ESDEBUG
void
es_dump_smcregs(char *where, union smcregs *smc)
{
u_short cur_bank = smc->b0.bsr & BSR_MASK;
printf("SMC registers %p from %s bank %04x\n", smc, where,
smc->b0.bsr);
smc->b0.bsr = BSR_BANK0;
printf("TCR %04x EPHSR %04x RCR %04x ECR %04x MIR %04x MCR %04x\n",
SWAP(smc->b0.tcr), SWAP(smc->b0.ephsr), SWAP(smc->b0.rcr),
SWAP(smc->b0.ecr), SWAP(smc->b0.mir), SWAP(smc->b0.mcr));
smc->b1.bsr = BSR_BANK1;
printf("CR %04x BAR %04x IAR %04x %04x %04x GPR %04x CTR %04x\n",
SWAP(smc->b1.cr), SWAP(smc->b1.bar), smc->b1.iar[0], smc->b1.iar[1],
smc->b1.iar[2], smc->b1.gpr, SWAP(smc->b1.ctr));
smc->b2.bsr = BSR_BANK2;
printf("MMUCR %04x PNR %02x ARR %02x FIFO %04x PTR %04x",
SWAP(smc->b2.mmucr), smc->b2.pnr, smc->b2.arr, smc->b2.fifo,
SWAP(smc->b2.ptr));
printf(" DATA %04x %04x IST %02x MSK %02x\n", smc->b2.data,
smc->b2.datax, smc->b2.ist, smc->b2.msk);
smc->b3.bsr = BSR_BANK3;
printf("MT %04x %04x %04x %04x\n",
smc->b3.mt[0], smc->b3.mt[1], smc->b3.mt[2], smc->b3.mt[3]);
smc->b3.bsr = cur_bank;
}
#endif
void
esstop(struct es_softc *sc)
{
union smcregs *smc = sc->sc_base;
/*
* Clear interrupt mask; disable all interrupts.
*/
smc->b2.bsr = BSR_BANK2;
smc->b2.msk = 0;
/*
* Disable transmitter and receiver.
*/
smc->b0.bsr = BSR_BANK0;
smc->b0.rcr = 0;
smc->b0.tcr = 0;
/*
* Cancel watchdog timer.
*/
sc->sc_ethercom.ec_if.if_timer = 0;
}
void
esinit(struct es_softc *sc)
{
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
union smcregs *smc = sc->sc_base;
int s;
s = splnet();
#ifdef ESDEBUG
if (ifp->if_flags & IFF_RUNNING)
es_dump_smcregs("esinit", smc);
#endif
smc->b0.bsr = BSR_BANK0; /* Select bank 0 */
smc->b0.rcr = RCR_EPH_RST;
smc->b0.rcr = 0;
smc->b3.bsr = BSR_BANK3; /* Select bank 3 */
smc->b3.mt[0] = 0; /* clear Multicast table */
smc->b3.mt[1] = 0;
smc->b3.mt[2] = 0;
smc->b3.mt[3] = 0;
/* XXX set Multicast table from Multicast list */
smc->b1.bsr = BSR_BANK1; /* Select bank 1 */
smc->b1.cr = CR_RAM32K | CR_NO_WAIT_ST | CR_SET_SQLCH;
smc->b1.ctr = CTR_AUTO_RLSE | CTR_TE_ENA;
smc->b1.iar[0] = *((const unsigned short *) &CLLADDR(ifp->if_sadl)[0]);
smc->b1.iar[1] = *((const unsigned short *) &CLLADDR(ifp->if_sadl)[2]);
smc->b1.iar[2] = *((const unsigned short *) &CLLADDR(ifp->if_sadl)[4]);
smc->b2.bsr = BSR_BANK2; /* Select bank 2 */
smc->b2.mmucr = MMUCR_RESET;
smc->b0.bsr = BSR_BANK0; /* Select bank 0 */
smc->b0.mcr = SWAP(0x0020); /* reserve 8K for transmit buffers */
smc->b0.tcr = TCR_PAD_EN | (TCR_TXENA + TCR_MON_CSN);
smc->b0.rcr = RCR_FILT_CAR | RCR_STRIP_CRC | RCR_RXEN | RCR_ALLMUL;
/* XXX add promiscuous flags */
smc->b2.bsr = BSR_BANK2; /* Select bank 2 */
smc->b2.msk = sc->sc_intctl = MSK_RX_OVRN | MSK_RX | MSK_EPHINT;
/* Interface is now 'running', with no output active. */
ifp->if_flags |= IFF_RUNNING;
ifp->if_flags &= ~IFF_OACTIVE;
/* Attempt to start output, if any. */
esstart(ifp);
splx(s);
}
int
esintr(void *arg)
{
struct es_softc *sc = arg;
struct ifnet *ifp = &sc->sc_ethercom.ec_if;
u_short intsts, intact;
union smcregs *smc;
int s = splnet();
smc = sc->sc_base;
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2 &&
ifp->if_flags & IFF_RUNNING) {
printf("%s: intr BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
intsts = smc->b2.ist;
intact = smc->b2.msk & intsts;
if ((intact) == 0) {
splx(s);
return (0);
}
#ifdef ESDEBUG
if (esdebug)
printf ("%s: esintr ist %02x msk %02x",
device_xname(sc->sc_dev), intsts, smc->b2.msk);
if (sc->sc_intbusy++) {
printf("%s: esintr re-entered\n", device_xname(sc->sc_dev));
panic("esintr re-entered");
}
if (sc->sc_smcbusy)
printf("%s: esintr interrupted busy %d\n", device_xname(sc->sc_dev),
sc->sc_smcbusy);
#endif
smc->b2.msk = 0;
#ifdef ESDEBUG
if (esdebug)
printf ("=>%02x%02x pnr %02x arr %02x fifo %04x\n",
smc->b2.ist, smc->b2.ist, smc->b2.pnr, smc->b2.arr,
smc->b2.fifo);
#endif
if (intact & IST_ALLOC) {
sc->sc_intctl &= ~MSK_ALLOC;
#ifdef ESDEBUG
if (esdebug || 1)
printf ("%s: ist %02x", device_xname(sc->sc_dev),
intsts);
#endif
if ((smc->b2.arr & ARR_FAILED) == 0) {
u_char save_pnr;
#ifdef ESDEBUG
if (esdebug || 1)
printf (" arr %02x\n", smc->b2.arr);
#endif
save_pnr = smc->b2.pnr;
smc->b2.pnr = smc->b2.arr;
smc->b2.mmucr = MMUCR_RLSPKT;
while (smc->b2.mmucr & MMUCR_BUSY)
;
smc->b2.pnr = save_pnr;
ifp->if_flags &= ~IFF_OACTIVE;
ifp->if_timer = 0;
}
#ifdef ESDEBUG
else if (esdebug || 1)
printf (" IST_ALLOC with ARR_FAILED?\n");
#endif
}
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: intr+ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
while ((smc->b2.fifo & FIFO_REMPTY) == 0) {
esrint(sc);
}
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: intr++ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
if (intact & IST_RX_OVRN) {
printf ("%s: Overrun ist %02x", device_xname(sc->sc_dev),
intsts);
smc->b2.ist = ACK_RX_OVRN;
printf ("->%02x\n", smc->b2.ist);
ifp->if_ierrors++;
}
if (intact & IST_TX_EMPTY) {
u_short ecr;
#ifdef ESDEBUG
if (esdebug)
printf ("%s: TX EMPTY %02x",
device_xname(sc->sc_dev), intsts);
++estxint5; /* count # IST_TX_EMPTY ints */
#endif
smc->b2.ist = ACK_TX_EMPTY;
sc->sc_intctl &= ~(MSK_TX_EMPTY | MSK_TX);
ifp->if_timer = 0;
#ifdef ESDEBUG
if (esdebug)
printf ("->%02x intcl %x pnr %02x arr %02x\n",
smc->b2.ist, sc->sc_intctl, smc->b2.pnr,
smc->b2.arr);
#endif
if (smc->b2.ist & IST_TX) {
intact |= IST_TX;
#ifdef ESDEBUG
++estxint2; /* count # TX after TX_EMPTY */
#endif
} else {
smc->b0.bsr = BSR_BANK0;
ecr = smc->b0.ecr; /* Get error counters */
if (ecr & 0xff00)
ifp->if_collisions += ((ecr >> 8) & 15) +
((ecr >> 11) & 0x1e);
smc->b2.bsr = BSR_BANK2;
#if 0
smc->b2.mmucr = MMUCR_RESET_TX; /* XXX reset TX FIFO */
#endif
}
}
if (intact & IST_TX) {
u_char tx_pnr, save_pnr;
u_short save_ptr, ephsr, tcr;
int n = 0;
#ifdef ESDEBUG
if (esdebug) {
printf ("%s: TX INT ist %02x",
device_xname(sc->sc_dev), intsts);
printf ("->%02x\n", smc->b2.ist);
}
++estxint3; /* count # IST_TX */
#endif
zzzz:
#ifdef ESDEBUG
++estxint4; /* count # ~TEMPTY */
#endif
smc->b0.bsr = BSR_BANK0;
ephsr = smc->b0.ephsr; /* get EPHSR */
__USE(ephsr);
tcr = smc->b0.tcr; /* and TCR */
smc->b2.bsr = BSR_BANK2;
save_ptr = smc->b2.ptr;
save_pnr = smc->b2.pnr;
tx_pnr = smc->b2.fifo >> 8; /* pktno from completion fifo */
smc->b2.pnr = tx_pnr; /* set TX packet number */
smc->b2.ptr = PTR_READ; /* point to status word */
#if 0 /* XXXX */
printf("%s: esintr TXINT IST %02x PNR %02x(%d)",
device_xname(sc->sc_dev), smc->b2.ist,
tx_pnr, n);
printf(" Status %04x", smc->b2.data);
printf(" EPHSR %04x\n", ephsr);
#endif
if ((smc->b2.data & EPHSR_TX_SUC) == 0 && (tcr & TCR_TXENA) == 0) {
/*
* Transmitter was stopped for some error. Enqueue
* the packet again and restart the transmitter.
* May need some check to limit the number of retries.
*/
smc->b2.mmucr = MMUCR_ENQ_TX;
smc->b0.bsr = BSR_BANK0;
smc->b0.tcr |= TCR_TXENA;
smc->b2.bsr = BSR_BANK2;
ifp->if_oerrors++;
sc->sc_intctl |= MSK_TX_EMPTY | MSK_TX;
} else {
/*
* This shouldn't have happened: IST_TX indicates
* the TX completion FIFO is not empty, but the
* status for the packet on the completion FIFO
* shows that the transmit was successful. Since
* AutoRelease is being used, a successful transmit
* should not result in a packet on the completion
* FIFO. Also, that packet doesn't seem to want
* to be acknowledged. If this occurs, just reset
* the TX FIFOs.
*/
#if 1
if (smc->b2.ist & IST_TX_EMPTY) {
smc->b2.mmucr = MMUCR_RESET_TX;
sc->sc_intctl &= ~(MSK_TX_EMPTY | MSK_TX);
ifp->if_timer = 0;
}
#endif
#ifdef ESDEBUG
++estxints; /* count IST_TX with TX enabled */
#endif
}
smc->b2.pnr = save_pnr;
smc->b2.ptr = save_ptr;
smc->b2.ist = ACK_TX;
if ((smc->b2.fifo & FIFO_TEMPTY) == 0 && n++ < 32) {
#if 0 /* XXXX */
printf("%s: multiple TX int(%2d) pnr %02x ist %02x fifo %04x",
device_xname(sc->sc_dev), n, tx_pnr, smc->b2.ist, smc->b2.fifo);
smc->w2.istmsk = ACK_TX << 8;
printf(" %04x\n", smc->b2.fifo);
#endif
if (tx_pnr != (smc->b2.fifo >> 8))
goto zzzz;
}
}
if (intact & IST_EPHINT) {
ifp->if_oerrors++;
esreset(sc);
}
/* output packets */
estint(sc);
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: intr+++ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
smc->b2.msk = sc->sc_intctl;
#ifdef ESDEBUG
if (--sc->sc_intbusy) {
printf("%s: esintr busy on exit\n", device_xname(sc->sc_dev));
panic("esintr busy on exit");
}
#endif
splx(s);
return (1);
}
void
esrint(struct es_softc *sc)
{
union smcregs *smc = sc->sc_base;
u_short len;
short cnt;
u_short pktctlw, pktlen, *buf;
volatile u_short *data;
#if 0
u_long *lbuf;
volatile u_long *ldata;
#endif
struct ifnet *ifp;
struct mbuf *top, **mp, *m;
#ifdef USEPKTBUF
u_char *b, pktbuf[1530];
#endif
#ifdef ESDEBUG
int i;
#endif
ifp = &sc->sc_ethercom.ec_if;
#ifdef ESDEBUG
if (esdebug)
printf ("%s: esrint fifo %04x", device_xname(sc->sc_dev),
smc->b2.fifo);
if (sc->sc_smcbusy++) {
printf("%s: esrint re-entered\n", device_xname(sc->sc_dev));
panic("esrint re-entered");
}
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: rint BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
data = (volatile u_short *)&smc->b2.data;
smc->b2.ptr = PTR_RCV | PTR_AUTOINCR | PTR_READ | SWAP(0x0002);
(void) smc->b2.mmucr;
#ifdef ESDEBUG
if (esdebug)
printf ("->%04x", smc->b2.fifo);
#endif
len = *data;
len = SWAP(len); /* Careful of macro side-effects */
#ifdef ESDEBUG
if (esdebug)
printf (" length %d", len);
#endif
smc->b2.ptr = PTR_RCV | (PTR_AUTOINCR + PTR_READ) | SWAP(0x0000);
(void) smc->b2.mmucr;
pktctlw = *data;
pktlen = *data;
pktctlw = SWAP(pktctlw);
pktlen = SWAP(pktlen) - 6;
if (pktctlw & RFSW_ODDFRM)
pktlen++;
if (len > 1530) {
printf("%s: Corrupted packet length-sts %04x bytcnt %04x len %04x bank %04x\n",
device_xname(sc->sc_dev), pktctlw, pktlen, len, smc->b2.bsr);
/* XXX ignore packet, or just truncate? */
#if defined(ESDEBUG) && defined(DDB)
if ((smc->b2.bsr & BSR_MASK) != BSR_BANK2)
Debugger();
#endif
smc->b2.bsr = BSR_BANK2;
smc->b2.mmucr = MMUCR_REMRLS_RX;
while (smc->b2.mmucr & MMUCR_BUSY)
;
++ifp->if_ierrors;
#ifdef ESDEBUG
if (--sc->sc_smcbusy) {
printf("%s: esrintr busy on bad packet exit\n",
device_xname(sc->sc_dev));
panic("esrintr busy on exit");
}
#endif
return;
}
#ifdef USEPKTBUF
#if 0
lbuf = (u_long *) pktbuf;
ldata = (u_long *)data;
cnt = (len - 4) / 4;
while (cnt--)
*lbuf++ = *ldata;
if ((len - 4) & 2) {
buf = (u_short *) lbuf;
*buf = *data;
}
#else
buf = (u_short *)pktbuf;
cnt = (len - 4) / 2;
while (cnt--)
*buf++ = *data;
#endif
smc->b2.mmucr = MMUCR_REMRLS_RX;
while (smc->b2.mmucr & MMUCR_BUSY)
;
#ifdef ESDEBUG
if (pktctlw & (RFSW_ALGNERR | RFSW_BADCRC | RFSW_TOOLNG | RFSW_TOOSHORT)) {
printf ("%s: Packet error %04x\n", device_xname(sc->sc_dev), pktctlw);
/* count input error? */
}
if (esdebug) {
printf (" pktctlw %04x pktlen %04x fifo %04x\n", pktctlw, pktlen,
smc->b2.fifo);
for (i = 0; i < pktlen; ++i)
printf ("%02x%s", pktbuf[i], ((i & 31) == 31) ? "\n" :
"");
if (i & 31)
printf ("\n");
}
#endif
#else /* USEPKTBUF */
/* XXX copy directly from controller to mbuf */
#ifdef ESDEBUG
if (pktctlw & (RFSW_ALGNERR | RFSW_BADCRC | RFSW_TOOLNG | RFSW_TOOSHORT)) {
printf ("%s: Packet error %04x\n", device_xname(sc->sc_dev), pktctlw);
/* count input error? */
}
if (esdebug) {
printf (" pktctlw %04x pktlen %04x fifo %04x\n", pktctlw, pktlen,
smc->b2.fifo);
}
#endif
#endif /* USEPKTBUF */
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == NULL)
return;
m_set_rcvif(m, ifp);
m->m_pkthdr.len = pktlen;
len = MHLEN;
top = NULL;
mp = &top;
#ifdef USEPKTBUF
b = pktbuf;
#endif
while (pktlen > 0) {
if (top) {
MGET(m, M_DONTWAIT, MT_DATA);
if (m == 0) {
m_freem(top);
return;
}
len = MLEN;
}
if (pktlen >= MINCLSIZE) {
MCLGET(m, M_DONTWAIT);
if (m->m_flags & M_EXT)
len = MCLBYTES;
}
m->m_len = len = min(pktlen, len);
#ifdef USEPKTBUF
memcpy(mtod(m, void *), (void *)b, len);
b += len;
#else /* USEPKTBUF */
buf = mtod(m, u_short *);
cnt = len / 2;
while (cnt--)
*buf++ = *data;
if (len & 1)
*buf = *data; /* XXX should be byte store */
#ifdef ESDEBUG
if (esdebug) {
buf = mtod(m, u_short *);
for (i = 0; i < len; ++i)
printf ("%02x%s", ((u_char *)buf)[i],
((i & 31) == 31) ? "\n" : "");
if (i & 31)
printf ("\n");
}
#endif
#endif /* USEPKTBUF */
pktlen -= len;
*mp = m;
mp = &m->m_next;
}
#ifndef USEPKTBUF
smc->b2.mmucr = MMUCR_REMRLS_RX;
while (smc->b2.mmucr & MMUCR_BUSY)
;
#endif
/*
* Check if there's a BPF listener on this interface. If so, hand off
* the raw packet to bpf.
*/
if_percpuq_enqueue(ifp->if_percpuq, top);
#ifdef ESDEBUG
if (--sc->sc_smcbusy) {
printf("%s: esintr busy on exit\n", device_xname(sc->sc_dev));
panic("esintr busy on exit");
}
#endif
}
void
estint(struct es_softc *sc)
{
esstart(&sc->sc_ethercom.ec_if);
}
void
esstart(struct ifnet *ifp)
{
struct es_softc *sc = ifp->if_softc;
union smcregs *smc = sc->sc_base;
struct mbuf *m0, *m;
#ifdef USEPKTBUF
u_short pktbuf[ETHERMTU + 2];
#else
u_short oddbyte, needbyte;
#endif
u_short pktctlw, pktlen;
u_short *buf;
volatile u_short *data;
#if 0
u_long *lbuf;
volatile u_long *ldata;
#endif
short cnt;
int i;
u_char active_pnr;
if ((sc->sc_ethercom.ec_if.if_flags & (IFF_RUNNING | IFF_OACTIVE)) !=
IFF_RUNNING)
return;
#ifdef ESDEBUG
if (sc->sc_smcbusy++) {
printf("%s: esstart re-entered\n", device_xname(sc->sc_dev));
panic("esstart re-entred");
}
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: esstart BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
for (;;) {
#ifdef ESDEBUG
u_short start_ptr, end_ptr;
#endif
/*
* Sneak a peek at the next packet to get the length
* and see if the SMC 91C90 can accept it.
*/
m = sc->sc_ethercom.ec_if.if_snd.ifq_head;
if (!m)
break;
#ifdef ESDEBUG
if (esdebug && (m->m_next || m->m_len & 1))
printf("%s: esstart m_next %p m_len %d\n",
device_xname(sc->sc_dev), m->m_next, m->m_len);
#endif
for (m0 = m, pktlen = 0; m0; m0 = m0->m_next)
pktlen += m0->m_len;
pktctlw = 0;
pktlen += 4;
if (pktlen & 1)
++pktlen; /* control byte after last byte */
else
pktlen += 2; /* control byte after pad byte */
smc->b2.mmucr = MMUCR_ALLOC | (pktlen & 0x0700);
for (i = 0; i <= 5; ++i)
if ((smc->b2.arr & ARR_FAILED) == 0)
break;
if (smc->b2.arr & ARR_FAILED) {
sc->sc_ethercom.ec_if.if_flags |= IFF_OACTIVE;
sc->sc_intctl |= MSK_ALLOC;
sc->sc_ethercom.ec_if.if_timer = 5;
break;
}
active_pnr = smc->b2.pnr = smc->b2.arr;
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: esstart+ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
IF_DEQUEUE(&sc->sc_ethercom.ec_if.if_snd, m);
smc->b2.ptr = PTR_AUTOINCR;
(void) smc->b2.mmucr;
data = (volatile u_short *)&smc->b2.data;
*data = SWAP(pktctlw);
*data = SWAP(pktlen);
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: esstart++ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
#endif
#ifdef USEPKTBUF
i = 0;
for (m0 = m; m; m = m->m_next) {
memcpy((char *)pktbuf + i, mtod(m, void *), m->m_len);
i += m->m_len;
}
if (i & 1) /* Figure out where to put control byte */
pktbuf[i/2] = (pktbuf[i/2] & 0xff00) | CTLB_ODD;
else
pktbuf[i/2] = 0;
pktlen -= 4;
#ifdef ESDEBUG
if (pktlen > sizeof(pktbuf) && i > (sizeof(pktbuf) * 2))
printf("%s: esstart packet longer than pktbuf\n",
device_xname(sc->sc_dev));
#endif
#if 0 /* doesn't quite work? */
lbuf = (u_long *)(pktbuf);
ldata = (u_long *)data;
cnt = pktlen / 4;
while(cnt--)
*ldata = *lbuf++;
if (pktlen & 2) {
buf = (u_short *)lbuf;
*data = *buf;
}
#else
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: esstart++2 BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
start_ptr = SWAP(smc->b2.ptr); /* save PTR before copy */
#endif
buf = pktbuf;
cnt = pktlen / 2;
while (cnt--)
*data = *buf++;
#ifdef ESDEBUG
end_ptr = SWAP(smc->b2.ptr); /* save PTR after copy */
#endif
#endif
#else /* USEPKTBUF */
pktctlw = 0;
oddbyte = needbyte = 0;
for (m0 = m; m; m = m->m_next) {
buf = mtod(m, u_short *);
cnt = m->m_len / 2;
if (needbyte) {
oddbyte |= *buf >> 8;
*data = oddbyte;
}
while (cnt--)
*data = *buf++;
if (m->m_len & 1)
pktctlw = (*buf & 0xff00) | CTLB_ODD;
if (m->m_len & 1 && m->m_next)
printf("%s: esstart odd byte count in mbuf\n",
device_xname(sc->sc_dev));
}
*data = pktctlw;
#endif /* USEPKTBUF */
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
/*
* The bank select register has changed. This seems
* to happen with my A2000/Zeus once in a while. It
* appears that the Ethernet chip resets while
* copying the transmit buffer. Requeue the current
* transmit buffer and reinitialize the interface.
* The initialize routine will take care of
* retransmitting the buffer. mhitch
*/
#ifdef DIAGNOSTIC
printf("%s: esstart+++ BSR not 2: %04x\n",
device_xname(sc->sc_dev), smc->b2.bsr);
#endif
smc->b2.bsr = BSR_BANK2;
#ifdef ESDEBUG
printf("start_ptr %04x end_ptr %04x cur ptr %04x\n",
start_ptr, end_ptr, SWAP(smc->b2.ptr));
--sc->sc_smcbusy;
#endif
IF_PREPEND(&sc->sc_ethercom.ec_if.if_snd, m0);
esinit(sc); /* It's really hosed - reset */
return;
}
smc->b2.mmucr = MMUCR_ENQ_TX;
if (smc->b2.pnr != active_pnr)
printf("%s: esstart - PNR changed %x->%x\n",
device_xname(sc->sc_dev), active_pnr, smc->b2.pnr);
bpf_mtap(&sc->sc_ethercom.ec_if, m0);
m_freem(m0);
sc->sc_ethercom.ec_if.if_opackets++; /* move to interrupt? */
sc->sc_intctl |= MSK_TX_EMPTY | MSK_TX;
sc->sc_ethercom.ec_if.if_timer = 5;
}
smc->b2.msk = sc->sc_intctl;
#ifdef ESDEBUG
while ((smc->b2.bsr & BSR_MASK) != BSR_BANK2) {
printf("%s: esstart++++ BSR not 2: %04x\n", device_xname(sc->sc_dev),
smc->b2.bsr);
smc->b2.bsr = BSR_BANK2;
}
if (--sc->sc_smcbusy) {
printf("%s: esstart busy on exit\n", device_xname(sc->sc_dev));
panic("esstart busy on exit");
}
#endif
}
int
esioctl(struct ifnet *ifp, u_long cmd, void *data)
{
struct es_softc *sc = ifp->if_softc;
register struct ifaddr *ifa = (struct ifaddr *)data;
struct ifreq *ifr = (struct ifreq *)data;
int s, error = 0;
s = splnet();
switch (cmd) {
case SIOCINITIFADDR:
ifp->if_flags |= IFF_UP;
switch (ifa->ifa_addr->sa_family) {
#ifdef INET
case AF_INET:
esinit(sc);
arp_ifinit(ifp, ifa);
break;
#endif
default:
esinit(sc);
break;
}
break;
case SIOCSIFFLAGS:
if ((error = ifioctl_common(ifp, cmd, data)) != 0)
break;
/* XXX see the comment in ed_ioctl() about code re-use */
/*
* If interface is marked down and it is running, then stop it
*/
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.
*/
esstop(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.
*/
esinit(sc);
} else {
/*
* Reset the interface to pick up changes in any other
* flags that affect hardware registers.
*/
esstop(sc);
esinit(sc);
}
#ifdef ESDEBUG
if (ifp->if_flags & IFF_DEBUG)
esdebug = sc->sc_debug = 1;
else
esdebug = sc->sc_debug = 0;
#endif
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
/*
* Multicast list has changed; set the hardware filter
* accordingly.
*/
if (ifp->if_flags & IFF_RUNNING) {
/* XXX */
}
error = 0;
}
break;
case SIOCGIFMEDIA:
case SIOCSIFMEDIA:
error = ifmedia_ioctl(ifp, ifr, &sc->sc_media, cmd);
break;
default:
error = ether_ioctl(ifp, cmd, data);
break;
}
splx(s);
return (error);
}
/*
* Reset the interface.
*/
void
esreset(struct es_softc *sc)
{
int s;
s = splnet();
esstop(sc);
esinit(sc);
splx(s);
}
void
eswatchdog(struct ifnet *ifp)
{
struct es_softc *sc = ifp->if_softc;
log(LOG_ERR, "%s: device timeout\n", device_xname(sc->sc_dev));
++ifp->if_oerrors;
esreset(sc);
}
int
esmediachange(struct ifnet *ifp)
{
return 0;
}
void
esmediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
{
}