net: phy: make of_set_phy_supported work with genphy driver
of_set_phy_supported allows overwiting hardware capabilities of a phy with values from the devicetree. of_set_phy_supported is called right after phy_device_register in the assumption that phy_probe is called from phy_device_register and the features of the phy are already initialized. For the genphy driver this is not true, here phy_probe is called later during phy_connect time. phy_probe will then overwrite all settings done from of_set_phy_supported Fix this by moving of_set_phy_supported to the core phy code and calling it from phy_probe. Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
c242a47238
commit
de906af1cf
@ -33,6 +33,7 @@
|
|||||||
#include <linux/mdio.h>
|
#include <linux/mdio.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
#include <linux/uaccess.h>
|
#include <linux/uaccess.h>
|
||||||
|
#include <linux/of.h>
|
||||||
|
|
||||||
#include <asm/irq.h>
|
#include <asm/irq.h>
|
||||||
|
|
||||||
@ -1166,6 +1167,38 @@ static int gen10g_resume(struct phy_device *phydev)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void of_set_phy_supported(struct phy_device *phydev)
|
||||||
|
{
|
||||||
|
struct device_node *node = phydev->dev.of_node;
|
||||||
|
u32 max_speed;
|
||||||
|
|
||||||
|
if (!IS_ENABLED(CONFIG_OF_MDIO))
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (!node)
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (!of_property_read_u32(node, "max-speed", &max_speed)) {
|
||||||
|
/* The default values for phydev->supported are provided by the PHY
|
||||||
|
* driver "features" member, we want to reset to sane defaults fist
|
||||||
|
* before supporting higher speeds.
|
||||||
|
*/
|
||||||
|
phydev->supported &= PHY_DEFAULT_FEATURES;
|
||||||
|
|
||||||
|
switch (max_speed) {
|
||||||
|
default:
|
||||||
|
return;
|
||||||
|
|
||||||
|
case SPEED_1000:
|
||||||
|
phydev->supported |= PHY_1000BT_FEATURES;
|
||||||
|
case SPEED_100:
|
||||||
|
phydev->supported |= PHY_100BT_FEATURES;
|
||||||
|
case SPEED_10:
|
||||||
|
phydev->supported |= PHY_10BT_FEATURES;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* phy_probe - probe and init a PHY device
|
* phy_probe - probe and init a PHY device
|
||||||
* @dev: device to probe and init
|
* @dev: device to probe and init
|
||||||
@ -1200,7 +1233,8 @@ static int phy_probe(struct device *dev)
|
|||||||
* or both of these values
|
* or both of these values
|
||||||
*/
|
*/
|
||||||
phydev->supported = phydrv->features;
|
phydev->supported = phydrv->features;
|
||||||
phydev->advertising = phydrv->features;
|
of_set_phy_supported(phydev);
|
||||||
|
phydev->advertising = phydev->supported;
|
||||||
|
|
||||||
/* Set the state to READY by default */
|
/* Set the state to READY by default */
|
||||||
phydev->state = PHY_READY;
|
phydev->state = PHY_READY;
|
||||||
|
@ -23,27 +23,6 @@
|
|||||||
MODULE_AUTHOR("Grant Likely <grant.likely@secretlab.ca>");
|
MODULE_AUTHOR("Grant Likely <grant.likely@secretlab.ca>");
|
||||||
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
||||||
|
|
||||||
static void of_set_phy_supported(struct phy_device *phydev, u32 max_speed)
|
|
||||||
{
|
|
||||||
/* The default values for phydev->supported are provided by the PHY
|
|
||||||
* driver "features" member, we want to reset to sane defaults fist
|
|
||||||
* before supporting higher speeds.
|
|
||||||
*/
|
|
||||||
phydev->supported &= PHY_DEFAULT_FEATURES;
|
|
||||||
|
|
||||||
switch (max_speed) {
|
|
||||||
default:
|
|
||||||
return;
|
|
||||||
|
|
||||||
case SPEED_1000:
|
|
||||||
phydev->supported |= PHY_1000BT_FEATURES;
|
|
||||||
case SPEED_100:
|
|
||||||
phydev->supported |= PHY_100BT_FEATURES;
|
|
||||||
case SPEED_10:
|
|
||||||
phydev->supported |= PHY_10BT_FEATURES;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Extract the clause 22 phy ID from the compatible string of the form
|
/* Extract the clause 22 phy ID from the compatible string of the form
|
||||||
* ethernet-phy-idAAAA.BBBB */
|
* ethernet-phy-idAAAA.BBBB */
|
||||||
static int of_get_phy_id(struct device_node *device, u32 *phy_id)
|
static int of_get_phy_id(struct device_node *device, u32 *phy_id)
|
||||||
@ -104,11 +83,6 @@ static int of_mdiobus_register_phy(struct mii_bus *mdio, struct device_node *chi
|
|||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Set phydev->supported based on the "max-speed" property
|
|
||||||
* if present */
|
|
||||||
if (!of_property_read_u32(child, "max-speed", &max_speed))
|
|
||||||
of_set_phy_supported(phy, max_speed);
|
|
||||||
|
|
||||||
dev_dbg(&mdio->dev, "registered phy %s at address %i\n",
|
dev_dbg(&mdio->dev, "registered phy %s at address %i\n",
|
||||||
child->name, addr);
|
child->name, addr);
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user