Lines Matching +full:ptp +full:- +full:timer
1 // SPDX-License-Identifier: GPL-2.0+
2 /* PTP 1588 clock using the Renesas Ethernet AVB
4 * Copyright (C) 2013-2015 Renesas Electronics Corporation
6 * Copyright (C) 2015-2016 Cogent Embedded, Inc. <source@cogentembedded.com>
13 struct net_device *ndev = priv->ndev;
27 struct net_device *ndev = priv->ndev;
34 ts->tv_nsec = ravb_read(ndev, GCT0);
35 ts->tv_sec = ravb_read(ndev, GCT1) |
45 struct net_device *ndev = priv->ndev;
55 return -EBUSY;
56 ravb_write(ndev, ts->tv_nsec, GTO0);
57 ravb_write(ndev, ts->tv_sec, GTO1);
58 ravb_write(ndev, (ts->tv_sec >> 32) & 0xffff, GTO2);
67 struct net_device *ndev = priv->ndev;
69 * [x-1 to x+1] (x is the configured increment value in
71 * not detected when the timer wraps around.
73 u32 gti_ns_plus_1 = (priv->ptp.current_addend >> 20) + 1;
78 else if (ns > 0 - gti_ns_plus_1)
79 ns = 0 - gti_ns_plus_1;
83 return -EBUSY;
90 /* PTP clock operations */
91 static int ravb_ptp_adjfine(struct ptp_clock_info *ptp, long scaled_ppm)
93 struct ravb_private *priv = container_of(ptp, struct ravb_private,
94 ptp.info);
95 struct net_device *ndev = priv->ndev;
100 addend = (u32)adjust_by_scaled_ppm(priv->ptp.default_addend,
103 spin_lock_irqsave(&priv->lock, flags);
105 priv->ptp.current_addend = addend;
109 spin_unlock_irqrestore(&priv->lock, flags);
110 return -EBUSY;
115 spin_unlock_irqrestore(&priv->lock, flags);
120 static int ravb_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta)
122 struct ravb_private *priv = container_of(ptp, struct ravb_private,
123 ptp.info);
128 spin_lock_irqsave(&priv->lock, flags);
136 spin_unlock_irqrestore(&priv->lock, flags);
141 static int ravb_ptp_gettime64(struct ptp_clock_info *ptp, struct timespec64 *ts)
143 struct ravb_private *priv = container_of(ptp, struct ravb_private,
144 ptp.info);
148 spin_lock_irqsave(&priv->lock, flags);
150 spin_unlock_irqrestore(&priv->lock, flags);
155 static int ravb_ptp_settime64(struct ptp_clock_info *ptp,
158 struct ravb_private *priv = container_of(ptp, struct ravb_private,
159 ptp.info);
163 spin_lock_irqsave(&priv->lock, flags);
165 spin_unlock_irqrestore(&priv->lock, flags);
170 static int ravb_ptp_extts(struct ptp_clock_info *ptp,
173 struct ravb_private *priv = container_of(ptp, struct ravb_private,
174 ptp.info);
175 const struct ravb_hw_info *info = priv->info;
176 struct net_device *ndev = priv->ndev;
179 if (req->index)
180 return -EINVAL;
182 if (priv->ptp.extts[req->index] == on)
184 priv->ptp.extts[req->index] = on;
186 spin_lock_irqsave(&priv->lock, flags);
187 if (!info->irq_en_dis)
193 spin_unlock_irqrestore(&priv->lock, flags);
198 static int ravb_ptp_perout(struct ptp_clock_info *ptp,
201 struct ravb_private *priv = container_of(ptp, struct ravb_private,
202 ptp.info);
203 const struct ravb_hw_info *info = priv->info;
204 struct net_device *ndev = priv->ndev;
209 if (req->index)
210 return -EINVAL;
216 start_ns = req->start.sec * NSEC_PER_SEC + req->start.nsec;
217 period_ns = req->period.sec * NSEC_PER_SEC + req->period.nsec;
221 "ptp: start value (nsec) is over limit. Maximum size of start is only 32 bits\n");
222 return -ERANGE;
227 "ptp: period value (nsec) is over limit. Maximum size of period is only 32 bits\n");
228 return -ERANGE;
231 spin_lock_irqsave(&priv->lock, flags);
233 perout = &priv->ptp.perout[req->index];
234 perout->target = (u32)start_ns;
235 perout->period = (u32)period_ns;
239 if (!info->irq_en_dis)
245 spin_lock_irqsave(&priv->lock, flags);
247 perout = &priv->ptp.perout[req->index];
248 perout->period = 0;
251 if (!info->irq_en_dis)
256 spin_unlock_irqrestore(&priv->lock, flags);
261 static int ravb_ptp_enable(struct ptp_clock_info *ptp,
264 switch (req->type) {
266 return ravb_ptp_extts(ptp, &req->extts, on);
268 return ravb_ptp_perout(ptp, &req->perout, on);
270 return -EOPNOTSUPP;
301 ptp_clock_event(priv->ptp.clock, &event);
304 struct ravb_ptp_perout *perout = priv->ptp.perout;
306 if (perout->period) {
307 perout->target += perout->period;
308 ravb_ptp_update_compare(priv, perout->target);
320 priv->ptp.info = ravb_ptp_info;
322 priv->ptp.default_addend = ravb_read(ndev, GTI);
323 priv->ptp.current_addend = priv->ptp.default_addend;
325 spin_lock_irqsave(&priv->lock, flags);
328 spin_unlock_irqrestore(&priv->lock, flags);
330 priv->ptp.clock = ptp_clock_register(&priv->ptp.info, &pdev->dev);
340 ptp_clock_unregister(priv->ptp.clock);