Lines Matching +full:ocelot +full:- +full:1
1 // SPDX-License-Identifier: (GPL-2.0 OR MIT)
2 /* Microsemi Ocelot PTP clock driver
9 #include <linux/dsa/ocelot.h>
14 #include <soc/mscc/ocelot.h>
15 #include "ocelot.h"
21 struct ocelot *ocelot = container_of(ptp, struct ocelot, ptp_info); in ocelot_ptp_gettime64() local
27 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_gettime64()
29 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_gettime64()
32 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_gettime64()
34 s = ocelot_read_rix(ocelot, PTP_PIN_TOD_SEC_MSB, TOD_ACC_PIN) & 0xffff; in ocelot_ptp_gettime64()
36 s += ocelot_read_rix(ocelot, PTP_PIN_TOD_SEC_LSB, TOD_ACC_PIN); in ocelot_ptp_gettime64()
37 ns = ocelot_read_rix(ocelot, PTP_PIN_TOD_NSEC, TOD_ACC_PIN); in ocelot_ptp_gettime64()
39 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_gettime64()
43 s--; in ocelot_ptp_gettime64()
56 struct ocelot *ocelot = container_of(ptp, struct ocelot, ptp_info); in ocelot_ptp_settime64() local
60 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_settime64()
62 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_settime64()
66 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_settime64()
68 ocelot_write_rix(ocelot, lower_32_bits(ts->tv_sec), PTP_PIN_TOD_SEC_LSB, in ocelot_ptp_settime64()
70 ocelot_write_rix(ocelot, upper_32_bits(ts->tv_sec), PTP_PIN_TOD_SEC_MSB, in ocelot_ptp_settime64()
72 ocelot_write_rix(ocelot, ts->tv_nsec, PTP_PIN_TOD_NSEC, TOD_ACC_PIN); in ocelot_ptp_settime64()
74 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_settime64()
78 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_settime64()
80 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_settime64()
82 if (ocelot->ops->tas_clock_adjust) in ocelot_ptp_settime64()
83 ocelot->ops->tas_clock_adjust(ocelot); in ocelot_ptp_settime64()
91 if (delta > -(NSEC_PER_SEC / 2) && delta < (NSEC_PER_SEC / 2)) { in ocelot_ptp_adjtime()
92 struct ocelot *ocelot = container_of(ptp, struct ocelot, in ocelot_ptp_adjtime() local
97 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_adjtime()
99 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_adjtime()
104 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_adjtime()
106 ocelot_write_rix(ocelot, 0, PTP_PIN_TOD_SEC_LSB, TOD_ACC_PIN); in ocelot_ptp_adjtime()
107 ocelot_write_rix(ocelot, 0, PTP_PIN_TOD_SEC_MSB, TOD_ACC_PIN); in ocelot_ptp_adjtime()
108 ocelot_write_rix(ocelot, delta, PTP_PIN_TOD_NSEC, TOD_ACC_PIN); in ocelot_ptp_adjtime()
110 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_adjtime()
115 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_ptp_adjtime()
117 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_adjtime()
119 if (ocelot->ops->tas_clock_adjust) in ocelot_ptp_adjtime()
120 ocelot->ops->tas_clock_adjust(ocelot); in ocelot_ptp_adjtime()
140 struct ocelot *ocelot = container_of(ptp, struct ocelot, ptp_info); in ocelot_ptp_adjfine() local
145 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_adjfine()
152 scaled_ppm = -scaled_ppm; in ocelot_ptp_adjfine()
160 if (adj >= (1L << 30)) { in ocelot_ptp_adjfine()
166 if (adj >= (1L << 30)) in ocelot_ptp_adjfine()
169 ocelot_write(ocelot, unit | adj, PTP_CLK_CFG_ADJ_FREQ); in ocelot_ptp_adjfine()
170 ocelot_write(ocelot, PTP_CFG_CLK_ADJ_CFG_ENA | direction, in ocelot_ptp_adjfine()
173 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_adjfine()
177 ocelot_write(ocelot, 0, PTP_CLK_CFG_ADJ_CFG); in ocelot_ptp_adjfine()
179 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_adjfine()
193 return -1; in ocelot_ptp_verify()
202 struct ocelot *ocelot = container_of(ptp, struct ocelot, ptp_info); in ocelot_ptp_enable() local
207 int pin = -1; in ocelot_ptp_enable()
212 switch (rq->type) { in ocelot_ptp_enable()
215 if (rq->perout.flags & ~(PTP_PEROUT_DUTY_CYCLE | in ocelot_ptp_enable()
217 return -EOPNOTSUPP; in ocelot_ptp_enable()
219 pin = ptp_find_pin(ocelot->ptp_clock, PTP_PF_PEROUT, in ocelot_ptp_enable()
220 rq->perout.index); in ocelot_ptp_enable()
223 else if (pin == 1) in ocelot_ptp_enable()
230 return -EBUSY; in ocelot_ptp_enable()
232 ts_period.tv_sec = rq->perout.period.sec; in ocelot_ptp_enable()
233 ts_period.tv_nsec = rq->perout.period.nsec; in ocelot_ptp_enable()
235 if (ts_period.tv_sec == 1 && ts_period.tv_nsec == 0) in ocelot_ptp_enable()
240 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
242 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, ptp_pin); in ocelot_ptp_enable()
243 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
247 if (rq->perout.flags & PTP_PEROUT_PHASE) { in ocelot_ptp_enable()
248 ts_phase.tv_sec = rq->perout.phase.sec; in ocelot_ptp_enable()
249 ts_phase.tv_nsec = rq->perout.phase.nsec; in ocelot_ptp_enable()
252 ts_phase.tv_sec = rq->perout.start.sec; in ocelot_ptp_enable()
253 ts_phase.tv_nsec = rq->perout.start.nsec; in ocelot_ptp_enable()
256 dev_warn(ocelot->dev, in ocelot_ptp_enable()
258 dev_warn(ocelot->dev, in ocelot_ptp_enable()
260 return -EINVAL; in ocelot_ptp_enable()
264 if (rq->perout.flags & PTP_PEROUT_DUTY_CYCLE) { in ocelot_ptp_enable()
267 ts_on.tv_sec = rq->perout.on.sec; in ocelot_ptp_enable()
268 ts_on.tv_nsec = rq->perout.on.nsec; in ocelot_ptp_enable()
281 wf_low -= wf_high; in ocelot_ptp_enable()
285 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
286 ocelot_write_rix(ocelot, ts_phase.tv_nsec, in ocelot_ptp_enable()
288 ocelot_write_rix(ocelot, wf_high, in ocelot_ptp_enable()
292 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, ptp_pin); in ocelot_ptp_enable()
293 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
299 return -EINVAL; in ocelot_ptp_enable()
301 return -EINVAL; in ocelot_ptp_enable()
303 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
304 ocelot_write_rix(ocelot, wf_low, PTP_PIN_WF_LOW_PERIOD, in ocelot_ptp_enable()
306 ocelot_write_rix(ocelot, wf_high, PTP_PIN_WF_HIGH_PERIOD, in ocelot_ptp_enable()
309 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, ptp_pin); in ocelot_ptp_enable()
310 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_ptp_enable()
313 return -EOPNOTSUPP; in ocelot_ptp_enable()
321 trap->key_type = OCELOT_VCAP_KEY_ETYPE; in ocelot_populate_l2_ptp_trap_key()
322 *(__be16 *)trap->key.etype.etype.value = htons(ETH_P_1588); in ocelot_populate_l2_ptp_trap_key()
323 *(__be16 *)trap->key.etype.etype.mask = htons(0xffff); in ocelot_populate_l2_ptp_trap_key()
329 trap->key_type = OCELOT_VCAP_KEY_IPV4; in ocelot_populate_ipv4_ptp_event_trap_key()
330 trap->key.ipv4.proto.value[0] = IPPROTO_UDP; in ocelot_populate_ipv4_ptp_event_trap_key()
331 trap->key.ipv4.proto.mask[0] = 0xff; in ocelot_populate_ipv4_ptp_event_trap_key()
332 trap->key.ipv4.dport.value = PTP_EV_PORT; in ocelot_populate_ipv4_ptp_event_trap_key()
333 trap->key.ipv4.dport.mask = 0xffff; in ocelot_populate_ipv4_ptp_event_trap_key()
339 trap->key_type = OCELOT_VCAP_KEY_IPV6; in ocelot_populate_ipv6_ptp_event_trap_key()
340 trap->key.ipv6.proto.value[0] = IPPROTO_UDP; in ocelot_populate_ipv6_ptp_event_trap_key()
341 trap->key.ipv6.proto.mask[0] = 0xff; in ocelot_populate_ipv6_ptp_event_trap_key()
342 trap->key.ipv6.dport.value = PTP_EV_PORT; in ocelot_populate_ipv6_ptp_event_trap_key()
343 trap->key.ipv6.dport.mask = 0xffff; in ocelot_populate_ipv6_ptp_event_trap_key()
349 trap->key_type = OCELOT_VCAP_KEY_IPV4; in ocelot_populate_ipv4_ptp_general_trap_key()
350 trap->key.ipv4.proto.value[0] = IPPROTO_UDP; in ocelot_populate_ipv4_ptp_general_trap_key()
351 trap->key.ipv4.proto.mask[0] = 0xff; in ocelot_populate_ipv4_ptp_general_trap_key()
352 trap->key.ipv4.dport.value = PTP_GEN_PORT; in ocelot_populate_ipv4_ptp_general_trap_key()
353 trap->key.ipv4.dport.mask = 0xffff; in ocelot_populate_ipv4_ptp_general_trap_key()
359 trap->key_type = OCELOT_VCAP_KEY_IPV6; in ocelot_populate_ipv6_ptp_general_trap_key()
360 trap->key.ipv6.proto.value[0] = IPPROTO_UDP; in ocelot_populate_ipv6_ptp_general_trap_key()
361 trap->key.ipv6.proto.mask[0] = 0xff; in ocelot_populate_ipv6_ptp_general_trap_key()
362 trap->key.ipv6.dport.value = PTP_GEN_PORT; in ocelot_populate_ipv6_ptp_general_trap_key()
363 trap->key.ipv6.dport.mask = 0xffff; in ocelot_populate_ipv6_ptp_general_trap_key()
366 static int ocelot_l2_ptp_trap_add(struct ocelot *ocelot, int port) in ocelot_l2_ptp_trap_add() argument
368 unsigned long l2_cookie = OCELOT_VCAP_IS2_L2_PTP_TRAP(ocelot); in ocelot_l2_ptp_trap_add()
370 return ocelot_trap_add(ocelot, port, l2_cookie, true, in ocelot_l2_ptp_trap_add()
374 static int ocelot_l2_ptp_trap_del(struct ocelot *ocelot, int port) in ocelot_l2_ptp_trap_del() argument
376 unsigned long l2_cookie = OCELOT_VCAP_IS2_L2_PTP_TRAP(ocelot); in ocelot_l2_ptp_trap_del()
378 return ocelot_trap_del(ocelot, port, l2_cookie); in ocelot_l2_ptp_trap_del()
381 static int ocelot_ipv4_ptp_trap_add(struct ocelot *ocelot, int port) in ocelot_ipv4_ptp_trap_add() argument
383 unsigned long ipv4_gen_cookie = OCELOT_VCAP_IS2_IPV4_GEN_PTP_TRAP(ocelot); in ocelot_ipv4_ptp_trap_add()
384 unsigned long ipv4_ev_cookie = OCELOT_VCAP_IS2_IPV4_EV_PTP_TRAP(ocelot); in ocelot_ipv4_ptp_trap_add()
387 err = ocelot_trap_add(ocelot, port, ipv4_ev_cookie, true, in ocelot_ipv4_ptp_trap_add()
392 err = ocelot_trap_add(ocelot, port, ipv4_gen_cookie, false, in ocelot_ipv4_ptp_trap_add()
395 ocelot_trap_del(ocelot, port, ipv4_ev_cookie); in ocelot_ipv4_ptp_trap_add()
400 static int ocelot_ipv4_ptp_trap_del(struct ocelot *ocelot, int port) in ocelot_ipv4_ptp_trap_del() argument
402 unsigned long ipv4_gen_cookie = OCELOT_VCAP_IS2_IPV4_GEN_PTP_TRAP(ocelot); in ocelot_ipv4_ptp_trap_del()
403 unsigned long ipv4_ev_cookie = OCELOT_VCAP_IS2_IPV4_EV_PTP_TRAP(ocelot); in ocelot_ipv4_ptp_trap_del()
406 err = ocelot_trap_del(ocelot, port, ipv4_ev_cookie); in ocelot_ipv4_ptp_trap_del()
407 err |= ocelot_trap_del(ocelot, port, ipv4_gen_cookie); in ocelot_ipv4_ptp_trap_del()
411 static int ocelot_ipv6_ptp_trap_add(struct ocelot *ocelot, int port) in ocelot_ipv6_ptp_trap_add() argument
413 unsigned long ipv6_gen_cookie = OCELOT_VCAP_IS2_IPV6_GEN_PTP_TRAP(ocelot); in ocelot_ipv6_ptp_trap_add()
414 unsigned long ipv6_ev_cookie = OCELOT_VCAP_IS2_IPV6_EV_PTP_TRAP(ocelot); in ocelot_ipv6_ptp_trap_add()
417 err = ocelot_trap_add(ocelot, port, ipv6_ev_cookie, true, in ocelot_ipv6_ptp_trap_add()
422 err = ocelot_trap_add(ocelot, port, ipv6_gen_cookie, false, in ocelot_ipv6_ptp_trap_add()
425 ocelot_trap_del(ocelot, port, ipv6_ev_cookie); in ocelot_ipv6_ptp_trap_add()
430 static int ocelot_ipv6_ptp_trap_del(struct ocelot *ocelot, int port) in ocelot_ipv6_ptp_trap_del() argument
432 unsigned long ipv6_gen_cookie = OCELOT_VCAP_IS2_IPV6_GEN_PTP_TRAP(ocelot); in ocelot_ipv6_ptp_trap_del()
433 unsigned long ipv6_ev_cookie = OCELOT_VCAP_IS2_IPV6_EV_PTP_TRAP(ocelot); in ocelot_ipv6_ptp_trap_del()
436 err = ocelot_trap_del(ocelot, port, ipv6_ev_cookie); in ocelot_ipv6_ptp_trap_del()
437 err |= ocelot_trap_del(ocelot, port, ipv6_gen_cookie); in ocelot_ipv6_ptp_trap_del()
441 static int ocelot_setup_ptp_traps(struct ocelot *ocelot, int port, in ocelot_setup_ptp_traps() argument
444 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_setup_ptp_traps()
447 ocelot_port->trap_proto &= ~(OCELOT_PROTO_PTP_L2 | in ocelot_setup_ptp_traps()
451 err = ocelot_l2_ptp_trap_add(ocelot, port); in ocelot_setup_ptp_traps()
453 err = ocelot_l2_ptp_trap_del(ocelot, port); in ocelot_setup_ptp_traps()
458 err = ocelot_ipv4_ptp_trap_add(ocelot, port); in ocelot_setup_ptp_traps()
462 err = ocelot_ipv6_ptp_trap_add(ocelot, port); in ocelot_setup_ptp_traps()
466 err = ocelot_ipv4_ptp_trap_del(ocelot, port); in ocelot_setup_ptp_traps()
468 err |= ocelot_ipv6_ptp_trap_del(ocelot, port); in ocelot_setup_ptp_traps()
474 ocelot_port->trap_proto |= OCELOT_PROTO_PTP_L2; in ocelot_setup_ptp_traps()
476 ocelot_port->trap_proto |= OCELOT_PROTO_PTP_L4; in ocelot_setup_ptp_traps()
481 ocelot_ipv4_ptp_trap_del(ocelot, port); in ocelot_setup_ptp_traps()
484 ocelot_l2_ptp_trap_del(ocelot, port); in ocelot_setup_ptp_traps()
516 return -ERANGE; in ocelot_ptp_tx_type_to_cmd()
522 int ocelot_hwstamp_get(struct ocelot *ocelot, int port, struct ifreq *ifr) in ocelot_hwstamp_get() argument
524 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_hwstamp_get()
527 switch (ocelot_port->ptp_cmd) { in ocelot_hwstamp_get()
539 cfg.rx_filter = ocelot_traps_to_ptp_rx_filter(ocelot_port->trap_proto); in ocelot_hwstamp_get()
541 return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0; in ocelot_hwstamp_get()
545 int ocelot_hwstamp_set(struct ocelot *ocelot, int port, struct ifreq *ifr) in ocelot_hwstamp_set() argument
547 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_hwstamp_set()
548 int ptp_cmd, old_ptp_cmd = ocelot_port->ptp_cmd; in ocelot_hwstamp_set()
554 if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg))) in ocelot_hwstamp_set()
555 return -EFAULT; in ocelot_hwstamp_set()
582 return -ERANGE; in ocelot_hwstamp_set()
585 old_l2 = ocelot_port->trap_proto & OCELOT_PROTO_PTP_L2; in ocelot_hwstamp_set()
586 old_l4 = ocelot_port->trap_proto & OCELOT_PROTO_PTP_L4; in ocelot_hwstamp_set()
588 err = ocelot_setup_ptp_traps(ocelot, port, l2, l4); in ocelot_hwstamp_set()
592 ocelot_port->ptp_cmd = ptp_cmd; in ocelot_hwstamp_set()
594 cfg.rx_filter = ocelot_traps_to_ptp_rx_filter(ocelot_port->trap_proto); in ocelot_hwstamp_set()
596 if (copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg))) { in ocelot_hwstamp_set()
597 err = -EFAULT; in ocelot_hwstamp_set()
603 ocelot_setup_ptp_traps(ocelot, port, old_l2, old_l4); in ocelot_hwstamp_set()
604 ocelot_port->ptp_cmd = old_ptp_cmd; in ocelot_hwstamp_set()
609 int ocelot_get_ts_info(struct ocelot *ocelot, int port, in ocelot_get_ts_info() argument
612 info->phc_index = ocelot->ptp_clock ? in ocelot_get_ts_info()
613 ptp_clock_index(ocelot->ptp_clock) : -1; in ocelot_get_ts_info()
614 if (info->phc_index == -1) { in ocelot_get_ts_info()
615 info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE | in ocelot_get_ts_info()
620 info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE | in ocelot_get_ts_info()
626 info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON) | in ocelot_get_ts_info()
628 info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | in ocelot_get_ts_info()
637 static struct sk_buff *ocelot_port_dequeue_ptp_tx_skb(struct ocelot *ocelot, in ocelot_port_dequeue_ptp_tx_skb() argument
641 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_port_dequeue_ptp_tx_skb()
645 spin_lock(&ocelot->ts_id_lock); in ocelot_port_dequeue_ptp_tx_skb()
647 skb_queue_walk_safe(&ocelot_port->tx_skbs, skb, skb_tmp) { in ocelot_port_dequeue_ptp_tx_skb()
648 if (OCELOT_SKB_CB(skb)->ts_id != ts_id) in ocelot_port_dequeue_ptp_tx_skb()
653 * NULL, because we've pre-validated the packet's ptp_class. in ocelot_port_dequeue_ptp_tx_skb()
655 hdr = ptp_parse_header(skb, OCELOT_SKB_CB(skb)->ptp_class); in ocelot_port_dequeue_ptp_tx_skb()
656 if (seqid != ntohs(hdr->sequence_id)) in ocelot_port_dequeue_ptp_tx_skb()
659 __skb_unlink(skb, &ocelot_port->tx_skbs); in ocelot_port_dequeue_ptp_tx_skb()
660 ocelot->ptp_skbs_in_flight--; in ocelot_port_dequeue_ptp_tx_skb()
665 spin_unlock(&ocelot->ts_id_lock); in ocelot_port_dequeue_ptp_tx_skb()
670 static int ocelot_port_queue_ptp_tx_skb(struct ocelot *ocelot, int port, in ocelot_port_queue_ptp_tx_skb() argument
673 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_port_queue_ptp_tx_skb()
678 spin_lock(&ocelot->ts_id_lock); in ocelot_port_queue_ptp_tx_skb()
684 skb_queue_walk_safe(&ocelot_port->tx_skbs, skb, skb_tmp) { in ocelot_port_queue_ptp_tx_skb()
685 if (time_before(OCELOT_SKB_CB(skb)->ptp_tx_time + in ocelot_port_queue_ptp_tx_skb()
687 dev_warn_ratelimited(ocelot->dev, in ocelot_port_queue_ptp_tx_skb()
689 port, OCELOT_SKB_CB(skb)->ts_id); in ocelot_port_queue_ptp_tx_skb()
690 __skb_unlink(skb, &ocelot_port->tx_skbs); in ocelot_port_queue_ptp_tx_skb()
692 ocelot->ptp_skbs_in_flight--; in ocelot_port_queue_ptp_tx_skb()
694 __set_bit(OCELOT_SKB_CB(skb)->ts_id, ts_id_in_flight); in ocelot_port_queue_ptp_tx_skb()
698 if (ocelot->ptp_skbs_in_flight == OCELOT_PTP_FIFO_SIZE) { in ocelot_port_queue_ptp_tx_skb()
699 spin_unlock(&ocelot->ts_id_lock); in ocelot_port_queue_ptp_tx_skb()
700 return -EBUSY; in ocelot_port_queue_ptp_tx_skb()
705 spin_unlock(&ocelot->ts_id_lock); in ocelot_port_queue_ptp_tx_skb()
706 return -EBUSY; in ocelot_port_queue_ptp_tx_skb()
710 OCELOT_SKB_CB(clone)->ts_id = n; in ocelot_port_queue_ptp_tx_skb()
711 OCELOT_SKB_CB(clone)->ptp_tx_time = jiffies; in ocelot_port_queue_ptp_tx_skb()
712 ocelot->ptp_skbs_in_flight++; in ocelot_port_queue_ptp_tx_skb()
713 __skb_queue_tail(&ocelot_port->tx_skbs, clone); in ocelot_port_queue_ptp_tx_skb()
715 spin_unlock(&ocelot->ts_id_lock); in ocelot_port_queue_ptp_tx_skb()
717 dev_dbg_ratelimited(ocelot->dev, "port %d timestamp id %lu\n", port, n); in ocelot_port_queue_ptp_tx_skb()
733 twostep = hdr->flag_field[0] & 0x2; in ocelot_ptp_is_onestep_sync()
741 int ocelot_port_txtstamp_request(struct ocelot *ocelot, int port, in ocelot_port_txtstamp_request() argument
745 struct ocelot_port *ocelot_port = ocelot->ports[port]; in ocelot_port_txtstamp_request()
746 u8 ptp_cmd = ocelot_port->ptp_cmd; in ocelot_port_txtstamp_request()
756 return -EINVAL; in ocelot_port_txtstamp_request()
758 /* Store ptp_cmd in OCELOT_SKB_CB(skb)->ptp_cmd */ in ocelot_port_txtstamp_request()
761 OCELOT_SKB_CB(skb)->ptp_cmd = ptp_cmd; in ocelot_port_txtstamp_request()
765 /* Fall back to two-step timestamping */ in ocelot_port_txtstamp_request()
772 return -ENOMEM; in ocelot_port_txtstamp_request()
774 /* Store timestamp ID in OCELOT_SKB_CB(clone)->ts_id */ in ocelot_port_txtstamp_request()
775 err = ocelot_port_queue_ptp_tx_skb(ocelot, port, *clone); in ocelot_port_txtstamp_request()
781 skb_shinfo(*clone)->tx_flags |= SKBTX_IN_PROGRESS; in ocelot_port_txtstamp_request()
782 OCELOT_SKB_CB(skb)->ptp_cmd = ptp_cmd; in ocelot_port_txtstamp_request()
783 OCELOT_SKB_CB(*clone)->ptp_class = ptp_class; in ocelot_port_txtstamp_request()
790 static void ocelot_get_hwtimestamp(struct ocelot *ocelot, in ocelot_get_hwtimestamp() argument
796 spin_lock_irqsave(&ocelot->ptp_clock_lock, flags); in ocelot_get_hwtimestamp()
799 val = ocelot_read_rix(ocelot, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_get_hwtimestamp()
803 ocelot_write_rix(ocelot, val, PTP_PIN_CFG, TOD_ACC_PIN); in ocelot_get_hwtimestamp()
804 ts->tv_sec = ocelot_read_rix(ocelot, PTP_PIN_TOD_SEC_LSB, TOD_ACC_PIN); in ocelot_get_hwtimestamp()
807 val = ocelot_read(ocelot, SYS_PTP_TXSTAMP); in ocelot_get_hwtimestamp()
808 ts->tv_nsec = SYS_PTP_TXSTAMP_PTP_TXSTAMP(val); in ocelot_get_hwtimestamp()
811 if ((ts->tv_sec & 0x1) != !!(val & SYS_PTP_TXSTAMP_PTP_TXSTAMP_SEC)) in ocelot_get_hwtimestamp()
812 ts->tv_sec--; in ocelot_get_hwtimestamp()
814 spin_unlock_irqrestore(&ocelot->ptp_clock_lock, flags); in ocelot_get_hwtimestamp()
817 void ocelot_get_txtstamp(struct ocelot *ocelot) in ocelot_get_txtstamp() argument
821 while (budget--) { in ocelot_get_txtstamp()
827 val = ocelot_read(ocelot, SYS_PTP_STATUS); in ocelot_get_txtstamp()
841 skb_match = ocelot_port_dequeue_ptp_tx_skb(ocelot, txport, id, in ocelot_get_txtstamp()
844 dev_warn_ratelimited(ocelot->dev, in ocelot_get_txtstamp()
851 ocelot_get_hwtimestamp(ocelot, &ts); in ocelot_get_txtstamp()
859 ocelot_write(ocelot, SYS_PTP_NXT_PTP_NXT, SYS_PTP_NXT); in ocelot_get_txtstamp()
864 int ocelot_init_timestamp(struct ocelot *ocelot, in ocelot_init_timestamp() argument
870 ocelot->ptp_info = *info; in ocelot_init_timestamp()
873 struct ptp_pin_desc *p = &ocelot->ptp_pins[i]; in ocelot_init_timestamp()
875 snprintf(p->name, sizeof(p->name), "switch_1588_dat%d", i); in ocelot_init_timestamp()
876 p->index = i; in ocelot_init_timestamp()
877 p->func = PTP_PF_NONE; in ocelot_init_timestamp()
880 ocelot->ptp_info.pin_config = &ocelot->ptp_pins[0]; in ocelot_init_timestamp()
882 ptp_clock = ptp_clock_register(&ocelot->ptp_info, ocelot->dev); in ocelot_init_timestamp()
889 ocelot->ptp_clock = ptp_clock; in ocelot_init_timestamp()
891 ocelot_write(ocelot, SYS_PTP_CFG_PTP_STAMP_WID(30), SYS_PTP_CFG); in ocelot_init_timestamp()
892 ocelot_write(ocelot, 0xffffffff, ANA_TABLES_PTP_ID_LOW); in ocelot_init_timestamp()
893 ocelot_write(ocelot, 0xffffffff, ANA_TABLES_PTP_ID_HIGH); in ocelot_init_timestamp()
895 ocelot_write(ocelot, PTP_CFG_MISC_PTP_EN, PTP_CFG_MISC); in ocelot_init_timestamp()
901 int ocelot_deinit_timestamp(struct ocelot *ocelot) in ocelot_deinit_timestamp() argument
903 if (ocelot->ptp_clock) in ocelot_deinit_timestamp()
904 ptp_clock_unregister(ocelot->ptp_clock); in ocelot_deinit_timestamp()