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 The full GNU General Public License is included in this distribution in
16 the file called "COPYING".
18 Author: Rayagond Kokatanur <rayagond@vayavyalabs.com>
19 Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
20 *******************************************************************************/
23 #include <linux/delay.h>
25 #include "stmmac_ptp.h"
27 static void stmmac_config_hw_tstamping(void __iomem *ioaddr, u32 data)
29 writel(data, ioaddr + PTP_TCR);
32 static u32 stmmac_config_sub_second_increment(void __iomem *ioaddr,
33 u32 ptp_clock, int gmac4)
35 u32 value = readl(ioaddr + PTP_TCR);
39 /* For GMAC3.x, 4.x versions, in "fine adjustement mode" set sub-second
40 * increment to twice the number of nanoseconds of a clock cycle.
41 * The calculation of the default_addend value by the caller will set it
42 * to mid-range = 2^31 when the remainder of this division is zero,
43 * which will make the accumulator overflow once every 2 ptp_clock
44 * cycles, adding twice the number of nanoseconds of a clock cycle :
45 * 2000000000ULL / ptp_clock.
47 if (value & PTP_TCR_TSCFUPDT)
48 data = (2000000000ULL / ptp_clock);
50 data = (1000000000ULL / ptp_clock);
52 /* 0.465ns accuracy */
53 if (!(value & PTP_TCR_TSCTRLSSR))
54 data = (data * 1000) / 465;
56 if (data > PTP_SSIR_SSINC_MAX)
57 data = PTP_SSIR_SSINC_MAX;
61 reg_value <<= GMAC4_PTP_SSIR_SSINC_SHIFT;
63 writel(reg_value, ioaddr + PTP_SSIR);
68 static int stmmac_init_systime(void __iomem *ioaddr, u32 sec, u32 nsec)
73 writel(sec, ioaddr + PTP_STSUR);
74 writel(nsec, ioaddr + PTP_STNSUR);
75 /* issue command to initialize the system time value */
76 value = readl(ioaddr + PTP_TCR);
77 value |= PTP_TCR_TSINIT;
78 writel(value, ioaddr + PTP_TCR);
80 /* wait for present system time initialize to complete */
83 if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSINIT))
93 static int stmmac_config_addend(void __iomem *ioaddr, u32 addend)
98 writel(addend, ioaddr + PTP_TAR);
99 /* issue command to update the addend value */
100 value = readl(ioaddr + PTP_TCR);
101 value |= PTP_TCR_TSADDREG;
102 writel(value, ioaddr + PTP_TCR);
104 /* wait for present addend update to complete */
107 if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSADDREG))
117 static int stmmac_adjust_systime(void __iomem *ioaddr, u32 sec, u32 nsec,
118 int add_sub, int gmac4)
124 /* If the new sec value needs to be subtracted with
125 * the system time, then MAC_STSUR reg should be
126 * programmed with (2^32 – <new_sec_value>)
131 value = readl(ioaddr + PTP_TCR);
132 if (value & PTP_TCR_TSCTRLSSR)
133 nsec = (PTP_DIGITAL_ROLLOVER_MODE - nsec);
135 nsec = (PTP_BINARY_ROLLOVER_MODE - nsec);
138 writel(sec, ioaddr + PTP_STSUR);
139 value = (add_sub << PTP_STNSUR_ADDSUB_SHIFT) | nsec;
140 writel(value, ioaddr + PTP_STNSUR);
142 /* issue command to initialize the system time value */
143 value = readl(ioaddr + PTP_TCR);
144 value |= PTP_TCR_TSUPDT;
145 writel(value, ioaddr + PTP_TCR);
147 /* wait for present system time adjust/update to complete */
150 if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSUPDT))
160 static u64 stmmac_get_systime(void __iomem *ioaddr)
164 /* Get the TSSS value */
165 ns = readl(ioaddr + PTP_STNSR);
166 /* Get the TSS and convert sec time value to nanosecond */
167 ns += readl(ioaddr + PTP_STSR) * 1000000000ULL;
172 const struct stmmac_hwtimestamp stmmac_ptp = {
173 .config_hw_tstamping = stmmac_config_hw_tstamping,
174 .init_systime = stmmac_init_systime,
175 .config_sub_second_increment = stmmac_config_sub_second_increment,
176 .config_addend = stmmac_config_addend,
177 .adjust_systime = stmmac_adjust_systime,
178 .get_systime = stmmac_get_systime,