mirror of
https://github.com/coolsnowwolf/lede.git
synced 2025-06-08 11:32:05 +08:00
127 lines
4.2 KiB
Diff
127 lines
4.2 KiB
Diff
From 7840e4d6f48a75413470935ebdc4bab4fc0c035e Mon Sep 17 00:00:00 2001
|
|
From: Daniel Braunwarth <daniel.braunwarth@kuka.com>
|
|
Date: Tue, 29 Apr 2025 13:33:37 +0200
|
|
Subject: [PATCH] net: phy: realtek: Add support for WOL magic packet on
|
|
RTL8211F
|
|
|
|
The RTL8211F supports multiple WOL modes. This patch adds support for
|
|
magic packets.
|
|
|
|
The PHY notifies the system via the INTB/PMEB pin when a WOL event
|
|
occurs.
|
|
|
|
Signed-off-by: Daniel Braunwarth <daniel.braunwarth@kuka.com>
|
|
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
|
|
Link: https://patch.msgid.link/20250429-realtek_wol-v2-1-8f84def1ef2c@kuka.com
|
|
Signed-off-by: Jakub Kicinski <kuba@kernel.org>
|
|
---
|
|
drivers/net/phy/realtek/realtek_main.c | 69 ++++++++++++++++++++++++++
|
|
1 file changed, 69 insertions(+)
|
|
|
|
--- a/drivers/net/phy/realtek/realtek_main.c
|
|
+++ b/drivers/net/phy/realtek/realtek_main.c
|
|
@@ -10,6 +10,7 @@
|
|
#include <linux/bitops.h>
|
|
#include <linux/of.h>
|
|
#include <linux/phy.h>
|
|
+#include <linux/netdevice.h>
|
|
#include <linux/module.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/clk.h>
|
|
@@ -38,6 +39,24 @@
|
|
|
|
#define RTL8211F_INSR 0x1d
|
|
|
|
+/* RTL8211F WOL interrupt configuration */
|
|
+#define RTL8211F_INTBCR_PAGE 0xd40
|
|
+#define RTL8211F_INTBCR 0x16
|
|
+#define RTL8211F_INTBCR_INTB_PMEB BIT(5)
|
|
+
|
|
+/* RTL8211F WOL settings */
|
|
+#define RTL8211F_WOL_SETTINGS_PAGE 0xd8a
|
|
+#define RTL8211F_WOL_SETTINGS_EVENTS 16
|
|
+#define RTL8211F_WOL_EVENT_MAGIC BIT(12)
|
|
+#define RTL8211F_WOL_SETTINGS_STATUS 17
|
|
+#define RTL8211F_WOL_STATUS_RESET (BIT(15) | 0x1fff)
|
|
+
|
|
+/* RTL8211F Unique phyiscal and multicast address (WOL) */
|
|
+#define RTL8211F_PHYSICAL_ADDR_PAGE 0xd8c
|
|
+#define RTL8211F_PHYSICAL_ADDR_WORD0 16
|
|
+#define RTL8211F_PHYSICAL_ADDR_WORD1 17
|
|
+#define RTL8211F_PHYSICAL_ADDR_WORD2 18
|
|
+
|
|
#define RTL8211F_LEDCR 0x10
|
|
#define RTL8211F_LEDCR_MODE BIT(15)
|
|
#define RTL8211F_LEDCR_ACT_TXRX BIT(4)
|
|
@@ -123,6 +142,7 @@ struct rtl821x_priv {
|
|
u16 phycr2;
|
|
bool has_phycr2;
|
|
struct clk *clk;
|
|
+ u32 saved_wolopts;
|
|
};
|
|
|
|
static int rtl821x_read_page(struct phy_device *phydev)
|
|
@@ -354,6 +374,53 @@ static irqreturn_t rtl8211f_handle_inter
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
+static void rtl8211f_get_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
|
|
+{
|
|
+ wol->supported = WAKE_MAGIC;
|
|
+ if (phy_read_paged(dev, RTL8211F_WOL_SETTINGS_PAGE, RTL8211F_WOL_SETTINGS_EVENTS)
|
|
+ & RTL8211F_WOL_EVENT_MAGIC)
|
|
+ wol->wolopts = WAKE_MAGIC;
|
|
+}
|
|
+
|
|
+static int rtl8211f_set_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
|
|
+{
|
|
+ const u8 *mac_addr = dev->attached_dev->dev_addr;
|
|
+ int oldpage;
|
|
+
|
|
+ oldpage = phy_save_page(dev);
|
|
+ if (oldpage < 0)
|
|
+ goto err;
|
|
+
|
|
+ if (wol->wolopts & WAKE_MAGIC) {
|
|
+ /* Store the device address for the magic packet */
|
|
+ rtl821x_write_page(dev, RTL8211F_PHYSICAL_ADDR_PAGE);
|
|
+ __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD0, mac_addr[1] << 8 | (mac_addr[0]));
|
|
+ __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD1, mac_addr[3] << 8 | (mac_addr[2]));
|
|
+ __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD2, mac_addr[5] << 8 | (mac_addr[4]));
|
|
+
|
|
+ /* Enable magic packet matching and reset WOL status */
|
|
+ rtl821x_write_page(dev, RTL8211F_WOL_SETTINGS_PAGE);
|
|
+ __phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, RTL8211F_WOL_EVENT_MAGIC);
|
|
+ __phy_write(dev, RTL8211F_WOL_SETTINGS_STATUS, RTL8211F_WOL_STATUS_RESET);
|
|
+
|
|
+ /* Enable the WOL interrupt */
|
|
+ rtl821x_write_page(dev, RTL8211F_INTBCR_PAGE);
|
|
+ __phy_set_bits(dev, RTL8211F_INTBCR, RTL8211F_INTBCR_INTB_PMEB);
|
|
+ } else {
|
|
+ /* Disable the WOL interrupt */
|
|
+ rtl821x_write_page(dev, RTL8211F_INTBCR_PAGE);
|
|
+ __phy_clear_bits(dev, RTL8211F_INTBCR, RTL8211F_INTBCR_INTB_PMEB);
|
|
+
|
|
+ /* Disable magic packet matching and reset WOL status */
|
|
+ rtl821x_write_page(dev, RTL8211F_WOL_SETTINGS_PAGE);
|
|
+ __phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, 0);
|
|
+ __phy_write(dev, RTL8211F_WOL_SETTINGS_STATUS, RTL8211F_WOL_STATUS_RESET);
|
|
+ }
|
|
+
|
|
+err:
|
|
+ return phy_restore_page(dev, oldpage, 0);
|
|
+}
|
|
+
|
|
static int rtl8211_config_aneg(struct phy_device *phydev)
|
|
{
|
|
int ret;
|
|
@@ -1400,6 +1467,8 @@ static struct phy_driver realtek_drvs[]
|
|
.read_status = rtlgen_read_status,
|
|
.config_intr = &rtl8211f_config_intr,
|
|
.handle_interrupt = rtl8211f_handle_interrupt,
|
|
+ .set_wol = rtl8211f_set_wol,
|
|
+ .get_wol = rtl8211f_get_wol,
|
|
.suspend = rtl821x_suspend,
|
|
.resume = rtl821x_resume,
|
|
.read_page = rtl821x_read_page,
|