mirror of https://github.com/hak5/openwrt.git
202 lines
6.5 KiB
Diff
202 lines
6.5 KiB
Diff
From 52c956003a9d5bcae1f445f9dfd42b624adb6e87 Mon Sep 17 00:00:00 2001
|
|
From: Russell King <rmk+kernel@armlinux.org.uk>
|
|
Date: Wed, 11 Dec 2019 10:56:45 +0000
|
|
Subject: [PATCH] net: phylink: delay MAC configuration for copper SFP modules
|
|
|
|
Knowing whether we need to delay the MAC configuration because a module
|
|
may have a PHY is useful to phylink to allow NBASE-T modules to work on
|
|
systems supporting no more than 2.5G speeds.
|
|
|
|
This commit allows us to delay such configuration until after the PHY
|
|
has been probed by recording the parsed capabilities, and if the module
|
|
may have a PHY, doing no more until the module_start() notification is
|
|
called. At that point, we either have a PHY, or we don't.
|
|
|
|
We move the PHY-based setup a little later, and use the PHYs support
|
|
capabilities rather than the EEPROM parsed capabilities to determine
|
|
whether we can support the PHY.
|
|
|
|
Reviewed-by: Andrew Lunn <andrew@lunn.ch>
|
|
Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
|
|
Signed-off-by: David S. Miller <davem@davemloft.net>
|
|
---
|
|
drivers/net/phy/phylink.c | 53 +++++++++++++++++++++++++++++++--------
|
|
drivers/net/phy/sfp-bus.c | 28 +++++++++++++++++++++
|
|
include/linux/sfp.h | 7 ++++++
|
|
3 files changed, 78 insertions(+), 10 deletions(-)
|
|
|
|
--- a/drivers/net/phy/phylink.c
|
|
+++ b/drivers/net/phy/phylink.c
|
|
@@ -72,6 +72,9 @@ struct phylink {
|
|
bool mac_link_dropped;
|
|
|
|
struct sfp_bus *sfp_bus;
|
|
+ bool sfp_may_have_phy;
|
|
+ __ETHTOOL_DECLARE_LINK_MODE_MASK(sfp_support);
|
|
+ u8 sfp_port;
|
|
};
|
|
|
|
#define phylink_printk(level, pl, fmt, ...) \
|
|
@@ -1688,7 +1691,7 @@ static void phylink_sfp_detach(void *ups
|
|
pl->netdev->sfp_bus = NULL;
|
|
}
|
|
|
|
-static int phylink_sfp_config(struct phylink *pl, u8 mode, u8 port,
|
|
+static int phylink_sfp_config(struct phylink *pl, u8 mode,
|
|
const unsigned long *supported,
|
|
const unsigned long *advertising)
|
|
{
|
|
@@ -1762,7 +1765,7 @@ static int phylink_sfp_config(struct phy
|
|
phy_modes(config.interface));
|
|
}
|
|
|
|
- pl->link_port = port;
|
|
+ pl->link_port = pl->sfp_port;
|
|
|
|
if (changed && !test_bit(PHYLINK_DISABLE_STOPPED,
|
|
&pl->phylink_disable_state))
|
|
@@ -1775,15 +1778,20 @@ static int phylink_sfp_module_insert(voi
|
|
const struct sfp_eeprom_id *id)
|
|
{
|
|
struct phylink *pl = upstream;
|
|
- __ETHTOOL_DECLARE_LINK_MODE_MASK(support) = { 0, };
|
|
- u8 port;
|
|
+ unsigned long *support = pl->sfp_support;
|
|
|
|
ASSERT_RTNL();
|
|
|
|
+ linkmode_zero(support);
|
|
sfp_parse_support(pl->sfp_bus, id, support);
|
|
- port = sfp_parse_port(pl->sfp_bus, id, support);
|
|
+ pl->sfp_port = sfp_parse_port(pl->sfp_bus, id, support);
|
|
|
|
- return phylink_sfp_config(pl, MLO_AN_INBAND, port, support, support);
|
|
+ /* If this module may have a PHY connecting later, defer until later */
|
|
+ pl->sfp_may_have_phy = sfp_may_have_phy(pl->sfp_bus, id);
|
|
+ if (pl->sfp_may_have_phy)
|
|
+ return 0;
|
|
+
|
|
+ return phylink_sfp_config(pl, MLO_AN_INBAND, support, support);
|
|
}
|
|
|
|
static int phylink_sfp_module_start(void *upstream)
|
|
@@ -1791,10 +1799,19 @@ static int phylink_sfp_module_start(void
|
|
struct phylink *pl = upstream;
|
|
|
|
/* If this SFP module has a PHY, start the PHY now. */
|
|
- if (pl->phydev)
|
|
+ if (pl->phydev) {
|
|
phy_start(pl->phydev);
|
|
-
|
|
- return 0;
|
|
+ return 0;
|
|
+ }
|
|
+
|
|
+ /* If the module may have a PHY but we didn't detect one we
|
|
+ * need to configure the MAC here.
|
|
+ */
|
|
+ if (!pl->sfp_may_have_phy)
|
|
+ return 0;
|
|
+
|
|
+ return phylink_sfp_config(pl, MLO_AN_INBAND,
|
|
+ pl->sfp_support, pl->sfp_support);
|
|
}
|
|
|
|
static void phylink_sfp_module_stop(void *upstream)
|
|
@@ -1828,10 +1845,26 @@ static void phylink_sfp_link_up(void *up
|
|
static int phylink_sfp_connect_phy(void *upstream, struct phy_device *phy)
|
|
{
|
|
struct phylink *pl = upstream;
|
|
- phy_interface_t interface = pl->link_config.interface;
|
|
+ phy_interface_t interface;
|
|
int ret;
|
|
|
|
- ret = phylink_attach_phy(pl, phy, pl->link_config.interface);
|
|
+ /*
|
|
+ * This is the new way of dealing with flow control for PHYs,
|
|
+ * as described by Timur Tabi in commit 529ed1275263 ("net: phy:
|
|
+ * phy drivers should not set SUPPORTED_[Asym_]Pause") except
|
|
+ * using our validate call to the MAC, we rely upon the MAC
|
|
+ * clearing the bits from both supported and advertising fields.
|
|
+ */
|
|
+ phy_support_asym_pause(phy);
|
|
+
|
|
+ /* Do the initial configuration */
|
|
+ ret = phylink_sfp_config(pl, MLO_AN_INBAND, phy->supported,
|
|
+ phy->advertising);
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+
|
|
+ interface = pl->link_config.interface;
|
|
+ ret = phylink_attach_phy(pl, phy, interface);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
--- a/drivers/net/phy/sfp-bus.c
|
|
+++ b/drivers/net/phy/sfp-bus.c
|
|
@@ -103,6 +103,7 @@ static const struct sfp_quirk *sfp_looku
|
|
|
|
return NULL;
|
|
}
|
|
+
|
|
/**
|
|
* sfp_parse_port() - Parse the EEPROM base ID, setting the port type
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
@@ -179,6 +180,33 @@ int sfp_parse_port(struct sfp_bus *bus,
|
|
EXPORT_SYMBOL_GPL(sfp_parse_port);
|
|
|
|
/**
|
|
+ * sfp_may_have_phy() - indicate whether the module may have a PHY
|
|
+ * @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
+ * @id: a pointer to the module's &struct sfp_eeprom_id
|
|
+ *
|
|
+ * Parse the EEPROM identification given in @id, and return whether
|
|
+ * this module may have a PHY.
|
|
+ */
|
|
+bool sfp_may_have_phy(struct sfp_bus *bus, const struct sfp_eeprom_id *id)
|
|
+{
|
|
+ if (id->base.e1000_base_t)
|
|
+ return true;
|
|
+
|
|
+ if (id->base.phys_id != SFF8024_ID_DWDM_SFP) {
|
|
+ switch (id->base.extended_cc) {
|
|
+ case SFF8024_ECC_10GBASE_T_SFI:
|
|
+ case SFF8024_ECC_10GBASE_T_SR:
|
|
+ case SFF8024_ECC_5GBASE_T:
|
|
+ case SFF8024_ECC_2_5GBASE_T:
|
|
+ return true;
|
|
+ }
|
|
+ }
|
|
+
|
|
+ return false;
|
|
+}
|
|
+EXPORT_SYMBOL_GPL(sfp_may_have_phy);
|
|
+
|
|
+/**
|
|
* sfp_parse_support() - Parse the eeprom id for supported link modes
|
|
* @bus: a pointer to the &struct sfp_bus structure for the sfp module
|
|
* @id: a pointer to the module's &struct sfp_eeprom_id
|
|
--- a/include/linux/sfp.h
|
|
+++ b/include/linux/sfp.h
|
|
@@ -533,6 +533,7 @@ struct sfp_upstream_ops {
|
|
#if IS_ENABLED(CONFIG_SFP)
|
|
int sfp_parse_port(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
|
unsigned long *support);
|
|
+bool sfp_may_have_phy(struct sfp_bus *bus, const struct sfp_eeprom_id *id);
|
|
void sfp_parse_support(struct sfp_bus *bus, const struct sfp_eeprom_id *id,
|
|
unsigned long *support);
|
|
phy_interface_t sfp_select_interface(struct sfp_bus *bus,
|
|
@@ -556,6 +557,12 @@ static inline int sfp_parse_port(struct
|
|
return PORT_OTHER;
|
|
}
|
|
|
|
+static inline bool sfp_may_have_phy(struct sfp_bus *bus,
|
|
+ const struct sfp_eeprom_id *id)
|
|
+{
|
|
+ return false;
|
|
+}
|
|
+
|
|
static inline void sfp_parse_support(struct sfp_bus *bus,
|
|
const struct sfp_eeprom_id *id,
|
|
unsigned long *support)
|