2 files changed, 23 insertions, 0 deletions

diff --git a/drivers/net/tg3.c b/drivers/net/tg3.c
index a43ef2b3a530..003ab53cf613 100644
--- a/drivers/net/tg3.c
+++ b/drivers/net/tg3.c
@@ -2149,6 +2149,26 @@ static void tg3_power_down_phy(struct tg3 *tp, bool do_low_power)
                 tw32_f(GRC_MISC_CFG, val | GRC_MISC_CFG_EPHY_IDDQ);
                 udelay(40);
                 return;
+        } else if (tp->tg3_flags3 & TG3_FLG3_PHY_IS_FET) {
+                u32 phytest;
+                if (!tg3_readphy(tp, MII_TG3_FET_TEST, &phytest)) {
+                        u32 phy;
+
+                        tg3_writephy(tp, MII_ADVERTISE, 0);
+                        tg3_writephy(tp, MII_BMCR,
+                                     BMCR_ANENABLE | BMCR_ANRESTART);
+
+                        tg3_writephy(tp, MII_TG3_FET_TEST,
+                                     phytest | MII_TG3_FET_SHADOW_EN);
+                        if (!tg3_readphy(tp, MII_TG3_FET_SHDW_AUXMODE4, &phy)) {
+                                phy |= MII_TG3_FET_SHDW_AUXMODE4_SBPD;
+                                tg3_writephy(tp,
+                                             MII_TG3_FET_SHDW_AUXMODE4,
+                                             phy);
+                        }
+                        tg3_writephy(tp, MII_TG3_FET_TEST, phytest);
+                }
+                return;
         } else if (do_low_power) {
                 tg3_writephy(tp, MII_TG3_EXT_CTRL,
                              MII_TG3_EXT_CTRL_FORCE_LED_OFF);
diff --git a/drivers/net/tg3.h b/drivers/net/tg3.h
index 68431da5aad3..9999345a11a4 100644
--- a/drivers/net/tg3.h
+++ b/drivers/net/tg3.h
@@ -2080,6 +2080,9 @@
 #define MII_TG3_FET_SHDW_MISCCTRL       0x10
 #define  MII_TG3_FET_SHDW_MISCCTRL_MDIX 0x4000
 
+#define MII_TG3_FET_SHDW_AUXMODE4       0x1a
+#define MII_TG3_FET_SHDW_AUXMODE4_SBPD  0x0008
+
 #define MII_TG3_FET_SHDW_AUXSTAT2       0x1b
 #define  MII_TG3_FET_SHDW_AUXSTAT2_APD  0x0020