target/linux/generic/patches-4.9/735-net-phy-at803x-fix-at8033-sgmii-mode.patch

   1 --- a/drivers/net/phy/at803x.c
   2 +++ b/drivers/net/phy/at803x.c
   3 @@ -55,6 +55,10 @@
   4  #define AT803X_DEBUG_ADDR                      0x1D
   5  #define AT803X_DEBUG_DATA                      0x1E
   6
   7 +#define AT803X_REG_CHIP_CONFIG                 0x1f
   8 +#define AT803X_BT_BX_REG_SEL                   0x8000
   9 +#define AT803X_SGMII_ANEG_EN                   0x1000
  10 +
  11  #define AT803X_MODE_CFG_MASK                   0x0F
  12  #define AT803X_MODE_CFG_SGMII                  0x01
  13
  14 @@ -295,6 +299,27 @@ static int at803x_config_init(struct phy
  15  {
  16         struct at803x_platform_data *pdata;
  17         int ret;
  18 +       u32 v;
  19 +
  20 +       if (phydev->drv->phy_id == ATH8031_PHY_ID &&
  21 +               phydev->interface == PHY_INTERFACE_MODE_SGMII)
  22 +       {
  23 +               v = phy_read(phydev, AT803X_REG_CHIP_CONFIG);
  24 +               /* select SGMII/fiber page */
  25 +               ret = phy_write(phydev, AT803X_REG_CHIP_CONFIG,
  26 +                                               v & ~AT803X_BT_BX_REG_SEL);
  27 +               if (ret)
  28 +                       return ret;
  29 +               /* enable SGMII autonegotiation */
  30 +               ret = phy_write(phydev, MII_BMCR, AT803X_SGMII_ANEG_EN);
  31 +               if (ret)
  32 +                       return ret;
  33 +               /* select copper page */
  34 +               ret = phy_write(phydev, AT803X_REG_CHIP_CONFIG,
  35 +                                               v | AT803X_BT_BX_REG_SEL);
  36 +               if (ret)
  37 +                       return ret;
  38 +       }
  39
  40         ret = genphy_config_init(phydev);
  41         if (ret < 0)