Lines Matching +full:tx +full:- +full:delay +full:- +full:ps
1 // SPDX-License-Identifier: GPL-2.0-or-later
19 #define SKB_PTP_TYPE(__skb) (*(unsigned int *)((__skb)->cb))
24 if (!chip->info->ops->avb_ops->port_ptp_read)
25 return -EOPNOTSUPP;
27 return chip->info->ops->avb_ops->port_ptp_read(chip, port, addr,
34 if (!chip->info->ops->avb_ops->port_ptp_write)
35 return -EOPNOTSUPP;
37 return chip->info->ops->avb_ops->port_ptp_write(chip, port, addr,
44 if (!chip->info->ops->avb_ops->ptp_write)
45 return -EOPNOTSUPP;
47 return chip->info->ops->avb_ops->ptp_write(chip, addr, data);
53 if (!chip->info->ops->avb_ops->ptp_read)
54 return -EOPNOTSUPP;
56 return chip->info->ops->avb_ops->ptp_read(chip, addr, data, 1);
59 /* TX_TSTAMP_TIMEOUT: This limits the time spent polling for a TX
72 chip = ds->priv;
73 ptp_ops = chip->info->ops->ptp_ops;
75 if (!chip->info->ptp_support)
76 return -EOPNOTSUPP;
78 info->so_timestamping =
82 info->phc_index = ptp_clock_index(chip->ptp_clock);
83 info->tx_types =
86 info->rx_filters = ptp_ops->rx_filters;
94 const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
95 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
98 /* Prevent the TX/RX paths from trying to interact with the
101 clear_bit_unlock(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state);
103 switch (config->tx_type) {
111 return -ERANGE;
118 if (!(BIT(config->rx_filter) & ptp_ops->rx_filters)) {
119 config->rx_filter = HWTSTAMP_FILTER_NONE;
120 dev_dbg(chip->dev, "Unsupported rx_filter %d\n",
121 config->rx_filter);
122 return -ERANGE;
125 switch (config->rx_filter) {
138 config->rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT;
142 config->rx_filter = HWTSTAMP_FILTER_NONE;
143 return -ERANGE;
148 chip->enable_count += 1;
149 if (chip->enable_count == 1 && ptp_ops->global_enable)
150 ptp_ops->global_enable(chip);
151 if (ptp_ops->port_enable)
152 ptp_ops->port_enable(chip, port);
154 if (ptp_ops->port_disable)
155 ptp_ops->port_disable(chip, port);
156 chip->enable_count -= 1;
157 if (chip->enable_count == 0 && ptp_ops->global_disable)
158 ptp_ops->global_disable(chip);
163 * in the RX/TX paths.
166 set_bit(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state);
175 struct mv88e6xxx_chip *chip = ds->priv;
176 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
179 if (!chip->info->ptp_support)
180 return -EOPNOTSUPP;
187 ps->tstamp_config = *config;
195 struct mv88e6xxx_chip *chip = ds->priv;
196 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
198 if (!chip->info->ptp_support)
199 return -EOPNOTSUPP;
201 *config = ps->tstamp_config;
213 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
216 if (!chip->info->ptp_support)
223 if (!test_bit(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state))
245 return ts_seqid == ntohs(hdr->sequence_id);
249 struct mv88e6xxx_port_hwtstamp *ps,
262 spin_lock_irqsave(&rxq->lock, flags);
264 spin_unlock_irqrestore(&rxq->lock, flags);
267 err = mv88e6xxx_port_ptp_read(chip, ps->port_id,
280 err = mv88e6xxx_port_ptp_write(chip, ps->port_id, reg, 0);
293 ns = timecounter_cyc2time(&chip->tstamp_tc, ns);
297 shwt->hwtstamp = ns_to_ktime(ns);
305 struct mv88e6xxx_port_hwtstamp *ps)
307 const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
310 skb = skb_dequeue(&ps->rx_queue);
313 mv88e6xxx_get_rxts(chip, ps, skb, ptp_ops->arr0_sts_reg,
314 &ps->rx_queue);
316 skb = skb_dequeue(&ps->rx_queue2);
318 mv88e6xxx_get_rxts(chip, ps, skb, ptp_ops->arr1_sts_reg,
319 &ps->rx_queue2);
324 return (hdr->tsmt & 0xf) == 3;
330 struct mv88e6xxx_port_hwtstamp *ps;
334 chip = ds->priv;
335 ps = &chip->port_hwtstamp[port];
337 if (ps->tstamp_config.rx_filter != HWTSTAMP_FILTER_PTP_V2_EVENT)
347 skb_queue_tail(&ps->rx_queue2, skb);
349 skb_queue_tail(&ps->rx_queue, skb);
351 ptp_schedule_worker(chip->ptp_clock, 0);
357 struct mv88e6xxx_port_hwtstamp *ps)
359 const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
367 if (!ps->tx_skb)
371 err = mv88e6xxx_port_ptp_read(chip, ps->port_id,
372 ptp_ops->dep_sts_reg,
381 if (time_is_before_jiffies(ps->tx_tstamp_start +
383 dev_warn(chip->dev, "p%d: clearing tx timestamp hang\n",
384 ps->port_id);
396 mv88e6xxx_port_ptp_write(chip, ps->port_id, ptp_ops->dep_sts_reg, 0);
401 dev_warn(chip->dev, "p%d: tx timestamp overrun\n", ps->port_id);
405 if (departure_block[3] != ps->tx_seq_id) {
406 dev_warn(chip->dev, "p%d: unexpected seq. id\n", ps->port_id);
413 ns = timecounter_cyc2time(&chip->tstamp_tc, time_raw);
417 dev_dbg(chip->dev,
419 ps->port_id, ktime_to_ns(shhwtstamps.hwtstamp),
420 departure_block[0], ps->tx_seq_id, departure_block[3]);
423 * another timestamp-able transmit. We have to be ready for it
424 * -- by clearing the ps->tx_skb "flag" -- beforehand.
427 tmp_skb = ps->tx_skb;
428 ps->tx_skb = NULL;
429 clear_bit_unlock(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state);
435 dev_kfree_skb_any(ps->tx_skb);
436 ps->tx_skb = NULL;
437 clear_bit_unlock(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state);
445 struct dsa_switch *ds = chip->ds;
446 struct mv88e6xxx_port_hwtstamp *ps;
449 for (i = 0; i < ds->num_ports; i++) {
453 ps = &chip->port_hwtstamp[i];
454 if (test_bit(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state))
455 restart |= mv88e6xxx_txtstamp_work(chip, ps);
457 mv88e6xxx_rxtstamp_work(chip, ps);
460 return restart ? 1 : -1;
466 struct mv88e6xxx_chip *chip = ds->priv;
467 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
485 &ps->state)) {
490 ps->tx_skb = clone;
491 ps->tx_tstamp_start = jiffies;
492 ps->tx_seq_id = be16_to_cpu(hdr->sequence_id);
494 ptp_schedule_worker(chip->ptp_clock, 0);
538 const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
539 struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
541 ps->port_id = port;
543 skb_queue_head_init(&ps->rx_queue);
544 skb_queue_head_init(&ps->rx_queue2);
546 if (ptp_ops->port_disable)
547 return ptp_ops->port_disable(chip, port);
554 const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
566 if (ptp_ops->global_disable) {
567 err = ptp_ops->global_disable(chip);
579 * but the timestamp config is per-port; thus we configure all events
587 /* Use ARRIVAL1 for peer delay response messages. */
597 if (chip->info->family == MV88E6XXX_FAMILY_6341) {