target/linux/mediatek/patches-4.4/0080-net-next-mediatek-fix-gigabit-and-flow-control-adver.patch

   1 From 6918f290a9019425043dbedf7b39bc82a69e23a6 Mon Sep 17 00:00:00 2001
   2 From: John Crispin <blogic@openwrt.org>
   3 Date: Fri, 22 Apr 2016 11:05:23 +0200
   4 Subject: [PATCH 80/91] net-next: mediatek: fix gigabit and flow control
   5  advertisement
   6
   7 The current code will not setup the PHYs advertisement features correctly.
   8 Fix this and properly advertise Gigabit features and properly handle
   9 asymmetric pause frames.
  10
  11 Signed-off-by: John Crispin <blogic@openwrt.org>
  12 ---
  13  drivers/net/ethernet/mediatek/mtk_eth_soc.c |   16 ++++++++++++++--
  14  1 file changed, 14 insertions(+), 2 deletions(-)
  15
  16 --- a/drivers/net/ethernet/mediatek/mtk_eth_soc.c
  17 +++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.c
  18 @@ -133,6 +133,8 @@ static int mtk_mdio_read(struct mii_bus
  19  static void mtk_phy_link_adjust(struct net_device *dev)
  20  {
  21         struct mtk_mac *mac = netdev_priv(dev);
  22 +       u16 lcl_adv, rmt_adv = 0;
  23 +       u8 flowctrl;
  24         u32 mcr = MAC_MCR_MAX_RX_1536 | MAC_MCR_IPG_CFG |
  25                   MAC_MCR_FORCE_MODE | MAC_MCR_TX_EN |
  26                   MAC_MCR_RX_EN | MAC_MCR_BACKOFF_EN |
  27 @@ -154,7 +156,16 @@ static void mtk_phy_link_adjust(struct n
  28                 mcr |= MAC_MCR_FORCE_DPX;
  29
  30         if (mac->phy_dev->pause)
  31 -               mcr |= MAC_MCR_FORCE_RX_FC | MAC_MCR_FORCE_TX_FC;
  32 +               rmt_adv = LPA_PAUSE_CAP;
  33 +       if (mac->phy_dev->asym_pause)
  34 +               rmt_adv |= LPA_PAUSE_ASYM;
  35 +
  36 +       lcl_adv = mii_advertise_flowctrl(FLOW_CTRL_RX | FLOW_CTRL_TX);
  37 +       flowctrl = mii_resolve_flowctrl_fdx(lcl_adv, rmt_adv);
  38 +       if (flowctrl & FLOW_CTRL_TX)
  39 +               mcr |= MAC_MCR_FORCE_TX_FC;
  40 +       if (flowctrl & FLOW_CTRL_RX)
  41 +               mcr |= MAC_MCR_FORCE_RX_FC;
  42
  43         mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
  44
  45 @@ -236,7 +247,8 @@ static int mtk_phy_connect(struct mtk_ma
  46         mac->phy_dev->autoneg = AUTONEG_ENABLE;
  47         mac->phy_dev->speed = 0;
  48         mac->phy_dev->duplex = 0;
  49 -       mac->phy_dev->supported &= PHY_BASIC_FEATURES;
  50 +       mac->phy_dev->supported &= PHY_GBIT_FEATURES | SUPPORTED_Pause |
  51 +                                  ~SUPPORTED_Asym_Pause;
  52         mac->phy_dev->advertising = mac->phy_dev->supported |
  53                                     ADVERTISED_Autoneg;
  54         phy_start_aneg(mac->phy_dev);