This patch adds ability to switch beetween two PHY SGMII modes.
Some hardware, for example, FPGA IP designs may use 6-wire mode
which enables differential SGMII clock to MAC.

Signed-off-by: Vitaly Gaiduk <[email protected]>
---
 drivers/net/phy/dp83867.c | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/drivers/net/phy/dp83867.c b/drivers/net/phy/dp83867.c
index 1f1ecee0ee2f..3efb33e7523f 100644
--- a/drivers/net/phy/dp83867.c
+++ b/drivers/net/phy/dp83867.c
@@ -37,6 +37,7 @@
 #define DP83867_STRAP_STS2     0x006f
 #define DP83867_RGMIIDCTL      0x0086
 #define DP83867_IO_MUX_CFG     0x0170
+#define DP83867_SGMIICTL       0x00D3
 #define DP83867_10M_SGMII_CFG   0x016F
 #define DP83867_10M_SGMII_RATE_ADAPT_MASK BIT(7)
 
@@ -61,6 +62,9 @@
 #define DP83867_RGMII_TX_CLK_DELAY_EN          BIT(1)
 #define DP83867_RGMII_RX_CLK_DELAY_EN          BIT(0)
 
+/* SGMIICTL bits */
+#define DP83867_SGMII_TYPE             BIT(14)
+
 /* STRAP_STS1 bits */
 #define DP83867_STRAP_STS1_RESERVED            BIT(11)
 
@@ -109,6 +113,7 @@ struct dp83867_private {
        bool rxctrl_strap_quirk;
        bool set_clk_output;
        u32 clk_output_sel;
+       bool sgmii_type;
 };
 
 static int dp83867_ack_interrupt(struct phy_device *phydev)
@@ -197,6 +202,8 @@ static int dp83867_of_init(struct phy_device *phydev)
        dp83867->rxctrl_strap_quirk = of_property_read_bool(of_node,
                                        "ti,dp83867-rxctrl-strap-quirk");
 
+       dp83867->sgmii_type = of_property_read_bool(of_node, "ti,sgmii-type");
+
        /* Existing behavior was to use default pin strapping delay in rgmii
         * mode, but rgmii should have meant no delay.  Warn existing users.
         */
@@ -389,6 +396,14 @@ static int dp83867_config_init(struct phy_device *phydev)
 
                if (ret)
                        return ret;
+
+               /* SGMII type is set to 4-wire mode by default */
+               if (dp83867->sgmii_type) {
+                       /* Switch-on 6-wire mode */
+                       val = phy_read_mmd(phydev, DP83867_DEVADDR, 
DP83867_SGMIICTL);
+                       val |= DP83867_SGMII_TYPE;
+                       phy_write_mmd(phydev, DP83867_DEVADDR, 
DP83867_SGMIICTL, val);
+               }
        }
 
        /* Enable Interrupt output INT_OE in CFG3 register */
-- 
2.16.4

Reply via email to