Gitiles
Code Review Sign In
review.shift-gmbh.com / SHIFTPHONES / kernel / common / d2e5fb927ee7f52c1fe2a98b554881e9dffd8514 / . / net / core / timestamping.c
blob: 7911235706a978a87f9eee2d6e89f20d3755f209 [file] [log] [blame]
Thomas Gleixner74ba9202019-05-20 09:19:02 +0200[diff] [blame]1// SPDX-License-Identifier: GPL-2.0-or-later
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]2/*
3 * PTP 1588 clock support - support for timestamping in PHY devices
4 *
5 * Copyright (C) 2010 OMICRON electronics GmbH
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]6 */
7#include <linux/errqueue.h>
8#include <linux/phy.h>
9#include <linux/ptp_classify.h>
10#include <linux/skbuff.h>
Paul Gortmakerbc3b2d72011-07-15 11:47:34 -0400[diff] [blame]11#include <linux/export.h>
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]12
Eric Dumazet62ab0812010-12-06 20:50:09 +0000[diff] [blame]13static unsigned int classify(const struct sk_buff *skb)
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]14{
Daniel Borkmanne62d2df2014-03-28 18:58:21 +0100[diff] [blame]15 if (likely(skb->dev && skb->dev->phydev &&
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]16 skb->dev->phydev->drv))
Daniel Borkmann164d8c62014-03-28 18:58:22 +0100[diff] [blame]17 return ptp_classify_raw(skb);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]18 else
19 return PTP_CLASS_NONE;
20}
21
22void skb_clone_tx_timestamp(struct sk_buff *skb)
23{
24 struct phy_device *phydev;
25 struct sk_buff *clone;
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]26 unsigned int type;
27
Alexander Duyck62bccb82014-09-04 13:31:35 -0400[diff] [blame]28 if (!skb->sk)
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]29 return;
30
31 type = classify(skb);
Stefan Sørensenb9c701e2014-06-27 11:59:09 +0200[diff] [blame]32 if (type == PTP_CLASS_NONE)
33 return;
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]34
Stefan Sørensenb9c701e2014-06-27 11:59:09 +0200[diff] [blame]35 phydev = skb->dev->phydev;
36 if (likely(phydev->drv->txtstamp)) {
Alexander Duyck62bccb82014-09-04 13:31:35 -0400[diff] [blame]37 clone = skb_clone_sk(skb);
38 if (!clone)
Stefan Sørensenb9c701e2014-06-27 11:59:09 +0200[diff] [blame]39 return;
Stefan Sørensenb9c701e2014-06-27 11:59:09 +0200[diff] [blame]40 phydev->drv->txtstamp(phydev, clone, type);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]41 }
42}
Richard Cochran1c172162011-06-12 02:18:58 +0000[diff] [blame]43EXPORT_SYMBOL_GPL(skb_clone_tx_timestamp);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]44
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]45bool skb_defer_rx_timestamp(struct sk_buff *skb)
46{
47 struct phy_device *phydev;
48 unsigned int type;
49
Alexander Duyck1007f592015-07-09 11:02:52 -0700[diff] [blame]50 if (!skb->dev || !skb->dev->phydev || !skb->dev->phydev->drv)
51 return false;
52
Eric Dumazeta19faf02010-12-05 18:50:32 +0000[diff] [blame]53 if (skb_headroom(skb) < ETH_HLEN)
54 return false;
Alexander Duyck1007f592015-07-09 11:02:52 -0700[diff] [blame]55
Eric Dumazeta19faf02010-12-05 18:50:32 +0000[diff] [blame]56 __skb_push(skb, ETH_HLEN);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]57
Alexander Duyck1007f592015-07-09 11:02:52 -0700[diff] [blame]58 type = ptp_classify_raw(skb);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]59
Eric Dumazeta19faf02010-12-05 18:50:32 +0000[diff] [blame]60 __skb_pull(skb, ETH_HLEN);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]61
Stefan Sørensenb9c701e2014-06-27 11:59:09 +0200[diff] [blame]62 if (type == PTP_CLASS_NONE)
63 return false;
64
65 phydev = skb->dev->phydev;
66 if (likely(phydev->drv->rxtstamp))
67 return phydev->drv->rxtstamp(phydev, skb, type);
Richard Cochranc1f19b52010-07-17 08:49:36 +0000[diff] [blame]68
69 return false;
70}
Richard Cochran238442f2011-06-19 21:51:23 +0000[diff] [blame]71EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);