|
@@ -297,6 +297,17 @@ static int kszphy_config_init(struct phy_device *phydev)
|
|
if (priv->led_mode >= 0)
|
|
if (priv->led_mode >= 0)
|
|
kszphy_setup_led(phydev, type->led_mode_reg, priv->led_mode);
|
|
kszphy_setup_led(phydev, type->led_mode_reg, priv->led_mode);
|
|
|
|
|
|
|
|
+ if (phy_interrupt_is_valid(phydev)) {
|
|
|
|
+ int ctl = phy_read(phydev, MII_BMCR);
|
|
|
|
+
|
|
|
|
+ if (ctl < 0)
|
|
|
|
+ return ctl;
|
|
|
|
+
|
|
|
|
+ ret = phy_write(phydev, MII_BMCR, ctl & ~BMCR_ANENABLE);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ }
|
|
|
|
+
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -635,6 +646,21 @@ static void kszphy_get_stats(struct phy_device *phydev,
|
|
data[i] = kszphy_get_stat(phydev, i);
|
|
data[i] = kszphy_get_stat(phydev, i);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static int kszphy_resume(struct phy_device *phydev)
|
|
|
|
+{
|
|
|
|
+ int value;
|
|
|
|
+
|
|
|
|
+ mutex_lock(&phydev->lock);
|
|
|
|
+
|
|
|
|
+ value = phy_read(phydev, MII_BMCR);
|
|
|
|
+ phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN);
|
|
|
|
+
|
|
|
|
+ kszphy_config_intr(phydev);
|
|
|
|
+ mutex_unlock(&phydev->lock);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
static int kszphy_probe(struct phy_device *phydev)
|
|
static int kszphy_probe(struct phy_device *phydev)
|
|
{
|
|
{
|
|
const struct kszphy_type *type = phydev->drv->driver_data;
|
|
const struct kszphy_type *type = phydev->drv->driver_data;
|
|
@@ -844,7 +870,7 @@ static struct phy_driver ksphy_driver[] = {
|
|
.get_strings = kszphy_get_strings,
|
|
.get_strings = kszphy_get_strings,
|
|
.get_stats = kszphy_get_stats,
|
|
.get_stats = kszphy_get_stats,
|
|
.suspend = genphy_suspend,
|
|
.suspend = genphy_suspend,
|
|
- .resume = genphy_resume,
|
|
|
|
|
|
+ .resume = kszphy_resume,
|
|
}, {
|
|
}, {
|
|
.phy_id = PHY_ID_KSZ8061,
|
|
.phy_id = PHY_ID_KSZ8061,
|
|
.name = "Micrel KSZ8061",
|
|
.name = "Micrel KSZ8061",
|