Commit 34ae2c09 authored by Russell King (Oracle)'s avatar Russell King (Oracle) Committed by David S. Miller
Browse files

net: phylink: add generic validate implementation 



Add a generic validate() implementation using the supported_interfaces
and a bitmask of MAC pause/speed/duplex capabilities. This allows us
to entirely eliminate many driver private validate() implementations.

We expose the underlying phylink_get_linkmodes() function so that
drivers which have special needs can still benefit from conversion.

Signed-off-by: default avatarRussell King (Oracle) <rmk+kernel@armlinux.org.uk>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 5cf46d8e

drivers/net/phy/phylink.c

+252 −0
Original line number Diff line number Diff line
@@ -166,6 +166,258 @@ static const char *phylink_an_mode_str(unsigned int mode) 
	return mode < ARRAY_SIZE(modestr) ? modestr[mode] : "unknown";

}



static void phylink_caps_to_linkmodes(unsigned long *linkmodes,

				      unsigned long caps)

{

	if (caps & MAC_SYM_PAUSE)

		__set_bit(ETHTOOL_LINK_MODE_Pause_BIT, linkmodes);



	if (caps & MAC_ASYM_PAUSE)

		__set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, linkmodes);



	if (caps & MAC_10HD)

		__set_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, linkmodes);



	if (caps & MAC_10FD)

		__set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, linkmodes);



	if (caps & MAC_100HD) {

		__set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT, linkmodes);

	}



	if (caps & MAC_100FD) {

		__set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100baseT1_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT, linkmodes);

	}



	if (caps & MAC_1000HD)

		__set_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, linkmodes);



	if (caps & MAC_1000FD) {

		__set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_1000baseT1_Full_BIT, linkmodes);

	}



	if (caps & MAC_2500FD) {

		__set_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_2500baseX_Full_BIT, linkmodes);

	}



	if (caps & MAC_5000FD)

		__set_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT, linkmodes);



	if (caps & MAC_10000FD) {

		__set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseKR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT, linkmodes);

	}



	if (caps & MAC_25000FD) {

		__set_bit(ETHTOOL_LINK_MODE_25000baseCR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_25000baseKR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_25000baseSR_Full_BIT, linkmodes);

	}



	if (caps & MAC_40000FD) {

		__set_bit(ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT, linkmodes);

	}



	if (caps & MAC_50000FD) {

		__set_bit(ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseSR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseKR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseSR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseCR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseLR_ER_FR_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_50000baseDR_Full_BIT, linkmodes);

	}



	if (caps & MAC_56000FD) {

		__set_bit(ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT, linkmodes);

	}



	if (caps & MAC_100000FD) {

		__set_bit(ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseKR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseSR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseCR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseLR2_ER2_FR2_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseDR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseKR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseSR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseLR_ER_FR_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseCR_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_100000baseDR_Full_BIT, linkmodes);

	}



	if (caps & MAC_200000FD) {

		__set_bit(ETHTOOL_LINK_MODE_200000baseKR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseSR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseLR4_ER4_FR4_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseDR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseCR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseKR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseSR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseLR2_ER2_FR2_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseDR2_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_200000baseCR2_Full_BIT, linkmodes);

	}



	if (caps & MAC_400000FD) {

		__set_bit(ETHTOOL_LINK_MODE_400000baseKR8_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseSR8_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseLR8_ER8_FR8_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseDR8_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseCR8_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseKR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseSR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseLR4_ER4_FR4_Full_BIT,

			  linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseDR4_Full_BIT, linkmodes);

		__set_bit(ETHTOOL_LINK_MODE_400000baseCR4_Full_BIT, linkmodes);

	}

}



/**

 * phylink_get_linkmodes() - get acceptable link modes

 * @linkmodes: ethtool linkmode mask (must be already initialised)

 * @interface: phy interface mode defined by &typedef phy_interface_t

 * @mac_capabilities: bitmask of MAC capabilities

 *

 * Set all possible pause, speed and duplex linkmodes in @linkmodes that

 * are supported by the @interface mode and @mac_capabilities. @linkmodes

 * must have been initialised previously.

 */

void phylink_get_linkmodes(unsigned long *linkmodes, phy_interface_t interface,

			   unsigned long mac_capabilities)

{

	unsigned long caps = MAC_SYM_PAUSE | MAC_ASYM_PAUSE;



	switch (interface) {

	case PHY_INTERFACE_MODE_USXGMII:

		caps |= MAC_10000FD | MAC_5000FD | MAC_2500FD;

		fallthrough;



	case PHY_INTERFACE_MODE_RGMII_TXID:

	case PHY_INTERFACE_MODE_RGMII_RXID:

	case PHY_INTERFACE_MODE_RGMII_ID:

	case PHY_INTERFACE_MODE_RGMII:

	case PHY_INTERFACE_MODE_QSGMII:

	case PHY_INTERFACE_MODE_SGMII:

	case PHY_INTERFACE_MODE_GMII:

		caps |= MAC_1000HD | MAC_1000FD;

		fallthrough;



	case PHY_INTERFACE_MODE_REVRMII:

	case PHY_INTERFACE_MODE_RMII:

	case PHY_INTERFACE_MODE_REVMII:

	case PHY_INTERFACE_MODE_MII:

		caps |= MAC_10HD | MAC_10FD;

		fallthrough;



	case PHY_INTERFACE_MODE_100BASEX:

		caps |= MAC_100HD | MAC_100FD;

		break;



	case PHY_INTERFACE_MODE_TBI:

	case PHY_INTERFACE_MODE_MOCA:

	case PHY_INTERFACE_MODE_RTBI:

	case PHY_INTERFACE_MODE_1000BASEX:

		caps |= MAC_1000HD;

		fallthrough;

	case PHY_INTERFACE_MODE_TRGMII:

		caps |= MAC_1000FD;

		break;



	case PHY_INTERFACE_MODE_2500BASEX:

		caps |= MAC_2500FD;

		break;



	case PHY_INTERFACE_MODE_5GBASER:

		caps |= MAC_5000FD;

		break;



	case PHY_INTERFACE_MODE_XGMII:

	case PHY_INTERFACE_MODE_RXAUI:

	case PHY_INTERFACE_MODE_XAUI:

	case PHY_INTERFACE_MODE_10GBASER:

	case PHY_INTERFACE_MODE_10GKR:

		caps |= MAC_10000FD;

		break;



	case PHY_INTERFACE_MODE_25GBASER:

		caps |= MAC_25000FD;

		break;



	case PHY_INTERFACE_MODE_XLGMII:

		caps |= MAC_40000FD;

		break;



	case PHY_INTERFACE_MODE_INTERNAL:

		caps |= ~0;

		break;



	case PHY_INTERFACE_MODE_NA:

	case PHY_INTERFACE_MODE_MAX:

	case PHY_INTERFACE_MODE_SMII:

		break;

	}



	phylink_caps_to_linkmodes(linkmodes, caps & mac_capabilities);

}

EXPORT_SYMBOL_GPL(phylink_get_linkmodes);



/**

 * phylink_generic_validate() - generic validate() callback implementation

 * @config: a pointer to a &struct phylink_config.

 * @supported: ethtool bitmask for supported link modes.

 * @state: a pointer to a &struct phylink_link_state.

 *

 * Generic implementation of the validate() callback that MAC drivers can

 * use when they pass the range of supported interfaces and MAC capabilities.

 * This makes use of phylink_get_linkmodes().

 */

void phylink_generic_validate(struct phylink_config *config,

			      unsigned long *supported,

			      struct phylink_link_state *state)

{

	__ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, };



	phylink_set_port_modes(mask);

	phylink_set(mask, Autoneg);

	phylink_get_linkmodes(mask, state->interface, config->mac_capabilities);



	linkmode_and(supported, supported, mask);

	linkmode_and(state->advertising, state->advertising, mask);

}

EXPORT_SYMBOL_GPL(phylink_generic_validate);



static int phylink_validate_any(struct phylink *pl, unsigned long *supported,

				struct phylink_link_state *state)

{

include/linux/phylink.h

+31 −0
Original line number Diff line number Diff line
@@ -20,6 +20,29 @@ enum { 
	MLO_AN_PHY = 0,	/* Conventional PHY */

	MLO_AN_FIXED,	/* Fixed-link mode */

	MLO_AN_INBAND,	/* In-band protocol */



	MAC_SYM_PAUSE	= BIT(0),

	MAC_ASYM_PAUSE	= BIT(1),

	MAC_10HD	= BIT(2),

	MAC_10FD	= BIT(3),

	MAC_10		= MAC_10HD | MAC_10FD,

	MAC_100HD	= BIT(4),

	MAC_100FD	= BIT(5),

	MAC_100		= MAC_100HD | MAC_100FD,

	MAC_1000HD	= BIT(6),

	MAC_1000FD	= BIT(7),

	MAC_1000	= MAC_1000HD | MAC_1000FD,

	MAC_2500FD	= BIT(8),

	MAC_5000FD	= BIT(9),

	MAC_10000FD	= BIT(10),

	MAC_20000FD	= BIT(11),

	MAC_25000FD	= BIT(12),

	MAC_40000FD	= BIT(13),

	MAC_50000FD	= BIT(14),

	MAC_56000FD	= BIT(15),

	MAC_100000FD	= BIT(16),

	MAC_200000FD	= BIT(17),

	MAC_400000FD	= BIT(18),

};



static inline bool phylink_autoneg_inband(unsigned int mode)
@@ -69,6 +92,7 @@ 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.

 * @mac_capabilities: MAC pause/speed/duplex capabilities.

 */

struct phylink_config {

	struct device *dev;
@@ -79,6 +103,7 @@ struct phylink_config { 
	void (*get_fixed_state)(struct phylink_config *config,

				struct phylink_link_state *state);

	DECLARE_PHY_INTERFACE_MASK(supported_interfaces);

	unsigned long mac_capabilities;

};



/**
@@ -442,6 +467,12 @@ void pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, 
		 phy_interface_t interface, int speed, int duplex);

#endif



void phylink_get_linkmodes(unsigned long *linkmodes, phy_interface_t interface,

			   unsigned long mac_capabilities);

void phylink_generic_validate(struct phylink_config *config,

			      unsigned long *supported,

			      struct phylink_link_state *state);



struct phylink *phylink_create(struct phylink_config *, struct fwnode_handle *,

			       phy_interface_t iface,

			       const struct phylink_mac_ops *mac_ops);