From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.1 (2015-04-28) on sa.local.altlinux.org X-Spam-Level: X-Spam-Status: No, score=-4.3 required=5.0 tests=ALL_TRUSTED,BAYES_00, RP_MATCHES_RCVD autolearn=ham autolearn_force=no version=3.4.1 From: Alexey Sheplyakov To: devel-kernel@lists.altlinux.org Date: Wed, 14 Dec 2022 17:19:18 +0400 Message-Id: <20221214131919.681481-31-asheplyakov@basealt.ru> X-Mailer: git-send-email 2.33.5 In-Reply-To: <20221214131919.681481-1-asheplyakov@basealt.ru> References: <20221214131919.681481-1-asheplyakov@basealt.ru> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Cc: =?UTF-8?q?=D0=A0=D0=BE=D0=BC=D0=B0=D0=BD=20=D0=A1=D1=82=D0=B0=D0=B2=D1=86=D0=B5=D0=B2?= , =?UTF-8?q?=D0=98=D0=B3=D0=BE=D1=80=D1=8C=20=D0=A7=D1=83=D0=B4=D0=BE=D0=B2?= , =?UTF-8?q?=D0=95=D0=B2=D0=B3=D0=B5=D0=BD=D0=B8=D0=B9=20=D0=A1=D0=B8=D0=BD=D0=B5=D0=BB=D1=8C=D0=BD=D0=B8=D0=BA=D0=BE=D0=B2?= , =?UTF-8?q?=D0=94=D0=BC=D0=B8=D1=82=D1=80=D0=B8=D0=B9=20=D0=A2=D0=B5=D1=80=D1=91=D1=85=D0=B8=D0=BD?= Subject: [d-kernel] [PATCH 31/32] phy: realtek: leds configuration for RTL8211f X-BeenThere: devel-kernel@lists.altlinux.org X-Mailman-Version: 2.1.12 Precedence: list Reply-To: ALT Linux kernel packages development List-Id: ALT Linux kernel packages development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , X-List-Received-Date: Wed, 14 Dec 2022 13:20:37 -0000 Archived-At: List-Archive: List-Post: Configure leds according to 'realtek,led-mode', 'realtek,led[0-2]-control' knobs (specified in DTB). Note that *all* of these parameters must be set in DTB for this to work. See https://my.basealt.space/issues/85133 X-feature-Baikal-M DONTUPSTREAM --- drivers/net/phy/realtek.c | 55 +++++++++++++++++++ .../dt-bindings/net/realtek-phy-rtl8211f.h | 26 +++++++++ 2 files changed, 81 insertions(+) create mode 100644 include/dt-bindings/net/realtek-phy-rtl8211f.h diff --git a/drivers/net/phy/realtek.c b/drivers/net/phy/realtek.c index 3d99fd6664d7..dd343b07ec8d 100644 --- a/drivers/net/phy/realtek.c +++ b/drivers/net/phy/realtek.c @@ -9,6 +9,7 @@ */ #include #include +#include #include #include #include @@ -30,6 +31,7 @@ #define RTL8211F_PHYCR1 0x18 #define RTL8211F_PHYCR2 0x19 #define RTL8211F_INSR 0x1d +#define RTL8211F_LCR 0x10 #define RTL8211F_TX_DELAY BIT(8) #define RTL8211F_RX_DELAY BIT(3) @@ -328,6 +330,56 @@ static int rtl8211_config_aneg(struct phy_device *phydev) return 0; } +static void rtl8211f_config_led(struct phy_device *phydev) +{ + struct device *dev = &phydev->mdio.dev; + struct device_node *of_node = dev->of_node; + u16 val; + u32 led_mode, led0_ctrl, led1_ctrl, led2_ctrl; + int ret; + + ret = of_property_read_u32(of_node, "realtek,led-mode", &led_mode); + if (ret < 0) { + dev_dbg(dev, "refusing to reconfigure leds: no 'realtek,led-mode' in dtb\n"); + return; + } + ret = of_property_read_u32(of_node, "realtek,led0-control", &led0_ctrl); + if (ret < 0) { + dev_dbg(dev, "refusing to reconfigure leds: no 'realtek,led0-control' in dtb\n"); + return; + } + ret = of_property_read_u32(of_node, "realtek,led1-control", &led1_ctrl); + if (ret < 0) { + dev_dbg(dev, "refusing to reconfigure leds: no 'realtek,led1-control' in dtb\n"); + return; + } + ret = of_property_read_u32(of_node, "realtek,led2-control", &led2_ctrl); + if (ret < 0) { + dev_dbg(dev, "refusing to reconfigure leds: no 'realtek,led-control' in dtb\n"); + return; + } + + val = (led_mode << 15) | (led2_ctrl << 10) | + (led1_ctrl << 5) | led0_ctrl; + + ret = phy_write_paged(phydev, 0xd04, RTL8211F_LCR, val); + if (ret < 0) + dev_dbg(dev, "Failed to update the LED control register\n"); +} + +static int rtl8211f_config_aneg(struct phy_device *phydev) +{ + int ret; + + rtl8211f_config_led(phydev); + + ret = genphy_config_aneg(phydev); + if (ret < 0) + return ret; + + return 0; +} + static int rtl8211c_config_init(struct phy_device *phydev) { /* RTL8211C has an issue when operating in Gigabit slave mode */ @@ -342,6 +394,8 @@ static int rtl8211f_config_init(struct phy_device *phydev) u16 val_txdly, val_rxdly; int ret; + rtl8211f_config_led(phydev); + ret = phy_modify_paged_changed(phydev, 0xa43, RTL8211F_PHYCR1, RTL8211F_ALDPS_PLL_OFF | RTL8211F_ALDPS_ENABLE | RTL8211F_ALDPS_XTAL_OFF, priv->phycr1); @@ -923,6 +977,7 @@ static struct phy_driver realtek_drvs[] = { PHY_ID_MATCH_EXACT(0x001cc916), .name = "RTL8211F Gigabit Ethernet", .probe = rtl821x_probe, + .config_aneg = rtl8211f_config_aneg, .config_init = &rtl8211f_config_init, .read_status = rtlgen_read_status, .config_intr = &rtl8211f_config_intr, diff --git a/include/dt-bindings/net/realtek-phy-rtl8211f.h b/include/dt-bindings/net/realtek-phy-rtl8211f.h new file mode 100644 index 000000000000..46d17644119d --- /dev/null +++ b/include/dt-bindings/net/realtek-phy-rtl8211f.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#ifndef _DT_BINDINGS_REALTEK_PHY_RTL8211F_H +#define _DT_BINDINGS_REALTEK_PHY_RTL8211F_H + +/* LED modes for RTL8211F PHY */ + +#define RTL8211F_LED_MODE_A 0 +#define RTL8211F_LED_MODE_B 1 + +#define RTL8211F_LINK_10 1 +#define RTL8211F_LINK_100 2 +#define RTL8211F_LINK_10_100 3 +#define RTL8211F_LINK_1000 8 +#define RTL8211F_LINK_10_1000 9 +#define RTL8211F_LINK_100_1000 10 +#define RTL8211F_LINK_10_100_1000 11 +#define RTL8211F_ACTIVITY 16 +#define RTL8211F_LINK_10_ACTIVITY 17 +#define RTL8211F_LINK_100_ACTIVITY 18 +#define RTL8211F_LINK_10_100_ACTIVITY 19 +#define RTL8211F_LINK_1000_ACTIVITY 24 +#define RTL8211F_LINK_10_1000_ACTIVITY 25 +#define RTL8211F_LINK_100_1000_ACTIVITY 26 +#define RTL8211F_LINK_10_100_1000_ACTIVITY 27 + +#endif -- 2.33.5