The Finisar FCLF8520P2BTL 1000BaseT SFP module uses a Marvel 81E1111 PHY
with a modified PHY ID, and by default does not have 1000BaseX
auto-negotiation enabled, which is not generally desirable with Linux
networking drivers. Add handling to enable 1000BaseX auto-negotiation.
Also, it requires some special handling to ensure that 1000BaseT auto-
negotiation is enabled properly when desired.

Based on existing handling in the AMD xgbe driver and the information in
the Finisar FAQ:
https://www.finisar.com/sites/default/files/resources/an-2036_1000base-t_sfp_faqreve1.pdf

Signed-off-by: Robert Hancock <robert.hanc...@calian.com>
---
 drivers/net/phy/marvell.c   | 82 +++++++++++++++++++++++++++++++++++++
 include/linux/marvell_phy.h |  3 ++
 2 files changed, 85 insertions(+)

diff --git a/drivers/net/phy/marvell.c b/drivers/net/phy/marvell.c
index 5aec673a0120..8d85c96209ad 100644
--- a/drivers/net/phy/marvell.c
+++ b/drivers/net/phy/marvell.c
@@ -80,8 +80,11 @@
 #define MII_M1111_HWCFG_MODE_FIBER_RGMII       0x3
 #define MII_M1111_HWCFG_MODE_SGMII_NO_CLK      0x4
 #define MII_M1111_HWCFG_MODE_RTBI              0x7
+#define MII_M1111_HWCFG_MODE_COPPER_1000BX_AN  0x8
 #define MII_M1111_HWCFG_MODE_COPPER_RTBI       0x9
 #define MII_M1111_HWCFG_MODE_COPPER_RGMII      0xb
+#define MII_M1111_HWCFG_MODE_COPPER_1000BX_NOAN 0xc
+#define MII_M1111_HWCFG_SERIAL_AN_BYPASS       BIT(12)
 #define MII_M1111_HWCFG_FIBER_COPPER_RES       BIT(13)
 #define MII_M1111_HWCFG_FIBER_COPPER_AUTO      BIT(15)
 
@@ -629,6 +632,39 @@ static int marvell_config_aneg_fiber(struct phy_device 
*phydev)
        return genphy_check_and_restart_aneg(phydev, changed);
 }
 
+static int m88e1111_finisar_config_aneg(struct phy_device *phydev)
+{
+       int err;
+
+       err = marvell_set_page(phydev, MII_MARVELL_COPPER_PAGE);
+       if (err < 0)
+               goto error;
+
+       /* Configure the copper link first */
+       err = marvell_config_aneg(phydev);
+       if (err < 0)
+               goto error;
+
+       /* Do not touch the fiber page if we're in copper->sgmii mode */
+       if (phydev->interface == PHY_INTERFACE_MODE_SGMII)
+               return 0;
+
+       /* Then the fiber link */
+       err = marvell_set_page(phydev, MII_MARVELL_FIBER_PAGE);
+       if (err < 0)
+               goto error;
+
+       err = marvell_config_aneg_fiber(phydev);
+       if (err < 0)
+               goto error;
+
+       return marvell_set_page(phydev, MII_MARVELL_COPPER_PAGE);
+
+error:
+       marvell_set_page(phydev, MII_MARVELL_COPPER_PAGE);
+       return err;
+}
+
 static int m88e1510_config_aneg(struct phy_device *phydev)
 {
        int err;
@@ -843,6 +879,30 @@ static int m88e1111_config_init(struct phy_device *phydev)
        return genphy_soft_reset(phydev);
 }
 
+static int m88e1111_finisar_config_init(struct phy_device *phydev)
+{
+       int err;
+       int extsr = phy_read(phydev, MII_M1111_PHY_EXT_SR);
+
+       if (extsr < 0)
+               return extsr;
+
+       /* If using 1000BaseX and 1000BaseX auto-negotiation is disabled, 
enable it */
+       if (phydev->interface == PHY_INTERFACE_MODE_1000BASEX &&
+           (extsr & MII_M1111_HWCFG_MODE_MASK) ==
+           MII_M1111_HWCFG_MODE_COPPER_1000BX_NOAN) {
+               err = phy_modify(phydev, MII_M1111_PHY_EXT_SR,
+                                MII_M1111_HWCFG_MODE_MASK |
+                                MII_M1111_HWCFG_SERIAL_AN_BYPASS,
+                                MII_M1111_HWCFG_MODE_COPPER_1000BX_AN |
+                                MII_M1111_HWCFG_SERIAL_AN_BYPASS);
+               if (err < 0)
+                       return err;
+       }
+
+       return m88e1111_config_init(phydev);
+}
+
 static int m88e1111_get_downshift(struct phy_device *phydev, u8 *data)
 {
        int val, cnt, enable;
@@ -2672,6 +2732,27 @@ static struct phy_driver marvell_drivers[] = {
                .get_tunable = m88e1111_get_tunable,
                .set_tunable = m88e1111_set_tunable,
        },
+       {
+               .phy_id = MARVELL_PHY_ID_88E1111_FINISAR,
+               .phy_id_mask = MARVELL_PHY_ID_MASK,
+               .name = "Marvell 88E1111 (Finisar)",
+               /* PHY_GBIT_FEATURES */
+               .probe = marvell_probe,
+               .config_init = &m88e1111_finisar_config_init,
+               .config_aneg = &m88e1111_finisar_config_aneg,
+               .read_status = &marvell_read_status,
+               .ack_interrupt = &marvell_ack_interrupt,
+               .config_intr = &marvell_config_intr,
+               .resume = &genphy_resume,
+               .suspend = &genphy_suspend,
+               .read_page = marvell_read_page,
+               .write_page = marvell_write_page,
+               .get_sset_count = marvell_get_sset_count,
+               .get_strings = marvell_get_strings,
+               .get_stats = marvell_get_stats,
+               .get_tunable = m88e1111_get_tunable,
+               .set_tunable = m88e1111_set_tunable,
+       },
        {
                .phy_id = MARVELL_PHY_ID_88E1118,
                .phy_id_mask = MARVELL_PHY_ID_MASK,
@@ -2989,6 +3070,7 @@ static struct mdio_device_id __maybe_unused marvell_tbl[] 
= {
        { MARVELL_PHY_ID_88E1101, MARVELL_PHY_ID_MASK },
        { MARVELL_PHY_ID_88E1112, MARVELL_PHY_ID_MASK },
        { MARVELL_PHY_ID_88E1111, MARVELL_PHY_ID_MASK },
+       { MARVELL_PHY_ID_88E1111_FINISAR, MARVELL_PHY_ID_MASK },
        { MARVELL_PHY_ID_88E1118, MARVELL_PHY_ID_MASK },
        { MARVELL_PHY_ID_88E1121R, MARVELL_PHY_ID_MASK },
        { MARVELL_PHY_ID_88E1145, MARVELL_PHY_ID_MASK },
diff --git a/include/linux/marvell_phy.h b/include/linux/marvell_phy.h
index ff7b7607c8cf..52b1610eae68 100644
--- a/include/linux/marvell_phy.h
+++ b/include/linux/marvell_phy.h
@@ -25,6 +25,9 @@
 #define MARVELL_PHY_ID_88X3310         0x002b09a0
 #define MARVELL_PHY_ID_88E2110         0x002b09b0
 
+/* Marvel 88E1111 in Finisar SFP module with modified PHY ID */
+#define MARVELL_PHY_ID_88E1111_FINISAR 0x01ff0cc0
+
 /* The MV88e6390 Ethernet switch contains embedded PHYs. These PHYs do
  * not have a model ID. So the switch driver traps reads to the ID2
  * register and returns the switch family ID
-- 
2.18.4

Reply via email to