|
@@ -535,16 +535,16 @@ static int phy_poll_reset(struct phy_device *phydev)
|
|
|
|
|
|
int phy_init_hw(struct phy_device *phydev)
|
|
int phy_init_hw(struct phy_device *phydev)
|
|
{
|
|
{
|
|
- int ret;
|
|
|
|
|
|
+ int ret = 0;
|
|
|
|
|
|
if (!phydev->drv || !phydev->drv->config_init)
|
|
if (!phydev->drv || !phydev->drv->config_init)
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
- ret = phy_write(phydev, MII_BMCR, BMCR_RESET);
|
|
|
|
- if (ret < 0)
|
|
|
|
- return ret;
|
|
|
|
|
|
+ if (phydev->drv->soft_reset)
|
|
|
|
+ ret = phydev->drv->soft_reset(phydev);
|
|
|
|
+ else
|
|
|
|
+ ret = genphy_soft_reset(phydev);
|
|
|
|
|
|
- ret = phy_poll_reset(phydev);
|
|
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
return ret;
|
|
return ret;
|
|
|
|
|
|
@@ -1045,6 +1045,27 @@ static int gen10g_read_status(struct phy_device *phydev)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+/**
|
|
|
|
+ * genphy_soft_reset - software reset the PHY via BMCR_RESET bit
|
|
|
|
+ * @phydev: target phy_device struct
|
|
|
|
+ *
|
|
|
|
+ * Description: Perform a software PHY reset using the standard
|
|
|
|
+ * BMCR_RESET bit and poll for the reset bit to be cleared.
|
|
|
|
+ *
|
|
|
|
+ * Returns: 0 on success, < 0 on failure
|
|
|
|
+ */
|
|
|
|
+int genphy_soft_reset(struct phy_device *phydev)
|
|
|
|
+{
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ ret = phy_write(phydev, MII_BMCR, BMCR_RESET);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
|
|
+ return phy_poll_reset(phydev);
|
|
|
|
+}
|
|
|
|
+EXPORT_SYMBOL(genphy_soft_reset);
|
|
|
|
+
|
|
static int genphy_config_init(struct phy_device *phydev)
|
|
static int genphy_config_init(struct phy_device *phydev)
|
|
{
|
|
{
|
|
int val;
|
|
int val;
|
|
@@ -1091,6 +1112,12 @@ static int genphy_config_init(struct phy_device *phydev)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static int gen10g_soft_reset(struct phy_device *phydev)
|
|
|
|
+{
|
|
|
|
+ /* Do nothing for now */
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
static int gen10g_config_init(struct phy_device *phydev)
|
|
static int gen10g_config_init(struct phy_device *phydev)
|
|
{
|
|
{
|
|
/* Temporarily just say we support everything */
|
|
/* Temporarily just say we support everything */
|
|
@@ -1265,6 +1292,7 @@ static struct phy_driver genphy_driver[] = {
|
|
.phy_id = 0xffffffff,
|
|
.phy_id = 0xffffffff,
|
|
.phy_id_mask = 0xffffffff,
|
|
.phy_id_mask = 0xffffffff,
|
|
.name = "Generic PHY",
|
|
.name = "Generic PHY",
|
|
|
|
+ .soft_reset = genphy_soft_reset,
|
|
.config_init = genphy_config_init,
|
|
.config_init = genphy_config_init,
|
|
.features = 0,
|
|
.features = 0,
|
|
.config_aneg = genphy_config_aneg,
|
|
.config_aneg = genphy_config_aneg,
|
|
@@ -1277,6 +1305,7 @@ static struct phy_driver genphy_driver[] = {
|
|
.phy_id = 0xffffffff,
|
|
.phy_id = 0xffffffff,
|
|
.phy_id_mask = 0xffffffff,
|
|
.phy_id_mask = 0xffffffff,
|
|
.name = "Generic 10G PHY",
|
|
.name = "Generic 10G PHY",
|
|
|
|
+ .soft_reset = gen10g_soft_reset,
|
|
.config_init = gen10g_config_init,
|
|
.config_init = gen10g_config_init,
|
|
.features = 0,
|
|
.features = 0,
|
|
.config_aneg = gen10g_config_aneg,
|
|
.config_aneg = gen10g_config_aneg,
|