1 // SPDX-License-Identifier: GPL-2.0-only
3  * Broadcom GENET (Gigabit Ethernet) Wake-on-LAN support
5  * Copyright (c) 2014-2024 Broadcom
37 /* ethtool function - get WOL (Wake on LAN) settings, Only Magic Packet
40 void bcmgenet_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)  in bcmgenet_get_wol()  argument
43 	struct device *kdev = &priv->pdev->dev;  in bcmgenet_get_wol()
45 	if (dev->phydev)  in bcmgenet_get_wol()
46 		phy_ethtool_get_wol(dev->phydev, wol);  in bcmgenet_get_wol()
48 	/* MAC is not wake-up capable, return what the PHY does */  in bcmgenet_get_wol()
52 	/* Overlay MAC capabilities with that of the PHY queried before */  in bcmgenet_get_wol()
53 	wol->supported |= WAKE_MAGIC | WAKE_MAGICSECURE | WAKE_FILTER;  in bcmgenet_get_wol()
54 	wol->wolopts = priv->wolopts;  in bcmgenet_get_wol()
55 	memset(wol->sopass, 0, sizeof(wol->sopass));  in bcmgenet_get_wol()
57 	if (wol->wolopts & WAKE_MAGICSECURE)  in bcmgenet_get_wol()
58 		memcpy(wol->sopass, priv->sopass, sizeof(priv->sopass));  in bcmgenet_get_wol()
61 /* ethtool function - set WOL (Wake on LAN) settings.
64 int bcmgenet_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)  in bcmgenet_set_wol()  argument
67 	struct device *kdev = &priv->pdev->dev;  in bcmgenet_set_wol()
70 	/* Try Wake-on-LAN from the PHY first */  in bcmgenet_set_wol()
71 	if (dev->phydev) {  in bcmgenet_set_wol()
72 		ret = phy_ethtool_set_wol(dev->phydev, wol);  in bcmgenet_set_wol()
73 		if (ret != -EOPNOTSUPP)  in bcmgenet_set_wol()
78 		return -ENOTSUPP;  in bcmgenet_set_wol()
80 	if (wol->wolopts & ~(WAKE_MAGIC | WAKE_MAGICSECURE | WAKE_FILTER))  in bcmgenet_set_wol()
81 		return -EINVAL;  in bcmgenet_set_wol()
83 	if (wol->wolopts & WAKE_MAGICSECURE)  in bcmgenet_set_wol()
84 		memcpy(priv->sopass, wol->sopass, sizeof(priv->sopass));  in bcmgenet_set_wol()
87 	if (wol->wolopts) {  in bcmgenet_set_wol()
90 		if (priv->wol_irq_disabled) {  in bcmgenet_set_wol()
91 			enable_irq_wake(priv->wol_irq);  in bcmgenet_set_wol()
92 			enable_irq_wake(priv->irq0);  in bcmgenet_set_wol()
94 		priv->wol_irq_disabled = false;  in bcmgenet_set_wol()
98 		if (!priv->wol_irq_disabled) {  in bcmgenet_set_wol()
99 			disable_irq_wake(priv->wol_irq);  in bcmgenet_set_wol()
100 			disable_irq_wake(priv->irq0);  in bcmgenet_set_wol()
102 		priv->wol_irq_disabled = true;  in bcmgenet_set_wol()
105 	priv->wolopts = wol->wolopts;  in bcmgenet_set_wol()
112 	struct net_device *dev = priv->dev;  in bcmgenet_poll_wol_status()
119 			netdev_crit(dev, "polling wol mode timeout\n");  in bcmgenet_poll_wol_status()
120 			return -ETIMEDOUT;  in bcmgenet_poll_wol_status()
130 	bcmgenet_umac_writel(priv, get_unaligned_be16(&priv->sopass[0]),  in bcmgenet_set_mpd_password()
132 	bcmgenet_umac_writel(priv, get_unaligned_be32(&priv->sopass[2]),  in bcmgenet_set_mpd_password()
139 	struct net_device *dev = priv->dev;  in bcmgenet_wol_power_down_cfg()
145 		netif_err(priv, wol, dev, "unsupported mode: %d\n", mode);  in bcmgenet_wol_power_down_cfg()
146 		return -EINVAL;  in bcmgenet_wol_power_down_cfg()
149 	/* Can't suspend with WoL if MAC is still in reset */  in bcmgenet_wol_power_down_cfg()
150 	spin_lock_bh(&priv->reg_lock);  in bcmgenet_wol_power_down_cfg()
158 	spin_unlock_bh(&priv->reg_lock);  in bcmgenet_wol_power_down_cfg()
161 	if (priv->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {  in bcmgenet_wol_power_down_cfg()
164 		if (priv->wolopts & WAKE_MAGICSECURE) {  in bcmgenet_wol_power_down_cfg()
172 	if (priv->wolopts & WAKE_FILTER) {  in bcmgenet_wol_power_down_cfg()
173 		list_for_each_entry(rule, &priv->rxnfc_list, list)  in bcmgenet_wol_power_down_cfg()
174 			if (rule->fs.ring_cookie == RX_CLS_FLOW_WAKE)  in bcmgenet_wol_power_down_cfg()
175 				hfb_enable |= (1 << rule->fs.location);  in bcmgenet_wol_power_down_cfg()
190 	netif_dbg(priv, wol, dev, "MPD WOL-ready status set after %d msec\n",  in bcmgenet_wol_power_down_cfg()
193 	clk_prepare_enable(priv->clk_wol);  in bcmgenet_wol_power_down_cfg()
194 	priv->wol_active = 1;  in bcmgenet_wol_power_down_cfg()
204 	spin_lock_bh(&priv->reg_lock);  in bcmgenet_wol_power_down_cfg()
206 	priv->crc_fwd_en = 1;  in bcmgenet_wol_power_down_cfg()
209 	/* Receiver must be enabled for WOL MP detection */  in bcmgenet_wol_power_down_cfg()
212 	spin_unlock_bh(&priv->reg_lock);  in bcmgenet_wol_power_down_cfg()
229 		netif_err(priv, wol, priv->dev, "invalid mode: %d\n", mode);  in bcmgenet_wol_power_up_cfg()
233 	if (!priv->wol_active)  in bcmgenet_wol_power_up_cfg()
236 	priv->wol_active = 0;  in bcmgenet_wol_power_up_cfg()
237 	clk_disable_unprepare(priv->clk_wol);  in bcmgenet_wol_power_up_cfg()
238 	priv->crc_fwd_en = 0;  in bcmgenet_wol_power_up_cfg()
241 	if (priv->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {  in bcmgenet_wol_power_up_cfg()
250 	if (priv->wolopts & WAKE_FILTER) {  in bcmgenet_wol_power_up_cfg()
259 	spin_lock_bh(&priv->reg_lock);  in bcmgenet_wol_power_up_cfg()
263 	spin_unlock_bh(&priv->reg_lock);  in bcmgenet_wol_power_up_cfg()