mirrors/linux
1
0
Fork 0
mirror of https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git synced 2026-05-02 12:10:23 -04:00
Code Issues Packages Projects Releases Wiki Activity

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

Browse Source 
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>
This commit is contained in:
Divya Koppera
2024-12-19 18:03:11 +05:30
committed by Jakub Kicinski
parent 85b39f7593
commit 9fc3d6fe80
1 changed files with 38 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

41
drivers/net/phy/microchip_t1.c
View File

@@ -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,