mirror of
https://github.com/torvalds/linux.git
synced 2026-07-31 11:37:06 +02:00
net: freescale: ucc_geth: Fix WOL configuration
The get/set_wol ethtool ops rely on querying the PHY for its WoL capabilities, checking for the presence of a PHY and a PHY interrupts isn't enough. Address that by cleaning up the WoL configuration sequence. Signed-off-by: Maxime Chevallier <maxime.chevallier@bootlin.com> Reviewed-by: Andrew Lunn <andrew@lunn.ch> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
43068024cc
commit
d2adc441a1
|
|
@ -3413,11 +3413,11 @@ static int ucc_geth_suspend(struct platform_device *ofdev, pm_message_t state)
|
|||
*/
|
||||
ugeth_disable(ugeth, COMM_DIR_RX_AND_TX);
|
||||
|
||||
if (ugeth->wol_en & WAKE_MAGIC) {
|
||||
if (ugeth->wol_en & WAKE_MAGIC && !ugeth->phy_wol_en) {
|
||||
setbits32(ugeth->uccf->p_uccm, UCC_GETH_UCCE_MPD);
|
||||
setbits32(&ugeth->ug_regs->maccfg2, MACCFG2_MPE);
|
||||
ucc_fast_enable(ugeth->uccf, COMM_DIR_RX_AND_TX);
|
||||
} else if (!(ugeth->wol_en & WAKE_PHY)) {
|
||||
} else if (!ugeth->phy_wol_en) {
|
||||
phy_stop(ndev->phydev);
|
||||
}
|
||||
|
||||
|
|
|
|||
|
|
@ -1217,6 +1217,7 @@ struct ucc_geth_private {
|
|||
int oldduplex;
|
||||
int oldlink;
|
||||
int wol_en;
|
||||
u32 phy_wol_en;
|
||||
|
||||
struct device_node *node;
|
||||
};
|
||||
|
|
|
|||
|
|
@ -346,26 +346,48 @@ static void uec_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
|
|||
struct ucc_geth_private *ugeth = netdev_priv(netdev);
|
||||
struct phy_device *phydev = netdev->phydev;
|
||||
|
||||
if (phydev && phydev->irq)
|
||||
wol->supported |= WAKE_PHY;
|
||||
wol->supported = 0;
|
||||
wol->wolopts = 0;
|
||||
|
||||
if (phydev)
|
||||
phy_ethtool_get_wol(phydev, wol);
|
||||
|
||||
if (qe_alive_during_sleep())
|
||||
wol->supported |= WAKE_MAGIC;
|
||||
|
||||
wol->wolopts = ugeth->wol_en;
|
||||
wol->wolopts |= ugeth->wol_en;
|
||||
}
|
||||
|
||||
static int uec_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
|
||||
{
|
||||
struct ucc_geth_private *ugeth = netdev_priv(netdev);
|
||||
struct phy_device *phydev = netdev->phydev;
|
||||
int ret = 0;
|
||||
|
||||
if (wol->wolopts & ~(WAKE_PHY | WAKE_MAGIC))
|
||||
return -EINVAL;
|
||||
else if (wol->wolopts & WAKE_PHY && (!phydev || !phydev->irq))
|
||||
return -EINVAL;
|
||||
else if (wol->wolopts & WAKE_MAGIC && !qe_alive_during_sleep())
|
||||
if (phydev) {
|
||||
ret = phy_ethtool_set_wol(phydev, wol);
|
||||
if (ret == -EOPNOTSUPP) {
|
||||
ugeth->phy_wol_en = 0;
|
||||
} else if (ret) {
|
||||
return ret;
|
||||
} else {
|
||||
ugeth->phy_wol_en = wol->wolopts;
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
|
||||
/* If the PHY isn't handling the WoL and the MAC is asked to more than
|
||||
* WAKE_MAGIC, error-out
|
||||
*/
|
||||
if (!ugeth->phy_wol_en &&
|
||||
wol->wolopts & ~WAKE_MAGIC)
|
||||
return -EINVAL;
|
||||
|
||||
if (wol->wolopts & WAKE_MAGIC &&
|
||||
!qe_alive_during_sleep())
|
||||
return -EINVAL;
|
||||
|
||||
out:
|
||||
ugeth->wol_en = wol->wolopts;
|
||||
device_set_wakeup_enable(&netdev->dev, ugeth->wol_en);
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user