1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * PTP 1588 clock support - support for timestamping in PHY devices
4 *
5 * Copyright (C) 2010 OMICRON electronics GmbH
6 */
7 #include <linux/errqueue.h>
8 #include <linux/phy.h>
9 #include <linux/ptp_classify.h>
10 #include <linux/skbuff.h>
11 #include <linux/export.h>
12
13 static unsigned int classify(const struct sk_buff *skb)
14 {
15 if (likely(skb->dev && skb->dev->phydev &&
16 skb->dev->phydev->mii_ts))
17 return ptp_classify_raw(skb);
18 else
19 return PTP_CLASS_NONE;
20 }
21
22 void skb_clone_tx_timestamp(struct sk_buff *skb)
23 {
24 struct mii_timestamper *mii_ts;
25 struct sk_buff *clone;
26 unsigned int type;
27
28 if (!skb->sk || !skb->dev ||
29 !phy_is_default_hwtstamp(skb->dev->phydev))
30 return;
31
32 type = classify(skb);
33 if (type == PTP_CLASS_NONE)
34 return;
35
36 mii_ts = skb->dev->phydev->mii_ts;
37 if (likely(mii_ts->txtstamp)) {
38 clone = skb_clone_sk(skb);
39 if (!clone)
40 return;
41 mii_ts->txtstamp(mii_ts, clone, type);
42 }
43 }
44 EXPORT_SYMBOL_GPL(skb_clone_tx_timestamp);
45
46 bool skb_defer_rx_timestamp(struct sk_buff *skb)
47 {
48 struct mii_timestamper *mii_ts;
49 unsigned int type;
50
51 if (!skb->dev || !phy_is_default_hwtstamp(skb->dev->phydev))
52 return false;
53
54 if (skb_headroom(skb) < ETH_HLEN)
55 return false;
56
57 __skb_push(skb, ETH_HLEN);
58
59 type = ptp_classify_raw(skb);
60
61 __skb_pull(skb, ETH_HLEN);
62
63 if (type == PTP_CLASS_NONE)
64 return false;
65
66 mii_ts = skb->dev->phydev->mii_ts;
67 if (likely(mii_ts->rxtstamp))
68 return mii_ts->rxtstamp(mii_ts, skb, type);
69
70 return false;
71 }
72 EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);
73
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.