1 /* SPDX-License-Identifier: GPL-2.0 */
2 /* Copyright (c) 2019, Vladimir Oltean <olteanv@gmail.com>
7 #include <linux/timer.h>
9 #if IS_ENABLED(CONFIG_NET_DSA_SJA1105_PTP)
11 /* Timestamps are in units of 8 ns clock ticks (equivalent to
12 * a fixed 125 MHz clock).
14 #define SJA1105_TICK_NS 8
16 static inline s64 ns_to_sja1105_ticks(s64 ns)
18 return ns / SJA1105_TICK_NS;
21 static inline s64 sja1105_ticks_to_ns(s64 ticks)
23 return ticks * SJA1105_TICK_NS;
26 /* Calculate the first base_time in the future that satisfies this
29 * future_base_time = base_time + N x cycle_time >= now, or
32 * N >= ---------------
35 * Because N is an integer, the ceiling value of the above "a / b" ratio
36 * is in fact precisely the floor value of "(a + b - 1) / b", which is
37 * easier to calculate only having integer division tools.
39 static inline s64 future_base_time(s64 base_time, s64 cycle_time, s64 now)
48 n = div_s64(a + b - 1, b);
50 return base_time + n * cycle_time;
53 /* This is not a preprocessor macro because the "ns" argument may or may not be
54 * s64 at caller side. This ensures it is properly type-cast before div_s64.
56 static inline s64 ns_to_sja1105_delta(s64 ns)
58 return div_s64(ns, 200);
61 static inline s64 sja1105_delta_to_ns(s64 delta)
66 struct sja1105_ptp_cmd {
67 u64 startptpcp; /* start toggling PTP_CLK pin */
68 u64 stopptpcp; /* stop toggling PTP_CLK pin */
69 u64 ptpstrtsch; /* start schedule */
70 u64 ptpstopsch; /* stop schedule */
71 u64 resptp; /* reset */
72 u64 corrclk4ts; /* use the corrected clock for timestamps */
73 u64 ptpclkadd; /* enum sja1105_ptp_clk_mode */
76 struct sja1105_ptp_data {
77 struct timer_list extts_timer;
78 /* Used only on SJA1105 to reconstruct partial timestamps */
79 struct sk_buff_head skb_rxtstamp_queue;
80 /* Used on SJA1110 where meta frames are generated only for
81 * 2-step TX timestamps
83 struct sk_buff_head skb_txtstamp_queue;
84 struct ptp_clock_info caps;
85 struct ptp_clock *clock;
86 struct sja1105_ptp_cmd cmd;
87 /* Serializes all operations on the PTP hardware clock */
93 int sja1105_ptp_clock_register(struct dsa_switch *ds);
95 void sja1105_ptp_clock_unregister(struct dsa_switch *ds);
97 void sja1105et_ptp_cmd_packing(u8 *buf, struct sja1105_ptp_cmd *cmd,
100 void sja1105pqrs_ptp_cmd_packing(u8 *buf, struct sja1105_ptp_cmd *cmd,
103 int sja1105_get_ts_info(struct dsa_switch *ds, int port,
104 struct ethtool_ts_info *ts);
106 void sja1105_ptp_txtstamp_skb(struct dsa_switch *ds, int slot,
107 struct sk_buff *clone);
109 bool sja1105_port_rxtstamp(struct dsa_switch *ds, int port,
110 struct sk_buff *skb, unsigned int type);
112 void sja1105_port_txtstamp(struct dsa_switch *ds, int port,
113 struct sk_buff *skb);
115 int sja1105_hwtstamp_get(struct dsa_switch *ds, int port, struct ifreq *ifr);
117 int sja1105_hwtstamp_set(struct dsa_switch *ds, int port, struct ifreq *ifr);
119 int __sja1105_ptp_gettimex(struct dsa_switch *ds, u64 *ns,
120 struct ptp_system_timestamp *sts);
122 int __sja1105_ptp_settime(struct dsa_switch *ds, u64 ns,
123 struct ptp_system_timestamp *ptp_sts);
125 int __sja1105_ptp_adjtime(struct dsa_switch *ds, s64 delta);
127 int sja1105_ptp_commit(struct dsa_switch *ds, struct sja1105_ptp_cmd *cmd,
128 sja1105_spi_rw_mode_t rw);
130 bool sja1105_rxtstamp(struct dsa_switch *ds, int port, struct sk_buff *skb);
131 bool sja1110_rxtstamp(struct dsa_switch *ds, int port, struct sk_buff *skb);
132 void sja1110_txtstamp(struct dsa_switch *ds, int port, struct sk_buff *skb);
136 struct sja1105_ptp_cmd;
138 /* Structures cannot be empty in C. Bah!
139 * Keep the mutex as the only element, which is a bit more difficult to
140 * refactor out of sja1105_main.c anyway.
142 struct sja1105_ptp_data {
146 static inline int sja1105_ptp_clock_register(struct dsa_switch *ds)
151 static inline void sja1105_ptp_clock_unregister(struct dsa_switch *ds) { }
153 static inline void sja1105_ptp_txtstamp_skb(struct dsa_switch *ds, int slot,
154 struct sk_buff *clone)
158 static inline int __sja1105_ptp_gettimex(struct dsa_switch *ds, u64 *ns,
159 struct ptp_system_timestamp *sts)
164 static inline int __sja1105_ptp_settime(struct dsa_switch *ds, u64 ns,
165 struct ptp_system_timestamp *ptp_sts)
170 static inline int __sja1105_ptp_adjtime(struct dsa_switch *ds, s64 delta)
175 static inline int sja1105_ptp_commit(struct dsa_switch *ds,
176 struct sja1105_ptp_cmd *cmd,
177 sja1105_spi_rw_mode_t rw)
182 #define sja1105et_ptp_cmd_packing NULL
184 #define sja1105pqrs_ptp_cmd_packing NULL
186 #define sja1105_get_ts_info NULL
188 #define sja1105_port_rxtstamp NULL
190 #define sja1105_port_txtstamp NULL
192 #define sja1105_hwtstamp_get NULL
194 #define sja1105_hwtstamp_set NULL
196 #define sja1105_rxtstamp NULL
197 #define sja1110_rxtstamp NULL
198 #define sja1110_txtstamp NULL
200 #endif /* IS_ENABLED(CONFIG_NET_DSA_SJA1105_PTP) */
202 #endif /* _SJA1105_PTP_H */