target/linux/generic/backport-5.15/815-v6.4-09-net-phy-marvell-Implement-led_blink_set.patch

   1 From ea9e86485decb2ac1750005bd96c166c9b780406 Mon Sep 17 00:00:00 2001
   2 From: Andrew Lunn <andrew@lunn.ch>
   3 Date: Mon, 17 Apr 2023 17:17:31 +0200
   4 Subject: [PATCH 9/9] net: phy: marvell: Implement led_blink_set()
   5
   6 The Marvell PHY can blink the LEDs, simple on/off. All LEDs blink at
   7 the same rate, and the reset default is 84ms per blink, which is
   8 around 12Hz.
   9
  10 Signed-off-by: Andrew Lunn <andrew@lunn.ch>
  11 Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>
  12 Reviewed-by: Florian Fainelli <f.fainelli@gmail.com>
  13 Signed-off-by: David S. Miller <davem@davemloft.net>
  14 ---
  15  drivers/net/phy/marvell.c | 36 ++++++++++++++++++++++++++++++++++++
  16  1 file changed, 36 insertions(+)
  17
  18 --- a/drivers/net/phy/marvell.c
  19 +++ b/drivers/net/phy/marvell.c
  20 @@ -147,6 +147,8 @@
  21  #define MII_88E1318S_PHY_LED_FUNC              0x10
  22  #define MII_88E1318S_PHY_LED_FUNC_OFF          (0x8)
  23  #define MII_88E1318S_PHY_LED_FUNC_ON           (0x9)
  24 +#define MII_88E1318S_PHY_LED_FUNC_HI_Z         (0xa)
  25 +#define MII_88E1318S_PHY_LED_FUNC_BLINK                (0xb)
  26  #define MII_88E1318S_PHY_LED_TCR               0x12
  27  #define MII_88E1318S_PHY_LED_TCR_FORCE_INT     BIT(15)
  28  #define MII_88E1318S_PHY_LED_TCR_INTn_ENABLE   BIT(7)
  29 @@ -2823,6 +2825,35 @@ static int m88e1318_led_brightness_set(s
  30                                MII_88E1318S_PHY_LED_FUNC, reg);
  31  }
  32
  33 +static int m88e1318_led_blink_set(struct phy_device *phydev, u8 index,
  34 +                                 unsigned long *delay_on,
  35 +                                 unsigned long *delay_off)
  36 +{
  37 +       int reg;
  38 +
  39 +       reg = phy_read_paged(phydev, MII_MARVELL_LED_PAGE,
  40 +                            MII_88E1318S_PHY_LED_FUNC);
  41 +       if (reg < 0)
  42 +               return reg;
  43 +
  44 +       switch (index) {
  45 +       case 0:
  46 +       case 1:
  47 +       case 2:
  48 +               reg &= ~(0xf << (4 * index));
  49 +                       reg |= MII_88E1318S_PHY_LED_FUNC_BLINK << (4 * index);
  50 +                       /* Reset default is 84ms */
  51 +                       *delay_on = 84 / 2;
  52 +                       *delay_off = 84 / 2;
  53 +               break;
  54 +       default:
  55 +               return -EINVAL;
  56 +       }
  57 +
  58 +       return phy_write_paged(phydev, MII_MARVELL_LED_PAGE,
  59 +                              MII_88E1318S_PHY_LED_FUNC, reg);
  60 +}
  61 +
  62  static int marvell_probe(struct phy_device *phydev)
  63  {
  64         struct marvell_priv *priv;
  65 @@ -3072,6 +3103,7 @@ static struct phy_driver marvell_drivers
  66                 .get_strings = marvell_get_strings,
  67                 .get_stats = marvell_get_stats,
  68                 .led_brightness_set = m88e1318_led_brightness_set,
  69 +               .led_blink_set = m88e1318_led_blink_set,
  70         },
  71         {
  72                 .phy_id = MARVELL_PHY_ID_88E1145,
  73 @@ -3179,6 +3211,7 @@ static struct phy_driver marvell_drivers
  74                 .cable_test_tdr_start = marvell_vct5_cable_test_tdr_start,
  75                 .cable_test_get_status = marvell_vct7_cable_test_get_status,
  76                 .led_brightness_set = m88e1318_led_brightness_set,
  77 +               .led_blink_set = m88e1318_led_blink_set,
  78         },
  79         {
  80                 .phy_id = MARVELL_PHY_ID_88E1540,
  81 @@ -3206,6 +3239,7 @@ static struct phy_driver marvell_drivers
  82                 .cable_test_tdr_start = marvell_vct5_cable_test_tdr_start,
  83                 .cable_test_get_status = marvell_vct7_cable_test_get_status,
  84                 .led_brightness_set = m88e1318_led_brightness_set,
  85 +               .led_blink_set = m88e1318_led_blink_set,
  86         },
  87         {
  88                 .phy_id = MARVELL_PHY_ID_88E1545,
  89 @@ -3233,6 +3267,7 @@ static struct phy_driver marvell_drivers
  90                 .cable_test_tdr_start = marvell_vct5_cable_test_tdr_start,
  91                 .cable_test_get_status = marvell_vct7_cable_test_get_status,
  92                 .led_brightness_set = m88e1318_led_brightness_set,
  93 +               .led_blink_set = m88e1318_led_blink_set,
  94         },
  95         {
  96                 .phy_id = MARVELL_PHY_ID_88E3016,
  97 @@ -3375,6 +3410,7 @@ static struct phy_driver marvell_drivers
  98                 .get_tunable = m88e1540_get_tunable,
  99                 .set_tunable = m88e1540_set_tunable,
 100                 .led_brightness_set = m88e1318_led_brightness_set,
 101 +               .led_blink_set = m88e1318_led_blink_set,
 102         },
 103  };
 104