Commit 0ccb4fc6 authored by Russell King's avatar Russell King Committed by David S. Miller
Browse files

net: phy: move phy_lookup_setting() and guts of phy_supported_speeds() to phy-core 



phy_lookup_setting() provides useful functionality in ethtool code
outside phylib.  Move it to phy-core and allow it to be re-used (eg,
in phylink) rather than duplicated elsewhere.  Note that this supports
the larger linkmode space.

As we move the phy settings table, we also need to move the guts of
phy_supported_speeds() as well.

Signed-off-by: default avatarRussell King <rmk+kernel@armlinux.org.uk>
Reviewed-by: default avatarAndrew Lunn <andrew@lunn.ch>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent da4625ac

drivers/net/phy/phy-core.c

+126 −0
Original line number Diff line number Diff line
@@ -58,6 +58,132 @@ const char *phy_duplex_to_str(unsigned int duplex) 
}

EXPORT_SYMBOL_GPL(phy_duplex_to_str);



/* A mapping of all SUPPORTED settings to speed/duplex.  This table

 * must be grouped by speed and sorted in descending match priority

 * - iow, descending speed. */

static const struct phy_setting settings[] = {

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseKR_Full_BIT,

	},

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT,

	},

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseT_Full_BIT,

	},

	{

		.speed = SPEED_2500,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_2500baseX_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_1000baseKX_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_1000baseT_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_1000baseT_Half_BIT,

	},

	{

		.speed = SPEED_100,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_100baseT_Full_BIT,

	},

	{

		.speed = SPEED_100,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_100baseT_Half_BIT,

	},

	{

		.speed = SPEED_10,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10baseT_Full_BIT,

	},

	{

		.speed = SPEED_10,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_10baseT_Half_BIT,

	},

};



/**

 * phy_lookup_setting - lookup a PHY setting

 * @speed: speed to match

 * @duplex: duplex to match

 * @mask: allowed link modes

 * @maxbit: bit size of link modes

 * @exact: an exact match is required

 *

 * Search the settings array for a setting that matches the speed and

 * duplex, and which is supported.

 *

 * If @exact is unset, either an exact match or %NULL for no match will

 * be returned.

 *

 * If @exact is set, an exact match, the fastest supported setting at

 * or below the specified speed, the slowest supported setting, or if

 * they all fail, %NULL will be returned.

 */

const struct phy_setting *

phy_lookup_setting(int speed, int duplex, const unsigned long *mask,

		   size_t maxbit, bool exact)

{

	const struct phy_setting *p, *match = NULL, *last = NULL;

	int i;



	for (i = 0, p = settings; i < ARRAY_SIZE(settings); i++, p++) {

		if (p->bit < maxbit && test_bit(p->bit, mask)) {

			last = p;

			if (p->speed == speed && p->duplex == duplex) {

				/* Exact match for speed and duplex */

				match = p;

				break;

			} else if (!exact) {

				if (!match && p->speed <= speed)

					/* Candidate */

					match = p;



				if (p->speed < speed)

					break;

			}

		}

	}



	if (!match && !exact)

		match = last;



	return match;

}

EXPORT_SYMBOL_GPL(phy_lookup_setting);



size_t phy_speeds(unsigned int *speeds, size_t size,

		  unsigned long *mask, size_t maxbit)

{

	size_t count;

	int i;



	for (i = 0, count = 0; i < ARRAY_SIZE(settings) && count < size; i++)

		if (settings[i].bit < maxbit &&

		    test_bit(settings[i].bit, mask) &&

		    (count == 0 || speeds[count - 1] != settings[i].speed))

			speeds[count++] = settings[i].speed;



	return count;

}



static void mmd_phy_indirect(struct mii_bus *bus, int phy_addr, int devad,

			     u16 regnum)

{

drivers/net/phy/phy.c

+1 −129
Original line number Diff line number Diff line
@@ -157,125 +157,6 @@ int phy_aneg_done(struct phy_device *phydev) 
}

EXPORT_SYMBOL(phy_aneg_done);



/* A structure for mapping a particular speed and duplex

 * combination to a particular SUPPORTED and ADVERTISED value

 */

struct phy_setting {

	int speed;

	int duplex;

	int bit;

};



/* A mapping of all SUPPORTED settings to speed/duplex.  This table

 * must be grouped by speed and sorted in descending match priority

 * - iow, descending speed. */

static const struct phy_setting settings[] = {

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseKR_Full_BIT,

	},

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT,

	},

	{

		.speed = SPEED_10000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10000baseT_Full_BIT,

	},

	{

		.speed = SPEED_2500,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_2500baseX_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_1000baseKX_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_1000baseT_Full_BIT,

	},

	{

		.speed = SPEED_1000,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_1000baseT_Half_BIT,

	},

	{

		.speed = SPEED_100,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_100baseT_Full_BIT,

	},

	{

		.speed = SPEED_100,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_100baseT_Half_BIT,

	},

	{

		.speed = SPEED_10,

		.duplex = DUPLEX_FULL,

		.bit = ETHTOOL_LINK_MODE_10baseT_Full_BIT,

	},

	{

		.speed = SPEED_10,

		.duplex = DUPLEX_HALF,

		.bit = ETHTOOL_LINK_MODE_10baseT_Half_BIT,

	},

};



/**

 * phy_lookup_setting - lookup a PHY setting

 * @speed: speed to match

 * @duplex: duplex to match

 * @mask: allowed link modes

 * @maxbit: bit size of link modes

 * @exact: an exact match is required

 *

 * Search the settings array for a setting that matches the speed and

 * duplex, and which is supported.

 *

 * If @exact is unset, either an exact match or %NULL for no match will

 * be returned.

 *

 * If @exact is set, an exact match, the fastest supported setting at

 * or below the specified speed, the slowest supported setting, or if

 * they all fail, %NULL will be returned.

 */

static const struct phy_setting *

phy_lookup_setting(int speed, int duplex, const unsigned long *mask,

		   size_t maxbit, bool exact)

{

	const struct phy_setting *p, *match = NULL, *last = NULL;

	int i;



	for (i = 0, p = settings; i < ARRAY_SIZE(settings); i++, p++) {

		if (p->bit < maxbit && test_bit(p->bit, mask)) {

			last = p;

			if (p->speed == speed && p->duplex == duplex) {

				/* Exact match for speed and duplex */

				match = p;

				break;

			} else if (!exact) {

				if (!match && p->speed <= speed)

					/* Candidate */

					match = p;



				if (p->speed < speed)

					break;

			}

		}

	}



	if (!match && !exact)

		match = last;



	return match;

}



/**

 * phy_find_valid - find a PHY setting that matches the requested parameters

 * @speed: desired speed
@@ -312,17 +193,8 @@ unsigned int phy_supported_speeds(struct phy_device *phy, 
				  unsigned int size)

{

	unsigned long supported = phy->supported;

	unsigned int count = 0;

	unsigned int idx = 0;



	for (idx = 0; idx < ARRAY_SIZE(settings) && count < size; idx++)

		/* Assumes settings are grouped by speed */

		if (settings[idx].bit < BITS_PER_LONG &&

		    !test_bit(settings[idx].bit, &supported) &&

		    (count == 0 || speeds[count - 1] != settings[idx].speed))

			speeds[count++] = settings[idx].speed;



	return count;

	return phy_speeds(speeds, size, &supported, BITS_PER_LONG);

}



/**

include/linux/phy.h

+15 −0
Original line number Diff line number Diff line
@@ -670,6 +670,21 @@ struct phy_fixup { 
const char *phy_speed_to_str(int speed);

const char *phy_duplex_to_str(unsigned int duplex);



/* A structure for mapping a particular speed and duplex

 * combination to a particular SUPPORTED and ADVERTISED value

 */

struct phy_setting {

	u32 speed;

	u8 duplex;

	u8 bit;

};



const struct phy_setting *

phy_lookup_setting(int speed, int duplex, const unsigned long *mask,

		   size_t maxbit, bool exact);

size_t phy_speeds(unsigned int *speeds, size_t size,

		  unsigned long *mask, size_t maxbit);



/**

 * phy_read_mmd - Convenience function for reading a register

 * from an MMD on a given PHY.

CRA Git | Maintained and supported by SUSTech CRA and CCSE