From patchwork Wed Dec 20 20:35:35 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: =?utf-8?q?Jernej_=C5=A0krabec?= X-Patchwork-Id: 13500442 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 75E8BC3DA6E for ; Wed, 20 Dec 2023 20:36:50 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-ID:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=ddcKzah34gYcS5j31JdiFD+9mWxDWt6BdFHWf7pxy2U=; b=QJd+tjHnflWElq tO+E6pW1jIFiMTMbkBMzyYu/oJtJOtvWUaihWbYdSw8DTG/1vVGIJFDyGkXnCP8/waqGd1Kasd+e5 JtHgaI0ASh2OPRq25DgVWOxug+CFJO+aJb7g9P+JKxxa5LIuPRL4opOMSCMA6fHq03T3islU/Kqaa vTPh8yxxtlYMLO5YCpbGT28iJczYPkx1bunnE3BvEF6RxzWTYGPTx6mdFMDu+XWLNt2gEvuVgPLX8 0C8Wppu5H82RHgbZvk7XlHd8zxeuGPL0alYPDtX09pQR4LmuwXrLUkkl+zWTW6MZz7QAGccvNrXtP TDSHEhwXMMD8+PFC06JA==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.96 #2 (Red Hat Linux)) id 1rG3Il-000qv2-2X; Wed, 20 Dec 2023 20:36:23 +0000 Received: from mail-wm1-x32b.google.com ([2a00:1450:4864:20::32b]) by bombadil.infradead.org with esmtps (Exim 4.96 #2 (Red Hat Linux)) id 1rG3Id-000qry-1Q for linux-arm-kernel@lists.infradead.org; Wed, 20 Dec 2023 20:36:16 +0000 Received: by mail-wm1-x32b.google.com with SMTP id 5b1f17b1804b1-40d3bf30664so1138625e9.0 for ; Wed, 20 Dec 2023 12:36:12 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1703104571; x=1703709371; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=eIdMcgR1xN4ns0nq94SPlX3IQrW5ygmTO1oJeanhn+I=; b=P/rY7cMXDZYcwnSazN//bWLV7vcIrFU2RgoxVuG4pjgBYO5UB0gJCoHqo+X1wMNkst QHOvpfKgx3+r8dJARW3a9j4qjr/s494Sx8cW+XvZuB7/0SczpU8LxhS1IOxbXLfgXkHS UVB4KybF95POBKzR3pQ/xccn2eLsTUidDDjGM8QBzS9xr+fu6nUzYUVGhlJpegGU0l62 MDF3VzI0qexwPaJXvuQsp7vRbSs7iUKzdGnpKUEY71vOrsc5iSrg1uUobFZPkblxzJ7K 2GYUn3JwXODrHPVFn7VncjE2Xqo5Gr77U2/7bN71rJ84qliBcbwOeHu2f0mh5sRLpWA5 b9lw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1703104571; x=1703709371; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=eIdMcgR1xN4ns0nq94SPlX3IQrW5ygmTO1oJeanhn+I=; b=C6Nt2RnkAwWIJywTT+kZX0dGGvdFqsbEZ7q90AL6ezmphSjYLA/PCSFZq9zz4c4FHp ZKukC1fnqhksZvJmk8+FQdQJhcyWJ7NfFMsLQQ6HrVlFYpsGOQLGVpAUQCCpaVZbjC13 OD1qhFyEB2c9nfVERVtFVqORsVg1cnaaH2KD7kVrbjPI7g8ogDWW49qno5onHZ6hKHfz nl7+b0dxFuBtdmsT/jL+de0LPe4CNeqosEzGj07ZJAzK2vFxvZJo9qUUz9Xc+r0LcHWE oSSj8yjBuW0ozWoUk7Me0FbIGCkqTlwZf8KzszPZMpS3KMIW4cZy0S++u5MZVhLj+1M5 +W7Q== X-Gm-Message-State: AOJu0Ywx2ffXQF94YusHQT4NU8OrlvL2W3u5TvPNaHG/u7fhNN6sn+dU HudXqi34x2+PI5kcu3nc69o= X-Google-Smtp-Source: AGHT+IG/D8jv7xHts+zKw5KVQe0+21x1UOh0v3cWgYMqZaEVHW2LEgli3e1cqjEXDZ7JCD+2QIyOzQ== X-Received: by 2002:a05:600c:63c8:b0:40c:5528:b482 with SMTP id dx8-20020a05600c63c800b0040c5528b482mr160077wmb.11.1703104571397; Wed, 20 Dec 2023 12:36:11 -0800 (PST) Received: from localhost.localdomain (82-149-12-148.dynamic.telemach.net. [82.149.12.148]) by smtp.gmail.com with ESMTPSA id v14-20020a05600c444e00b0040c58e410a3sm8703224wmn.14.2023.12.20.12.36.10 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 20 Dec 2023 12:36:11 -0800 (PST) From: Jernej Skrabec To: robh+dt@kernel.org, krzysztof.kozlowski+dt@linaro.org, conor+dt@kernel.org, wens@csie.org, samuel@sholland.org, andrew@lunn.ch, hkallweit1@gmail.com, linux@armlinux.org.uk, davem@davemloft.net, edumazet@google.com, kuba@kernel.org, pabeni@redhat.com Cc: devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-sunxi@lists.linux.dev, linux-kernel@vger.kernel.org, netdev@vger.kernel.org, Corentin Labbe , Jernej Skrabec Subject: [PATCH v5 1/3] phy: handle optional regulator for PHY Date: Wed, 20 Dec 2023 21:35:35 +0100 Message-ID: <20231220203537.83479-2-jernej.skrabec@gmail.com> X-Mailer: git-send-email 2.43.0 In-Reply-To: <20231220203537.83479-1-jernej.skrabec@gmail.com> References: <20231220203537.83479-1-jernej.skrabec@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20231220_123615_482136_1BA5BCF3 X-CRM114-Status: GOOD ( 17.90 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Corentin Labbe Add handling of optional regulators for PHY. Regulators need to be enabled before PHY scanning, so MDIO bus initiate this task. Signed-off-by: Corentin Labbe Signed-off-by: Jernej Skrabec --- drivers/net/mdio/fwnode_mdio.c | 53 ++++++++++++++++++++++++++++++++-- drivers/net/phy/phy_device.c | 6 ++++ include/linux/phy.h | 3 ++ 3 files changed, 60 insertions(+), 2 deletions(-) diff --git a/drivers/net/mdio/fwnode_mdio.c b/drivers/net/mdio/fwnode_mdio.c index fd02f5cbc853..bd5a27eaf40c 100644 --- a/drivers/net/mdio/fwnode_mdio.c +++ b/drivers/net/mdio/fwnode_mdio.c @@ -11,6 +11,7 @@ #include #include #include +#include MODULE_AUTHOR("Calvin Johnson "); MODULE_LICENSE("GPL"); @@ -58,6 +59,40 @@ fwnode_find_mii_timestamper(struct fwnode_handle *fwnode) return register_mii_timestamper(arg.np, arg.args[0]); } +static int +fwnode_regulator_get_bulk_enabled(struct device *dev, + struct fwnode_handle *fwnode, + struct regulator_bulk_data **consumers) +{ + struct device_node *np; + int ret, reg_cnt; + + np = to_of_node(fwnode); + if (!np) + return 0; + + reg_cnt = of_regulator_bulk_get_all(dev, np, consumers); + if (reg_cnt < 0) { + ret = reg_cnt; + goto clean_consumers; + } + + if (reg_cnt == 0) + return 0; + + ret = regulator_bulk_enable(reg_cnt, *consumers); + if (ret) + goto clean_consumers; + + return reg_cnt; + +clean_consumers: + kfree(*consumers); + *consumers = NULL; + + return ret; +} + int fwnode_mdiobus_phy_device_register(struct mii_bus *mdio, struct phy_device *phy, struct fwnode_handle *child, u32 addr) @@ -113,12 +148,13 @@ EXPORT_SYMBOL(fwnode_mdiobus_phy_device_register); int fwnode_mdiobus_register_phy(struct mii_bus *bus, struct fwnode_handle *child, u32 addr) { + struct regulator_bulk_data *consumers = NULL; struct mii_timestamper *mii_ts = NULL; struct pse_control *psec = NULL; struct phy_device *phy; + int rc, reg_cnt; bool is_c45; u32 phy_id; - int rc; psec = fwnode_find_pse_control(child); if (IS_ERR(psec)) @@ -130,6 +166,12 @@ int fwnode_mdiobus_register_phy(struct mii_bus *bus, goto clean_pse; } + reg_cnt = fwnode_regulator_get_bulk_enabled(&bus->dev, child, &consumers); + if (reg_cnt < 0) { + rc = reg_cnt; + goto clean_mii_ts; + } + is_c45 = fwnode_device_is_compatible(child, "ethernet-phy-ieee802.3-c45"); if (is_c45 || fwnode_get_phy_id(child, &phy_id)) phy = get_phy_device(bus, addr, is_c45); @@ -137,9 +179,12 @@ int fwnode_mdiobus_register_phy(struct mii_bus *bus, phy = phy_device_create(bus, addr, phy_id, 0, NULL); if (IS_ERR(phy)) { rc = PTR_ERR(phy); - goto clean_mii_ts; + goto clean_regulators; } + phy->regulator_cnt = reg_cnt; + phy->consumers = consumers; + if (is_acpi_node(child)) { phy->irq = bus->irq[addr]; @@ -174,6 +219,10 @@ int fwnode_mdiobus_register_phy(struct mii_bus *bus, clean_phy: phy_device_free(phy); +clean_regulators: + if (reg_cnt > 0) + regulator_bulk_disable(reg_cnt, consumers); + kfree(consumers); clean_mii_ts: unregister_mii_timestamper(mii_ts); clean_pse: diff --git a/drivers/net/phy/phy_device.c b/drivers/net/phy/phy_device.c index 2ce74593d6e4..31b6913ceed1 100644 --- a/drivers/net/phy/phy_device.c +++ b/drivers/net/phy/phy_device.c @@ -31,6 +31,7 @@ #include #include #include +#include #include #include #include @@ -3400,6 +3401,11 @@ static int phy_remove(struct device *dev) phydev->drv = NULL; + if (phydev->regulator_cnt > 0) + regulator_bulk_disable(phydev->regulator_cnt, phydev->consumers); + + kfree(phydev->consumers); + return 0; } diff --git a/include/linux/phy.h b/include/linux/phy.h index 3cc52826f18e..832cb2d4f76a 100644 --- a/include/linux/phy.h +++ b/include/linux/phy.h @@ -757,6 +757,9 @@ struct phy_device { void (*phy_link_change)(struct phy_device *phydev, bool up); void (*adjust_link)(struct net_device *dev); + int regulator_cnt; + struct regulator_bulk_data *consumers; + #if IS_ENABLED(CONFIG_MACSEC) /* MACsec management functions */ const struct macsec_ops *macsec_ops;