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)
29		return;
30
31	type = classify(skb);
32	if (type == PTP_CLASS_NONE)
33		return;
34
35	mii_ts = skb->dev->phydev->mii_ts;
36	if (likely(mii_ts->txtstamp)) {
37		clone = skb_clone_sk(skb);
38		if (!clone)
39			return;
40		mii_ts->txtstamp(mii_ts, clone, type);
41	}
42}
43EXPORT_SYMBOL_GPL(skb_clone_tx_timestamp);
44
45bool skb_defer_rx_timestamp(struct sk_buff *skb)
46{
47	struct mii_timestamper *mii_ts;
48	unsigned int type;
49
50	if (!skb->dev || !skb->dev->phydev || !skb->dev->phydev->mii_ts)
51		return false;
52
53	if (skb_headroom(skb) < ETH_HLEN)
54		return false;
55
56	__skb_push(skb, ETH_HLEN);
57
58	type = ptp_classify_raw(skb);
59
60	__skb_pull(skb, ETH_HLEN);
61
62	if (type == PTP_CLASS_NONE)
63		return false;
64
65	mii_ts = skb->dev->phydev->mii_ts;
66	if (likely(mii_ts->rxtstamp))
67		return mii_ts->rxtstamp(mii_ts, skb, type);
68
69	return false;
70}
71EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);
72