b733c278d7
Propagate error code from genphy_update_link() to phy startup(). Signed-off-by: Michal Simek <michal.simek@xilinx.com> Acked-by: Stephen Warren <swarren@nvidia.com>
106 lines
2.4 KiB
C
106 lines
2.4 KiB
C
/*
|
|
* ET1011C PHY driver
|
|
*
|
|
* Derived from Linux kernel driver by Chaithrika U S
|
|
* Copyright (C) 2013, Texas Instruments, Incorporated - http://www.ti.com/
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
#include <config.h>
|
|
#include <phy.h>
|
|
|
|
#define ET1011C_CONFIG_REG (0x16)
|
|
#define ET1011C_TX_FIFO_MASK (0x3 << 12)
|
|
#define ET1011C_TX_FIFO_DEPTH_8 (0x0 << 12)
|
|
#define ET1011C_TX_FIFO_DEPTH_16 (0x1 << 12)
|
|
#define ET1011C_INTERFACE_MASK (0x7 << 0)
|
|
#define ET1011C_GMII_INTERFACE (0x2 << 0)
|
|
#define ET1011C_SYS_CLK_EN (0x1 << 4)
|
|
#define ET1011C_TX_CLK_EN (0x1 << 5)
|
|
|
|
#define ET1011C_STATUS_REG (0x1A)
|
|
#define ET1011C_DUPLEX_STATUS (0x1 << 7)
|
|
#define ET1011C_SPEED_MASK (0x3 << 8)
|
|
#define ET1011C_SPEED_1000 (0x2 << 8)
|
|
#define ET1011C_SPEED_100 (0x1 << 8)
|
|
#define ET1011C_SPEED_10 (0x0 << 8)
|
|
|
|
static int et1011c_config(struct phy_device *phydev)
|
|
{
|
|
int ctl = 0;
|
|
ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
|
|
if (ctl < 0)
|
|
return ctl;
|
|
ctl &= ~(BMCR_FULLDPLX | BMCR_SPEED100 | BMCR_SPEED1000 |
|
|
BMCR_ANENABLE);
|
|
/* First clear the PHY */
|
|
phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, ctl | BMCR_RESET);
|
|
|
|
return genphy_config_aneg(phydev);
|
|
}
|
|
|
|
static int et1011c_parse_status(struct phy_device *phydev)
|
|
{
|
|
int mii_reg;
|
|
int speed;
|
|
|
|
mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, ET1011C_STATUS_REG);
|
|
|
|
if (mii_reg & ET1011C_DUPLEX_STATUS)
|
|
phydev->duplex = DUPLEX_FULL;
|
|
else
|
|
phydev->duplex = DUPLEX_HALF;
|
|
|
|
speed = mii_reg & ET1011C_SPEED_MASK;
|
|
switch (speed) {
|
|
case ET1011C_SPEED_1000:
|
|
phydev->speed = SPEED_1000;
|
|
mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, ET1011C_CONFIG_REG);
|
|
mii_reg &= ~ET1011C_TX_FIFO_MASK;
|
|
phy_write(phydev, MDIO_DEVAD_NONE, ET1011C_CONFIG_REG,
|
|
mii_reg |
|
|
ET1011C_GMII_INTERFACE |
|
|
ET1011C_SYS_CLK_EN |
|
|
#ifdef CONFIG_PHY_ET1011C_TX_CLK_FIX
|
|
ET1011C_TX_CLK_EN |
|
|
#endif
|
|
ET1011C_TX_FIFO_DEPTH_16);
|
|
break;
|
|
case ET1011C_SPEED_100:
|
|
phydev->speed = SPEED_100;
|
|
break;
|
|
case ET1011C_SPEED_10:
|
|
phydev->speed = SPEED_10;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int et1011c_startup(struct phy_device *phydev)
|
|
{
|
|
int ret;
|
|
|
|
ret = genphy_update_link(phydev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return et1011c_parse_status(phydev);
|
|
}
|
|
|
|
static struct phy_driver et1011c_driver = {
|
|
.name = "ET1011C",
|
|
.uid = 0x0282f014,
|
|
.mask = 0xfffffff0,
|
|
.features = PHY_GBIT_FEATURES,
|
|
.config = &et1011c_config,
|
|
.startup = &et1011c_startup,
|
|
};
|
|
|
|
int phy_et1011c_init(void)
|
|
{
|
|
phy_register(&et1011c_driver);
|
|
|
|
return 0;
|
|
}
|