Lines Matching +full:mode +full:- +full:reg
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
43 struct device *kdev = &priv->pdev->dev; in bcmgenet_get_wol()
46 if (dev->phydev) { in bcmgenet_get_wol()
47 phy_ethtool_get_wol(dev->phydev, wol); in bcmgenet_get_wol()
48 phy_wolopts = wol->wolopts; in bcmgenet_get_wol()
51 /* MAC is not wake-up capable, return what the PHY does */ in bcmgenet_get_wol()
56 wol->supported |= WAKE_MAGIC | WAKE_MAGICSECURE | WAKE_FILTER; in bcmgenet_get_wol()
57 wol->wolopts |= priv->wolopts; in bcmgenet_get_wol()
64 memset(wol->sopass, 0, sizeof(wol->sopass)); in bcmgenet_get_wol()
65 if (wol->wolopts & WAKE_MAGICSECURE) in bcmgenet_get_wol()
66 memcpy(wol->sopass, priv->sopass, sizeof(priv->sopass)); in bcmgenet_get_wol()
69 /* ethtool function - set WOL (Wake on LAN) settings.
70 * Only for magic packet detection mode.
75 struct device *kdev = &priv->pdev->dev; in bcmgenet_set_wol()
78 /* Try Wake-on-LAN from the PHY first */ in bcmgenet_set_wol()
79 if (dev->phydev) { in bcmgenet_set_wol()
80 ret = phy_ethtool_set_wol(dev->phydev, wol); in bcmgenet_set_wol()
81 if (ret != -EOPNOTSUPP && wol->wolopts) in bcmgenet_set_wol()
86 return -ENOTSUPP; in bcmgenet_set_wol()
88 if (wol->wolopts & ~(WAKE_MAGIC | WAKE_MAGICSECURE | WAKE_FILTER)) in bcmgenet_set_wol()
89 return -EINVAL; in bcmgenet_set_wol()
91 if (wol->wolopts & WAKE_MAGICSECURE) in bcmgenet_set_wol()
92 memcpy(priv->sopass, wol->sopass, sizeof(priv->sopass)); in bcmgenet_set_wol()
95 if (wol->wolopts) { in bcmgenet_set_wol()
98 if (priv->wol_irq_disabled) { in bcmgenet_set_wol()
99 enable_irq_wake(priv->wol_irq); in bcmgenet_set_wol()
100 enable_irq_wake(priv->irq0); in bcmgenet_set_wol()
102 priv->wol_irq_disabled = false; in bcmgenet_set_wol()
106 if (!priv->wol_irq_disabled) { in bcmgenet_set_wol()
107 disable_irq_wake(priv->wol_irq); in bcmgenet_set_wol()
108 disable_irq_wake(priv->irq0); in bcmgenet_set_wol()
110 priv->wol_irq_disabled = true; in bcmgenet_set_wol()
113 priv->wolopts = wol->wolopts; in bcmgenet_set_wol()
120 struct net_device *dev = priv->dev; in bcmgenet_poll_wol_status()
127 netdev_crit(dev, "polling wol mode timeout\n"); in bcmgenet_poll_wol_status()
128 return -ETIMEDOUT; in bcmgenet_poll_wol_status()
138 bcmgenet_umac_writel(priv, get_unaligned_be16(&priv->sopass[0]), in bcmgenet_set_mpd_password()
140 bcmgenet_umac_writel(priv, get_unaligned_be32(&priv->sopass[2]), in bcmgenet_set_mpd_password()
145 enum bcmgenet_power_mode mode) in bcmgenet_wol_power_down_cfg() argument
147 struct net_device *dev = priv->dev; in bcmgenet_wol_power_down_cfg()
149 u32 reg, hfb_ctrl_reg, hfb_enable = 0; in bcmgenet_wol_power_down_cfg() local
152 if (mode != GENET_POWER_WOL_MAGIC) { in bcmgenet_wol_power_down_cfg()
153 netif_err(priv, wol, dev, "unsupported mode: %d\n", mode); in bcmgenet_wol_power_down_cfg()
154 return -EINVAL; in bcmgenet_wol_power_down_cfg()
158 spin_lock_bh(&priv->reg_lock); in bcmgenet_wol_power_down_cfg()
159 reg = bcmgenet_umac_readl(priv, UMAC_CMD); in bcmgenet_wol_power_down_cfg()
160 if (reg & CMD_SW_RESET) in bcmgenet_wol_power_down_cfg()
161 reg &= ~CMD_SW_RESET; in bcmgenet_wol_power_down_cfg()
164 reg &= ~CMD_RX_EN; in bcmgenet_wol_power_down_cfg()
165 bcmgenet_umac_writel(priv, reg, UMAC_CMD); in bcmgenet_wol_power_down_cfg()
166 spin_unlock_bh(&priv->reg_lock); in bcmgenet_wol_power_down_cfg()
169 if (priv->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) { in bcmgenet_wol_power_down_cfg()
170 reg = bcmgenet_umac_readl(priv, UMAC_MPD_CTRL); in bcmgenet_wol_power_down_cfg()
171 reg |= MPD_EN; in bcmgenet_wol_power_down_cfg()
172 if (priv->wolopts & WAKE_MAGICSECURE) { in bcmgenet_wol_power_down_cfg()
174 reg |= MPD_PW_EN; in bcmgenet_wol_power_down_cfg()
176 bcmgenet_umac_writel(priv, reg, UMAC_MPD_CTRL); in bcmgenet_wol_power_down_cfg()
180 if (priv->wolopts & WAKE_FILTER) { in bcmgenet_wol_power_down_cfg()
181 list_for_each_entry(rule, &priv->rxnfc_list, list) in bcmgenet_wol_power_down_cfg()
182 if (rule->fs.ring_cookie == RX_CLS_FLOW_WAKE) in bcmgenet_wol_power_down_cfg()
183 hfb_enable |= (1 << rule->fs.location); in bcmgenet_wol_power_down_cfg()
184 reg = (hfb_ctrl_reg & ~RBUF_HFB_EN) | RBUF_ACPI_EN; in bcmgenet_wol_power_down_cfg()
185 bcmgenet_hfb_reg_writel(priv, reg, HFB_CTRL); in bcmgenet_wol_power_down_cfg()
188 /* Do not leave UniMAC in MPD mode only */ in bcmgenet_wol_power_down_cfg()
191 reg = bcmgenet_umac_readl(priv, UMAC_MPD_CTRL); in bcmgenet_wol_power_down_cfg()
192 reg &= ~(MPD_EN | MPD_PW_EN); in bcmgenet_wol_power_down_cfg()
193 bcmgenet_umac_writel(priv, reg, UMAC_MPD_CTRL); in bcmgenet_wol_power_down_cfg()
198 netif_dbg(priv, wol, dev, "MPD WOL-ready status set after %d msec\n", in bcmgenet_wol_power_down_cfg()
201 clk_prepare_enable(priv->clk_wol); in bcmgenet_wol_power_down_cfg()
202 priv->wol_active = 1; in bcmgenet_wol_power_down_cfg()
212 spin_lock_bh(&priv->reg_lock); in bcmgenet_wol_power_down_cfg()
213 reg = bcmgenet_umac_readl(priv, UMAC_CMD); in bcmgenet_wol_power_down_cfg()
214 priv->crc_fwd_en = 1; in bcmgenet_wol_power_down_cfg()
215 reg |= CMD_CRC_FWD; in bcmgenet_wol_power_down_cfg()
218 reg |= CMD_RX_EN; in bcmgenet_wol_power_down_cfg()
219 bcmgenet_umac_writel(priv, reg, UMAC_CMD); in bcmgenet_wol_power_down_cfg()
220 spin_unlock_bh(&priv->reg_lock); in bcmgenet_wol_power_down_cfg()
222 reg = UMAC_IRQ_MPD_R; in bcmgenet_wol_power_down_cfg()
224 reg |= UMAC_IRQ_HFB_SM | UMAC_IRQ_HFB_MM; in bcmgenet_wol_power_down_cfg()
226 bcmgenet_intrl2_0_writel(priv, reg, INTRL2_CPU_MASK_CLEAR); in bcmgenet_wol_power_down_cfg()
232 enum bcmgenet_power_mode mode) in bcmgenet_wol_power_up_cfg() argument
234 u32 reg; in bcmgenet_wol_power_up_cfg() local
236 if (mode != GENET_POWER_WOL_MAGIC) { in bcmgenet_wol_power_up_cfg()
237 netif_err(priv, wol, priv->dev, "invalid mode: %d\n", mode); in bcmgenet_wol_power_up_cfg()
241 if (!priv->wol_active) in bcmgenet_wol_power_up_cfg()
244 priv->wol_active = 0; in bcmgenet_wol_power_up_cfg()
245 clk_disable_unprepare(priv->clk_wol); in bcmgenet_wol_power_up_cfg()
246 priv->crc_fwd_en = 0; in bcmgenet_wol_power_up_cfg()
249 if (priv->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) { in bcmgenet_wol_power_up_cfg()
250 reg = bcmgenet_umac_readl(priv, UMAC_MPD_CTRL); in bcmgenet_wol_power_up_cfg()
251 if (!(reg & MPD_EN)) in bcmgenet_wol_power_up_cfg()
253 reg &= ~(MPD_EN | MPD_PW_EN); in bcmgenet_wol_power_up_cfg()
254 bcmgenet_umac_writel(priv, reg, UMAC_MPD_CTRL); in bcmgenet_wol_power_up_cfg()
258 if (priv->wolopts & WAKE_FILTER) { in bcmgenet_wol_power_up_cfg()
259 reg = bcmgenet_hfb_reg_readl(priv, HFB_CTRL); in bcmgenet_wol_power_up_cfg()
260 if (!(reg & RBUF_ACPI_EN)) in bcmgenet_wol_power_up_cfg()
262 reg &= ~(RBUF_HFB_EN | RBUF_ACPI_EN); in bcmgenet_wol_power_up_cfg()
263 bcmgenet_hfb_reg_writel(priv, reg, HFB_CTRL); in bcmgenet_wol_power_up_cfg()
267 spin_lock_bh(&priv->reg_lock); in bcmgenet_wol_power_up_cfg()
268 reg = bcmgenet_umac_readl(priv, UMAC_CMD); in bcmgenet_wol_power_up_cfg()
269 reg &= ~CMD_CRC_FWD; in bcmgenet_wol_power_up_cfg()
270 bcmgenet_umac_writel(priv, reg, UMAC_CMD); in bcmgenet_wol_power_up_cfg()
271 spin_unlock_bh(&priv->reg_lock); in bcmgenet_wol_power_up_cfg()