Commit 5ba33cf4 authored by Russell King's avatar Russell King Committed by David S. Miller

net: phy: set devices_in_package only after validation

Only set the devices_in_package to a non-zero value if we find a valid
value for this field, so we avoid leaving it set to e.g. 0x1fffffff.
Reviewed-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Signed-off-by: default avatarRussell King <rmk+kernel@armlinux.org.uk>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent c746053d
...@@ -732,13 +732,13 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr, ...@@ -732,13 +732,13 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr,
struct phy_c45_device_ids *c45_ids) struct phy_c45_device_ids *c45_ids)
{ {
const int num_ids = ARRAY_SIZE(c45_ids->device_ids); const int num_ids = ARRAY_SIZE(c45_ids->device_ids);
u32 *devs = &c45_ids->devices_in_package; u32 devs_in_pkg = 0;
int i, ret, phy_reg; int i, ret, phy_reg;
/* Find first non-zero Devices In package. Device zero is reserved /* Find first non-zero Devices In package. Device zero is reserved
* for 802.3 c45 complied PHYs, so don't probe it at first. * for 802.3 c45 complied PHYs, so don't probe it at first.
*/ */
for (i = 1; i < MDIO_MMD_NUM && *devs == 0; i++) { for (i = 1; i < MDIO_MMD_NUM && devs_in_pkg == 0; i++) {
if (i == MDIO_MMD_VEND1 || i == MDIO_MMD_VEND2) { if (i == MDIO_MMD_VEND1 || i == MDIO_MMD_VEND2) {
/* Check that there is a device present at this /* Check that there is a device present at this
* address before reading the devices-in-package * address before reading the devices-in-package
...@@ -753,28 +753,28 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr, ...@@ -753,28 +753,28 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr,
if (!ret) if (!ret)
continue; continue;
} }
phy_reg = get_phy_c45_devs_in_pkg(bus, addr, i, devs); phy_reg = get_phy_c45_devs_in_pkg(bus, addr, i, &devs_in_pkg);
if (phy_reg < 0) if (phy_reg < 0)
return -EIO; return -EIO;
} }
if ((*devs & 0x1fffffff) == 0x1fffffff) { if ((devs_in_pkg & 0x1fffffff) == 0x1fffffff) {
/* If mostly Fs, there is no device there, then let's probe /* If mostly Fs, there is no device there, then let's probe
* MMD 0, as some 10G PHYs have zero Devices In package, * MMD 0, as some 10G PHYs have zero Devices In package,
* e.g. Cortina CS4315/CS4340 PHY. * e.g. Cortina CS4315/CS4340 PHY.
*/ */
phy_reg = get_phy_c45_devs_in_pkg(bus, addr, 0, devs); phy_reg = get_phy_c45_devs_in_pkg(bus, addr, 0, &devs_in_pkg);
if (phy_reg < 0) if (phy_reg < 0)
return -EIO; return -EIO;
/* no device there, let's get out of here */ /* no device there, let's get out of here */
if ((*devs & 0x1fffffff) == 0x1fffffff) if ((devs_in_pkg & 0x1fffffff) == 0x1fffffff)
return -ENODEV; return -ENODEV;
} }
/* Now probe Device Identifiers for each device present. */ /* Now probe Device Identifiers for each device present. */
for (i = 1; i < num_ids; i++) { for (i = 1; i < num_ids; i++) {
if (!(c45_ids->devices_in_package & (1 << i))) if (!(devs_in_pkg & (1 << i)))
continue; continue;
phy_reg = mdiobus_c45_read(bus, addr, i, MII_PHYSID1); phy_reg = mdiobus_c45_read(bus, addr, i, MII_PHYSID1);
...@@ -788,6 +788,8 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr, ...@@ -788,6 +788,8 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr,
c45_ids->device_ids[i] |= phy_reg; c45_ids->device_ids[i] |= phy_reg;
} }
c45_ids->devices_in_package = devs_in_pkg;
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment