bsps: Move legacy network drivers to bsps

This patch is a part of the BSP source reorganization.

Update #3285.

2 files changed, 1 insertions, 865 deletions

diff --git a/c/src/lib/libbsp/arm/csb337/Makefile.am b/c/src/lib/libbsp/arm/csb337/Makefile.am
index 945ea01a89..f8be23696a 100644
--- a/c/src/lib/libbsp/arm/csb337/Makefile.am
+++ b/c/src/lib/libbsp/arm/csb337/Makefile.am
@@ -68,7 +68,7 @@ endif
 librtemsbsp_a_SOURCES += ../../../../../../bsps/arm/shared/cache/cache-cp15.c
 
 if HAS_NETWORKING
-librtemsbsp_a_SOURCES += network/network.c
+librtemsbsp_a_SOURCES += ../../../../../../bsps/arm/csb337/net/network.c
 endif
 
 librtemsbsp_a_SOURCES += ../../../../../../bsps/arm/shared/cp15/arm920-mmu.c
diff --git a/c/src/lib/libbsp/arm/csb337/network/network.c b/c/src/lib/libbsp/arm/csb337/network/network.c
deleted file mode 100644
index af7150122d..0000000000
--- a/c/src/lib/libbsp/arm/csb337/network/network.c
+++ /dev/null
@@ -1,864 +0,0 @@
-/*
- *  AT91RM9200 ethernet driver
- *
- *  Copyright (c) 2003 by Cogent Computer Systems
- *  Written by Mike Kelly <mike@cogcomp.com>
- *         and Jay Monkman <jtm@lopingdog.com>
- *
- *
- *  July 2009: Joel Sherrill merged csb637 PHY differences from
- *             MicroMonitor 1.17.
- */
-
-#define __INSIDE_RTEMS_BSD_TCPIP_STACK__
-
-#include <rtems.h>
-#include <rtems/rtems_bsdnet.h>
-#include <rtems/bspIo.h>
-#include <at91rm9200.h>
-#include <at91rm9200_emac.h>
-#include <at91rm9200_gpio.h>
-#include <at91rm9200_pmc.h>
-
-#include <stdio.h>
-#include <string.h>
-
-#include <errno.h>
-#include <rtems/error.h>
-#include <assert.h>
-
-#include <sys/param.h>
-#include <sys/mbuf.h>
-#include <sys/socket.h>
-#include <sys/sockio.h>
-
-#include <net/if.h>
-
-#include <netinet/in.h>
-#include <netinet/if_ether.h>
-
-#include <bsp/irq.h>
-#include <bspopts.h>
-
-/* enable debugging of the PHY code */
-#define PHY_DBG
-
-/* enable debugging of the EMAC code */
-/* #define EMAC_DBG */
-
-#if csb637
-  /* Bit defines for the PHY Status Register #1 (phy address 0x01) */
-  /* 1 = PHY able to perform 100BASE-T4 */
-  #define PHY_STAT_100BASE_T4     BIT15
-  /* 1 = PHY able to perform full-duplex 100BASE-X */
-  #define PHY_STAT_100BASE_X_FDX  BIT14
-  /* 1 = PHY able to perform half-duplex 100BASE-X */
-  #define PHY_STAT_100BASE_X_HDX  BIT13
-  /* 1 = PHY able to operate at 10 Mbps in full-duplex mode */
-  #define PHY_STAT_10BASE_FDX     BIT12
-  /* 1 = PHY able to operate at 10 Mbps in half-duplex mode */
-  #define PHY_STAT_10BASE_HDX     BIT11
-  /* 1 = PHY will accept management frames with preamble suppressed */
-  #define PHY_STAT_MF_PREAMBLE    BIT6
-  /* 1 = Auto-negotiation complete */
-  #define PHY_STAT_AUTO_NEG_DONE  BIT5
-  /* 1 = Remote fault condition detected */
-  #define PHY_STAT_REM_FLT        BIT4
-  /* 1 = PHY is able to perform Auto-Negotiation */
-  #define PHY_STAT_AUTO_NEG_ABLE  BIT3
-  /* 1 = Link is up */
-  #define PHY_STAT_LINK_UP        BIT2
-  /* 1 = Jabber condition detected */
-  #define PHY_STAT_JABBER         BIT1
-  /* 1 = Extended register capabilities */
-  #define PHY_STAT_EXT_REG        BIT0
-
-  /* Bit defines for the Auxillary Mode 3 register */
-  #define PHY_AUX_MODE2_TRAFFIC_LED   BIT6
-#endif
-
-  /* interrupt stuff */
-  #define EMAC_INT_PRIORITY       0       /* lowest priority */
-
-  /*  RTEMS event used by interrupt handler to start receive daemon. */
-  #define START_RECEIVE_EVENT  RTEMS_EVENT_1
-
-  /* RTEMS event used to start transmit daemon. */
-  #define START_TRANSMIT_EVENT    RTEMS_EVENT_2
-
-static void at91rm9200_emac_isr (void *);
-static void at91rm9200_emac_isr_on(void);
-
-/* use the values defined in linkcmds for our use of SRAM */
-extern void * at91rm9200_emac_rxbuf_hdrs;
-extern void * at91rm9200_emac_txbuf;
-extern void * at91rm9200_emac_rxbufs;
-
-/* Set up EMAC hardware */
-/* Number of Receive and Transmit Buffers and Buffer Descriptors */
-#define NUM_RXBDS 8
-#define NUM_TXBDS 1
-#define RX_BUFFER_SIZE 0x600
-
-/* use internal SRAM for buffers and descriptors
- * also insure that the receive descriptors
- * start on a 64byte boundary
- * Receive Buffer Descriptor Header
- */
-
-typedef struct
-{
-    unsigned long address;
-    unsigned long status;
-} RXBUF_HDR;
-
-RXBUF_HDR       *rxbuf_hdrs;
-unsigned char   *txbuf;
-unsigned char   *rxbuf;
-
-int delay_cnt;
-
-/*
- * Hardware-specific storage
- */
-typedef struct
-{
-    /*
-     * Connection to networking code
-     * This entry *must* be the first in the sonic_softc structure.
-     */
-    struct arpcom                    arpcom;
-
-    /*
-     * Interrupt vector
-     */
-    rtems_vector_number             vector;
-
-    /*
-     *  Indicates configuration
-     */
-    int                             acceptBroadcast;
-
-    /*
-     * Task waiting for interrupts
-     */
-    rtems_id                        rxDaemonTid;
-    rtems_id                        txDaemonTid;
-
-    /*
-     * current receive header
-     */
-    int                rx_buf_idx;
-
-
-
-    /*
-     * Statistics
-     */
-    unsigned long                   Interrupts;
-    unsigned long                   rxInterrupts;
-    unsigned long                   rxMissed;
-    unsigned long                   rxGiant;
-    unsigned long                   rxNonOctet;
-    unsigned long                   rxBadCRC;
-    unsigned long                   rxCollision;
-
-    unsigned long                   txInterrupts;
-    unsigned long                   txSingleCollision;
-    unsigned long                   txMultipleCollision;
-    unsigned long                   txCollision;
-    unsigned long                   txDeferred;
-    unsigned long                   txUnderrun;
-    unsigned long                   txLateCollision;
-    unsigned long                   txExcessiveCollision;
-    unsigned long                   txExcessiveDeferral;
-    unsigned long                   txLostCarrier;
-    unsigned long                   txRawWait;
-} at91rm9200_emac_softc_t;
-
-static at91rm9200_emac_softc_t softc;
-
-
-/* The AT91RM9200 ethernet fifos are very undersized. Therefore
- * we use the internal SRAM to hold 4 receive packets and one
- * transmit packet.  Note that the AT91RM9200 can only queue
- * one transmit packet at a time.
- */
-
-/* function prototypes */
-int rtems_at91rm9200_emac_attach (struct rtems_bsdnet_ifconfig *config,
-                                  void *chip);
-void at91rm9200_emac_init(void *arg);
-void at91rm9200_emac_init_hw(at91rm9200_emac_softc_t *sc);
-void at91rm9200_emac_start(struct ifnet *ifp);
-void at91rm9200_emac_stop (at91rm9200_emac_softc_t *sc);
-void at91rm9200_emac_txDaemon (void *arg);
-void at91rm9200_emac_sendpacket (struct ifnet *ifp, struct mbuf *m);
-void at91rm9200_emac_rxDaemon(void *arg);
-void at91rm9200_emac_stats (at91rm9200_emac_softc_t *sc);
-static int at91rm9200_emac_ioctl (struct ifnet *ifp,
-                                  ioctl_command_t command,
-                                  caddr_t data);
-
-#if csb637
-/*
- * phyread(): Read the PHY
- */
-static uint32_t phyread(uint8_t reg)
-{
-  EMAC_REG(EMAC_MAN) = (0x01 << 30  /* Start of Frame Delimiter */
-            | 0x02 << 28            /* Operation, 0x01 = Write, 0x02 = Read */
-            | 0x00 << 23            /* Phy Number, 0 as we only have one */
-            | reg << 18             /* Phy Register */
-            | 0x02 << 16);          /* must be 0x02 for turn around field */
-
-  /* wait for phy read to complete (was udelay(5000)) */
-  rtems_task_wake_after(1);
-
-  #if defined(EMAC_DBG)
-    printk(
-      "EMAC: Phy 0, Reg %d, Read 0x%04lx.\n",
-       reg,
-       (EMAC_REG(EMAC_MAN) & 0xffff)
-    );
-  #endif
-
-  return EMAC_REG(EMAC_MAN) & 0xffff;
-}
-#endif
-
-/*
- * phywrite(): Write the PHY
- */
-static void phywrite(uint8_t reg, uint16_t data)
-{
-  EMAC_REG(EMAC_MAN) = (0x01 << 30 /* Start of Frame Delimiter */
-             | 0x01 << 28          /* Operation, 0x01 = Write, 0x02 = Read */
-             | 0x00 << 23          /* Phy Number, BCM5221 is address 0 */
-             | reg << 18           /* Phy Register */
-             | 0x02 << 16          /* must be 0x02 for turn around field */
-             | data);
-  #if defined(EMAC_DBG)
-    printk("EMAC: Phy 0, Reg %d, Write 0x%04x.\n", reg, data);
-  #endif
-
-  /* wait for phy write to complete (was udelay(5000)) */
-  rtems_task_wake_after(1);
-}
-
-
-int rtems_at91rm9200_emac_attach (
-    struct rtems_bsdnet_ifconfig *config,
-    void *chip  /* only one ethernet, so no chip number */
-    )
-{
-    struct ifnet *ifp;
-    int mtu;
-    int unitnumber;
-    char *unitname;
-    void *p;
-
-    /* an array of receive buffer descriptors -- avoid type punned warning */
-    p = (void *)&at91rm9200_emac_rxbuf_hdrs;
-    rxbuf_hdrs = (RXBUF_HDR *)p;
-
-    /* one transmit buffer, 1536 bytes maximum */
-    txbuf = (unsigned char *)&at91rm9200_emac_txbuf;
-
-    /* receive buffers starting address */
-    rxbuf = (unsigned char *)&at91rm9200_emac_rxbufs;
-    /*
-     * Parse driver name
-     */
-    if ((unitnumber = rtems_bsdnet_parse_driver_name (config, &unitname)) < 0)
-        return 0;
-
-    /*
-     * Is driver free?
-     */
-    if (unitnumber != 0) {
-        printk ("Bad AT91RM9200 EMAC unit number.\n");
-        return 0;
-    }
-    ifp = &softc.arpcom.ac_if;
-    if (ifp->if_softc != NULL) {
-        printk ("Driver already in use.\n");
-        return 0;
-    }
-
-    /*
-     *  zero out the control structure
-     */
-
-    memset( &softc, 0, sizeof(softc) );
-
-
-    /* get the MAC address from the chip */
-    softc.arpcom.ac_enaddr[0] = (EMAC_REG(EMAC_SA1L) >> 0) & 0xff;
-    softc.arpcom.ac_enaddr[1] = (EMAC_REG(EMAC_SA1L) >> 8) & 0xff;
-    softc.arpcom.ac_enaddr[2] = (EMAC_REG(EMAC_SA1L) >> 16) & 0xff;
-    softc.arpcom.ac_enaddr[3] = (EMAC_REG(EMAC_SA1L) >> 24) & 0xff;
-    softc.arpcom.ac_enaddr[4] = (EMAC_REG(EMAC_SA1H) >> 0) & 0xff;
-    softc.arpcom.ac_enaddr[5] = (EMAC_REG(EMAC_SA1H) >> 8) & 0xff;
-
-    #if 0
-      printk( "MAC=%02x:%02x:%02x:%02x:%02x:%02x\n",
-        softc.arpcom.ac_enaddr[0],
-        softc.arpcom.ac_enaddr[1],
-        softc.arpcom.ac_enaddr[2],
-        softc.arpcom.ac_enaddr[3],
-        softc.arpcom.ac_enaddr[4],
-        softc.arpcom.ac_enaddr[5]
-      );
-    #endif
-
-    if (config->mtu) {
-        mtu = config->mtu;
-    } else {
-        mtu = ETHERMTU;
-    }
-
-    softc.acceptBroadcast = !config->ignore_broadcast;
-
-    /*
-     * Set up network interface values
-     */
-    ifp->if_softc = &softc;
-    ifp->if_unit = unitnumber;
-    ifp->if_name = unitname;
-    ifp->if_mtu = mtu;
-    ifp->if_init = at91rm9200_emac_init;
-    ifp->if_ioctl = at91rm9200_emac_ioctl;
-    ifp->if_start = at91rm9200_emac_start;
-    ifp->if_output = ether_output;
-    ifp->if_flags = IFF_BROADCAST;
-    if (ifp->if_snd.ifq_maxlen == 0) {
-        ifp->if_snd.ifq_maxlen = ifqmaxlen;
-    }
-
-    softc.rx_buf_idx = 0;
-
-    /*
-     * Attach the interface
-     */
-    if_attach (ifp);
-    ether_ifattach (ifp);
-    return 1;
-}
-
-void at91rm9200_emac_init(void *arg)
-{
-    at91rm9200_emac_softc_t     *sc = arg;
-    struct ifnet *ifp = &sc->arpcom.ac_if;
-    rtems_status_code status = RTEMS_SUCCESSFUL;
-
-    /*
-     *This is for stuff that only gets done once (at91rm9200_emac_init()
-     * gets called multiple times
-     */
-    if (sc->txDaemonTid == 0) {
-        /* Set up EMAC hardware */
-        at91rm9200_emac_init_hw(sc);
-
-        /*      Start driver tasks */
-        sc->rxDaemonTid = rtems_bsdnet_newproc("ENrx",
-                                               4096,
-                                               at91rm9200_emac_rxDaemon,
-                                               sc);
-        sc->txDaemonTid = rtems_bsdnet_newproc("ENtx",
-                                               4096,
-                                               at91rm9200_emac_txDaemon,
-                                               sc);
-    } /* if txDaemonTid */
-
-    /* set our priority in the AIC */
-    AIC_SMR_REG(AIC_SMR_EMAC) = AIC_SMR_PRIOR(EMAC_INT_PRIORITY);
-
-    /* install the interrupt handler */
-    status = rtems_interrupt_handler_install(
-        AT91RM9200_INT_EMAC,
-        "Network",
-        RTEMS_INTERRUPT_UNIQUE,
-        at91rm9200_emac_isr,
-        NULL
-    );
-    assert(status == RTEMS_SUCCESSFUL);
-    at91rm9200_emac_isr_on();
-
-    /* EMAC doesn't support promiscuous, so ignore requests */
-    if (ifp->if_flags & IFF_PROMISC) {
-        printk ("Warning - AT91RM9200 Ethernet driver"
-                " doesn't support Promiscuous Mode!\n");
-    }
-
-    /*
-     * Tell the world that we're running.
-     */
-    ifp->if_flags |= IFF_RUNNING;
-
-    /* Enable TX/RX and clear the statistics counters */
-    EMAC_REG(EMAC_CTL) = (EMAC_CTL_TE | EMAC_CTL_RE | EMAC_CTL_CSR);
-
-    /* clear any pending interrupts */
-    EMAC_REG(EMAC_TSR) = 0xffffffff;
-    EMAC_REG(EMAC_RSR) = 0xffffffff;
-
-} /* at91rm9200_emac_init() */
-
-void  at91rm9200_emac_init_hw(at91rm9200_emac_softc_t *sc)
-{
-    int i;
-
-    /* Configure shared pins for Ethernet, not GPIO */
-    PIOA_REG(PIO_PDR) = ( BIT7  |   /* tx clock      */
-                          BIT8  |   /* tx enable     */
-                          BIT9  |   /* tx data 0     */
-                          BIT10 |   /* tx data 1     */
-                          BIT11 |   /* carrier sense */
-                          BIT12 |   /* rx data 0     */
-                          BIT13 |   /* rx data 1     */
-                          BIT14 |   /* rx error      */
-                          BIT15 |   /* MII clock     */
-                          BIT16 );  /* MII data      */
-
-    PIOB_REG(PIO_PDR) = ( BIT12 |   /* tx data 2     */
-                          BIT13 |   /* tx data 3     */
-                          BIT14 |   /* tx error      */
-                          BIT15 |   /* rx data 2     */
-                          BIT16 |   /* rx data 3     */
-                          BIT17 |   /* rx data valid */
-                          BIT18 |   /* rx collistion */
-                          BIT19 );  /* rx clock   */
-
-    PIOB_REG(PIO_BSR) = ( BIT12 |   /* tx data 2     */
-                          BIT13 |   /* tx data 3     */
-                          BIT14 |   /* tx error      */
-                          BIT15 |   /* rx data 2     */
-                          BIT16 |   /* rx data 3     */
-                          BIT17 |   /* rx data valid */
-                          BIT18 |   /* rx collistion */
-                          BIT19 );  /* rx clock   */
-
-
-    /* Enable the clock to the EMAC */
-    PMC_REG(PMC_PCER) |= PMC_PCR_PID_EMAC;
-
-    /* initialize our receive buffer descriptors */
-    for (i = 0; i < NUM_RXBDS-1; i++) {
-        rxbuf_hdrs[i].address = (unsigned long)(&rxbuf[i * RX_BUFFER_SIZE]);
-        rxbuf_hdrs[i].status = 0x00000000;
-    }
-
-    /* last one needs the wrapbit set as well  */
-    rxbuf_hdrs[i].address = ((unsigned long)(&rxbuf[i * RX_BUFFER_SIZE]) |
-                             RXBUF_ADD_WRAP);
-    rxbuf_hdrs[i].status = 0x00000000;
-
-    /* point to our receive buffer queue */
-    EMAC_REG(EMAC_RBQP) = (unsigned long)rxbuf_hdrs;
-
-    /* clear any left over status bits */
-    EMAC_REG(EMAC_RSR)  &= ~(EMAC_RSR_OVR | EMAC_RSR_REC | EMAC_RSR_BNA);
-
-    /* set the MII clock divder to MCK/64 */
-    EMAC_REG(EMAC_CFG) &= EMAC_CFG_CLK_MASK;
-    EMAC_REG(EMAC_CFG) = (EMAC_CFG_CLK_64 | EMAC_CFG_BIG | EMAC_CFG_FD);
-
-    /* enable the MII interface */
-    EMAC_REG(EMAC_CTL) = EMAC_CTL_MPE;
-
-    #if csb637
-    {
-      int      timeout;
-      uint32_t emac_link_status;
-
-      #if defined(PHY_DBG)
-        printk("EMAC: Getting Link Status.\n");
-      #endif
-      /* read the PHY ID registers */
-      emac_link_status = phyread(0x02);
-      emac_link_status = phyread(0x03);
-
-      /* Get the link status - wait for done with a timeout */
-      for (timeout = 10000 ; timeout ; ) {
-	for (i = 0; i < 100; i++)
-          ;
-        emac_link_status = phyread(0x01);
-        if (!(emac_link_status & PHY_STAT_AUTO_NEG_ABLE)) {
-	  #if defined(PHY_DBG)
-            printk("EMAC: PHY is unable to Auto-Negotatiate!\n");
-          #endif
-          timeout = 0;
-          break;
-        }
-        if (emac_link_status & PHY_STAT_AUTO_NEG_DONE) {
-	  #if defined(PHY_DBG)
-	    printk("EMAC: Auto-Negotiate Complete, Link = ");
-          #endif
-          break;
-        }
-        timeout-- ;
-      }
-      if (!timeout) {
-	#if defined(PHY_DBG)
-	  printk(
-           "EMAC: Auto-Negotatiate Failed, Status = 0x%04lx!\n"
-	   "EMAC: Initialization Halted.\n",
-           emac_link_status
-          );
-        #endif
-        /* if autonegotiation fails, just force to 10HD... */
-        emac_link_status = PHY_STAT_10BASE_HDX;
-      }
-
-      /* Set SPD and FD based on the return link status */
-      if (emac_link_status & (PHY_STAT_100BASE_X_FDX | PHY_STAT_100BASE_X_HDX)){
-        EMAC_REG(EMAC_CFG) |= EMAC_CFG_SPD;
-	#if defined(PHY_DBG)
-          printk("100MBIT, ");
-        #endif
-      } else {
-        EMAC_REG(EMAC_CFG) &= ~EMAC_CFG_SPD;
-	#if defined(PHY_DBG)
-          printk("10MBIT, ");
-        #endif
-      }
-
-      if (emac_link_status & (PHY_STAT_100BASE_X_FDX | PHY_STAT_10BASE_FDX)) {
-        EMAC_REG(EMAC_CFG) |= EMAC_CFG_FD;
-	#if defined(PHY_DBG)
-          printk("Full Duplex.\n");
-        #endif
-      } else {
-        EMAC_REG(EMAC_CFG) &= ~EMAC_CFG_FD;
-	#if defined(PHY_DBG)
-          printk("Half Duplex.\n");
-        #endif
-      }
-
-      /* Set PHY LED modes.  Traffic Meter Mode for ACTLED
-       * Set Bit 6 - Traffic Mode on
-       */
-      phywrite(0x1b, PHY_AUX_MODE2_TRAFFIC_LED);
-    }
-    #else
-      /* must be csb337 */
-      /* Set PHY LED2 to combined Link/Activity and enable pulse stretching */
-      phywrite( 18, 0x0d0a );
-    #endif
-
-    #if 0
-    EMAC_REG(EMAC_MAN) = (0x01 << 30 |   /* Start of Frame Delimiter */
-                          0x01 << 28 |   /* Operation, 0x01 = Write */
-                          0x00 << 23 |   /* Phy Number */
-                          0x14 << 18 |   /* Phy Register */
-                          0x02 << 16 |   /* must be 0x02 */
-                          0x0D0A);       /* Write data (0x0000 if read) */
-   #endif
-
-} /* at91rm9200_emac_init_hw() */
-
-void at91rm9200_emac_start(struct ifnet *ifp)
-{
-    at91rm9200_emac_softc_t *sc = ifp->if_softc;
-
-    rtems_bsdnet_event_send(sc->txDaemonTid, START_TRANSMIT_EVENT);
-    ifp->if_flags |= IFF_OACTIVE;
-}
-
-void at91rm9200_emac_stop (at91rm9200_emac_softc_t *sc)
-{
-    struct ifnet *ifp = &sc->arpcom.ac_if;
-
-    ifp->if_flags &= ~IFF_RUNNING;
-
-    /*
-     * Stop the transmitter and receiver.
-     */
-    EMAC_REG(EMAC_CTL) &= ~(EMAC_CTL_TE | EMAC_CTL_RE);
-}
-
-/*
- * Driver transmit daemon
- */
-void at91rm9200_emac_txDaemon (void *arg)
-{
-    at91rm9200_emac_softc_t *sc = (at91rm9200_emac_softc_t *)arg;
-    struct ifnet *ifp = &sc->arpcom.ac_if;
-    struct mbuf *m;
-    rtems_event_set events;
-
-    for (;;)
-    {
-        /* turn on TX interrupt, then wait for one */
-        EMAC_REG(EMAC_IER) = EMAC_INT_TCOM;     /* Transmit complete */
-
-        rtems_bsdnet_event_receive(
-            START_TRANSMIT_EVENT,
-            RTEMS_EVENT_ANY | RTEMS_WAIT,
-            RTEMS_NO_TIMEOUT,
-            &events);
-
-        /* Send packets till queue is empty */
-        for (;;)
-        {
-            /* Get the next mbuf chain to transmit. */
-            IF_DEQUEUE(&ifp->if_snd, m);
-            if (!m)
-                break;
-            at91rm9200_emac_sendpacket (ifp, m);
-        }
-        ifp->if_flags &= ~IFF_OACTIVE;
-    }
-}
-
-/* Send packet */
-void at91rm9200_emac_sendpacket (struct ifnet *ifp, struct mbuf *m)
-{
-    struct mbuf *l = NULL;
-    unsigned int pkt_offset = 0;
-    delay_cnt = 0;
-    /* printk("at91rm9200_emac_sendpacket %p\n", m); */
-
-    /* Wait for EMAC Transmit Queue to become available. */
-    while (((EMAC_REG(EMAC_TSR) & EMAC_TSR_COMP) == 0) &&
-           ((EMAC_REG(EMAC_TSR) & EMAC_TSR_TXIDLE) == 0))
-
-    {
-        delay_cnt++;
-/*        sleep(0);       make sure we don't hog the cpu */
-        continue;
-    }
-
-    /* copy the mbuf chain into the transmit buffer */
-    l = m;
-    while (l != NULL) {
-        memcpy(((char *)txbuf + pkt_offset),  /* offset into pkt for mbuf */
-               (char *)mtod(l, void *),       /* cast to void */
-               l->m_len);                     /* length of this mbuf */
-
-        pkt_offset += l->m_len;               /* update offset */
-        l = l->m_next;                        /* get next mbuf, if any */
-    }
-
-    /* free the mbuf chain we just copied */
-    m_freem(m);
-
-    /* clear any pending status */
-    EMAC_REG(EMAC_TSR) = (EMAC_TSR_OVR | EMAC_TSR_COL | EMAC_TSR_RLE
-                          | EMAC_TSR_COMP | EMAC_TSR_UND);
-
-    /* tell the EMAC about our buffer */
-    EMAC_REG(EMAC_TAR) = (unsigned long)txbuf;
-    EMAC_REG(EMAC_TCR) = (unsigned long)pkt_offset;
-} /* at91rm9200_emac_sendpacket () */
-
-
-/* SONIC reader task */
-void at91rm9200_emac_rxDaemon(void *arg)
-{
-    at91rm9200_emac_softc_t *sc = (at91rm9200_emac_softc_t *)arg;
-    struct ifnet *ifp = &sc->arpcom.ac_if;
-    struct mbuf *m;
-    struct ether_header *eh;
-    rtems_event_set events;
-    int pktlen;
-
-    /* Input packet handling loop */
-    for (;;) {
-        /* turn on RX interrupts, then wait for one */
-        EMAC_REG(EMAC_IER) = (EMAC_INT_RCOM |   /* Receive complete */
-                              EMAC_INT_RBNA |   /* Receive buf not available */
-                              EMAC_INT_ROVR);   /* Receive overrun */
-
-        rtems_bsdnet_event_receive(
-            START_RECEIVE_EVENT,
-            RTEMS_EVENT_ANY | RTEMS_WAIT,
-            RTEMS_NO_TIMEOUT,
-            &events);
-
-        if (EMAC_REG(EMAC_RSR) & EMAC_RSR_BNA) {
-            printk("1: EMAC_BNA\n");
-        }
-
-        if (EMAC_REG(EMAC_RSR) & EMAC_RSR_OVR) {
-            printk("1: EMAC_OVR\n");
-        }
-
-        /* clear the receive status as we do not use it anyway */
-        EMAC_REG(EMAC_RSR) = (EMAC_RSR_REC | EMAC_RSR_OVR | EMAC_RSR_BNA);
-
-        /* scan the buffer descriptors looking for any with data in them */
-        while (rxbuf_hdrs[sc->rx_buf_idx].address & RXBUF_ADD_OWNED) {
-            pktlen = rxbuf_hdrs[sc->rx_buf_idx].status & RXBUF_STAT_LEN_MASK;
-
-            /* get an mbuf this packet */
-            MGETHDR(m, M_WAIT, MT_DATA);
-
-            /* now get a cluster pointed to by the mbuf */
-            /* since an mbuf by itself is too small */
-            MCLGET(m, M_WAIT);
-
-            /* set the type of mbuf to ifp (ethernet I/F) */
-            m->m_pkthdr.rcvif = ifp;
-            m->m_nextpkt = 0;
-
-            /* copy the packet into the cluster pointed to by the mbuf */
-            memcpy((char *)m->m_ext.ext_buf,
-                   (char *)(rxbuf_hdrs[sc->rx_buf_idx].address & 0xfffffffc),
-                   pktlen);
-
-            /* Release the buffer ASAP back to the EMAC */
-            rxbuf_hdrs[sc->rx_buf_idx].address &= ~RXBUF_ADD_OWNED;
-
-            /* set the length of the mbuf */
-            m->m_len = pktlen - (sizeof(struct ether_header) + 4);
-            m->m_pkthdr.len = m->m_len;
-
-            /* strip off the ethernet header from the mbuf */
-            /* but save the pointer to it */
-            eh = mtod (m, struct ether_header *);
-            m->m_data += sizeof(struct ether_header);
-
-            /* increment the buffer index */
-            sc->rx_buf_idx++;
-            if (sc->rx_buf_idx >= NUM_RXBDS) {
-                sc->rx_buf_idx = 0;
-            }
-
-            /* give all this stuff to the stack */
-            ether_input(ifp, eh, m);
-
-        } /* while ADD_OWNED = 0 */
-
-        if (EMAC_REG(EMAC_RSR) & EMAC_RSR_BNA) {
-            printk("2:EMAC_BNA\n");
-        }
-        if (EMAC_REG(EMAC_RSR) & EMAC_RSR_OVR) {
-            printk("2:EMAC_OVR\n");
-        }
-
-
-    } /* for (;;) */
-} /* at91rm9200_emac_rxDaemon() */
-
-
-/* Show interface statistics */
-void at91rm9200_emac_stats (at91rm9200_emac_softc_t *sc)
-{
-    printf (" Total Interrupts:%-8lu",          sc->Interrupts);
-    printf ("    Rx Interrupts:%-8lu",          sc->rxInterrupts);
-    printf ("            Giant:%-8lu",          sc->rxGiant);
-    printf ("        Non-octet:%-8lu\n",                sc->rxNonOctet);
-    printf ("          Bad CRC:%-8lu",          sc->rxBadCRC);
-    printf ("        Collision:%-8lu",          sc->rxCollision);
-    printf ("           Missed:%-8lu\n",                sc->rxMissed);
-
-    printf (    "    Tx Interrupts:%-8lu",      sc->txInterrupts);
-    printf (  "           Deferred:%-8lu",      sc->txDeferred);
-    printf ("        Lost Carrier:%-8lu\n",     sc->txLostCarrier);
-    printf (   "Single Collisions:%-8lu",       sc->txSingleCollision);
-    printf ( "Multiple Collisions:%-8lu",       sc->txMultipleCollision);
-    printf ("Excessive Collisions:%-8lu\n",     sc->txExcessiveCollision);
-    printf (   " Total Collisions:%-8lu",       sc->txCollision);
-    printf ( "     Late Collision:%-8lu",       sc->txLateCollision);
-    printf ("            Underrun:%-8lu\n",     sc->txUnderrun);
-    printf (   "  Raw output wait:%-8lu\n",     sc->txRawWait);
-}
-
-
-/* Enables at91rm9200_emac interrupts. */
-static void at91rm9200_emac_isr_on(void)
-{
-    /* Enable various TX/RX interrupts */
-    EMAC_REG(EMAC_IER) = (EMAC_INT_RCOM | /* Receive complete */
-                          EMAC_INT_RBNA | /* Receive buffer not available */
-                          EMAC_INT_TCOM | /* Transmit complete */
-                          EMAC_INT_ROVR | /* Receive overrun */
-                          EMAC_INT_ABT);  /* Abort on DMA transfer */
-
-    return;
-}
-
-/*  Driver ioctl handler */
-static int
-at91rm9200_emac_ioctl (struct ifnet *ifp, ioctl_command_t command, caddr_t data)
-{
-    at91rm9200_emac_softc_t *sc = ifp->if_softc;
-    int error = 0;
-
-    switch (command) {
-    case SIOCGIFADDR:
-    case SIOCSIFADDR:
-        ether_ioctl (ifp, command, data);
-        break;
-
-    case SIOCSIFFLAGS:
-        switch (ifp->if_flags & (IFF_UP | IFF_RUNNING))
-        {
-        case IFF_RUNNING:
-            at91rm9200_emac_stop (sc);
-            break;
-
-        case IFF_UP:
-            at91rm9200_emac_init (sc);
-            break;
-
-        case IFF_UP | IFF_RUNNING:
-            at91rm9200_emac_stop (sc);
-            at91rm9200_emac_init (sc);
-            break;
-
-        default:
-            break;
-        } /* switch (if_flags) */
-        break;
-
-    case SIO_RTEMS_SHOW_STATS:
-        at91rm9200_emac_stats (sc);
-        break;
-
-        /*
-         * FIXME: All sorts of multicast commands need to be added here!
-         */
-    default:
-        error = EINVAL;
-        break;
-    } /* switch (command) */
-    return error;
-}
-
-/* interrupt handler */
-static void at91rm9200_emac_isr (void * unused)
-{
-    unsigned long status32;
-
-    /* get the ISR status and determine RX or TX */
-    status32 = EMAC_REG(EMAC_ISR);
-
-    if (status32 & EMAC_INT_ABT) {
-        EMAC_REG(EMAC_IDR) = EMAC_INT_ABT; /* disable it */
-        rtems_panic("AT91RM9200 Ethernet MAC has received an Abort.\n");
-    }
-
-    if (status32 & (EMAC_INT_RCOM |    /* Receive complete */
-                    EMAC_INT_RBNA |    /* Receive buffer not available */
-                    EMAC_INT_ROVR)) {  /* Receive overrun */
-
-        /* disable the RX interrupts */
-        EMAC_REG(EMAC_IDR) = (EMAC_INT_RCOM |  /* Receive complete */
-                              EMAC_INT_RBNA |  /* Receive buf not available */
-                              EMAC_INT_ROVR);  /* Receive overrun */
-
-        rtems_bsdnet_event_send (softc.rxDaemonTid, START_RECEIVE_EVENT);
-    }
-
-    if (status32 & EMAC_INT_TCOM) {      /* Transmit buffer register empty */
-
-        /* disable the TX interrupts */
-        EMAC_REG(EMAC_IDR) = EMAC_INT_TCOM;
-
-        rtems_bsdnet_event_send (softc.txDaemonTid, START_TRANSMIT_EVENT);
-    }
-}
-