diff options
| author | Linus Torvalds <torvalds@linux-foundation.org> | 2010-08-04 11:47:58 -0700 | 
|---|---|---|
| committer | Linus Torvalds <torvalds@linux-foundation.org> | 2010-08-04 11:47:58 -0700 | 
| commit | 6ba74014c1ab0e37af7de6f64b4eccbbae3cb9e7 (patch) | |
| tree | 8f3892fc44f1e403675a6d7e88fda5c70e56ee4c /net/core/timestamping.c | |
| parent | 5abd9ccced7a726c817dd6b5b96bc933859138d1 (diff) | |
| parent | 3ff1c25927e3af61c6bf0e4ed959504058ae4565 (diff) | |
| download | olio-linux-3.10-6ba74014c1ab0e37af7de6f64b4eccbbae3cb9e7.tar.xz olio-linux-3.10-6ba74014c1ab0e37af7de6f64b4eccbbae3cb9e7.zip  | |
Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-next-2.6
* git://git.kernel.org/pub/scm/linux/kernel/git/davem/net-next-2.6: (1443 commits)
  phy/marvell: add 88ec048 support
  igb: Program MDICNFG register prior to PHY init
  e1000e: correct MAC-PHY interconnect register offset for 82579
  hso: Add new product ID
  can: Add driver for esd CAN-USB/2 device
  l2tp: fix export of header file for userspace
  can-raw: Fix skb_orphan_try handling
  Revert "net: remove zap_completion_queue"
  net: cleanup inclusion
  phy/marvell: add 88e1121 interface mode support
  u32: negative offset fix
  net: Fix a typo from "dev" to "ndev"
  igb: Use irq_synchronize per vector when using MSI-X
  ixgbevf: fix null pointer dereference due to filter being set for VLAN 0
  e1000e: Fix irq_synchronize in MSI-X case
  e1000e: register pm_qos request on hardware activation
  ip_fragment: fix subtracting PPPOE_SES_HLEN from mtu twice
  net: Add getsockopt support for TCP thin-streams
  cxgb4: update driver version
  cxgb4: add new PCI IDs
  ...
Manually fix up conflicts in:
 - drivers/net/e1000e/netdev.c: due to pm_qos registration
   infrastructure changes
 - drivers/net/phy/marvell.c: conflict between adding 88ec048 support
   and cleaning up the IDs
 - drivers/net/wireless/ipw2x00/ipw2100.c: trivial ipw2100_pm_qos_req
   conflict (registration change vs marking it static)
Diffstat (limited to 'net/core/timestamping.c')
| -rw-r--r-- | net/core/timestamping.c | 126 | 
1 files changed, 126 insertions, 0 deletions
diff --git a/net/core/timestamping.c b/net/core/timestamping.c new file mode 100644 index 00000000000..0ae6c22da85 --- /dev/null +++ b/net/core/timestamping.c @@ -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))); +}  |