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