|
@@ -1162,6 +1162,52 @@ static void tg3_mdio_fini(struct tg3 *tp)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+static int tg3_phy_cl45_write(struct tg3 *tp, u32 devad, u32 addr, u32 val)
|
|
|
+{
|
|
|
+ int err;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_CTRL, devad);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_ADDRESS, addr);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_CTRL,
|
|
|
+ MII_TG3_MMD_CTRL_DATA_NOINC | devad);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_ADDRESS, val);
|
|
|
+
|
|
|
+done:
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
+static int tg3_phy_cl45_read(struct tg3 *tp, u32 devad, u32 addr, u32 *val)
|
|
|
+{
|
|
|
+ int err;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_CTRL, devad);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_ADDRESS, addr);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_writephy(tp, MII_TG3_MMD_CTRL,
|
|
|
+ MII_TG3_MMD_CTRL_DATA_NOINC | devad);
|
|
|
+ if (err)
|
|
|
+ goto done;
|
|
|
+
|
|
|
+ err = tg3_readphy(tp, MII_TG3_MMD_ADDRESS, val);
|
|
|
+
|
|
|
+done:
|
|
|
+ return err;
|
|
|
+}
|
|
|
+
|
|
|
/* tp->lock is held. */
|
|
|
static inline void tg3_generate_fw_event(struct tg3 *tp)
|
|
|
{
|