Lines Matching +full:tx +full:- +full:delay +full:- +full:ns
1 // SPDX-License-Identifier: GPL-2.0
4 * Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com
9 #include <linux/clk-provider.h>
23 #include "am65-cpts.h"
166 /* separate lists to handle TX and RX timestamp independently */
203 #define am65_cpts_write32(c, v, r) writel(v, &(c)->reg->r)
204 #define am65_cpts_read32(c, r) readl(&(c)->reg->r)
221 cpts->ts_add_val = (NSEC_PER_SEC / cpts->refclk_freq - 1) & 0x7; in am65_cpts_set_add_val()
223 am65_cpts_write32(cpts, cpts->ts_add_val, ts_add_val); in am65_cpts_set_add_val()
241 if (time_after(jiffies, event->tmo)) { in am65_cpts_purge_event_list()
242 list_del_init(&event->list); in am65_cpts_purge_event_list()
243 list_add(&event->list, &cpts->pool); in am65_cpts_purge_event_list()
252 return (event->event1 & AM65_CPTS_EVENT_1_PORT_NUMBER_MASK) >> in am65_cpts_event_get_port()
258 return (event->event1 & AM65_CPTS_EVENT_1_EVENT_TYPE_MASK) >> in am65_cpts_event_get_type()
266 removed += am65_cpts_purge_event_list(cpts, &cpts->events_tx); in am65_cpts_purge_events()
267 removed += am65_cpts_purge_event_list(cpts, &cpts->events_rx); in am65_cpts_purge_events()
270 dev_dbg(cpts->dev, "event pool cleaned up %d\n", removed); in am65_cpts_purge_events()
271 return removed ? 0 : -1; in am65_cpts_purge_events()
280 event->timestamp = am65_cpts_read32(cpts, event_0); in am65_cpts_fifo_pop_event()
281 event->event1 = am65_cpts_read32(cpts, event_1); in am65_cpts_fifo_pop_event()
282 event->event2 = am65_cpts_read32(cpts, event_2); in am65_cpts_fifo_pop_event()
283 event->timestamp |= (u64)am65_cpts_read32(cpts, event_3) << 32; in am65_cpts_fifo_pop_event()
298 event = list_first_entry_or_null(&cpts->pool, in __am65_cpts_fifo_read()
303 dev_err(cpts->dev, "cpts: event pool empty\n"); in __am65_cpts_fifo_read()
304 ret = -1; in __am65_cpts_fifo_read()
316 cpts->timestamp = event->timestamp; in __am65_cpts_fifo_read()
317 dev_dbg(cpts->dev, "AM65_CPTS_EV_PUSH t:%llu\n", in __am65_cpts_fifo_read()
318 cpts->timestamp); in __am65_cpts_fifo_read()
321 event->tmo = jiffies + in __am65_cpts_fifo_read()
324 list_move_tail(&event->list, &cpts->events_rx); in __am65_cpts_fifo_read()
326 dev_dbg(cpts->dev, in __am65_cpts_fifo_read()
328 event->event1, event->event2, in __am65_cpts_fifo_read()
329 event->timestamp); in __am65_cpts_fifo_read()
332 event->tmo = jiffies + in __am65_cpts_fifo_read()
335 list_move_tail(&event->list, &cpts->events_tx); in __am65_cpts_fifo_read()
337 dev_dbg(cpts->dev, in __am65_cpts_fifo_read()
339 event->event1, event->event2, in __am65_cpts_fifo_read()
340 event->timestamp); in __am65_cpts_fifo_read()
344 pevent.index = am65_cpts_event_get_port(event) - 1; in __am65_cpts_fifo_read()
345 pevent.timestamp = event->timestamp; in __am65_cpts_fifo_read()
346 if (cpts->pps_enabled && pevent.index == cpts->pps_hw_ts_idx) { in __am65_cpts_fifo_read()
352 dev_dbg(cpts->dev, "AM65_CPTS_EV_HW:%s p:%d t:%llu\n", in __am65_cpts_fifo_read()
355 pevent.index, event->timestamp); in __am65_cpts_fifo_read()
357 ptp_clock_event(cpts->ptp_clock, &pevent); in __am65_cpts_fifo_read()
364 dev_dbg(cpts->dev, in __am65_cpts_fifo_read()
367 event->event1, event->event2, in __am65_cpts_fifo_read()
368 event->timestamp); in __am65_cpts_fifo_read()
371 dev_err(cpts->dev, "cpts: unknown event type\n"); in __am65_cpts_fifo_read()
372 ret = -1; in __am65_cpts_fifo_read()
379 ptp_schedule_worker(cpts->ptp_clock, 0); in __am65_cpts_fifo_read()
389 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_fifo_read()
391 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_fifo_read()
403 * doubled read. Interrupt can be in-flight - it's Ok. in am65_cpts_gettime()
408 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_gettime()
413 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_gettime()
419 val = cpts->timestamp; in am65_cpts_gettime()
429 dev_dbg(cpts->dev, "cpts: unable to obtain a time stamp\n"); in am65_cpts_interrupt()
440 int pps_index = cpts->pps_genf_idx; in am65_cpts_ptp_adjfine()
448 ppb = -ppb; in am65_cpts_ptp_adjfine()
460 adj_period = div_u64(cpts->refclk_freq, ppb); in am65_cpts_ptp_adjfine()
462 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_ptp_adjfine()
473 if (cpts->pps_enabled) { in am65_cpts_ptp_adjfine()
481 * (cpts->ts_add_val + 1) ns, so GenF length PPM adj period in am65_cpts_ptp_adjfine()
484 pps_adj_period = adj_period * (cpts->ts_add_val + 1); in am65_cpts_ptp_adjfine()
489 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_ptp_adjfine()
492 * - delay between PPM dir and PPM value changes can cause err due old in am65_cpts_ptp_adjfine()
494 * - delay between CPTS-clock PPM cfg and GenF PPM cfg can cause err in am65_cpts_ptp_adjfine()
495 * due CPTS-clock PPM working with new cfg while GenF PPM cfg still in am65_cpts_ptp_adjfine()
503 if (cpts->pps_enabled) { in am65_cpts_ptp_adjfine()
510 if (cpts->estf_enable & BIT(i)) { in am65_cpts_ptp_adjfine()
517 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_ptp_adjfine()
519 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_ptp_adjfine()
527 s64 ns; in am65_cpts_ptp_adjtime() local
529 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_ptp_adjtime()
530 ns = am65_cpts_gettime(cpts, NULL); in am65_cpts_ptp_adjtime()
531 ns += delta; in am65_cpts_ptp_adjtime()
532 am65_cpts_settime(cpts, ns); in am65_cpts_ptp_adjtime()
533 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_ptp_adjtime()
543 u64 ns; in am65_cpts_ptp_gettimex() local
545 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_ptp_gettimex()
546 ns = am65_cpts_gettime(cpts, sts); in am65_cpts_ptp_gettimex()
547 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_ptp_gettimex()
548 *ts = ns_to_timespec64(ns); in am65_cpts_ptp_gettimex()
555 u64 ns; in am65_cpts_ns_gettime() local
558 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_ns_gettime()
559 ns = am65_cpts_gettime(cpts, NULL); in am65_cpts_ns_gettime()
560 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_ns_gettime()
562 return ns; in am65_cpts_ns_gettime()
570 u64 ns; in am65_cpts_ptp_settime() local
572 ns = timespec64_to_ns(ts); in am65_cpts_ptp_settime()
573 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_ptp_settime()
574 am65_cpts_settime(cpts, ns); in am65_cpts_ptp_settime()
575 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_ptp_settime()
587 cpts->hw_ts_enable |= BIT(index); in am65_cpts_extts_enable_hw()
590 cpts->hw_ts_enable &= ~BIT(index); in am65_cpts_extts_enable_hw()
597 if (index >= cpts->ptp_info.n_ext_ts) in am65_cpts_extts_enable()
598 return -ENXIO; in am65_cpts_extts_enable()
600 if (cpts->pps_present && index == cpts->pps_hw_ts_idx) in am65_cpts_extts_enable()
601 return -EINVAL; in am65_cpts_extts_enable()
603 if (((cpts->hw_ts_enable & BIT(index)) >> index) == on) in am65_cpts_extts_enable()
606 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_extts_enable()
608 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_extts_enable()
610 dev_dbg(cpts->dev, "%s: ExtTS:%u %s\n", in am65_cpts_extts_enable()
622 cycles = cfg->ns_period * cpts->refclk_freq; in am65_cpts_estf_enable()
625 return -EINVAL; in am65_cpts_estf_enable()
630 val = upper_32_bits(cfg->ns_start); in am65_cpts_estf_enable()
632 val = lower_32_bits(cfg->ns_start); in am65_cpts_estf_enable()
640 cpts->estf_enable |= BIT(idx); in am65_cpts_estf_enable()
642 dev_dbg(cpts->dev, "%s: ESTF:%u enabled\n", __func__, idx); in am65_cpts_estf_enable()
651 cpts->estf_enable &= ~BIT(idx); in am65_cpts_estf_disable()
653 dev_dbg(cpts->dev, "%s: ESTF:%u disabled\n", __func__, idx); in am65_cpts_estf_disable()
665 ts.tv_sec = req->period.sec; in am65_cpts_perout_enable_hw()
666 ts.tv_nsec = req->period.nsec; in am65_cpts_perout_enable_hw()
669 cycles = (ns_period * cpts->refclk_freq) / NSEC_PER_SEC; in am65_cpts_perout_enable_hw()
671 ts.tv_sec = req->start.sec; in am65_cpts_perout_enable_hw()
672 ts.tv_nsec = req->start.nsec; in am65_cpts_perout_enable_hw()
676 am65_cpts_write32(cpts, val, genf[req->index].comp_hi); in am65_cpts_perout_enable_hw()
678 am65_cpts_write32(cpts, val, genf[req->index].comp_lo); in am65_cpts_perout_enable_hw()
680 am65_cpts_write32(cpts, val, genf[req->index].length); in am65_cpts_perout_enable_hw()
682 am65_cpts_write32(cpts, 0, genf[req->index].control); in am65_cpts_perout_enable_hw()
683 am65_cpts_write32(cpts, 0, genf[req->index].ppm_hi); in am65_cpts_perout_enable_hw()
684 am65_cpts_write32(cpts, 0, genf[req->index].ppm_low); in am65_cpts_perout_enable_hw()
686 cpts->genf_enable |= BIT(req->index); in am65_cpts_perout_enable_hw()
688 am65_cpts_write32(cpts, 0, genf[req->index].length); in am65_cpts_perout_enable_hw()
690 cpts->genf_enable &= ~BIT(req->index); in am65_cpts_perout_enable_hw()
697 if (req->index >= cpts->ptp_info.n_per_out) in am65_cpts_perout_enable()
698 return -ENXIO; in am65_cpts_perout_enable()
700 if (cpts->pps_present && req->index == cpts->pps_genf_idx) in am65_cpts_perout_enable()
701 return -EINVAL; in am65_cpts_perout_enable()
703 if (!!(cpts->genf_enable & BIT(req->index)) == !!on) in am65_cpts_perout_enable()
706 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_perout_enable()
708 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_perout_enable()
710 dev_dbg(cpts->dev, "%s: GenF:%u %s\n", in am65_cpts_perout_enable()
711 __func__, req->index, on ? "enabled" : "disabled"); in am65_cpts_perout_enable()
721 u64 ns; in am65_cpts_pps_enable() local
723 if (!cpts->pps_present) in am65_cpts_pps_enable()
724 return -EINVAL; in am65_cpts_pps_enable()
726 if (cpts->pps_enabled == !!on) in am65_cpts_pps_enable()
729 mutex_lock(&cpts->ptp_clk_lock); in am65_cpts_pps_enable()
732 am65_cpts_extts_enable_hw(cpts, cpts->pps_hw_ts_idx, on); in am65_cpts_pps_enable()
734 ns = am65_cpts_gettime(cpts, NULL); in am65_cpts_pps_enable()
735 ts = ns_to_timespec64(ns); in am65_cpts_pps_enable()
740 rq.perout.index = cpts->pps_genf_idx; in am65_cpts_pps_enable()
743 cpts->pps_enabled = true; in am65_cpts_pps_enable()
745 rq.perout.index = cpts->pps_genf_idx; in am65_cpts_pps_enable()
747 am65_cpts_extts_enable_hw(cpts, cpts->pps_hw_ts_idx, on); in am65_cpts_pps_enable()
748 cpts->pps_enabled = false; in am65_cpts_pps_enable()
751 mutex_unlock(&cpts->ptp_clk_lock); in am65_cpts_pps_enable()
753 dev_dbg(cpts->dev, "%s: pps: %s\n", in am65_cpts_pps_enable()
763 switch (rq->type) { in am65_cpts_ptp_enable()
765 return am65_cpts_extts_enable(cpts, rq->extts.index, on); in am65_cpts_ptp_enable()
767 return am65_cpts_perout_enable(cpts, &rq->perout, on); in am65_cpts_ptp_enable()
774 return -EOPNOTSUPP; in am65_cpts_ptp_enable()
799 mtype_seqid = event->event1 & in am65_cpts_match_tx_ts()
806 spin_lock_irqsave(&cpts->txq.lock, flags); in am65_cpts_match_tx_ts()
807 skb_queue_splice_init(&cpts->txq, &txq_list); in am65_cpts_match_tx_ts()
808 spin_unlock_irqrestore(&cpts->txq.lock, flags); in am65_cpts_match_tx_ts()
810 /* no need to grab txq.lock as access is always done under cpts->lock */ in am65_cpts_match_tx_ts()
814 (struct am65_cpts_skb_cb_data *)skb->cb; in am65_cpts_match_tx_ts()
818 (skb_cb->skb_mtype_seqid & AM65_CPTS_EVENT_1_SEQUENCE_ID_MASK))) in am65_cpts_match_tx_ts()
819 mtype_seqid = skb_cb->skb_mtype_seqid; in am65_cpts_match_tx_ts()
821 if (mtype_seqid == skb_cb->skb_mtype_seqid) { in am65_cpts_match_tx_ts()
822 u64 ns = event->timestamp; in am65_cpts_match_tx_ts() local
825 ssh.hwtstamp = ns_to_ktime(ns); in am65_cpts_match_tx_ts()
830 dev_dbg(cpts->dev, in am65_cpts_match_tx_ts()
831 "match tx timestamp mtype_seqid %08x\n", in am65_cpts_match_tx_ts()
836 if (time_after(jiffies, skb_cb->tmo)) { in am65_cpts_match_tx_ts()
838 dev_dbg(cpts->dev, in am65_cpts_match_tx_ts()
839 "expiring tx timestamp mtype_seqid %08x\n", in am65_cpts_match_tx_ts()
846 spin_lock_irqsave(&cpts->txq.lock, flags); in am65_cpts_match_tx_ts()
847 skb_queue_splice(&txq_list, &cpts->txq); in am65_cpts_match_tx_ts()
848 spin_unlock_irqrestore(&cpts->txq.lock, flags); in am65_cpts_match_tx_ts()
861 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_find_tx_ts()
862 list_splice_init(&cpts->events_tx, &events); in am65_cpts_find_tx_ts()
863 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_find_tx_ts()
868 time_after(jiffies, event->tmo)) { in am65_cpts_find_tx_ts()
869 list_del_init(&event->list); in am65_cpts_find_tx_ts()
870 list_add(&event->list, &events_free); in am65_cpts_find_tx_ts()
874 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_find_tx_ts()
875 list_splice_tail(&events, &cpts->events_tx); in am65_cpts_find_tx_ts()
876 list_splice_tail(&events_free, &cpts->pool); in am65_cpts_find_tx_ts()
877 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_find_tx_ts()
884 long delay = -1; in am65_cpts_ts_work() local
888 spin_lock_irqsave(&cpts->txq.lock, flags); in am65_cpts_ts_work()
889 if (!skb_queue_empty(&cpts->txq)) in am65_cpts_ts_work()
890 delay = AM65_CPTS_SKB_TX_WORK_TIMEOUT; in am65_cpts_ts_work()
891 spin_unlock_irqrestore(&cpts->txq.lock, flags); in am65_cpts_ts_work()
893 return delay; in am65_cpts_ts_work()
911 seqid = ntohs(hdr->sequence_id); in am65_skb_get_mtype_seqid()
926 u64 ns = 0; in am65_cpts_find_rx_ts() local
928 spin_lock_irqsave(&cpts->lock, flags); in am65_cpts_find_rx_ts()
930 list_for_each_safe(this, next, &cpts->events_rx) { in am65_cpts_find_rx_ts()
932 if (time_after(jiffies, event->tmo)) { in am65_cpts_find_rx_ts()
933 list_move(&event->list, &cpts->pool); in am65_cpts_find_rx_ts()
937 mtype_seqid = event->event1 & in am65_cpts_find_rx_ts()
943 ns = event->timestamp; in am65_cpts_find_rx_ts()
944 list_move(&event->list, &cpts->pool); in am65_cpts_find_rx_ts()
948 spin_unlock_irqrestore(&cpts->lock, flags); in am65_cpts_find_rx_ts()
950 return ns; in am65_cpts_find_rx_ts()
955 struct am65_cpts_skb_cb_data *skb_cb = (struct am65_cpts_skb_cb_data *)skb->cb; in am65_cpts_rx_timestamp()
958 u64 ns; in am65_cpts_rx_timestamp() local
965 ret = am65_skb_get_mtype_seqid(skb, &skb_cb->skb_mtype_seqid); in am65_cpts_rx_timestamp()
969 skb_cb->skb_mtype_seqid |= (AM65_CPTS_EV_RX << AM65_CPTS_EVENT_1_EVENT_TYPE_SHIFT); in am65_cpts_rx_timestamp()
971 dev_dbg(cpts->dev, "%s mtype seqid %08x\n", __func__, skb_cb->skb_mtype_seqid); in am65_cpts_rx_timestamp()
973 ns = am65_cpts_find_rx_ts(cpts, skb_cb->skb_mtype_seqid); in am65_cpts_rx_timestamp()
974 if (!ns) in am65_cpts_rx_timestamp()
979 ssh->hwtstamp = ns_to_ktime(ns); in am65_cpts_rx_timestamp()
984 * am65_cpts_tx_timestamp - save tx packet for timestamping
988 * This functions saves tx packet for timestamping if packet can be timestamped.
993 struct am65_cpts_skb_cb_data *skb_cb = (void *)skb->cb; in am65_cpts_tx_timestamp()
995 if (!(skb_shinfo(skb)->tx_flags & SKBTX_IN_PROGRESS)) in am65_cpts_tx_timestamp()
1003 skb_cb->tmo = jiffies + msecs_to_jiffies(100); in am65_cpts_tx_timestamp()
1004 skb_queue_tail(&cpts->txq, skb); in am65_cpts_tx_timestamp()
1005 ptp_schedule_worker(cpts->ptp_clock, 0); in am65_cpts_tx_timestamp()
1010 * am65_cpts_prep_tx_timestamp - check and prepare tx packet for timestamping
1016 * in skb-cb and marks packet as SKBTX_IN_PROGRESS.
1020 struct am65_cpts_skb_cb_data *skb_cb = (void *)skb->cb; in am65_cpts_prep_tx_timestamp()
1023 if (!(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)) in am65_cpts_prep_tx_timestamp()
1026 ret = am65_skb_get_mtype_seqid(skb, &skb_cb->skb_mtype_seqid); in am65_cpts_prep_tx_timestamp()
1029 skb_cb->skb_mtype_seqid |= (AM65_CPTS_EV_TX << in am65_cpts_prep_tx_timestamp()
1032 skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; in am65_cpts_prep_tx_timestamp()
1038 return cpts->phc_index; in am65_cpts_phc_index()
1046 of_clk_del_provider(cpts->clk_mux_np); in cpts_free_clk_mux()
1047 clk_hw_unregister_mux(cpts->clk_mux_hw); in cpts_free_clk_mux()
1048 of_node_put(cpts->clk_mux_np); in cpts_free_clk_mux()
1058 int ret = -EINVAL; in cpts_of_mux_clk_setup()
1060 cpts->clk_mux_np = of_get_child_by_name(node, "refclk-mux"); in cpts_of_mux_clk_setup()
1061 if (!cpts->clk_mux_np) in cpts_of_mux_clk_setup()
1064 num_parents = of_clk_get_parent_count(cpts->clk_mux_np); in cpts_of_mux_clk_setup()
1066 dev_err(cpts->dev, "mux-clock %pOF must have parents\n", in cpts_of_mux_clk_setup()
1067 cpts->clk_mux_np); in cpts_of_mux_clk_setup()
1071 parent_names = devm_kcalloc(cpts->dev, sizeof(char *), num_parents, in cpts_of_mux_clk_setup()
1074 ret = -ENOMEM; in cpts_of_mux_clk_setup()
1078 of_clk_parent_fill(cpts->clk_mux_np, parent_names, num_parents); in cpts_of_mux_clk_setup()
1080 clk_mux_name = devm_kasprintf(cpts->dev, GFP_KERNEL, "%s.%pOFn", in cpts_of_mux_clk_setup()
1081 dev_name(cpts->dev), cpts->clk_mux_np); in cpts_of_mux_clk_setup()
1083 ret = -ENOMEM; in cpts_of_mux_clk_setup()
1087 reg = &cpts->reg->rftclk_sel; in cpts_of_mux_clk_setup()
1091 cpts->clk_mux_hw = clk_hw_register_mux(NULL, clk_mux_name, in cpts_of_mux_clk_setup()
1094 if (IS_ERR(cpts->clk_mux_hw)) { in cpts_of_mux_clk_setup()
1095 ret = PTR_ERR(cpts->clk_mux_hw); in cpts_of_mux_clk_setup()
1099 ret = of_clk_add_hw_provider(cpts->clk_mux_np, of_clk_hw_simple_get, in cpts_of_mux_clk_setup()
1100 cpts->clk_mux_hw); in cpts_of_mux_clk_setup()
1104 ret = devm_add_action_or_reset(cpts->dev, cpts_free_clk_mux, cpts); in cpts_of_mux_clk_setup()
1106 dev_err(cpts->dev, "failed to add clkmux reset action %d", ret); in cpts_of_mux_clk_setup()
1111 clk_hw_unregister_mux(cpts->clk_mux_hw); in cpts_of_mux_clk_setup()
1113 of_node_put(cpts->clk_mux_np); in cpts_of_mux_clk_setup()
1121 if (!of_property_read_u32(node, "ti,cpts-ext-ts-inputs", &prop[0])) in am65_cpts_of_parse()
1122 cpts->ext_ts_inputs = prop[0]; in am65_cpts_of_parse()
1124 if (!of_property_read_u32(node, "ti,cpts-periodic-outputs", &prop[0])) in am65_cpts_of_parse()
1125 cpts->genf_num = prop[0]; in am65_cpts_of_parse()
1128 cpts->pps_present = true; in am65_cpts_of_parse()
1131 dev_err(cpts->dev, "invalid HWx_TS_PUSH index: %u provided\n", prop[0]); in am65_cpts_of_parse()
1132 cpts->pps_present = false; in am65_cpts_of_parse()
1135 dev_err(cpts->dev, "invalid GENFy index: %u provided\n", prop[1]); in am65_cpts_of_parse()
1136 cpts->pps_present = false; in am65_cpts_of_parse()
1138 if (cpts->pps_present) { in am65_cpts_of_parse()
1139 cpts->pps_hw_ts_idx = prop[0]; in am65_cpts_of_parse()
1140 cpts->pps_genf_idx = prop[1]; in am65_cpts_of_parse()
1149 ptp_clock_unregister(cpts->ptp_clock); in am65_cpts_release()
1151 clk_disable_unprepare(cpts->refclk); in am65_cpts_release()
1163 return ERR_PTR(-ENOMEM); in am65_cpts_create()
1165 cpts->dev = dev; in am65_cpts_create()
1166 cpts->reg = (struct am65_cpts_regs __iomem *)regs; in am65_cpts_create()
1168 cpts->irq = of_irq_get_byname(node, "cpts"); in am65_cpts_create()
1169 if (cpts->irq <= 0) { in am65_cpts_create()
1170 ret = cpts->irq ?: -ENXIO; in am65_cpts_create()
1179 mutex_init(&cpts->ptp_clk_lock); in am65_cpts_create()
1180 INIT_LIST_HEAD(&cpts->events_tx); in am65_cpts_create()
1181 INIT_LIST_HEAD(&cpts->events_rx); in am65_cpts_create()
1182 INIT_LIST_HEAD(&cpts->pool); in am65_cpts_create()
1183 spin_lock_init(&cpts->lock); in am65_cpts_create()
1184 skb_queue_head_init(&cpts->txq); in am65_cpts_create()
1187 list_add(&cpts->pool_data[i].list, &cpts->pool); in am65_cpts_create()
1189 cpts->refclk = devm_get_clk_from_child(dev, node, "cpts"); in am65_cpts_create()
1190 if (IS_ERR(cpts->refclk)) { in am65_cpts_create()
1191 ret = PTR_ERR(cpts->refclk); in am65_cpts_create()
1196 ret = clk_prepare_enable(cpts->refclk); in am65_cpts_create()
1202 cpts->refclk_freq = clk_get_rate(cpts->refclk); in am65_cpts_create()
1204 am65_ptp_info.max_adj = cpts->refclk_freq / AM65_CPTS_MIN_PPM; in am65_cpts_create()
1205 cpts->ptp_info = am65_ptp_info; in am65_cpts_create()
1207 if (cpts->ext_ts_inputs) in am65_cpts_create()
1208 cpts->ptp_info.n_ext_ts = cpts->ext_ts_inputs; in am65_cpts_create()
1209 if (cpts->genf_num) in am65_cpts_create()
1210 cpts->ptp_info.n_per_out = cpts->genf_num; in am65_cpts_create()
1211 if (cpts->pps_present) in am65_cpts_create()
1212 cpts->ptp_info.pps = 1; in am65_cpts_create()
1225 cpts->ptp_clock = ptp_clock_register(&cpts->ptp_info, cpts->dev); in am65_cpts_create()
1226 if (IS_ERR_OR_NULL(cpts->ptp_clock)) { in am65_cpts_create()
1228 PTR_ERR(cpts->ptp_clock)); in am65_cpts_create()
1229 ret = cpts->ptp_clock ? PTR_ERR(cpts->ptp_clock) : -ENODEV; in am65_cpts_create()
1232 cpts->phc_index = ptp_clock_index(cpts->ptp_clock); in am65_cpts_create()
1234 ret = devm_request_threaded_irq(dev, cpts->irq, NULL, in am65_cpts_create()
1238 dev_err(cpts->dev, "error attaching irq %d\n", ret); in am65_cpts_create()
1244 cpts->refclk_freq, cpts->ts_add_val, cpts->pps_present); in am65_cpts_create()
1251 clk_disable_unprepare(cpts->refclk); in am65_cpts_create()
1259 cpts->sr_control = am65_cpts_read32(cpts, control); in am65_cpts_suspend()
1260 cpts->sr_int_enable = am65_cpts_read32(cpts, int_enable); in am65_cpts_suspend()
1261 cpts->sr_rftclk_sel = am65_cpts_read32(cpts, rftclk_sel); in am65_cpts_suspend()
1262 cpts->sr_ts_ppm_hi = am65_cpts_read32(cpts, ts_ppm_hi); in am65_cpts_suspend()
1263 cpts->sr_ts_ppm_low = am65_cpts_read32(cpts, ts_ppm_low); in am65_cpts_suspend()
1264 cpts->sr_cpts_ns = am65_cpts_gettime(cpts, NULL); in am65_cpts_suspend()
1265 cpts->sr_ktime_ns = ktime_to_ns(ktime_get_real()); in am65_cpts_suspend()
1267 clk_disable(cpts->refclk); in am65_cpts_suspend()
1270 memcpy_fromio(&cpts->sr_genf, &cpts->reg->genf, sizeof(cpts->sr_genf)); in am65_cpts_suspend()
1273 memcpy_fromio(&cpts->sr_estf, &cpts->reg->estf, sizeof(cpts->sr_estf)); in am65_cpts_suspend()
1283 clk_enable(cpts->refclk); in am65_cpts_resume()
1284 am65_cpts_write32(cpts, cpts->sr_rftclk_sel, rftclk_sel); in am65_cpts_resume()
1286 am65_cpts_write32(cpts, cpts->sr_control, control); in am65_cpts_resume()
1287 am65_cpts_write32(cpts, cpts->sr_int_enable, int_enable); in am65_cpts_resume()
1291 ktime_ns -= cpts->sr_ktime_ns; in am65_cpts_resume()
1292 am65_cpts_settime(cpts, cpts->sr_cpts_ns + ktime_ns); in am65_cpts_resume()
1295 am65_cpts_write32(cpts, cpts->sr_ts_ppm_hi, ts_ppm_hi); in am65_cpts_resume()
1296 am65_cpts_write32(cpts, cpts->sr_ts_ppm_low, ts_ppm_low); in am65_cpts_resume()
1301 am65_cpts_write32(cpts, cpts->sr_genf[i].comp_hi, genf[i].comp_hi); in am65_cpts_resume()
1302 am65_cpts_write32(cpts, cpts->sr_genf[i].comp_lo, genf[i].comp_lo); in am65_cpts_resume()
1303 am65_cpts_write32(cpts, cpts->sr_genf[i].length, genf[i].length); in am65_cpts_resume()
1304 am65_cpts_write32(cpts, cpts->sr_genf[i].control, genf[i].control); in am65_cpts_resume()
1305 am65_cpts_write32(cpts, cpts->sr_genf[i].ppm_hi, genf[i].ppm_hi); in am65_cpts_resume()
1306 am65_cpts_write32(cpts, cpts->sr_genf[i].ppm_low, genf[i].ppm_low); in am65_cpts_resume()
1312 am65_cpts_write32(cpts, cpts->sr_estf[i].comp_hi, estf[i].comp_hi); in am65_cpts_resume()
1313 am65_cpts_write32(cpts, cpts->sr_estf[i].comp_lo, estf[i].comp_lo); in am65_cpts_resume()
1314 am65_cpts_write32(cpts, cpts->sr_estf[i].length, estf[i].length); in am65_cpts_resume()
1315 am65_cpts_write32(cpts, cpts->sr_estf[i].control, estf[i].control); in am65_cpts_resume()
1316 am65_cpts_write32(cpts, cpts->sr_estf[i].ppm_hi, estf[i].ppm_hi); in am65_cpts_resume()
1317 am65_cpts_write32(cpts, cpts->sr_estf[i].ppm_low, estf[i].ppm_low); in am65_cpts_resume()
1324 struct device_node *node = pdev->dev.of_node; in am65_cpts_probe()
1325 struct device *dev = &pdev->dev; in am65_cpts_probe()
1338 { .compatible = "ti,am65-cpts", },
1339 { .compatible = "ti,j721e-cpts", },
1347 .name = "am65-cpts",