[PATCH 1/3] Remove duplicate GRETH driver
Jiri Gaisler
jiri at gaisler.se
Sun Oct 25 22:26:24 UTC 2020
* bsps/shared/net/greth2.c is being used instead
---
bsps/shared/grlib-sources.am | 4 -
bsps/shared/grlib/net/README | 7 -
bsps/shared/grlib/net/greth.c | 1655 -----------------
bsps/shared/grlib/net/network_interface_add.c | 62 -
4 files changed, 1728 deletions(-)
delete mode 100644 bsps/shared/grlib/net/README
delete mode 100644 bsps/shared/grlib/net/greth.c
delete mode 100644 bsps/shared/grlib/net/network_interface_add.c
diff --git a/bsps/shared/grlib-sources.am b/bsps/shared/grlib-sources.am
index 512a48c7f7..2261eb957f 100644
--- a/bsps/shared/grlib-sources.am
+++ b/bsps/shared/grlib-sources.am
@@ -34,10 +34,6 @@ librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/iommu/griommu.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/irq/genirq.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/l2c/l2c.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/mem/mctrl.c
-if HAS_NETWORKING
-librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/net/greth.c
-librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/net/network_interface_add.c
-endif
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/pci/gr_701.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/pci/grpci2.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/grlib/pci/grpci2dma.c
diff --git a/bsps/shared/grlib/net/README b/bsps/shared/grlib/net/README
deleted file mode 100644
index 3ef086f223..0000000000
--- a/bsps/shared/grlib/net/README
+++ /dev/null
@@ -1,7 +0,0 @@
-A non Driver Manager GRETH driver is located in libchip/network/greth.c. This
-version requires the driver manager.
-
-network_interface_add is used to assign IP/NETMASK and MAC address to
-GRETH interfaces dynamically according to in which order devices are
-registered. The function takes the settings from the user defined
-interface_configs[] array, defined in the project configuration.
diff --git a/bsps/shared/grlib/net/greth.c b/bsps/shared/grlib/net/greth.c
deleted file mode 100644
index bc4d3cc40f..0000000000
--- a/bsps/shared/grlib/net/greth.c
+++ /dev/null
@@ -1,1655 +0,0 @@
-/*
- * Gaisler Research ethernet MAC driver
- * adapted from Opencores driver by Marko Isomaki
- *
- * The license and distribution terms for this file may be
- * found in found in the file LICENSE in this distribution or at
- * http://www.rtems.org/license/LICENSE.
- *
- *
- * 2008-12-10, Converted to driver manager and added support for
- * multiple GRETH cores. <daniel at gaisler.com>
- * 2007-09-07, Ported GBIT support from 4.6.5
- */
-
-#include <machine/rtems-bsd-kernel-space.h>
-
-#include <rtems.h>
-#define CPU_U32_FIX
-#include <bsp.h>
-
-#ifdef GRETH_SUPPORTED
-
-#include <inttypes.h>
-#include <errno.h>
-#include <rtems/bspIo.h>
-#include <stdlib.h>
-#include <stdio.h>
-#include <stdarg.h>
-#include <rtems/error.h>
-#include <rtems/rtems_bsdnet.h>
-
-#include <grlib/greth.h>
-#include <drvmgr/drvmgr.h>
-#include <grlib/ambapp_bus.h>
-#include <grlib/ambapp.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
-
-#include <grlib/grlib_impl.h>
-
-#if defined(__m68k__)
-extern m68k_isr_entry set_vector( rtems_isr_entry, rtems_vector_number, int );
-#else
-extern rtems_isr_entry set_vector( rtems_isr_entry, rtems_vector_number, int );
-#endif
-
-
-/* #define GRETH_DEBUG */
-
-#ifdef GRETH_DEBUG
-#define DBG(args...) printk(args)
-#else
-#define DBG(args...)
-#endif
-
-/* #define GRETH_DEBUG_MII */
-
-#ifdef GRETH_DEBUG_MII
-#define MIIDBG(args...) printk(args)
-#else
-#define MIIDBG(args...)
-#endif
-
-#ifdef CPU_U32_FIX
-extern void ipalign(struct mbuf *m);
-#endif
-
-/* Used when reading from memory written by GRETH DMA unit */
-#ifndef GRETH_MEM_LOAD
-#define GRETH_MEM_LOAD(addr) (*(volatile unsigned int *)(addr))
-#endif
-
-/*
- * Number of OCs supported by this driver
- */
-#define NOCDRIVER 1
-
-/*
- * Receive buffer size -- Allow for a full ethernet packet including CRC
- */
-#define RBUF_SIZE 1518
-
-#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 GRETH_TX_WAIT_EVENT RTEMS_EVENT_3
-
-#if (MCLBYTES < RBUF_SIZE)
-# error "Driver must have MCLBYTES > RBUF_SIZE"
-#endif
-
-/* 4s Autonegotiation Timeout */
-#ifndef GRETH_AUTONEGO_TIMEOUT_MS
-#define GRETH_AUTONEGO_TIMEOUT_MS 4000
-#endif
-const struct timespec greth_tan = {
- GRETH_AUTONEGO_TIMEOUT_MS/1000,
- (GRETH_AUTONEGO_TIMEOUT_MS % 1000) * 1000000
-};
-
-/* For optimizing the autonegotiation time */
-#define GRETH_AUTONEGO_PRINT_TIME
-
-/* Ethernet buffer descriptor */
-
-typedef struct _greth_rxtxdesc {
- volatile uint32_t ctrl; /* Length and status */
- uint32_t *addr; /* Buffer pointer */
-} greth_rxtxdesc;
-
-
-/*
- * Per-device data
- */
-struct greth_softc
-{
-
- struct arpcom arpcom;
- struct drvmgr_dev *dev; /* Driver manager device */
- char devName[32];
-
- greth_regs *regs;
- int minor;
- int phyaddr; /* PHY Address configured by user (or -1 to autodetect) */
- unsigned int edcl_dis;
- int greth_rst;
-
- int acceptBroadcast;
- rtems_id daemonTid;
-
- unsigned int tx_ptr;
- unsigned int tx_dptr;
- unsigned int tx_cnt;
- unsigned int rx_ptr;
- unsigned int txbufs;
- unsigned int rxbufs;
- greth_rxtxdesc *txdesc;
- greth_rxtxdesc *rxdesc;
- unsigned int txdesc_remote;
- unsigned int rxdesc_remote;
- struct mbuf **rxmbuf;
- struct mbuf **txmbuf;
- rtems_vector_number vector;
-
- /* TX descriptor interrupt generation */
- int tx_int_gen;
- int tx_int_gen_cur;
- struct mbuf *next_tx_mbuf;
- int max_fragsize;
-
- /*Status*/
- struct phy_device_info phydev;
- int phy_read_access;
- int phy_write_access;
- int fd;
- int sp;
- int gb;
- int gbit_mac;
- int auto_neg;
- unsigned int advmodes; /* advertise ethernet speed modes. 0 = all modes. */
- struct timespec auto_neg_time;
- int mc_available;
-
- /*
- * Statistics
- */
- unsigned long rxInterrupts;
-
- unsigned long rxPackets;
- unsigned long rxLengthError;
- unsigned long rxNonOctet;
- unsigned long rxBadCRC;
- unsigned long rxOverrun;
-
- unsigned long txInterrupts;
-
- unsigned long txDeferred;
- unsigned long txHeartbeat;
- unsigned long txLateCollision;
- unsigned long txRetryLimit;
- unsigned long txUnderrun;
-
- /* Spin-lock ISR protection */
- SPIN_DECLARE(devlock);
-};
-
-int greth_process_tx_gbit(struct greth_softc *sc);
-int greth_process_tx(struct greth_softc *sc);
-
-static char *almalloc(int sz, int alignment)
-{
- char *tmp;
- tmp = grlib_calloc(1, sz + (alignment-1));
- tmp = (char *) (((int)tmp+alignment) & ~(alignment -1));
- return(tmp);
-}
-
-/* GRETH interrupt handler */
-
-static void greth_interrupt (void *arg)
-{
- uint32_t status;
- uint32_t ctrl;
- rtems_event_set events = 0;
- struct greth_softc *greth = arg;
- SPIN_ISR_IRQFLAGS(flags);
-
- /* read and clear interrupt cause */
- status = greth->regs->status;
- greth->regs->status = status;
-
- SPIN_LOCK(&greth->devlock, flags);
- ctrl = greth->regs->ctrl;
-
- /* Frame received? */
- if ((ctrl & GRETH_CTRL_RXIRQ) && (status & (GRETH_STATUS_RXERR | GRETH_STATUS_RXIRQ)))
- {
- greth->rxInterrupts++;
- /* Stop RX-Error and RX-Packet interrupts */
- ctrl &= ~GRETH_CTRL_RXIRQ;
- events |= INTERRUPT_EVENT;
- }
-
- if ( (ctrl & GRETH_CTRL_TXIRQ) && (status & (GRETH_STATUS_TXERR | GRETH_STATUS_TXIRQ)) )
- {
- greth->txInterrupts++;
- ctrl &= ~GRETH_CTRL_TXIRQ;
- events |= GRETH_TX_WAIT_EVENT;
- }
-
- /* Clear interrupt sources */
- greth->regs->ctrl = ctrl;
- SPIN_UNLOCK(&greth->devlock, flags);
-
- /* Send the event(s) */
- if ( events )
- rtems_bsdnet_event_send(greth->daemonTid, events);
-}
-
-static uint32_t read_mii(struct greth_softc *sc, uint32_t phy_addr, uint32_t reg_addr)
-{
- sc->phy_read_access++;
- while (sc->regs->mdio_ctrl & GRETH_MDIO_BUSY) {}
- sc->regs->mdio_ctrl = (phy_addr << 11) | (reg_addr << 6) | GRETH_MDIO_READ;
- while (sc->regs->mdio_ctrl & GRETH_MDIO_BUSY) {}
- if (!(sc->regs->mdio_ctrl & GRETH_MDIO_LINKFAIL)) {
- MIIDBG("greth%d: mii read[%d] OK to %" PRIx32 ".%" PRIx32
- " (0x%08" PRIx32 ",0x%08" PRIx32 ")\n",
- sc->minor, sc->phy_read_access, phy_addr, reg_addr,
- sc->regs->ctrl, sc->regs->mdio_ctrl);
- return((sc->regs->mdio_ctrl >> 16) & 0xFFFF);
- } else {
- printf("greth%d: mii read[%d] failed to %" PRIx32 ".%" PRIx32
- " (0x%08" PRIx32 ",0x%08" PRIx32 ")\n",
- sc->minor, sc->phy_read_access, phy_addr, reg_addr,
- sc->regs->ctrl, sc->regs->mdio_ctrl);
- return (0xffff);
- }
-}
-
-static void write_mii(struct greth_softc *sc, uint32_t phy_addr, uint32_t reg_addr, uint32_t data)
-{
- sc->phy_write_access++;
- while (sc->regs->mdio_ctrl & GRETH_MDIO_BUSY) {}
- sc->regs->mdio_ctrl =
- ((data & 0xFFFF) << 16) | (phy_addr << 11) | (reg_addr << 6) | GRETH_MDIO_WRITE;
- while (sc->regs->mdio_ctrl & GRETH_MDIO_BUSY) {}
- if (!(sc->regs->mdio_ctrl & GRETH_MDIO_LINKFAIL)) {
- MIIDBG("greth%d: mii write[%d] OK to to %" PRIx32 ".%" PRIx32
- "(0x%08" PRIx32 ",0x%08" PRIx32 ")\n",
- sc->minor, sc->phy_write_access, phy_addr, reg_addr,
- sc->regs->ctrl, sc->regs->mdio_ctrl);
- } else {
- printf("greth%d: mii write[%d] failed to to %" PRIx32 ".%" PRIx32
- " (0x%08" PRIx32 ",0x%08" PRIx32 ")\n",
- sc->minor, sc->phy_write_access, phy_addr, reg_addr,
- sc->regs->ctrl, sc->regs->mdio_ctrl);
- }
-}
-
-static void print_init_info(struct greth_softc *sc)
-{
- printf("greth: driver attached\n");
- if ( sc->auto_neg == -1 ){
- printf("Auto negotiation timed out. Selecting default config\n");
- }
- printf("**** PHY ****\n");
- printf("Vendor: %x Device: %x Revision: %d\n",sc->phydev.vendor, sc->phydev.device, sc->phydev.rev);
- printf("Current Operating Mode: ");
- if (sc->gb) {
- printf("1000 Mbit ");
- } else if (sc->sp) {
- printf("100 Mbit ");
- } else {
- printf("10 Mbit ");
- }
- if (sc->fd) {
- printf("Full Duplex\n");
- } else {
- printf("Half Duplex\n");
- }
-#ifdef GRETH_AUTONEGO_PRINT_TIME
- if ( sc->auto_neg ) {
- printf("Autonegotiation Time: %" PRIdMAX "ms\n",
- (intmax_t)sc->auto_neg_time.tv_sec * 1000 +
- sc->auto_neg_time.tv_nsec / 1000000);
- }
-#endif
-}
-
-/*
- * Generates the hash words based on CRCs of the enabled MAC addresses that are
- * allowed to be received. The allowed MAC addresses are maintained in a linked
- * "multi-cast" list available in the arpcom structure.
- *
- * Returns the number of MAC addresses that were processed (in the list)
- */
-static int
-greth_mac_filter_calc(struct arpcom *ac, uint32_t *msb, uint32_t *lsb)
-{
- struct ether_multistep step;
- struct ether_multi *enm;
- int cnt = 0;
- uint32_t crc, htindex, ht[2] = {0, 0};
-
- /* Go through the Ethernet Multicast addresses one by one and add their
- * CRC contribution to the MAC filter.
- */
- ETHER_FIRST_MULTI(step, ac, enm);
- while (enm) {
- crc = ether_crc32_be((uint8_t *)enm->enm_addrlo, 6);
- htindex = crc & 0x3f;
- ht[htindex >> 5] |= (1 << (htindex & 0x1F));
- cnt++;
- ETHER_NEXT_MULTI(step, enm);
- }
-
- if (cnt > 0) {
- *msb = ht[1];
- *lsb = ht[0];
- }
-
- return cnt;
-}
-
-/*
- * Initialize the ethernet hardware
- */
-static int greth_mac_filter_set(struct greth_softc *sc)
-{
- struct ifnet *ifp = &sc->arpcom.ac_if;
- uint32_t hash_msb, hash_lsb, ctrl;
- SPIN_IRQFLAGS(flags);
-
- hash_msb = 0;
- hash_lsb = 0;
- ctrl = 0;
- if (ifp->if_flags & IFF_PROMISC) {
- /* No need to enable multi-cast when promiscous mode accepts all */
- ctrl |= GRETH_CTRL_PRO;
- } else if(!sc->mc_available) {
- return EINVAL; /* no hardware support for multicast filtering. */
- } else if (ifp->if_flags & IFF_ALLMULTI) {
- /* We should accept all multicast addresses */
- ctrl |= GRETH_CTRL_MCE;
- hash_msb = 0xFFFFFFFF;
- hash_lsb = 0xFFFFFFFF;
- } else if (greth_mac_filter_calc(&sc->arpcom, &hash_msb, &hash_lsb) > 0) {
- /* Generate hash for MAC filtering out multicast addresses */
- ctrl |= GRETH_CTRL_MCE;
- } else {
- /* Multicast list is empty .. disable multicast */
- }
- SPIN_LOCK_IRQ(&sc->devlock, flags);
- sc->regs->ht_msb = hash_msb;
- sc->regs->ht_lsb = hash_lsb;
- sc->regs->ctrl = (sc->regs->ctrl & ~(GRETH_CTRL_PRO | GRETH_CTRL_MCE)) |
- ctrl;
- SPIN_UNLOCK_IRQ(&sc->devlock, flags);
-
- return 0;
-}
-
-/*
- * Initialize the ethernet hardware
- */
-static void
-greth_initialize_hardware (struct greth_softc *sc)
-{
- struct mbuf *m;
- int i;
- int phyaddr;
- int phyctrl;
- int phystatus;
- int tmp1;
- int tmp2;
- struct timespec tstart, tnow;
- greth_regs *regs;
- unsigned int advmodes, speed;
-
- regs = sc->regs;
-
- /* Reset the controller. */
- sc->rxInterrupts = 0;
- sc->rxPackets = 0;
-
- if (sc->greth_rst) {
- /* Reset ON */
- regs->ctrl = GRETH_CTRL_RST | GRETH_CTRL_DD | GRETH_CTRL_ED;
- for (i = 0; i<100 && (regs->ctrl & GRETH_CTRL_RST); i++)
- ;
- speed = 0; /* probe mode below */
- } else {
- /* inherit EDCL mode for now */
- speed = sc->regs->ctrl & (GRETH_CTRL_GB|GRETH_CTRL_SP|GRETH_CTRL_FULLD);
- }
- /* Reset OFF and RX/TX DMA OFF. SW do PHY Init */
- regs->ctrl = GRETH_CTRL_DD | GRETH_CTRL_ED | speed;
-
- /* Check if mac is gbit capable*/
- sc->gbit_mac = (regs->ctrl >> 27) & 1;
-
- /* Get the phy address which assumed to have been set
- correctly with the reset value in hardware*/
- if ( sc->phyaddr == -1 ) {
- phyaddr = (regs->mdio_ctrl >> 11) & 0x1F;
- } else {
- phyaddr = sc->phyaddr;
- }
- sc->phy_read_access = 0;
- sc->phy_write_access = 0;
-
- /* As I understand the PHY comes back to a good default state after
- * Power-down or Reset, so we do both just in case. Power-down bit should
- * be cleared.
- * Wait for old reset (if asserted by boot loader) to complete, otherwise
- * power-down instruction might not have any effect.
- */
- while (read_mii(sc, phyaddr, 0) & 0x8000) {}
- write_mii(sc, phyaddr, 0, 0x0800); /* Power-down */
- write_mii(sc, phyaddr, 0, 0x0000); /* Power-Up */
- write_mii(sc, phyaddr, 0, 0x8000); /* Reset */
-
- /* We wait about 30ms */
- rtems_task_wake_after(rtems_clock_get_ticks_per_second()/32);
-
- /* Wait for reset to complete and get default values */
- while ((phyctrl = read_mii(sc, phyaddr, 0)) & 0x8000) {}
-
- /* Set up PHY advertising modes for auto-negotiation */
- advmodes = sc->advmodes;
- if (advmodes == 0)
- advmodes = GRETH_ADV_ALL;
- if (!sc->gbit_mac)
- advmodes &= ~(GRETH_ADV_1000_FD | GRETH_ADV_1000_HD);
-
- /* Enable/Disable GBit auto-neg advetisement so that the link partner
- * know that we have/haven't GBit capability. The MAC may not support
- * Gbit even though PHY does...
- */
- phystatus = read_mii(sc, phyaddr, 1);
- if (phystatus & 0x0100) {
- tmp1 = read_mii(sc, phyaddr, 9);
- tmp1 &= ~0x300;
- if (advmodes & GRETH_ADV_1000_FD)
- tmp1 |= 0x200;
- if (advmodes & GRETH_ADV_1000_HD)
- tmp1 |= 0x100;
- write_mii(sc, phyaddr, 9, tmp1);
- }
-
- /* Optionally limit the 10/100 modes as configured by user */
- tmp1 = read_mii(sc, phyaddr, 4);
- tmp1 &= ~0x1e0;
- if (advmodes & GRETH_ADV_100_FD)
- tmp1 |= 0x100;
- if (advmodes & GRETH_ADV_100_HD)
- tmp1 |= 0x080;
- if (advmodes & GRETH_ADV_10_FD)
- tmp1 |= 0x040;
- if (advmodes & GRETH_ADV_10_HD)
- tmp1 |= 0x020;
- write_mii(sc, phyaddr, 4, tmp1);
-
- /* If autonegotiation implemented we start it */
- if (phystatus & 0x0008) {
- write_mii(sc, phyaddr, 0, phyctrl | 0x1200);
- phyctrl = read_mii(sc, phyaddr, 0);
- }
-
- /* Check if PHY is autoneg capable and then determine operating mode,
- otherwise force it to 10 Mbit halfduplex */
- sc->gb = 0;
- sc->fd = 0;
- sc->sp = 0;
- sc->auto_neg = 0;
- timespecclear(&sc->auto_neg_time);
- if ((phyctrl >> 12) & 1) {
- /*wait for auto negotiation to complete*/
- sc->auto_neg = 1;
- if (rtems_clock_get_uptime(&tstart) != RTEMS_SUCCESSFUL)
- printk("rtems_clock_get_uptime failed\n");
- while (!(((phystatus = read_mii(sc, phyaddr, 1)) >> 5) & 1)) {
- if (rtems_clock_get_uptime(&tnow) != RTEMS_SUCCESSFUL)
- printk("rtems_clock_get_uptime failed\n");
- timespecsub(&tnow, &tstart, &sc->auto_neg_time);
- if (timespeccmp(&sc->auto_neg_time, &greth_tan, >)) {
- sc->auto_neg = -1; /* Failed */
- tmp1 = read_mii(sc, phyaddr, 0);
- sc->gb = ((phyctrl >> 6) & 1) && !((phyctrl >> 13) & 1);
- sc->sp = !((phyctrl >> 6) & 1) && ((phyctrl >> 13) & 1);
- sc->fd = (phyctrl >> 8) & 1;
- goto auto_neg_done;
- }
- /* Wait about 30ms, time is PHY dependent */
- rtems_task_wake_after(rtems_clock_get_ticks_per_second()/32);
- }
- sc->phydev.adv = read_mii(sc, phyaddr, 4);
- sc->phydev.part = read_mii(sc, phyaddr, 5);
- if ((phystatus >> 8) & 1) {
- sc->phydev.extadv = read_mii(sc, phyaddr, 9);
- sc->phydev.extpart = read_mii(sc, phyaddr, 10);
- if ( (sc->phydev.extadv & GRETH_MII_EXTADV_1000HD) &&
- (sc->phydev.extpart & GRETH_MII_EXTPRT_1000HD)) {
- sc->gb = 1;
- sc->fd = 0;
- }
- if ( (sc->phydev.extadv & GRETH_MII_EXTADV_1000FD) &&
- (sc->phydev.extpart & GRETH_MII_EXTPRT_1000FD)) {
- sc->gb = 1;
- sc->fd = 1;
- }
- }
- if ((sc->gb == 0) || ((sc->gb == 1) && (sc->gbit_mac == 0))) {
- if ( (sc->phydev.adv & GRETH_MII_100TXFD) &&
- (sc->phydev.part & GRETH_MII_100TXFD)) {
- sc->sp = 1;
- sc->fd = 1;
- } else if ( (sc->phydev.adv & GRETH_MII_100TXHD) &&
- (sc->phydev.part & GRETH_MII_100TXHD)) {
- sc->sp = 1;
- sc->fd = 0;
- } else if ( (sc->phydev.adv & GRETH_MII_10FD) &&
- (sc->phydev.part & GRETH_MII_10FD)) {
- sc->fd = 1;
- }
- }
- }
-auto_neg_done:
- sc->phydev.vendor = 0;
- sc->phydev.device = 0;
- sc->phydev.rev = 0;
- phystatus = read_mii(sc, phyaddr, 1);
-
- /* Read out PHY info if extended registers are available */
- if (phystatus & 1) {
- tmp1 = read_mii(sc, phyaddr, 2);
- tmp2 = read_mii(sc, phyaddr, 3);
-
- sc->phydev.vendor = (tmp1 << 6) | ((tmp2 >> 10) & 0x3F);
- sc->phydev.rev = tmp2 & 0xF;
- sc->phydev.device = (tmp2 >> 4) & 0x3F;
- }
-
- /* Force to 10 mbit half duplex if the 10/100 MAC is used with a 1000 PHY */
- if (((sc->gb) && !(sc->gbit_mac)) || !((phyctrl >> 12) & 1)) {
- write_mii(sc, phyaddr, 0, sc->sp << 13);
-
- /* check if marvell 88EE1111 PHY. Needs special reset handling */
- if ((phystatus & 1) && (sc->phydev.vendor == 0x005043) &&
- (sc->phydev.device == 0x0C))
- write_mii(sc, phyaddr, 0, 0x8000);
-
- sc->gb = 0;
- sc->sp = 0;
- sc->fd = 0;
- }
- while ((read_mii(sc, phyaddr, 0)) & 0x8000) {}
-
- if (sc->greth_rst) {
- /* Reset ON */
- regs->ctrl = GRETH_CTRL_RST | GRETH_CTRL_DD | GRETH_CTRL_ED;
- for (i = 0; i < 100 && (regs->ctrl & GRETH_CTRL_RST); i++)
- ;
- }
- /* Reset OFF. Set mode matching PHY settings. */
- speed = (sc->gb << 8) | (sc->sp << 7) | (sc->fd << 4);
- regs->ctrl = GRETH_CTRL_DD | sc->edcl_dis | speed;
-
- /* Initialize rx/tx descriptor table pointers. Due to alignment we
- * always allocate maximum table size.
- */
- sc->txdesc = (greth_rxtxdesc *) almalloc(0x800, 0x400);
- sc->rxdesc = (greth_rxtxdesc *) &sc->txdesc[128];
- sc->tx_ptr = 0;
- sc->tx_dptr = 0;
- sc->tx_cnt = 0;
- sc->rx_ptr = 0;
-
- /* Translate the Descriptor DMA table base address into an address that
- * the GRETH core can understand
- */
- drvmgr_translate_check(
- sc->dev,
- CPUMEM_TO_DMA,
- (void *)sc->txdesc,
- (void **)&sc->txdesc_remote,
- 0x800);
- sc->rxdesc_remote = sc->txdesc_remote + 0x400;
- regs->txdesc = (int) sc->txdesc_remote;
- regs->rxdesc = (int) sc->rxdesc_remote;
-
- sc->rxmbuf = grlib_calloc(sc->rxbufs, sizeof(*sc->rxmbuf));
- sc->txmbuf = grlib_calloc(sc->txbufs, sizeof(*sc->txmbuf));
-
- for (i = 0; i < sc->txbufs; i++)
- {
- sc->txdesc[i].ctrl = 0;
- if (!(sc->gbit_mac)) {
- drvmgr_translate_check(
- sc->dev,
- CPUMEM_TO_DMA,
- (void *)grlib_malloc(GRETH_MAXBUF_LEN),
- (void **)&sc->txdesc[i].addr,
- GRETH_MAXBUF_LEN);
- }
-#ifdef GRETH_DEBUG
- /* printf("TXBUF: %08x\n", (int) sc->txdesc[i].addr); */
-#endif
- }
- for (i = 0; i < sc->rxbufs; i++)
- {
- MGETHDR (m, M_WAIT, MT_DATA);
- MCLGET (m, M_WAIT);
- if (sc->gbit_mac)
- m->m_data += 2;
- m->m_pkthdr.rcvif = &sc->arpcom.ac_if;
- sc->rxmbuf[i] = m;
- drvmgr_translate_check(
- sc->dev,
- CPUMEM_TO_DMA,
- (void *)mtod(m, uint32_t *),
- (void **)&sc->rxdesc[i].addr,
- GRETH_MAXBUF_LEN);
- sc->rxdesc[i].ctrl = GRETH_RXD_ENABLE | GRETH_RXD_IRQ;
-#ifdef GRETH_DEBUG
-/* printf("RXBUF: %08x\n", (int) sc->rxdesc[i].addr); */
-#endif
- }
- sc->rxdesc[sc->rxbufs - 1].ctrl |= GRETH_RXD_WRAP;
-
- /* set ethernet address. */
- regs->mac_addr_msb =
- sc->arpcom.ac_enaddr[0] << 8 | sc->arpcom.ac_enaddr[1];
- regs->mac_addr_lsb =
- sc->arpcom.ac_enaddr[2] << 24 | sc->arpcom.ac_enaddr[3] << 16 |
- sc->arpcom.ac_enaddr[4] << 8 | sc->arpcom.ac_enaddr[5];
-
- if ( sc->rxbufs < 10 ) {
- sc->tx_int_gen = sc->tx_int_gen_cur = 1;
- }else{
- sc->tx_int_gen = sc->tx_int_gen_cur = sc->txbufs/2;
- }
- sc->next_tx_mbuf = NULL;
-
- if ( !sc->gbit_mac )
- sc->max_fragsize = 1;
-
- /* clear all pending interrupts */
- regs->status = 0xffffffff;
-
- /* install interrupt handler */
- drvmgr_interrupt_register(sc->dev, 0, "greth", greth_interrupt, sc);
-
- regs->ctrl |= GRETH_CTRL_RXEN | GRETH_CTRL_RXIRQ;
-
- print_init_info(sc);
-}
-
-#ifdef CPU_U32_FIX
-
-/*
- * Routine to align the received packet so that the ip header
- * is on a 32-bit boundary. Necessary for cpu's that do not
- * allow unaligned loads and stores and when the 32-bit DMA
- * mode is used.
- *
- * Transfers are done on word basis to avoid possibly slow byte
- * and half-word writes.
- */
-
-void ipalign(struct mbuf *m)
-{
- unsigned int *first, *last, data;
- unsigned int tmp = 0;
-
- if ((((int) m->m_data) & 2) && (m->m_len)) {
- last = (unsigned int *) ((((int) m->m_data) + m->m_len + 8) & ~3);
- first = (unsigned int *) (((int) m->m_data) & ~3);
- /* tmp = *first << 16; */
- asm volatile (" lda [%1] 1, %0\n" : "=r"(tmp) : "r"(first) );
- tmp = tmp << 16;
- first++;
- do {
- /* When snooping is not available the LDA instruction must be used
- * to avoid the cache to return an illegal value.
- ** Load with forced cache miss
- * data = *first;
- */
- asm volatile (" lda [%1] 1, %0\n" : "=r"(data) : "r"(first) );
- *first = tmp | (data >> 16);
- tmp = data << 16;
- first++;
- } while (first <= last);
-
- m->m_data = (caddr_t)(((int) m->m_data) + 2);
- }
-}
-#endif
-
-static void
-greth_Daemon (void *arg)
-{
- struct ether_header *eh;
- struct greth_softc *dp = (struct greth_softc *) arg;
- struct ifnet *ifp = &dp->arpcom.ac_if;
- struct mbuf *m;
- unsigned int len, len_status, bad;
- rtems_event_set events;
- SPIN_IRQFLAGS(flags);
- int first;
- int tmp;
- unsigned int addr;
-
- for (;;)
- {
- rtems_bsdnet_event_receive (INTERRUPT_EVENT | GRETH_TX_WAIT_EVENT,
- RTEMS_WAIT | RTEMS_EVENT_ANY,
- RTEMS_NO_TIMEOUT, &events);
-
- if ( events & GRETH_TX_WAIT_EVENT ){
- /* TX interrupt.
- * We only end up here when all TX descriptors has been used,
- * and
- */
- if ( dp->gbit_mac )
- greth_process_tx_gbit(dp);
- else
- greth_process_tx(dp);
-
- /* If we didn't get a RX interrupt we don't process it */
- if ( (events & INTERRUPT_EVENT) == 0 )
- continue;
- }
-
-
-#ifdef GRETH_ETH_DEBUG
- printf ("r\n");
-#endif
- first=1;
- /* Scan for Received packets */
-again:
- while (!((len_status =
- GRETH_MEM_LOAD(&dp->rxdesc[dp->rx_ptr].ctrl)) & GRETH_RXD_ENABLE))
- {
- bad = 0;
- if (len_status & GRETH_RXD_TOOLONG)
- {
- dp->rxLengthError++;
- bad = 1;
- }
- if (len_status & GRETH_RXD_DRIBBLE)
- {
- dp->rxNonOctet++;
- bad = 1;
- }
- if (len_status & GRETH_RXD_CRCERR)
- {
- dp->rxBadCRC++;
- bad = 1;
- }
- if (len_status & GRETH_RXD_OVERRUN)
- {
- dp->rxOverrun++;
- bad = 1;
- }
- if (len_status & GRETH_RXD_LENERR)
- {
- dp->rxLengthError++;
- bad = 1;
- }
- if (!bad)
- {
- /* pass on the packet in the receive buffer */
- len = len_status & 0x7FF;
- m = dp->rxmbuf[dp->rx_ptr];
-#ifdef GRETH_DEBUG
- int i;
- printf("RX: 0x%08x, Len: %d : ", (int) m->m_data, len);
- for (i=0; i<len; i++)
- printf("%x%x", (m->m_data[i] >> 4) & 0x0ff, m->m_data[i] & 0x0ff);
- printf("\n");
-#endif
- 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
- if(!dp->gbit_mac) {
- /* OVERRIDE CACHED ETHERNET HEADER FOR NON-SNOOPING SYSTEMS */
- addr = (unsigned int)eh;
- asm volatile (" lda [%1] 1, %0\n" : "=r"(tmp) : "r"(addr) );
- addr+=4;
- asm volatile (" lda [%1] 1, %0\n" : "=r"(tmp) : "r"(addr) );
- addr+=4;
- asm volatile (" lda [%1] 1, %0\n" : "=r"(tmp) : "r"(addr) );
- addr+=4;
- asm volatile (" lda [%1] 1, %0\n" : "=r"(tmp) : "r"(addr) );
-
- ipalign(m); /* Align packet on 32-bit boundary */
- }
-#endif
-/*
- if(!(dp->gbit_mac) && !CPU_SPARC_HAS_SNOOPING) {
- rtems_cache_invalidate_entire_data();
- }
-*/
- ether_input (ifp, eh, m);
- MGETHDR (m, M_WAIT, MT_DATA);
- MCLGET (m, M_WAIT);
- if (dp->gbit_mac)
- m->m_data += 2;
- dp->rxmbuf[dp->rx_ptr] = m;
- m->m_pkthdr.rcvif = ifp;
- drvmgr_translate_check(
- dp->dev,
- CPUMEM_TO_DMA,
- (void *)mtod (m, uint32_t *),
- (void **)&dp->rxdesc[dp->rx_ptr].addr,
- GRETH_MAXBUF_LEN);
- dp->rxPackets++;
- }
- if (dp->rx_ptr == dp->rxbufs - 1) {
- dp->rxdesc[dp->rx_ptr].ctrl = GRETH_RXD_ENABLE | GRETH_RXD_IRQ | GRETH_RXD_WRAP;
- } else {
- dp->rxdesc[dp->rx_ptr].ctrl = GRETH_RXD_ENABLE | GRETH_RXD_IRQ;
- }
- SPIN_LOCK_IRQ(&dp->devlock, flags);
- dp->regs->ctrl |= GRETH_CTRL_RXEN;
- SPIN_UNLOCK_IRQ(&dp->devlock, flags);
- dp->rx_ptr = (dp->rx_ptr + 1) % dp->rxbufs;
- }
-
- /* Always scan twice to avoid deadlock */
- if ( first ){
- first=0;
- SPIN_LOCK_IRQ(&dp->devlock, flags);
- dp->regs->ctrl |= GRETH_CTRL_RXIRQ;
- SPIN_UNLOCK_IRQ(&dp->devlock, flags);
- goto again;
- }
-
- }
-}
-
-static int
-sendpacket (struct ifnet *ifp, struct mbuf *m)
-{
- struct greth_softc *dp = ifp->if_softc;
- unsigned char *temp;
- struct mbuf *n;
- unsigned int len;
- SPIN_IRQFLAGS(flags);
-
- /*
- * Is there a free descriptor available?
- */
- if (GRETH_MEM_LOAD(&dp->txdesc[dp->tx_ptr].ctrl) & GRETH_TXD_ENABLE){
- /* No. */
- return 1;
- }
-
- /* Remember head of chain */
- n = m;
-
- len = 0;
- temp = (unsigned char *) GRETH_MEM_LOAD(&dp->txdesc[dp->tx_ptr].addr);
- drvmgr_translate(dp->dev, CPUMEM_FROM_DMA, (void *)temp, (void **)&temp);
-#ifdef GRETH_DEBUG
- printf("TXD: 0x%08x : BUF: 0x%08x\n", (int) m->m_data, (int) temp);
-#endif
- for (;;)
- {
-#ifdef GRETH_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 <= GRETH_MAXBUF_LEN) {
- if (dp->tx_ptr < dp->txbufs-1) {
- dp->txdesc[dp->tx_ptr].ctrl = GRETH_TXD_IRQ |
- GRETH_TXD_ENABLE | len;
- } else {
- dp->txdesc[dp->tx_ptr].ctrl = GRETH_TXD_IRQ |
- GRETH_TXD_WRAP | GRETH_TXD_ENABLE | len;
- }
- dp->tx_ptr = (dp->tx_ptr + 1) % dp->txbufs;
- SPIN_LOCK_IRQ(&dp->devlock, flags);
- dp->regs->ctrl = dp->regs->ctrl | GRETH_CTRL_TXEN;
- SPIN_UNLOCK_IRQ(&dp->devlock, flags);
- }
-
- return 0;
-}
-
-
-static int
-sendpacket_gbit (struct ifnet *ifp, struct mbuf *m)
-{
- struct greth_softc *dp = ifp->if_softc;
- unsigned int len;
-
- unsigned int ctrl;
- int frags;
- struct mbuf *mtmp;
- int int_en;
- SPIN_IRQFLAGS(flags);
-
- len = 0;
-#ifdef GRETH_DEBUG
- printf("TXD: 0x%08x\n", (int) m->m_data);
-#endif
- /* Get number of fragments too see if we have enough
- * resources.
- */
- frags=1;
- mtmp=m;
- while(mtmp->m_next){
- frags++;
- mtmp = mtmp->m_next;
- }
-
- if ( frags > dp->max_fragsize )
- dp->max_fragsize = frags;
-
- if ( frags > dp->txbufs ){
- printf("GRETH: MBUF-chain cannot be sent. Increase descriptor count.\n");
- return -1;
- }
-
- if ( frags > (dp->txbufs-dp->tx_cnt) ){
- /* Return number of fragments */
- return frags;
- }
-
-
- /* Enable interrupt from descriptor every tx_int_gen
- * descriptor. Typically every 16 descriptor. This
- * is only to reduce the number of interrupts during
- * heavy load.
- */
- dp->tx_int_gen_cur-=frags;
- if ( dp->tx_int_gen_cur <= 0 ){
- dp->tx_int_gen_cur = dp->tx_int_gen;
- int_en = GRETH_TXD_IRQ;
- }else{
- int_en = 0;
- }
-
- /* At this stage we know that enough descriptors are available */
- for (;;)
- {
-
-#ifdef GRETH_DEBUG
- int i;
- printf("MBUF: 0x%08x, Len: %d : ", (int) m->m_data, m->m_len);
- 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;
- drvmgr_translate_check(
- dp->dev,
- CPUMEM_TO_DMA,
- (void *)(uint32_t *)m->m_data,
- (void **)&dp->txdesc[dp->tx_ptr].addr,
- m->m_len);
-
- /* Wrap around? */
- if (dp->tx_ptr < dp->txbufs-1) {
- ctrl = GRETH_TXD_ENABLE;
- }else{
- ctrl = GRETH_TXD_ENABLE | GRETH_TXD_WRAP;
- }
-
- /* Enable Descriptor */
- if ((m->m_next) == NULL) {
- dp->txdesc[dp->tx_ptr].ctrl = ctrl | int_en | m->m_len;
- break;
- }else{
- dp->txdesc[dp->tx_ptr].ctrl = GRETH_TXD_MORE | ctrl | int_en | m->m_len;
- }
-
- /* Next */
- dp->txmbuf[dp->tx_ptr] = m;
- dp->tx_ptr = (dp->tx_ptr + 1) % dp->txbufs;
- dp->tx_cnt++;
- m = m->m_next;
- }
- dp->txmbuf[dp->tx_ptr] = m;
- dp->tx_ptr = (dp->tx_ptr + 1) % dp->txbufs;
- dp->tx_cnt++;
-
- /* Tell Hardware about newly enabled descriptor */
- SPIN_LOCK_IRQ(&dp->devlock, flags);
- dp->regs->ctrl = dp->regs->ctrl | GRETH_CTRL_TXEN;
- SPIN_UNLOCK_IRQ(&dp->devlock, flags);
-
- return 0;
-}
-
-int greth_process_tx_gbit(struct greth_softc *sc)
-{
- struct ifnet *ifp = &sc->arpcom.ac_if;
- struct mbuf *m;
- SPIN_IRQFLAGS(flags);
- int first=1;
-
- /*
- * Send packets till queue is empty
- */
- for (;;){
- /* Reap Sent packets */
- while((sc->tx_cnt > 0) && !(GRETH_MEM_LOAD(&sc->txdesc[sc->tx_dptr].ctrl) & GRETH_TXD_ENABLE)) {
- m_free(sc->txmbuf[sc->tx_dptr]);
- sc->tx_dptr = (sc->tx_dptr + 1) % sc->txbufs;
- sc->tx_cnt--;
- }
-
- if ( sc->next_tx_mbuf ){
- /* Get packet we tried but faild to transmit last time */
- m = sc->next_tx_mbuf;
- sc->next_tx_mbuf = NULL; /* Mark packet taken */
- }else{
- /*
- * Get the next mbuf chain to transmit from Stack.
- */
- IF_DEQUEUE (&ifp->if_snd, m);
- if (!m){
- /* Hardware has sent all schedule packets, this
- * makes the stack enter at greth_start next time
- * a packet is to be sent.
- */
- ifp->if_flags &= ~IFF_OACTIVE;
- break;
- }
- }
-
- /* Are there free descriptors available? */
- /* Try to send packet, if it a negative number is returned. */
- if ( (sc->tx_cnt >= sc->txbufs) || sendpacket_gbit(ifp, m) ){
- /* Not enough resources */
-
- /* Since we have taken the mbuf out of the "send chain"
- * we must remember to use that next time we come back.
- * or else we have dropped a packet.
- */
- sc->next_tx_mbuf = m;
-
- /* Not enough resources, enable interrupt for transmissions
- * this way we will be informed when more TX-descriptors are
- * available.
- */
- if ( first ){
- first = 0;
- SPIN_LOCK_IRQ(&sc->devlock, flags);
- ifp->if_flags |= IFF_OACTIVE;
- sc->regs->ctrl |= GRETH_CTRL_TXIRQ;
- SPIN_UNLOCK_IRQ(&sc->devlock, flags);
-
- /* We must check again to be sure that we didn't
- * miss an interrupt (if a packet was sent just before
- * enabling interrupts)
- */
- continue;
- }
-
- return -1;
- }else{
- /* Sent Ok, proceed to process more packets if available */
- }
- }
- return 0;
-}
-
-int greth_process_tx(struct greth_softc *sc)
-{
- struct ifnet *ifp = &sc->arpcom.ac_if;
- struct mbuf *m;
- SPIN_IRQFLAGS(flags);
- int first=1;
-
- /*
- * Send packets till queue is empty
- */
- for (;;){
- if ( sc->next_tx_mbuf ){
- /* Get packet we tried but failed to transmit last time */
- m = sc->next_tx_mbuf;
- sc->next_tx_mbuf = NULL; /* Mark packet taken */
- }else{
- /*
- * Get the next mbuf chain to transmit from Stack.
- */
- IF_DEQUEUE (&ifp->if_snd, m);
- if (!m){
- /* Hardware has sent all schedule packets, this
- * makes the stack enter at greth_start next time
- * a packet is to be sent.
- */
- ifp->if_flags &= ~IFF_OACTIVE;
- break;
- }
- }
-
- /* Try to send packet, failed if it a non-zero number is returned. */
- if ( sendpacket(ifp, m) ){
- /* Not enough resources */
-
- /* Since we have taken the mbuf out of the "send chain"
- * we must remember to use that next time we come back.
- * or else we have dropped a packet.
- */
- sc->next_tx_mbuf = m;
-
- /* Not enough resources, enable interrupt for transmissions
- * this way we will be informed when more TX-descriptors are
- * available.
- */
- if ( first ){
- first = 0;
- SPIN_LOCK_IRQ(&sc->devlock, flags);
- ifp->if_flags |= IFF_OACTIVE;
- sc->regs->ctrl |= GRETH_CTRL_TXIRQ;
- SPIN_UNLOCK_IRQ(&sc->devlock, flags);
-
- /* We must check again to be sure that we didn't
- * miss an interrupt (if a packet was sent just before
- * enabling interrupts)
- */
- continue;
- }
-
- return -1;
- }else{
- /* Sent Ok, proceed to process more packets if available */
- }
- }
- return 0;
-}
-
-static void
-greth_start (struct ifnet *ifp)
-{
- struct greth_softc *sc = ifp->if_softc;
-
- if ( ifp->if_flags & IFF_OACTIVE )
- return;
-
- if ( sc->gbit_mac ){
- /* No use trying to handle this if we are waiting on GRETH
- * to send the previously scheduled packets.
- */
-
- greth_process_tx_gbit(sc);
- }else{
- greth_process_tx(sc);
- }
-
-}
-
-/*
- * Initialize and start the device
- */
-static void
-greth_init (void *arg)
-{
- struct greth_softc *sc = arg;
- struct ifnet *ifp = &sc->arpcom.ac_if;
- char name[4] = {'E', 'T', 'H', '0'};
-
- if (sc->daemonTid == 0)
- {
- /*
- * Start driver tasks
- */
- name[3] += sc->minor;
- sc->daemonTid = rtems_bsdnet_newproc (name, 4096,
- greth_Daemon, sc);
-
- /*
- * Set up GRETH hardware
- */
- greth_initialize_hardware (sc);
- }
-
- /*
- * Setup promiscous/multi-cast MAC address filters if user enabled it
- */
- greth_mac_filter_set(sc);
-
- /*
- * Tell the world that we're running.
- */
- ifp->if_flags |= IFF_RUNNING;
-}
-
-/*
- * Stop the device
- */
-static void
-greth_stop (struct greth_softc *sc)
-{
- struct ifnet *ifp = &sc->arpcom.ac_if;
- SPIN_IRQFLAGS(flags);
- unsigned int speed;
-
- SPIN_LOCK_IRQ(&sc->devlock, flags);
- ifp->if_flags &= ~IFF_RUNNING;
-
- speed = sc->regs->ctrl & (GRETH_CTRL_GB | GRETH_CTRL_SP | GRETH_CTRL_FULLD);
-
- /* RX/TX OFF */
- sc->regs->ctrl = GRETH_CTRL_DD | GRETH_CTRL_ED | speed;
- /* Reset ON */
- if (sc->greth_rst)
- sc->regs->ctrl = GRETH_CTRL_RST | GRETH_CTRL_DD | GRETH_CTRL_ED | speed;
- /* Reset OFF and restore link settings previously detected if any */
- sc->regs->ctrl = GRETH_CTRL_DD | sc->edcl_dis | speed;
- SPIN_UNLOCK_IRQ(&sc->devlock, flags);
-
- sc->next_tx_mbuf = NULL;
-}
-
-
-/*
- * Show interface statistics
- */
-static void
-greth_stats (struct greth_softc *sc)
-{
- printf (" Rx Interrupts:%-8lu", sc->rxInterrupts);
- printf (" Rx Packets:%-8lu", sc->rxPackets);
- printf (" Length:%-8lu", sc->rxLengthError);
- printf (" Non-octet:%-8lu\n", sc->rxNonOctet);
- printf (" Bad CRC:%-8lu", sc->rxBadCRC);
- printf (" Overrun:%-8lu", sc->rxOverrun);
- printf (" Tx Interrupts:%-8lu", sc->txInterrupts);
- printf (" Maximal Frags:%-8d", sc->max_fragsize);
- printf (" GBIT MAC:%-8d", sc->gbit_mac);
-}
-
-/*
- * Driver ioctl handler
- */
-static int
-greth_ioctl (struct ifnet *ifp, ioctl_command_t command, caddr_t data)
-{
- struct greth_softc *sc = ifp->if_softc;
- int error = 0;
- struct ifreq *ifr;
-
- 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:
- greth_stop (sc);
- break;
-
- case IFF_UP:
- greth_init (sc);
- break;
-
- case IFF_UP | IFF_RUNNING:
- greth_stop (sc);
- greth_init (sc);
- break;
- default:
- break;
- }
- break;
-
- case SIO_RTEMS_SHOW_STATS:
- greth_stats (sc);
- break;
-
- /*
- * Multicast commands: Enabling/disabling filtering of MAC addresses
- */
- case SIOCADDMULTI:
- case SIOCDELMULTI:
- ifr = (struct ifreq *)data;
- if (command == SIOCADDMULTI) {
- error = ether_addmulti(ifr, &sc->arpcom);
- } else {
- error = ether_delmulti(ifr, &sc->arpcom);
- }
- if (error == ENETRESET) {
- error = greth_mac_filter_set(sc);
- }
- break;
-
- default:
- error = EINVAL;
- break;
- }
-
- return error;
-}
-
-/*
- * Attach an GRETH driver to the system
- */
-static int
-greth_interface_driver_attach (
- struct rtems_bsdnet_ifconfig *config,
- int attach
- )
-{
- struct greth_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 = config->drv_ctrl;
- ifp = &sc->arpcom.ac_if;
-#ifdef GRETH_DEBUG
- printf("GRETH[%d]: %s, sc %p, dev %p on %s\n", unitNumber, config->ip_address, sc, sc->dev, sc->dev->parent->dev->name);
-#endif
- 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;
-
- /*
- * Set up network interface values
- */
- ifp->if_softc = sc;
- ifp->if_unit = unitNumber;
- ifp->if_name = unitName;
- ifp->if_mtu = mtu;
- ifp->if_init = greth_init;
- ifp->if_ioctl = greth_ioctl;
- ifp->if_start = greth_start;
- ifp->if_output = ether_output;
- ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX;
- if (sc->mc_available)
- ifp->if_flags |= IFF_MULTICAST;
- if (ifp->if_snd.ifq_maxlen == 0)
- ifp->if_snd.ifq_maxlen = ifqmaxlen;
-
- /*
- * Attach the interface
- */
- if_attach (ifp);
- ether_ifattach (ifp);
-
-#ifdef GRETH_DEBUG
- printf ("GRETH : driver has been attached\n");
-#endif
- return 1;
-}
-
-/******************* Driver manager interface ***********************/
-
-/* Driver prototypes */
-int greth_register_io(rtems_device_major_number *m);
-int greth_device_init(struct greth_softc *sc);
-int network_interface_add(struct rtems_bsdnet_ifconfig *interface);
-
-#ifdef GRETH_INFO_AVAIL
-static int greth_info(
- struct drvmgr_dev *dev,
- void (*print_line)(void *p, char *str),
- void *p, int argc, char *argv[]);
-#define GRETH_INFO_FUNC greth_info
-#else
-#define GRETH_INFO_FUNC NULL
-#endif
-
-int greth_init2(struct drvmgr_dev *dev);
-int greth_init3(struct drvmgr_dev *dev);
-
-struct drvmgr_drv_ops greth_ops =
-{
- .init =
- {
- NULL,
- greth_init2,
- greth_init3,
- NULL
- },
- .remove = NULL,
- .info = GRETH_INFO_FUNC,
-};
-
-struct amba_dev_id greth_ids[] =
-{
- {VENDOR_GAISLER, GAISLER_ETHMAC},
- {0, 0} /* Mark end of table */
-};
-
-struct amba_drv_info greth_drv_info =
-{
- {
- DRVMGR_OBJ_DRV, /* Driver */
- NULL, /* Next driver */
- NULL, /* Device list */
- DRIVER_AMBAPP_GAISLER_GRETH_ID, /* Driver ID */
- "GRETH_DRV", /* Driver Name */
- DRVMGR_BUS_TYPE_AMBAPP, /* Bus Type */
- &greth_ops,
- NULL, /* Funcs */
- 0, /* No devices yet */
- 0,
- },
- &greth_ids[0]
-};
-
-void greth_register_drv (void)
-{
- DBG("Registering GRETH driver\n");
- drvmgr_drv_register(&greth_drv_info.general);
-}
-
-int greth_init2(struct drvmgr_dev *dev)
-{
- struct greth_softc *priv;
-
- DBG("GRETH[%d] on bus %s\n", dev->minor_drv, dev->parent->dev->name);
- priv = dev->priv = grlib_calloc(1, sizeof(*priv));
- if ( !priv )
- return DRVMGR_NOMEM;
- priv->dev = dev;
-
- /* This core will not find other cores, so we wait for init3() */
-
- return DRVMGR_OK;
-}
-
-int greth_init3(struct drvmgr_dev *dev)
-{
- struct greth_softc *sc;
- struct rtems_bsdnet_ifconfig *ifp;
- rtems_status_code status;
-
- sc = dev->priv;
- sprintf(sc->devName, "gr_eth%d", (dev->minor_drv+1));
-
- /* Init GRETH device */
- if ( greth_device_init(sc) ) {
- printk("GRETH: Failed to init device\n");
- return DRVMGR_FAIL;
- }
-
- /* Initialize Spin-lock for GRSPW Device. This is to protect
- * CTRL and DMACTRL registers from ISR.
- */
- SPIN_INIT(&sc->devlock, sc->devName);
-
- /* Register GRETH device as an Network interface */
- ifp = grlib_calloc(1, sizeof(*ifp));
-
- ifp->name = sc->devName;
- ifp->drv_ctrl = sc;
- ifp->attach = greth_interface_driver_attach;
-
- status = network_interface_add(ifp);
- if (status != 0) {
- return DRVMGR_FAIL;
- }
-
- return DRVMGR_OK;
-}
-
-int greth_device_init(struct greth_softc *sc)
-{
- struct amba_dev_info *ambadev;
- struct ambapp_core *pnpinfo;
- union drvmgr_key_value *value;
- unsigned int speed;
-
- /* Get device information from AMBA PnP information */
- ambadev = (struct amba_dev_info *)sc->dev->businfo;
- if ( ambadev == NULL ) {
- return -1;
- }
- pnpinfo = &ambadev->info;
- sc->regs = (greth_regs *)pnpinfo->apb_slv->start;
- sc->minor = sc->dev->minor_drv;
- sc->greth_rst = 1;
-
- /* Remember EDCL enabled/disable state before reset */
- sc->edcl_dis = sc->regs->ctrl & GRETH_CTRL_ED;
-
- /* Default is to inherit EDCL Disable bit from HW. User can force En/Dis */
- value = drvmgr_dev_key_get(sc->dev, "edclDis", DRVMGR_KT_INT);
- if ( value ) {
- /* Force EDCL mode. Has an effect later when GRETH+PHY is initialized */
- if (value->i > 0) {
- sc->edcl_dis = GRETH_CTRL_ED;
- } else {
- /* Default to avoid soft-reset the GRETH when EDCL is forced */
- sc->edcl_dis = 0;
- sc->greth_rst = 0;
- }
- }
-
- /* let user control soft-reset of GRETH (for debug) */
- value = drvmgr_dev_key_get(sc->dev, "soft-reset", DRVMGR_KT_INT);
- if ( value) {
- sc->greth_rst = value->i ? 1 : 0;
- }
-
- /* clear control register and reset NIC and keep current speed modes.
- * This should be done as quick as possible during startup, this is to
- * stop DMA transfers after a reboot.
- *
- * When EDCL is forced enabled reset is skipped, disabling RX/TX DMA is
- * is enough during debug.
- */
- speed = sc->regs->ctrl & (GRETH_CTRL_GB | GRETH_CTRL_SP | GRETH_CTRL_FULLD);
- sc->regs->ctrl = GRETH_CTRL_DD | GRETH_CTRL_ED | speed;
- if (sc->greth_rst)
- sc->regs->ctrl = GRETH_CTRL_RST | GRETH_CTRL_DD | GRETH_CTRL_ED | speed;
- sc->regs->ctrl = GRETH_CTRL_DD | sc->edcl_dis | speed;
-
- /* Configure driver by overriding default config with the bus resources
- * configured by the user
- */
- sc->txbufs = 32;
- sc->rxbufs = 32;
- sc->phyaddr = -1;
-
- value = drvmgr_dev_key_get(sc->dev, "txDescs", DRVMGR_KT_INT);
- if ( value && (value->i <= 128) )
- sc->txbufs = value->i;
-
- value = drvmgr_dev_key_get(sc->dev, "rxDescs", DRVMGR_KT_INT);
- if ( value && (value->i <= 128) )
- sc->rxbufs = value->i;
-
- value = drvmgr_dev_key_get(sc->dev, "phyAdr", DRVMGR_KT_INT);
- if ( value && (value->i < 32) )
- sc->phyaddr = value->i;
-
- value = drvmgr_dev_key_get(sc->dev, "advModes", DRVMGR_KT_INT);
- if ( value )
- sc->advmodes = value->i;
-
- /* Check if multicast support is available */
- sc->mc_available = sc->regs->ctrl & GRETH_CTRL_MC;
-
- return 0;
-}
-
-#ifdef GRETH_INFO_AVAIL
-static int greth_info(
- struct drvmgr_dev *dev,
- void (*print_line)(void *p, char *str),
- void *p, int argc, char *argv[])
-{
- struct greth_softc *sc;
- char buf[64];
-
- if (dev->priv == NULL)
- return -DRVMGR_EINVAL;
- sc = dev->priv;
-
- sprintf(buf, "IFACE NAME: %s", sc->devName);
- print_line(p, buf);
- sprintf(buf, "GBIT MAC: %s", sc->gbit_mac ? "YES" : "NO");
- print_line(p, buf);
-
- return DRVMGR_OK;
-}
-#endif
-
-#endif
diff --git a/bsps/shared/grlib/net/network_interface_add.c b/bsps/shared/grlib/net/network_interface_add.c
deleted file mode 100644
index 011137404f..0000000000
--- a/bsps/shared/grlib/net/network_interface_add.c
+++ /dev/null
@@ -1,62 +0,0 @@
-/* Network interface register help function
- *
- * COPYRIGHT (c) 2008.
- * Cobham Gaisler AB.
- *
- * This function adds a network interface to the
- * rtems_bsdnet_config.ifconfig linked list of interfaces.
- * The interface configuration is taken from the user defined
- * array interface_configs. This function is useful for PnP
- * systems when an unknown number of interfaces are available.
- *
- * The license and distribution terms for this file may be
- * found in found in the file LICENSE in this distribution or at
- * http://www.rtems.org/license/LICENSE.
- */
-
-#include <rtems/rtems_bsdnet.h>
-#include <stdio.h>
-
-#include <grlib/network_interface_add.h>
-
-extern struct rtems_bsdnet_config rtems_bsdnet_config;
-
-/* Number of interfaces taken */
-int network_interface_cnt = 0;
-
-int network_interface_add(struct rtems_bsdnet_ifconfig *interface)
-{
- struct ethernet_config *cfg = NULL;
- int i, last_entry = 1;
-
- /* Init interface description */
- interface->next = NULL;
-
- cfg = &interface_configs[network_interface_cnt];
- for(i=0; i<6; i++) {
- if ( cfg->eth_adr[i] != 0 ) {
- last_entry = 0;
- break;
- }
- }
- /* Do we have a valid configuration? */
- if ( last_entry == 0 ) {
- cfg = &interface_configs[network_interface_cnt];
-
- interface->ip_address = cfg->ip_addr;
- interface->ip_netmask = cfg->ip_netmask;
- interface->hardware_address = cfg->eth_adr;
-
- network_interface_cnt++;
- } else {
- interface->ip_address = NULL;
- interface->ip_netmask = NULL;
- interface->hardware_address = NULL;
- }
-
- /* Insert interface first into list */
- interface->next = rtems_bsdnet_config.ifconfig;
- rtems_bsdnet_config.ifconfig = interface;
-
- return 0;
-}
--
2.17.1
More information about the devel
mailing list