3 files changed, 9 insertions, 0 deletions

diff --git a/drivers/net/ethernet/nvidia/eqos/drv.c b/drivers/net/ethernet/nvidia/eqos/drv.c
index 7163708a5..1ee3ca2fa 100644
--- a/drivers/net/ethernet/nvidia/eqos/drv.c
+++ b/drivers/net/ethernet/nvidia/eqos/drv.c
@@ -5789,6 +5789,11 @@ void eqos_stop_dev(struct eqos_prv_data *pdata)
 
         DBGPR("-->%s()\n", __func__);
 
+#ifdef CONFIG_TEGRA_PTP_NOTIFIER
+        /* Unregister broadcasting MAC timestamp to clients */
+        tegra_unregister_hwtime_source();
+#endif
+
         /* turn off sources of data into dev */
         netif_tx_disable(pdata->dev);
 
diff --git a/drivers/net/ethernet/nvidia/eqos/ptp.c b/drivers/net/ethernet/nvidia/eqos/ptp.c
index 29fc737af..4f83666d8 100644
--- a/drivers/net/ethernet/nvidia/eqos/ptp.c
+++ b/drivers/net/ethernet/nvidia/eqos/ptp.c
@@ -137,6 +137,9 @@ static int eqos_adjust_time(struct ptp_clock_info *ptp, s64 delta)
 
         spin_unlock(&pdata->ptp_lock);
 
+        /* Register broadcasting MAC timestamp to clients */
+        tegra_register_hwtime_source(hw_if->get_systime);
+
         DBGPR_PTP("<--eqos_adjust_time\n");
 
         return 0;
diff --git a/drivers/net/ethernet/nvidia/eqos/yheader.h b/drivers/net/ethernet/nvidia/eqos/yheader.h
index db1faf6c8..030d715de 100644
--- a/drivers/net/ethernet/nvidia/eqos/yheader.h
+++ b/drivers/net/ethernet/nvidia/eqos/yheader.h
@@ -91,6 +91,7 @@
 #include <linux/phy.h>
 #include <linux/mdio.h>
 #include <linux/thermal.h>
+#include <linux/platform/tegra/ptp-notifier.h>
 
 #define L32(data) ((data)&0xFFFFFFFF)
 #define H32(data) (((data)&0xFFFFFFFF00000000)>>32)