net: phy: microchip_t1 : Add initialization of ptp for lan887x

Add initialization of ptp for lan887x.

Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Divya Koppera <divya.koppera@microchip.com>
Link: https://patch.msgid.link/20241219123311.30213-6-divya.koppera@microchip.com
Signed-off-by: Jakub Kicinski <kuba@kernel.org>

diff --git a/drivers/net/phy/microchip_t1.c b/drivers/net/phy/microchip_t1.c
index b17bf6708003e01165d5c07386a4f60e609e16bc..73f28463bc356d4eebfe7c3751a620596a37aa62 100644 (file)
--- a/drivers/net/phy/microchip_t1.c
+++ b/drivers/net/phy/microchip_t1.c
@@ -10,11 +10,15 @@
 #include <linux/ethtool.h>
 #include <linux/ethtool_netlink.h>
 #include <linux/bitfield.h>
+#include "microchip_rds_ptp.h"
 
 #define PHY_ID_LAN87XX                         0x0007c150
 #define PHY_ID_LAN937X                         0x0007c180
 #define PHY_ID_LAN887X                         0x0007c1f0
 
+#define MCHP_RDS_PTP_LTC_BASE_ADDR             0xe000
+#define MCHP_RDS_PTP_PORT_BASE_ADDR        (MCHP_RDS_PTP_LTC_BASE_ADDR + 0x800)
+
 /* External Register Control Register */
 #define LAN87XX_EXT_REG_CTL                     (0x14)
 #define LAN87XX_EXT_REG_CTL_RD_CTL              (0x1000)
@@ -229,6 +233,7 @@
 
 #define LAN887X_INT_STS                                0xf000
 #define LAN887X_INT_MSK                                0xf001
+#define LAN887X_INT_MSK_P1588_MOD_INT_MSK      BIT(3)
 #define LAN887X_INT_MSK_T1_PHY_INT_MSK         BIT(2)
 #define LAN887X_INT_MSK_LINK_UP_MSK            BIT(1)
 #define LAN887X_INT_MSK_LINK_DOWN_MSK          BIT(0)
@@ -319,6 +324,8 @@ struct lan887x_regwr_map {
 
 struct lan887x_priv {
        u64 stats[ARRAY_SIZE(lan887x_hw_stats)];
+       struct mchp_rds_ptp_clock *clock;
+       bool init_done;
 };
 
 static int lan937x_dsp_workaround(struct phy_device *phydev, u16 ereg, u8 bank)
@@ -1269,8 +1276,19 @@ static int lan887x_get_features(struct phy_device *phydev)
 
 static int lan887x_phy_init(struct phy_device *phydev)
 {
+       struct lan887x_priv *priv = phydev->priv;
        int ret;
 
+       if (!priv->init_done && phy_interrupt_is_valid(phydev)) {
+               priv->clock = mchp_rds_ptp_probe(phydev, MDIO_MMD_VEND1,
+                                                MCHP_RDS_PTP_LTC_BASE_ADDR,
+                                                MCHP_RDS_PTP_PORT_BASE_ADDR);
+               if (IS_ERR(priv->clock))
+                       return PTR_ERR(priv->clock);
+
+               priv->init_done = true;
+       }
+
        /* Clear loopback */
        ret = phy_clear_bits_mmd(phydev, MDIO_MMD_VEND1,
                                 LAN887X_MIS_CFG_REG2,
@@ -1470,6 +1488,7 @@ static int lan887x_probe(struct phy_device *phydev)
        if (!priv)
                return -ENOMEM;
 
+       priv->init_done = false;
        phydev->priv = priv;
 
        return lan887x_phy_setup(phydev);
@@ -1518,6 +1537,7 @@ static void lan887x_get_strings(struct phy_device *phydev, u8 *data)
 
 static int lan887x_config_intr(struct phy_device *phydev)
 {
+       struct lan887x_priv *priv = phydev->priv;
        int rc;
 
        if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
@@ -1537,12 +1557,24 @@ static int lan887x_config_intr(struct phy_device *phydev)
 
                rc = phy_read_mmd(phydev, MDIO_MMD_VEND1, LAN887X_INT_STS);
        }
+       if (rc < 0)
+               return rc;
 
-       return rc < 0 ? rc : 0;
+       if (phy_is_default_hwtstamp(phydev)) {
+               return mchp_rds_ptp_top_config_intr(priv->clock,
+                                       LAN887X_INT_MSK,
+                                       LAN887X_INT_MSK_P1588_MOD_INT_MSK,
+                                       (phydev->interrupts ==
+                                        PHY_INTERRUPT_ENABLED));
+       }
+
+       return 0;
 }
 
 static irqreturn_t lan887x_handle_interrupt(struct phy_device *phydev)
 {
+       struct lan887x_priv *priv = phydev->priv;
+       int rc = IRQ_NONE;
        int irq_status;
 
        irq_status = phy_read_mmd(phydev, MDIO_MMD_VEND1, LAN887X_INT_STS);
@@ -1553,10 +1585,13 @@ static irqreturn_t lan887x_handle_interrupt(struct phy_device *phydev)
 
        if (irq_status & LAN887X_MX_CHIP_TOP_LINK_MSK) {
                phy_trigger_machine(phydev);
-               return IRQ_HANDLED;
+               rc = IRQ_HANDLED;
        }
 
-       return IRQ_NONE;
+       if (irq_status & LAN887X_INT_MSK_P1588_MOD_INT_MSK)
+               rc = mchp_rds_ptp_handle_interrupt(priv->clock);
+
+       return rc;
 }
 
 static int lan887x_cd_reset(struct phy_device *phydev,