Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
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
13static 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
22void 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}
44EXPORT_SYMBOL_GPL(skb_clone_tx_timestamp);
45
46bool 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}
72EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);