Commit 657de1cf authored by Heiner Kallweit's avatar Heiner Kallweit Committed by David S. Miller

net: phy: smsc: add support for edpd tunable

This adds support for the EDPD PHY tunable.
Per default EDPD is disabled in interrupt mode, the tunable can be used
to override this, e.g. if the link partner doesn't use EDPD.
The interval to check for energy can be chosen between 1000ms and
2000ms. Note that this value consists of the 1000ms phylib interval
for state machine runs plus the time to wait for energy being detected.

v2:
- consider that phylib core holds phydev->lock when calling the
  phy tunable hooks
Signed-off-by: default avatarHeiner Kallweit <hkallweit1@gmail.com>
Reviewed-by: default avatarSimon Horman <simon.horman@corigine.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 1ce65869
......@@ -34,6 +34,8 @@
#define SPECIAL_CTRL_STS_AMDIX_STATE_ 0x2000
#define EDPD_MAX_WAIT_DFLT_MS 640
/* interval between phylib state machine runs in ms */
#define PHY_STATE_MACH_MS 1000
struct smsc_hw_stat {
const char *string;
......@@ -295,6 +297,79 @@ static void smsc_get_stats(struct phy_device *phydev,
data[i] = smsc_get_stat(phydev, i);
}
static int smsc_phy_get_edpd(struct phy_device *phydev, u16 *edpd)
{
struct smsc_phy_priv *priv = phydev->priv;
if (!priv)
return -EOPNOTSUPP;
if (!priv->edpd_enable)
*edpd = ETHTOOL_PHY_EDPD_DISABLE;
else if (!priv->edpd_max_wait_ms)
*edpd = ETHTOOL_PHY_EDPD_NO_TX;
else
*edpd = PHY_STATE_MACH_MS + priv->edpd_max_wait_ms;
return 0;
}
static int smsc_phy_set_edpd(struct phy_device *phydev, u16 edpd)
{
struct smsc_phy_priv *priv = phydev->priv;
if (!priv)
return -EOPNOTSUPP;
switch (edpd) {
case ETHTOOL_PHY_EDPD_DISABLE:
priv->edpd_enable = false;
break;
case ETHTOOL_PHY_EDPD_NO_TX:
priv->edpd_enable = true;
priv->edpd_max_wait_ms = 0;
break;
case ETHTOOL_PHY_EDPD_DFLT_TX_MSECS:
edpd = PHY_STATE_MACH_MS + EDPD_MAX_WAIT_DFLT_MS;
fallthrough;
default:
if (phydev->irq != PHY_POLL)
return -EOPNOTSUPP;
if (edpd < PHY_STATE_MACH_MS || edpd > PHY_STATE_MACH_MS + 1000)
return -EINVAL;
priv->edpd_enable = true;
priv->edpd_max_wait_ms = edpd - PHY_STATE_MACH_MS;
}
priv->edpd_mode_set_by_user = true;
return smsc_phy_config_edpd(phydev);
}
int smsc_phy_get_tunable(struct phy_device *phydev,
struct ethtool_tunable *tuna, void *data)
{
switch (tuna->id) {
case ETHTOOL_PHY_EDPD:
return smsc_phy_get_edpd(phydev, data);
default:
return -EOPNOTSUPP;
}
}
EXPORT_SYMBOL_GPL(smsc_phy_get_tunable);
int smsc_phy_set_tunable(struct phy_device *phydev,
struct ethtool_tunable *tuna, const void *data)
{
switch (tuna->id) {
case ETHTOOL_PHY_EDPD:
return smsc_phy_set_edpd(phydev, *(u16 *)data);
default:
return -EOPNOTSUPP;
}
}
EXPORT_SYMBOL_GPL(smsc_phy_set_tunable);
int smsc_phy_probe(struct phy_device *phydev)
{
struct device *dev = &phydev->mdio.dev;
......
......@@ -32,6 +32,10 @@ int smsc_phy_config_intr(struct phy_device *phydev);
irqreturn_t smsc_phy_handle_interrupt(struct phy_device *phydev);
int smsc_phy_config_init(struct phy_device *phydev);
int lan87xx_read_status(struct phy_device *phydev);
int smsc_phy_get_tunable(struct phy_device *phydev,
struct ethtool_tunable *tuna, void *data);
int smsc_phy_set_tunable(struct phy_device *phydev,
struct ethtool_tunable *tuna, const void *data);
int smsc_phy_probe(struct phy_device *phydev);
#endif /* __LINUX_SMSCPHY_H__ */
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment