|
@@ -23,16 +23,13 @@
|
|
|
#include <linux/skbuff.h>
|
|
|
#include <linux/export.h>
|
|
|
|
|
|
-static struct sock_filter ptp_filter[] = {
|
|
|
- PTP_FILTER
|
|
|
-};
|
|
|
+static struct sk_filter *ptp_insns __read_mostly;
|
|
|
|
|
|
static unsigned int classify(const struct sk_buff *skb)
|
|
|
{
|
|
|
- if (likely(skb->dev &&
|
|
|
- skb->dev->phydev &&
|
|
|
+ if (likely(skb->dev && skb->dev->phydev &&
|
|
|
skb->dev->phydev->drv))
|
|
|
- return sk_run_filter(skb, ptp_filter);
|
|
|
+ return SK_RUN_FILTER(ptp_insns, skb);
|
|
|
else
|
|
|
return PTP_CLASS_NONE;
|
|
|
}
|
|
@@ -60,11 +57,13 @@ void skb_clone_tx_timestamp(struct sk_buff *skb)
|
|
|
if (likely(phydev->drv->txtstamp)) {
|
|
|
if (!atomic_inc_not_zero(&sk->sk_refcnt))
|
|
|
return;
|
|
|
+
|
|
|
clone = skb_clone(skb, GFP_ATOMIC);
|
|
|
if (!clone) {
|
|
|
sock_put(sk);
|
|
|
return;
|
|
|
}
|
|
|
+
|
|
|
clone->sk = sk;
|
|
|
phydev->drv->txtstamp(phydev, clone, type);
|
|
|
}
|
|
@@ -89,12 +88,15 @@ void skb_complete_tx_timestamp(struct sk_buff *skb,
|
|
|
}
|
|
|
|
|
|
*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);
|
|
|
+
|
|
|
sock_put(sk);
|
|
|
if (err)
|
|
|
kfree_skb(skb);
|
|
@@ -135,5 +137,10 @@ EXPORT_SYMBOL_GPL(skb_defer_rx_timestamp);
|
|
|
|
|
|
void __init skb_timestamping_init(void)
|
|
|
{
|
|
|
- BUG_ON(sk_chk_filter(ptp_filter, ARRAY_SIZE(ptp_filter)));
|
|
|
+ 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));
|
|
|
}
|