Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
net: support time stamping in phy devices.
This patch adds a new networking option to allow hardware time stamps from PHY devices. When enabled, likely candidates among incoming and outgoing network packets are offered to the PHY driver for possible time stamping. When accepted by the PHY driver, incoming packets are deferred for later delivery by the driver. The patch also adds phylib driver methods for the SIOCSHWTSTAMP ioctl and callbacks for transmit and receive time stamping. Drivers may optionally implement these functions. Signed-off-by: Richard Cochran <richard.cochran@omicron.at> Signed-off-by: David S. Miller <davem@davemloft.net>
- Loading branch information
1 parent
15f0127
commit c1f19b5
Showing
10 changed files
with
208 additions
and
1 deletion.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,126 @@ | ||
/* | ||
* PTP 1588 clock support - support for timestamping in PHY devices | ||
* | ||
* Copyright (C) 2010 OMICRON electronics GmbH | ||
* | ||
* This program is free software; you can redistribute it and/or modify | ||
* it under the terms of the GNU General Public License as published by | ||
* the Free Software Foundation; either version 2 of the License, or | ||
* (at your option) any later version. | ||
* | ||
* This program is distributed in the hope that it will be useful, | ||
* but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
* GNU General Public License for more details. | ||
* | ||
* You should have received a copy of the GNU General Public License | ||
* along with this program; if not, write to the Free Software | ||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
*/ | ||
#include <linux/errqueue.h> | ||
#include <linux/phy.h> | ||
#include <linux/ptp_classify.h> | ||
#include <linux/skbuff.h> | ||
|
||
static struct sock_filter ptp_filter[] = { | ||
PTP_FILTER | ||
}; | ||
|
||
static unsigned int classify(struct sk_buff *skb) | ||
{ | ||
if (likely(skb->dev && | ||
skb->dev->phydev && | ||
skb->dev->phydev->drv)) | ||
return sk_run_filter(skb, ptp_filter, ARRAY_SIZE(ptp_filter)); | ||
else | ||
return PTP_CLASS_NONE; | ||
} | ||
|
||
void skb_clone_tx_timestamp(struct sk_buff *skb) | ||
{ | ||
struct phy_device *phydev; | ||
struct sk_buff *clone; | ||
struct sock *sk = skb->sk; | ||
unsigned int type; | ||
|
||
if (!sk) | ||
return; | ||
|
||
type = classify(skb); | ||
|
||
switch (type) { | ||
case PTP_CLASS_V1_IPV4: | ||
case PTP_CLASS_V1_IPV6: | ||
case PTP_CLASS_V2_IPV4: | ||
case PTP_CLASS_V2_IPV6: | ||
case PTP_CLASS_V2_L2: | ||
case PTP_CLASS_V2_VLAN: | ||
phydev = skb->dev->phydev; | ||
if (likely(phydev->drv->txtstamp)) { | ||
clone = skb_clone(skb, GFP_ATOMIC); | ||
if (!clone) | ||
return; | ||
clone->sk = sk; | ||
phydev->drv->txtstamp(phydev, clone, type); | ||
} | ||
break; | ||
default: | ||
break; | ||
} | ||
} | ||
|
||
void skb_complete_tx_timestamp(struct sk_buff *skb, | ||
struct skb_shared_hwtstamps *hwtstamps) | ||
{ | ||
struct sock *sk = skb->sk; | ||
struct sock_exterr_skb *serr; | ||
int err; | ||
|
||
if (!hwtstamps) | ||
return; | ||
|
||
*skb_hwtstamps(skb) = *hwtstamps; | ||
serr = SKB_EXT_ERR(skb); | ||
memset(serr, 0, sizeof(*serr)); | ||
serr->ee.ee_errno = ENOMSG; | ||
serr->ee.ee_origin = SO_EE_ORIGIN_TIMESTAMPING; | ||
skb->sk = NULL; | ||
err = sock_queue_err_skb(sk, skb); | ||
if (err) | ||
kfree_skb(skb); | ||
} | ||
EXPORT_SYMBOL_GPL(skb_complete_tx_timestamp); | ||
|
||
bool skb_defer_rx_timestamp(struct sk_buff *skb) | ||
{ | ||
struct phy_device *phydev; | ||
unsigned int type; | ||
|
||
skb_push(skb, ETH_HLEN); | ||
|
||
type = classify(skb); | ||
|
||
skb_pull(skb, ETH_HLEN); | ||
|
||
switch (type) { | ||
case PTP_CLASS_V1_IPV4: | ||
case PTP_CLASS_V1_IPV6: | ||
case PTP_CLASS_V2_IPV4: | ||
case PTP_CLASS_V2_IPV6: | ||
case PTP_CLASS_V2_L2: | ||
case PTP_CLASS_V2_VLAN: | ||
phydev = skb->dev->phydev; | ||
if (likely(phydev->drv->rxtstamp)) | ||
return phydev->drv->rxtstamp(phydev, skb, type); | ||
break; | ||
default: | ||
break; | ||
} | ||
|
||
return false; | ||
} | ||
|
||
void __init skb_timestamping_init(void) | ||
{ | ||
BUG_ON(sk_chk_filter(ptp_filter, ARRAY_SIZE(ptp_filter))); | ||
} |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters