From nobody Tue Sep 16 08:47:30 2025 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 vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id D6BA5C61DB3 for ; Fri, 6 Jan 2023 18:45:37 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S235946AbjAFSpg (ORCPT ); Fri, 6 Jan 2023 13:45:36 -0500 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:36728 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S235916AbjAFSpa (ORCPT ); Fri, 6 Jan 2023 13:45:30 -0500 Received: from mail-ed1-x52c.google.com (mail-ed1-x52c.google.com [IPv6:2a00:1450:4864:20::52c]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 380DF81130; Fri, 6 Jan 2023 10:45:29 -0800 (PST) Received: by mail-ed1-x52c.google.com with SMTP id v30so3407602edb.9; Fri, 06 Jan 2023 10:45:29 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20210112; h=in-reply-to:content-disposition:mime-version:references:message-id :subject:cc:to:from:date:from:to:cc:subject:date:message-id:reply-to; bh=lXdQJuCgdcK3bFq0qc/kkXKb90RrNwHuu1s1i0Cf6y0=; b=pkkjbDTEs5OPeJHNl7lopR5cJliet1dXU5MEDth36HzMdx5NlzPP/49vO/w/hr+AWw tHXSiNMNjn2q6eC2f2BGcHfkI2tP9WQn07Zn4IjbBfs5Q5BC1uMQlDv4dC54znUzzSMc wUre2tFjuikAcpgJgdeIVdY+iSJt5dsQsUwnvW74Wottoi8VTl33uJSsV5g+Y2rOut0m gB2QEpfeKJZnFsrlvSVNIgnWid/p15a5IcDq0Cp/5CxCnC2WHFionqqRCs7JkDF0+gzN nge8pLB8rH0fhXB6oUcikv5cZ9tg8hp97s/Rhd4t0flJjRQKbnLwBfB6bHeaVz4blVhb 8jdw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=in-reply-to:content-disposition:mime-version:references:message-id :subject:cc:to:from:date:x-gm-message-state:from:to:cc:subject:date :message-id:reply-to; bh=lXdQJuCgdcK3bFq0qc/kkXKb90RrNwHuu1s1i0Cf6y0=; b=wxkaKXsbtVGY5qtNNSmlcNwCaoEW//4XvS0/VEoAqErbCD+5qppTglmi9KGveFqmph Z4xDnEEtYfQvAJ63g1dvNjWPaG8ZB+ahWcB+OfG3Airn42z73ntS07dg9/2L0Dnmq/5z /YcVOq8FNVHWWQbtBz69NHL3joLzy+hXOAM5Swv+fk3JxRfdnrMubF/ReUhn5Hf6tXlI 43lRWGx69McMct+kKjuZmzOx2Y12tUDd3SfwHrnYIPRBQzfwb9rk3+6PfJZb7eOdL+zK wwtXC2NThuikS9flmulTzyhyAQLbgi2XOxa/T4N0ZnoPfnya3yn42ExQlQ3ULOE5+Xm2 lkBg== X-Gm-Message-State: AFqh2kr7H3qWs13mccBUZ1Nm4nEja76AUo9mBc+xJxn3ogH+Qp2WuH8w xzTX8l7cgdqDxH6xOVNLmKk= X-Google-Smtp-Source: AMrXdXsxYp71cqii8He3bFE07AvichCS3lwzvyxT9pW4/civf4Cu9Ra4OpcMg7ujjmM3mDu6j+H7nA== X-Received: by 2002:a05:6402:206c:b0:47c:30aa:ae0e with SMTP id bd12-20020a056402206c00b0047c30aaae0emr47561141edb.11.1673030727657; Fri, 06 Jan 2023 10:45:27 -0800 (PST) Received: from gvm01 ([91.199.164.40]) by smtp.gmail.com with ESMTPSA id f9-20020a056402068900b0048999d127e0sm716044edy.86.2023.01.06.10.45.25 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 06 Jan 2023 10:45:27 -0800 (PST) Date: Fri, 6 Jan 2023 19:45:21 +0100 From: Piergiorgio Beruto To: Andrew Lunn , Heiner Kallweit , Russell King , "David S. Miller" , Eric Dumazet , Jakub Kicinski , Paolo Abeni Cc: linux-kernel@vger.kernel.org, netdev@vger.kernel.org, Oleksij Rempel , mailhol.vincent@wanadoo.fr, sudheer.mogilappagari@intel.com, sbhatta@marvell.com, linux-doc@vger.kernel.org, wangjie125@huawei.com, corbet@lwn.net, lkp@intel.com, gal@nvidia.com, gustavoars@kernel.org Subject: [PATCH v2 net-next 4/5] drivers/net/phy: add helpers to get/set PLCA configuration Message-ID: <35720efb893ac9ae2667110d4c2dc2828e9d4222.1673030528.git.piergiorgio.beruto@gmail.com> References: MIME-Version: 1.0 Content-Disposition: inline In-Reply-To: Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Transfer-Encoding: quoted-printable Content-Type: text/plain; charset="utf-8" This patch adds support in phylib to read/write PLCA configuration for Ethernet PHYs that support the OPEN Alliance "10BASE-T1S PLCA Management Registers" specifications. These can be found at https://www.opensig.org/about/specifications/ Signed-off-by: Piergiorgio Beruto --- MAINTAINERS | 1 + drivers/net/phy/mdio-open-alliance.h | 46 +++++++ drivers/net/phy/phy-c45.c | 183 +++++++++++++++++++++++++++ include/linux/phy.h | 6 + 4 files changed, 236 insertions(+) create mode 100644 drivers/net/phy/mdio-open-alliance.h diff --git a/MAINTAINERS b/MAINTAINERS index 8faa15c360e3..4356382ad57c 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -16617,6 +16617,7 @@ PLCA RECONCILIATION SUBLAYER (IEEE802.3 Clause 148) M: Piergiorgio Beruto L: netdev@vger.kernel.org S: Maintained +F: drivers/net/phy/mdio-open-alliance.h F: net/ethtool/plca.c =20 PLDMFW LIBRARY diff --git a/drivers/net/phy/mdio-open-alliance.h b/drivers/net/phy/mdio-op= en-alliance.h new file mode 100644 index 000000000000..931e14660d75 --- /dev/null +++ b/drivers/net/phy/mdio-open-alliance.h @@ -0,0 +1,46 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * mdio-open-alliance.h - definition of OPEN Alliance SIG standard registe= rs + */ + +#ifndef __MDIO_OPEN_ALLIANCE__ +#define __MDIO_OPEN_ALLIANCE__ + +#include + +/* NOTE: all OATC14 registers are located in MDIO_MMD_VEND2 */ + +/* Open Alliance TC14 (10BASE-T1S) registers */ +#define MDIO_OATC14_PLCA_IDVER 0xca00 /* PLCA ID and version */ +#define MDIO_OATC14_PLCA_CTRL0 0xca01 /* PLCA Control register 0 */ +#define MDIO_OATC14_PLCA_CTRL1 0xca02 /* PLCA Control register 1 */ +#define MDIO_OATC14_PLCA_STATUS 0xca03 /* PLCA Status register */ +#define MDIO_OATC14_PLCA_TOTMR 0xca04 /* PLCA TO Timer register */ +#define MDIO_OATC14_PLCA_BURST 0xca05 /* PLCA BURST mode register */ + +/* Open Alliance TC14 PLCA IDVER register */ +#define MDIO_OATC14_PLCA_IDM 0xff00 /* PLCA MAP ID */ +#define MDIO_OATC14_PLCA_VER 0x00ff /* PLCA MAP version */ + +/* Open Alliance TC14 PLCA CTRL0 register */ +#define MDIO_OATC14_PLCA_EN BIT(15) /* PLCA enable */ +#define MDIO_OATC14_PLCA_RST BIT(14) /* PLCA reset */ + +/* Open Alliance TC14 PLCA CTRL1 register */ +#define MDIO_OATC14_PLCA_NCNT 0xff00 /* PLCA node count */ +#define MDIO_OATC14_PLCA_ID 0x00ff /* PLCA local node ID */ + +/* Open Alliance TC14 PLCA STATUS register */ +#define MDIO_OATC14_PLCA_PST BIT(15) /* PLCA status indication */ + +/* Open Alliance TC14 PLCA TOTMR register */ +#define MDIO_OATC14_PLCA_TOT 0x00ff + +/* Open Alliance TC14 PLCA BURST register */ +#define MDIO_OATC14_PLCA_MAXBC 0xff00 +#define MDIO_OATC14_PLCA_BTMR 0x00ff + +/* Version Identifiers */ +#define OATC14_IDM 0x0a00 + +#endif /* __MDIO_OPEN_ALLIANCE__ */ diff --git a/drivers/net/phy/phy-c45.c b/drivers/net/phy/phy-c45.c index a87a4b3ffce4..508edd1f17d7 100644 --- a/drivers/net/phy/phy-c45.c +++ b/drivers/net/phy/phy-c45.c @@ -8,6 +8,8 @@ #include #include =20 +#include "mdio-open-alliance.h" + /** * genphy_c45_baset1_able - checks if the PMA has BASE-T1 extended abiliti= es * @phydev: target phy_device struct @@ -931,6 +933,187 @@ int genphy_c45_fast_retrain(struct phy_device *phydev= , bool enable) } EXPORT_SYMBOL_GPL(genphy_c45_fast_retrain); =20 +/** + * genphy_c45_plca_get_cfg - get PLCA configuration from standard registers + * @phydev: target phy_device struct + * @plca_cfg: output structure to store the PLCA configuration + * + * Description: if the PHY complies to the Open Alliance TC14 10BASE-T1S P= LCA + * Management Registers specifications, this function can be used to ret= rieve + * the current PLCA configuration from the standard registers in MMD 31. + */ +int genphy_c45_plca_get_cfg(struct phy_device *phydev, + struct phy_plca_cfg *plca_cfg) +{ + int ret; + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_IDVER); + if (ret < 0) + return ret; + + if ((ret & MDIO_OATC14_PLCA_IDM) !=3D OATC14_IDM) + return -ENODEV; + + plca_cfg->version =3D ret & ~MDIO_OATC14_PLCA_IDM; + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_CTRL0); + if (ret < 0) + return ret; + + plca_cfg->enabled =3D !!(ret & MDIO_OATC14_PLCA_EN); + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_CTRL1); + if (ret < 0) + return ret; + + plca_cfg->node_cnt =3D (ret & MDIO_OATC14_PLCA_NCNT) >> 8; + plca_cfg->node_id =3D (ret & MDIO_OATC14_PLCA_ID); + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_TOTMR); + if (ret < 0) + return ret; + + plca_cfg->to_tmr =3D ret & MDIO_OATC14_PLCA_TOT; + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_BURST); + if (ret < 0) + return ret; + + plca_cfg->burst_cnt =3D (ret & MDIO_OATC14_PLCA_MAXBC) >> 8; + plca_cfg->burst_tmr =3D (ret & MDIO_OATC14_PLCA_BTMR); + + return 0; +} +EXPORT_SYMBOL_GPL(genphy_c45_plca_get_cfg); + +/** + * genphy_c45_plca_set_cfg - set PLCA configuration using standard registe= rs + * @phydev: target phy_device struct + * @plca_cfg: structure containing the PLCA configuration. Fields set to -= 1 are + * not to be changed. + * + * Description: if the PHY complies to the Open Alliance TC14 10BASE-T1S P= LCA + * Management Registers specifications, this function can be used to mod= ify + * the PLCA configuration using the standard registers in MMD 31. + */ +int genphy_c45_plca_set_cfg(struct phy_device *phydev, + const struct phy_plca_cfg *plca_cfg) +{ + int ret; + u16 val; + + // PLCA IDVER is read-only + if (plca_cfg->version >=3D 0) + return -EINVAL; + + // first of all, disable PLCA if required + if (plca_cfg->enabled =3D=3D 0) { + ret =3D phy_clear_bits_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_CTRL0, + MDIO_OATC14_PLCA_EN); + + if (ret < 0) + return ret; + } + + if (plca_cfg->node_cnt >=3D 0 || plca_cfg->node_id >=3D 0) { + if (plca_cfg->node_cnt < 0 || plca_cfg->node_id < 0) { + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_CTRL1); + + if (ret < 0) + return ret; + + val =3D ret; + } + + if (plca_cfg->node_cnt >=3D 0) + val =3D (val & ~MDIO_OATC14_PLCA_NCNT) | + (plca_cfg->node_cnt << 8); + + if (plca_cfg->node_id >=3D 0) + val =3D (val & ~MDIO_OATC14_PLCA_ID) | + (plca_cfg->node_id); + + ret =3D phy_write_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_CTRL1, val); + + if (ret < 0) + return ret; + } + + if (plca_cfg->to_tmr >=3D 0) { + ret =3D phy_write_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_TOTMR, + plca_cfg->to_tmr); + + if (ret < 0) + return ret; + } + + if (plca_cfg->burst_cnt >=3D 0 || plca_cfg->burst_tmr >=3D 0) { + if (plca_cfg->burst_cnt < 0 || plca_cfg->burst_tmr < 0) { + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_BURST); + + if (ret < 0) + return ret; + + val =3D ret; + } + + if (plca_cfg->burst_cnt >=3D 0) + val =3D (val & ~MDIO_OATC14_PLCA_MAXBC) | + (plca_cfg->burst_cnt << 8); + + if (plca_cfg->burst_tmr >=3D 0) + val =3D (val & ~MDIO_OATC14_PLCA_BTMR) | + (plca_cfg->burst_tmr); + + ret =3D phy_write_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_BURST, val); + + if (ret < 0) + return ret; + } + + // if we need to enable PLCA, do it at the end + if (plca_cfg->enabled > 0) { + ret =3D phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, + MDIO_OATC14_PLCA_CTRL0, + MDIO_OATC14_PLCA_EN); + + if (ret < 0) + return ret; + } + + return 0; +} +EXPORT_SYMBOL_GPL(genphy_c45_plca_set_cfg); + +/** + * genphy_c45_plca_get_status - get PLCA status from standard registers + * @phydev: target phy_device struct + * @plca_st: output structure to store the PLCA status + * + * Description: if the PHY complies to the Open Alliance TC14 10BASE-T1S P= LCA + * Management Registers specifications, this function can be used to ret= rieve + * the current PLCA status information from the standard registers in MM= D 31. + */ +int genphy_c45_plca_get_status(struct phy_device *phydev, + struct phy_plca_status *plca_st) +{ + int ret; + + ret =3D phy_read_mmd(phydev, MDIO_MMD_VEND2, MDIO_OATC14_PLCA_STATUS); + if (ret < 0) + return ret; + + plca_st->pst =3D !!(ret & MDIO_OATC14_PLCA_PST); + return 0; +} +EXPORT_SYMBOL_GPL(genphy_c45_plca_get_status); + struct phy_driver genphy_c45_driver =3D { .phy_id =3D 0xffffffff, .phy_id_mask =3D 0xffffffff, diff --git a/include/linux/phy.h b/include/linux/phy.h index bcaf1dfd0687..23aa23cde940 100644 --- a/include/linux/phy.h +++ b/include/linux/phy.h @@ -1748,6 +1748,12 @@ int genphy_c45_loopback(struct phy_device *phydev, b= ool enable); int genphy_c45_pma_resume(struct phy_device *phydev); int genphy_c45_pma_suspend(struct phy_device *phydev); int genphy_c45_fast_retrain(struct phy_device *phydev, bool enable); +int genphy_c45_plca_get_cfg(struct phy_device *phydev, + struct phy_plca_cfg *plca_cfg); +int genphy_c45_plca_set_cfg(struct phy_device *phydev, + const struct phy_plca_cfg *plca_cfg); +int genphy_c45_plca_get_status(struct phy_device *phydev, + struct phy_plca_status *plca_st); =20 /* Generic C45 PHY driver */ extern struct phy_driver genphy_c45_driver; --=20 2.37.4