mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-01 17:10:11 +00:00
6e7df1d151
At this point, the remaining places where we have a symbol that is defined as CONFIG_... are in fairly odd locations. While as much dead code has been removed as possible, some of these locations are simply less obvious at first. In other cases, this code is used, but was defined in such a way as to have been missed by earlier checks. Perform a rename of all such remaining symbols to be CFG_... rather than CONFIG_... Signed-off-by: Tom Rini <trini@konsulko.com> Reviewed-by: Simon Glass <sjg@chromium.org>
868 lines
21 KiB
C
868 lines
21 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2010
|
|
* Vipin Kumar, STMicroelectronics, vipin.kumar@st.com.
|
|
*/
|
|
|
|
/*
|
|
* Designware ethernet IP driver for U-Boot
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <clk.h>
|
|
#include <cpu_func.h>
|
|
#include <dm.h>
|
|
#include <errno.h>
|
|
#include <log.h>
|
|
#include <miiphy.h>
|
|
#include <malloc.h>
|
|
#include <net.h>
|
|
#include <pci.h>
|
|
#include <reset.h>
|
|
#include <asm/cache.h>
|
|
#include <dm/device_compat.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/devres.h>
|
|
#include <dm/lists.h>
|
|
#include <linux/compiler.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/err.h>
|
|
#include <linux/kernel.h>
|
|
#include <asm/io.h>
|
|
#include <power/regulator.h>
|
|
#include "designware.h"
|
|
|
|
static int dw_mdio_read(struct mii_dev *bus, int addr, int devad, int reg)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv((struct udevice *)bus->priv);
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
ulong start;
|
|
u16 miiaddr;
|
|
int timeout = CFG_MDIO_TIMEOUT;
|
|
|
|
miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
|
|
((reg << MIIREGSHIFT) & MII_REGMSK);
|
|
|
|
writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
|
|
|
|
start = get_timer(0);
|
|
while (get_timer(start) < timeout) {
|
|
if (!(readl(&mac_p->miiaddr) & MII_BUSY))
|
|
return readl(&mac_p->miidata);
|
|
udelay(10);
|
|
};
|
|
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
static int dw_mdio_write(struct mii_dev *bus, int addr, int devad, int reg,
|
|
u16 val)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv((struct udevice *)bus->priv);
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
ulong start;
|
|
u16 miiaddr;
|
|
int ret = -ETIMEDOUT, timeout = CFG_MDIO_TIMEOUT;
|
|
|
|
writel(val, &mac_p->miidata);
|
|
miiaddr = ((addr << MIIADDRSHIFT) & MII_ADDRMSK) |
|
|
((reg << MIIREGSHIFT) & MII_REGMSK) | MII_WRITE;
|
|
|
|
writel(miiaddr | MII_CLKRANGE_150_250M | MII_BUSY, &mac_p->miiaddr);
|
|
|
|
start = get_timer(0);
|
|
while (get_timer(start) < timeout) {
|
|
if (!(readl(&mac_p->miiaddr) & MII_BUSY)) {
|
|
ret = 0;
|
|
break;
|
|
}
|
|
udelay(10);
|
|
};
|
|
|
|
return ret;
|
|
}
|
|
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
static int __dw_mdio_reset(struct udevice *dev)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
struct dw_eth_pdata *pdata = dev_get_plat(dev);
|
|
int ret;
|
|
|
|
if (!dm_gpio_is_valid(&priv->reset_gpio))
|
|
return 0;
|
|
|
|
/* reset the phy */
|
|
ret = dm_gpio_set_value(&priv->reset_gpio, 0);
|
|
if (ret)
|
|
return ret;
|
|
|
|
udelay(pdata->reset_delays[0]);
|
|
|
|
ret = dm_gpio_set_value(&priv->reset_gpio, 1);
|
|
if (ret)
|
|
return ret;
|
|
|
|
udelay(pdata->reset_delays[1]);
|
|
|
|
ret = dm_gpio_set_value(&priv->reset_gpio, 0);
|
|
if (ret)
|
|
return ret;
|
|
|
|
udelay(pdata->reset_delays[2]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dw_mdio_reset(struct mii_dev *bus)
|
|
{
|
|
struct udevice *dev = bus->priv;
|
|
|
|
return __dw_mdio_reset(dev);
|
|
}
|
|
#endif
|
|
|
|
#if IS_ENABLED(CONFIG_DM_MDIO)
|
|
int designware_eth_mdio_read(struct udevice *mdio_dev, int addr, int devad, int reg)
|
|
{
|
|
struct mdio_perdev_priv *pdata = dev_get_uclass_priv(mdio_dev);
|
|
|
|
return dw_mdio_read(pdata->mii_bus, addr, devad, reg);
|
|
}
|
|
|
|
int designware_eth_mdio_write(struct udevice *mdio_dev, int addr, int devad, int reg, u16 val)
|
|
{
|
|
struct mdio_perdev_priv *pdata = dev_get_uclass_priv(mdio_dev);
|
|
|
|
return dw_mdio_write(pdata->mii_bus, addr, devad, reg, val);
|
|
}
|
|
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
int designware_eth_mdio_reset(struct udevice *mdio_dev)
|
|
{
|
|
struct mdio_perdev_priv *mdio_pdata = dev_get_uclass_priv(mdio_dev);
|
|
struct udevice *dev = mdio_pdata->mii_bus->priv;
|
|
|
|
return __dw_mdio_reset(dev->parent);
|
|
}
|
|
#endif
|
|
|
|
static const struct mdio_ops designware_eth_mdio_ops = {
|
|
.read = designware_eth_mdio_read,
|
|
.write = designware_eth_mdio_write,
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
.reset = designware_eth_mdio_reset,
|
|
#endif
|
|
};
|
|
|
|
static int designware_eth_mdio_probe(struct udevice *dev)
|
|
{
|
|
/* Use the priv data of parent */
|
|
dev_set_priv(dev, dev_get_priv(dev->parent));
|
|
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_DRIVER(designware_eth_mdio) = {
|
|
.name = "eth_designware_mdio",
|
|
.id = UCLASS_MDIO,
|
|
.probe = designware_eth_mdio_probe,
|
|
.ops = &designware_eth_mdio_ops,
|
|
.plat_auto = sizeof(struct mdio_perdev_priv),
|
|
};
|
|
#endif
|
|
|
|
static int dw_mdio_init(const char *name, void *priv)
|
|
{
|
|
struct mii_dev *bus = mdio_alloc();
|
|
|
|
if (!bus) {
|
|
printf("Failed to allocate MDIO bus\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
bus->read = dw_mdio_read;
|
|
bus->write = dw_mdio_write;
|
|
snprintf(bus->name, sizeof(bus->name), "%s", name);
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
bus->reset = dw_mdio_reset;
|
|
#endif
|
|
|
|
bus->priv = priv;
|
|
|
|
return mdio_register(bus);
|
|
}
|
|
|
|
#if IS_ENABLED(CONFIG_DM_MDIO)
|
|
static int dw_dm_mdio_init(const char *name, void *priv)
|
|
{
|
|
struct udevice *dev = priv;
|
|
ofnode node;
|
|
int ret;
|
|
|
|
ofnode_for_each_subnode(node, dev_ofnode(dev)) {
|
|
const char *subnode_name = ofnode_get_name(node);
|
|
struct udevice *mdiodev;
|
|
|
|
if (strcmp(subnode_name, "mdio"))
|
|
continue;
|
|
|
|
ret = device_bind_driver_to_node(dev, "eth_designware_mdio",
|
|
subnode_name, node, &mdiodev);
|
|
if (ret)
|
|
debug("%s: not able to bind mdio device node\n", __func__);
|
|
|
|
return 0;
|
|
}
|
|
|
|
printf("%s: mdio node is missing, registering legacy mdio bus", __func__);
|
|
|
|
return dw_mdio_init(name, priv);
|
|
}
|
|
#endif
|
|
|
|
static void tx_descs_init(struct dw_eth_dev *priv)
|
|
{
|
|
struct eth_dma_regs *dma_p = priv->dma_regs_p;
|
|
struct dmamacdescr *desc_table_p = &priv->tx_mac_descrtable[0];
|
|
char *txbuffs = &priv->txbuffs[0];
|
|
struct dmamacdescr *desc_p;
|
|
u32 idx;
|
|
|
|
for (idx = 0; idx < CFG_TX_DESCR_NUM; idx++) {
|
|
desc_p = &desc_table_p[idx];
|
|
desc_p->dmamac_addr = (ulong)&txbuffs[idx * CFG_ETH_BUFSIZE];
|
|
desc_p->dmamac_next = (ulong)&desc_table_p[idx + 1];
|
|
|
|
#if defined(CONFIG_DW_ALTDESCRIPTOR)
|
|
desc_p->txrx_status &= ~(DESC_TXSTS_TXINT | DESC_TXSTS_TXLAST |
|
|
DESC_TXSTS_TXFIRST | DESC_TXSTS_TXCRCDIS |
|
|
DESC_TXSTS_TXCHECKINSCTRL |
|
|
DESC_TXSTS_TXRINGEND | DESC_TXSTS_TXPADDIS);
|
|
|
|
desc_p->txrx_status |= DESC_TXSTS_TXCHAIN;
|
|
desc_p->dmamac_cntl = 0;
|
|
desc_p->txrx_status &= ~(DESC_TXSTS_MSK | DESC_TXSTS_OWNBYDMA);
|
|
#else
|
|
desc_p->dmamac_cntl = DESC_TXCTRL_TXCHAIN;
|
|
desc_p->txrx_status = 0;
|
|
#endif
|
|
}
|
|
|
|
/* Correcting the last pointer of the chain */
|
|
desc_p->dmamac_next = (ulong)&desc_table_p[0];
|
|
|
|
/* Flush all Tx buffer descriptors at once */
|
|
flush_dcache_range((ulong)priv->tx_mac_descrtable,
|
|
(ulong)priv->tx_mac_descrtable +
|
|
sizeof(priv->tx_mac_descrtable));
|
|
|
|
writel((ulong)&desc_table_p[0], &dma_p->txdesclistaddr);
|
|
priv->tx_currdescnum = 0;
|
|
}
|
|
|
|
static void rx_descs_init(struct dw_eth_dev *priv)
|
|
{
|
|
struct eth_dma_regs *dma_p = priv->dma_regs_p;
|
|
struct dmamacdescr *desc_table_p = &priv->rx_mac_descrtable[0];
|
|
char *rxbuffs = &priv->rxbuffs[0];
|
|
struct dmamacdescr *desc_p;
|
|
u32 idx;
|
|
|
|
/* Before passing buffers to GMAC we need to make sure zeros
|
|
* written there right after "priv" structure allocation were
|
|
* flushed into RAM.
|
|
* Otherwise there's a chance to get some of them flushed in RAM when
|
|
* GMAC is already pushing data to RAM via DMA. This way incoming from
|
|
* GMAC data will be corrupted. */
|
|
flush_dcache_range((ulong)rxbuffs, (ulong)rxbuffs + RX_TOTAL_BUFSIZE);
|
|
|
|
for (idx = 0; idx < CFG_RX_DESCR_NUM; idx++) {
|
|
desc_p = &desc_table_p[idx];
|
|
desc_p->dmamac_addr = (ulong)&rxbuffs[idx * CFG_ETH_BUFSIZE];
|
|
desc_p->dmamac_next = (ulong)&desc_table_p[idx + 1];
|
|
|
|
desc_p->dmamac_cntl =
|
|
(MAC_MAX_FRAME_SZ & DESC_RXCTRL_SIZE1MASK) |
|
|
DESC_RXCTRL_RXCHAIN;
|
|
|
|
desc_p->txrx_status = DESC_RXSTS_OWNBYDMA;
|
|
}
|
|
|
|
/* Correcting the last pointer of the chain */
|
|
desc_p->dmamac_next = (ulong)&desc_table_p[0];
|
|
|
|
/* Flush all Rx buffer descriptors at once */
|
|
flush_dcache_range((ulong)priv->rx_mac_descrtable,
|
|
(ulong)priv->rx_mac_descrtable +
|
|
sizeof(priv->rx_mac_descrtable));
|
|
|
|
writel((ulong)&desc_table_p[0], &dma_p->rxdesclistaddr);
|
|
priv->rx_currdescnum = 0;
|
|
}
|
|
|
|
static int _dw_write_hwaddr(struct dw_eth_dev *priv, u8 *mac_id)
|
|
{
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
u32 macid_lo, macid_hi;
|
|
|
|
macid_lo = mac_id[0] + (mac_id[1] << 8) + (mac_id[2] << 16) +
|
|
(mac_id[3] << 24);
|
|
macid_hi = mac_id[4] + (mac_id[5] << 8);
|
|
|
|
writel(macid_hi, &mac_p->macaddr0hi);
|
|
writel(macid_lo, &mac_p->macaddr0lo);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dw_adjust_link(struct dw_eth_dev *priv, struct eth_mac_regs *mac_p,
|
|
struct phy_device *phydev)
|
|
{
|
|
u32 conf = readl(&mac_p->conf) | FRAMEBURSTENABLE | DISABLERXOWN;
|
|
|
|
if (!phydev->link) {
|
|
printf("%s: No link.\n", phydev->dev->name);
|
|
return 0;
|
|
}
|
|
|
|
if (phydev->speed != 1000)
|
|
conf |= MII_PORTSELECT;
|
|
else
|
|
conf &= ~MII_PORTSELECT;
|
|
|
|
if (phydev->speed == 100)
|
|
conf |= FES_100;
|
|
|
|
if (phydev->duplex)
|
|
conf |= FULLDPLXMODE;
|
|
|
|
writel(conf, &mac_p->conf);
|
|
|
|
printf("Speed: %d, %s duplex%s\n", phydev->speed,
|
|
(phydev->duplex) ? "full" : "half",
|
|
(phydev->port == PORT_FIBRE) ? ", fiber mode" : "");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void _dw_eth_halt(struct dw_eth_dev *priv)
|
|
{
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
struct eth_dma_regs *dma_p = priv->dma_regs_p;
|
|
|
|
writel(readl(&mac_p->conf) & ~(RXENABLE | TXENABLE), &mac_p->conf);
|
|
writel(readl(&dma_p->opmode) & ~(RXSTART | TXSTART), &dma_p->opmode);
|
|
|
|
phy_shutdown(priv->phydev);
|
|
}
|
|
|
|
int designware_eth_init(struct dw_eth_dev *priv, u8 *enetaddr)
|
|
{
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
struct eth_dma_regs *dma_p = priv->dma_regs_p;
|
|
unsigned int start;
|
|
int ret;
|
|
|
|
writel(readl(&dma_p->busmode) | DMAMAC_SRST, &dma_p->busmode);
|
|
|
|
/*
|
|
* When a MII PHY is used, we must set the PS bit for the DMA
|
|
* reset to succeed.
|
|
*/
|
|
if (priv->phydev->interface == PHY_INTERFACE_MODE_MII)
|
|
writel(readl(&mac_p->conf) | MII_PORTSELECT, &mac_p->conf);
|
|
else
|
|
writel(readl(&mac_p->conf) & ~MII_PORTSELECT, &mac_p->conf);
|
|
|
|
start = get_timer(0);
|
|
while (readl(&dma_p->busmode) & DMAMAC_SRST) {
|
|
if (get_timer(start) >= CFG_MACRESET_TIMEOUT) {
|
|
printf("DMA reset timeout\n");
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
mdelay(100);
|
|
};
|
|
|
|
/*
|
|
* Soft reset above clears HW address registers.
|
|
* So we have to set it here once again.
|
|
*/
|
|
_dw_write_hwaddr(priv, enetaddr);
|
|
|
|
rx_descs_init(priv);
|
|
tx_descs_init(priv);
|
|
|
|
writel(FIXEDBURST | PRIORXTX_41 | DMA_PBL, &dma_p->busmode);
|
|
|
|
#ifndef CONFIG_DW_MAC_FORCE_THRESHOLD_MODE
|
|
writel(readl(&dma_p->opmode) | FLUSHTXFIFO | STOREFORWARD,
|
|
&dma_p->opmode);
|
|
#else
|
|
writel(readl(&dma_p->opmode) | FLUSHTXFIFO,
|
|
&dma_p->opmode);
|
|
#endif
|
|
|
|
writel(readl(&dma_p->opmode) | RXSTART | TXSTART, &dma_p->opmode);
|
|
|
|
#ifdef CONFIG_DW_AXI_BURST_LEN
|
|
writel((CONFIG_DW_AXI_BURST_LEN & 0x1FF >> 1), &dma_p->axibus);
|
|
#endif
|
|
|
|
/* Start up the PHY */
|
|
ret = phy_startup(priv->phydev);
|
|
if (ret) {
|
|
printf("Could not initialize PHY %s\n",
|
|
priv->phydev->dev->name);
|
|
return ret;
|
|
}
|
|
|
|
ret = dw_adjust_link(priv, mac_p, priv->phydev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int designware_eth_enable(struct dw_eth_dev *priv)
|
|
{
|
|
struct eth_mac_regs *mac_p = priv->mac_regs_p;
|
|
|
|
if (!priv->phydev->link)
|
|
return -EIO;
|
|
|
|
writel(readl(&mac_p->conf) | RXENABLE | TXENABLE, &mac_p->conf);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#define ETH_ZLEN 60
|
|
|
|
static int _dw_eth_send(struct dw_eth_dev *priv, void *packet, int length)
|
|
{
|
|
struct eth_dma_regs *dma_p = priv->dma_regs_p;
|
|
u32 desc_num = priv->tx_currdescnum;
|
|
struct dmamacdescr *desc_p = &priv->tx_mac_descrtable[desc_num];
|
|
ulong desc_start = (ulong)desc_p;
|
|
ulong desc_end = desc_start +
|
|
roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
|
|
ulong data_start = desc_p->dmamac_addr;
|
|
ulong data_end = data_start + roundup(length, ARCH_DMA_MINALIGN);
|
|
/*
|
|
* Strictly we only need to invalidate the "txrx_status" field
|
|
* for the following check, but on some platforms we cannot
|
|
* invalidate only 4 bytes, so we flush the entire descriptor,
|
|
* which is 16 bytes in total. This is safe because the
|
|
* individual descriptors in the array are each aligned to
|
|
* ARCH_DMA_MINALIGN and padded appropriately.
|
|
*/
|
|
invalidate_dcache_range(desc_start, desc_end);
|
|
|
|
/* Check if the descriptor is owned by CPU */
|
|
if (desc_p->txrx_status & DESC_TXSTS_OWNBYDMA) {
|
|
printf("CPU not owner of tx frame\n");
|
|
return -EPERM;
|
|
}
|
|
|
|
memcpy((void *)data_start, packet, length);
|
|
if (length < ETH_ZLEN) {
|
|
memset(&((char *)data_start)[length], 0, ETH_ZLEN - length);
|
|
length = ETH_ZLEN;
|
|
}
|
|
|
|
/* Flush data to be sent */
|
|
flush_dcache_range(data_start, data_end);
|
|
|
|
#if defined(CONFIG_DW_ALTDESCRIPTOR)
|
|
desc_p->txrx_status |= DESC_TXSTS_TXFIRST | DESC_TXSTS_TXLAST;
|
|
desc_p->dmamac_cntl = (desc_p->dmamac_cntl & ~DESC_TXCTRL_SIZE1MASK) |
|
|
((length << DESC_TXCTRL_SIZE1SHFT) &
|
|
DESC_TXCTRL_SIZE1MASK);
|
|
|
|
desc_p->txrx_status &= ~(DESC_TXSTS_MSK);
|
|
desc_p->txrx_status |= DESC_TXSTS_OWNBYDMA;
|
|
#else
|
|
desc_p->dmamac_cntl = (desc_p->dmamac_cntl & ~DESC_TXCTRL_SIZE1MASK) |
|
|
((length << DESC_TXCTRL_SIZE1SHFT) &
|
|
DESC_TXCTRL_SIZE1MASK) | DESC_TXCTRL_TXLAST |
|
|
DESC_TXCTRL_TXFIRST;
|
|
|
|
desc_p->txrx_status = DESC_TXSTS_OWNBYDMA;
|
|
#endif
|
|
|
|
/* Flush modified buffer descriptor */
|
|
flush_dcache_range(desc_start, desc_end);
|
|
|
|
/* Test the wrap-around condition. */
|
|
if (++desc_num >= CFG_TX_DESCR_NUM)
|
|
desc_num = 0;
|
|
|
|
priv->tx_currdescnum = desc_num;
|
|
|
|
/* Start the transmission */
|
|
writel(POLL_DATA, &dma_p->txpolldemand);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int _dw_eth_recv(struct dw_eth_dev *priv, uchar **packetp)
|
|
{
|
|
u32 status, desc_num = priv->rx_currdescnum;
|
|
struct dmamacdescr *desc_p = &priv->rx_mac_descrtable[desc_num];
|
|
int length = -EAGAIN;
|
|
ulong desc_start = (ulong)desc_p;
|
|
ulong desc_end = desc_start +
|
|
roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
|
|
ulong data_start = desc_p->dmamac_addr;
|
|
ulong data_end;
|
|
|
|
/* Invalidate entire buffer descriptor */
|
|
invalidate_dcache_range(desc_start, desc_end);
|
|
|
|
status = desc_p->txrx_status;
|
|
|
|
/* Check if the owner is the CPU */
|
|
if (!(status & DESC_RXSTS_OWNBYDMA)) {
|
|
|
|
length = (status & DESC_RXSTS_FRMLENMSK) >>
|
|
DESC_RXSTS_FRMLENSHFT;
|
|
|
|
/* Invalidate received data */
|
|
data_end = data_start + roundup(length, ARCH_DMA_MINALIGN);
|
|
invalidate_dcache_range(data_start, data_end);
|
|
*packetp = (uchar *)(ulong)desc_p->dmamac_addr;
|
|
}
|
|
|
|
return length;
|
|
}
|
|
|
|
static int _dw_free_pkt(struct dw_eth_dev *priv)
|
|
{
|
|
u32 desc_num = priv->rx_currdescnum;
|
|
struct dmamacdescr *desc_p = &priv->rx_mac_descrtable[desc_num];
|
|
ulong desc_start = (ulong)desc_p;
|
|
ulong desc_end = desc_start +
|
|
roundup(sizeof(*desc_p), ARCH_DMA_MINALIGN);
|
|
|
|
/*
|
|
* Make the current descriptor valid again and go to
|
|
* the next one
|
|
*/
|
|
desc_p->txrx_status |= DESC_RXSTS_OWNBYDMA;
|
|
|
|
/* Flush only status field - others weren't changed */
|
|
flush_dcache_range(desc_start, desc_end);
|
|
|
|
/* Test the wrap-around condition. */
|
|
if (++desc_num >= CFG_RX_DESCR_NUM)
|
|
desc_num = 0;
|
|
priv->rx_currdescnum = desc_num;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dw_phy_init(struct dw_eth_dev *priv, void *dev)
|
|
{
|
|
struct phy_device *phydev;
|
|
int ret;
|
|
|
|
#if IS_ENABLED(CONFIG_DM_MDIO)
|
|
phydev = dm_eth_phy_connect(dev);
|
|
if (!phydev)
|
|
return -ENODEV;
|
|
#else
|
|
int phy_addr = -1;
|
|
|
|
#ifdef CONFIG_PHY_ADDR
|
|
phy_addr = CONFIG_PHY_ADDR;
|
|
#endif
|
|
|
|
phydev = phy_connect(priv->bus, phy_addr, dev, priv->interface);
|
|
if (!phydev)
|
|
return -ENODEV;
|
|
#endif
|
|
|
|
phydev->supported &= PHY_GBIT_FEATURES;
|
|
if (priv->max_speed) {
|
|
ret = phy_set_supported(phydev, priv->max_speed);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
phydev->advertising = phydev->supported;
|
|
|
|
priv->phydev = phydev;
|
|
phy_config(phydev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int designware_eth_start(struct udevice *dev)
|
|
{
|
|
struct eth_pdata *pdata = dev_get_plat(dev);
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
int ret;
|
|
|
|
ret = designware_eth_init(priv, pdata->enetaddr);
|
|
if (ret)
|
|
return ret;
|
|
ret = designware_eth_enable(priv);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int designware_eth_send(struct udevice *dev, void *packet, int length)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
return _dw_eth_send(priv, packet, length);
|
|
}
|
|
|
|
int designware_eth_recv(struct udevice *dev, int flags, uchar **packetp)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
return _dw_eth_recv(priv, packetp);
|
|
}
|
|
|
|
int designware_eth_free_pkt(struct udevice *dev, uchar *packet, int length)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
return _dw_free_pkt(priv);
|
|
}
|
|
|
|
void designware_eth_stop(struct udevice *dev)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
return _dw_eth_halt(priv);
|
|
}
|
|
|
|
int designware_eth_write_hwaddr(struct udevice *dev)
|
|
{
|
|
struct eth_pdata *pdata = dev_get_plat(dev);
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
return _dw_write_hwaddr(priv, pdata->enetaddr);
|
|
}
|
|
|
|
static int designware_eth_bind(struct udevice *dev)
|
|
{
|
|
if (IS_ENABLED(CONFIG_PCI)) {
|
|
static int num_cards;
|
|
char name[20];
|
|
|
|
/* Create a unique device name for PCI type devices */
|
|
if (device_is_on_pci_bus(dev)) {
|
|
sprintf(name, "eth_designware#%u", num_cards++);
|
|
device_set_name(dev, name);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int designware_eth_probe(struct udevice *dev)
|
|
{
|
|
struct eth_pdata *pdata = dev_get_plat(dev);
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
u32 iobase = pdata->iobase;
|
|
ulong ioaddr;
|
|
int ret, err;
|
|
struct reset_ctl_bulk reset_bulk;
|
|
#ifdef CONFIG_CLK
|
|
int i, clock_nb;
|
|
|
|
priv->clock_count = 0;
|
|
clock_nb = dev_count_phandle_with_args(dev, "clocks", "#clock-cells",
|
|
0);
|
|
if (clock_nb > 0) {
|
|
priv->clocks = devm_kcalloc(dev, clock_nb, sizeof(struct clk),
|
|
GFP_KERNEL);
|
|
if (!priv->clocks)
|
|
return -ENOMEM;
|
|
|
|
for (i = 0; i < clock_nb; i++) {
|
|
err = clk_get_by_index(dev, i, &priv->clocks[i]);
|
|
if (err < 0)
|
|
break;
|
|
|
|
err = clk_enable(&priv->clocks[i]);
|
|
if (err && err != -ENOSYS && err != -ENOTSUPP) {
|
|
pr_err("failed to enable clock %d\n", i);
|
|
clk_free(&priv->clocks[i]);
|
|
goto clk_err;
|
|
}
|
|
priv->clock_count++;
|
|
}
|
|
} else if (clock_nb != -ENOENT) {
|
|
pr_err("failed to get clock phandle(%d)\n", clock_nb);
|
|
return clock_nb;
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_DM_REGULATOR)
|
|
struct udevice *phy_supply;
|
|
|
|
ret = device_get_supply_regulator(dev, "phy-supply",
|
|
&phy_supply);
|
|
if (ret) {
|
|
debug("%s: No phy supply\n", dev->name);
|
|
} else {
|
|
ret = regulator_set_enable(phy_supply, true);
|
|
if (ret) {
|
|
puts("Error enabling phy supply\n");
|
|
return ret;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
ret = reset_get_bulk(dev, &reset_bulk);
|
|
if (ret)
|
|
dev_warn(dev, "Can't get reset: %d\n", ret);
|
|
else
|
|
reset_deassert_bulk(&reset_bulk);
|
|
|
|
/*
|
|
* If we are on PCI bus, either directly attached to a PCI root port,
|
|
* or via a PCI bridge, fill in plat before we probe the hardware.
|
|
*/
|
|
if (IS_ENABLED(CONFIG_PCI) && device_is_on_pci_bus(dev)) {
|
|
dm_pci_read_config32(dev, PCI_BASE_ADDRESS_0, &iobase);
|
|
iobase &= PCI_BASE_ADDRESS_MEM_MASK;
|
|
iobase = dm_pci_mem_to_phys(dev, iobase);
|
|
|
|
pdata->iobase = iobase;
|
|
pdata->phy_interface = PHY_INTERFACE_MODE_RMII;
|
|
}
|
|
|
|
debug("%s, iobase=%x, priv=%p\n", __func__, iobase, priv);
|
|
ioaddr = iobase;
|
|
priv->mac_regs_p = (struct eth_mac_regs *)ioaddr;
|
|
priv->dma_regs_p = (struct eth_dma_regs *)(ioaddr + DW_DMA_BASE_OFFSET);
|
|
priv->interface = pdata->phy_interface;
|
|
priv->max_speed = pdata->max_speed;
|
|
|
|
#if IS_ENABLED(CONFIG_DM_MDIO)
|
|
ret = dw_dm_mdio_init(dev->name, dev);
|
|
#else
|
|
ret = dw_mdio_init(dev->name, dev);
|
|
#endif
|
|
if (ret) {
|
|
err = ret;
|
|
goto mdio_err;
|
|
}
|
|
priv->bus = miiphy_get_dev_by_name(dev->name);
|
|
|
|
ret = dw_phy_init(priv, dev);
|
|
debug("%s, ret=%d\n", __func__, ret);
|
|
if (!ret)
|
|
return 0;
|
|
|
|
/* continue here for cleanup if no PHY found */
|
|
err = ret;
|
|
mdio_unregister(priv->bus);
|
|
mdio_free(priv->bus);
|
|
mdio_err:
|
|
|
|
#ifdef CONFIG_CLK
|
|
clk_err:
|
|
ret = clk_release_all(priv->clocks, priv->clock_count);
|
|
if (ret)
|
|
pr_err("failed to disable all clocks\n");
|
|
|
|
#endif
|
|
return err;
|
|
}
|
|
|
|
static int designware_eth_remove(struct udevice *dev)
|
|
{
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
|
|
free(priv->phydev);
|
|
mdio_unregister(priv->bus);
|
|
mdio_free(priv->bus);
|
|
|
|
#ifdef CONFIG_CLK
|
|
return clk_release_all(priv->clocks, priv->clock_count);
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
const struct eth_ops designware_eth_ops = {
|
|
.start = designware_eth_start,
|
|
.send = designware_eth_send,
|
|
.recv = designware_eth_recv,
|
|
.free_pkt = designware_eth_free_pkt,
|
|
.stop = designware_eth_stop,
|
|
.write_hwaddr = designware_eth_write_hwaddr,
|
|
};
|
|
|
|
int designware_eth_of_to_plat(struct udevice *dev)
|
|
{
|
|
struct dw_eth_pdata *dw_pdata = dev_get_plat(dev);
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
struct dw_eth_dev *priv = dev_get_priv(dev);
|
|
#endif
|
|
struct eth_pdata *pdata = &dw_pdata->eth_pdata;
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
int reset_flags = GPIOD_IS_OUT;
|
|
#endif
|
|
int ret = 0;
|
|
|
|
pdata->iobase = dev_read_addr(dev);
|
|
pdata->phy_interface = dev_read_phy_mode(dev);
|
|
if (pdata->phy_interface == PHY_INTERFACE_MODE_NA)
|
|
return -EINVAL;
|
|
|
|
pdata->max_speed = dev_read_u32_default(dev, "max-speed", 0);
|
|
|
|
#if CONFIG_IS_ENABLED(DM_GPIO)
|
|
if (dev_read_bool(dev, "snps,reset-active-low"))
|
|
reset_flags |= GPIOD_ACTIVE_LOW;
|
|
|
|
ret = gpio_request_by_name(dev, "snps,reset-gpio", 0,
|
|
&priv->reset_gpio, reset_flags);
|
|
if (ret == 0) {
|
|
ret = dev_read_u32_array(dev, "snps,reset-delays-us",
|
|
dw_pdata->reset_delays, 3);
|
|
} else if (ret == -ENOENT) {
|
|
ret = 0;
|
|
}
|
|
#endif
|
|
|
|
return ret;
|
|
}
|
|
|
|
static const struct udevice_id designware_eth_ids[] = {
|
|
{ .compatible = "allwinner,sun7i-a20-gmac" },
|
|
{ .compatible = "amlogic,meson6-dwmac" },
|
|
{ .compatible = "st,stm32-dwmac" },
|
|
{ .compatible = "snps,arc-dwmac-3.70a" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(eth_designware) = {
|
|
.name = "eth_designware",
|
|
.id = UCLASS_ETH,
|
|
.of_match = designware_eth_ids,
|
|
.of_to_plat = designware_eth_of_to_plat,
|
|
.bind = designware_eth_bind,
|
|
.probe = designware_eth_probe,
|
|
.remove = designware_eth_remove,
|
|
.ops = &designware_eth_ops,
|
|
.priv_auto = sizeof(struct dw_eth_dev),
|
|
.plat_auto = sizeof(struct dw_eth_pdata),
|
|
.flags = DM_FLAG_ALLOC_PRIV_DMA,
|
|
};
|
|
|
|
static struct pci_device_id supported[] = {
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_QRK_EMAC) },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_PCI_DEVICE(eth_designware, supported);
|