[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <E1o4hhM-004Aoy-Df@rmk-PC.armlinux.org.uk>
Date: Fri, 24 Jun 2022 12:42:04 +0100
From: "Russell King (Oracle)" <rmk+kernel@...linux.org.uk>
To: Andrew Lunn <andrew@...n.ch>,
Heiner Kallweit <hkallweit1@...il.com>
Cc: Alexandre Belloni <alexandre.belloni@...tlin.com>,
"Alvin __ipraga" <alsi@...g-olufsen.dk>,
Claudiu Manoil <claudiu.manoil@....com>,
"David S. Miller" <davem@...emloft.net>,
DENG Qingfang <dqfext@...il.com>,
Eric Dumazet <edumazet@...gle.com>,
Florian Fainelli <f.fainelli@...il.com>,
George McCollister <george.mccollister@...il.com>,
Hauke Mehrtens <hauke@...ke-m.de>,
Jakub Kicinski <kuba@...nel.org>,
Kurt Kanzenbach <kurt@...utronix.de>,
Landen Chao <Landen.Chao@...iatek.com>,
Linus Walleij <linus.walleij@...aro.org>,
linux-arm-kernel@...ts.infradead.org,
linux-mediatek@...ts.infradead.org,
Matthias Brugger <matthias.bgg@...il.com>,
netdev@...r.kernel.org, Paolo Abeni <pabeni@...hat.com>,
Sean Wang <sean.wang@...iatek.com>,
UNGLinuxDriver@...rochip.com,
Vivien Didelot <vivien.didelot@...il.com>,
Vladimir Oltean <olteanv@...il.com>,
Woojung Huh <woojung.huh@...rochip.com>
Subject: [PATCH RFC net-next 3/4] net: phylink: add
phylink_set_max_fixed_link()
Add a function for DSA to use to configure phylink, in the absence of
any other configuration, to a fixed link operating at the maximum
supported link speed.
This is needed so we can support phylink usage on CPU and DSA ports.
Signed-off-by: Russell King (Oracle) <rmk+kernel@...linux.org.uk>
---
drivers/net/phy/phylink.c | 83 +++++++++++++++++++++++++++++++++++++++
include/linux/phylink.h | 2 +
2 files changed, 85 insertions(+)
diff --git a/drivers/net/phy/phylink.c b/drivers/net/phy/phylink.c
index e20cdab824db..bd9f09cfc281 100644
--- a/drivers/net/phy/phylink.c
+++ b/drivers/net/phy/phylink.c
@@ -1317,6 +1317,89 @@ void phylink_destroy(struct phylink *pl)
}
EXPORT_SYMBOL_GPL(phylink_destroy);
+static struct {
+ unsigned long fd_mask;
+ unsigned long hd_mask;
+ int speed;
+} phylink_caps_speeds[] = {
+ { MAC_400000FD, 0, SPEED_400000 },
+ { MAC_200000FD, 0, SPEED_200000 },
+ { MAC_100000FD, 0, SPEED_100000 },
+ { MAC_56000FD, 0, SPEED_56000 },
+ { MAC_50000FD, 0, SPEED_50000 },
+ { MAC_40000FD, 0, SPEED_40000 },
+ { MAC_25000FD, 0, SPEED_40000 },
+ { MAC_20000FD, 0, SPEED_20000 },
+ { MAC_10000FD, 0, SPEED_10000 },
+ { MAC_5000FD, 0, SPEED_5000 },
+ { MAC_2500FD, 0, SPEED_2500 },
+ { MAC_1000FD, MAC_1000HD, SPEED_1000 },
+ { MAC_100FD, MAC_100HD, SPEED_100 },
+ { MAC_10FD, MAC_10HD, SPEED_10 },
+};
+
+/**
+ * phylink_set_max_fixed_link() - set a fixed link configuration for phylink
+ * @pl: a pointer to a &struct phylink returned from phylink_create()
+ *
+ * Set a maximum speed fixed-link configuration for the chosen interface
+ * mode and MAC capabilities for the phylink instance. Only valid for use
+ * immediately after creation. Must not be used at any other time.
+ *
+ * The user must have initialised mac_capabilities and set a valid interface.
+ */
+int phylink_set_max_fixed_link(struct phylink *pl)
+{
+ unsigned long caps;
+ int speed, duplex;
+ int i;
+
+ /* If we are not in PHY mode, or have a PHY, or have a SFP bus,
+ * then we must not default to a fixed link.
+ */
+ if (pl->cfg_link_an_mode != MLO_AN_PHY || pl->phydev || pl->sfp_bus)
+ return -EBUSY;
+
+ /* Get the speed/duplex capabilities and reduce according to the
+ * interface mode.
+ */
+ caps = pl->config->mac_capabilities;
+ caps &= ~(MAC_SYM_PAUSE | MAC_ASYM_PAUSE);
+ caps &= phylink_interface_to_caps(pl->link_config.interface);
+
+ /* If there are no capabilities, then we are not using this default. */
+ if (!caps)
+ return -EINVAL;
+
+ /* Decode to fastest speed and duplex */
+ duplex = DUPLEX_UNKNOWN;
+ speed = SPEED_UNKNOWN;
+ for (i = 0; i < ARRAY_SIZE(phylink_caps_speeds); i++) {
+ if (caps & phylink_caps_speeds[i].fd_mask) {
+ duplex = DUPLEX_FULL;
+ speed = phylink_caps_speeds[i].speed;
+ break;
+ } else if (caps & phylink_caps_speeds[i].hd_mask) {
+ duplex = DUPLEX_HALF;
+ speed = phylink_caps_speeds[i].speed;
+ break;
+ }
+ }
+
+ /* If we didn't find anything, bail. */
+ if (speed == SPEED_UNKNOWN)
+ return -EINVAL;
+
+ pl->link_config.speed = speed;
+ pl->link_config.duplex = duplex;
+ pl->link_config.link = 1;
+ pl->cfg_link_an_mode = MLO_AN_FIXED;
+ pl->cur_link_an_mode = MLO_AN_FIXED;
+
+ return 0;
+}
+EXPORT_SYMBOL_GPL(phylink_set_max_fixed_link);
+
static void phylink_phy_change(struct phy_device *phydev, bool up)
{
struct phylink *pl = phydev->phylink;
diff --git a/include/linux/phylink.h b/include/linux/phylink.h
index 6d06896fc20d..145fec38ad90 100644
--- a/include/linux/phylink.h
+++ b/include/linux/phylink.h
@@ -529,6 +529,8 @@ struct phylink *phylink_create(struct phylink_config *, struct fwnode_handle *,
const struct phylink_mac_ops *mac_ops);
void phylink_destroy(struct phylink *);
+int phylink_set_max_fixed_link(struct phylink *pl);
+
int phylink_connect_phy(struct phylink *, struct phy_device *);
int phylink_of_phy_connect(struct phylink *, struct device_node *, u32 flags);
int phylink_fwnode_phy_connect(struct phylink *pl,
--
2.30.2
Powered by blists - more mailing lists