@@ -502,9 +502,8 @@ struct sxgbe_priv_data {
struct timer_list eee_ctrl_timer;
bool tx_path_in_lpi_mode;
int lpi_irq;
- int eee_enabled;
- int eee_active;
int tx_lpi_timer;
+ bool tx_lpi_enabled;
};
/* Function prototypes */
@@ -528,5 +527,4 @@ int sxgbe_restore(struct net_device *ndev);
const struct sxgbe_mtl_ops *sxgbe_get_mtl_ops(void);
void sxgbe_disable_eee_mode(struct sxgbe_priv_data * const priv);
-bool sxgbe_eee_init(struct sxgbe_priv_data * const priv);
#endif /* __SXGBE_COMMON_H__ */
@@ -140,8 +140,7 @@ static int sxgbe_get_eee(struct net_device *dev,
if (!priv->hw_cap.eee)
return -EOPNOTSUPP;
- edata->eee_enabled = priv->eee_enabled;
- edata->eee_active = priv->eee_active;
+ edata->tx_lpi_enabled = priv->tx_lpi_enabled;
edata->tx_lpi_timer = priv->tx_lpi_timer;
return phy_ethtool_get_eee(dev->phydev, edata);
@@ -152,22 +151,8 @@ static int sxgbe_set_eee(struct net_device *dev,
{
struct sxgbe_priv_data *priv = netdev_priv(dev);
- priv->eee_enabled = edata->eee_enabled;
-
- if (!priv->eee_enabled) {
- sxgbe_disable_eee_mode(priv);
- } else {
- /* We are asking for enabling the EEE but it is safe
- * to verify all by invoking the eee_init function.
- * In case of failure it will return an error.
- */
- priv->eee_enabled = sxgbe_eee_init(priv);
- if (!priv->eee_enabled)
- return -EOPNOTSUPP;
-
- /* Do not change tx_lpi_timer in case of failure */
- priv->tx_lpi_timer = edata->tx_lpi_timer;
- }
+ priv->tx_lpi_timer = edata->tx_lpi_timer;
+ priv->tx_lpi_enabled = edata->tx_lpi_enabled;
return phy_ethtool_set_eee(dev->phydev, edata);
}
@@ -230,7 +215,7 @@ static void sxgbe_get_ethtool_stats(struct net_device *dev,
int i;
char *p;
- if (priv->eee_enabled) {
+ if (dev->phydev->eee_active) {
int val = phy_get_eee_err(dev->phydev);
if (val)
@@ -119,18 +119,10 @@ static void sxgbe_eee_ctrl_timer(struct timer_list *t)
* phy can also manage EEE, so enable the LPI state and start the timer
* to verify if the tx path can enter in LPI state.
*/
-bool sxgbe_eee_init(struct sxgbe_priv_data * const priv)
+static void sxgbe_eee_init(struct sxgbe_priv_data * const priv)
{
- struct net_device *ndev = priv->dev;
- bool ret = false;
-
/* MAC core supports the EEE feature. */
if (priv->hw_cap.eee) {
- /* Check if the PHY supports EEE */
- if (phy_init_eee(ndev->phydev, true))
- return false;
-
- priv->eee_active = 1;
timer_setup(&priv->eee_ctrl_timer, sxgbe_eee_ctrl_timer, 0);
priv->eee_ctrl_timer.expires = SXGBE_LPI_TIMER(eee_timer);
add_timer(&priv->eee_ctrl_timer);
@@ -140,23 +132,16 @@ bool sxgbe_eee_init(struct sxgbe_priv_data * const priv)
priv->tx_lpi_timer);
pr_info("Energy-Efficient Ethernet initialized\n");
-
- ret = true;
}
-
- return ret;
}
-static void sxgbe_eee_adjust(const struct sxgbe_priv_data *priv)
+static void sxgbe_eee_adjust(const struct sxgbe_priv_data *priv,
+ bool eee_active)
{
- struct net_device *ndev = priv->dev;
-
- /* When the EEE has been already initialised we have to
- * modify the PLS bit in the LPI ctrl & status reg according
- * to the PHY link status. For this reason.
- */
- if (priv->eee_enabled)
- priv->hw->mac->set_eee_pls(priv->ioaddr, ndev->phydev->link);
+ if (priv->hw_cap.eee)
+ priv->hw->mac->set_eee_pls(priv->ioaddr,
+ eee_active && priv->tx_lpi_enabled);
+ phy_eee_clk_stop_enable(priv->dev->phydev);
}
/**
@@ -250,7 +235,7 @@ static void sxgbe_adjust_link(struct net_device *dev)
phy_print_status(phydev);
/* Alter the MAC settings for EEE */
- sxgbe_eee_adjust(priv);
+ sxgbe_eee_adjust(priv, phydev->eee_active);
}
/**
@@ -803,7 +788,7 @@ static void sxgbe_tx_all_clean(struct sxgbe_priv_data * const priv)
sxgbe_tx_queue_clean(tqueue);
}
- if ((priv->eee_enabled) && (!priv->tx_path_in_lpi_mode)) {
+ if (priv->hw_cap.eee && !priv->tx_path_in_lpi_mode) {
sxgbe_enable_eee_mode(priv);
mod_timer(&priv->eee_ctrl_timer, SXGBE_LPI_TIMER(eee_timer));
}
@@ -1181,7 +1166,7 @@ static int sxgbe_open(struct net_device *dev)
}
priv->tx_lpi_timer = SXGBE_DEFAULT_LPI_TIMER;
- priv->eee_enabled = sxgbe_eee_init(priv);
+ sxgbe_eee_init(priv);
napi_enable(&priv->napi);
netif_start_queue(dev);
@@ -1208,7 +1193,7 @@ static int sxgbe_release(struct net_device *dev)
{
struct sxgbe_priv_data *priv = netdev_priv(dev);
- if (priv->eee_enabled)
+ if (priv->hw_cap.eee)
del_timer_sync(&priv->eee_ctrl_timer);
/* Stop and disconnect the PHY */
The enabling/disabling of EEE in the MAC should happen as a result of auto negotiation. So rework sxgbe_eee_adjust() to take the result of negotiation into account. sxgbe_set_eee() now just stores LTI timer value and tx_lpi_enabled. Everything else is passed to phylib, so it can correctly setup the PHY. sxgbe_get_eee() relies on phylib doing most of the work, the MAC driver just adds the LTI timer value and tx_lpi_enabled. The hw_cap.eee is now used to control timers, rather than eee_enabled, which was wrongly being set based on the value of phy_init_eee() before auto-neg even completed. Signed-off-by: Andrew Lunn <andrew@lunn.ch> --- .../net/ethernet/samsung/sxgbe/sxgbe_common.h | 4 +- .../ethernet/samsung/sxgbe/sxgbe_ethtool.c | 23 ++---------- .../net/ethernet/samsung/sxgbe/sxgbe_main.c | 37 ++++++------------- 3 files changed, 16 insertions(+), 48 deletions(-)