[PATCH net-next 1/1] net: phy: Add additional logics on probing C45 PHY devices

[Wong Vee Khee]

For clause 45 PHY, introduce additional logics in get_phy_c45_ids() to
check if there is at least one valid device ID, return 0 on true, and
-ENODEV otherwise.

Signed-off-by: Wong Vee Khee <vee.khee.w...@intel.com>
---
 drivers/net/phy/phy_device.c | 10 ++++++++++
 1 file changed, 10 insertions(+)

diff --git a/drivers/net/phy/phy_device.c b/drivers/net/phy/phy_device.c
index e13a46c25437..c9ddcd7a63d4 100644
--- a/drivers/net/phy/phy_device.c
+++ b/drivers/net/phy/phy_device.c
@@ -730,6 +730,7 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr,
        const int num_ids = ARRAY_SIZE(c45_ids->device_ids);
        u32 devs_in_pkg = 0;
        int i, ret, phy_reg;
+       u32 valid_did = 0;
 
        /* Find first non-zero Devices In package. Device zero is reserved
         * for 802.3 c45 complied PHYs, so don't probe it at first.
@@ -796,12 +797,21 @@ static int get_phy_c45_ids(struct mii_bus *bus, int addr,
                if (phy_reg < 0)
                        return -EIO;
                c45_ids->device_ids[i] |= phy_reg;
+
+               /* Check if there is at least one valid device ID */
+               if (c45_ids->device_ids[i] &&
+                   (c45_ids->device_ids[i] & 0x1fffffff) != 0x1fffffff)
+                       valid_did |= (1 << i);
        }
 
        c45_ids->devices_in_package = devs_in_pkg;
        /* Bit 0 doesn't represent a device, it indicates c22 regs presence */
        c45_ids->mmds_present = devs_in_pkg & ~BIT(0);
 
+       /* There is no valid device ID */
+       if (!valid_did)
+               return -ENODEV;
+
        return 0;
 }
 
-- 
2.17.0