drivers: phy: rtl8211f: read chip ID in initialization

Read back chip ID firstly, it will be help to check MDIO works.

Signed-off-by: Jiafei Pan <[email protected]>

Author: JiafeiPan

drivers/ethernet/phy/phy_realtek_rtl8211f.c

@@ -27,6 +27,10 @@ LOG_MODULE_REGISTER(LOG_MODULE_NAME);
 
 #include "phy_mii.h"
 
+
+#define RTL8211F_PHY_ID1         0x001c
+#define PHY_READID_TIMEOUT_COUNT 1000U
+
 #define REALTEK_OUI_MSB (0x1CU)
 
 #define PHY_RT_RTL8211F_PHYSR_REG (0x1A)
@@ -441,6 +445,8 @@ static int phy_rt_rtl8211f_init(const struct device *dev)
 {
 	const struct rt_rtl8211f_config *config = dev->config;
 	struct rt_rtl8211f_data *data = dev->data;
+	uint32_t counter = PHY_READID_TIMEOUT_COUNT;
+	uint16_t phy_id1 = 0, phy_id2 = 0;
 	uint32_t reg_val;
 	int ret;
 
@@ -453,6 +459,18 @@ static int phy_rt_rtl8211f_init(const struct device *dev)
 
 	mdio_bus_enable(config->mdio_dev);
 
+	do {
+		if (phy_rt_rtl8211f_read(dev, MII_PHYID1R, &reg_val) < 0) {
+			return -EIO;
+		}
+	} while ((uint16_t)reg_val != RTL8211F_PHY_ID1 && counter-- > 0);
+	phy_id1 = (uint16_t)reg_val;
+	if (phy_rt_rtl8211f_read(dev, MII_PHYID2R, &reg_val) < 0) {
+		return -EIO;
+	}
+	phy_id2 = (uint16_t)reg_val;
+	LOG_INF("PHY (%d) ID %X\n", config->addr, ((uint32_t)phy_id1 << 16) | phy_id2);
+
 #if DT_ANY_INST_HAS_PROP_STATUS_OKAY(reset_gpios)
 	/* Configure reset pin */
 	if (config->reset_gpio.port) {