diff options
Diffstat (limited to 'bsps/shared/net/open_eth.c')
-rw-r--r-- | bsps/shared/net/open_eth.c | 767 |
1 files changed, 0 insertions, 767 deletions
diff --git a/bsps/shared/net/open_eth.c b/bsps/shared/net/open_eth.c deleted file mode 100644 index 2335b7f2e1..0000000000 --- a/bsps/shared/net/open_eth.c +++ /dev/null @@ -1,767 +0,0 @@ -/* - * RTEMS driver for Opencores Ethernet Controller - * - * Weakly based on dec21140 rtems driver and open_eth linux driver - * Written by Jiri Gaisler, Gaisler Research - * - * The license and distribution terms for this file may be - * found in the file LICENSE in this distribution or at - * http://www.rtems.org/license/LICENSE. - * - */ - -/* - * This driver current only supports architectures with the old style - * exception processing. The following checks try to keep this - * from being compiled on systems which can't support this driver. - * - * NOTE: The i386, ARM, and PowerPC use a different interrupt API than - * that used by this driver. - */ - -#include <machine/rtems-bsd-kernel-space.h> - -#if defined(__i386__) || defined(__arm__) || defined(__PPC__) - #define OPENETH_NOT_SUPPORTED -#endif - -#if !defined(OPENETH_NOT_SUPPORTED) -#include <bsp.h> -#include <rtems.h> - -#include <bsp.h> - -#include <inttypes.h> -#include <stdlib.h> -#include <stdio.h> -#include <stdarg.h> -#include <errno.h> - -#include <rtems/error.h> -#include <rtems/rtems_bsdnet.h> -#include <libchip/open_eth.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> - -#ifdef malloc -#undef malloc -#endif -#ifdef free -#undef free -#endif - -extern rtems_isr_entry set_vector( rtems_isr_entry, rtems_vector_number, int ); - - /* -#define OPEN_ETH_DEBUG - */ - -#ifdef CPU_U32_FIX -extern void ipalign(struct mbuf *m); -#endif - -/* message descriptor entry */ -struct MDTX -{ - char *buf; -}; - -struct MDRX -{ - struct mbuf *m; -}; - -/* - * Number of OCs supported by this driver - */ -#define NOCDRIVER 1 - -/* - * Receive buffer size -- Allow for a full ethernet packet including CRC - */ -#define RBUF_SIZE 1536 - -#define ET_MINLEN 64 /* minimum message length */ - -/* - * RTEMS event used by interrupt handler to signal driver tasks. - * This must not be any of the events used by the network task synchronization. - */ -#define INTERRUPT_EVENT RTEMS_EVENT_1 - -/* - * RTEMS event used to start transmit daemon. - * This must not be the same as INTERRUPT_EVENT. - */ -#define START_TRANSMIT_EVENT RTEMS_EVENT_2 - - /* event to send when tx buffers become available */ -#define OPEN_ETH_TX_WAIT_EVENT RTEMS_EVENT_3 - - /* suspend when all TX descriptors exhausted */ - /* -#define OETH_SUSPEND_NOTXBUF - */ - -#if (MCLBYTES < RBUF_SIZE) -# error "Driver must have MCLBYTES > RBUF_SIZE" -#endif - -/* - * Per-device data - */ -struct open_eth_softc -{ - - struct arpcom arpcom; - - oeth_regs *regs; - - int acceptBroadcast; - rtems_id rxDaemonTid; - rtems_id txDaemonTid; - - unsigned int tx_ptr; - unsigned int rx_ptr; - unsigned int txbufs; - unsigned int rxbufs; - struct MDTX *txdesc; - struct MDRX *rxdesc; - rtems_vector_number vector; - unsigned int en100MHz; - - /* - * Statistics - */ - unsigned long rxInterrupts; - unsigned long rxPackets; - unsigned long rxLengthError; - unsigned long rxNonOctet; - unsigned long rxBadCRC; - unsigned long rxOverrun; - unsigned long rxMiss; - unsigned long rxCollision; - - unsigned long txInterrupts; - unsigned long txDeferred; - unsigned long txHeartbeat; - unsigned long txLateCollision; - unsigned long txRetryLimit; - unsigned long txUnderrun; - unsigned long txLostCarrier; - unsigned long txRawWait; -}; - -static struct open_eth_softc oc; - -/* OPEN_ETH interrupt handler */ - -static rtems_isr -open_eth_interrupt_handler (rtems_vector_number v) -{ - uint32_t status; - - /* read and clear interrupt cause */ - - status = oc.regs->int_src; - oc.regs->int_src = status; - - /* Frame received? */ - - if (status & (OETH_INT_RXF | OETH_INT_RXE)) - { - oc.rxInterrupts++; - rtems_bsdnet_event_send (oc.rxDaemonTid, INTERRUPT_EVENT); - } -#ifdef OETH_SUSPEND_NOTXBUF - if (status & (OETH_INT_MASK_TXB | OETH_INT_MASK_TXC | OETH_INT_MASK_TXE)) - { - oc.txInterrupts++; - rtems_bsdnet_event_send (oc.txDaemonTid, OPEN_ETH_TX_WAIT_EVENT); - } -#endif - /* -#ifdef __leon__ - LEON_Clear_interrupt(v-0x10); -#endif - */ -} - -static uint32_t read_mii(uint32_t addr) -{ - while (oc.regs->miistatus & OETH_MIISTATUS_BUSY) {} - oc.regs->miiaddress = addr << 8; - oc.regs->miicommand = OETH_MIICOMMAND_RSTAT; - while (oc.regs->miistatus & OETH_MIISTATUS_BUSY) {} - if (!(oc.regs->miistatus & OETH_MIISTATUS_NVALID)) - return(oc.regs->miirx_data); - else { - printf("open_eth: failed to read mii\n"); - return (0); - } -} - -static void write_mii(uint32_t addr, uint32_t data) -{ - while (oc.regs->miistatus & OETH_MIISTATUS_BUSY) {} - oc.regs->miiaddress = addr << 8; - oc.regs->miitx_data = data; - oc.regs->miicommand = OETH_MIICOMMAND_WCTRLDATA; - while (oc.regs->miistatus & OETH_MIISTATUS_BUSY) {} -} -/* - * Initialize the ethernet hardware - */ -static void -open_eth_initialize_hardware (struct open_eth_softc *sc) -{ - struct mbuf *m; - int i; - int mii_cr = 0; - - oeth_regs *regs; - - regs = sc->regs; - - /* Reset the controller. */ - - regs->ctrlmoder = 0; - regs->moder = OETH_MODER_RST; /* Reset ON */ - regs->moder = 0; /* Reset OFF */ - - /* reset PHY and wait for complettion */ - mii_cr = 0x3300; - if (!sc->en100MHz) mii_cr = 0; - write_mii(0, mii_cr | 0x8000); - while (read_mii(0) & 0x8000) {} - if (!sc->en100MHz) write_mii(0, 0); - mii_cr = read_mii(0); - printf("open_eth: driver attached, PHY config : 0x%04" PRIx32 "\n", read_mii(0)); - -#ifdef OPEN_ETH_DEBUG - printf("mii_cr: %04x\n", mii_cr); - for (i=0;i<21;i++) - printf("mii_reg %2d : 0x%04x\n", i, read_mii(i)); -#endif - - /* Setting TXBD base to sc->txbufs */ - - regs->tx_bd_num = sc->txbufs; - - /* Initialize rx/tx pointers. */ - - sc->rx_ptr = 0; - sc->tx_ptr = 0; - - /* Set min/max packet length */ - regs->packet_len = 0x00400600; - - /* Set IPGT register to recomended value */ - regs->ipgt = 0x00000015; - - /* Set IPGR1 register to recomended value */ - regs->ipgr1 = 0x0000000c; - - /* Set IPGR2 register to recomended value */ - regs->ipgr2 = 0x00000012; - - /* Set COLLCONF register to recomended value */ - regs->collconf = 0x000f003f; - - /* initialize TX descriptors */ - - sc->txdesc = calloc(sc->txbufs, sizeof(*sc->txdesc)); - for (i = 0; i < sc->txbufs; i++) - { - sc->regs->xd[i].len_status = OETH_TX_BD_PAD | OETH_TX_BD_CRC; - sc->txdesc[i].buf = calloc(1, OETH_MAXBUF_LEN); -#ifdef OPEN_ETH_DEBUG - printf("TXBUF: %08x\n", (int) sc->txdesc[i].buf); -#endif - } - sc->regs->xd[sc->txbufs - 1].len_status |= OETH_TX_BD_WRAP; - - /* allocate RX buffers */ - - sc->rxdesc = calloc(sc->rxbufs, sizeof(*sc->rxdesc)); - for (i = 0; i < sc->rxbufs; i++) - { - - MGETHDR (m, M_WAIT, MT_DATA); - MCLGET (m, M_WAIT); - m->m_pkthdr.rcvif = &sc->arpcom.ac_if; - sc->rxdesc[i].m = m; - sc->regs->xd[i + sc->txbufs].addr = mtod (m, uint32_t*); - sc->regs->xd[i + sc->txbufs].len_status = - OETH_RX_BD_EMPTY | OETH_RX_BD_IRQ; -#ifdef OPEN_ETH_DEBUG - printf("RXBUF: %08x\n", (int) sc->rxdesc[i].m); -#endif - } - sc->regs->xd[sc->rxbufs + sc->txbufs - 1].len_status |= OETH_RX_BD_WRAP; - - - /* set ethernet address. */ - - regs->mac_addr1 = sc->arpcom.ac_enaddr[0] << 8 | sc->arpcom.ac_enaddr[1]; - - uint32_t mac_addr0; - mac_addr0 = sc->arpcom.ac_enaddr[2]; - mac_addr0 <<= 8; - mac_addr0 |= sc->arpcom.ac_enaddr[3]; - mac_addr0 <<= 8; - mac_addr0 |= sc->arpcom.ac_enaddr[4]; - mac_addr0 <<= 8; - mac_addr0 |= sc->arpcom.ac_enaddr[5]; - - regs->mac_addr0 = mac_addr0; - - /* install interrupt vector */ - set_vector (open_eth_interrupt_handler, sc->vector, 1); - - /* clear all pending interrupts */ - - regs->int_src = 0xffffffff; - - /* MAC mode register: PAD, IFG, CRCEN */ - - regs->moder = OETH_MODER_PAD | OETH_MODER_CRCEN | ((mii_cr & 0x100) << 2); - - /* enable interrupts */ - - regs->int_mask = OETH_INT_MASK_RXF | OETH_INT_MASK_RXE | OETH_INT_MASK_RXC; - -#ifdef OETH_SUSPEND_NOTXBUF - regs->int_mask |= OETH_INT_MASK_TXB | OETH_INT_MASK_TXC | OETH_INT_MASK_TXE | OETH_INT_BUSY;*/ - sc->regs->xd[(sc->txbufs - 1)/2].len_status |= OETH_TX_BD_IRQ; - sc->regs->xd[sc->txbufs - 1].len_status |= OETH_TX_BD_IRQ; -#endif - - regs->moder |= OETH_MODER_RXEN | OETH_MODER_TXEN; -} - -static void -open_eth_rxDaemon (void *arg) -{ - struct ether_header *eh; - struct open_eth_softc *dp = (struct open_eth_softc *) &oc; - struct ifnet *ifp = &dp->arpcom.ac_if; - struct mbuf *m; - unsigned int len; - uint32_t len_status; - unsigned int bad; - rtems_event_set events; - - - for (;;) - { - - rtems_bsdnet_event_receive (INTERRUPT_EVENT, - RTEMS_WAIT | RTEMS_EVENT_ANY, - RTEMS_NO_TIMEOUT, &events); -#ifdef OPEN_ETH_DEBUG - printf ("r\n"); -#endif - - while (! - ((len_status = - dp->regs->xd[dp->rx_ptr+dp->txbufs].len_status) & OETH_RX_BD_EMPTY)) - { - bad = 0; - if (len_status & (OETH_RX_BD_TOOLONG | OETH_RX_BD_SHORT)) - { - dp->rxLengthError++; - bad = 1; - } - if (len_status & OETH_RX_BD_DRIBBLE) - { - dp->rxNonOctet++; - bad = 1; - } - if (len_status & OETH_RX_BD_CRCERR) - { - dp->rxBadCRC++; - bad = 1; - } - if (len_status & OETH_RX_BD_OVERRUN) - { - dp->rxOverrun++; - bad = 1; - } - if (len_status & OETH_RX_BD_MISS) - { - dp->rxMiss++; - bad = 1; - } - if (len_status & OETH_RX_BD_LATECOL) - { - dp->rxCollision++; - bad = 1; - } - - if (!bad) - { - /* pass on the packet in the receive buffer */ - len = len_status >> 16; - m = (struct mbuf *) (dp->rxdesc[dp->rx_ptr].m); - m->m_len = m->m_pkthdr.len = - len - sizeof (struct ether_header); - eh = mtod (m, struct ether_header *); - m->m_data += sizeof (struct ether_header); -#ifdef CPU_U32_FIX - ipalign(m); /* Align packet on 32-bit boundary */ -#endif - - ether_input (ifp, eh, m); - - /* get a new mbuf */ - MGETHDR (m, M_WAIT, MT_DATA); - MCLGET (m, M_WAIT); - m->m_pkthdr.rcvif = ifp; - dp->rxdesc[dp->rx_ptr].m = m; - dp->regs->xd[dp->rx_ptr + dp->txbufs].addr = - (uint32_t*) mtod (m, void *); - dp->rxPackets++; - } - - dp->regs->xd[dp->rx_ptr+dp->txbufs].len_status = - (dp->regs->xd[dp->rx_ptr+dp->txbufs].len_status & - ~OETH_TX_BD_STATS) | OETH_TX_BD_READY; - dp->rx_ptr = (dp->rx_ptr + 1) % dp->rxbufs; - } - } -} - -static int inside = 0; -static void -sendpacket (struct ifnet *ifp, struct mbuf *m) -{ - struct open_eth_softc *dp = ifp->if_softc; - unsigned char *temp; - struct mbuf *n; - uint32_t len, len_status; - - if (inside) printf ("error: sendpacket re-entered!!\n"); - inside = 1; - /* - * Waiting for Transmitter ready - */ - n = m; - - while (dp->regs->xd[dp->tx_ptr].len_status & OETH_TX_BD_READY) - { -#ifdef OETH_SUSPEND_NOTXBUF - rtems_event_set events; - rtems_bsdnet_event_receive (OPEN_ETH_TX_WAIT_EVENT, - RTEMS_WAIT | RTEMS_EVENT_ANY, - RTEMS_MILLISECONDS_TO_TICKS(500), &events); -#endif - } - - len = 0; - temp = (unsigned char *) dp->txdesc[dp->tx_ptr].buf; - dp->regs->xd[dp->tx_ptr].addr = (uint32_t*) temp; - -#ifdef OPEN_ETH_DEBUG - printf("TXD: 0x%08x\n", (int) m->m_data); -#endif - for (;;) - { -#ifdef OPEN_ETH_DEBUG - int i; - printf("MBUF: 0x%08x : ", (int) m->m_data); - for (i=0;i<m->m_len;i++) - printf("%x%x", (m->m_data[i] >> 4) & 0x0ff, m->m_data[i] & 0x0ff); - printf("\n"); -#endif - len += m->m_len; - if (len <= RBUF_SIZE) - memcpy ((void *) temp, (char *) m->m_data, m->m_len); - temp += m->m_len; - if ((m = m->m_next) == NULL) - break; - } - - m_freem (n); - - /* don't send long packets */ - - if (len <= RBUF_SIZE) { - - /* Clear all of the status flags. */ - len_status = dp->regs->xd[dp->tx_ptr].len_status & ~OETH_TX_BD_STATS; - - /* If the frame is short, tell CPM to pad it. */ - if (len < ET_MINLEN) { - len_status |= OETH_TX_BD_PAD; - len = ET_MINLEN; - } - else - len_status &= ~OETH_TX_BD_PAD; - - /* write buffer descriptor length and status */ - len_status &= 0x0000ffff; - len_status |= (len << 16) | (OETH_TX_BD_READY | OETH_TX_BD_CRC); - dp->regs->xd[dp->tx_ptr].len_status = len_status; - dp->tx_ptr = (dp->tx_ptr + 1) % dp->txbufs; - - } - inside = 0; -} - -/* - * Driver transmit daemon - */ -static void -open_eth_txDaemon (void *arg) -{ - struct open_eth_softc *sc = (struct open_eth_softc *) arg; - struct ifnet *ifp = &sc->arpcom.ac_if; - struct mbuf *m; - rtems_event_set events; - - for (;;) - { - /* - * Wait for packet - */ - - rtems_bsdnet_event_receive (START_TRANSMIT_EVENT, - RTEMS_EVENT_ANY | RTEMS_WAIT, - RTEMS_NO_TIMEOUT, &events); -#ifdef OPEN_ETH_DEBUG - printf ("t\n"); -#endif - - /* - * Send packets till queue is empty - */ - for (;;) - { - /* - * Get the next mbuf chain to transmit. - */ - IF_DEQUEUE (&ifp->if_snd, m); - if (!m) - break; - sendpacket (ifp, m); - } - ifp->if_flags &= ~IFF_OACTIVE; - } -} - - -static void -open_eth_start (struct ifnet *ifp) -{ - struct open_eth_softc *sc = ifp->if_softc; - - rtems_bsdnet_event_send (sc->txDaemonTid, START_TRANSMIT_EVENT); - ifp->if_flags |= IFF_OACTIVE; -} - -/* - * Initialize and start the device - */ -static void -open_eth_init (void *arg) -{ - struct open_eth_softc *sc = arg; - struct ifnet *ifp = &sc->arpcom.ac_if; - - if (sc->txDaemonTid == 0) - { - - /* - * Set up OPEN_ETH hardware - */ - open_eth_initialize_hardware (sc); - - /* - * Start driver tasks - */ - sc->rxDaemonTid = rtems_bsdnet_newproc ("DCrx", 4096, - open_eth_rxDaemon, sc); - sc->txDaemonTid = rtems_bsdnet_newproc ("DCtx", 4096, - open_eth_txDaemon, sc); - } - - /* - * Tell the world that we're running. - */ - ifp->if_flags |= IFF_RUNNING; - -} - -/* - * Stop the device - */ -static void -open_eth_stop (struct open_eth_softc *sc) -{ - struct ifnet *ifp = &sc->arpcom.ac_if; - - ifp->if_flags &= ~IFF_RUNNING; - - sc->regs->moder = 0; /* RX/TX OFF */ - sc->regs->moder = OETH_MODER_RST; /* Reset ON */ - sc->regs->moder = 0; /* Reset OFF */ -} - - -/* - * Show interface statistics - */ -static void -open_eth_stats (struct open_eth_softc *sc) -{ - printf (" Rx Packets:%-8lu", sc->rxPackets); - printf (" Rx Interrupts:%-8lu", sc->rxInterrupts); - printf (" Length:%-8lu", sc->rxLengthError); - printf (" Non-octet:%-8lu\n", sc->rxNonOctet); - printf (" Bad CRC:%-8lu", sc->rxBadCRC); - printf (" Overrun:%-8lu", sc->rxOverrun); - printf (" Miss:%-8lu", sc->rxMiss); - printf (" Collision:%-8lu\n", sc->rxCollision); - - printf (" Tx Interrupts:%-8lu", sc->txInterrupts); - printf (" Deferred:%-8lu", sc->txDeferred); - printf (" Missed Hearbeat:%-8lu\n", sc->txHeartbeat); - printf (" No Carrier:%-8lu", sc->txLostCarrier); - printf ("Retransmit Limit:%-8lu", sc->txRetryLimit); - printf (" Late Collision:%-8lu\n", sc->txLateCollision); - printf (" Underrun:%-8lu", sc->txUnderrun); - printf (" Raw output wait:%-8lu\n", sc->txRawWait); -} - -/* - * Driver ioctl handler - */ -static int -open_eth_ioctl (struct ifnet *ifp, ioctl_command_t command, caddr_t data) -{ - struct open_eth_softc *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: - open_eth_stop (sc); - break; - - case IFF_UP: - open_eth_init (sc); - break; - - case IFF_UP | IFF_RUNNING: - open_eth_stop (sc); - open_eth_init (sc); - break; - - default: - break; - } - break; - - case SIO_RTEMS_SHOW_STATS: - open_eth_stats (sc); - break; - - /* - * FIXME: All sorts of multicast commands need to be added here! - */ - default: - error = EINVAL; - break; - } - - return error; -} - -/* - * Attach an OPEN_ETH driver to the system - */ -int -rtems_open_eth_driver_attach (struct rtems_bsdnet_ifconfig *config, - open_eth_configuration_t * chip) -{ - struct open_eth_softc *sc; - struct ifnet *ifp; - int mtu; - int unitNumber; - char *unitName; - - /* parse driver name */ - if ((unitNumber = rtems_bsdnet_parse_driver_name (config, &unitName)) < 0) - return 0; - - sc = &oc; - ifp = &sc->arpcom.ac_if; - memset (sc, 0, sizeof (*sc)); - - if (config->hardware_address) - { - memcpy (sc->arpcom.ac_enaddr, config->hardware_address, - ETHER_ADDR_LEN); - } - else - { - memset (sc->arpcom.ac_enaddr, 0x08, ETHER_ADDR_LEN); - } - - if (config->mtu) - mtu = config->mtu; - else - mtu = ETHERMTU; - - sc->acceptBroadcast = !config->ignore_broadcast; - sc->regs = chip->base_address; - sc->vector = chip->vector; - sc->txbufs = chip->txd_count; - sc->rxbufs = chip->rxd_count; - sc->en100MHz = chip->en100MHz; - - - /* - * Set up network interface values - */ - ifp->if_softc = sc; - ifp->if_unit = unitNumber; - ifp->if_name = unitName; - ifp->if_mtu = mtu; - ifp->if_init = open_eth_init; - ifp->if_ioctl = open_eth_ioctl; - ifp->if_start = open_eth_start; - ifp->if_output = ether_output; - ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX; - if (ifp->if_snd.ifq_maxlen == 0) - ifp->if_snd.ifq_maxlen = ifqmaxlen; - - /* - * Attach the interface - */ - if_attach (ifp); - ether_ifattach (ifp); - -#ifdef OPEN_ETH_DEBUG - printf ("OPEN_ETH : driver has been attached\n"); -#endif - return 1; -}; - -#endif /* OPENETH_NOT_SUPPORTED */ |