Commit 9fc3d6fe authored by Divya Koppera's avatar Divya Koppera Committed by Jakub Kicinski
Browse files

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



Add initialization of ptp for lan887x.

Reviewed-by: default avatarAndrew Lunn <andrew@lunn.ch>
Signed-off-by: default avatarDivya Koppera <divya.koppera@microchip.com>
Link: https://patch.msgid.link/20241219123311.30213-6-divya.koppera@microchip.com


Signed-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parent 85b39f75

drivers/net/phy/microchip_t1.c

+38 −3
Original line number Diff line number Diff line
@@ -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,