1 /*******************************************************************************
2 Copyright (C) 2013 Vayavya Labs Pvt Ltd
4 This implements all the API for managing HW timestamp & PTP.
6 This program is free software; you can redistribute it and/or modify it
7 under the terms and conditions of the GNU General Public License,
8 version 2, as published by the Free Software Foundation.
10 This program is distributed in the hope it will be useful, but WITHOUT
11 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
15 You should have received a copy of the GNU General Public License along with
16 this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
19 The full GNU General Public License is included in this distribution in
20 the file called "COPYING".
22 Author: Rayagond Kokatanur <rayagond@vayavyalabs.com>
23 Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
24 *******************************************************************************/
27 #include <linux/delay.h>
29 #include "stmmac_ptp.h"
31 static void stmmac_config_hw_tstamping(void __iomem
*ioaddr
, u32 data
)
33 writel(data
, ioaddr
+ PTP_TCR
);
36 static u32
stmmac_config_sub_second_increment(void __iomem
*ioaddr
,
39 u32 value
= readl(ioaddr
+ PTP_TCR
);
42 /* Convert the ptp_clock to nano second
43 * formula = (2/ptp_clock) * 1000000000
44 * where, ptp_clock = 50MHz.
46 data
= (2000000000ULL / ptp_clock
);
48 /* 0.465ns accuracy */
49 if (!(value
& PTP_TCR_TSCTRLSSR
))
50 data
= (data
* 1000) / 465;
52 writel(data
, ioaddr
+ PTP_SSIR
);
57 static int stmmac_init_systime(void __iomem
*ioaddr
, u32 sec
, u32 nsec
)
62 writel(sec
, ioaddr
+ PTP_STSUR
);
63 writel(nsec
, ioaddr
+ PTP_STNSUR
);
64 /* issue command to initialize the system time value */
65 value
= readl(ioaddr
+ PTP_TCR
);
66 value
|= PTP_TCR_TSINIT
;
67 writel(value
, ioaddr
+ PTP_TCR
);
69 /* wait for present system time initialize to complete */
72 if (!(readl(ioaddr
+ PTP_TCR
) & PTP_TCR_TSINIT
))
82 static int stmmac_config_addend(void __iomem
*ioaddr
, u32 addend
)
87 writel(addend
, ioaddr
+ PTP_TAR
);
88 /* issue command to update the addend value */
89 value
= readl(ioaddr
+ PTP_TCR
);
90 value
|= PTP_TCR_TSADDREG
;
91 writel(value
, ioaddr
+ PTP_TCR
);
93 /* wait for present addend update to complete */
96 if (!(readl(ioaddr
+ PTP_TCR
) & PTP_TCR_TSADDREG
))
106 static int stmmac_adjust_systime(void __iomem
*ioaddr
, u32 sec
, u32 nsec
,
112 writel(sec
, ioaddr
+ PTP_STSUR
);
113 writel(((add_sub
<< PTP_STNSUR_ADDSUB_SHIFT
) | nsec
),
114 ioaddr
+ PTP_STNSUR
);
115 /* issue command to initialize the system time value */
116 value
= readl(ioaddr
+ PTP_TCR
);
117 value
|= PTP_TCR_TSUPDT
;
118 writel(value
, ioaddr
+ PTP_TCR
);
120 /* wait for present system time adjust/update to complete */
123 if (!(readl(ioaddr
+ PTP_TCR
) & PTP_TCR_TSUPDT
))
133 static u64
stmmac_get_systime(void __iomem
*ioaddr
)
137 ns
= readl(ioaddr
+ PTP_STNSR
);
138 /* convert sec time value to nanosecond */
139 ns
+= readl(ioaddr
+ PTP_STSR
) * 1000000000ULL;
144 const struct stmmac_hwtimestamp stmmac_ptp
= {
145 .config_hw_tstamping
= stmmac_config_hw_tstamping
,
146 .init_systime
= stmmac_init_systime
,
147 .config_sub_second_increment
= stmmac_config_sub_second_increment
,
148 .config_addend
= stmmac_config_addend
,
149 .adjust_systime
= stmmac_adjust_systime
,
150 .get_systime
= stmmac_get_systime
,