12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2c6fe0ad2SBrandon Streiff /*
3c6fe0ad2SBrandon Streiff * Marvell 88E6xxx Switch hardware timestamping support
4c6fe0ad2SBrandon Streiff *
5c6fe0ad2SBrandon Streiff * Copyright (c) 2008 Marvell Semiconductor
6c6fe0ad2SBrandon Streiff *
7c6fe0ad2SBrandon Streiff * Copyright (c) 2017 National Instruments
8c6fe0ad2SBrandon Streiff * Erik Hons <erik.hons@ni.com>
9c6fe0ad2SBrandon Streiff * Brandon Streiff <brandon.streiff@ni.com>
10c6fe0ad2SBrandon Streiff * Dane Wagner <dane.wagner@ni.com>
11c6fe0ad2SBrandon Streiff */
12c6fe0ad2SBrandon Streiff
13c6fe0ad2SBrandon Streiff #include "chip.h"
14c6fe0ad2SBrandon Streiff #include "global2.h"
15c6fe0ad2SBrandon Streiff #include "hwtstamp.h"
16c6fe0ad2SBrandon Streiff #include "ptp.h"
17c6fe0ad2SBrandon Streiff #include <linux/ptp_classify.h>
18c6fe0ad2SBrandon Streiff
19c6fe0ad2SBrandon Streiff #define SKB_PTP_TYPE(__skb) (*(unsigned int *)((__skb)->cb))
20c6fe0ad2SBrandon Streiff
mv88e6xxx_port_ptp_read(struct mv88e6xxx_chip * chip,int port,int addr,u16 * data,int len)21c6fe0ad2SBrandon Streiff static int mv88e6xxx_port_ptp_read(struct mv88e6xxx_chip *chip, int port,
22c6fe0ad2SBrandon Streiff int addr, u16 *data, int len)
23c6fe0ad2SBrandon Streiff {
24c6fe0ad2SBrandon Streiff if (!chip->info->ops->avb_ops->port_ptp_read)
25c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
26c6fe0ad2SBrandon Streiff
27c6fe0ad2SBrandon Streiff return chip->info->ops->avb_ops->port_ptp_read(chip, port, addr,
28c6fe0ad2SBrandon Streiff data, len);
29c6fe0ad2SBrandon Streiff }
30c6fe0ad2SBrandon Streiff
mv88e6xxx_port_ptp_write(struct mv88e6xxx_chip * chip,int port,int addr,u16 data)31c6fe0ad2SBrandon Streiff static int mv88e6xxx_port_ptp_write(struct mv88e6xxx_chip *chip, int port,
32c6fe0ad2SBrandon Streiff int addr, u16 data)
33c6fe0ad2SBrandon Streiff {
34c6fe0ad2SBrandon Streiff if (!chip->info->ops->avb_ops->port_ptp_write)
35c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
36c6fe0ad2SBrandon Streiff
37c6fe0ad2SBrandon Streiff return chip->info->ops->avb_ops->port_ptp_write(chip, port, addr,
38c6fe0ad2SBrandon Streiff data);
39c6fe0ad2SBrandon Streiff }
40c6fe0ad2SBrandon Streiff
mv88e6xxx_ptp_write(struct mv88e6xxx_chip * chip,int addr,u16 data)41c6fe0ad2SBrandon Streiff static int mv88e6xxx_ptp_write(struct mv88e6xxx_chip *chip, int addr,
42c6fe0ad2SBrandon Streiff u16 data)
43c6fe0ad2SBrandon Streiff {
44c6fe0ad2SBrandon Streiff if (!chip->info->ops->avb_ops->ptp_write)
45c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
46c6fe0ad2SBrandon Streiff
47c6fe0ad2SBrandon Streiff return chip->info->ops->avb_ops->ptp_write(chip, addr, data);
48c6fe0ad2SBrandon Streiff }
49c6fe0ad2SBrandon Streiff
mv88e6xxx_ptp_read(struct mv88e6xxx_chip * chip,int addr,u16 * data)50e2294a8bSAndrew Lunn static int mv88e6xxx_ptp_read(struct mv88e6xxx_chip *chip, int addr,
51e2294a8bSAndrew Lunn u16 *data)
52e2294a8bSAndrew Lunn {
53e2294a8bSAndrew Lunn if (!chip->info->ops->avb_ops->ptp_read)
54e2294a8bSAndrew Lunn return -EOPNOTSUPP;
55e2294a8bSAndrew Lunn
56e2294a8bSAndrew Lunn return chip->info->ops->avb_ops->ptp_read(chip, addr, data, 1);
57e2294a8bSAndrew Lunn }
58e2294a8bSAndrew Lunn
59c6fe0ad2SBrandon Streiff /* TX_TSTAMP_TIMEOUT: This limits the time spent polling for a TX
60c6fe0ad2SBrandon Streiff * timestamp. When working properly, hardware will produce a timestamp
61c6fe0ad2SBrandon Streiff * within 1ms. Software may enounter delays due to MDIO contention, so
62c6fe0ad2SBrandon Streiff * the timeout is set accordingly.
63c6fe0ad2SBrandon Streiff */
64df31b74cSAndrew Lunn #define TX_TSTAMP_TIMEOUT msecs_to_jiffies(40)
65c6fe0ad2SBrandon Streiff
mv88e6xxx_get_ts_info(struct dsa_switch * ds,int port,struct ethtool_ts_info * info)66c6fe0ad2SBrandon Streiff int mv88e6xxx_get_ts_info(struct dsa_switch *ds, int port,
67c6fe0ad2SBrandon Streiff struct ethtool_ts_info *info)
68c6fe0ad2SBrandon Streiff {
6948cb5e03SAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops;
7048cb5e03SAndrew Lunn struct mv88e6xxx_chip *chip;
7148cb5e03SAndrew Lunn
7248cb5e03SAndrew Lunn chip = ds->priv;
7348cb5e03SAndrew Lunn ptp_ops = chip->info->ops->ptp_ops;
74c6fe0ad2SBrandon Streiff
75c6fe0ad2SBrandon Streiff if (!chip->info->ptp_support)
76c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
77c6fe0ad2SBrandon Streiff
78c6fe0ad2SBrandon Streiff info->so_timestamping =
79c6fe0ad2SBrandon Streiff SOF_TIMESTAMPING_TX_HARDWARE |
80c6fe0ad2SBrandon Streiff SOF_TIMESTAMPING_RX_HARDWARE |
81c6fe0ad2SBrandon Streiff SOF_TIMESTAMPING_RAW_HARDWARE;
82c6fe0ad2SBrandon Streiff info->phc_index = ptp_clock_index(chip->ptp_clock);
83c6fe0ad2SBrandon Streiff info->tx_types =
84c6fe0ad2SBrandon Streiff (1 << HWTSTAMP_TX_OFF) |
85c6fe0ad2SBrandon Streiff (1 << HWTSTAMP_TX_ON);
8648cb5e03SAndrew Lunn info->rx_filters = ptp_ops->rx_filters;
87c6fe0ad2SBrandon Streiff
88c6fe0ad2SBrandon Streiff return 0;
89c6fe0ad2SBrandon Streiff }
90c6fe0ad2SBrandon Streiff
mv88e6xxx_set_hwtstamp_config(struct mv88e6xxx_chip * chip,int port,struct hwtstamp_config * config)91c6fe0ad2SBrandon Streiff static int mv88e6xxx_set_hwtstamp_config(struct mv88e6xxx_chip *chip, int port,
92c6fe0ad2SBrandon Streiff struct hwtstamp_config *config)
93c6fe0ad2SBrandon Streiff {
94ffc705deSAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
95c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
96c6fe0ad2SBrandon Streiff bool tstamp_enable = false;
97c6fe0ad2SBrandon Streiff
98c6fe0ad2SBrandon Streiff /* Prevent the TX/RX paths from trying to interact with the
99c6fe0ad2SBrandon Streiff * timestamp hardware while we reconfigure it.
100c6fe0ad2SBrandon Streiff */
101c6fe0ad2SBrandon Streiff clear_bit_unlock(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state);
102c6fe0ad2SBrandon Streiff
103c6fe0ad2SBrandon Streiff switch (config->tx_type) {
104c6fe0ad2SBrandon Streiff case HWTSTAMP_TX_OFF:
105c6fe0ad2SBrandon Streiff tstamp_enable = false;
106c6fe0ad2SBrandon Streiff break;
107c6fe0ad2SBrandon Streiff case HWTSTAMP_TX_ON:
108c6fe0ad2SBrandon Streiff tstamp_enable = true;
109c6fe0ad2SBrandon Streiff break;
110c6fe0ad2SBrandon Streiff default:
111c6fe0ad2SBrandon Streiff return -ERANGE;
112c6fe0ad2SBrandon Streiff }
113c6fe0ad2SBrandon Streiff
114c6fe0ad2SBrandon Streiff /* The switch supports timestamping both L2 and L4; one cannot be
115c6fe0ad2SBrandon Streiff * disabled independently of the other.
116c6fe0ad2SBrandon Streiff */
11748cb5e03SAndrew Lunn
11848cb5e03SAndrew Lunn if (!(BIT(config->rx_filter) & ptp_ops->rx_filters)) {
11948cb5e03SAndrew Lunn config->rx_filter = HWTSTAMP_FILTER_NONE;
12048cb5e03SAndrew Lunn dev_dbg(chip->dev, "Unsupported rx_filter %d\n",
12148cb5e03SAndrew Lunn config->rx_filter);
12248cb5e03SAndrew Lunn return -ERANGE;
12348cb5e03SAndrew Lunn }
12448cb5e03SAndrew Lunn
125c6fe0ad2SBrandon Streiff switch (config->rx_filter) {
126c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_NONE:
127c6fe0ad2SBrandon Streiff tstamp_enable = false;
128c6fe0ad2SBrandon Streiff break;
129c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L4_EVENT:
130c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L4_SYNC:
131c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ:
132c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L2_EVENT:
133c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L2_SYNC:
134c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ:
135c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_EVENT:
136c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_SYNC:
137c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ:
138c6fe0ad2SBrandon Streiff config->rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT;
139c6fe0ad2SBrandon Streiff break;
140c6fe0ad2SBrandon Streiff case HWTSTAMP_FILTER_ALL:
141c6fe0ad2SBrandon Streiff default:
142c6fe0ad2SBrandon Streiff config->rx_filter = HWTSTAMP_FILTER_NONE;
143c6fe0ad2SBrandon Streiff return -ERANGE;
144c6fe0ad2SBrandon Streiff }
145c6fe0ad2SBrandon Streiff
146c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
147ffc705deSAndrew Lunn if (tstamp_enable) {
148e2294a8bSAndrew Lunn chip->enable_count += 1;
149e2294a8bSAndrew Lunn if (chip->enable_count == 1 && ptp_ops->global_enable)
150e2294a8bSAndrew Lunn ptp_ops->global_enable(chip);
151ffc705deSAndrew Lunn if (ptp_ops->port_enable)
152ffc705deSAndrew Lunn ptp_ops->port_enable(chip, port);
153ffc705deSAndrew Lunn } else {
154ffc705deSAndrew Lunn if (ptp_ops->port_disable)
155ffc705deSAndrew Lunn ptp_ops->port_disable(chip, port);
156e2294a8bSAndrew Lunn chip->enable_count -= 1;
157e2294a8bSAndrew Lunn if (chip->enable_count == 0 && ptp_ops->global_disable)
158e2294a8bSAndrew Lunn ptp_ops->global_disable(chip);
159ffc705deSAndrew Lunn }
160c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
161c6fe0ad2SBrandon Streiff
162c6fe0ad2SBrandon Streiff /* Once hardware has been configured, enable timestamp checks
163c6fe0ad2SBrandon Streiff * in the RX/TX paths.
164c6fe0ad2SBrandon Streiff */
165c6fe0ad2SBrandon Streiff if (tstamp_enable)
166c6fe0ad2SBrandon Streiff set_bit(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state);
167c6fe0ad2SBrandon Streiff
168c6fe0ad2SBrandon Streiff return 0;
169c6fe0ad2SBrandon Streiff }
170c6fe0ad2SBrandon Streiff
mv88e6xxx_port_hwtstamp_set(struct dsa_switch * ds,int port,struct ifreq * ifr)171c6fe0ad2SBrandon Streiff int mv88e6xxx_port_hwtstamp_set(struct dsa_switch *ds, int port,
172c6fe0ad2SBrandon Streiff struct ifreq *ifr)
173c6fe0ad2SBrandon Streiff {
174c6fe0ad2SBrandon Streiff struct mv88e6xxx_chip *chip = ds->priv;
175c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
176c6fe0ad2SBrandon Streiff struct hwtstamp_config config;
177c6fe0ad2SBrandon Streiff int err;
178c6fe0ad2SBrandon Streiff
179c6fe0ad2SBrandon Streiff if (!chip->info->ptp_support)
180c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
181c6fe0ad2SBrandon Streiff
182c6fe0ad2SBrandon Streiff if (copy_from_user(&config, ifr->ifr_data, sizeof(config)))
183c6fe0ad2SBrandon Streiff return -EFAULT;
184c6fe0ad2SBrandon Streiff
185c6fe0ad2SBrandon Streiff err = mv88e6xxx_set_hwtstamp_config(chip, port, &config);
186c6fe0ad2SBrandon Streiff if (err)
187c6fe0ad2SBrandon Streiff return err;
188c6fe0ad2SBrandon Streiff
189c6fe0ad2SBrandon Streiff /* Save the chosen configuration to be returned later. */
190c6fe0ad2SBrandon Streiff memcpy(&ps->tstamp_config, &config, sizeof(config));
191c6fe0ad2SBrandon Streiff
192c6fe0ad2SBrandon Streiff return copy_to_user(ifr->ifr_data, &config, sizeof(config)) ?
193c6fe0ad2SBrandon Streiff -EFAULT : 0;
194c6fe0ad2SBrandon Streiff }
195c6fe0ad2SBrandon Streiff
mv88e6xxx_port_hwtstamp_get(struct dsa_switch * ds,int port,struct ifreq * ifr)196c6fe0ad2SBrandon Streiff int mv88e6xxx_port_hwtstamp_get(struct dsa_switch *ds, int port,
197c6fe0ad2SBrandon Streiff struct ifreq *ifr)
198c6fe0ad2SBrandon Streiff {
199c6fe0ad2SBrandon Streiff struct mv88e6xxx_chip *chip = ds->priv;
200c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
201c6fe0ad2SBrandon Streiff struct hwtstamp_config *config = &ps->tstamp_config;
202c6fe0ad2SBrandon Streiff
203c6fe0ad2SBrandon Streiff if (!chip->info->ptp_support)
204c6fe0ad2SBrandon Streiff return -EOPNOTSUPP;
205c6fe0ad2SBrandon Streiff
206c6fe0ad2SBrandon Streiff return copy_to_user(ifr->ifr_data, config, sizeof(*config)) ?
207c6fe0ad2SBrandon Streiff -EFAULT : 0;
208c6fe0ad2SBrandon Streiff }
209c6fe0ad2SBrandon Streiff
210c6fe0ad2SBrandon Streiff /* Returns a pointer to the PTP header if the caller should time stamp,
211c6fe0ad2SBrandon Streiff * or NULL if the caller should not.
212c6fe0ad2SBrandon Streiff */
mv88e6xxx_should_tstamp(struct mv88e6xxx_chip * chip,int port,struct sk_buff * skb,unsigned int type)21328fba67fSKurt Kanzenbach static struct ptp_header *mv88e6xxx_should_tstamp(struct mv88e6xxx_chip *chip,
21428fba67fSKurt Kanzenbach int port, struct sk_buff *skb,
21528fba67fSKurt Kanzenbach unsigned int type)
216c6fe0ad2SBrandon Streiff {
217c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
21828fba67fSKurt Kanzenbach struct ptp_header *hdr;
219c6fe0ad2SBrandon Streiff
220c6fe0ad2SBrandon Streiff if (!chip->info->ptp_support)
221c6fe0ad2SBrandon Streiff return NULL;
222c6fe0ad2SBrandon Streiff
22328fba67fSKurt Kanzenbach hdr = ptp_parse_header(skb, type);
224c6fe0ad2SBrandon Streiff if (!hdr)
225c6fe0ad2SBrandon Streiff return NULL;
226c6fe0ad2SBrandon Streiff
227c6fe0ad2SBrandon Streiff if (!test_bit(MV88E6XXX_HWTSTAMP_ENABLED, &ps->state))
228c6fe0ad2SBrandon Streiff return NULL;
229c6fe0ad2SBrandon Streiff
230c6fe0ad2SBrandon Streiff return hdr;
231c6fe0ad2SBrandon Streiff }
232c6fe0ad2SBrandon Streiff
mv88e6xxx_ts_valid(u16 status)233c6fe0ad2SBrandon Streiff static int mv88e6xxx_ts_valid(u16 status)
234c6fe0ad2SBrandon Streiff {
235c6fe0ad2SBrandon Streiff if (!(status & MV88E6XXX_PTP_TS_VALID))
236c6fe0ad2SBrandon Streiff return 0;
237c6fe0ad2SBrandon Streiff if (status & MV88E6XXX_PTP_TS_STATUS_MASK)
238c6fe0ad2SBrandon Streiff return 0;
239c6fe0ad2SBrandon Streiff return 1;
240c6fe0ad2SBrandon Streiff }
241c6fe0ad2SBrandon Streiff
seq_match(struct sk_buff * skb,u16 ts_seqid)242c6fe0ad2SBrandon Streiff static int seq_match(struct sk_buff *skb, u16 ts_seqid)
243c6fe0ad2SBrandon Streiff {
244c6fe0ad2SBrandon Streiff unsigned int type = SKB_PTP_TYPE(skb);
24528fba67fSKurt Kanzenbach struct ptp_header *hdr;
246c6fe0ad2SBrandon Streiff
24728fba67fSKurt Kanzenbach hdr = ptp_parse_header(skb, type);
248c6fe0ad2SBrandon Streiff
24928fba67fSKurt Kanzenbach return ts_seqid == ntohs(hdr->sequence_id);
250c6fe0ad2SBrandon Streiff }
251c6fe0ad2SBrandon Streiff
mv88e6xxx_get_rxts(struct mv88e6xxx_chip * chip,struct mv88e6xxx_port_hwtstamp * ps,struct sk_buff * skb,u16 reg,struct sk_buff_head * rxq)252c6fe0ad2SBrandon Streiff static void mv88e6xxx_get_rxts(struct mv88e6xxx_chip *chip,
253c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps,
254c6fe0ad2SBrandon Streiff struct sk_buff *skb, u16 reg,
255c6fe0ad2SBrandon Streiff struct sk_buff_head *rxq)
256c6fe0ad2SBrandon Streiff {
257b2d12101SColin Ian King u16 buf[4] = { 0 }, status, seq_id;
258c6fe0ad2SBrandon Streiff struct skb_shared_hwtstamps *shwt;
25922904823SRichard Cochran struct sk_buff_head received;
26022904823SRichard Cochran u64 ns, timelo, timehi;
26122904823SRichard Cochran unsigned long flags;
262c6fe0ad2SBrandon Streiff int err;
263c6fe0ad2SBrandon Streiff
26422904823SRichard Cochran /* The latched timestamp belongs to one of the received frames. */
26522904823SRichard Cochran __skb_queue_head_init(&received);
26622904823SRichard Cochran spin_lock_irqsave(&rxq->lock, flags);
26722904823SRichard Cochran skb_queue_splice_tail_init(rxq, &received);
26822904823SRichard Cochran spin_unlock_irqrestore(&rxq->lock, flags);
26922904823SRichard Cochran
270c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
271c6fe0ad2SBrandon Streiff err = mv88e6xxx_port_ptp_read(chip, ps->port_id,
272c6fe0ad2SBrandon Streiff reg, buf, ARRAY_SIZE(buf));
273c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
274c6fe0ad2SBrandon Streiff if (err)
275c6fe0ad2SBrandon Streiff pr_err("failed to get the receive time stamp\n");
276c6fe0ad2SBrandon Streiff
277c6fe0ad2SBrandon Streiff status = buf[0];
278c6fe0ad2SBrandon Streiff timelo = buf[1];
279c6fe0ad2SBrandon Streiff timehi = buf[2];
280c6fe0ad2SBrandon Streiff seq_id = buf[3];
281c6fe0ad2SBrandon Streiff
282c6fe0ad2SBrandon Streiff if (status & MV88E6XXX_PTP_TS_VALID) {
283c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
284c6fe0ad2SBrandon Streiff err = mv88e6xxx_port_ptp_write(chip, ps->port_id, reg, 0);
285c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
286c6fe0ad2SBrandon Streiff if (err)
287c6fe0ad2SBrandon Streiff pr_err("failed to clear the receive status\n");
288c6fe0ad2SBrandon Streiff }
289c6fe0ad2SBrandon Streiff /* Since the device can only handle one time stamp at a time,
290c6fe0ad2SBrandon Streiff * we purge any extra frames from the queue.
291c6fe0ad2SBrandon Streiff */
29222904823SRichard Cochran for ( ; skb; skb = __skb_dequeue(&received)) {
293c6fe0ad2SBrandon Streiff if (mv88e6xxx_ts_valid(status) && seq_match(skb, seq_id)) {
294b2d12101SColin Ian King ns = timehi << 16 | timelo;
295c6fe0ad2SBrandon Streiff
296c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
297c6fe0ad2SBrandon Streiff ns = timecounter_cyc2time(&chip->tstamp_tc, ns);
298c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
299c6fe0ad2SBrandon Streiff shwt = skb_hwtstamps(skb);
300c6fe0ad2SBrandon Streiff memset(shwt, 0, sizeof(*shwt));
301c6fe0ad2SBrandon Streiff shwt->hwtstamp = ns_to_ktime(ns);
302c6fe0ad2SBrandon Streiff status &= ~MV88E6XXX_PTP_TS_VALID;
303c6fe0ad2SBrandon Streiff }
304*db00cc9dSSebastian Andrzej Siewior netif_rx(skb);
305c6fe0ad2SBrandon Streiff }
306c6fe0ad2SBrandon Streiff }
307c6fe0ad2SBrandon Streiff
mv88e6xxx_rxtstamp_work(struct mv88e6xxx_chip * chip,struct mv88e6xxx_port_hwtstamp * ps)308c6fe0ad2SBrandon Streiff static void mv88e6xxx_rxtstamp_work(struct mv88e6xxx_chip *chip,
309c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps)
310c6fe0ad2SBrandon Streiff {
311ffc705deSAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
312c6fe0ad2SBrandon Streiff struct sk_buff *skb;
313c6fe0ad2SBrandon Streiff
314c6fe0ad2SBrandon Streiff skb = skb_dequeue(&ps->rx_queue);
315c6fe0ad2SBrandon Streiff
316c6fe0ad2SBrandon Streiff if (skb)
317ffc705deSAndrew Lunn mv88e6xxx_get_rxts(chip, ps, skb, ptp_ops->arr0_sts_reg,
318c6fe0ad2SBrandon Streiff &ps->rx_queue);
319c6fe0ad2SBrandon Streiff
320c6fe0ad2SBrandon Streiff skb = skb_dequeue(&ps->rx_queue2);
321c6fe0ad2SBrandon Streiff if (skb)
322ffc705deSAndrew Lunn mv88e6xxx_get_rxts(chip, ps, skb, ptp_ops->arr1_sts_reg,
323c6fe0ad2SBrandon Streiff &ps->rx_queue2);
324c6fe0ad2SBrandon Streiff }
325c6fe0ad2SBrandon Streiff
is_pdelay_resp(const struct ptp_header * hdr)32628fba67fSKurt Kanzenbach static int is_pdelay_resp(const struct ptp_header *hdr)
327c6fe0ad2SBrandon Streiff {
32828fba67fSKurt Kanzenbach return (hdr->tsmt & 0xf) == 3;
329c6fe0ad2SBrandon Streiff }
330c6fe0ad2SBrandon Streiff
mv88e6xxx_port_rxtstamp(struct dsa_switch * ds,int port,struct sk_buff * skb,unsigned int type)331c6fe0ad2SBrandon Streiff bool mv88e6xxx_port_rxtstamp(struct dsa_switch *ds, int port,
332c6fe0ad2SBrandon Streiff struct sk_buff *skb, unsigned int type)
333c6fe0ad2SBrandon Streiff {
334c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps;
335c6fe0ad2SBrandon Streiff struct mv88e6xxx_chip *chip;
33628fba67fSKurt Kanzenbach struct ptp_header *hdr;
337c6fe0ad2SBrandon Streiff
338c6fe0ad2SBrandon Streiff chip = ds->priv;
339c6fe0ad2SBrandon Streiff ps = &chip->port_hwtstamp[port];
340c6fe0ad2SBrandon Streiff
341c6fe0ad2SBrandon Streiff if (ps->tstamp_config.rx_filter != HWTSTAMP_FILTER_PTP_V2_EVENT)
342c6fe0ad2SBrandon Streiff return false;
343c6fe0ad2SBrandon Streiff
344c6fe0ad2SBrandon Streiff hdr = mv88e6xxx_should_tstamp(chip, port, skb, type);
345c6fe0ad2SBrandon Streiff if (!hdr)
346c6fe0ad2SBrandon Streiff return false;
347c6fe0ad2SBrandon Streiff
348c6fe0ad2SBrandon Streiff SKB_PTP_TYPE(skb) = type;
349c6fe0ad2SBrandon Streiff
350c6fe0ad2SBrandon Streiff if (is_pdelay_resp(hdr))
351c6fe0ad2SBrandon Streiff skb_queue_tail(&ps->rx_queue2, skb);
352c6fe0ad2SBrandon Streiff else
353c6fe0ad2SBrandon Streiff skb_queue_tail(&ps->rx_queue, skb);
354c6fe0ad2SBrandon Streiff
355c6fe0ad2SBrandon Streiff ptp_schedule_worker(chip->ptp_clock, 0);
356c6fe0ad2SBrandon Streiff
357c6fe0ad2SBrandon Streiff return true;
358c6fe0ad2SBrandon Streiff }
359c6fe0ad2SBrandon Streiff
mv88e6xxx_txtstamp_work(struct mv88e6xxx_chip * chip,struct mv88e6xxx_port_hwtstamp * ps)360c6fe0ad2SBrandon Streiff static int mv88e6xxx_txtstamp_work(struct mv88e6xxx_chip *chip,
361c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps)
362c6fe0ad2SBrandon Streiff {
363ffc705deSAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
364c6fe0ad2SBrandon Streiff struct skb_shared_hwtstamps shhwtstamps;
365c6fe0ad2SBrandon Streiff u16 departure_block[4], status;
366c6fe0ad2SBrandon Streiff struct sk_buff *tmp_skb;
367c6fe0ad2SBrandon Streiff u32 time_raw;
368c6fe0ad2SBrandon Streiff int err;
369c6fe0ad2SBrandon Streiff u64 ns;
370c6fe0ad2SBrandon Streiff
371c6fe0ad2SBrandon Streiff if (!ps->tx_skb)
372c6fe0ad2SBrandon Streiff return 0;
373c6fe0ad2SBrandon Streiff
374c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
375c6fe0ad2SBrandon Streiff err = mv88e6xxx_port_ptp_read(chip, ps->port_id,
376ffc705deSAndrew Lunn ptp_ops->dep_sts_reg,
377c6fe0ad2SBrandon Streiff departure_block,
378c6fe0ad2SBrandon Streiff ARRAY_SIZE(departure_block));
379c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
380c6fe0ad2SBrandon Streiff
381c6fe0ad2SBrandon Streiff if (err)
382c6fe0ad2SBrandon Streiff goto free_and_clear_skb;
383c6fe0ad2SBrandon Streiff
384c6fe0ad2SBrandon Streiff if (!(departure_block[0] & MV88E6XXX_PTP_TS_VALID)) {
385c6fe0ad2SBrandon Streiff if (time_is_before_jiffies(ps->tx_tstamp_start +
386c6fe0ad2SBrandon Streiff TX_TSTAMP_TIMEOUT)) {
387c6fe0ad2SBrandon Streiff dev_warn(chip->dev, "p%d: clearing tx timestamp hang\n",
388c6fe0ad2SBrandon Streiff ps->port_id);
389c6fe0ad2SBrandon Streiff goto free_and_clear_skb;
390c6fe0ad2SBrandon Streiff }
391c6fe0ad2SBrandon Streiff /* The timestamp should be available quickly, while getting it
392c6fe0ad2SBrandon Streiff * is high priority and time bounded to only 10ms. A poll is
393c6fe0ad2SBrandon Streiff * warranted so restart the work.
394c6fe0ad2SBrandon Streiff */
395c6fe0ad2SBrandon Streiff return 1;
396c6fe0ad2SBrandon Streiff }
397c6fe0ad2SBrandon Streiff
398c6fe0ad2SBrandon Streiff /* We have the timestamp; go ahead and clear valid now */
399c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
400ffc705deSAndrew Lunn mv88e6xxx_port_ptp_write(chip, ps->port_id, ptp_ops->dep_sts_reg, 0);
401c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
402c6fe0ad2SBrandon Streiff
403c6fe0ad2SBrandon Streiff status = departure_block[0] & MV88E6XXX_PTP_TS_STATUS_MASK;
404c6fe0ad2SBrandon Streiff if (status != MV88E6XXX_PTP_TS_STATUS_NORMAL) {
405c6fe0ad2SBrandon Streiff dev_warn(chip->dev, "p%d: tx timestamp overrun\n", ps->port_id);
406c6fe0ad2SBrandon Streiff goto free_and_clear_skb;
407c6fe0ad2SBrandon Streiff }
408c6fe0ad2SBrandon Streiff
409c6fe0ad2SBrandon Streiff if (departure_block[3] != ps->tx_seq_id) {
410c6fe0ad2SBrandon Streiff dev_warn(chip->dev, "p%d: unexpected seq. id\n", ps->port_id);
411c6fe0ad2SBrandon Streiff goto free_and_clear_skb;
412c6fe0ad2SBrandon Streiff }
413c6fe0ad2SBrandon Streiff
414c6fe0ad2SBrandon Streiff memset(&shhwtstamps, 0, sizeof(shhwtstamps));
415c6fe0ad2SBrandon Streiff time_raw = ((u32)departure_block[2] << 16) | departure_block[1];
416c9acece0SRasmus Villemoes mv88e6xxx_reg_lock(chip);
417c6fe0ad2SBrandon Streiff ns = timecounter_cyc2time(&chip->tstamp_tc, time_raw);
418c9acece0SRasmus Villemoes mv88e6xxx_reg_unlock(chip);
419c6fe0ad2SBrandon Streiff shhwtstamps.hwtstamp = ns_to_ktime(ns);
420c6fe0ad2SBrandon Streiff
421c6fe0ad2SBrandon Streiff dev_dbg(chip->dev,
422c6fe0ad2SBrandon Streiff "p%d: txtstamp %llx status 0x%04x skb ID 0x%04x hw ID 0x%04x\n",
423c6fe0ad2SBrandon Streiff ps->port_id, ktime_to_ns(shhwtstamps.hwtstamp),
424c6fe0ad2SBrandon Streiff departure_block[0], ps->tx_seq_id, departure_block[3]);
425c6fe0ad2SBrandon Streiff
426c6fe0ad2SBrandon Streiff /* skb_complete_tx_timestamp() will free up the client to make
427c6fe0ad2SBrandon Streiff * another timestamp-able transmit. We have to be ready for it
428c6fe0ad2SBrandon Streiff * -- by clearing the ps->tx_skb "flag" -- beforehand.
429c6fe0ad2SBrandon Streiff */
430c6fe0ad2SBrandon Streiff
431c6fe0ad2SBrandon Streiff tmp_skb = ps->tx_skb;
432c6fe0ad2SBrandon Streiff ps->tx_skb = NULL;
433c6fe0ad2SBrandon Streiff clear_bit_unlock(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state);
434c6fe0ad2SBrandon Streiff skb_complete_tx_timestamp(tmp_skb, &shhwtstamps);
435c6fe0ad2SBrandon Streiff
436c6fe0ad2SBrandon Streiff return 0;
437c6fe0ad2SBrandon Streiff
438c6fe0ad2SBrandon Streiff free_and_clear_skb:
439c6fe0ad2SBrandon Streiff dev_kfree_skb_any(ps->tx_skb);
440c6fe0ad2SBrandon Streiff ps->tx_skb = NULL;
441c6fe0ad2SBrandon Streiff clear_bit_unlock(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state);
442c6fe0ad2SBrandon Streiff
443c6fe0ad2SBrandon Streiff return 0;
444c6fe0ad2SBrandon Streiff }
445c6fe0ad2SBrandon Streiff
mv88e6xxx_hwtstamp_work(struct ptp_clock_info * ptp)446c6fe0ad2SBrandon Streiff long mv88e6xxx_hwtstamp_work(struct ptp_clock_info *ptp)
447c6fe0ad2SBrandon Streiff {
448c6fe0ad2SBrandon Streiff struct mv88e6xxx_chip *chip = ptp_to_chip(ptp);
449c6fe0ad2SBrandon Streiff struct dsa_switch *ds = chip->ds;
450c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps;
451c6fe0ad2SBrandon Streiff int i, restart = 0;
452c6fe0ad2SBrandon Streiff
453c6fe0ad2SBrandon Streiff for (i = 0; i < ds->num_ports; i++) {
454c6fe0ad2SBrandon Streiff if (!dsa_is_user_port(ds, i))
455c6fe0ad2SBrandon Streiff continue;
456c6fe0ad2SBrandon Streiff
457c6fe0ad2SBrandon Streiff ps = &chip->port_hwtstamp[i];
458c6fe0ad2SBrandon Streiff if (test_bit(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS, &ps->state))
459c6fe0ad2SBrandon Streiff restart |= mv88e6xxx_txtstamp_work(chip, ps);
460c6fe0ad2SBrandon Streiff
461c6fe0ad2SBrandon Streiff mv88e6xxx_rxtstamp_work(chip, ps);
462c6fe0ad2SBrandon Streiff }
463c6fe0ad2SBrandon Streiff
464c6fe0ad2SBrandon Streiff return restart ? 1 : -1;
465c6fe0ad2SBrandon Streiff }
466c6fe0ad2SBrandon Streiff
mv88e6xxx_port_txtstamp(struct dsa_switch * ds,int port,struct sk_buff * skb)4675c5416f5SYangbo Lu void mv88e6xxx_port_txtstamp(struct dsa_switch *ds, int port,
4685c5416f5SYangbo Lu struct sk_buff *skb)
469c6fe0ad2SBrandon Streiff {
470c6fe0ad2SBrandon Streiff struct mv88e6xxx_chip *chip = ds->priv;
471c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
47228fba67fSKurt Kanzenbach struct ptp_header *hdr;
4735c5416f5SYangbo Lu struct sk_buff *clone;
474cf536ea3SYangbo Lu unsigned int type;
475cf536ea3SYangbo Lu
4765c5416f5SYangbo Lu type = ptp_classify_raw(skb);
477cf536ea3SYangbo Lu if (type == PTP_CLASS_NONE)
4785c5416f5SYangbo Lu return;
479c6fe0ad2SBrandon Streiff
4805c5416f5SYangbo Lu hdr = mv88e6xxx_should_tstamp(chip, port, skb, type);
481c6fe0ad2SBrandon Streiff if (!hdr)
4825c5416f5SYangbo Lu return;
4835c5416f5SYangbo Lu
4845c5416f5SYangbo Lu clone = skb_clone_sk(skb);
4855c5416f5SYangbo Lu if (!clone)
4865c5416f5SYangbo Lu return;
487c6fe0ad2SBrandon Streiff
488c6fe0ad2SBrandon Streiff if (test_and_set_bit_lock(MV88E6XXX_HWTSTAMP_TX_IN_PROGRESS,
4895c5416f5SYangbo Lu &ps->state)) {
4905c5416f5SYangbo Lu kfree_skb(clone);
4915c5416f5SYangbo Lu return;
4925c5416f5SYangbo Lu }
493c6fe0ad2SBrandon Streiff
494c6fe0ad2SBrandon Streiff ps->tx_skb = clone;
495c6fe0ad2SBrandon Streiff ps->tx_tstamp_start = jiffies;
49628fba67fSKurt Kanzenbach ps->tx_seq_id = be16_to_cpu(hdr->sequence_id);
497c6fe0ad2SBrandon Streiff
498c6fe0ad2SBrandon Streiff ptp_schedule_worker(chip->ptp_clock, 0);
499c6fe0ad2SBrandon Streiff }
500c6fe0ad2SBrandon Streiff
mv88e6165_global_disable(struct mv88e6xxx_chip * chip)501e2294a8bSAndrew Lunn int mv88e6165_global_disable(struct mv88e6xxx_chip *chip)
502e2294a8bSAndrew Lunn {
503e2294a8bSAndrew Lunn u16 val;
504e2294a8bSAndrew Lunn int err;
505e2294a8bSAndrew Lunn
506e2294a8bSAndrew Lunn err = mv88e6xxx_ptp_read(chip, MV88E6165_PTP_CFG, &val);
507e2294a8bSAndrew Lunn if (err)
508e2294a8bSAndrew Lunn return err;
509e2294a8bSAndrew Lunn val |= MV88E6165_PTP_CFG_DISABLE_PTP;
510e2294a8bSAndrew Lunn
511e2294a8bSAndrew Lunn return mv88e6xxx_ptp_write(chip, MV88E6165_PTP_CFG, val);
512e2294a8bSAndrew Lunn }
513e2294a8bSAndrew Lunn
mv88e6165_global_enable(struct mv88e6xxx_chip * chip)514e2294a8bSAndrew Lunn int mv88e6165_global_enable(struct mv88e6xxx_chip *chip)
515e2294a8bSAndrew Lunn {
516e2294a8bSAndrew Lunn u16 val;
517e2294a8bSAndrew Lunn int err;
518e2294a8bSAndrew Lunn
519e2294a8bSAndrew Lunn err = mv88e6xxx_ptp_read(chip, MV88E6165_PTP_CFG, &val);
520e2294a8bSAndrew Lunn if (err)
521e2294a8bSAndrew Lunn return err;
522e2294a8bSAndrew Lunn
523e2294a8bSAndrew Lunn val &= ~(MV88E6165_PTP_CFG_DISABLE_PTP | MV88E6165_PTP_CFG_TSPEC_MASK);
524e2294a8bSAndrew Lunn
525e2294a8bSAndrew Lunn return mv88e6xxx_ptp_write(chip, MV88E6165_PTP_CFG, val);
526e2294a8bSAndrew Lunn }
527e2294a8bSAndrew Lunn
mv88e6352_hwtstamp_port_disable(struct mv88e6xxx_chip * chip,int port)528ffc705deSAndrew Lunn int mv88e6352_hwtstamp_port_disable(struct mv88e6xxx_chip *chip, int port)
529ffc705deSAndrew Lunn {
530ffc705deSAndrew Lunn return mv88e6xxx_port_ptp_write(chip, port, MV88E6XXX_PORT_PTP_CFG0,
531ffc705deSAndrew Lunn MV88E6XXX_PORT_PTP_CFG0_DISABLE_PTP);
532ffc705deSAndrew Lunn }
533ffc705deSAndrew Lunn
mv88e6352_hwtstamp_port_enable(struct mv88e6xxx_chip * chip,int port)534ffc705deSAndrew Lunn int mv88e6352_hwtstamp_port_enable(struct mv88e6xxx_chip *chip, int port)
535ffc705deSAndrew Lunn {
536ffc705deSAndrew Lunn return mv88e6xxx_port_ptp_write(chip, port, MV88E6XXX_PORT_PTP_CFG0,
537ffc705deSAndrew Lunn MV88E6XXX_PORT_PTP_CFG0_DISABLE_TSPEC_MATCH);
538ffc705deSAndrew Lunn }
539ffc705deSAndrew Lunn
mv88e6xxx_hwtstamp_port_setup(struct mv88e6xxx_chip * chip,int port)540c6fe0ad2SBrandon Streiff static int mv88e6xxx_hwtstamp_port_setup(struct mv88e6xxx_chip *chip, int port)
541c6fe0ad2SBrandon Streiff {
542ffc705deSAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
543c6fe0ad2SBrandon Streiff struct mv88e6xxx_port_hwtstamp *ps = &chip->port_hwtstamp[port];
544c6fe0ad2SBrandon Streiff
545c6fe0ad2SBrandon Streiff ps->port_id = port;
546c6fe0ad2SBrandon Streiff
547c6fe0ad2SBrandon Streiff skb_queue_head_init(&ps->rx_queue);
548c6fe0ad2SBrandon Streiff skb_queue_head_init(&ps->rx_queue2);
549c6fe0ad2SBrandon Streiff
550ffc705deSAndrew Lunn if (ptp_ops->port_disable)
551ffc705deSAndrew Lunn return ptp_ops->port_disable(chip, port);
552ffc705deSAndrew Lunn
553ffc705deSAndrew Lunn return 0;
554c6fe0ad2SBrandon Streiff }
555c6fe0ad2SBrandon Streiff
mv88e6xxx_hwtstamp_setup(struct mv88e6xxx_chip * chip)556c6fe0ad2SBrandon Streiff int mv88e6xxx_hwtstamp_setup(struct mv88e6xxx_chip *chip)
557c6fe0ad2SBrandon Streiff {
558e2294a8bSAndrew Lunn const struct mv88e6xxx_ptp_ops *ptp_ops = chip->info->ops->ptp_ops;
559c6fe0ad2SBrandon Streiff int err;
560c6fe0ad2SBrandon Streiff int i;
561c6fe0ad2SBrandon Streiff
562c6fe0ad2SBrandon Streiff /* Disable timestamping on all ports. */
563c6fe0ad2SBrandon Streiff for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
564c6fe0ad2SBrandon Streiff err = mv88e6xxx_hwtstamp_port_setup(chip, i);
565c6fe0ad2SBrandon Streiff if (err)
566c6fe0ad2SBrandon Streiff return err;
567c6fe0ad2SBrandon Streiff }
568c6fe0ad2SBrandon Streiff
569e2294a8bSAndrew Lunn /* Disable PTP globally */
570e2294a8bSAndrew Lunn if (ptp_ops->global_disable) {
571e2294a8bSAndrew Lunn err = ptp_ops->global_disable(chip);
572e2294a8bSAndrew Lunn if (err)
573e2294a8bSAndrew Lunn return err;
574e2294a8bSAndrew Lunn }
575e2294a8bSAndrew Lunn
5762dbed245SAndrew Lunn /* Set the ethertype of L2 PTP messages */
5772dbed245SAndrew Lunn err = mv88e6xxx_ptp_write(chip, MV88E6XXX_PTP_GC_ETYPE, ETH_P_1588);
5782dbed245SAndrew Lunn if (err)
5792dbed245SAndrew Lunn return err;
5802dbed245SAndrew Lunn
581c6fe0ad2SBrandon Streiff /* MV88E6XXX_PTP_MSG_TYPE is a mask of PTP message types to
582c6fe0ad2SBrandon Streiff * timestamp. This affects all ports that have timestamping enabled,
583c6fe0ad2SBrandon Streiff * but the timestamp config is per-port; thus we configure all events
584c6fe0ad2SBrandon Streiff * here and only support the HWTSTAMP_FILTER_*_EVENT filter types.
585c6fe0ad2SBrandon Streiff */
586c6fe0ad2SBrandon Streiff err = mv88e6xxx_ptp_write(chip, MV88E6XXX_PTP_MSGTYPE,
587c6fe0ad2SBrandon Streiff MV88E6XXX_PTP_MSGTYPE_ALL_EVENT);
588c6fe0ad2SBrandon Streiff if (err)
589c6fe0ad2SBrandon Streiff return err;
590c6fe0ad2SBrandon Streiff
591c6fe0ad2SBrandon Streiff /* Use ARRIVAL1 for peer delay response messages. */
592c6fe0ad2SBrandon Streiff err = mv88e6xxx_ptp_write(chip, MV88E6XXX_PTP_TS_ARRIVAL_PTR,
593c6fe0ad2SBrandon Streiff MV88E6XXX_PTP_MSGTYPE_PDLAY_RES);
594c6fe0ad2SBrandon Streiff if (err)
595c6fe0ad2SBrandon Streiff return err;
596c6fe0ad2SBrandon Streiff
597a2e47134SBrandon Streiff /* 88E6341 devices default to timestamping at the PHY, but this has
598a2e47134SBrandon Streiff * a hardware issue that results in unreliable timestamps. Force
599a2e47134SBrandon Streiff * these devices to timestamp at the MAC.
600a2e47134SBrandon Streiff */
601a2e47134SBrandon Streiff if (chip->info->family == MV88E6XXX_FAMILY_6341) {
602a2e47134SBrandon Streiff u16 val = MV88E6341_PTP_CFG_UPDATE |
603a2e47134SBrandon Streiff MV88E6341_PTP_CFG_MODE_IDX |
604a2e47134SBrandon Streiff MV88E6341_PTP_CFG_MODE_TS_AT_MAC;
605a2e47134SBrandon Streiff err = mv88e6xxx_ptp_write(chip, MV88E6341_PTP_CFG, val);
606a2e47134SBrandon Streiff if (err)
607a2e47134SBrandon Streiff return err;
608a2e47134SBrandon Streiff }
609a2e47134SBrandon Streiff
610c6fe0ad2SBrandon Streiff return 0;
611c6fe0ad2SBrandon Streiff }
612c6fe0ad2SBrandon Streiff
mv88e6xxx_hwtstamp_free(struct mv88e6xxx_chip * chip)613c6fe0ad2SBrandon Streiff void mv88e6xxx_hwtstamp_free(struct mv88e6xxx_chip *chip)
614c6fe0ad2SBrandon Streiff {
615c6fe0ad2SBrandon Streiff }
616