target/linux/bcm4908/patches-5.4/075-v5.13-0004-net-dsa-bcm_sf2-add-function-finding-RGMII-register.patch

   1 From 55cfeb396965c3906a84d09a9c487d065e37773b Mon Sep 17 00:00:00 2001
   2 From: =?UTF-8?q?Rafa=C5=82=20Mi=C5=82ecki?= <rafal@milecki.pl>
   3 Date: Thu, 18 Mar 2021 09:01:42 +0100
   4 Subject: [PATCH 1/2] net: dsa: bcm_sf2: add function finding RGMII register
   5 MIME-Version: 1.0
   6 Content-Type: text/plain; charset=UTF-8
   7 Content-Transfer-Encoding: 8bit
   8
   9 Simple macro like REG_RGMII_CNTRL_P() is insufficient as:
  10 1. It doesn't validate port argument
  11 2. It doesn't support chipsets with non-lineral RGMII regs layout
  12
  13 Missing port validation could result in getting register offset from out
  14 of array. Random memory -> random offset -> random reads/writes. It
  15 affected e.g. BCM4908 for REG_RGMII_CNTRL_P(7).
  16
  17 Fixes: a78e86ed586d ("net: dsa: bcm_sf2: Prepare for different register layouts")
  18 Signed-off-by: Rafał Miłecki <rafal@milecki.pl>
  19 Acked-by: Florian Fainelli <f.fainelli@gmail.com>
  20 Signed-off-by: David S. Miller <davem@davemloft.net>
  21 ---
  22  drivers/net/dsa/bcm_sf2.c      | 49 +++++++++++++++++++++++++++++-----
  23  drivers/net/dsa/bcm_sf2_regs.h |  2 --
  24  2 files changed, 42 insertions(+), 9 deletions(-)
  25
  26 --- a/drivers/net/dsa/bcm_sf2.c
  27 +++ b/drivers/net/dsa/bcm_sf2.c
  28 @@ -31,6 +31,31 @@
  29  #include "b53/b53_priv.h"
  30  #include "b53/b53_regs.h"
  31
  32 +static u16 bcm_sf2_reg_rgmii_cntrl(struct bcm_sf2_priv *priv, int port)
  33 +{
  34 +       switch (priv->type) {
  35 +       case BCM4908_DEVICE_ID:
  36 +               /* TODO */
  37 +               break;
  38 +       default:
  39 +               switch (port) {
  40 +               case 0:
  41 +                       return REG_RGMII_0_CNTRL;
  42 +               case 1:
  43 +                       return REG_RGMII_1_CNTRL;
  44 +               case 2:
  45 +                       return REG_RGMII_2_CNTRL;
  46 +               default:
  47 +                       break;
  48 +               }
  49 +       }
  50 +
  51 +       WARN_ONCE(1, "Unsupported port %d\n", port);
  52 +
  53 +       /* RO fallback reg */
  54 +       return REG_SWITCH_STATUS;
  55 +}
  56 +
  57  static void bcm_sf2_imp_setup(struct dsa_switch *ds, int port)
  58  {
  59         struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
  60 @@ -586,6 +611,7 @@ static void bcm_sf2_sw_mac_config(struct
  61  {
  62         struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
  63         u32 id_mode_dis = 0, port_mode;
  64 +       u32 reg_rgmii_ctrl;
  65         u32 reg, offset;
  66
  67         if (port == core_readl(priv, CORE_IMP0_PRT_ID))
  68 @@ -615,10 +641,12 @@ static void bcm_sf2_sw_mac_config(struct
  69                 goto force_link;
  70         }
  71
  72 +       reg_rgmii_ctrl = bcm_sf2_reg_rgmii_cntrl(priv, port);
  73 +
  74         /* Clear id_mode_dis bit, and the existing port mode, let
  75          * RGMII_MODE_EN bet set by mac_link_{up,down}
  76          */
  77 -       reg = reg_readl(priv, REG_RGMII_CNTRL_P(port));
  78 +       reg = reg_readl(priv, reg_rgmii_ctrl);
  79         reg &= ~ID_MODE_DIS;
  80         reg &= ~(PORT_MODE_MASK << PORT_MODE_SHIFT);
  81         reg &= ~(RX_PAUSE_EN | TX_PAUSE_EN);
  82 @@ -633,7 +661,7 @@ static void bcm_sf2_sw_mac_config(struct
  83                 reg |= RX_PAUSE_EN;
  84         }
  85
  86 -       reg_writel(priv, reg, REG_RGMII_CNTRL_P(port));
  87 +       reg_writel(priv, reg, reg_rgmii_ctrl);
  88
  89  force_link:
  90         /* Force link settings detected from the PHY */
  91 @@ -659,6 +687,7 @@ static void bcm_sf2_sw_mac_link_set(stru
  92                                     phy_interface_t interface, bool link)
  93  {
  94         struct bcm_sf2_priv *priv = bcm_sf2_to_priv(ds);
  95 +       u32 reg_rgmii_ctrl;
  96         u32 reg;
  97
  98         if (!phy_interface_mode_is_rgmii(interface) &&
  99 @@ -666,13 +695,15 @@ static void bcm_sf2_sw_mac_link_set(stru
 100             interface != PHY_INTERFACE_MODE_REVMII)
 101                 return;
 102
 103 +       reg_rgmii_ctrl = bcm_sf2_reg_rgmii_cntrl(priv, port);
 104 +
 105         /* If the link is down, just disable the interface to conserve power */
 106 -       reg = reg_readl(priv, REG_RGMII_CNTRL_P(port));
 107 +       reg = reg_readl(priv, reg_rgmii_ctrl);
 108         if (link)
 109                 reg |= RGMII_MODE_EN;
 110         else
 111                 reg &= ~RGMII_MODE_EN;
 112 -       reg_writel(priv, reg, REG_RGMII_CNTRL_P(port));
 113 +       reg_writel(priv, reg, reg_rgmii_ctrl);
 114  }
 115
 116  static void bcm_sf2_sw_mac_link_down(struct dsa_switch *ds, int port,
 117 --- a/drivers/net/dsa/bcm_sf2_regs.h
 118 +++ b/drivers/net/dsa/bcm_sf2_regs.h
 119 @@ -55,8 +55,6 @@ enum bcm_sf2_reg_offs {
 120  #define CROSSBAR_BCM4908_EXT_GPHY4     1
 121  #define CROSSBAR_BCM4908_EXT_RGMII     2
 122
 123 -#define REG_RGMII_CNTRL_P(x)           (REG_RGMII_0_CNTRL + (x))
 124 -
 125  /* Relative to REG_RGMII_CNTRL */
 126  #define  RGMII_MODE_EN                 (1 << 0)
 127  #define  ID_MODE_DIS                   (1 << 1)