Loading...
1/* SPDX-License-Identifier: GPL-2.0+ */
2/* Copyright (C) 2018 Microchip Technology Inc. */
3
4#include <linux/netdevice.h>
5
6#include <linux/ptp_clock_kernel.h>
7#include <linux/module.h>
8#include <linux/pci.h>
9#include <linux/net_tstamp.h>
10#include "lan743x_main.h"
11
12#include "lan743x_ptp.h"
13
14#define LAN743X_LED0_ENABLE 20 /* LED0 offset in HW_CFG */
15#define LAN743X_LED_ENABLE(pin) BIT(LAN743X_LED0_ENABLE + (pin))
16
17#define LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB (31249999)
18#define LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM (2047999934)
19
20static bool lan743x_ptp_is_enabled(struct lan743x_adapter *adapter);
21static void lan743x_ptp_enable(struct lan743x_adapter *adapter);
22static void lan743x_ptp_disable(struct lan743x_adapter *adapter);
23static void lan743x_ptp_reset(struct lan743x_adapter *adapter);
24static void lan743x_ptp_clock_set(struct lan743x_adapter *adapter,
25 u32 seconds, u32 nano_seconds,
26 u32 sub_nano_seconds);
27
28static int lan743x_get_channel(u32 ch_map)
29{
30 int idx;
31
32 for (idx = 0; idx < 32; idx++) {
33 if (ch_map & (0x1 << idx))
34 return idx;
35 }
36
37 return -EINVAL;
38}
39
40int lan743x_gpio_init(struct lan743x_adapter *adapter)
41{
42 struct lan743x_gpio *gpio = &adapter->gpio;
43
44 spin_lock_init(&gpio->gpio_lock);
45
46 gpio->gpio_cfg0 = 0; /* set all direction to input, data = 0 */
47 gpio->gpio_cfg1 = 0x0FFF0000;/* disable all gpio, set to open drain */
48 gpio->gpio_cfg2 = 0;/* set all to 1588 low polarity level */
49 gpio->gpio_cfg3 = 0;/* disable all 1588 output */
50 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
51 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
52 lan743x_csr_write(adapter, GPIO_CFG2, gpio->gpio_cfg2);
53 lan743x_csr_write(adapter, GPIO_CFG3, gpio->gpio_cfg3);
54
55 return 0;
56}
57
58static void lan743x_ptp_wait_till_cmd_done(struct lan743x_adapter *adapter,
59 u32 bit_mask)
60{
61 int timeout = 1000;
62 u32 data = 0;
63
64 while (timeout &&
65 (data = (lan743x_csr_read(adapter, PTP_CMD_CTL) &
66 bit_mask))) {
67 usleep_range(1000, 20000);
68 timeout--;
69 }
70 if (data) {
71 netif_err(adapter, drv, adapter->netdev,
72 "timeout waiting for cmd to be done, cmd = 0x%08X\n",
73 bit_mask);
74 }
75}
76
77static void lan743x_ptp_tx_ts_enqueue_ts(struct lan743x_adapter *adapter,
78 u32 seconds, u32 nano_seconds,
79 u32 header)
80{
81 struct lan743x_ptp *ptp = &adapter->ptp;
82
83 spin_lock_bh(&ptp->tx_ts_lock);
84 if (ptp->tx_ts_queue_size < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
85 ptp->tx_ts_seconds_queue[ptp->tx_ts_queue_size] = seconds;
86 ptp->tx_ts_nseconds_queue[ptp->tx_ts_queue_size] = nano_seconds;
87 ptp->tx_ts_header_queue[ptp->tx_ts_queue_size] = header;
88 ptp->tx_ts_queue_size++;
89 } else {
90 netif_err(adapter, drv, adapter->netdev,
91 "tx ts queue overflow\n");
92 }
93 spin_unlock_bh(&ptp->tx_ts_lock);
94}
95
96static void lan743x_ptp_tx_ts_complete(struct lan743x_adapter *adapter)
97{
98 struct lan743x_ptp *ptp = &adapter->ptp;
99 struct skb_shared_hwtstamps tstamps;
100 u32 header, nseconds, seconds;
101 bool ignore_sync = false;
102 struct sk_buff *skb;
103 int c, i;
104
105 spin_lock_bh(&ptp->tx_ts_lock);
106 c = ptp->tx_ts_skb_queue_size;
107
108 if (c > ptp->tx_ts_queue_size)
109 c = ptp->tx_ts_queue_size;
110 if (c <= 0)
111 goto done;
112
113 for (i = 0; i < c; i++) {
114 ignore_sync = ((ptp->tx_ts_ignore_sync_queue &
115 BIT(i)) != 0);
116 skb = ptp->tx_ts_skb_queue[i];
117 nseconds = ptp->tx_ts_nseconds_queue[i];
118 seconds = ptp->tx_ts_seconds_queue[i];
119 header = ptp->tx_ts_header_queue[i];
120
121 memset(&tstamps, 0, sizeof(tstamps));
122 tstamps.hwtstamp = ktime_set(seconds, nseconds);
123 if (!ignore_sync ||
124 ((header & PTP_TX_MSG_HEADER_MSG_TYPE_) !=
125 PTP_TX_MSG_HEADER_MSG_TYPE_SYNC_))
126 skb_tstamp_tx(skb, &tstamps);
127
128 dev_kfree_skb(skb);
129
130 ptp->tx_ts_skb_queue[i] = NULL;
131 ptp->tx_ts_seconds_queue[i] = 0;
132 ptp->tx_ts_nseconds_queue[i] = 0;
133 ptp->tx_ts_header_queue[i] = 0;
134 }
135
136 /* shift queue */
137 ptp->tx_ts_ignore_sync_queue >>= c;
138 for (i = c; i < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS; i++) {
139 ptp->tx_ts_skb_queue[i - c] = ptp->tx_ts_skb_queue[i];
140 ptp->tx_ts_seconds_queue[i - c] = ptp->tx_ts_seconds_queue[i];
141 ptp->tx_ts_nseconds_queue[i - c] = ptp->tx_ts_nseconds_queue[i];
142 ptp->tx_ts_header_queue[i - c] = ptp->tx_ts_header_queue[i];
143
144 ptp->tx_ts_skb_queue[i] = NULL;
145 ptp->tx_ts_seconds_queue[i] = 0;
146 ptp->tx_ts_nseconds_queue[i] = 0;
147 ptp->tx_ts_header_queue[i] = 0;
148 }
149 ptp->tx_ts_skb_queue_size -= c;
150 ptp->tx_ts_queue_size -= c;
151done:
152 ptp->pending_tx_timestamps -= c;
153 spin_unlock_bh(&ptp->tx_ts_lock);
154}
155
156static int lan743x_ptp_reserve_event_ch(struct lan743x_adapter *adapter,
157 int event_channel)
158{
159 struct lan743x_ptp *ptp = &adapter->ptp;
160 int result = -ENODEV;
161
162 mutex_lock(&ptp->command_lock);
163 if (!(test_bit(event_channel, &ptp->used_event_ch))) {
164 ptp->used_event_ch |= BIT(event_channel);
165 result = event_channel;
166 } else {
167 netif_warn(adapter, drv, adapter->netdev,
168 "attempted to reserved a used event_channel = %d\n",
169 event_channel);
170 }
171 mutex_unlock(&ptp->command_lock);
172 return result;
173}
174
175static void lan743x_ptp_release_event_ch(struct lan743x_adapter *adapter,
176 int event_channel)
177{
178 struct lan743x_ptp *ptp = &adapter->ptp;
179
180 mutex_lock(&ptp->command_lock);
181 if (test_bit(event_channel, &ptp->used_event_ch)) {
182 ptp->used_event_ch &= ~BIT(event_channel);
183 } else {
184 netif_warn(adapter, drv, adapter->netdev,
185 "attempted release on a not used event_channel = %d\n",
186 event_channel);
187 }
188 mutex_unlock(&ptp->command_lock);
189}
190
191static void lan743x_ptp_clock_get(struct lan743x_adapter *adapter,
192 u32 *seconds, u32 *nano_seconds,
193 u32 *sub_nano_seconds);
194static void lan743x_ptp_io_clock_get(struct lan743x_adapter *adapter,
195 u32 *sec, u32 *nsec, u32 *sub_nsec);
196static void lan743x_ptp_clock_step(struct lan743x_adapter *adapter,
197 s64 time_step_ns);
198
199static void lan743x_led_mux_enable(struct lan743x_adapter *adapter,
200 int pin, bool enable)
201{
202 struct lan743x_ptp *ptp = &adapter->ptp;
203
204 if (ptp->leds_multiplexed &&
205 ptp->led_enabled[pin]) {
206 u32 val = lan743x_csr_read(adapter, HW_CFG);
207
208 if (enable)
209 val |= LAN743X_LED_ENABLE(pin);
210 else
211 val &= ~LAN743X_LED_ENABLE(pin);
212
213 lan743x_csr_write(adapter, HW_CFG, val);
214 }
215}
216
217static void lan743x_led_mux_save(struct lan743x_adapter *adapter)
218{
219 struct lan743x_ptp *ptp = &adapter->ptp;
220 u32 id_rev = adapter->csr.id_rev & ID_REV_ID_MASK_;
221
222 if (id_rev == ID_REV_ID_LAN7430_) {
223 int i;
224 u32 val = lan743x_csr_read(adapter, HW_CFG);
225
226 for (i = 0; i < LAN7430_N_LED; i++) {
227 bool led_enabled = (val & LAN743X_LED_ENABLE(i)) != 0;
228
229 ptp->led_enabled[i] = led_enabled;
230 }
231 ptp->leds_multiplexed = true;
232 } else {
233 ptp->leds_multiplexed = false;
234 }
235}
236
237static void lan743x_led_mux_restore(struct lan743x_adapter *adapter)
238{
239 u32 id_rev = adapter->csr.id_rev & ID_REV_ID_MASK_;
240
241 if (id_rev == ID_REV_ID_LAN7430_) {
242 int i;
243
244 for (i = 0; i < LAN7430_N_LED; i++)
245 lan743x_led_mux_enable(adapter, i, true);
246 }
247}
248
249static int lan743x_gpio_rsrv_ptp_out(struct lan743x_adapter *adapter,
250 int pin, int event_channel)
251{
252 struct lan743x_gpio *gpio = &adapter->gpio;
253 unsigned long irq_flags = 0;
254 int bit_mask = BIT(pin);
255 int ret = -EBUSY;
256
257 spin_lock_irqsave(&gpio->gpio_lock, irq_flags);
258
259 if (!(gpio->used_bits & bit_mask)) {
260 gpio->used_bits |= bit_mask;
261 gpio->output_bits |= bit_mask;
262 gpio->ptp_bits |= bit_mask;
263
264 /* assign pin to GPIO function */
265 lan743x_led_mux_enable(adapter, pin, false);
266
267 /* set as output, and zero initial value */
268 gpio->gpio_cfg0 |= GPIO_CFG0_GPIO_DIR_BIT_(pin);
269 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DATA_BIT_(pin);
270 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
271
272 /* enable gpio, and set buffer type to push pull */
273 gpio->gpio_cfg1 &= ~GPIO_CFG1_GPIOEN_BIT_(pin);
274 gpio->gpio_cfg1 |= GPIO_CFG1_GPIOBUF_BIT_(pin);
275 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
276
277 /* set 1588 polarity to high */
278 gpio->gpio_cfg2 |= GPIO_CFG2_1588_POL_BIT_(pin);
279 lan743x_csr_write(adapter, GPIO_CFG2, gpio->gpio_cfg2);
280
281 if (event_channel == 0) {
282 /* use channel A */
283 gpio->gpio_cfg3 &= ~GPIO_CFG3_1588_CH_SEL_BIT_(pin);
284 } else {
285 /* use channel B */
286 gpio->gpio_cfg3 |= GPIO_CFG3_1588_CH_SEL_BIT_(pin);
287 }
288 gpio->gpio_cfg3 |= GPIO_CFG3_1588_OE_BIT_(pin);
289 lan743x_csr_write(adapter, GPIO_CFG3, gpio->gpio_cfg3);
290
291 ret = pin;
292 }
293 spin_unlock_irqrestore(&gpio->gpio_lock, irq_flags);
294 return ret;
295}
296
297static void lan743x_gpio_release(struct lan743x_adapter *adapter, int pin)
298{
299 struct lan743x_gpio *gpio = &adapter->gpio;
300 unsigned long irq_flags = 0;
301 int bit_mask = BIT(pin);
302
303 spin_lock_irqsave(&gpio->gpio_lock, irq_flags);
304 if (gpio->used_bits & bit_mask) {
305 gpio->used_bits &= ~bit_mask;
306 if (gpio->output_bits & bit_mask) {
307 gpio->output_bits &= ~bit_mask;
308
309 if (gpio->ptp_bits & bit_mask) {
310 gpio->ptp_bits &= ~bit_mask;
311 /* disable ptp output */
312 gpio->gpio_cfg3 &= ~GPIO_CFG3_1588_OE_BIT_(pin);
313 lan743x_csr_write(adapter, GPIO_CFG3,
314 gpio->gpio_cfg3);
315 }
316 /* release gpio output */
317
318 /* disable gpio */
319 gpio->gpio_cfg1 |= GPIO_CFG1_GPIOEN_BIT_(pin);
320 gpio->gpio_cfg1 &= ~GPIO_CFG1_GPIOBUF_BIT_(pin);
321 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
322
323 /* reset back to input */
324 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DIR_BIT_(pin);
325 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DATA_BIT_(pin);
326 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
327
328 /* assign pin to original function */
329 lan743x_led_mux_enable(adapter, pin, true);
330 }
331 }
332 spin_unlock_irqrestore(&gpio->gpio_lock, irq_flags);
333}
334
335static int lan743x_ptpci_adjfine(struct ptp_clock_info *ptpci, long scaled_ppm)
336{
337 struct lan743x_ptp *ptp =
338 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
339 struct lan743x_adapter *adapter =
340 container_of(ptp, struct lan743x_adapter, ptp);
341 u32 lan743x_rate_adj = 0;
342 u64 u64_delta;
343
344 if ((scaled_ppm < (-LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM)) ||
345 scaled_ppm > LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM) {
346 return -EINVAL;
347 }
348
349 /* diff_by_scaled_ppm returns true if the difference is negative */
350 if (diff_by_scaled_ppm(1ULL << 35, scaled_ppm, &u64_delta))
351 lan743x_rate_adj = (u32)u64_delta;
352 else
353 lan743x_rate_adj = (u32)u64_delta | PTP_CLOCK_RATE_ADJ_DIR_;
354
355 lan743x_csr_write(adapter, PTP_CLOCK_RATE_ADJ,
356 lan743x_rate_adj);
357
358 return 0;
359}
360
361static int lan743x_ptpci_adjtime(struct ptp_clock_info *ptpci, s64 delta)
362{
363 struct lan743x_ptp *ptp =
364 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
365 struct lan743x_adapter *adapter =
366 container_of(ptp, struct lan743x_adapter, ptp);
367
368 lan743x_ptp_clock_step(adapter, delta);
369
370 return 0;
371}
372
373static int lan743x_ptpci_gettime64(struct ptp_clock_info *ptpci,
374 struct timespec64 *ts)
375{
376 struct lan743x_ptp *ptp =
377 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
378 struct lan743x_adapter *adapter =
379 container_of(ptp, struct lan743x_adapter, ptp);
380 u32 nano_seconds = 0;
381 u32 seconds = 0;
382
383 if (adapter->is_pci11x1x)
384 lan743x_ptp_io_clock_get(adapter, &seconds, &nano_seconds,
385 NULL);
386 else
387 lan743x_ptp_clock_get(adapter, &seconds, &nano_seconds, NULL);
388 ts->tv_sec = seconds;
389 ts->tv_nsec = nano_seconds;
390
391 return 0;
392}
393
394static int lan743x_ptpci_settime64(struct ptp_clock_info *ptpci,
395 const struct timespec64 *ts)
396{
397 struct lan743x_ptp *ptp =
398 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
399 struct lan743x_adapter *adapter =
400 container_of(ptp, struct lan743x_adapter, ptp);
401 u32 nano_seconds = 0;
402 u32 seconds = 0;
403
404 if (ts) {
405 if (ts->tv_sec > 0xFFFFFFFFLL ||
406 ts->tv_sec < 0) {
407 netif_warn(adapter, drv, adapter->netdev,
408 "ts->tv_sec out of range, %lld\n",
409 ts->tv_sec);
410 return -ERANGE;
411 }
412 if (ts->tv_nsec >= 1000000000L ||
413 ts->tv_nsec < 0) {
414 netif_warn(adapter, drv, adapter->netdev,
415 "ts->tv_nsec out of range, %ld\n",
416 ts->tv_nsec);
417 return -ERANGE;
418 }
419 seconds = ts->tv_sec;
420 nano_seconds = ts->tv_nsec;
421 lan743x_ptp_clock_set(adapter, seconds, nano_seconds, 0);
422 } else {
423 netif_warn(adapter, drv, adapter->netdev, "ts == NULL\n");
424 return -EINVAL;
425 }
426
427 return 0;
428}
429
430static void lan743x_ptp_perout_off(struct lan743x_adapter *adapter,
431 unsigned int index)
432{
433 struct lan743x_ptp *ptp = &adapter->ptp;
434 u32 general_config = 0;
435 struct lan743x_ptp_perout *perout = &ptp->perout[index];
436
437 if (perout->gpio_pin >= 0) {
438 lan743x_gpio_release(adapter, perout->gpio_pin);
439 perout->gpio_pin = -1;
440 }
441
442 if (perout->event_ch >= 0) {
443 /* set target to far in the future, effectively disabling it */
444 lan743x_csr_write(adapter,
445 PTP_CLOCK_TARGET_SEC_X(perout->event_ch),
446 0xFFFF0000);
447 lan743x_csr_write(adapter,
448 PTP_CLOCK_TARGET_NS_X(perout->event_ch),
449 0);
450
451 general_config = lan743x_csr_read(adapter, PTP_GENERAL_CONFIG);
452 general_config |= PTP_GENERAL_CONFIG_RELOAD_ADD_X_
453 (perout->event_ch);
454 lan743x_csr_write(adapter, PTP_GENERAL_CONFIG, general_config);
455 lan743x_ptp_release_event_ch(adapter, perout->event_ch);
456 perout->event_ch = -1;
457 }
458}
459
460static int lan743x_ptp_perout(struct lan743x_adapter *adapter, int on,
461 struct ptp_perout_request *perout_request)
462{
463 struct lan743x_ptp *ptp = &adapter->ptp;
464 u32 period_sec = 0, period_nsec = 0;
465 u32 start_sec = 0, start_nsec = 0;
466 u32 general_config = 0;
467 int pulse_width = 0;
468 int perout_pin = 0;
469 unsigned int index = perout_request->index;
470 struct lan743x_ptp_perout *perout = &ptp->perout[index];
471 int ret = 0;
472
473 /* Reject requests with unsupported flags */
474 if (perout_request->flags & ~PTP_PEROUT_DUTY_CYCLE)
475 return -EOPNOTSUPP;
476
477 if (on) {
478 perout_pin = ptp_find_pin(ptp->ptp_clock, PTP_PF_PEROUT,
479 perout_request->index);
480 if (perout_pin < 0)
481 return -EBUSY;
482 } else {
483 lan743x_ptp_perout_off(adapter, index);
484 return 0;
485 }
486
487 if (perout->event_ch >= 0 ||
488 perout->gpio_pin >= 0) {
489 /* already on, turn off first */
490 lan743x_ptp_perout_off(adapter, index);
491 }
492
493 perout->event_ch = lan743x_ptp_reserve_event_ch(adapter, index);
494
495 if (perout->event_ch < 0) {
496 netif_warn(adapter, drv, adapter->netdev,
497 "Failed to reserve event channel %d for PEROUT\n",
498 index);
499 ret = -EBUSY;
500 goto failed;
501 }
502
503 perout->gpio_pin = lan743x_gpio_rsrv_ptp_out(adapter,
504 perout_pin,
505 perout->event_ch);
506
507 if (perout->gpio_pin < 0) {
508 netif_warn(adapter, drv, adapter->netdev,
509 "Failed to reserve gpio %d for PEROUT\n",
510 perout_pin);
511 ret = -EBUSY;
512 goto failed;
513 }
514
515 start_sec = perout_request->start.sec;
516 start_sec += perout_request->start.nsec / 1000000000;
517 start_nsec = perout_request->start.nsec % 1000000000;
518
519 period_sec = perout_request->period.sec;
520 period_sec += perout_request->period.nsec / 1000000000;
521 period_nsec = perout_request->period.nsec % 1000000000;
522
523 if (perout_request->flags & PTP_PEROUT_DUTY_CYCLE) {
524 struct timespec64 ts_on, ts_period;
525 s64 wf_high, period64, half;
526 s32 reminder;
527
528 ts_on.tv_sec = perout_request->on.sec;
529 ts_on.tv_nsec = perout_request->on.nsec;
530 wf_high = timespec64_to_ns(&ts_on);
531 ts_period.tv_sec = perout_request->period.sec;
532 ts_period.tv_nsec = perout_request->period.nsec;
533 period64 = timespec64_to_ns(&ts_period);
534
535 if (period64 < 200) {
536 netif_warn(adapter, drv, adapter->netdev,
537 "perout period too small, minimum is 200nS\n");
538 ret = -EOPNOTSUPP;
539 goto failed;
540 }
541 if (wf_high >= period64) {
542 netif_warn(adapter, drv, adapter->netdev,
543 "pulse width must be smaller than period\n");
544 ret = -EINVAL;
545 goto failed;
546 }
547
548 /* Check if we can do 50% toggle on an even value of period.
549 * If the period number is odd, then check if the requested
550 * pulse width is the same as one of pre-defined width values.
551 * Otherwise, return failure.
552 */
553 half = div_s64_rem(period64, 2, &reminder);
554 if (!reminder) {
555 if (half == wf_high) {
556 /* It's 50% match. Use the toggle option */
557 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_TOGGLE_;
558 /* In this case, devide period value by 2 */
559 ts_period = ns_to_timespec64(div_s64(period64, 2));
560 period_sec = ts_period.tv_sec;
561 period_nsec = ts_period.tv_nsec;
562
563 goto program;
564 }
565 }
566 /* if we can't do toggle, then the width option needs to be the exact match */
567 if (wf_high == 200000000) {
568 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
569 } else if (wf_high == 10000000) {
570 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10MS_;
571 } else if (wf_high == 1000000) {
572 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_1MS_;
573 } else if (wf_high == 100000) {
574 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100US_;
575 } else if (wf_high == 10000) {
576 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10US_;
577 } else if (wf_high == 100) {
578 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100NS_;
579 } else {
580 netif_warn(adapter, drv, adapter->netdev,
581 "duty cycle specified is not supported\n");
582 ret = -EOPNOTSUPP;
583 goto failed;
584 }
585 } else {
586 if (period_sec == 0) {
587 if (period_nsec >= 400000000) {
588 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
589 } else if (period_nsec >= 20000000) {
590 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10MS_;
591 } else if (period_nsec >= 2000000) {
592 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_1MS_;
593 } else if (period_nsec >= 200000) {
594 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100US_;
595 } else if (period_nsec >= 20000) {
596 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10US_;
597 } else if (period_nsec >= 200) {
598 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100NS_;
599 } else {
600 netif_warn(adapter, drv, adapter->netdev,
601 "perout period too small, minimum is 200nS\n");
602 ret = -EOPNOTSUPP;
603 goto failed;
604 }
605 } else {
606 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
607 }
608 }
609program:
610
611 /* turn off by setting target far in future */
612 lan743x_csr_write(adapter,
613 PTP_CLOCK_TARGET_SEC_X(perout->event_ch),
614 0xFFFF0000);
615 lan743x_csr_write(adapter,
616 PTP_CLOCK_TARGET_NS_X(perout->event_ch), 0);
617
618 /* Configure to pulse every period */
619 general_config = lan743x_csr_read(adapter, PTP_GENERAL_CONFIG);
620 general_config &= ~(PTP_GENERAL_CONFIG_CLOCK_EVENT_X_MASK_
621 (perout->event_ch));
622 general_config |= PTP_GENERAL_CONFIG_CLOCK_EVENT_X_SET_
623 (perout->event_ch, pulse_width);
624 general_config &= ~PTP_GENERAL_CONFIG_RELOAD_ADD_X_
625 (perout->event_ch);
626 lan743x_csr_write(adapter, PTP_GENERAL_CONFIG, general_config);
627
628 /* set the reload to one toggle cycle */
629 lan743x_csr_write(adapter,
630 PTP_CLOCK_TARGET_RELOAD_SEC_X(perout->event_ch),
631 period_sec);
632 lan743x_csr_write(adapter,
633 PTP_CLOCK_TARGET_RELOAD_NS_X(perout->event_ch),
634 period_nsec);
635
636 /* set the start time */
637 lan743x_csr_write(adapter,
638 PTP_CLOCK_TARGET_SEC_X(perout->event_ch),
639 start_sec);
640 lan743x_csr_write(adapter,
641 PTP_CLOCK_TARGET_NS_X(perout->event_ch),
642 start_nsec);
643
644 return 0;
645
646failed:
647 lan743x_ptp_perout_off(adapter, index);
648 return ret;
649}
650
651static void lan743x_ptp_io_perout_off(struct lan743x_adapter *adapter,
652 u32 index)
653{
654 struct lan743x_ptp *ptp = &adapter->ptp;
655 int perout_pin;
656 int event_ch;
657 u32 gen_cfg;
658 int val;
659
660 event_ch = ptp->ptp_io_perout[index];
661 if (event_ch >= 0) {
662 /* set target to far in the future, effectively disabling it */
663 lan743x_csr_write(adapter,
664 PTP_CLOCK_TARGET_SEC_X(event_ch),
665 0xFFFF0000);
666 lan743x_csr_write(adapter,
667 PTP_CLOCK_TARGET_NS_X(event_ch),
668 0);
669
670 gen_cfg = lan743x_csr_read(adapter, HS_PTP_GENERAL_CONFIG);
671 gen_cfg &= ~(HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_X_MASK_
672 (event_ch));
673 gen_cfg &= ~(HS_PTP_GENERAL_CONFIG_EVENT_POL_X_(event_ch));
674 gen_cfg |= HS_PTP_GENERAL_CONFIG_RELOAD_ADD_X_(event_ch);
675 lan743x_csr_write(adapter, HS_PTP_GENERAL_CONFIG, gen_cfg);
676 if (event_ch)
677 lan743x_csr_write(adapter, PTP_INT_STS,
678 PTP_INT_TIMER_INT_B_);
679 else
680 lan743x_csr_write(adapter, PTP_INT_STS,
681 PTP_INT_TIMER_INT_A_);
682 lan743x_ptp_release_event_ch(adapter, event_ch);
683 ptp->ptp_io_perout[index] = -1;
684 }
685
686 perout_pin = ptp_find_pin(ptp->ptp_clock, PTP_PF_PEROUT, index);
687
688 /* Deselect Event output */
689 val = lan743x_csr_read(adapter, PTP_IO_EVENT_OUTPUT_CFG);
690
691 /* Disables the output of Local Time Target compare events */
692 val &= ~PTP_IO_EVENT_OUTPUT_CFG_EN_(perout_pin);
693 lan743x_csr_write(adapter, PTP_IO_EVENT_OUTPUT_CFG, val);
694
695 /* Configured as an opendrain driver*/
696 val = lan743x_csr_read(adapter, PTP_IO_PIN_CFG);
697 val &= ~PTP_IO_PIN_CFG_OBUF_TYPE_(perout_pin);
698 lan743x_csr_write(adapter, PTP_IO_PIN_CFG, val);
699 /* Dummy read to make sure write operation success */
700 val = lan743x_csr_read(adapter, PTP_IO_PIN_CFG);
701}
702
703static int lan743x_ptp_io_perout(struct lan743x_adapter *adapter, int on,
704 struct ptp_perout_request *perout_request)
705{
706 struct lan743x_ptp *ptp = &adapter->ptp;
707 u32 period_sec, period_nsec;
708 u32 start_sec, start_nsec;
709 u32 pulse_sec, pulse_nsec;
710 int pulse_width;
711 int perout_pin;
712 int event_ch;
713 u32 gen_cfg;
714 u32 index;
715 int val;
716
717 index = perout_request->index;
718 event_ch = ptp->ptp_io_perout[index];
719
720 if (on) {
721 perout_pin = ptp_find_pin(ptp->ptp_clock, PTP_PF_PEROUT, index);
722 if (perout_pin < 0)
723 return -EBUSY;
724 } else {
725 lan743x_ptp_io_perout_off(adapter, index);
726 return 0;
727 }
728
729 if (event_ch >= LAN743X_PTP_N_EVENT_CHAN) {
730 /* already on, turn off first */
731 lan743x_ptp_io_perout_off(adapter, index);
732 }
733
734 event_ch = lan743x_ptp_reserve_event_ch(adapter, index);
735 if (event_ch < 0) {
736 netif_warn(adapter, drv, adapter->netdev,
737 "Failed to reserve event channel %d for PEROUT\n",
738 index);
739 goto failed;
740 }
741 ptp->ptp_io_perout[index] = event_ch;
742
743 if (perout_request->flags & PTP_PEROUT_DUTY_CYCLE) {
744 pulse_sec = perout_request->on.sec;
745 pulse_sec += perout_request->on.nsec / 1000000000;
746 pulse_nsec = perout_request->on.nsec % 1000000000;
747 } else {
748 pulse_sec = perout_request->period.sec;
749 pulse_sec += perout_request->period.nsec / 1000000000;
750 pulse_nsec = perout_request->period.nsec % 1000000000;
751 }
752
753 if (pulse_sec == 0) {
754 if (pulse_nsec >= 400000000) {
755 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
756 } else if (pulse_nsec >= 200000000) {
757 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_100MS_;
758 } else if (pulse_nsec >= 100000000) {
759 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_50MS_;
760 } else if (pulse_nsec >= 20000000) {
761 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_10MS_;
762 } else if (pulse_nsec >= 10000000) {
763 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_5MS_;
764 } else if (pulse_nsec >= 2000000) {
765 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_1MS_;
766 } else if (pulse_nsec >= 1000000) {
767 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_500US_;
768 } else if (pulse_nsec >= 200000) {
769 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_100US_;
770 } else if (pulse_nsec >= 100000) {
771 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_50US_;
772 } else if (pulse_nsec >= 20000) {
773 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_10US_;
774 } else if (pulse_nsec >= 10000) {
775 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_5US_;
776 } else if (pulse_nsec >= 2000) {
777 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_1US_;
778 } else if (pulse_nsec >= 1000) {
779 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_500NS_;
780 } else if (pulse_nsec >= 200) {
781 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_100NS_;
782 } else {
783 netif_warn(adapter, drv, adapter->netdev,
784 "perout period too small, min is 200nS\n");
785 goto failed;
786 }
787 } else {
788 pulse_width = HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
789 }
790
791 /* turn off by setting target far in future */
792 lan743x_csr_write(adapter,
793 PTP_CLOCK_TARGET_SEC_X(event_ch),
794 0xFFFF0000);
795 lan743x_csr_write(adapter,
796 PTP_CLOCK_TARGET_NS_X(event_ch), 0);
797
798 /* Configure to pulse every period */
799 gen_cfg = lan743x_csr_read(adapter, HS_PTP_GENERAL_CONFIG);
800 gen_cfg &= ~(HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_X_MASK_(event_ch));
801 gen_cfg |= HS_PTP_GENERAL_CONFIG_CLOCK_EVENT_X_SET_
802 (event_ch, pulse_width);
803 gen_cfg |= HS_PTP_GENERAL_CONFIG_EVENT_POL_X_(event_ch);
804 gen_cfg &= ~(HS_PTP_GENERAL_CONFIG_RELOAD_ADD_X_(event_ch));
805 lan743x_csr_write(adapter, HS_PTP_GENERAL_CONFIG, gen_cfg);
806
807 /* set the reload to one toggle cycle */
808 period_sec = perout_request->period.sec;
809 period_sec += perout_request->period.nsec / 1000000000;
810 period_nsec = perout_request->period.nsec % 1000000000;
811 lan743x_csr_write(adapter,
812 PTP_CLOCK_TARGET_RELOAD_SEC_X(event_ch),
813 period_sec);
814 lan743x_csr_write(adapter,
815 PTP_CLOCK_TARGET_RELOAD_NS_X(event_ch),
816 period_nsec);
817
818 start_sec = perout_request->start.sec;
819 start_sec += perout_request->start.nsec / 1000000000;
820 start_nsec = perout_request->start.nsec % 1000000000;
821
822 /* set the start time */
823 lan743x_csr_write(adapter,
824 PTP_CLOCK_TARGET_SEC_X(event_ch),
825 start_sec);
826 lan743x_csr_write(adapter,
827 PTP_CLOCK_TARGET_NS_X(event_ch),
828 start_nsec);
829
830 /* Enable LTC Target Read */
831 val = lan743x_csr_read(adapter, PTP_CMD_CTL);
832 val |= PTP_CMD_CTL_PTP_LTC_TARGET_READ_;
833 lan743x_csr_write(adapter, PTP_CMD_CTL, val);
834
835 /* Configure as an push/pull driver */
836 val = lan743x_csr_read(adapter, PTP_IO_PIN_CFG);
837 val |= PTP_IO_PIN_CFG_OBUF_TYPE_(perout_pin);
838 lan743x_csr_write(adapter, PTP_IO_PIN_CFG, val);
839
840 /* Select Event output */
841 val = lan743x_csr_read(adapter, PTP_IO_EVENT_OUTPUT_CFG);
842 if (event_ch)
843 /* Channel B as the output */
844 val |= PTP_IO_EVENT_OUTPUT_CFG_SEL_(perout_pin);
845 else
846 /* Channel A as the output */
847 val &= ~PTP_IO_EVENT_OUTPUT_CFG_SEL_(perout_pin);
848
849 /* Enables the output of Local Time Target compare events */
850 val |= PTP_IO_EVENT_OUTPUT_CFG_EN_(perout_pin);
851 lan743x_csr_write(adapter, PTP_IO_EVENT_OUTPUT_CFG, val);
852
853 return 0;
854
855failed:
856 lan743x_ptp_io_perout_off(adapter, index);
857 return -ENODEV;
858}
859
860static void lan743x_ptp_io_extts_off(struct lan743x_adapter *adapter,
861 u32 index)
862{
863 struct lan743x_ptp *ptp = &adapter->ptp;
864 struct lan743x_extts *extts;
865 int val;
866
867 extts = &ptp->extts[index];
868 /* PTP Interrupt Enable Clear Register */
869 if (extts->flags & PTP_FALLING_EDGE)
870 val = PTP_INT_EN_FE_EN_CLR_(index);
871 else
872 val = PTP_INT_EN_RE_EN_CLR_(index);
873 lan743x_csr_write(adapter, PTP_INT_EN_CLR, val);
874
875 /* Disables PTP-IO edge lock */
876 val = lan743x_csr_read(adapter, PTP_IO_CAP_CONFIG);
877 if (extts->flags & PTP_FALLING_EDGE) {
878 val &= ~PTP_IO_CAP_CONFIG_LOCK_FE_(index);
879 val &= ~PTP_IO_CAP_CONFIG_FE_CAP_EN_(index);
880 } else {
881 val &= ~PTP_IO_CAP_CONFIG_LOCK_RE_(index);
882 val &= ~PTP_IO_CAP_CONFIG_RE_CAP_EN_(index);
883 }
884 lan743x_csr_write(adapter, PTP_IO_CAP_CONFIG, val);
885
886 /* PTP-IO De-select register */
887 val = lan743x_csr_read(adapter, PTP_IO_SEL);
888 val &= ~PTP_IO_SEL_MASK_;
889 lan743x_csr_write(adapter, PTP_IO_SEL, val);
890
891 /* Clear timestamp */
892 memset(&extts->ts, 0, sizeof(struct timespec64));
893 extts->flags = 0;
894}
895
896static int lan743x_ptp_io_event_cap_en(struct lan743x_adapter *adapter,
897 u32 flags, u32 channel)
898{
899 struct lan743x_ptp *ptp = &adapter->ptp;
900 int val;
901
902 if ((flags & PTP_EXTTS_EDGES) == PTP_EXTTS_EDGES)
903 return -EOPNOTSUPP;
904
905 mutex_lock(&ptp->command_lock);
906 /* PTP-IO Event Capture Enable */
907 val = lan743x_csr_read(adapter, PTP_IO_CAP_CONFIG);
908 if (flags & PTP_FALLING_EDGE) {
909 val &= ~PTP_IO_CAP_CONFIG_LOCK_RE_(channel);
910 val &= ~PTP_IO_CAP_CONFIG_RE_CAP_EN_(channel);
911 val |= PTP_IO_CAP_CONFIG_LOCK_FE_(channel);
912 val |= PTP_IO_CAP_CONFIG_FE_CAP_EN_(channel);
913 } else {
914 /* Rising eventing as Default */
915 val &= ~PTP_IO_CAP_CONFIG_LOCK_FE_(channel);
916 val &= ~PTP_IO_CAP_CONFIG_FE_CAP_EN_(channel);
917 val |= PTP_IO_CAP_CONFIG_LOCK_RE_(channel);
918 val |= PTP_IO_CAP_CONFIG_RE_CAP_EN_(channel);
919 }
920 lan743x_csr_write(adapter, PTP_IO_CAP_CONFIG, val);
921
922 /* PTP-IO Select */
923 val = lan743x_csr_read(adapter, PTP_IO_SEL);
924 val &= ~PTP_IO_SEL_MASK_;
925 val |= channel << PTP_IO_SEL_SHIFT_;
926 lan743x_csr_write(adapter, PTP_IO_SEL, val);
927
928 /* PTP Interrupt Enable Register */
929 if (flags & PTP_FALLING_EDGE)
930 val = PTP_INT_EN_FE_EN_SET_(channel);
931 else
932 val = PTP_INT_EN_RE_EN_SET_(channel);
933 lan743x_csr_write(adapter, PTP_INT_EN_SET, val);
934
935 mutex_unlock(&ptp->command_lock);
936
937 return 0;
938}
939
940static int lan743x_ptp_io_extts(struct lan743x_adapter *adapter, int on,
941 struct ptp_extts_request *extts_request)
942{
943 struct lan743x_ptp *ptp = &adapter->ptp;
944 u32 flags = extts_request->flags;
945 u32 index = extts_request->index;
946 struct lan743x_extts *extts;
947 int extts_pin;
948 int ret = 0;
949
950 extts = &ptp->extts[index];
951
952 if (on) {
953 extts_pin = ptp_find_pin(ptp->ptp_clock, PTP_PF_EXTTS, index);
954 if (extts_pin < 0)
955 return -EBUSY;
956
957 ret = lan743x_ptp_io_event_cap_en(adapter, flags, index);
958 if (!ret)
959 extts->flags = flags;
960 } else {
961 lan743x_ptp_io_extts_off(adapter, index);
962 }
963
964 return ret;
965}
966
967static int lan743x_ptpci_enable(struct ptp_clock_info *ptpci,
968 struct ptp_clock_request *request, int on)
969{
970 struct lan743x_ptp *ptp =
971 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
972 struct lan743x_adapter *adapter =
973 container_of(ptp, struct lan743x_adapter, ptp);
974
975 if (request) {
976 switch (request->type) {
977 case PTP_CLK_REQ_EXTTS:
978 if (request->extts.index < ptpci->n_ext_ts)
979 return lan743x_ptp_io_extts(adapter, on,
980 &request->extts);
981 return -EINVAL;
982 case PTP_CLK_REQ_PEROUT:
983 if (request->perout.index < ptpci->n_per_out) {
984 if (adapter->is_pci11x1x)
985 return lan743x_ptp_io_perout(adapter, on,
986 &request->perout);
987 else
988 return lan743x_ptp_perout(adapter, on,
989 &request->perout);
990 }
991 return -EINVAL;
992 case PTP_CLK_REQ_PPS:
993 return -EINVAL;
994 default:
995 netif_err(adapter, drv, adapter->netdev,
996 "request->type == %d, Unknown\n",
997 request->type);
998 break;
999 }
1000 } else {
1001 netif_err(adapter, drv, adapter->netdev, "request == NULL\n");
1002 }
1003 return 0;
1004}
1005
1006static int lan743x_ptpci_verify_pin_config(struct ptp_clock_info *ptp,
1007 unsigned int pin,
1008 enum ptp_pin_function func,
1009 unsigned int chan)
1010{
1011 struct lan743x_ptp *lan_ptp =
1012 container_of(ptp, struct lan743x_ptp, ptp_clock_info);
1013 struct lan743x_adapter *adapter =
1014 container_of(lan_ptp, struct lan743x_adapter, ptp);
1015 int result = 0;
1016
1017 /* Confirm the requested function is supported. Parameter
1018 * validation is done by the caller.
1019 */
1020 switch (func) {
1021 case PTP_PF_NONE:
1022 case PTP_PF_PEROUT:
1023 break;
1024 case PTP_PF_EXTTS:
1025 if (!adapter->is_pci11x1x)
1026 result = -1;
1027 break;
1028 case PTP_PF_PHYSYNC:
1029 default:
1030 result = -1;
1031 break;
1032 }
1033 return result;
1034}
1035
1036static void lan743x_ptp_io_event_clock_get(struct lan743x_adapter *adapter,
1037 bool fe, u8 channel,
1038 struct timespec64 *ts)
1039{
1040 struct lan743x_ptp *ptp = &adapter->ptp;
1041 struct lan743x_extts *extts;
1042 u32 sec, nsec;
1043
1044 mutex_lock(&ptp->command_lock);
1045 if (fe) {
1046 sec = lan743x_csr_read(adapter, PTP_IO_FE_LTC_SEC_CAP_X);
1047 nsec = lan743x_csr_read(adapter, PTP_IO_FE_LTC_NS_CAP_X);
1048 } else {
1049 sec = lan743x_csr_read(adapter, PTP_IO_RE_LTC_SEC_CAP_X);
1050 nsec = lan743x_csr_read(adapter, PTP_IO_RE_LTC_NS_CAP_X);
1051 }
1052
1053 mutex_unlock(&ptp->command_lock);
1054
1055 /* Update Local timestamp */
1056 extts = &ptp->extts[channel];
1057 extts->ts.tv_sec = sec;
1058 extts->ts.tv_nsec = nsec;
1059 ts->tv_sec = sec;
1060 ts->tv_nsec = nsec;
1061}
1062
1063static long lan743x_ptpci_do_aux_work(struct ptp_clock_info *ptpci)
1064{
1065 struct lan743x_ptp *ptp =
1066 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
1067 struct lan743x_adapter *adapter =
1068 container_of(ptp, struct lan743x_adapter, ptp);
1069 u32 cap_info, cause, header, nsec, seconds;
1070 bool new_timestamp_available = false;
1071 struct ptp_clock_event ptp_event;
1072 struct timespec64 ts;
1073 int ptp_int_sts;
1074 int count = 0;
1075 int channel;
1076 s64 ns;
1077
1078 ptp_int_sts = lan743x_csr_read(adapter, PTP_INT_STS);
1079 while ((count < 100) && ptp_int_sts) {
1080 count++;
1081
1082 if (ptp_int_sts & PTP_INT_BIT_TX_TS_) {
1083 cap_info = lan743x_csr_read(adapter, PTP_CAP_INFO);
1084
1085 if (PTP_CAP_INFO_TX_TS_CNT_GET_(cap_info) > 0) {
1086 seconds = lan743x_csr_read(adapter,
1087 PTP_TX_EGRESS_SEC);
1088 nsec = lan743x_csr_read(adapter,
1089 PTP_TX_EGRESS_NS);
1090 cause = (nsec &
1091 PTP_TX_EGRESS_NS_CAPTURE_CAUSE_MASK_);
1092 header = lan743x_csr_read(adapter,
1093 PTP_TX_MSG_HEADER);
1094
1095 if (cause ==
1096 PTP_TX_EGRESS_NS_CAPTURE_CAUSE_SW_) {
1097 nsec &= PTP_TX_EGRESS_NS_TS_NS_MASK_;
1098 lan743x_ptp_tx_ts_enqueue_ts(adapter,
1099 seconds,
1100 nsec,
1101 header);
1102 new_timestamp_available = true;
1103 } else if (cause ==
1104 PTP_TX_EGRESS_NS_CAPTURE_CAUSE_AUTO_) {
1105 netif_err(adapter, drv, adapter->netdev,
1106 "Auto capture cause not supported\n");
1107 } else {
1108 netif_warn(adapter, drv, adapter->netdev,
1109 "unknown tx timestamp capture cause\n");
1110 }
1111 } else {
1112 netif_warn(adapter, drv, adapter->netdev,
1113 "TX TS INT but no TX TS CNT\n");
1114 }
1115 lan743x_csr_write(adapter, PTP_INT_STS,
1116 PTP_INT_BIT_TX_TS_);
1117 }
1118
1119 if (ptp_int_sts & PTP_INT_IO_FE_MASK_) {
1120 do {
1121 channel = lan743x_get_channel((ptp_int_sts &
1122 PTP_INT_IO_FE_MASK_) >>
1123 PTP_INT_IO_FE_SHIFT_);
1124 if (channel >= 0 &&
1125 channel < PCI11X1X_PTP_IO_MAX_CHANNELS) {
1126 lan743x_ptp_io_event_clock_get(adapter,
1127 true,
1128 channel,
1129 &ts);
1130 /* PTP Falling Event post */
1131 ns = timespec64_to_ns(&ts);
1132 ptp_event.timestamp = ns;
1133 ptp_event.index = channel;
1134 ptp_event.type = PTP_CLOCK_EXTTS;
1135 ptp_clock_event(ptp->ptp_clock,
1136 &ptp_event);
1137 lan743x_csr_write(adapter, PTP_INT_STS,
1138 PTP_INT_IO_FE_SET_
1139 (channel));
1140 ptp_int_sts &= ~(1 <<
1141 (PTP_INT_IO_FE_SHIFT_ +
1142 channel));
1143 } else {
1144 /* Clear falling event interrupts */
1145 lan743x_csr_write(adapter, PTP_INT_STS,
1146 PTP_INT_IO_FE_MASK_);
1147 ptp_int_sts &= ~PTP_INT_IO_FE_MASK_;
1148 }
1149 } while (ptp_int_sts & PTP_INT_IO_FE_MASK_);
1150 }
1151
1152 if (ptp_int_sts & PTP_INT_IO_RE_MASK_) {
1153 do {
1154 channel = lan743x_get_channel((ptp_int_sts &
1155 PTP_INT_IO_RE_MASK_) >>
1156 PTP_INT_IO_RE_SHIFT_);
1157 if (channel >= 0 &&
1158 channel < PCI11X1X_PTP_IO_MAX_CHANNELS) {
1159 lan743x_ptp_io_event_clock_get(adapter,
1160 false,
1161 channel,
1162 &ts);
1163 /* PTP Rising Event post */
1164 ns = timespec64_to_ns(&ts);
1165 ptp_event.timestamp = ns;
1166 ptp_event.index = channel;
1167 ptp_event.type = PTP_CLOCK_EXTTS;
1168 ptp_clock_event(ptp->ptp_clock,
1169 &ptp_event);
1170 lan743x_csr_write(adapter, PTP_INT_STS,
1171 PTP_INT_IO_RE_SET_
1172 (channel));
1173 ptp_int_sts &= ~(1 <<
1174 (PTP_INT_IO_RE_SHIFT_ +
1175 channel));
1176 } else {
1177 /* Clear Rising event interrupt */
1178 lan743x_csr_write(adapter, PTP_INT_STS,
1179 PTP_INT_IO_RE_MASK_);
1180 ptp_int_sts &= ~PTP_INT_IO_RE_MASK_;
1181 }
1182 } while (ptp_int_sts & PTP_INT_IO_RE_MASK_);
1183 }
1184
1185 ptp_int_sts = lan743x_csr_read(adapter, PTP_INT_STS);
1186 }
1187
1188 if (new_timestamp_available)
1189 lan743x_ptp_tx_ts_complete(adapter);
1190
1191 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
1192
1193 return -1;
1194}
1195
1196static void lan743x_ptp_clock_get(struct lan743x_adapter *adapter,
1197 u32 *seconds, u32 *nano_seconds,
1198 u32 *sub_nano_seconds)
1199{
1200 struct lan743x_ptp *ptp = &adapter->ptp;
1201
1202 mutex_lock(&ptp->command_lock);
1203
1204 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_CLOCK_READ_);
1205 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_CLOCK_READ_);
1206
1207 if (seconds)
1208 (*seconds) = lan743x_csr_read(adapter, PTP_CLOCK_SEC);
1209
1210 if (nano_seconds)
1211 (*nano_seconds) = lan743x_csr_read(adapter, PTP_CLOCK_NS);
1212
1213 if (sub_nano_seconds)
1214 (*sub_nano_seconds) =
1215 lan743x_csr_read(adapter, PTP_CLOCK_SUBNS);
1216
1217 mutex_unlock(&ptp->command_lock);
1218}
1219
1220static void lan743x_ptp_io_clock_get(struct lan743x_adapter *adapter,
1221 u32 *sec, u32 *nsec, u32 *sub_nsec)
1222{
1223 struct lan743x_ptp *ptp = &adapter->ptp;
1224
1225 mutex_lock(&ptp->command_lock);
1226 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_CLOCK_READ_);
1227 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_CLOCK_READ_);
1228
1229 if (sec)
1230 (*sec) = lan743x_csr_read(adapter, PTP_LTC_RD_SEC_LO);
1231
1232 if (nsec)
1233 (*nsec) = lan743x_csr_read(adapter, PTP_LTC_RD_NS);
1234
1235 if (sub_nsec)
1236 (*sub_nsec) =
1237 lan743x_csr_read(adapter, PTP_LTC_RD_SUBNS);
1238
1239 mutex_unlock(&ptp->command_lock);
1240}
1241
1242static void lan743x_ptp_clock_step(struct lan743x_adapter *adapter,
1243 s64 time_step_ns)
1244{
1245 struct lan743x_ptp *ptp = &adapter->ptp;
1246 u32 nano_seconds_step = 0;
1247 u64 abs_time_step_ns = 0;
1248 u32 unsigned_seconds = 0;
1249 u32 nano_seconds = 0;
1250 u32 remainder = 0;
1251 s32 seconds = 0;
1252
1253 if (time_step_ns > 15000000000LL) {
1254 /* convert to clock set */
1255 if (adapter->is_pci11x1x)
1256 lan743x_ptp_io_clock_get(adapter, &unsigned_seconds,
1257 &nano_seconds, NULL);
1258 else
1259 lan743x_ptp_clock_get(adapter, &unsigned_seconds,
1260 &nano_seconds, NULL);
1261 unsigned_seconds += div_u64_rem(time_step_ns, 1000000000LL,
1262 &remainder);
1263 nano_seconds += remainder;
1264 if (nano_seconds >= 1000000000) {
1265 unsigned_seconds++;
1266 nano_seconds -= 1000000000;
1267 }
1268 lan743x_ptp_clock_set(adapter, unsigned_seconds,
1269 nano_seconds, 0);
1270 return;
1271 } else if (time_step_ns < -15000000000LL) {
1272 /* convert to clock set */
1273 time_step_ns = -time_step_ns;
1274
1275 if (adapter->is_pci11x1x) {
1276 lan743x_ptp_io_clock_get(adapter, &unsigned_seconds,
1277 &nano_seconds, NULL);
1278 } else {
1279 lan743x_ptp_clock_get(adapter, &unsigned_seconds,
1280 &nano_seconds, NULL);
1281 }
1282 unsigned_seconds -= div_u64_rem(time_step_ns, 1000000000LL,
1283 &remainder);
1284 nano_seconds_step = remainder;
1285 if (nano_seconds < nano_seconds_step) {
1286 unsigned_seconds--;
1287 nano_seconds += 1000000000;
1288 }
1289 nano_seconds -= nano_seconds_step;
1290 lan743x_ptp_clock_set(adapter, unsigned_seconds,
1291 nano_seconds, 0);
1292 return;
1293 }
1294
1295 /* do clock step */
1296 if (time_step_ns >= 0) {
1297 abs_time_step_ns = (u64)(time_step_ns);
1298 seconds = (s32)div_u64_rem(abs_time_step_ns, 1000000000,
1299 &remainder);
1300 nano_seconds = (u32)remainder;
1301 } else {
1302 abs_time_step_ns = (u64)(-time_step_ns);
1303 seconds = -((s32)div_u64_rem(abs_time_step_ns, 1000000000,
1304 &remainder));
1305 nano_seconds = (u32)remainder;
1306 if (nano_seconds > 0) {
1307 /* subtracting nano seconds is not allowed
1308 * convert to subtracting from seconds,
1309 * and adding to nanoseconds
1310 */
1311 seconds--;
1312 nano_seconds = (1000000000 - nano_seconds);
1313 }
1314 }
1315
1316 if (nano_seconds > 0) {
1317 /* add 8 ns to cover the likely normal increment */
1318 nano_seconds += 8;
1319 }
1320
1321 if (nano_seconds >= 1000000000) {
1322 /* carry into seconds */
1323 seconds++;
1324 nano_seconds -= 1000000000;
1325 }
1326
1327 while (seconds) {
1328 mutex_lock(&ptp->command_lock);
1329 if (seconds > 0) {
1330 u32 adjustment_value = (u32)seconds;
1331
1332 if (adjustment_value > 0xF)
1333 adjustment_value = 0xF;
1334 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
1335 PTP_CLOCK_STEP_ADJ_DIR_ |
1336 adjustment_value);
1337 seconds -= ((s32)adjustment_value);
1338 } else {
1339 u32 adjustment_value = (u32)(-seconds);
1340
1341 if (adjustment_value > 0xF)
1342 adjustment_value = 0xF;
1343 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
1344 adjustment_value);
1345 seconds += ((s32)adjustment_value);
1346 }
1347 lan743x_csr_write(adapter, PTP_CMD_CTL,
1348 PTP_CMD_CTL_PTP_CLOCK_STEP_SEC_);
1349 lan743x_ptp_wait_till_cmd_done(adapter,
1350 PTP_CMD_CTL_PTP_CLOCK_STEP_SEC_);
1351 mutex_unlock(&ptp->command_lock);
1352 }
1353 if (nano_seconds) {
1354 mutex_lock(&ptp->command_lock);
1355 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
1356 PTP_CLOCK_STEP_ADJ_DIR_ |
1357 (nano_seconds &
1358 PTP_CLOCK_STEP_ADJ_VALUE_MASK_));
1359 lan743x_csr_write(adapter, PTP_CMD_CTL,
1360 PTP_CMD_CTL_PTP_CLK_STP_NSEC_);
1361 lan743x_ptp_wait_till_cmd_done(adapter,
1362 PTP_CMD_CTL_PTP_CLK_STP_NSEC_);
1363 mutex_unlock(&ptp->command_lock);
1364 }
1365}
1366
1367void lan743x_ptp_isr(void *context)
1368{
1369 struct lan743x_adapter *adapter = (struct lan743x_adapter *)context;
1370 struct lan743x_ptp *ptp = NULL;
1371 int enable_flag = 1;
1372 u32 ptp_int_sts = 0;
1373
1374 ptp = &adapter->ptp;
1375
1376 lan743x_csr_write(adapter, INT_EN_CLR, INT_BIT_1588_);
1377
1378 ptp_int_sts = lan743x_csr_read(adapter, PTP_INT_STS);
1379 ptp_int_sts &= lan743x_csr_read(adapter, PTP_INT_EN_SET);
1380
1381 if (ptp_int_sts & PTP_INT_BIT_TX_TS_) {
1382 ptp_schedule_worker(ptp->ptp_clock, 0);
1383 enable_flag = 0;/* tasklet will re-enable later */
1384 }
1385 if (ptp_int_sts & PTP_INT_BIT_TX_SWTS_ERR_) {
1386 netif_err(adapter, drv, adapter->netdev,
1387 "PTP TX Software Timestamp Error\n");
1388 /* clear int status bit */
1389 lan743x_csr_write(adapter, PTP_INT_STS,
1390 PTP_INT_BIT_TX_SWTS_ERR_);
1391 }
1392 if (ptp_int_sts & PTP_INT_BIT_TIMER_B_) {
1393 /* clear int status bit */
1394 lan743x_csr_write(adapter, PTP_INT_STS,
1395 PTP_INT_BIT_TIMER_B_);
1396 }
1397 if (ptp_int_sts & PTP_INT_BIT_TIMER_A_) {
1398 /* clear int status bit */
1399 lan743x_csr_write(adapter, PTP_INT_STS,
1400 PTP_INT_BIT_TIMER_A_);
1401 }
1402
1403 if (enable_flag) {
1404 /* re-enable isr */
1405 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
1406 }
1407}
1408
1409static void lan743x_ptp_tx_ts_enqueue_skb(struct lan743x_adapter *adapter,
1410 struct sk_buff *skb, bool ignore_sync)
1411{
1412 struct lan743x_ptp *ptp = &adapter->ptp;
1413
1414 spin_lock_bh(&ptp->tx_ts_lock);
1415 if (ptp->tx_ts_skb_queue_size < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
1416 ptp->tx_ts_skb_queue[ptp->tx_ts_skb_queue_size] = skb;
1417 if (ignore_sync)
1418 ptp->tx_ts_ignore_sync_queue |=
1419 BIT(ptp->tx_ts_skb_queue_size);
1420 ptp->tx_ts_skb_queue_size++;
1421 } else {
1422 /* this should never happen, so long as the tx channel
1423 * calls and honors the result from
1424 * lan743x_ptp_request_tx_timestamp
1425 */
1426 netif_err(adapter, drv, adapter->netdev,
1427 "tx ts skb queue overflow\n");
1428 dev_kfree_skb(skb);
1429 }
1430 spin_unlock_bh(&ptp->tx_ts_lock);
1431}
1432
1433static void lan743x_ptp_sync_to_system_clock(struct lan743x_adapter *adapter)
1434{
1435 struct timespec64 ts;
1436
1437 ktime_get_clocktai_ts64(&ts);
1438
1439 lan743x_ptp_clock_set(adapter, ts.tv_sec, ts.tv_nsec, 0);
1440}
1441
1442void lan743x_ptp_update_latency(struct lan743x_adapter *adapter,
1443 u32 link_speed)
1444{
1445 switch (link_speed) {
1446 case 10:
1447 lan743x_csr_write(adapter, PTP_LATENCY,
1448 PTP_LATENCY_TX_SET_(0) |
1449 PTP_LATENCY_RX_SET_(0));
1450 break;
1451 case 100:
1452 lan743x_csr_write(adapter, PTP_LATENCY,
1453 PTP_LATENCY_TX_SET_(181) |
1454 PTP_LATENCY_RX_SET_(594));
1455 break;
1456 case 1000:
1457 lan743x_csr_write(adapter, PTP_LATENCY,
1458 PTP_LATENCY_TX_SET_(30) |
1459 PTP_LATENCY_RX_SET_(525));
1460 break;
1461 }
1462}
1463
1464int lan743x_ptp_init(struct lan743x_adapter *adapter)
1465{
1466 struct lan743x_ptp *ptp = &adapter->ptp;
1467 int i;
1468
1469 mutex_init(&ptp->command_lock);
1470 spin_lock_init(&ptp->tx_ts_lock);
1471 ptp->used_event_ch = 0;
1472
1473 for (i = 0; i < LAN743X_PTP_N_EVENT_CHAN; i++) {
1474 ptp->perout[i].event_ch = -1;
1475 ptp->perout[i].gpio_pin = -1;
1476 }
1477
1478 lan743x_led_mux_save(adapter);
1479
1480 return 0;
1481}
1482
1483int lan743x_ptp_open(struct lan743x_adapter *adapter)
1484{
1485 struct lan743x_ptp *ptp = &adapter->ptp;
1486 int ret = -ENODEV;
1487 u32 temp;
1488 int i;
1489 int n_pins;
1490
1491 lan743x_ptp_reset(adapter);
1492 lan743x_ptp_sync_to_system_clock(adapter);
1493 temp = lan743x_csr_read(adapter, PTP_TX_MOD2);
1494 temp |= PTP_TX_MOD2_TX_PTP_CLR_UDPV4_CHKSUM_;
1495 lan743x_csr_write(adapter, PTP_TX_MOD2, temp);
1496
1497 /* Default Timestamping */
1498 lan743x_rx_set_tstamp_mode(adapter, HWTSTAMP_FILTER_NONE);
1499
1500 lan743x_ptp_enable(adapter);
1501 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
1502 lan743x_csr_write(adapter, PTP_INT_EN_SET,
1503 PTP_INT_BIT_TX_SWTS_ERR_ | PTP_INT_BIT_TX_TS_);
1504 ptp->flags |= PTP_FLAG_ISR_ENABLED;
1505
1506 if (!IS_ENABLED(CONFIG_PTP_1588_CLOCK))
1507 return 0;
1508
1509 switch (adapter->csr.id_rev & ID_REV_ID_MASK_) {
1510 case ID_REV_ID_LAN7430_:
1511 n_pins = LAN7430_N_GPIO;
1512 break;
1513 case ID_REV_ID_LAN7431_:
1514 case ID_REV_ID_A011_:
1515 case ID_REV_ID_A041_:
1516 n_pins = LAN7431_N_GPIO;
1517 break;
1518 default:
1519 netif_warn(adapter, drv, adapter->netdev,
1520 "Unknown LAN743x (%08x). Assuming no GPIO\n",
1521 adapter->csr.id_rev);
1522 n_pins = 0;
1523 break;
1524 }
1525
1526 if (n_pins > LAN743X_PTP_N_GPIO)
1527 n_pins = LAN743X_PTP_N_GPIO;
1528
1529 for (i = 0; i < n_pins; i++) {
1530 struct ptp_pin_desc *ptp_pin = &ptp->pin_config[i];
1531
1532 snprintf(ptp_pin->name,
1533 sizeof(ptp_pin->name), "lan743x_ptp_pin_%02d", i);
1534 ptp_pin->index = i;
1535 ptp_pin->func = PTP_PF_NONE;
1536 }
1537
1538 ptp->ptp_clock_info.owner = THIS_MODULE;
1539 snprintf(ptp->ptp_clock_info.name, 16, "%pm",
1540 adapter->netdev->dev_addr);
1541 ptp->ptp_clock_info.max_adj = LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB;
1542 ptp->ptp_clock_info.n_alarm = 0;
1543 ptp->ptp_clock_info.n_ext_ts = LAN743X_PTP_N_EXTTS;
1544 ptp->ptp_clock_info.n_per_out = LAN743X_PTP_N_EVENT_CHAN;
1545 ptp->ptp_clock_info.n_pins = n_pins;
1546 ptp->ptp_clock_info.pps = LAN743X_PTP_N_PPS;
1547 ptp->ptp_clock_info.pin_config = ptp->pin_config;
1548 ptp->ptp_clock_info.adjfine = lan743x_ptpci_adjfine;
1549 ptp->ptp_clock_info.adjtime = lan743x_ptpci_adjtime;
1550 ptp->ptp_clock_info.gettime64 = lan743x_ptpci_gettime64;
1551 ptp->ptp_clock_info.getcrosststamp = NULL;
1552 ptp->ptp_clock_info.settime64 = lan743x_ptpci_settime64;
1553 ptp->ptp_clock_info.enable = lan743x_ptpci_enable;
1554 ptp->ptp_clock_info.do_aux_work = lan743x_ptpci_do_aux_work;
1555 ptp->ptp_clock_info.verify = lan743x_ptpci_verify_pin_config;
1556
1557 ptp->ptp_clock = ptp_clock_register(&ptp->ptp_clock_info,
1558 &adapter->pdev->dev);
1559
1560 if (IS_ERR(ptp->ptp_clock)) {
1561 netif_err(adapter, ifup, adapter->netdev,
1562 "ptp_clock_register failed\n");
1563 goto done;
1564 }
1565 ptp->flags |= PTP_FLAG_PTP_CLOCK_REGISTERED;
1566 netif_info(adapter, ifup, adapter->netdev,
1567 "successfully registered ptp clock\n");
1568
1569 return 0;
1570done:
1571 lan743x_ptp_close(adapter);
1572 return ret;
1573}
1574
1575void lan743x_ptp_close(struct lan743x_adapter *adapter)
1576{
1577 struct lan743x_ptp *ptp = &adapter->ptp;
1578 int index;
1579
1580 if (IS_ENABLED(CONFIG_PTP_1588_CLOCK) &&
1581 (ptp->flags & PTP_FLAG_PTP_CLOCK_REGISTERED)) {
1582 ptp_clock_unregister(ptp->ptp_clock);
1583 ptp->ptp_clock = NULL;
1584 ptp->flags &= ~PTP_FLAG_PTP_CLOCK_REGISTERED;
1585 netif_info(adapter, drv, adapter->netdev,
1586 "ptp clock unregister\n");
1587 }
1588
1589 if (ptp->flags & PTP_FLAG_ISR_ENABLED) {
1590 lan743x_csr_write(adapter, PTP_INT_EN_CLR,
1591 PTP_INT_BIT_TX_SWTS_ERR_ |
1592 PTP_INT_BIT_TX_TS_);
1593 lan743x_csr_write(adapter, INT_EN_CLR, INT_BIT_1588_);
1594 ptp->flags &= ~PTP_FLAG_ISR_ENABLED;
1595 }
1596
1597 /* clean up pending timestamp requests */
1598 lan743x_ptp_tx_ts_complete(adapter);
1599 spin_lock_bh(&ptp->tx_ts_lock);
1600 for (index = 0;
1601 index < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS;
1602 index++) {
1603 struct sk_buff *skb = ptp->tx_ts_skb_queue[index];
1604
1605 dev_kfree_skb(skb);
1606 ptp->tx_ts_skb_queue[index] = NULL;
1607 ptp->tx_ts_seconds_queue[index] = 0;
1608 ptp->tx_ts_nseconds_queue[index] = 0;
1609 }
1610 ptp->tx_ts_skb_queue_size = 0;
1611 ptp->tx_ts_queue_size = 0;
1612 ptp->pending_tx_timestamps = 0;
1613 spin_unlock_bh(&ptp->tx_ts_lock);
1614
1615 lan743x_led_mux_restore(adapter);
1616
1617 lan743x_ptp_disable(adapter);
1618}
1619
1620static void lan743x_ptp_set_sync_ts_insert(struct lan743x_adapter *adapter,
1621 bool ts_insert_enable)
1622{
1623 u32 ptp_tx_mod = lan743x_csr_read(adapter, PTP_TX_MOD);
1624
1625 if (ts_insert_enable)
1626 ptp_tx_mod |= PTP_TX_MOD_TX_PTP_SYNC_TS_INSERT_;
1627 else
1628 ptp_tx_mod &= ~PTP_TX_MOD_TX_PTP_SYNC_TS_INSERT_;
1629
1630 lan743x_csr_write(adapter, PTP_TX_MOD, ptp_tx_mod);
1631}
1632
1633static bool lan743x_ptp_is_enabled(struct lan743x_adapter *adapter)
1634{
1635 if (lan743x_csr_read(adapter, PTP_CMD_CTL) & PTP_CMD_CTL_PTP_ENABLE_)
1636 return true;
1637 return false;
1638}
1639
1640static void lan743x_ptp_enable(struct lan743x_adapter *adapter)
1641{
1642 struct lan743x_ptp *ptp = &adapter->ptp;
1643
1644 mutex_lock(&ptp->command_lock);
1645
1646 if (lan743x_ptp_is_enabled(adapter)) {
1647 netif_warn(adapter, drv, adapter->netdev,
1648 "PTP already enabled\n");
1649 goto done;
1650 }
1651 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_ENABLE_);
1652done:
1653 mutex_unlock(&ptp->command_lock);
1654}
1655
1656static void lan743x_ptp_disable(struct lan743x_adapter *adapter)
1657{
1658 struct lan743x_ptp *ptp = &adapter->ptp;
1659
1660 /* Disable Timestamping */
1661 lan743x_rx_set_tstamp_mode(adapter, HWTSTAMP_FILTER_NONE);
1662
1663 mutex_lock(&ptp->command_lock);
1664 if (!lan743x_ptp_is_enabled(adapter)) {
1665 netif_warn(adapter, drv, adapter->netdev,
1666 "PTP already disabled\n");
1667 goto done;
1668 }
1669 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_DISABLE_);
1670 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_ENABLE_);
1671done:
1672 mutex_unlock(&ptp->command_lock);
1673}
1674
1675static void lan743x_ptp_reset(struct lan743x_adapter *adapter)
1676{
1677 struct lan743x_ptp *ptp = &adapter->ptp;
1678
1679 mutex_lock(&ptp->command_lock);
1680
1681 if (lan743x_ptp_is_enabled(adapter)) {
1682 netif_err(adapter, drv, adapter->netdev,
1683 "Attempting reset while enabled\n");
1684 goto done;
1685 }
1686
1687 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_RESET_);
1688 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_RESET_);
1689done:
1690 mutex_unlock(&ptp->command_lock);
1691}
1692
1693static void lan743x_ptp_clock_set(struct lan743x_adapter *adapter,
1694 u32 seconds, u32 nano_seconds,
1695 u32 sub_nano_seconds)
1696{
1697 struct lan743x_ptp *ptp = &adapter->ptp;
1698
1699 mutex_lock(&ptp->command_lock);
1700
1701 lan743x_csr_write(adapter, PTP_CLOCK_SEC, seconds);
1702 lan743x_csr_write(adapter, PTP_CLOCK_NS, nano_seconds);
1703 lan743x_csr_write(adapter, PTP_CLOCK_SUBNS, sub_nano_seconds);
1704
1705 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_CLOCK_LOAD_);
1706 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_CLOCK_LOAD_);
1707 mutex_unlock(&ptp->command_lock);
1708}
1709
1710bool lan743x_ptp_request_tx_timestamp(struct lan743x_adapter *adapter)
1711{
1712 struct lan743x_ptp *ptp = &adapter->ptp;
1713 bool result = false;
1714
1715 spin_lock_bh(&ptp->tx_ts_lock);
1716 if (ptp->pending_tx_timestamps < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
1717 /* request granted */
1718 ptp->pending_tx_timestamps++;
1719 result = true;
1720 }
1721 spin_unlock_bh(&ptp->tx_ts_lock);
1722 return result;
1723}
1724
1725void lan743x_ptp_unrequest_tx_timestamp(struct lan743x_adapter *adapter)
1726{
1727 struct lan743x_ptp *ptp = &adapter->ptp;
1728
1729 spin_lock_bh(&ptp->tx_ts_lock);
1730 if (ptp->pending_tx_timestamps > 0)
1731 ptp->pending_tx_timestamps--;
1732 else
1733 netif_err(adapter, drv, adapter->netdev,
1734 "unrequest failed, pending_tx_timestamps==0\n");
1735 spin_unlock_bh(&ptp->tx_ts_lock);
1736}
1737
1738void lan743x_ptp_tx_timestamp_skb(struct lan743x_adapter *adapter,
1739 struct sk_buff *skb, bool ignore_sync)
1740{
1741 lan743x_ptp_tx_ts_enqueue_skb(adapter, skb, ignore_sync);
1742
1743 lan743x_ptp_tx_ts_complete(adapter);
1744}
1745
1746int lan743x_ptp_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
1747{
1748 struct lan743x_adapter *adapter = netdev_priv(netdev);
1749 struct hwtstamp_config config;
1750 int ret = 0;
1751 int index;
1752
1753 if (!ifr) {
1754 netif_err(adapter, drv, adapter->netdev,
1755 "SIOCSHWTSTAMP, ifr == NULL\n");
1756 return -EINVAL;
1757 }
1758
1759 if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
1760 return -EFAULT;
1761
1762 switch (config.tx_type) {
1763 case HWTSTAMP_TX_OFF:
1764 for (index = 0; index < adapter->used_tx_channels;
1765 index++)
1766 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1767 false, false);
1768 lan743x_ptp_set_sync_ts_insert(adapter, false);
1769 break;
1770 case HWTSTAMP_TX_ON:
1771 for (index = 0; index < adapter->used_tx_channels;
1772 index++)
1773 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1774 true, false);
1775 lan743x_ptp_set_sync_ts_insert(adapter, false);
1776 break;
1777 case HWTSTAMP_TX_ONESTEP_SYNC:
1778 for (index = 0; index < adapter->used_tx_channels;
1779 index++)
1780 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1781 true, true);
1782
1783 lan743x_ptp_set_sync_ts_insert(adapter, true);
1784 break;
1785 case HWTSTAMP_TX_ONESTEP_P2P:
1786 ret = -ERANGE;
1787 break;
1788 default:
1789 netif_warn(adapter, drv, adapter->netdev,
1790 " tx_type = %d, UNKNOWN\n", config.tx_type);
1791 ret = -EINVAL;
1792 break;
1793 }
1794
1795 ret = lan743x_rx_set_tstamp_mode(adapter, config.rx_filter);
1796
1797 if (!ret)
1798 return copy_to_user(ifr->ifr_data, &config,
1799 sizeof(config)) ? -EFAULT : 0;
1800 return ret;
1801}
1/* SPDX-License-Identifier: GPL-2.0+ */
2/* Copyright (C) 2018 Microchip Technology Inc. */
3
4#include <linux/netdevice.h>
5#include "lan743x_main.h"
6
7#include <linux/ptp_clock_kernel.h>
8#include <linux/module.h>
9#include <linux/pci.h>
10#include <linux/net_tstamp.h>
11
12#include "lan743x_ptp.h"
13
14#define LAN743X_NUMBER_OF_GPIO (12)
15#define LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB (31249999)
16#define LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM (2047999934)
17
18static bool lan743x_ptp_is_enabled(struct lan743x_adapter *adapter);
19static void lan743x_ptp_enable(struct lan743x_adapter *adapter);
20static void lan743x_ptp_disable(struct lan743x_adapter *adapter);
21static void lan743x_ptp_reset(struct lan743x_adapter *adapter);
22static void lan743x_ptp_clock_set(struct lan743x_adapter *adapter,
23 u32 seconds, u32 nano_seconds,
24 u32 sub_nano_seconds);
25
26int lan743x_gpio_init(struct lan743x_adapter *adapter)
27{
28 struct lan743x_gpio *gpio = &adapter->gpio;
29
30 spin_lock_init(&gpio->gpio_lock);
31
32 gpio->gpio_cfg0 = 0; /* set all direction to input, data = 0 */
33 gpio->gpio_cfg1 = 0x0FFF0000;/* disable all gpio, set to open drain */
34 gpio->gpio_cfg2 = 0;/* set all to 1588 low polarity level */
35 gpio->gpio_cfg3 = 0;/* disable all 1588 output */
36 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
37 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
38 lan743x_csr_write(adapter, GPIO_CFG2, gpio->gpio_cfg2);
39 lan743x_csr_write(adapter, GPIO_CFG3, gpio->gpio_cfg3);
40
41 return 0;
42}
43
44static void lan743x_ptp_wait_till_cmd_done(struct lan743x_adapter *adapter,
45 u32 bit_mask)
46{
47 int timeout = 1000;
48 u32 data = 0;
49
50 while (timeout &&
51 (data = (lan743x_csr_read(adapter, PTP_CMD_CTL) &
52 bit_mask))) {
53 usleep_range(1000, 20000);
54 timeout--;
55 }
56 if (data) {
57 netif_err(adapter, drv, adapter->netdev,
58 "timeout waiting for cmd to be done, cmd = 0x%08X\n",
59 bit_mask);
60 }
61}
62
63static void lan743x_ptp_tx_ts_enqueue_ts(struct lan743x_adapter *adapter,
64 u32 seconds, u32 nano_seconds,
65 u32 header)
66{
67 struct lan743x_ptp *ptp = &adapter->ptp;
68
69 spin_lock_bh(&ptp->tx_ts_lock);
70 if (ptp->tx_ts_queue_size < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
71 ptp->tx_ts_seconds_queue[ptp->tx_ts_queue_size] = seconds;
72 ptp->tx_ts_nseconds_queue[ptp->tx_ts_queue_size] = nano_seconds;
73 ptp->tx_ts_header_queue[ptp->tx_ts_queue_size] = header;
74 ptp->tx_ts_queue_size++;
75 } else {
76 netif_err(adapter, drv, adapter->netdev,
77 "tx ts queue overflow\n");
78 }
79 spin_unlock_bh(&ptp->tx_ts_lock);
80}
81
82static void lan743x_ptp_tx_ts_complete(struct lan743x_adapter *adapter)
83{
84 struct lan743x_ptp *ptp = &adapter->ptp;
85 struct skb_shared_hwtstamps tstamps;
86 u32 header, nseconds, seconds;
87 bool ignore_sync = false;
88 struct sk_buff *skb;
89 int c, i;
90
91 spin_lock_bh(&ptp->tx_ts_lock);
92 c = ptp->tx_ts_skb_queue_size;
93
94 if (c > ptp->tx_ts_queue_size)
95 c = ptp->tx_ts_queue_size;
96 if (c <= 0)
97 goto done;
98
99 for (i = 0; i < c; i++) {
100 ignore_sync = ((ptp->tx_ts_ignore_sync_queue &
101 BIT(i)) != 0);
102 skb = ptp->tx_ts_skb_queue[i];
103 nseconds = ptp->tx_ts_nseconds_queue[i];
104 seconds = ptp->tx_ts_seconds_queue[i];
105 header = ptp->tx_ts_header_queue[i];
106
107 memset(&tstamps, 0, sizeof(tstamps));
108 tstamps.hwtstamp = ktime_set(seconds, nseconds);
109 if (!ignore_sync ||
110 ((header & PTP_TX_MSG_HEADER_MSG_TYPE_) !=
111 PTP_TX_MSG_HEADER_MSG_TYPE_SYNC_))
112 skb_tstamp_tx(skb, &tstamps);
113
114 dev_kfree_skb(skb);
115
116 ptp->tx_ts_skb_queue[i] = NULL;
117 ptp->tx_ts_seconds_queue[i] = 0;
118 ptp->tx_ts_nseconds_queue[i] = 0;
119 ptp->tx_ts_header_queue[i] = 0;
120 }
121
122 /* shift queue */
123 ptp->tx_ts_ignore_sync_queue >>= c;
124 for (i = c; i < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS; i++) {
125 ptp->tx_ts_skb_queue[i - c] = ptp->tx_ts_skb_queue[i];
126 ptp->tx_ts_seconds_queue[i - c] = ptp->tx_ts_seconds_queue[i];
127 ptp->tx_ts_nseconds_queue[i - c] = ptp->tx_ts_nseconds_queue[i];
128 ptp->tx_ts_header_queue[i - c] = ptp->tx_ts_header_queue[i];
129
130 ptp->tx_ts_skb_queue[i] = NULL;
131 ptp->tx_ts_seconds_queue[i] = 0;
132 ptp->tx_ts_nseconds_queue[i] = 0;
133 ptp->tx_ts_header_queue[i] = 0;
134 }
135 ptp->tx_ts_skb_queue_size -= c;
136 ptp->tx_ts_queue_size -= c;
137done:
138 ptp->pending_tx_timestamps -= c;
139 spin_unlock_bh(&ptp->tx_ts_lock);
140}
141
142static int lan743x_ptp_reserve_event_ch(struct lan743x_adapter *adapter)
143{
144 struct lan743x_ptp *ptp = &adapter->ptp;
145 int result = -ENODEV;
146 int index = 0;
147
148 mutex_lock(&ptp->command_lock);
149 for (index = 0; index < LAN743X_PTP_NUMBER_OF_EVENT_CHANNELS; index++) {
150 if (!(test_bit(index, &ptp->used_event_ch))) {
151 ptp->used_event_ch |= BIT(index);
152 result = index;
153 break;
154 }
155 }
156 mutex_unlock(&ptp->command_lock);
157 return result;
158}
159
160static void lan743x_ptp_release_event_ch(struct lan743x_adapter *adapter,
161 int event_channel)
162{
163 struct lan743x_ptp *ptp = &adapter->ptp;
164
165 mutex_lock(&ptp->command_lock);
166 if (test_bit(event_channel, &ptp->used_event_ch)) {
167 ptp->used_event_ch &= ~BIT(event_channel);
168 } else {
169 netif_warn(adapter, drv, adapter->netdev,
170 "attempted release on a not used event_channel = %d\n",
171 event_channel);
172 }
173 mutex_unlock(&ptp->command_lock);
174}
175
176static void lan743x_ptp_clock_get(struct lan743x_adapter *adapter,
177 u32 *seconds, u32 *nano_seconds,
178 u32 *sub_nano_seconds);
179static void lan743x_ptp_clock_step(struct lan743x_adapter *adapter,
180 s64 time_step_ns);
181
182static int lan743x_gpio_rsrv_ptp_out(struct lan743x_adapter *adapter,
183 int bit, int ptp_channel)
184{
185 struct lan743x_gpio *gpio = &adapter->gpio;
186 unsigned long irq_flags = 0;
187 int bit_mask = BIT(bit);
188 int ret = -EBUSY;
189
190 spin_lock_irqsave(&gpio->gpio_lock, irq_flags);
191
192 if (!(gpio->used_bits & bit_mask)) {
193 gpio->used_bits |= bit_mask;
194 gpio->output_bits |= bit_mask;
195 gpio->ptp_bits |= bit_mask;
196
197 /* set as output, and zero initial value */
198 gpio->gpio_cfg0 |= GPIO_CFG0_GPIO_DIR_BIT_(bit);
199 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DATA_BIT_(bit);
200 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
201
202 /* enable gpio, and set buffer type to push pull */
203 gpio->gpio_cfg1 &= ~GPIO_CFG1_GPIOEN_BIT_(bit);
204 gpio->gpio_cfg1 |= GPIO_CFG1_GPIOBUF_BIT_(bit);
205 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
206
207 /* set 1588 polarity to high */
208 gpio->gpio_cfg2 |= GPIO_CFG2_1588_POL_BIT_(bit);
209 lan743x_csr_write(adapter, GPIO_CFG2, gpio->gpio_cfg2);
210
211 if (!ptp_channel) {
212 /* use channel A */
213 gpio->gpio_cfg3 &= ~GPIO_CFG3_1588_CH_SEL_BIT_(bit);
214 } else {
215 /* use channel B */
216 gpio->gpio_cfg3 |= GPIO_CFG3_1588_CH_SEL_BIT_(bit);
217 }
218 gpio->gpio_cfg3 |= GPIO_CFG3_1588_OE_BIT_(bit);
219 lan743x_csr_write(adapter, GPIO_CFG3, gpio->gpio_cfg3);
220
221 ret = bit;
222 }
223 spin_unlock_irqrestore(&gpio->gpio_lock, irq_flags);
224 return ret;
225}
226
227static void lan743x_gpio_release(struct lan743x_adapter *adapter, int bit)
228{
229 struct lan743x_gpio *gpio = &adapter->gpio;
230 unsigned long irq_flags = 0;
231 int bit_mask = BIT(bit);
232
233 spin_lock_irqsave(&gpio->gpio_lock, irq_flags);
234 if (gpio->used_bits & bit_mask) {
235 gpio->used_bits &= ~bit_mask;
236 if (gpio->output_bits & bit_mask) {
237 gpio->output_bits &= ~bit_mask;
238
239 if (gpio->ptp_bits & bit_mask) {
240 gpio->ptp_bits &= ~bit_mask;
241 /* disable ptp output */
242 gpio->gpio_cfg3 &= ~GPIO_CFG3_1588_OE_BIT_(bit);
243 lan743x_csr_write(adapter, GPIO_CFG3,
244 gpio->gpio_cfg3);
245 }
246 /* release gpio output */
247
248 /* disable gpio */
249 gpio->gpio_cfg1 |= GPIO_CFG1_GPIOEN_BIT_(bit);
250 gpio->gpio_cfg1 &= ~GPIO_CFG1_GPIOBUF_BIT_(bit);
251 lan743x_csr_write(adapter, GPIO_CFG1, gpio->gpio_cfg1);
252
253 /* reset back to input */
254 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DIR_BIT_(bit);
255 gpio->gpio_cfg0 &= ~GPIO_CFG0_GPIO_DATA_BIT_(bit);
256 lan743x_csr_write(adapter, GPIO_CFG0, gpio->gpio_cfg0);
257 }
258 }
259 spin_unlock_irqrestore(&gpio->gpio_lock, irq_flags);
260}
261
262static int lan743x_ptpci_adjfine(struct ptp_clock_info *ptpci, long scaled_ppm)
263{
264 struct lan743x_ptp *ptp =
265 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
266 struct lan743x_adapter *adapter =
267 container_of(ptp, struct lan743x_adapter, ptp);
268 u32 lan743x_rate_adj = 0;
269 bool positive = true;
270 u64 u64_delta = 0;
271
272 if ((scaled_ppm < (-LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM)) ||
273 scaled_ppm > LAN743X_PTP_MAX_FINE_ADJ_IN_SCALED_PPM) {
274 return -EINVAL;
275 }
276 if (scaled_ppm > 0) {
277 u64_delta = (u64)scaled_ppm;
278 positive = true;
279 } else {
280 u64_delta = (u64)(-scaled_ppm);
281 positive = false;
282 }
283 u64_delta = (u64_delta << 19);
284 lan743x_rate_adj = div_u64(u64_delta, 1000000);
285
286 if (positive)
287 lan743x_rate_adj |= PTP_CLOCK_RATE_ADJ_DIR_;
288
289 lan743x_csr_write(adapter, PTP_CLOCK_RATE_ADJ,
290 lan743x_rate_adj);
291
292 return 0;
293}
294
295static int lan743x_ptpci_adjfreq(struct ptp_clock_info *ptpci, s32 delta_ppb)
296{
297 struct lan743x_ptp *ptp =
298 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
299 struct lan743x_adapter *adapter =
300 container_of(ptp, struct lan743x_adapter, ptp);
301 u32 lan743x_rate_adj = 0;
302 bool positive = true;
303 u32 u32_delta = 0;
304 u64 u64_delta = 0;
305
306 if ((delta_ppb < (-LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB)) ||
307 delta_ppb > LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB) {
308 return -EINVAL;
309 }
310 if (delta_ppb > 0) {
311 u32_delta = (u32)delta_ppb;
312 positive = true;
313 } else {
314 u32_delta = (u32)(-delta_ppb);
315 positive = false;
316 }
317 u64_delta = (((u64)u32_delta) << 35);
318 lan743x_rate_adj = div_u64(u64_delta, 1000000000);
319
320 if (positive)
321 lan743x_rate_adj |= PTP_CLOCK_RATE_ADJ_DIR_;
322
323 lan743x_csr_write(adapter, PTP_CLOCK_RATE_ADJ,
324 lan743x_rate_adj);
325
326 return 0;
327}
328
329static int lan743x_ptpci_adjtime(struct ptp_clock_info *ptpci, s64 delta)
330{
331 struct lan743x_ptp *ptp =
332 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
333 struct lan743x_adapter *adapter =
334 container_of(ptp, struct lan743x_adapter, ptp);
335
336 lan743x_ptp_clock_step(adapter, delta);
337
338 return 0;
339}
340
341static int lan743x_ptpci_gettime64(struct ptp_clock_info *ptpci,
342 struct timespec64 *ts)
343{
344 struct lan743x_ptp *ptp =
345 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
346 struct lan743x_adapter *adapter =
347 container_of(ptp, struct lan743x_adapter, ptp);
348 u32 nano_seconds = 0;
349 u32 seconds = 0;
350
351 lan743x_ptp_clock_get(adapter, &seconds, &nano_seconds, NULL);
352 ts->tv_sec = seconds;
353 ts->tv_nsec = nano_seconds;
354
355 return 0;
356}
357
358static int lan743x_ptpci_settime64(struct ptp_clock_info *ptpci,
359 const struct timespec64 *ts)
360{
361 struct lan743x_ptp *ptp =
362 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
363 struct lan743x_adapter *adapter =
364 container_of(ptp, struct lan743x_adapter, ptp);
365 u32 nano_seconds = 0;
366 u32 seconds = 0;
367
368 if (ts) {
369 if (ts->tv_sec > 0xFFFFFFFFLL ||
370 ts->tv_sec < 0) {
371 netif_warn(adapter, drv, adapter->netdev,
372 "ts->tv_sec out of range, %lld\n",
373 ts->tv_sec);
374 return -ERANGE;
375 }
376 if (ts->tv_nsec >= 1000000000L ||
377 ts->tv_nsec < 0) {
378 netif_warn(adapter, drv, adapter->netdev,
379 "ts->tv_nsec out of range, %ld\n",
380 ts->tv_nsec);
381 return -ERANGE;
382 }
383 seconds = ts->tv_sec;
384 nano_seconds = ts->tv_nsec;
385 lan743x_ptp_clock_set(adapter, seconds, nano_seconds, 0);
386 } else {
387 netif_warn(adapter, drv, adapter->netdev, "ts == NULL\n");
388 return -EINVAL;
389 }
390
391 return 0;
392}
393
394static void lan743x_ptp_perout_off(struct lan743x_adapter *adapter)
395{
396 struct lan743x_ptp *ptp = &adapter->ptp;
397 u32 general_config = 0;
398
399 if (ptp->perout_gpio_bit >= 0) {
400 lan743x_gpio_release(adapter, ptp->perout_gpio_bit);
401 ptp->perout_gpio_bit = -1;
402 }
403
404 if (ptp->perout_event_ch >= 0) {
405 /* set target to far in the future, effectively disabling it */
406 lan743x_csr_write(adapter,
407 PTP_CLOCK_TARGET_SEC_X(ptp->perout_event_ch),
408 0xFFFF0000);
409 lan743x_csr_write(adapter,
410 PTP_CLOCK_TARGET_NS_X(ptp->perout_event_ch),
411 0);
412
413 general_config = lan743x_csr_read(adapter, PTP_GENERAL_CONFIG);
414 general_config |= PTP_GENERAL_CONFIG_RELOAD_ADD_X_
415 (ptp->perout_event_ch);
416 lan743x_csr_write(adapter, PTP_GENERAL_CONFIG, general_config);
417 lan743x_ptp_release_event_ch(adapter, ptp->perout_event_ch);
418 ptp->perout_event_ch = -1;
419 }
420}
421
422static int lan743x_ptp_perout(struct lan743x_adapter *adapter, int on,
423 struct ptp_perout_request *perout)
424{
425 struct lan743x_ptp *ptp = &adapter->ptp;
426 u32 period_sec = 0, period_nsec = 0;
427 u32 start_sec = 0, start_nsec = 0;
428 u32 general_config = 0;
429 int pulse_width = 0;
430 int perout_bit = 0;
431
432 /* Reject requests with unsupported flags */
433 if (perout->flags)
434 return -EOPNOTSUPP;
435
436 if (!on) {
437 lan743x_ptp_perout_off(adapter);
438 return 0;
439 }
440
441 if (ptp->perout_event_ch >= 0 ||
442 ptp->perout_gpio_bit >= 0) {
443 /* already on, turn off first */
444 lan743x_ptp_perout_off(adapter);
445 }
446
447 ptp->perout_event_ch = lan743x_ptp_reserve_event_ch(adapter);
448 if (ptp->perout_event_ch < 0) {
449 netif_warn(adapter, drv, adapter->netdev,
450 "Failed to reserve event channel for PEROUT\n");
451 goto failed;
452 }
453
454 switch (adapter->csr.id_rev & ID_REV_ID_MASK_) {
455 case ID_REV_ID_LAN7430_:
456 perout_bit = 2;/* GPIO 2 is preferred on EVB LAN7430 */
457 break;
458 case ID_REV_ID_LAN7431_:
459 perout_bit = 4;/* GPIO 4 is preferred on EVB LAN7431 */
460 break;
461 }
462
463 ptp->perout_gpio_bit = lan743x_gpio_rsrv_ptp_out(adapter,
464 perout_bit,
465 ptp->perout_event_ch);
466
467 if (ptp->perout_gpio_bit < 0) {
468 netif_warn(adapter, drv, adapter->netdev,
469 "Failed to reserve gpio %d for PEROUT\n",
470 perout_bit);
471 goto failed;
472 }
473
474 start_sec = perout->start.sec;
475 start_sec += perout->start.nsec / 1000000000;
476 start_nsec = perout->start.nsec % 1000000000;
477
478 period_sec = perout->period.sec;
479 period_sec += perout->period.nsec / 1000000000;
480 period_nsec = perout->period.nsec % 1000000000;
481
482 if (period_sec == 0) {
483 if (period_nsec >= 400000000) {
484 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
485 } else if (period_nsec >= 20000000) {
486 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10MS_;
487 } else if (period_nsec >= 2000000) {
488 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_1MS_;
489 } else if (period_nsec >= 200000) {
490 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100US_;
491 } else if (period_nsec >= 20000) {
492 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_10US_;
493 } else if (period_nsec >= 200) {
494 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_100NS_;
495 } else {
496 netif_warn(adapter, drv, adapter->netdev,
497 "perout period too small, minimum is 200nS\n");
498 goto failed;
499 }
500 } else {
501 pulse_width = PTP_GENERAL_CONFIG_CLOCK_EVENT_200MS_;
502 }
503
504 /* turn off by setting target far in future */
505 lan743x_csr_write(adapter,
506 PTP_CLOCK_TARGET_SEC_X(ptp->perout_event_ch),
507 0xFFFF0000);
508 lan743x_csr_write(adapter,
509 PTP_CLOCK_TARGET_NS_X(ptp->perout_event_ch), 0);
510
511 /* Configure to pulse every period */
512 general_config = lan743x_csr_read(adapter, PTP_GENERAL_CONFIG);
513 general_config &= ~(PTP_GENERAL_CONFIG_CLOCK_EVENT_X_MASK_
514 (ptp->perout_event_ch));
515 general_config |= PTP_GENERAL_CONFIG_CLOCK_EVENT_X_SET_
516 (ptp->perout_event_ch, pulse_width);
517 general_config &= ~PTP_GENERAL_CONFIG_RELOAD_ADD_X_
518 (ptp->perout_event_ch);
519 lan743x_csr_write(adapter, PTP_GENERAL_CONFIG, general_config);
520
521 /* set the reload to one toggle cycle */
522 lan743x_csr_write(adapter,
523 PTP_CLOCK_TARGET_RELOAD_SEC_X(ptp->perout_event_ch),
524 period_sec);
525 lan743x_csr_write(adapter,
526 PTP_CLOCK_TARGET_RELOAD_NS_X(ptp->perout_event_ch),
527 period_nsec);
528
529 /* set the start time */
530 lan743x_csr_write(adapter,
531 PTP_CLOCK_TARGET_SEC_X(ptp->perout_event_ch),
532 start_sec);
533 lan743x_csr_write(adapter,
534 PTP_CLOCK_TARGET_NS_X(ptp->perout_event_ch),
535 start_nsec);
536
537 return 0;
538
539failed:
540 lan743x_ptp_perout_off(adapter);
541 return -ENODEV;
542}
543
544static int lan743x_ptpci_enable(struct ptp_clock_info *ptpci,
545 struct ptp_clock_request *request, int on)
546{
547 struct lan743x_ptp *ptp =
548 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
549 struct lan743x_adapter *adapter =
550 container_of(ptp, struct lan743x_adapter, ptp);
551
552 if (request) {
553 switch (request->type) {
554 case PTP_CLK_REQ_EXTTS:
555 return -EINVAL;
556 case PTP_CLK_REQ_PEROUT:
557 if (request->perout.index == 0)
558 return lan743x_ptp_perout(adapter, on,
559 &request->perout);
560 return -EINVAL;
561 case PTP_CLK_REQ_PPS:
562 return -EINVAL;
563 default:
564 netif_err(adapter, drv, adapter->netdev,
565 "request->type == %d, Unknown\n",
566 request->type);
567 break;
568 }
569 } else {
570 netif_err(adapter, drv, adapter->netdev, "request == NULL\n");
571 }
572 return 0;
573}
574
575static long lan743x_ptpci_do_aux_work(struct ptp_clock_info *ptpci)
576{
577 struct lan743x_ptp *ptp =
578 container_of(ptpci, struct lan743x_ptp, ptp_clock_info);
579 struct lan743x_adapter *adapter =
580 container_of(ptp, struct lan743x_adapter, ptp);
581 u32 cap_info, cause, header, nsec, seconds;
582 bool new_timestamp_available = false;
583 int count = 0;
584
585 while ((count < 100) &&
586 (lan743x_csr_read(adapter, PTP_INT_STS) & PTP_INT_BIT_TX_TS_)) {
587 count++;
588 cap_info = lan743x_csr_read(adapter, PTP_CAP_INFO);
589
590 if (PTP_CAP_INFO_TX_TS_CNT_GET_(cap_info) > 0) {
591 seconds = lan743x_csr_read(adapter,
592 PTP_TX_EGRESS_SEC);
593 nsec = lan743x_csr_read(adapter, PTP_TX_EGRESS_NS);
594 cause = (nsec &
595 PTP_TX_EGRESS_NS_CAPTURE_CAUSE_MASK_);
596 header = lan743x_csr_read(adapter,
597 PTP_TX_MSG_HEADER);
598
599 if (cause == PTP_TX_EGRESS_NS_CAPTURE_CAUSE_SW_) {
600 nsec &= PTP_TX_EGRESS_NS_TS_NS_MASK_;
601 lan743x_ptp_tx_ts_enqueue_ts(adapter,
602 seconds, nsec,
603 header);
604 new_timestamp_available = true;
605 } else if (cause ==
606 PTP_TX_EGRESS_NS_CAPTURE_CAUSE_AUTO_) {
607 netif_err(adapter, drv, adapter->netdev,
608 "Auto capture cause not supported\n");
609 } else {
610 netif_warn(adapter, drv, adapter->netdev,
611 "unknown tx timestamp capture cause\n");
612 }
613 } else {
614 netif_warn(adapter, drv, adapter->netdev,
615 "TX TS INT but no TX TS CNT\n");
616 }
617 lan743x_csr_write(adapter, PTP_INT_STS, PTP_INT_BIT_TX_TS_);
618 }
619
620 if (new_timestamp_available)
621 lan743x_ptp_tx_ts_complete(adapter);
622
623 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
624
625 return -1;
626}
627
628static void lan743x_ptp_clock_get(struct lan743x_adapter *adapter,
629 u32 *seconds, u32 *nano_seconds,
630 u32 *sub_nano_seconds)
631{
632 struct lan743x_ptp *ptp = &adapter->ptp;
633
634 mutex_lock(&ptp->command_lock);
635
636 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_CLOCK_READ_);
637 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_CLOCK_READ_);
638
639 if (seconds)
640 (*seconds) = lan743x_csr_read(adapter, PTP_CLOCK_SEC);
641
642 if (nano_seconds)
643 (*nano_seconds) = lan743x_csr_read(adapter, PTP_CLOCK_NS);
644
645 if (sub_nano_seconds)
646 (*sub_nano_seconds) =
647 lan743x_csr_read(adapter, PTP_CLOCK_SUBNS);
648
649 mutex_unlock(&ptp->command_lock);
650}
651
652static void lan743x_ptp_clock_step(struct lan743x_adapter *adapter,
653 s64 time_step_ns)
654{
655 struct lan743x_ptp *ptp = &adapter->ptp;
656 u32 nano_seconds_step = 0;
657 u64 abs_time_step_ns = 0;
658 u32 unsigned_seconds = 0;
659 u32 nano_seconds = 0;
660 u32 remainder = 0;
661 s32 seconds = 0;
662
663 if (time_step_ns > 15000000000LL) {
664 /* convert to clock set */
665 lan743x_ptp_clock_get(adapter, &unsigned_seconds,
666 &nano_seconds, NULL);
667 unsigned_seconds += div_u64_rem(time_step_ns, 1000000000LL,
668 &remainder);
669 nano_seconds += remainder;
670 if (nano_seconds >= 1000000000) {
671 unsigned_seconds++;
672 nano_seconds -= 1000000000;
673 }
674 lan743x_ptp_clock_set(adapter, unsigned_seconds,
675 nano_seconds, 0);
676 return;
677 } else if (time_step_ns < -15000000000LL) {
678 /* convert to clock set */
679 time_step_ns = -time_step_ns;
680
681 lan743x_ptp_clock_get(adapter, &unsigned_seconds,
682 &nano_seconds, NULL);
683 unsigned_seconds -= div_u64_rem(time_step_ns, 1000000000LL,
684 &remainder);
685 nano_seconds_step = remainder;
686 if (nano_seconds < nano_seconds_step) {
687 unsigned_seconds--;
688 nano_seconds += 1000000000;
689 }
690 nano_seconds -= nano_seconds_step;
691 lan743x_ptp_clock_set(adapter, unsigned_seconds,
692 nano_seconds, 0);
693 return;
694 }
695
696 /* do clock step */
697 if (time_step_ns >= 0) {
698 abs_time_step_ns = (u64)(time_step_ns);
699 seconds = (s32)div_u64_rem(abs_time_step_ns, 1000000000,
700 &remainder);
701 nano_seconds = (u32)remainder;
702 } else {
703 abs_time_step_ns = (u64)(-time_step_ns);
704 seconds = -((s32)div_u64_rem(abs_time_step_ns, 1000000000,
705 &remainder));
706 nano_seconds = (u32)remainder;
707 if (nano_seconds > 0) {
708 /* subtracting nano seconds is not allowed
709 * convert to subtracting from seconds,
710 * and adding to nanoseconds
711 */
712 seconds--;
713 nano_seconds = (1000000000 - nano_seconds);
714 }
715 }
716
717 if (nano_seconds > 0) {
718 /* add 8 ns to cover the likely normal increment */
719 nano_seconds += 8;
720 }
721
722 if (nano_seconds >= 1000000000) {
723 /* carry into seconds */
724 seconds++;
725 nano_seconds -= 1000000000;
726 }
727
728 while (seconds) {
729 mutex_lock(&ptp->command_lock);
730 if (seconds > 0) {
731 u32 adjustment_value = (u32)seconds;
732
733 if (adjustment_value > 0xF)
734 adjustment_value = 0xF;
735 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
736 PTP_CLOCK_STEP_ADJ_DIR_ |
737 adjustment_value);
738 seconds -= ((s32)adjustment_value);
739 } else {
740 u32 adjustment_value = (u32)(-seconds);
741
742 if (adjustment_value > 0xF)
743 adjustment_value = 0xF;
744 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
745 adjustment_value);
746 seconds += ((s32)adjustment_value);
747 }
748 lan743x_csr_write(adapter, PTP_CMD_CTL,
749 PTP_CMD_CTL_PTP_CLOCK_STEP_SEC_);
750 lan743x_ptp_wait_till_cmd_done(adapter,
751 PTP_CMD_CTL_PTP_CLOCK_STEP_SEC_);
752 mutex_unlock(&ptp->command_lock);
753 }
754 if (nano_seconds) {
755 mutex_lock(&ptp->command_lock);
756 lan743x_csr_write(adapter, PTP_CLOCK_STEP_ADJ,
757 PTP_CLOCK_STEP_ADJ_DIR_ |
758 (nano_seconds &
759 PTP_CLOCK_STEP_ADJ_VALUE_MASK_));
760 lan743x_csr_write(adapter, PTP_CMD_CTL,
761 PTP_CMD_CTL_PTP_CLK_STP_NSEC_);
762 lan743x_ptp_wait_till_cmd_done(adapter,
763 PTP_CMD_CTL_PTP_CLK_STP_NSEC_);
764 mutex_unlock(&ptp->command_lock);
765 }
766}
767
768void lan743x_ptp_isr(void *context)
769{
770 struct lan743x_adapter *adapter = (struct lan743x_adapter *)context;
771 struct lan743x_ptp *ptp = NULL;
772 int enable_flag = 1;
773 u32 ptp_int_sts = 0;
774
775 ptp = &adapter->ptp;
776
777 lan743x_csr_write(adapter, INT_EN_CLR, INT_BIT_1588_);
778
779 ptp_int_sts = lan743x_csr_read(adapter, PTP_INT_STS);
780 ptp_int_sts &= lan743x_csr_read(adapter, PTP_INT_EN_SET);
781
782 if (ptp_int_sts & PTP_INT_BIT_TX_TS_) {
783 ptp_schedule_worker(ptp->ptp_clock, 0);
784 enable_flag = 0;/* tasklet will re-enable later */
785 }
786 if (ptp_int_sts & PTP_INT_BIT_TX_SWTS_ERR_) {
787 netif_err(adapter, drv, adapter->netdev,
788 "PTP TX Software Timestamp Error\n");
789 /* clear int status bit */
790 lan743x_csr_write(adapter, PTP_INT_STS,
791 PTP_INT_BIT_TX_SWTS_ERR_);
792 }
793 if (ptp_int_sts & PTP_INT_BIT_TIMER_B_) {
794 /* clear int status bit */
795 lan743x_csr_write(adapter, PTP_INT_STS,
796 PTP_INT_BIT_TIMER_B_);
797 }
798 if (ptp_int_sts & PTP_INT_BIT_TIMER_A_) {
799 /* clear int status bit */
800 lan743x_csr_write(adapter, PTP_INT_STS,
801 PTP_INT_BIT_TIMER_A_);
802 }
803
804 if (enable_flag) {
805 /* re-enable isr */
806 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
807 }
808}
809
810static void lan743x_ptp_tx_ts_enqueue_skb(struct lan743x_adapter *adapter,
811 struct sk_buff *skb, bool ignore_sync)
812{
813 struct lan743x_ptp *ptp = &adapter->ptp;
814
815 spin_lock_bh(&ptp->tx_ts_lock);
816 if (ptp->tx_ts_skb_queue_size < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
817 ptp->tx_ts_skb_queue[ptp->tx_ts_skb_queue_size] = skb;
818 if (ignore_sync)
819 ptp->tx_ts_ignore_sync_queue |=
820 BIT(ptp->tx_ts_skb_queue_size);
821 ptp->tx_ts_skb_queue_size++;
822 } else {
823 /* this should never happen, so long as the tx channel
824 * calls and honors the result from
825 * lan743x_ptp_request_tx_timestamp
826 */
827 netif_err(adapter, drv, adapter->netdev,
828 "tx ts skb queue overflow\n");
829 dev_kfree_skb(skb);
830 }
831 spin_unlock_bh(&ptp->tx_ts_lock);
832}
833
834static void lan743x_ptp_sync_to_system_clock(struct lan743x_adapter *adapter)
835{
836 struct timespec64 ts;
837
838 ktime_get_clocktai_ts64(&ts);
839
840 lan743x_ptp_clock_set(adapter, ts.tv_sec, ts.tv_nsec, 0);
841}
842
843void lan743x_ptp_update_latency(struct lan743x_adapter *adapter,
844 u32 link_speed)
845{
846 switch (link_speed) {
847 case 10:
848 lan743x_csr_write(adapter, PTP_LATENCY,
849 PTP_LATENCY_TX_SET_(0) |
850 PTP_LATENCY_RX_SET_(0));
851 break;
852 case 100:
853 lan743x_csr_write(adapter, PTP_LATENCY,
854 PTP_LATENCY_TX_SET_(181) |
855 PTP_LATENCY_RX_SET_(594));
856 break;
857 case 1000:
858 lan743x_csr_write(adapter, PTP_LATENCY,
859 PTP_LATENCY_TX_SET_(30) |
860 PTP_LATENCY_RX_SET_(525));
861 break;
862 }
863}
864
865int lan743x_ptp_init(struct lan743x_adapter *adapter)
866{
867 struct lan743x_ptp *ptp = &adapter->ptp;
868
869 mutex_init(&ptp->command_lock);
870 spin_lock_init(&ptp->tx_ts_lock);
871 ptp->used_event_ch = 0;
872 ptp->perout_event_ch = -1;
873 ptp->perout_gpio_bit = -1;
874 return 0;
875}
876
877int lan743x_ptp_open(struct lan743x_adapter *adapter)
878{
879 struct lan743x_ptp *ptp = &adapter->ptp;
880 int ret = -ENODEV;
881 u32 temp;
882
883 lan743x_ptp_reset(adapter);
884 lan743x_ptp_sync_to_system_clock(adapter);
885 temp = lan743x_csr_read(adapter, PTP_TX_MOD2);
886 temp |= PTP_TX_MOD2_TX_PTP_CLR_UDPV4_CHKSUM_;
887 lan743x_csr_write(adapter, PTP_TX_MOD2, temp);
888 lan743x_ptp_enable(adapter);
889 lan743x_csr_write(adapter, INT_EN_SET, INT_BIT_1588_);
890 lan743x_csr_write(adapter, PTP_INT_EN_SET,
891 PTP_INT_BIT_TX_SWTS_ERR_ | PTP_INT_BIT_TX_TS_);
892 ptp->flags |= PTP_FLAG_ISR_ENABLED;
893
894 if (!IS_ENABLED(CONFIG_PTP_1588_CLOCK))
895 return 0;
896
897 snprintf(ptp->pin_config[0].name, 32, "lan743x_ptp_pin_0");
898 ptp->pin_config[0].index = 0;
899 ptp->pin_config[0].func = PTP_PF_PEROUT;
900 ptp->pin_config[0].chan = 0;
901
902 ptp->ptp_clock_info.owner = THIS_MODULE;
903 snprintf(ptp->ptp_clock_info.name, 16, "%pm",
904 adapter->netdev->dev_addr);
905 ptp->ptp_clock_info.max_adj = LAN743X_PTP_MAX_FREQ_ADJ_IN_PPB;
906 ptp->ptp_clock_info.n_alarm = 0;
907 ptp->ptp_clock_info.n_ext_ts = 0;
908 ptp->ptp_clock_info.n_per_out = 1;
909 ptp->ptp_clock_info.n_pins = 0;
910 ptp->ptp_clock_info.pps = 0;
911 ptp->ptp_clock_info.pin_config = NULL;
912 ptp->ptp_clock_info.adjfine = lan743x_ptpci_adjfine;
913 ptp->ptp_clock_info.adjfreq = lan743x_ptpci_adjfreq;
914 ptp->ptp_clock_info.adjtime = lan743x_ptpci_adjtime;
915 ptp->ptp_clock_info.gettime64 = lan743x_ptpci_gettime64;
916 ptp->ptp_clock_info.getcrosststamp = NULL;
917 ptp->ptp_clock_info.settime64 = lan743x_ptpci_settime64;
918 ptp->ptp_clock_info.enable = lan743x_ptpci_enable;
919 ptp->ptp_clock_info.do_aux_work = lan743x_ptpci_do_aux_work;
920 ptp->ptp_clock_info.verify = NULL;
921
922 ptp->ptp_clock = ptp_clock_register(&ptp->ptp_clock_info,
923 &adapter->pdev->dev);
924
925 if (IS_ERR(ptp->ptp_clock)) {
926 netif_err(adapter, ifup, adapter->netdev,
927 "ptp_clock_register failed\n");
928 goto done;
929 }
930 ptp->flags |= PTP_FLAG_PTP_CLOCK_REGISTERED;
931 netif_info(adapter, ifup, adapter->netdev,
932 "successfully registered ptp clock\n");
933
934 return 0;
935done:
936 lan743x_ptp_close(adapter);
937 return ret;
938}
939
940void lan743x_ptp_close(struct lan743x_adapter *adapter)
941{
942 struct lan743x_ptp *ptp = &adapter->ptp;
943 int index;
944
945 if (IS_ENABLED(CONFIG_PTP_1588_CLOCK) &&
946 ptp->flags & PTP_FLAG_PTP_CLOCK_REGISTERED) {
947 ptp_clock_unregister(ptp->ptp_clock);
948 ptp->ptp_clock = NULL;
949 ptp->flags &= ~PTP_FLAG_PTP_CLOCK_REGISTERED;
950 netif_info(adapter, drv, adapter->netdev,
951 "ptp clock unregister\n");
952 }
953
954 if (ptp->flags & PTP_FLAG_ISR_ENABLED) {
955 lan743x_csr_write(adapter, PTP_INT_EN_CLR,
956 PTP_INT_BIT_TX_SWTS_ERR_ |
957 PTP_INT_BIT_TX_TS_);
958 lan743x_csr_write(adapter, INT_EN_CLR, INT_BIT_1588_);
959 ptp->flags &= ~PTP_FLAG_ISR_ENABLED;
960 }
961
962 /* clean up pending timestamp requests */
963 lan743x_ptp_tx_ts_complete(adapter);
964 spin_lock_bh(&ptp->tx_ts_lock);
965 for (index = 0;
966 index < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS;
967 index++) {
968 struct sk_buff *skb = ptp->tx_ts_skb_queue[index];
969
970 dev_kfree_skb(skb);
971 ptp->tx_ts_skb_queue[index] = NULL;
972 ptp->tx_ts_seconds_queue[index] = 0;
973 ptp->tx_ts_nseconds_queue[index] = 0;
974 }
975 ptp->tx_ts_skb_queue_size = 0;
976 ptp->tx_ts_queue_size = 0;
977 ptp->pending_tx_timestamps = 0;
978 spin_unlock_bh(&ptp->tx_ts_lock);
979
980 lan743x_ptp_disable(adapter);
981}
982
983static void lan743x_ptp_set_sync_ts_insert(struct lan743x_adapter *adapter,
984 bool ts_insert_enable)
985{
986 u32 ptp_tx_mod = lan743x_csr_read(adapter, PTP_TX_MOD);
987
988 if (ts_insert_enable)
989 ptp_tx_mod |= PTP_TX_MOD_TX_PTP_SYNC_TS_INSERT_;
990 else
991 ptp_tx_mod &= ~PTP_TX_MOD_TX_PTP_SYNC_TS_INSERT_;
992
993 lan743x_csr_write(adapter, PTP_TX_MOD, ptp_tx_mod);
994}
995
996static bool lan743x_ptp_is_enabled(struct lan743x_adapter *adapter)
997{
998 if (lan743x_csr_read(adapter, PTP_CMD_CTL) & PTP_CMD_CTL_PTP_ENABLE_)
999 return true;
1000 return false;
1001}
1002
1003static void lan743x_ptp_enable(struct lan743x_adapter *adapter)
1004{
1005 struct lan743x_ptp *ptp = &adapter->ptp;
1006
1007 mutex_lock(&ptp->command_lock);
1008
1009 if (lan743x_ptp_is_enabled(adapter)) {
1010 netif_warn(adapter, drv, adapter->netdev,
1011 "PTP already enabled\n");
1012 goto done;
1013 }
1014 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_ENABLE_);
1015done:
1016 mutex_unlock(&ptp->command_lock);
1017}
1018
1019static void lan743x_ptp_disable(struct lan743x_adapter *adapter)
1020{
1021 struct lan743x_ptp *ptp = &adapter->ptp;
1022
1023 mutex_lock(&ptp->command_lock);
1024 if (!lan743x_ptp_is_enabled(adapter)) {
1025 netif_warn(adapter, drv, adapter->netdev,
1026 "PTP already disabled\n");
1027 goto done;
1028 }
1029 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_DISABLE_);
1030 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_ENABLE_);
1031done:
1032 mutex_unlock(&ptp->command_lock);
1033}
1034
1035static void lan743x_ptp_reset(struct lan743x_adapter *adapter)
1036{
1037 struct lan743x_ptp *ptp = &adapter->ptp;
1038
1039 mutex_lock(&ptp->command_lock);
1040
1041 if (lan743x_ptp_is_enabled(adapter)) {
1042 netif_err(adapter, drv, adapter->netdev,
1043 "Attempting reset while enabled\n");
1044 goto done;
1045 }
1046
1047 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_RESET_);
1048 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_RESET_);
1049done:
1050 mutex_unlock(&ptp->command_lock);
1051}
1052
1053static void lan743x_ptp_clock_set(struct lan743x_adapter *adapter,
1054 u32 seconds, u32 nano_seconds,
1055 u32 sub_nano_seconds)
1056{
1057 struct lan743x_ptp *ptp = &adapter->ptp;
1058
1059 mutex_lock(&ptp->command_lock);
1060
1061 lan743x_csr_write(adapter, PTP_CLOCK_SEC, seconds);
1062 lan743x_csr_write(adapter, PTP_CLOCK_NS, nano_seconds);
1063 lan743x_csr_write(adapter, PTP_CLOCK_SUBNS, sub_nano_seconds);
1064
1065 lan743x_csr_write(adapter, PTP_CMD_CTL, PTP_CMD_CTL_PTP_CLOCK_LOAD_);
1066 lan743x_ptp_wait_till_cmd_done(adapter, PTP_CMD_CTL_PTP_CLOCK_LOAD_);
1067 mutex_unlock(&ptp->command_lock);
1068}
1069
1070bool lan743x_ptp_request_tx_timestamp(struct lan743x_adapter *adapter)
1071{
1072 struct lan743x_ptp *ptp = &adapter->ptp;
1073 bool result = false;
1074
1075 spin_lock_bh(&ptp->tx_ts_lock);
1076 if (ptp->pending_tx_timestamps < LAN743X_PTP_NUMBER_OF_TX_TIMESTAMPS) {
1077 /* request granted */
1078 ptp->pending_tx_timestamps++;
1079 result = true;
1080 }
1081 spin_unlock_bh(&ptp->tx_ts_lock);
1082 return result;
1083}
1084
1085void lan743x_ptp_unrequest_tx_timestamp(struct lan743x_adapter *adapter)
1086{
1087 struct lan743x_ptp *ptp = &adapter->ptp;
1088
1089 spin_lock_bh(&ptp->tx_ts_lock);
1090 if (ptp->pending_tx_timestamps > 0)
1091 ptp->pending_tx_timestamps--;
1092 else
1093 netif_err(adapter, drv, adapter->netdev,
1094 "unrequest failed, pending_tx_timestamps==0\n");
1095 spin_unlock_bh(&ptp->tx_ts_lock);
1096}
1097
1098void lan743x_ptp_tx_timestamp_skb(struct lan743x_adapter *adapter,
1099 struct sk_buff *skb, bool ignore_sync)
1100{
1101 lan743x_ptp_tx_ts_enqueue_skb(adapter, skb, ignore_sync);
1102
1103 lan743x_ptp_tx_ts_complete(adapter);
1104}
1105
1106int lan743x_ptp_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
1107{
1108 struct lan743x_adapter *adapter = netdev_priv(netdev);
1109 struct hwtstamp_config config;
1110 int ret = 0;
1111 int index;
1112
1113 if (!ifr) {
1114 netif_err(adapter, drv, adapter->netdev,
1115 "SIOCSHWTSTAMP, ifr == NULL\n");
1116 return -EINVAL;
1117 }
1118
1119 if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
1120 return -EFAULT;
1121
1122 if (config.flags) {
1123 netif_warn(adapter, drv, adapter->netdev,
1124 "ignoring hwtstamp_config.flags == 0x%08X, expected 0\n",
1125 config.flags);
1126 }
1127
1128 switch (config.tx_type) {
1129 case HWTSTAMP_TX_OFF:
1130 for (index = 0; index < LAN743X_MAX_TX_CHANNELS;
1131 index++)
1132 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1133 false, false);
1134 lan743x_ptp_set_sync_ts_insert(adapter, false);
1135 break;
1136 case HWTSTAMP_TX_ON:
1137 for (index = 0; index < LAN743X_MAX_TX_CHANNELS;
1138 index++)
1139 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1140 true, false);
1141 lan743x_ptp_set_sync_ts_insert(adapter, false);
1142 break;
1143 case HWTSTAMP_TX_ONESTEP_SYNC:
1144 for (index = 0; index < LAN743X_MAX_TX_CHANNELS;
1145 index++)
1146 lan743x_tx_set_timestamping_mode(&adapter->tx[index],
1147 true, true);
1148
1149 lan743x_ptp_set_sync_ts_insert(adapter, true);
1150 break;
1151 default:
1152 netif_warn(adapter, drv, adapter->netdev,
1153 " tx_type = %d, UNKNOWN\n", config.tx_type);
1154 ret = -EINVAL;
1155 break;
1156 }
1157
1158 if (!ret)
1159 return copy_to_user(ifr->ifr_data, &config,
1160 sizeof(config)) ? -EFAULT : 0;
1161 return ret;
1162}