From mboxrd@z Thu Jan 1 00:00:00 1970 Return-path: Received: from 18.mo3.mail-out.ovh.net ([87.98.172.162] helo=mo3.mail-out.ovh.net) by merlin.infradead.org with esmtp (Exim 4.76 #1 (Red Hat Linux)) id 1T9eE6-0004mM-P4 for barebox@lists.infradead.org; Thu, 06 Sep 2012 15:42:49 +0000 Received: from mail91.ha.ovh.net (b7.ovh.net [213.186.33.57]) by mo3.mail-out.ovh.net (Postfix) with SMTP id 3EB8EFF9ACC for ; Thu, 6 Sep 2012 17:50:19 +0200 (CEST) Date: Thu, 6 Sep 2012 17:43:00 +0200 From: Jean-Christophe PLAGNIOL-VILLARD Message-ID: <20120906154300.GJ20330@game.jcrosoft.org> References: <1346940621-28732-1-git-send-email-jlu@pengutronix.de> MIME-Version: 1.0 Content-Disposition: inline In-Reply-To: <1346940621-28732-1-git-send-email-jlu@pengutronix.de> List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit Sender: barebox-bounces@lists.infradead.org Errors-To: barebox-bounces+u.kleine-koenig=pengutronix.de@lists.infradead.org Subject: Re: [PATCH] drivers/net: add driver for the EMAC device found in some TI SoCs To: Jan Luebbe Cc: barebox@lists.infradead.org On 16:10 Thu 06 Sep , Jan Luebbe wrote: > Signed-off-by: Jan Luebbe > --- > arch/arm/mach-omap/include/mach/emac_defs.h | 48 +++ > drivers/net/Kconfig | 5 + > drivers/net/Makefile | 1 + > drivers/net/davinci_emac.c | 618 +++++++++++++++++++++++++++ > drivers/net/davinci_emac.h | 289 +++++++++++++ > 5 files changed, 961 insertions(+) > create mode 100644 arch/arm/mach-omap/include/mach/emac_defs.h > create mode 100644 drivers/net/davinci_emac.c > create mode 100644 drivers/net/davinci_emac.h finally we can read the driver tks > > diff --git a/arch/arm/mach-omap/include/mach/emac_defs.h b/arch/arm/mach-omap/include/mach/emac_defs.h > new file mode 100644 > index 0000000..568de6a > --- /dev/null > +++ b/arch/arm/mach-omap/include/mach/emac_defs.h > @@ -0,0 +1,48 @@ > +/* > + * Copyright (C) 2007 Sergey Kubushyn > + * > + * Based on: > + * > + * ---------------------------------------------------------------------------- > + * > + * dm644x_emac.h > + * > + * TI DaVinci (DM644X) EMAC peripheral driver header for DV-EVM > + * > + * Copyright (C) 2005 Texas Instruments. > + * > + * ---------------------------------------------------------------------------- > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License as published by > + * the Free Software Foundation; either version 2 of the License, or > + * (at your option) any later version. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + * > + * You should have received a copy of the GNU General Public License > + * along with this program; if not, write to the Free Software > + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. > + * ---------------------------------------------------------------------------- > + > + * Modifications: > + * ver. 1.0: Sep 2005, TI PSP Team - Created EMAC version for uBoot. > + * > + */ > + > +#ifndef _AM3517_EMAC_H_ > +#define _AM3517_EMAC_H_ > + > +#define EMAC_BASE_ADDR 0x5C010000 > +#define EMAC_WRAPPER_BASE_ADDR 0x5C000000 > +#define EMAC_WRAPPER_RAM_ADDR 0x5C020000 > +#define EMAC_MDIO_BASE_ADDR 0x5C030000 > +#define EMAC_HW_RAM_ADDR 0x01E20000 > + > +#define EMAC_MDIO_BUS_FREQ 166000000 /* 166 MHZ check */ > +#define EMAC_MDIO_CLOCK_FREQ 1000000 /* 2.0 MHz */ no with the driver as it's mach specific > + > +#endif /* _AM3517_EMAC_H_ */ > diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig > index dac1eb9..bfde54b 100644 > --- a/drivers/net/Kconfig > +++ b/drivers/net/Kconfig > @@ -43,6 +43,11 @@ config DRIVER_NET_SMC91111 > This option enables support for the SMSC LAN91C111 > ethernet chip. > > +config DRIVER_NET_DAVINCI_EMAC > + bool "TI Davinci/OMAP EMAC ethernet driver" > + depends on ARCH_DAVINCI || ARCH_OMAP3 > + select MIIDEV > + > config DRIVER_NET_DM9K > bool "Davicom dm9k[E|A|B] ethernet driver" > depends on HAS_DM9000 > diff --git a/drivers/net/Makefile b/drivers/net/Makefile > index 951a220..52611f8 100644 > --- a/drivers/net/Makefile > +++ b/drivers/net/Makefile > @@ -1,6 +1,7 @@ > obj-$(CONFIG_DRIVER_NET_CS8900) += cs8900.o > obj-$(CONFIG_DRIVER_NET_SMC911X) += smc911x.o > obj-$(CONFIG_DRIVER_NET_SMC91111) += smc91111.o > +obj-$(CONFIG_DRIVER_NET_DAVINCI_EMAC) += davinci_emac.o > obj-$(CONFIG_DRIVER_NET_DM9K) += dm9k.o > obj-$(CONFIG_DRIVER_NET_NETX) += netx_eth.o > obj-$(CONFIG_DRIVER_NET_AT91_ETHER) += at91_ether.o > diff --git a/drivers/net/davinci_emac.c b/drivers/net/davinci_emac.c > new file mode 100644 > index 0000000..09fcb63 > --- /dev/null > +++ b/drivers/net/davinci_emac.c > @@ -0,0 +1,618 @@ > +/* > + * Copyright (C) 2012 Jan Luebbe > + * > + * Ethernet driver for TI TMS320DM644x (DaVinci) chips. > + * > + * Copyright (C) 2007 Sergey Kubushyn > + * > + * Parts shamelessly stolen from TI's dm644x_emac.c. Original copyright > + * follows: > + * > + * ---------------------------------------------------------------------------- > + * > + * dm644x_emac.c > + * > + * TI DaVinci (DM644X) EMAC peripheral driver source for DV-EVM > + * > + * Copyright (C) 2005 Texas Instruments. > + * > + * ---------------------------------------------------------------------------- > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License as published by > + * the Free Software Foundation; either version 2 of the License, or > + * (at your option) any later version. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + * > + * You should have received a copy of the GNU General Public License > + * along with this program; if not, write to the Free Software > + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. > + * ---------------------------------------------------------------------------- > + > + * Modifications: > + * ver. 1.0: Sep 2005, Anant Gole - Created EMAC version for uBoot. > + * ver 1.1: Nov 2005, Anant Gole - Extended the RX logic for multiple descriptors > + * > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include "davinci_emac.h" > + > +struct davinci_emac_priv { > + struct device_d *dev; > + struct eth_device edev; > + struct mii_device miidev; > + > + /* EMAC Addresses */ > + void __iomem *adap_emac; /* = EMAC_BASE_ADDR */ > + void __iomem *adap_ewrap; /* = EMAC_WRAPPER_BASE_ADDR */ > + void __iomem *adap_mdio; /* = EMAC_MDIO_BASE_ADDR */ > + > + /* EMAC descriptors */ > + void __iomem *emac_desc_base; /* = EMAC_WRAPPER_RAM_ADDR */ > + void __iomem *emac_rx_desc; /* = EMAC_WRAPPER_RAM_ADDR + EMAC_RX_DESC_BASE */ > + void __iomem *emac_tx_desc; /* = EMAC_WRAPPER_RAM_ADDR + EMAC_TX_DESC_BASE */ > + void __iomem *emac_rx_active_head; /* = 0 */ > + void __iomem *emac_rx_active_tail; /* = 0 */ > + int emac_rx_queue_active; /* = 0 */ > + > + /* Receive packet buffers */ > + unsigned char *emac_rx_buffers; /* [EMAC_MAX_RX_BUFFERS * (EMAC_MAX_ETHERNET_PKT_SIZE + EMAC_PKT_ALIGN)] */ > + > + /* PHY address for a discovered PHY (0xff - not found) */ > + uint8_t active_phy_addr; /* = 0xff */ mii_device have the info > + > + /* mac_addr[0] goes out on the wire first */ > + uint8_t mac_addr[6]; no need to trac the mac_addr > +}; > + > +#ifdef EMAC_HW_RAM_ADDR > +static inline uint32_t BD_TO_HW(void __iomem *x) > +{ > + if (x == 0) > + return 0; > + > + return (uint32_t)(x) - EMAC_WRAPPER_RAM_ADDR + EMAC_HW_RAM_ADDR; > +} > + > +static inline void __iomem *HW_TO_BD(uint32_t x) > +{ > + if (x == 0) > + return 0; > + > + return (struct emac_desc*)(x - EMAC_HW_RAM_ADDR + EMAC_WRAPPER_RAM_ADDR); > +} > +#else > +#define BD_TO_HW(x) (x) > +#define HW_TO_BD(x) (x) > +#endif > + > +static void davinci_eth_mdio_enable(struct davinci_emac_priv *priv) > +{ > + uint32_t clkdiv; > + > + clkdiv = (EMAC_MDIO_BUS_FREQ / EMAC_MDIO_CLOCK_FREQ) - 1; > + > + dev_dbg(priv->dev, "mdio_enable + 0x%08x\n", > + readl(priv->adap_mdio + EMAC_MDIO_CONTROL)); > + writel((clkdiv & 0xff) | > + MDIO_CONTROL_ENABLE | > + MDIO_CONTROL_FAULT | > + MDIO_CONTROL_FAULT_ENABLE, > + priv->adap_mdio + EMAC_MDIO_CONTROL); > + dev_dbg(priv->dev, "mdio_enable - 0x%08x\n", > + readl(priv->adap_mdio + EMAC_MDIO_CONTROL)); > + > + while (readl(priv->adap_mdio + EMAC_MDIO_CONTROL) & MDIO_CONTROL_IDLE); > +} > + > +/* Read a PHY register via MDIO inteface. Returns 1 on success, 0 otherwise */ > +static int davinci_eth_phy_read(struct davinci_emac_priv *priv, uint8_t phy_addr, uint8_t reg_num, uint16_t *data) > +{ > + int tmp; > + > + while (readl(priv->adap_mdio + EMAC_MDIO_USERACCESS0) & MDIO_USERACCESS0_GO); > + > + writel(MDIO_USERACCESS0_GO | > + MDIO_USERACCESS0_WRITE_READ | > + ((reg_num & 0x1f) << 21) | > + ((phy_addr & 0x1f) << 16), > + priv->adap_mdio + EMAC_MDIO_USERACCESS0); > + > + /* Wait for command to complete */ > + while ((tmp = readl(priv->adap_mdio + EMAC_MDIO_USERACCESS0)) & MDIO_USERACCESS0_GO); > + > + if (tmp & MDIO_USERACCESS0_ACK) { > + *data = tmp & 0xffff; > + dev_dbg(priv->dev, "emac_phy_read: addr=0x%02x reg=0x%02x data=0x%04x\n", > + phy_addr, reg_num, *data); > + return 1; > + } > + > + *data = -1; > + return 0; > +} > + > +/* Write to a PHY register via MDIO inteface. Blocks until operation is complete. */ > +static int davinci_eth_phy_write(struct davinci_emac_priv *priv, uint8_t phy_addr, uint8_t reg_num, uint16_t data) > +{ > + > + while (readl(priv->adap_mdio + EMAC_MDIO_USERACCESS0) & MDIO_USERACCESS0_GO); > + > + dev_dbg(priv->dev, "emac_phy_write: addr=0x%02x reg=0x%02x data=0x%04x\n", > + phy_addr, reg_num, data); > + writel(MDIO_USERACCESS0_GO | > + MDIO_USERACCESS0_WRITE_WRITE | > + ((reg_num & 0x1f) << 21) | > + ((phy_addr & 0x1f) << 16) | > + (data & 0xffff), > + priv->adap_mdio + EMAC_MDIO_USERACCESS0); > + > + /* Wait for command to complete */ > + while (readl(priv->adap_mdio + EMAC_MDIO_USERACCESS0) & MDIO_USERACCESS0_GO); > + > + return 1; > +} > + > +static int davinci_miidev_read(struct mii_device *dev, int addr, int reg) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)dev->edev->priv; > + uint16_t value = 0; missing blank line > + return davinci_eth_phy_read(priv, addr, reg, &value) ? value : -1; you can drop the double function > +} > + > +static int davinci_miidev_write(struct mii_device *dev, int addr, int reg, int value) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)dev->edev->priv; > + return davinci_eth_phy_write(priv, addr, reg, value) ? 0 : -1; you can drop the double function > +} > + > +static int davinci_emac_get_ethaddr(struct eth_device *edev, unsigned char *adr) > +{ > + return -1; > +} > + > +/* > + * This function must be called before emac_open() if you want to override > + * the default mac address. > + */ > +static int davinci_emac_set_ethaddr(struct eth_device *edev, unsigned char *addr) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)edev->priv; > + int i; > + > + for (i = 0; i < sizeof(priv->mac_addr); i++) > + priv->mac_addr[i] = addr[i]; > + return 0; > +} > + > +static int davinci_emac_init(struct eth_device *edev) > +{ > + dev_dbg(&edev->dev, "* emac_init\n"); > + return 0; > +} > + > +static int davinci_emac_open(struct eth_device *edev) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)edev->priv; > + uint32_t clkdiv, cnt; > + void __iomem *rx_desc; > + unsigned long mac_hi, mac_lo; > + int ret; > + > + dev_dbg(priv->dev, "+ emac_open\n"); > + > + dev_dbg(priv->dev, "emac->TXIDVER: 0x%08x\n", > + readl(priv->adap_emac + EMAC_TXIDVER)); > + dev_dbg(priv->dev, "emac->RXIDVER: 0x%08x\n", > + readl(priv->adap_emac + EMAC_RXIDVER)); > + > + /* Reset EMAC module and disable interrupts in wrapper */ > + writel(1, priv->adap_emac + EMAC_SOFTRESET); > + while (readl(priv->adap_emac + EMAC_SOFTRESET) != 0); > + writel(1, priv->adap_ewrap + EMAC_EWRAP_SOFTRESET); > + while (readl(priv->adap_ewrap + EMAC_EWRAP_SOFTRESET) != 0); > + > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0MISCEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1MISCEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2MISCEN); > + > + rx_desc = priv->emac_rx_desc; > + > + /* > + * Set MAC Addresses & Init multicast Hash to 0 (disable any multicast > + * receive) > + * Use channel 0 only - other channels are disabled > + */ > + writel(0, priv->adap_emac + EMAC_MACINDEX); > + mac_hi = (priv->mac_addr[3] << 24) | > + (priv->mac_addr[2] << 16) | > + (priv->mac_addr[1] << 8) | > + (priv->mac_addr[0]); > + mac_lo = (priv->mac_addr[5] << 8) | > + (priv->mac_addr[4]); > + > + writel(mac_hi, priv->adap_emac + EMAC_MACADDRHI); done via set_macaddr > + writel(mac_lo | EMAC_MAC_ADDR_IS_VALID | EMAC_MAC_ADDR_MATCH, > + priv->adap_emac + EMAC_MACADDRLO); > + > + /* Set source MAC address - REQUIRED */ > + writel(mac_hi, priv->adap_emac + EMAC_MACSRCADDRHI); > + writel(mac_lo, priv->adap_emac + EMAC_MACSRCADDRLO); > + > + /* Set DMA head and completion pointers to 0 */ > + for(cnt = 0; cnt < 8; cnt++) { > + writel(0, (void *)priv->adap_emac + EMAC_TX0HDP + 4 * cnt); > + writel(0, (void *)priv->adap_emac + EMAC_RX0HDP + 4 * cnt); > + writel(0, (void *)priv->adap_emac + EMAC_TX0CP + 4 * cnt); > + writel(0, (void *)priv->adap_emac + EMAC_RX0CP + 4 * cnt); > + } > + > + /* Clear Statistics (do this before setting MacControl register) */ > + for(cnt = 0; cnt < EMAC_NUM_STATS; cnt++) > + writel(0, (void *)priv->adap_emac + EMAC_RXGOODFRAMES + 4 * cnt); > + > + /* No multicast addressing */ > + writel(0, priv->adap_emac + EMAC_MACHASH1); > + writel(0, priv->adap_emac + EMAC_MACHASH2); > + > + writel(0x01, priv->adap_emac + EMAC_TXCONTROL); > + writel(0x01, priv->adap_emac + EMAC_RXCONTROL); > + > + /* Create RX queue and set receive process in place */ > + priv->emac_rx_active_head = priv->emac_rx_desc; > + for (cnt = 0; cnt < EMAC_MAX_RX_BUFFERS; cnt++) { > + writel(BD_TO_HW(rx_desc + EMAC_DESC_SIZE), rx_desc + EMAC_DESC_NEXT); > + writel(&priv->emac_rx_buffers[cnt * (EMAC_MAX_ETHERNET_PKT_SIZE + EMAC_PKT_ALIGN)], rx_desc + EMAC_DESC_BUFFER); > + writel(EMAC_MAX_ETHERNET_PKT_SIZE, rx_desc + EMAC_DESC_BUFF_OFF_LEN); > + writel(EMAC_CPPI_OWNERSHIP_BIT, rx_desc + EMAC_DESC_PKT_FLAG_LEN); > + rx_desc += EMAC_DESC_SIZE; > + } > + > + /* Set the last descriptor's "next" parameter to 0 to end the RX desc list */ > + rx_desc -= EMAC_DESC_SIZE; > + writel(0, rx_desc + EMAC_DESC_NEXT); > + priv->emac_rx_active_tail = rx_desc; > + priv->emac_rx_queue_active = 1; > + > + /* Enable TX/RX */ > + writel(EMAC_MAX_ETHERNET_PKT_SIZE, priv->adap_emac + EMAC_RXMAXLEN); > + writel(0, priv->adap_emac + EMAC_RXBUFFEROFFSET); > + > + /* No fancy configs - Use this for promiscous for debug - EMAC_RXMBPENABLE_RXCAFEN_ENABLE */ > + writel(EMAC_RXMBPENABLE_RXBROADEN, priv->adap_emac + EMAC_RXMBPENABLE); > + > + /* Enable ch 0 only */ > + writel(0x01, priv->adap_emac + EMAC_RXUNICASTSET); > + > + /* Enable MII interface and full duplex mode (using RMMI) */ > + writel((EMAC_MACCONTROL_MIIEN_ENABLE | > + EMAC_MACCONTROL_FULLDUPLEX_ENABLE | > + EMAC_MACCONTROL_RMIISPEED_100), > + priv->adap_emac + EMAC_MACCONTROL); > + > + /* Init MDIO & get link state */ > + clkdiv = (EMAC_MDIO_BUS_FREQ / EMAC_MDIO_CLOCK_FREQ) - 1; > + writel((clkdiv & 0xff) | MDIO_CONTROL_ENABLE | MDIO_CONTROL_FAULT, > + priv->adap_mdio + EMAC_MDIO_CONTROL); mii init at probe time otherwise mii_register will fail I agree the current phylib design is wirong as we are suppoed to do phy init a the open do the eth device > + > + /* Start receive process */ > + writel(BD_TO_HW(priv->emac_rx_desc), priv->adap_emac + EMAC_RX0HDP); > + > + ret = miidev_wait_aneg(&priv->miidev); > + if (ret) > + return ret; > + > + ret = miidev_get_status(&priv->miidev); > + if (ret < 0) > + return ret; > + > + miidev_print_status(&priv->miidev); > + > + dev_dbg(priv->dev, "- emac_open\n"); > + > + return 0; > +} > + > +/* EMAC Channel Teardown */ > +static void davinci_eth_ch_teardown(struct davinci_emac_priv *priv, int ch) > +{ > + uint32_t dly = 0xff; > + uint32_t cnt; > + > + dev_dbg(priv->dev, "+ emac_ch_teardown\n"); > + > + if (ch == EMAC_CH_TX) { > + /* Init TX channel teardown */ > + writel(0, priv->adap_emac + EMAC_TXTEARDOWN); > + for(cnt = 0; cnt != 0xfffffffc; cnt = readl(priv->adap_emac + EMAC_TX0CP)) { > + /* Wait here for Tx teardown completion interrupt to occur > + * Note: A task delay can be called here to pend rather than > + * occupying CPU cycles - anyway it has been found that teardown > + * takes very few cpu cycles and does not affect functionality */ > + dly--; > + udelay(1); > + if (dly == 0) > + break; > + } > + writel(cnt, priv->adap_emac + EMAC_TX0CP); > + writel(0, priv->adap_emac + EMAC_TX0HDP); > + } else { > + /* Init RX channel teardown */ > + writel(0, priv->adap_emac + EMAC_RXTEARDOWN); > + for(cnt = 0; cnt != 0xfffffffc; cnt = readl(priv->adap_emac + EMAC_RX0CP)) { > + /* Wait here for Rx teardown completion interrupt to occur > + * Note: A task delay can be called here to pend rather than > + * occupying CPU cycles - anyway it has been found that teardown > + * takes very few cpu cycles and does not affect functionality */ > + dly--; > + udelay(1); > + if (dly == 0) > + break; > + } > + writel(cnt, priv->adap_emac + EMAC_RX0CP); > + writel(0, priv->adap_emac + EMAC_RX0HDP); > + } > + > + dev_dbg(priv->dev, "- emac_ch_teardown\n"); > +} > + > +static void davinci_emac_halt(struct eth_device *edev) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)edev->priv; > + > + dev_dbg(priv->dev, "+ emac_halt\n"); > + > + davinci_eth_ch_teardown(priv, EMAC_CH_TX); /* TX Channel teardown */ > + davinci_eth_ch_teardown(priv, EMAC_CH_RX); /* RX Channel teardown */ > + > + /* Reset EMAC module and disable interrupts in wrapper */ > + writel(1, priv->adap_emac + EMAC_SOFTRESET); > + writel(1, priv->adap_ewrap + EMAC_EWRAP_SOFTRESET); > + > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2RXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2TXEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C0MISCEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C1MISCEN); > + writel(0, priv->adap_ewrap + EMAC_EWRAP_C2MISCEN); > + > + dev_dbg(priv->dev, "- emac_halt\n"); > +} > + > +/* > + * This function sends a single packet on the network and returns > + * positive number (number of bytes transmitted) or negative for error > + */ > +static int davinci_emac_send(struct eth_device *edev, void *packet, int length) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)edev->priv; > + uint64_t start; > + int ret_status = -1; > + > + dev_dbg(priv->dev, "+ emac_send (length %d)\n", length); > + > + /* Check packet size and if < EMAC_MIN_ETHERNET_PKT_SIZE, pad it up */ > + if (length < EMAC_MIN_ETHERNET_PKT_SIZE) { > + length = EMAC_MIN_ETHERNET_PKT_SIZE; > + } no need {} > + > + /* Populate the TX descriptor */ > + writel(0, priv->emac_tx_desc + EMAC_DESC_NEXT); > + writel((uint8_t *) packet, priv->emac_tx_desc + EMAC_DESC_BUFFER); > + writel((length & 0xffff), priv->emac_tx_desc + EMAC_DESC_BUFF_OFF_LEN); > + writel(((length & 0xffff) | EMAC_CPPI_SOP_BIT | > + EMAC_CPPI_OWNERSHIP_BIT | > + EMAC_CPPI_EOP_BIT), > + priv->emac_tx_desc + EMAC_DESC_PKT_FLAG_LEN); > + dma_flush_range((ulong) packet, (ulong)packet + length); > + /* Send the packet */ > + writel(BD_TO_HW(priv->emac_tx_desc), priv->adap_emac + EMAC_TX0HDP); > + > + /* Wait for packet to complete or link down */ > + start = get_time_ns(); > + while (1) { > + if (readl(priv->adap_emac + EMAC_TXINTSTATRAW) & 0x01) { > + /* Acknowledge the TX descriptor */ > + writel(BD_TO_HW(priv->emac_tx_desc), priv->adap_emac + EMAC_TX0CP); > + ret_status = length; > + break; > + } > + if (is_timeout(start, 100 * MSECOND)) { > + ret_status = -ETIMEDOUT; > + break; > + } > + } > + > + dev_dbg(priv->dev, "- emac_send (ret_status %i)\n", ret_status); > + return ret_status; > +} > + > +/* > + * This function handles receipt of a packet from the network > + */ > +static int davinci_emac_recv(struct eth_device *edev) > +{ > + struct davinci_emac_priv *priv = (struct davinci_emac_priv *)edev->priv; > + void __iomem *rx_curr_desc, *curr_desc, *tail_desc; > + unsigned char *pkt; > + int status, len, ret = -1; > + > + dev_dbg(priv->dev, "+ emac_recv\n"); > + > + rx_curr_desc = priv->emac_rx_active_head; > + status = readl(rx_curr_desc + EMAC_DESC_PKT_FLAG_LEN); > + if (status & EMAC_CPPI_OWNERSHIP_BIT) { > + ret = 0; > + goto out; > + } > + > + if (status & EMAC_CPPI_RX_ERROR_FRAME) { > + /* Error in packet - discard it and requeue desc */ > + dev_warn(priv->dev, "WARN: emac_rcv_pkt: Error in packet\n"); > + } else { > + pkt = (unsigned char *)readl(rx_curr_desc + EMAC_DESC_BUFFER); > + len = readl(rx_curr_desc + EMAC_DESC_BUFF_OFF_LEN) & 0xffff; > + dev_dbg(priv->dev, "| emac_recv got packet (length %i)\n", len); > + dma_inv_range((ulong)pkt, > + (ulong)readl(rx_curr_desc + EMAC_DESC_BUFFER) + len); > + net_receive(pkt, len); > + ret = len; > + } > + > + /* Ack received packet descriptor */ > + writel(BD_TO_HW(rx_curr_desc), priv->adap_emac + EMAC_RX0CP); > + curr_desc = rx_curr_desc; > + priv->emac_rx_active_head = HW_TO_BD(readl(rx_curr_desc + EMAC_DESC_NEXT)); > + > + if (status & EMAC_CPPI_EOQ_BIT) { > + if (priv->emac_rx_active_head) { > + writel(BD_TO_HW(priv->emac_rx_active_head), > + priv->adap_emac + EMAC_RX0HDP); > + } else { > + priv->emac_rx_queue_active = 0; > + dev_info(priv->dev, "INFO:emac_rcv_packet: RX Queue not active\n"); > + } > + } > + > + /* Recycle RX descriptor */ > + writel(EMAC_MAX_ETHERNET_PKT_SIZE, rx_curr_desc + EMAC_DESC_BUFF_OFF_LEN); > + writel(EMAC_CPPI_OWNERSHIP_BIT, rx_curr_desc + EMAC_DESC_PKT_FLAG_LEN); > + writel(0, rx_curr_desc + EMAC_DESC_NEXT); > + > + if (priv->emac_rx_active_head == 0) { > + dev_info(priv->dev, "INFO: emac_rcv_pkt: active queue head = 0\n"); > + priv->emac_rx_active_head = curr_desc; > + priv->emac_rx_active_tail = curr_desc; > + if (priv->emac_rx_queue_active != 0) { > + writel(BD_TO_HW(priv->emac_rx_active_head), priv->adap_emac + EMAC_RX0HDP); > + dev_info(priv->dev, "INFO: emac_rcv_pkt: active queue head = 0, HDP fired\n"); > + priv->emac_rx_queue_active = 1; > + } > + } else { > + tail_desc = priv->emac_rx_active_tail; > + priv->emac_rx_active_tail = curr_desc; > + writel(BD_TO_HW(curr_desc), tail_desc + EMAC_DESC_NEXT); > + status = readl(tail_desc + EMAC_DESC_PKT_FLAG_LEN); > + if (status & EMAC_CPPI_EOQ_BIT) { > + writel(BD_TO_HW(curr_desc), priv->adap_emac + EMAC_RX0HDP); > + status &= ~EMAC_CPPI_EOQ_BIT; > + writel(status, tail_desc + EMAC_DESC_PKT_FLAG_LEN); > + } > + } > + > +out: > + dev_dbg(priv->dev, "- emac_recv\n"); > + > + return ret; > +} > + > +static int davinci_emac_probe(struct device_d *dev) > +{ > + struct davinci_emac_priv *priv; > + uint64_t start; > + > + dev_dbg(dev, "+ emac_probe\n"); > + > + priv = xzalloc(sizeof(*priv)); > + dev->priv = priv; > + > + priv->dev = dev; > + > + priv->adap_emac = dev_request_mem_region(dev, 0); > + priv->adap_ewrap = dev_request_mem_region(dev, 1); > + priv->adap_mdio = dev_request_mem_region(dev, 2); > + priv->emac_desc_base = dev_request_mem_region(dev, 3); > + > + /* EMAC descriptors */ > + priv->emac_rx_desc = priv->emac_desc_base + EMAC_RX_DESC_BASE; > + priv->emac_tx_desc = priv->emac_desc_base + EMAC_TX_DESC_BASE; > + priv->emac_rx_active_head = NULL; > + priv->emac_rx_active_tail = NULL; > + priv->emac_rx_queue_active = 0; > + > + /* Receive packet buffers */ > + priv->emac_rx_buffers = xmemalign(4096, EMAC_MAX_RX_BUFFERS * (EMAC_MAX_ETHERNET_PKT_SIZE + EMAC_PKT_ALIGN)); dma?? > + > + /* PHY address for a discovered PHY (0xff - not found) */ > + priv->active_phy_addr = 0xff; > + > + priv->edev.priv = priv; > + priv->edev.init = davinci_emac_init; > + priv->edev.open = davinci_emac_open; > + priv->edev.halt = davinci_emac_halt; > + priv->edev.send = davinci_emac_send; > + priv->edev.recv = davinci_emac_recv; > + priv->edev.get_ethaddr = davinci_emac_get_ethaddr; > + priv->edev.set_ethaddr = davinci_emac_set_ethaddr; > + priv->edev.parent = dev; > + > + davinci_eth_mdio_enable(priv); > + > + start = get_time_ns(); > + while (1) { > + if (readl(priv->adap_mdio + EMAC_MDIO_ALIVE)) > + break; > + if (is_timeout(start, 256 * MSECOND)) { > + dev_err(dev, "No ETH PHY detected!\n"); > + break; > + } > + } > + > + priv->miidev.read = davinci_miidev_read; > + priv->miidev.write = davinci_miidev_write; > + priv->miidev.address = 0x01; > + priv->miidev.flags = MIIDEV_FORCE_LINK; > + priv->miidev.edev = &priv->edev; > + priv->miidev.parent = dev; > + > + mii_register(&priv->miidev); > + > + eth_register(&priv->edev); > + > + dev_dbg(dev, "- emac_probe\n"); > + return 0; > +} > + > +static void davinci_emac_remove(struct device_d *dev) > +{ > + struct davinci_emac_priv *priv = dev->priv; > + > + davinci_emac_halt(&priv->edev); > +} > + > +static struct driver_d davinci_emac_driver = { > + .name = "davinci_emac", > + .probe = davinci_emac_probe, > + .remove = davinci_emac_remove, > +}; > + > +static int davinci_emac_register(void) > +{ > + register_driver(&davinci_emac_driver); > + return 0; > +} > + Best Regards, J. _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox