2010-07-17 16:49:36 +08:00
|
|
|
/*
|
|
|
|
* 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>
|
2011-07-15 23:47:34 +08:00
|
|
|
#include <linux/export.h>
|
2010-07-17 16:49:36 +08:00
|
|
|
|
2014-03-29 01:58:21 +08:00
|
|
|
static struct sk_filter *ptp_insns __read_mostly;
|
2010-07-17 16:49:36 +08:00
|
|
|
|
2010-12-07 04:50:09 +08:00
|
|
|
static unsigned int classify(const struct sk_buff *skb)
|
2010-07-17 16:49:36 +08:00
|
|
|
{
|
2014-03-29 01:58:21 +08:00
|
|
|
if (likely(skb->dev && skb->dev->phydev &&
|
2010-07-17 16:49:36 +08:00
|
|
|
skb->dev->phydev->drv))
|
2014-03-29 01:58:21 +08:00
|
|
|
return SK_RUN_FILTER(ptp_insns, skb);
|
2010-07-17 16:49:36 +08:00
|
|
|
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)) {
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
if (!atomic_inc_not_zero(&sk->sk_refcnt))
|
|
|
|
return;
|
2014-03-29 01:58:21 +08:00
|
|
|
|
2010-07-17 16:49:36 +08:00
|
|
|
clone = skb_clone(skb, GFP_ATOMIC);
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
if (!clone) {
|
|
|
|
sock_put(sk);
|
2010-07-17 16:49:36 +08:00
|
|
|
return;
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
}
|
2014-03-29 01:58:21 +08:00
|
|
|
|
2010-07-17 16:49:36 +08:00
|
|
|
clone->sk = sk;
|
|
|
|
phydev->drv->txtstamp(phydev, clone, type);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2011-06-12 10:18:58 +08:00
|
|
|
EXPORT_SYMBOL_GPL(skb_clone_tx_timestamp);
|
2010-07-17 16:49:36 +08:00
|
|
|
|
|
|
|
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;
|
|
|
|
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
if (!hwtstamps) {
|
|
|
|
sock_put(sk);
|
|
|
|
kfree_skb(skb);
|
2010-07-17 16:49:36 +08:00
|
|
|
return;
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
}
|
2010-07-17 16:49:36 +08:00
|
|
|
|
|
|
|
*skb_hwtstamps(skb) = *hwtstamps;
|
2014-03-29 01:58:21 +08:00
|
|
|
|
2010-07-17 16:49:36 +08:00
|
|
|
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;
|
2014-03-29 01:58:21 +08:00
|
|
|
|
2010-07-17 16:49:36 +08:00
|
|
|
err = sock_queue_err_skb(sk, skb);
|
2014-03-29 01:58:21 +08:00
|
|
|
|
net: hold sock reference while processing tx timestamps
The pair of functions,
* skb_clone_tx_timestamp()
* skb_complete_tx_timestamp()
were designed to allow timestamping in PHY devices. The first
function, called during the MAC driver's hard_xmit method, identifies
PTP protocol packets, clones them, and gives them to the PHY device
driver. The PHY driver may hold onto the packet and deliver it at a
later time using the second function, which adds the packet to the
socket's error queue.
As pointed out by Johannes, nothing prevents the socket from
disappearing while the cloned packet is sitting in the PHY driver
awaiting a timestamp. This patch fixes the issue by taking a reference
on the socket for each such packet. In addition, the comments
regarding the usage of these function are expanded to highlight the
rule that PHY drivers must use skb_complete_tx_timestamp() to release
the packet, in order to release the socket reference, too.
These functions first appeared in v2.6.36.
Reported-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: Richard Cochran <richard.cochran@omicron.at>
Cc: <stable@vger.kernel.org>
Signed-off-by: Eric Dumazet <eric.dumazet@gmail.com>
Reviewed-by: Johannes Berg <johannes@sipsolutions.net>
Signed-off-by: David S. Miller <davem@davemloft.net>
2011-10-21 08:49:15 +08:00
|
|
|
sock_put(sk);
|
2010-07-17 16:49:36 +08:00
|
|
|
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;
|
|
|
|
|
2010-12-06 02:50:32 +08:00
|
|
|
if (skb_headroom(skb) < ETH_HLEN)
|
|
|
|
return false;
|
|
|
|
__skb_push(skb, ETH_HLEN);
|
2010-07-17 16:49:36 +08:00
|
|
|
|
|
|
|
type = classify(skb);
|
|
|
|
|
2010-12-06 02:50:32 +08:00
|
|
|
__skb_pull(skb, ETH_HLEN);
|
2010-07-17 16:49:36 +08:00
|
|
|
|
|
|
|
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;
|
|
|
|
}
|
2011-06-20 05:51:23 +08:00
|
|
|
EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);
|
2010-07-17 16:49:36 +08:00
|
|
|
|
|
|
|
void __init skb_timestamping_init(void)
|
|
|
|
{
|
2014-03-29 01:58:21 +08:00
|
|
|
static struct sock_filter ptp_filter[] = { PTP_FILTER };
|
|
|
|
struct sock_fprog ptp_prog = {
|
|
|
|
.len = ARRAY_SIZE(ptp_filter), .filter = ptp_filter,
|
|
|
|
};
|
|
|
|
|
|
|
|
BUG_ON(sk_unattached_filter_create(&ptp_insns, &ptp_prog));
|
2010-07-17 16:49:36 +08:00
|
|
|
}
|