root/sys/arch/amiga/dev/if_es.c
/*      $NetBSD: if_es.c,v 1.70 2023/08/27 22:09:55 andvar 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.70 2023/08/27 22:09:55 andvar 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>
#include <net/bpf.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;
        bool    sc_txbusy;
#ifdef ESDEBUG
        int     sc_debug;
        short   sc_intbusy;             /* counter for interrupt rentered */
        short   sc_smcbusy;             /* counter for other rentry checks */
#endif
};

#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(const 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_MULTICAST;

        /* Setup ifmedia interface */
        sc->sc_ethercom.ec_ifmedia = &sc->sc_media;
        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);
        if_deferred_start_init(ifp, NULL);
        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(const 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;
        sc->sc_txbusy = false;

        /* Attempt to start output, if any. */
        if_schedule_deferred_start(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;
                        sc->sc_txbusy = false;
                        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);
                if_statinc(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)
                                if_statadd(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;
                        if_statinc(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) {
                if_statinc(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)
                        ;
                if_statinc(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 = uimin(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) == 0)
                return;

#ifdef ESDEBUG
        if (sc->sc_smcbusy++) {
                printf("%s: esstart re-entered\n", device_xname(sc->sc_dev));
                panic("esstart re-entered");
        }
        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
        while (!sc->sc_txbusy) {
#if defined(ESDEBUG) && defined(USEPKTBUF)
                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.
                 */
                IF_POLL(&sc->sc_ethercom.ec_if.if_snd, m);
                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_txbusy = true;
                        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
                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
#ifdef USEPKTBUF
                        printf("start_ptr %04x end_ptr %04x cur ptr %04x\n",
                            start_ptr, end_ptr, SWAP(smc->b2.ptr));
#endif
                        --sc->sc_smcbusy;
#endif
                        esinit(sc);     /* It's really hosed - reset */
                        return;
                }
                IF_DEQUEUE(&sc->sc_ethercom.ec_if.if_snd, m);
                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, BPF_D_OUT);
                m_freem(m0);
                                /* move to interrupt? */
                if_statinc(&sc->sc_ethercom.ec_if, if_opackets);
                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;
        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;

        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));
        if_statinc(ifp, if_oerrors);

        esreset(sc);
}

int
esmediachange(struct ifnet *ifp)
{
        return 0;
}

void
esmediastatus(struct ifnet *ifp, struct ifmediareq *ifmr)
{
}