net: pcs: Introduce support for fwnode PCS
Subsystems (7)
v5 cover net: pcs: Introduce support for fwnode PCS
This series introduce a most awaited feature that is correctly provide PCS with fwnode without having to use specific export symbol and additional handling of PCS in phylink.
At times there were 2 different implementation (this and the one from Sean) but Sean agreed that this can be picked and used in favor of his implementation as long as his case with race condition is correctly handled.
---
First the PCS fwnode:
The concept is to implement a producer-consumer API similar to other subsystem like clock or PHY.
That seems to be the best solution to the problem as PCS driver needs to be detached from phylink and implement a simple way to provide a PCS while maintaining support for probe defer or driver removal.
To keep the implementation simple, the PCS driver devs needs some collaboration to correctly implement this. This is O.K. as helper to correctly implement this are provided hence it's really a matter of following a pattern to correct follow removal of a PCS driver.
A PCS provider have to implement and call fwnode_pcs_add_provider() in probe function and define an xlate function to define how the PCS should be provided based on the requested interface and phandle spec defined in fwnode (based on the #pcs-cells)
fwnode_pcs_get() is provided to provide a specific PCS declared in fwnode at index.
A simple xlate function is provided for simple single PCS implementation, fwnode_pcs_simple_get.
A PCS provider on driver removal should first call fwnode_pcs_del_provider() to delete itself as a provider and then release the PCS from phylink with phylink_release_pcs() under rtnl lock.
---
Second PCS handling in phylink:
We have the PCS problem for the only reason that in initial implementation, we permitted way too much flexibility to MAC driver and things started to deviate. At times we couldn't think SoC would start to put PCS outside the MAC hence it was OK to assume they would live in the same driver. With the introduction of 10g in more consumer devices, we are observing a rapid growth of this pattern with multiple PCS external to MAC.
To put a stop on this, the only solution is to give back to phylink control on PCS handling and enforce more robust supported interface definition from both MAC and PCS side.
It's suggested to read patch 0003 of this series for more info, here a brief explaination of the idea:
This series introduce handling of PCS in phylink and try to deprecate .mac_select_pcs.
Phylink now might contain a linked list of available PCS and those will be used for PCS selection on phylink_major_config.
MAC driver needs to define pcs_interfaces mask in phylink_config for every interface that needs a dedicated PCS.
These PCS needs to be provided to phylink at phylink_create time by setting the available_pcs and num_available_pcs in phylink_config. A helper to parse PCS from fwnode is provided fwnode_phylink_pcs_parse() that will fill a preallocated array of PCS. (the same function can be used to get the number of PCS defined in DT, more info in patch 0005)
phylink_create() will fill the internal PCS list with the passed array of PCS. phylink_major_config and other user of .mac_select_pcs are adapted to make use of this new PCS list.
The supported interface value is also moved internally to phylink struct. This is to handle late removal and addition of PCS. (the bonus effect to this is giving phylink a clear idea of what is actually supported by the MAC and his constraint with PCS)
The supported interface mask in phylink is done by OR the supported_interfaces in phylink_config with every PCS in PCS list.
PCS removal is supported by forcing a mac_config, refresh the supported interfaces and run a phy_resolve().
PCS late addition is supported by introducing a global notifier for PCS provider. If a phylink have the pcs_interfaces mask not zero, it's registered to this notifier.
PCS provider will emit a global PCS add event to signal any interface that a new PCS might be avialable.
The function will then check if the PCS is related to the MAC fwnode and add it accordingly.
A user for this new implementation is provided as an Airoha PCS driver. This was also tested downstream with the IPQ95xx QCOM SoC and with the help of Daniel also on the various Mediatek MT7988 SoC with both SFP cage implementation and DSA attached.
Lots of tests were done with driver unbind/bind and with interface up/down also by adding print to make sure major_config_fail gets correctly triggered and reset once the PCS comes back.
The dedicated commits have longer description on the implementation so it's suggested to also check there for additional info.
It's worth to mention that OpenWrt is currently using this on Mediatek SoC and QCOM ipq807x/ipq60xx/ipq50xx and Airoha are already ported in staging tree for testing.
---
Changes v5:
- Rebase on top of net-next
- Use the new force_major_config
- Reword some comments and commit description
- Return -ENODEV instead of -EPROBE_DEFER to perevent race condition
- Drop phy_interface_copy patch (Russell pushed an equivalent version) Changes v4:
- Move patch 0002 phy_interface_copy to 0002 (fix bisectability problem)
- Address review from Lorenzo for Airoha ethernet driver
- Fix kdoc error with missing Return (actually missing : before Return)
- Fix UNMET dependency reported error for CONFIG_FWNODE_PCS
- Revert to pcs.c instead of core.c (due to name conflict with other kmod)
- Fix clang compilation error for Airoha PCS driver
- Add missing inline function to pcs.h function
Changes v3:
- Out of RFC
- Fix various spelling mistake
- Drop circular dependency patch
- Complete Airoha Ethernet phylink integration
- Introduce .pcs_link_down PCS OP
Changes v2:
- Switch to fwnode
- Implement PCS provider notifier
- Better split changes
- Move supported_interfaces to phylink
- Add circular dependency patch
- Rework handling with indirect addition/removal and
trigger of phylink_resolve()
Christian Marangi (10):
net: phylink: keep and use MAC supported_interfaces in phylink struct
net: phylink: introduce internal phylink PCS handling
net: phylink: add phylink_release_pcs() to externally release a PCS
net: pcs: implement Firmware node support for PCS driver
net: phylink: support late PCS provider attach
dt-bindings: net: ethernet-controller: permit to define multiple PCS
net: phylink: add .pcs_link_down PCS OP
dt-bindings: net: pcs: Document support for Airoha Ethernet PCS
net: pcs: airoha: add PCS driver for Airoha SoC
net: airoha: add phylink support for GDM2/3/4
.../bindings/net/ethernet-controller.yaml | 2 - .../bindings/net/pcs/airoha,pcs.yaml | 112 + drivers/net/ethernet/airoha/Kconfig | 1 + drivers/net/ethernet/airoha/airoha_eth.c | 144 +- drivers/net/ethernet/airoha/airoha_eth.h | 3 + drivers/net/ethernet/airoha/airoha_regs.h | 12 + drivers/net/pcs/Kconfig | 13 + drivers/net/pcs/Makefile | 2 + drivers/net/pcs/pcs-airoha.c | 2921 +++++++++++++++++ drivers/net/pcs/pcs.c | 241 ++ drivers/net/phy/phylink.c | 280 +- include/linux/pcs/pcs-provider.h | 41 + include/linux/pcs/pcs.h | 104 + include/linux/phylink.h | 15 + 14 files changed, 3862 insertions(+), 29 deletions(-) create mode 100644 Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml create mode 100644 drivers/net/pcs/pcs-airoha.c create mode 100644 drivers/net/pcs/pcs.c create mode 100644 include/linux/pcs/pcs-provider.h create mode 100644 include/linux/pcs/pcs.h
Signature · 1 line
2.53.0
RFC PATCH v5 1/10 net: phylink: keep and use MAC supported_interfaces in phylink struct
Add in phylink struct a copy of supported_interfaces from phylink_config and make use of that instead of relying on phylink_config value.
This in preparation for support of PCS handling internally to phylink where a PCS can be removed or added after the phylink is created and we need both a reference of the supported_interfaces value from phylink_config and an internal value that can be updated with the new PCS info.
--- drivers/net/phy/phylink.c | 22 +++++++++++++++------- 1 file changed, 15 insertions(+), 7 deletions(-)
drivers/net/phy/phylink.c +15 -7
@@ -60,6 +60,11 @@ struct phylink {/* The link configuration settings */ struct phylink_link_state link_config; +/* What interface are supported by the current link. +* Can change on removal or addition of new PCS. +*/ +DECLARE_PHY_INTERFACE_MASK (supported_interfaces); +/* The current settings */ phy_interface_t cur_interface;
@@ -629,7 +634,7 @@ static int phylink_validate_mask(struct phylink *pl, struct phy_device *phy,static int phylink_validate (struct phylink *pl,unsigned long *supported,struct phylink_link_state *state) { -const unsigned long *interfaces = pl->config->supported_interfaces; +const unsigned long *interfaces = pl->supported_interfaces;if (state->interface ==PHY_INTERFACE_MODE_NA ) return phylink_validate_mask(pl, NULL, supported, state,
@@ -1868,6 +1873,9 @@ struct phylink *phylink_create(struct phylink_config *config,mutex_init (&pl->state_mutex);INIT_WORK (&pl->resolve, phylink_resolve); +phy_interface_copy (pl->supported_interfaces, + config->supported_interfaces); + pl->config = config;if (config->type ==PHYLINK_NETDEV ) { pl->netdev =to_net_dev (config->dev);
@@ -2026,7 +2034,7 @@ static int phylink_validate_phy(struct phylink *pl, struct phy_device *phy,* those which the host supports. */ phy_interface_and (interfaces, phy->possible_interfaces, - pl->config->supported_interfaces); + pl->supported_interfaces);if (phy_interface_empty (interfaces)) {phylink_err (pl,"PHY has no common interfaces\n" );
@@ -2828,12 +2836,12 @@ static phy_interface_t phylink_sfp_select_interface(struct phylink *pl,return interface; } -if (!test_bit (interface, pl->config->supported_interfaces)) { +if (!test_bit (interface, pl->supported_interfaces)) {phylink_err (pl,"selection of interface failed, SFP selected %s (%u) but MAC supports %*pbl\n" ,phy_modes (interface), interface, (int )PHY_INTERFACE_MODE_MAX , - pl->config->supported_interfaces); + pl->supported_interfaces);return PHY_INTERFACE_MODE_NA ; }
@@ -3761,14 +3769,14 @@ static int phylink_sfp_config_optical(struct phylink *pl)phylink_dbg (pl,"optical SFP: interfaces=[mac=%*pbl, sfp=%*pbl]\n" , (int )PHY_INTERFACE_MODE_MAX , - pl->config->supported_interfaces, + pl->supported_interfaces, (int )PHY_INTERFACE_MODE_MAX , pl->sfp_interfaces);/* Find the union of the supported interfaces by the PCS/MAC and * the SFP module. */ -phy_interface_and (pl->sfp_interfaces, pl->config->supported_interfaces, +phy_interface_and (pl->sfp_interfaces, pl->supported_interfaces, pl->sfp_interfaces);if (phy_interface_empty (pl->sfp_interfaces)) {phylink_err (pl,"unsupported SFP module: no common interface modes\n" );
@@ -3939,7 +3947,7 @@ static int phylink_sfp_connect_phy(void *upstream, struct phy_device *phy)/* Set the PHY's host supported interfaces */ phy_interface_and (phy->host_interfaces, phylink_sfp_interfaces, - pl->config->supported_interfaces); + pl->supported_interfaces);/* Do the initial configuration */ return phylink_sfp_config_phy (pl, phy);
Signature · 1 line
2.53.0
RFC PATCH v5 2/10 net: phylink: introduce internal phylink PCS handling
In reply to Christian MarangiIntroduce internal handling of PCS for phylink. This is an alternative to .mac_select_pcs that moves the selection logic of the PCS entirely to phylink with the usage of the supported_interface value in the PCS struct.
MAC should now provide an array of available PCS in phylink_config in .available_pcs and fill the .num_available_pcs with the number of elements in the array. MAC should also define a new bitmap, pcs_interfaces, in phylink_config to define for what interface mode a dedicated PCS is required.
On phylink_create() this array is parsed and a linked list of PCS is created based on the PCS passed in phylink_config.
Also the supported_interface value in phylink struct is updated with the new supported_interface from the provided PCS.
On phylink_start() every PCS in phylink PCS list gets attached to the phylink instance. This is done by setting the phylink value in phylink_pcs struct to the phylink instance.
On phylink_stop(), every PCS in phylink PCS list is detached from the phylink instance. This is done by setting the phylink value in phylink_pcs struct to NULL.
phylink_validate_mac_and_pcs(), phylink_major_config() and phylink_inband_caps() are updated to support this new implementation with the PCS list stored in phylink.
They will make use of phylink_validate_pcs_interface() that will loop for every PCS in the phylink PCS available list and find one that supports the passed interface.
phylink_validate_pcs_interface() applies the same logic of .mac_select_pcs where if a supported_interface value is not set for the PCS struct, then it's assumed every interface is supported.
A MAC is required to implement either a .mac_select_pcs or make use of the PCS list implementation. Implementing both will result in a fail on MAC/PCS validation.
phylink value in phylink_pcs struct with this implementation is used to track from PCS side when it's attached to a phylink instance. PCS driver will make use of this information to correctly detach from a phylink instance if needed.
The .mac_select_pcs implementation is not changed but it's expected that every MAC driver migrates to the new implementation to later deprecate and remove .mac_select_pcs.
--- drivers/net/phy/phylink.c | 149 +++++++++++++++++++++++++++++++++----- include/linux/phylink.h | 11 +++ 2 files changed, 141 insertions(+), 19 deletions(-)
drivers/net/phy/phylink.c +130 -19
@@ -60,6 +60,9 @@ struct phylink {/* The link configuration settings */ struct phylink_link_state link_config; +/* List of available PCS */ +struct list_head pcs_list; +/* What interface are supported by the current link. * Can change on removal or addition of new PCS. */
@@ -154,6 +157,8 @@ static const phy_interface_t phylink_sfp_interface_preference[] = {static DECLARE_PHY_INTERFACE_MASK (phylink_sfp_interfaces); +static void phylink_run_resolve (struct phylink *pl); +/** * phylink_set_port_modes() - set the port type modes in the ethtool mask * @mask: ethtool link mode mask
@@ -518,22 +523,59 @@ static void phylink_validate_mask_caps(unsigned long *supported,linkmode_and (state->advertising, state->advertising, mask); } +static int phylink_validate_pcs_interface (struct phylink_pcs *pcs, +phy_interface_t interface) +{ +/* If PCS define an empty supported_interfaces value, assume +* all interface are supported. +*/ +if (phy_interface_empty (pcs->supported_interfaces)) +return 0 ; + +/* Ensure that this PCS supports the interface mode */ +if (!test_bit (interface, pcs->supported_interfaces)) +return -EINVAL ; + +return 0 ; +} +static int phylink_validate_mac_and_pcs (struct phylink *pl,unsigned long *supported,struct phylink_link_state *state) { -struct phylink_pcs *pcs =NULL ;unsigned long capabilities; +struct phylink_pcs *pcs; +bool pcs_found = false;int ret;/* Get the PCS for this interface mode */ if (pl->mac_ops->mac_select_pcs) { +/* Make sure either PCS internal validation or .mac_select_pcs +* is used. Return error if both are defined. +*/ +if (!list_empty (&pl->pcs_list)) { +phylink_err (pl,"either phylink_pcs_add() or .mac_select_pcs must be used\n" ); +return -EINVAL ; + } + pcs = pl->mac_ops->mac_select_pcs (pl->config, state->interface);if (IS_ERR (pcs))return PTR_ERR (pcs); + + pcs_found = !!pcs; + }else { +/* Check every assigned PCS and search for one that supports +* the interface. +*/ +list_for_each_entry (pcs, &pl->pcs_list, list) { +if (!phylink_validate_pcs_interface (pcs, state->interface)) { + pcs_found = true; +break ; + } + } } -if (pcs) { +if (pcs_found) {/* The PCS, if present, must be setup before phylink_create() * has been called. If the ops is not initialised, print an * error and backtrace rather than oopsing the kernel.
@@ -545,13 +587,10 @@ static int phylink_validate_mac_and_pcs(struct phylink *pl,return -EINVAL ; } -/* Ensure that this PCS supports the interface which the MAC -* returned it for. It is an error for the MAC to return a PCS -* that does not support the interface mode. -*/ -if (!phy_interface_empty (pcs->supported_interfaces) && - !test_bit (state->interface, pcs->supported_interfaces)) { -phylink_err (pl,"MAC returned PCS which does not support %s\n" , +/* Recheck PCS to handle legacy way for .mac_select_pcs */ + ret =phylink_validate_pcs_interface (pcs, state->interface); +if (ret) { +phylink_err (pl,"selected PCS does not support %s\n" ,phy_modes (state->interface));return -EINVAL ; }
@@ -965,12 +1004,22 @@ static unsigned int phylink_inband_caps(struct phylink *pl, phy_interface_t interface) {struct phylink_pcs *pcs; +bool pcs_found = false; -if (!pl->mac_ops->mac_select_pcs) -return 0 ; +if (pl->mac_ops->mac_select_pcs) { + pcs = pl->mac_ops->mac_select_pcs (pl->config, + interface); + pcs_found = !!pcs; + }else { +list_for_each_entry (pcs, &pl->pcs_list, list) { +if (!phylink_validate_pcs_interface (pcs, interface)) { + pcs_found = true; +break ; + } + } + } - pcs = pl->mac_ops->mac_select_pcs (pl->config, interface); -if (!pcs) +if (!pcs_found)return 0 ;return phylink_pcs_inband_caps (pcs, interface);
@@ -1265,10 +1314,36 @@ static void phylink_major_config(struct phylink *pl, bool restart, pl->major_config_failed = true;return ; } +/* Find a PCS in available PCS list for the requested interface. +* This doesn't overwrite the previous .mac_select_pcs as either +* .mac_select_pcs or PCS list implementation are permitted. +* +* Skip searching if the MAC doesn't require a dedicaed PCS for +* the requested interface. +*/ + }else if (test_bit (state->interface, pl->config->pcs_interfaces)) { +bool pcs_found = false; + +list_for_each_entry (pcs, &pl->pcs_list, list) { +if (!phylink_validate_pcs_interface (pcs, + state->interface)) { + pcs_found = true; +break ; + } + } + +if (!pcs_found) { +phylink_err (pl, +"couldn't find a PCS for %s\n" , +phy_modes (state->interface)); - pcs_changed = pl->pcs != pcs; + pl->major_config_failed = true; +return ; + } } + pcs_changed = pl->pcs != pcs; +phylink_pcs_neg_mode (pl, pcs, state->interface, state->advertising); phylink_dbg(pl, "major config, active %s/%s/%s\n",
@@ -1295,11 +1370,13 @@ static void phylink_major_config(struct phylink *pl, bool restart,if (pcs_changed) {phylink_pcs_disable (pl->pcs); -if (pl->pcs) - pl->pcs->phylink =NULL ; +if (pl->mac_ops->mac_select_pcs) { +if (pl->pcs) + pl->pcs->phylink =NULL ; -if (pcs) - pcs->phylink = pl; +if (pcs) + pcs->phylink = pl; + } pl->pcs = pcs; }
@@ -1855,8 +1932,9 @@ struct phylink *phylink_create(struct phylink_config *config,phy_interface_t iface, const struct phylink_mac_ops *mac_ops) { + struct phylink_pcs *pcs;struct phylink *pl; -int ret; +int i, ret;/* Validate the supplied configuration */ if (phy_interface_empty (config->supported_interfaces)) {
@@ -1872,9 +1950,21 @@ struct phylink *phylink_create(struct phylink_config *config,mutex_init (&pl->phydev_mutex);mutex_init (&pl->state_mutex);INIT_WORK (&pl->resolve, phylink_resolve); +INIT_LIST_HEAD (&pl->pcs_list); + +/* Fill the PCS list with available PCS from phylink config */ +for (i =0 ; i < config->num_available_pcs; i++) { + pcs = config->available_pcs[i]; + +list_add (&pcs->list, &pl->pcs_list); + }phy_interface_copy (pl->supported_interfaces, config->supported_interfaces); +list_for_each_entry (pcs, &pl->pcs_list, list) +phy_interface_or (pl->supported_interfaces, + pl->supported_interfaces, + pcs->supported_interfaces); pl->config = config;if (config->type ==PHYLINK_NETDEV ) {
@@ -1953,10 +2043,16 @@ EXPORT_SYMBOL_GPL(phylink_create);*/ void phylink_destroy (struct phylink *pl) { +struct phylink_pcs *pcs, *tmp; +sfp_bus_del_upstream (pl->sfp_bus);if (pl->link_gpio)gpiod_put (pl->link_gpio); +/* Remove every PCS from phylink PCS list */ +list_for_each_entry_safe (pcs, tmp, &pl->pcs_list, list) +list_del (&pcs->list); +cancel_work_sync (&pl->resolve);kfree (pl); }
@@ -2437,6 +2533,7 @@ static irqreturn_t phylink_link_handler(int irq, void *data)*/ void phylink_start (struct phylink *pl) { +struct phylink_pcs *pcs;bool poll = false;ASSERT_RTNL ();
@@ -2463,6 +2560,10 @@ void phylink_start(struct phylink *pl) pl->pcs_state =PCS_STATE_STARTED ; +/* link available PCS to phylink struct */ +list_for_each_entry (pcs, &pl->pcs_list, list) + pcs->phylink = pl; +phylink_enable_and_run_resolve (pl,PHYLINK_DISABLE_STOPPED );if (pl->cfg_link_an_mode ==MLO_AN_FIXED && pl->link_gpio) {
@@ -2507,6 +2608,8 @@ EXPORT_SYMBOL_GPL(phylink_start);*/ void phylink_stop (struct phylink *pl) { +struct phylink_pcs *pcs; +ASSERT_RTNL ();if (pl->sfp_bus)
@@ -2524,6 +2627,14 @@ void phylink_stop(struct phylink *pl) pl->pcs_state =PCS_STATE_DOWN ;phylink_pcs_disable (pl->pcs); + +/* Drop link between phylink and PCS */ +list_for_each_entry (pcs, &pl->pcs_list, list) + pcs->phylink =NULL ; + +/* Restore original supported interfaces */ +phy_interface_copy (pl->supported_interfaces, + pl->config->supported_interfaces); }EXPORT_SYMBOL_GPL (phylink_stop);
include/linux/phylink.h +11 -0
@@ -151,6 +151,8 @@ enum phylink_op_type {* if MAC link is at %MLO_AN_FIXED mode. * @supported_interfaces: bitmap describing which PHY_INTERFACE_MODE_xxx * are supported by the MAC/PCS. +* @pcs_interfaces: bitmap describing for which PHY_INTERFACE_MODE_xxx a +* dedicated PCS is required. * @lpi_interfaces: bitmap describing which PHY interface modes can support * LPI signalling. * @mac_capabilities: MAC pause/speed/duplex capabilities.
@@ -160,6 +162,8 @@ enum phylink_op_type {* @wol_phy_legacy: Use Wake-on-Lan with PHY even if phy_can_wakeup() is false * @wol_phy_speed_ctrl: Use phy speed control on suspend/resume * @wol_mac_support: Bitmask of MAC supported %WAKE_* options +* @available_pcs: array of available phylink_pcs PCS +* @num_available_pcs: num of available phylink_pcs PCS */ struct phylink_config {struct device *dev;
@@ -172,6 +176,7 @@ struct phylink_config {void (*get_fixed_state)(struct phylink_config *config,struct phylink_link_state *state);DECLARE_PHY_INTERFACE_MASK (supported_interfaces); +DECLARE_PHY_INTERFACE_MASK (pcs_interfaces);DECLARE_PHY_INTERFACE_MASK (lpi_interfaces);unsigned long mac_capabilities;unsigned long lpi_capabilities;
@@ -182,6 +187,9 @@ struct phylink_config {bool wol_phy_legacy;bool wol_phy_speed_ctrl;u32 wol_mac_support; + +struct phylink_pcs **available_pcs; +unsigned int num_available_pcs; };void phylink_limit_mac_speed (struct phylink_config *config,u32 max_speed);
@@ -497,6 +505,9 @@ struct phylink_pcs {struct phylink *phylink;bool poll;bool rxc_always_on; + +/* private: */ +struct list_head list; };/**
Signature · 1 line
2.53.0
RFC PATCH v5 3/10 net: phylink: add phylink_release_pcs() to externally release a PCS
In reply to Christian MarangiAdd phylink_release_pcs() to externally release a PCS from a phylink instance. This can be used to handle case when a single PCS needs to be removed and the phylink instance needs to be refreshed.
On calling phylink_release_pcs(), the PCS will be removed from the phylink internal PCS list and the phylink supported_interfaces value is reparsed with the remaining PCS interfaces.
Also a phylink resolve is triggered to handle the PCS removal.
The flag force_major_config is set to make phylink resolve reconfigure the interface (even if it didn't change) is also added.
This is needed to handle the special case when the current PCS used by phylink is removed and a major_config is needed to propagae the configuration change. With this option enabled we also force mac_config even if the PHY link is not up for the in-band case.
--- drivers/net/phy/phylink.c | 49 +++++++++++++++++++++++++++++++++++++++ include/linux/phylink.h | 2 ++ 2 files changed, 51 insertions(+)
drivers/net/phy/phylink.c +49 -0
@@ -923,6 +923,55 @@ static void phylink_resolve_an_pause(struct phylink_link_state *state) } } +/** +* phylink_release_pcs - Removes a PCS from the phylink PCS available list +* @pcs: a pointer to the phylink_pcs struct to be released +* +* This function release a PCS from the phylink PCS available list if +* actually in use. It also refreshes the supported interfaces of the +* phylink instance by copying the supported interfaces from the phylink +* conf and merging the supported interfaces of the remaining available PCS +* in the list and trigger a resolve. +*/ +void phylink_release_pcs (struct phylink_pcs *pcs) +{ +struct phylink *pl; + +ASSERT_RTNL (); + + pl = pcs->phylink; +if (!pl) +return ; + +list_del (&pcs->list); + pcs->phylink =NULL ; + +/* Check if we are removing the PCS currently +* in use by phylink. If this is the case, +* force phylink resolve to reconfigure the interface +* mode and set the phylink PCS to NULL. +*/ +if (pl->pcs == pcs) { +mutex_lock (&pl->state_mutex); + + pl->force_major_config = true; + pl->pcs =NULL ; + +mutex_unlock (&pl->state_mutex); + } + +/* Refresh supported interfaces */ +phy_interface_copy (pl->supported_interfaces, + pl->config->supported_interfaces); +list_for_each_entry (pcs, &pl->pcs_list, list) +phy_interface_or (pl->supported_interfaces, + pl->supported_interfaces, + pcs->supported_interfaces); + +phylink_run_resolve (pl); +} +EXPORT_SYMBOL_GPL (phylink_release_pcs); +static unsigned int phylink_pcs_inband_caps (struct phylink_pcs *pcs,phy_interface_t interface) {
include/linux/phylink.h +2 -0
@@ -746,6 +746,8 @@ void phylink_disconnect_phy(struct phylink *);int phylink_set_fixed_link (struct phylink *,const struct phylink_link_state *); +void phylink_release_pcs (struct phylink_pcs *pcs); +void phylink_mac_change (struct phylink *,bool up);void phylink_pcs_change (struct phylink_pcs *,bool up);
Signature · 1 line
2.53.0
RFC PATCH v5 4/10 net: pcs: implement Firmware node support for PCS driver
In reply to Christian MarangiImplement the foundation of Firmware node support for PCS driver.
To support this, implement a simple Provider API where a PCS driver can expose multiple PCS with an xlate .get function.
PCS driver will have to call fwnode_pcs_add_provider() and pass the firmware node pointer and a xlate function to return the correct PCS for the passed #pcs-cells.
This will register the PCS in a global list of providers so that consumer can access it.
The consumer will then use fwnode_pcs_get() to get the actual PCS by passing the firmware node pointer and the index for #pcs-cells.
For a simple implementation where #pcs-cells is 0 and the PCS driver expose a single PCS, the xlate function fwnode_pcs_simple_get() is provided.
For an advanced implementation a custom xlate function is required.
One removal the PCS driver should first delete itself from the provider list using fwnode_pcs_del_provider() and then call phylink_release_pcs() on every PCS the driver provides.
A generic function fwnode_phylink_pcs_parse() is provided for MAC driver that will declare PCS in DT (or ACPI).
This function will parse "pcs-handle" property and fill the passed array with the parsed PCS in available_pcs up to the passed num_pcs value. It's also possible to pass NULL as array to only parse the PCS and update the num_pcs value with the count of scanned PCS.
--- drivers/net/pcs/Kconfig | 6 + drivers/net/pcs/Makefile | 1 + drivers/net/pcs/pcs.c | 201 +++++++++++++++++++++++++++++++ include/linux/pcs/pcs-provider.h | 41 +++++++ include/linux/pcs/pcs.h | 56 +++++++++ 5 files changed, 305 insertions(+) create mode 100644 drivers/net/pcs/pcs.c create mode 100644 include/linux/pcs/pcs-provider.h create mode 100644 include/linux/pcs/pcs.h
drivers/net/pcs/Kconfig +6 -0
@@ -5,6 +5,12 @@ menu "PCS device drivers" +config FWNODE_PCS + tristate + depends on (ACPI || OF) + help + Firmware node PCS accessors + config PCS_XPCS tristate "Synopsys DesignWare Ethernet XPCS" select PHYLINK
drivers/net/pcs/Makefile +1 -0
@@ -1,6 +1,7 @@ # SPDX-License-Identifier: GPL-2.0 # Makefile for Linux PCS drivers +obj-$(CONFIG_FWNODE_PCS) += pcs.o pcs_xpcs-$(CONFIG_PCS_XPCS) := pcs-xpcs.o pcs-xpcs-plat.o \ pcs-xpcs-nxp.o pcs-xpcs-wx.o
drivers/net/pcs/pcs.c new file +201 -0
201 lines not on this page · raw message
include/linux/pcs/pcs-provider.h new file +41 -0
41 lines not on this page · raw message
include/linux/pcs/pcs.h new file +56 -0
56 lines not on this page · raw message
Signature · 1 line
2.53.0
RFC PATCH v5 5/10 net: phylink: support late PCS provider attach
In reply to Christian MarangiAdd support for late PCS provider attachment to a phylink instance. This works by creating a global notifier for the PCS provider and making each phylink instance that makes use of fwnode subscribe to this notifier.
The PCS notifier will emit the event FWNODE_PCS_PROVIDER_ADD every time a new PCS provider is added.
phylink will then react to this event and will call the new function fwnode_phylink_pcs_get_from_fwnode() that will check if the PCS fwnode provided by the event is present in the phy-handle property of the phylink instance.
If a related PCS is found, then such PCS is added to the phylink instance PCS list.
Then we link the PCS to the phylink instance if it's not disable and we refresh the supported interfaces of the phylink instance.
Finally we check if we are in a major_config_failed scenario and trigger an interface reconfiguration in the next phylink resolve.
In the example scenario where the link was previously torn down due to removal of PCS, the link will be established again as the PCS came back and is now available to phylink.
--- drivers/net/pcs/pcs.c | 40 ++++++++++++++++++++++++++++++ drivers/net/phy/phylink.c | 52 +++++++++++++++++++++++++++++++++++++++ include/linux/pcs/pcs.h | 48 ++++++++++++++++++++++++++++++++++++ 3 files changed, 140 insertions(+)
drivers/net/pcs/pcs.c +40 -0
@@ -22,6 +22,13 @@ struct fwnode_pcs_provider {static LIST_HEAD (fwnode_pcs_providers);static DEFINE_MUTEX (fwnode_pcs_mutex); +static BLOCKING_NOTIFIER_HEAD (fwnode_pcs_notify_list); + +int register_fwnode_pcs_notifier (struct notifier_block *nb) +{ +return blocking_notifier_chain_register (&fwnode_pcs_notify_list, nb); +} +EXPORT_SYMBOL_GPL (register_fwnode_pcs_notifier);struct phylink_pcs *fwnode_pcs_simple_get (struct fwnode_reference_args *pcsspec,void *data)
@@ -55,6 +62,10 @@ int fwnode_pcs_add_provider(struct fwnode_handle *fwnode,fwnode_dev_initialized (fwnode, true); +blocking_notifier_call_chain (&fwnode_pcs_notify_list, +FWNODE_PCS_PROVIDER_ADD , + fwnode); +return 0 ; }EXPORT_SYMBOL_GPL (fwnode_pcs_add_provider);
@@ -147,6 +158,35 @@ struct phylink_pcs *fwnode_pcs_get(struct fwnode_handle *fwnode, int index) }EXPORT_SYMBOL_GPL (fwnode_pcs_get); +struct phylink_pcs * +fwnode_phylink_pcs_get_from_fwnode (struct fwnode_handle *fwnode, +struct fwnode_handle *pcs_fwnode) +{ +struct fwnode_reference_args pcsspec; +int index =0 ; +int ret; + +/* Loop until we find a matching PCS node or +* fwnode_parse_pcsspec() returns error +* if we don't have any other PCS reference to check. +*/ +while (true) { + ret =fwnode_parse_pcsspec (fwnode, index,NULL , &pcsspec); +if (ret) +return ERR_PTR (ret); + +/* Exit loop if we found the matching PCS node */ +if (pcsspec.fwnode == pcs_fwnode) +break ; + +/* Check the next PCS reference */ + index++; + } + +return fwnode_pcs_get (fwnode, index); +} +EXPORT_SYMBOL_GPL (fwnode_phylink_pcs_get_from_fwnode); +static int fwnode_phylink_pcs_count (struct fwnode_handle *fwnode,unsigned int *num_pcs) {
drivers/net/phy/phylink.c +52 -0
76 lines not on this page · raw message
include/linux/pcs/pcs.h +48 -0
73 lines not on this page · raw message
Signature · 1 line
2.53.0
RFC PATCH v5 6/10 dt-bindings: net: ethernet-controller: permit to define multiple PCS
In reply to Christian MarangiDrop the limitation of a single PCS in pcs-handle property. Multiple PCS can be defined for an ethrnet-controller node to support various PHY interface mode type.
It's very common for SoCs to have a 2 or more dedicated PCS for Base-X (for example SGMII, 1000base-x, 2500base-x, ...) and Base-R (for example USXGMII,10base-r, ...) with the MAC selecting one of the other based on the attached PHY.
--- Documentation/devicetree/bindings/net/ethernet-controller.yaml | 2 -- 1 file changed, 2 deletions(-)
Documentation/devicetree/bindings/net/ethernet-controller.yaml +0 -2
@@ -85,8 +85,6 @@ properties: pcs-handle: $ref: /schemas/types.yaml#/definitions/phandle-array - items: - maxItems: 1 description: Specifies a reference to a node representing a PCS PHY device on a MDIO bus to link with an external PHY (phy-handle) if exists.
Signature · 1 line
2.53.0
RFC PATCH v5 7/10 net: phylink: add .pcs_link_down PCS OP
In reply to Christian MarangiPermit for PCS driver to define specific operation to torn down the link between the MAC and the PCS.
This might be needed for some PCS that reset counter or require special reset to correctly work if the link needs to be restored later.
On phylink_link_down() call, the additional phylink_pcs_link_down() will be called before .mac_link_down to torn down the link.
PCS driver will need to define .pcs_link_down to make use of this.
--- drivers/net/phy/phylink.c | 8 ++++++++ include/linux/phylink.h | 2 ++ 2 files changed, 10 insertions(+)
drivers/net/phy/phylink.c +8 -0
@@ -1036,6 +1036,12 @@ static void phylink_pcs_link_up(struct phylink_pcs *pcs, unsigned int neg_mode, pcs->ops->pcs_link_up (pcs, neg_mode, interface, speed, duplex); } +static void phylink_pcs_link_down (struct phylink_pcs *pcs) +{ +if (pcs && pcs->ops->pcs_link_down) + pcs->ops->pcs_link_down (pcs); +} +static void phylink_pcs_disable_eee (struct phylink_pcs *pcs) {if (pcs && pcs->ops->pcs_disable_eee)
@@ -1735,6 +1741,8 @@ static void phylink_link_down(struct phylink *pl)phylink_deactivate_lpi (pl); +phylink_pcs_link_down (pl->pcs); + pl->mac_ops->mac_link_down (pl->config, pl->act_link_an_mode, pl->cur_interface);phylink_info (pl,"Link is Down\n" );
include/linux/phylink.h +2 -0
@@ -523,6 +523,7 @@ struct phylink_pcs {* @pcs_an_restart: restart 802.3z BaseX autonegotiation. * @pcs_link_up: program the PCS for the resolved link configuration * (where necessary). +* @pcs_link_down: torn down link between MAC and PCS. * @pcs_disable_eee: optional notification to PCS that EEE has been disabled * at the MAC. * @pcs_enable_eee: optional notification to PCS that EEE will be enabled at
@@ -550,6 +551,7 @@ struct phylink_pcs_ops {void (*pcs_an_restart)(struct phylink_pcs *pcs);void (*pcs_link_up)(struct phylink_pcs *pcs,unsigned int neg_mode,phy_interface_t interface,int speed,int duplex); +void (*pcs_link_down)(struct phylink_pcs *pcs);void (*pcs_disable_eee)(struct phylink_pcs *pcs);void (*pcs_enable_eee)(struct phylink_pcs *pcs);int (*pcs_pre_init)(struct phylink_pcs *pcs);
Signature · 1 line
2.53.0
RFC PATCH v5 8/10 dt-bindings: net: pcs: Document support for Airoha Ethernet PCS
In reply to Christian MarangiDocument support for Airoha Ethernet PCS for AN7581 SoC.
Airoha AN7581 SoC expose multiple Physical Coding Sublayer (PCS) for the various Serdes port supporting different Media Independent Interface (10BASE-R, USXGMII, 2500BASE-X, 1000BASE-X, SGMII).
This follow the new PCS provider with the use of #pcs-cells property.
--- .../bindings/net/pcs/airoha,pcs.yaml | 112 ++++++++++++++++++ 1 file changed, 112 insertions(+) create mode 100644 Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml new file +112 -0
@@ -0,0 +1,112 @@ +# SPDX-License-Identifier: GPL-2.0-only OR BSD-2-Clause +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/net/pcs/airoha,pcs.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: Airoha Ethernet PCS and Serdes + +maintainers: + - Christian Marangi <[email protected]> + +description: + Airoha AN7581 SoC expose multiple Physical Coding Sublayer (PCS) for + the various Serdes port supporting different Media Independent Interface + (10BASE-R, USXGMII, 2500BASE-X, 1000BASE-X, SGMII). + +properties: + compatible: + enum: + - airoha,an7581-pcs-eth + - airoha,an7581-pcs-pon + + reg: + items: + - description: XFI MAC reg + - description: HSGMII AN reg + - description: HSGMII PCS reg + - description: MULTI SGMII reg + - description: USXGMII reg + - description: HSGMII rate adaption reg + - description: XFI Analog register + - description: XFI PMA (Physical Medium Attachment) register + + reg-names: + items: + - const: xfi_mac + - const: hsgmii_an + - const: hsgmii_pcs + - const: multi_sgmii + - const: usxgmii + - const: hsgmii_rate_adp + - const: xfi_ana + - const: xfi_pma + + resets: + items: + - description: MAC reset + - description: PHY reset + + reset-names: + items: + - const: mac + - const: phy + + "#pcs-cells": + const: 0 + +required: + - compatible + - reg + - reg-names + - resets + - reset-names + - "#pcs-cells" + +additionalProperties: false + +examples: + - | + #include <dt-bindings/reset/airoha,en7581-reset.h> + + pcs@1fa08000 { + compatible = "airoha,an7581-pcs-pon"; + reg = <0x1fa08000 0x1000>, + <0x1fa80000 0x60>, + <0x1fa80a00 0x164>, + <0x1fa84000 0x450>, + <0x1fa85900 0x338>, + <0x1fa86000 0x300>, + <0x1fa8a000 0x1000>, + <0x1fa8b000 0x1000>; + reg-names = "xfi_mac", "hsgmii_an", "hsgmii_pcs", + "multi_sgmii", "usxgmii", + "hsgmii_rate_adp", "xfi_ana", "xfi_pma"; + + resets = <&scuclk EN7581_XPON_MAC_RST>, + <&scuclk EN7581_XPON_PHY_RST>; + reset-names = "mac", "phy"; + + #pcs-cells = <0>; + }; + + pcs@1fa09000 { + compatible = "airoha,an7581-pcs-eth"; + reg = <0x1fa09000 0x1000>, + <0x1fa70000 0x60>, + <0x1fa70a00 0x164>, + <0x1fa74000 0x450>, + <0x1fa75900 0x338>, + <0x1fa76000 0x300>, + <0x1fa7a000 0x1000>, + <0x1fa7b000 0x1000>; + reg-names = "xfi_mac", "hsgmii_an", "hsgmii_pcs", + "multi_sgmii", "usxgmii", + "hsgmii_rate_adp", "xfi_ana", "xfi_pma"; + + resets = <&scuclk EN7581_XSI_MAC_RST>, + <&scuclk EN7581_XSI_PHY_RST>; + reset-names = "mac", "phy"; + + #pcs-cells = <0>; + };
Signature · 1 line
2.53.0
Re: [net-next RFC PATCH v5 08/10] dt-bindings: net: pcs: Document support for Airoha Ethernet PCS
Hi.
Quoted 5 lines · Christian Marangi
Document support for Airoha Ethernet PCS for AN7581 SoC.
Airoha AN7581 SoC expose multiple Physical Coding Sublayer (PCS) for the various Serdes port supporting different Media Independent Interface (10BASE-R, USXGMII, 2500BASE-X, 1000BASE-X, SGMII).
10GBASE-R
Quoted 19 lines
This follow the new PCS provider with the use of #pcs-cells property.
Signed-off-by Christian Marangi <[email protected]>--- .../bindings/net/pcs/airoha,pcs.yaml | 112 ++++++++++++++++++ 1 file changed, 112 insertions(+)create mode 100644
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yamlDocumentation/devicetree/bindings/net/pcs/airoha,pcs.yaml new file +5
-0@@ -0,0 +1,112 @@ +# SPDX-License-Identifier: GPL-2.0-only OR BSD-2-Clause +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/net/pcs/airoha,pcs.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml#
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml line 15
Quoted 10 lines
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml new file +10
-0+ +title: Airoha Ethernet PCS and Serdes + +maintainers: + - Christian Marangi <[email protected]> + +description: + Airoha AN7581 SoC expose multiple Physical Coding Sublayer (PCS) for + the various Serdes port supporting different Media Independent Interface + (10BASE-R, USXGMII, 2500BASE-X, 1000BASE-X, SGMII).
10GBASE-R
Quoted 7 lines
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml new file +7
-0+ +properties: + compatible: + enum: + - airoha,an7581-pcs-eth + - airoha,an7581-pcs-pon +
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml line 32
Quoted 10 lines
Documentation/devicetree/bindings/net/pcs/airoha,pcs.yaml new file +10
-0+ reg: + items: + - description: XFI MAC reg + - description: HSGMII AN reg + - description: HSGMII PCS reg + - description: MULTI SGMII reg + - description: USXGMII reg + - description: HSGMII rate adaption reg + - description: XFI Analog register + - description: XFI PMA (Physical Medium Attachment) register
reg or register ?
MvH
Benjamin Larsson
RFC PATCH v5 9/10 net: pcs: airoha: add PCS driver for Airoha SoC
In reply to Christian MarangiAdd PCS driver for Airoha SoC for Ethernet Serdes and PCS and permit usage of external PHY or connected SFP cage. Supported modes are USXGMII, 10-BASER, 2500BASE-X, 1000BASE-X and SGMII.
The driver register as a PCS provider and supports poll mode to detect PCS port state. While interrupt is supported by the HW, there are some defect with the interrupt not fired on cable detach.
The PCS require complex calibration to correctly work and might require multiple try until the signal detection module "lock" on the signal level to correct work with the attached PHY.
--- drivers/net/pcs/Kconfig | 7 + drivers/net/pcs/Makefile | 1 + drivers/net/pcs/pcs-airoha.c | 2921 ++++++++++++++++++++++++++++++++++ 3 files changed, 2929 insertions(+) create mode 100644 drivers/net/pcs/pcs-airoha.c
drivers/net/pcs/Kconfig +7 -0
@@ -11,6 +11,13 @@ config FWNODE_PCS help Firmware node PCS accessors +config PCS_AIROHA + tristate "Airoha PCS driver" + select FWNODE_PCS + help + This module provides helper to phylink for managing the Airoha + PCS for SoC Ethernet Serdes and PCS. + config PCS_XPCS tristate "Synopsys DesignWare Ethernet XPCS" select PHYLINK
drivers/net/pcs/Makefile +1 -0
@@ -2,6 +2,7 @@ # Makefile for Linux PCS drivers obj-$(CONFIG_FWNODE_PCS) += pcs.o +obj-$(CONFIG_PCS_AIROHA) += pcs-airoha.o pcs_xpcs-$(CONFIG_PCS_XPCS) := pcs-xpcs.o pcs-xpcs-plat.o \ pcs-xpcs-nxp.o pcs-xpcs-wx.o
drivers/net/pcs/pcs-airoha.c new file +2921 -0
2,921 lines not on this page · raw message
Signature · 1 line
2.53.0
RFC PATCH v5 10/10 net: airoha: add phylink support for GDM2/3/4
In reply to Christian MarangiAdd phylink support for GDM2/3/4 port that require configuration of the PCS to make the external PHY or attached SFP cage work.
These needs to be defined in the GDM port node using the pcs-handle property.
--- drivers/net/ethernet/airoha/Kconfig | 1 + drivers/net/ethernet/airoha/airoha_eth.c | 144 +++++++++++++++++++++- drivers/net/ethernet/airoha/airoha_eth.h | 3 + drivers/net/ethernet/airoha/airoha_regs.h | 12 ++ 4 files changed, 159 insertions(+), 1 deletion(-)
drivers/net/ethernet/airoha/Kconfig +1 -0
@@ -20,6 +20,7 @@ config NET_AIROHA depends on NET_DSA || !NET_DSA select NET_AIROHA_NPU select PAGE_POOL + select PHYLINK help This driver supports the gigabit ethernet MACs in the Airoha SoC family.
drivers/net/ethernet/airoha/airoha_eth.c +143 -1
193 lines not on this page · raw message
drivers/net/ethernet/airoha/airoha_eth.h +3 -0
@@ -538,6 +538,9 @@ struct airoha_gdm_port {struct net_device *dev;int id; +struct phylink *phylink; +struct phylink_config phylink_config; +struct airoha_hw_stats stats;DECLARE_BITMAP (qos_sq_bmap,AIROHA_NUM_QOS_CHANNELS );
drivers/net/ethernet/airoha/airoha_regs.h +12 -0
@@ -358,6 +358,18 @@#define IP_FRAGMENT_PORT_MASK GENMASK(8, 5)#define IP_FRAGMENT_NBQ_MASK GENMASK(4, 0) +#define REG_GDMA4_TMBI_FRAG 0x2028 +#define GDMA4_SGMII1_TX_WEIGHT_MASK GENMASK(31, 26) +#define GDMA4_SGMII1_TX_FRAG_SIZE_MASK GENMASK(25, 16) +#define GDMA4_SGMII0_TX_WEIGHT_MASK GENMASK(15, 10) +#define GDMA4_SGMII0_TX_FRAG_SIZE_MASK GENMASK(9, 0) + +#define REG_GDMA4_RMBI_FRAG 0x202c +#define GDMA4_SGMII1_RX_WEIGHT_MASK GENMASK(31, 26) +#define GDMA4_SGMII1_RX_FRAG_SIZE_MASK GENMASK(25, 16) +#define GDMA4_SGMII0_RX_WEIGHT_MASK GENMASK(15, 10) +#define GDMA4_SGMII0_RX_FRAG_SIZE_MASK GENMASK(9, 0) +#define REG_MC_VLAN_EN 0x2100#define MC_VLAN_EN_MASK BIT(0)
Signature · 1 line
2.53.0
Lorenzo Bianconi
maintainerRe: [net-next RFC PATCH v5 10/10] net: airoha: add phylink support for GDM2/3/4
Quoted 7 lines
Add phylink support for GDM2/3/4 port that require configuration of the PCS to make the external PHY or attached SFP cage work.
These needs to be defined in the GDM port node using the pcs-handle property.
Signed-off-by Christian Marangi <[email protected]>
Hi Christian,
just a couple of nits inline.
Regards,
Lorenzo
Quoted 32 lines
--- drivers/net/ethernet/airoha/Kconfig | 1 + drivers/net/ethernet/airoha/airoha_eth.c | 144 +++++++++++++++++++++- drivers/net/ethernet/airoha/airoha_eth.h | 3 + drivers/net/ethernet/airoha/airoha_regs.h | 12 ++ 4 files changed, 159 insertions(+), 1 deletion(-)drivers/net/ethernet/airoha/Kconfig +1
-0@@ -20,6 +20,7 @@ config NET_AIROHA depends on NET_DSA || !NET_DSA select NET_AIROHA_NPU select PAGE_POOL + select PHYLINK help This driver supports the gigabit ethernet MACs in the Airoha SoC family.drivers/net/ethernet/airoha/airoha_eth.c +1
-0@@ -8,6 +8,7 @@#include <linux/of_reserved_mem.h> #include <linux/platform_device.h> #include <linux/tcp.h> +#include <linux/pcs/pcs.h> #include <linux/u64_stats_sync.h> #include <net/dst_metadata.h> #include <net/page_pool/helpers.h>
drivers/net/ethernet/airoha/airoha_eth.c static void airoha_qdma_irq_disable(struct airoha_irq_bank *irq_bank, · line 77
Quoted 6 lines
drivers/net/ethernet/airoha/airoha_eth.c +3
-0@@ -71,6 +72,11 @@ static void airoha_qdma_irq_disable(struct airoha_irq_bank *irq_bank,airoha_qdma_set_irqmask (irq_bank, index, mask,0 ); } +static bool airhoa_is_phy_external (struct airoha_gdm_port *port) +{ +return port->id !=1 ;
I guess you can use AIROHA_GDM1_IDX here.
Quoted 37 lines
drivers/net/ethernet/airoha/airoha_eth.c +18
-0+} +static void airoha_set_macaddr (struct airoha_gdm_port *port,const u8 *addr) {struct airoha_eth *eth = port->qdma->eth;@@ -1644,6 +1650,17 @@ static int airoha_dev_open(struct net_device *dev)struct airoha_qdma *qdma = port->qdma;u32 pse_port =FE_PSE_PORT_PPE1 ; +if (airhoa_is_phy_external (port)) { + err =phylink_of_phy_connect (port->phylink, dev->dev.of_node,0 ); +if (err) { +netdev_err (dev,"%s: could not attach PHY: %d\n" , __func__, + err); +return err; + } + +phylink_start (port->phylink); + } +netif_tx_start_all_queues (dev); err =airoha_set_vip_for_gdm_port (port, true);if (err)@@ -1707,6 +1724,11 @@ static int airoha_dev_stop(struct net_device *dev) } } +if (airhoa_is_phy_external (port)) { +phylink_stop (port->phylink); +phylink_disconnect_phy (port->phylink); + } +return 0 ; }@@ -2883,6 +2905,115 @@ bool airoha_is_valid_gdm_port(struct airoha_eth *eth,return false;
drivers/net/ethernet/airoha/airoha_eth.c bool airoha_is_valid_gdm_port(struct airoha_eth *eth, · line 2915
Quoted 10 lines
drivers/net/ethernet/airoha/airoha_eth.c +8
-0} +static void airoha_mac_link_up (struct phylink_config *config,struct phy_device *phy, +unsigned int mode,phy_interface_t interface, +int speed,int duplex,bool tx_pause,bool rx_pause) +{ + struct airoha_gdm_port *port = container_of(config, struct airoha_gdm_port, + phylink_config); +struct airoha_qdma *qdma = port->qdma; +struct airoha_eth *eth = qdma->eth;
since you do not need qdma pointer here, you can just do port->eth here.
drivers/net/ethernet/airoha/airoha_eth.c bool airoha_is_valid_gdm_port(struct airoha_eth *eth, · line 2918
Quoted 3 lines
drivers/net/ethernet/airoha/airoha_eth.c +3
-0+u32 frag_size_tx, frag_size_rx; + +if (port->id !=4 )
same here, AIROHA_GDM4_IDX
Quoted 102 lines
drivers/net/ethernet/airoha/airoha_eth.c +98
-0+return ; + +switch (speed) { +case SPEED_10000 : +case SPEED_5000 : + frag_size_tx =8 ; + frag_size_rx =8 ; +break ; +case SPEED_2500 : + frag_size_tx =2 ; + frag_size_rx =1 ; +break ; +default : + frag_size_tx =1 ; + frag_size_rx =0 ; + } + +/* Configure TX/RX frag based on speed */ +airoha_fe_rmw (eth,REG_GDMA4_TMBI_FRAG , +GDMA4_SGMII0_TX_FRAG_SIZE_MASK , +FIELD_PREP (GDMA4_SGMII0_TX_FRAG_SIZE_MASK , + frag_size_tx)); + +airoha_fe_rmw (eth,REG_GDMA4_RMBI_FRAG , +GDMA4_SGMII0_RX_FRAG_SIZE_MASK , +FIELD_PREP (GDMA4_SGMII0_RX_FRAG_SIZE_MASK , + frag_size_rx)); +} + +static const struct phylink_mac_ops airoha_phylink_ops = { + .mac_link_up = airoha_mac_link_up, +}; + +static int airoha_setup_phylink (struct net_device *dev) +{ +struct airoha_gdm_port *port =netdev_priv (dev); +struct device_node *np = dev->dev.of_node; +struct phylink_pcs **available_pcs; +phy_interface_t phy_mode; +struct phylink *phylink; +unsigned int num_pcs; +int err; + + err =of_get_phy_mode (np, &phy_mode); +if (err) { +dev_err (&dev->dev,"incorrect phy-mode\n" ); +return err; + } + + port->phylink_config.dev = &dev->dev; + port->phylink_config.type =PHYLINK_NETDEV ; + port->phylink_config.mac_capabilities =MAC_ASYM_PAUSE |MAC_SYM_PAUSE | +MAC_10 |MAC_100 |MAC_1000 |MAC_2500FD | +MAC_5000FD |MAC_10000FD ; + + err =fwnode_phylink_pcs_parse (dev_fwnode (&dev->dev),NULL , &num_pcs); +if (err) +return err; + + available_pcs =kcalloc (num_pcs,sizeof (*available_pcs),GFP_KERNEL ); +if (!available_pcs) +return -ENOMEM ; + + err =fwnode_phylink_pcs_parse (dev_fwnode (&dev->dev), available_pcs, + &num_pcs); +if (err) + goto out; + + port->phylink_config.available_pcs = available_pcs; + port->phylink_config.num_available_pcs = num_pcs; + +__set_bit (PHY_INTERFACE_MODE_SGMII , + port->phylink_config.supported_interfaces); +__set_bit (PHY_INTERFACE_MODE_1000BASEX , + port->phylink_config.supported_interfaces); +__set_bit (PHY_INTERFACE_MODE_2500BASEX , + port->phylink_config.supported_interfaces); +__set_bit (PHY_INTERFACE_MODE_USXGMII , + port->phylink_config.supported_interfaces); + +phy_interface_copy (port->phylink_config.pcs_interfaces, + port->phylink_config.supported_interfaces); + + phylink =phylink_create (&port->phylink_config, +of_fwnode_handle (np), + phy_mode, &airoha_phylink_ops); +if (IS_ERR (phylink)) { + err =PTR_ERR (phylink); + goto out; + } + + port->phylink = phylink; +out: +kfree (available_pcs); + +return err; +} +static int airoha_alloc_gdm_port (struct airoha_eth *eth,struct device_node *np) {
drivers/net/ethernet/airoha/airoha_eth.c static int airoha_alloc_gdm_port(struct airoha_eth *eth, · line 3089
Quoted 5 lines
drivers/net/ethernet/airoha/airoha_eth.c +2
-0@@ -2954,6 +3085,12 @@ static int airoha_alloc_gdm_port(struct airoha_eth *eth, port->id = id; eth->ports[p] = port; +if (airhoa_is_phy_external (port)) { + err =airoha_setup_phylink (dev);
should it be in airoha_register_gdm_devices()?
Quoted 69 lines
drivers/net/ethernet/airoha/airoha_eth.c +10
-1+if (err) +return err; + } +return airoha_metadata_dst_alloc (port); }@@ -3081,8 +3218,11 @@ static int airoha_probe(struct platform_device *pdev)if (!port)continue ; -if (port->dev->reg_state ==NETREG_REGISTERED ) +if (port->dev->reg_state ==NETREG_REGISTERED ) { +if (airhoa_is_phy_external (port)) +phylink_destroy (port->phylink);unregister_netdev (port->dev); + }airoha_metadata_dst_free (port); }airoha_hw_cleanup (eth);@@ -3107,6 +3247,8 @@ static void airoha_remove(struct platform_device *pdev)if (!port)continue ; +if (airhoa_is_phy_external (port)) +phylink_destroy (port->phylink);unregister_netdev (port->dev);airoha_metadata_dst_free (port); }drivers/net/ethernet/airoha/airoha_eth.h +3
-0@@ -538,6 +538,9 @@ struct airoha_gdm_port {struct net_device *dev;int id; +struct phylink *phylink; +struct phylink_config phylink_config; +struct airoha_hw_stats stats;DECLARE_BITMAP (qos_sq_bmap,AIROHA_NUM_QOS_CHANNELS );drivers/net/ethernet/airoha/airoha_regs.h +12
-0@@ -358,6 +358,18 @@#define IP_FRAGMENT_PORT_MASK GENMASK(8, 5)#define IP_FRAGMENT_NBQ_MASK GENMASK(4, 0) +#define REG_GDMA4_TMBI_FRAG 0x2028 +#define GDMA4_SGMII1_TX_WEIGHT_MASK GENMASK(31, 26) +#define GDMA4_SGMII1_TX_FRAG_SIZE_MASK GENMASK(25, 16) +#define GDMA4_SGMII0_TX_WEIGHT_MASK GENMASK(15, 10) +#define GDMA4_SGMII0_TX_FRAG_SIZE_MASK GENMASK(9, 0) + +#define REG_GDMA4_RMBI_FRAG 0x202c +#define GDMA4_SGMII1_RX_WEIGHT_MASK GENMASK(31, 26) +#define GDMA4_SGMII1_RX_FRAG_SIZE_MASK GENMASK(25, 16) +#define GDMA4_SGMII0_RX_WEIGHT_MASK GENMASK(15, 10) +#define GDMA4_SGMII0_RX_FRAG_SIZE_MASK GENMASK(9, 0) +#define REG_MC_VLAN_EN 0x2100#define MC_VLAN_EN_MASK BIT(0)Signature · 1 line
2.53.0