git.openwrt.org Git - openwrt/staging/xback.git/blob

   1 From 18aa36238a4d835c1644dcccd63d32c7fdd4b310 Mon Sep 17 00:00:00 2001
   2 From: Jianhui Zhao <zhaojh329@gmail.com>
   3 Date: Sun, 2 Nov 2025 16:26:37 +0100
   4 Subject: [PATCH] net: phy: realtek: add interrupt support for RTL8221B
   5
   6 This commit introduces interrupt support for RTL8221B (C45 mode).
   7 Interrupts are mapped on the VEND2 page. VEND2 registers are only
   8 accessible via C45 reads and cannot be accessed by C45 over C22.
   9
  10 Signed-off-by: Jianhui Zhao <zhaojh329@gmail.com>
  11 [Enable only link state change interrupts]
  12 Signed-off-by: Aleksander Jan Bajkowski <olek2@wp.pl>
  13 Reviewed-by: Andrew Lunn <andrew@lunn.ch>
  14 Link: https://patch.msgid.link/20251102152644.1676482-1-olek2@wp.pl
  15 Signed-off-by: Jakub Kicinski <kuba@kernel.org>
  16 ---
  17  drivers/net/phy/realtek/realtek_main.c | 56 ++++++++++++++++++++++++++
  18  1 file changed, 56 insertions(+)
  19
  20 --- a/drivers/net/phy/realtek/realtek_main.c
  21 +++ b/drivers/net/phy/realtek/realtek_main.c
  22 @@ -130,6 +130,11 @@
  23   */
  24  #define RTL822X_VND2_C22_REG(reg)              (0xa400 + 2 * (reg))
  25
  26 +#define RTL8221B_VND2_INER                     0xa4d2
  27 +#define RTL8221B_VND2_INER_LINK_STATUS         BIT(4)
  28 +
  29 +#define RTL8221B_VND2_INSR                     0xa4d4
  30 +
  31  #define RTL8224_MII_RTCT                       0x11
  32  #define RTL8224_MII_RTCT_ENABLE                        BIT(0)
  33  #define RTL8224_MII_RTCT_PAIR_A                        BIT(4)
  34 @@ -1744,6 +1749,53 @@ static irqreturn_t rtl9000a_handle_inter
  35         return IRQ_HANDLED;
  36  }
  37
  38 +static int rtl8221b_ack_interrupt(struct phy_device *phydev)
  39 +{
  40 +       int err;
  41 +
  42 +       err = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INSR);
  43 +
  44 +       return (err < 0) ? err : 0;
  45 +}
  46 +
  47 +static int rtl8221b_config_intr(struct phy_device *phydev)
  48 +{
  49 +       int err;
  50 +
  51 +       if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  52 +               err = rtl8221b_ack_interrupt(phydev);
  53 +               if (err)
  54 +                       return err;
  55 +
  56 +               err = phy_write_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INER,
  57 +                                   RTL8221B_VND2_INER_LINK_STATUS);
  58 +       } else {
  59 +               err = phy_write_mmd(phydev, MDIO_MMD_VEND2,
  60 +                                   RTL8221B_VND2_INER, 0);
  61 +               if (err)
  62 +                       return err;
  63 +
  64 +               err = rtl8221b_ack_interrupt(phydev);
  65 +       }
  66 +
  67 +       return err;
  68 +}
  69 +
  70 +static irqreturn_t rtl8221b_handle_interrupt(struct phy_device *phydev)
  71 +{
  72 +       int err;
  73 +
  74 +       err = rtl8221b_ack_interrupt(phydev);
  75 +       if (err) {
  76 +               phy_error(phydev);
  77 +               return IRQ_NONE;
  78 +       }
  79 +
  80 +       phy_trigger_machine(phydev);
  81 +
  82 +       return IRQ_HANDLED;
  83 +}
  84 +
  85  static struct phy_driver realtek_drvs[] = {
  86         {
  87                 PHY_ID_MATCH_EXACT(0x00008201),
  88 @@ -1918,6 +1970,8 @@ static struct phy_driver realtek_drvs[]
  89         }, {
  90                 .match_phy_device = rtl8221b_vb_cg_c45_match_phy_device,
  91                 .name           = "RTL8221B-VB-CG 2.5Gbps PHY (C45)",
  92 +               .config_intr    = rtl8221b_config_intr,
  93 +               .handle_interrupt = rtl8221b_handle_interrupt,
  94                 .probe          = rtl822x_probe,
  95                 .config_init    = rtl822xb_config_init,
  96                 .get_rate_matching = rtl822xb_get_rate_matching,
  97 @@ -1942,6 +1996,8 @@ static struct phy_driver realtek_drvs[]
  98         }, {
  99                 .match_phy_device = rtl8221b_vm_cg_c45_match_phy_device,
 100                 .name           = "RTL8221B-VM-CG 2.5Gbps PHY (C45)",
 101 +               .config_intr    = rtl8221b_config_intr,
 102 +               .handle_interrupt = rtl8221b_handle_interrupt,
 103                 .probe          = rtl822x_probe,
 104                 .config_init    = rtl822xb_config_init,
 105                 .get_rate_matching = rtl822xb_get_rate_matching,