mirror of
				git://git.openwrt.org/openwrt/openwrt.git
				synced 2025-10-26 03:24:26 -04:00 
			
		
		
		
	
		
			
				
	
	
		
			176 lines
		
	
	
		
			4.8 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
			
		
		
	
	
			176 lines
		
	
	
		
			4.8 KiB
		
	
	
	
		
			Diff
		
	
	
	
	
	
| --- a/include/linux/netdevice.h
 | |
| +++ b/include/linux/netdevice.h
 | |
| @@ -1093,6 +1093,11 @@ struct net_device {
 | |
|  	const struct net_device_ops *netdev_ops;
 | |
|  	const struct ethtool_ops *ethtool_ops;
 | |
|  
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +	void (*eth_mangle_rx)(struct net_device *dev, struct sk_buff *skb);
 | |
| +	struct sk_buff *(*eth_mangle_tx)(struct net_device *dev, struct sk_buff *skb);
 | |
| +#endif
 | |
| +
 | |
|  	/* Hardware header description */
 | |
|  	const struct header_ops *header_ops;
 | |
|  
 | |
| @@ -1149,6 +1154,9 @@ struct net_device {
 | |
|  	void			*ax25_ptr;	/* AX.25 specific data */
 | |
|  	struct wireless_dev	*ieee80211_ptr;	/* IEEE 802.11 specific data,
 | |
|  						   assign before registering */
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +	void			*phy_ptr; /* PHY device specific data */
 | |
| +#endif
 | |
|  
 | |
|  /*
 | |
|   * Cache lines mostly used on receive path (including eth_type_trans())
 | |
| --- a/include/uapi/linux/if.h
 | |
| +++ b/include/uapi/linux/if.h
 | |
| @@ -83,6 +83,7 @@
 | |
|  #define IFF_SUPP_NOFCS	0x80000		/* device supports sending custom FCS */
 | |
|  #define IFF_LIVE_ADDR_CHANGE 0x100000	/* device supports hardware address
 | |
|  					 * change when it's running */
 | |
| +#define IFF_NO_IP_ALIGN	0x200000	/* do not ip-align allocated rx pkts */
 | |
|  
 | |
|  
 | |
|  #define IF_GET_IFACE	0x0001		/* for querying only */
 | |
| --- a/include/linux/skbuff.h
 | |
| +++ b/include/linux/skbuff.h
 | |
| @@ -1757,6 +1757,10 @@ static inline int pskb_trim(struct sk_bu
 | |
|  	return (len < skb->len) ? __pskb_trim(skb, len) : 0;
 | |
|  }
 | |
|  
 | |
| +extern struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
 | |
| +		unsigned int length, gfp_t gfp);
 | |
| +
 | |
| +
 | |
|  /**
 | |
|   *	pskb_trim_unique - remove end from a paged unique (not cloned) buffer
 | |
|   *	@skb: buffer to alter
 | |
| @@ -1877,16 +1881,6 @@ static inline struct sk_buff *dev_alloc_
 | |
|  }
 | |
|  
 | |
|  
 | |
| -static inline struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
 | |
| -		unsigned int length, gfp_t gfp)
 | |
| -{
 | |
| -	struct sk_buff *skb = __netdev_alloc_skb(dev, length + NET_IP_ALIGN, gfp);
 | |
| -
 | |
| -	if (NET_IP_ALIGN && skb)
 | |
| -		skb_reserve(skb, NET_IP_ALIGN);
 | |
| -	return skb;
 | |
| -}
 | |
| -
 | |
|  static inline struct sk_buff *netdev_alloc_skb_ip_align(struct net_device *dev,
 | |
|  		unsigned int length)
 | |
|  {
 | |
| --- a/net/Kconfig
 | |
| +++ b/net/Kconfig
 | |
| @@ -23,6 +23,12 @@ menuconfig NET
 | |
|  
 | |
|  if NET
 | |
|  
 | |
| +config ETHERNET_PACKET_MANGLE
 | |
| +	bool
 | |
| +	help
 | |
| +	  This option can be selected by phy drivers that need to mangle
 | |
| +	  packets going in or out of an ethernet device.
 | |
| +
 | |
|  config WANT_COMPAT_NETLINK_MESSAGES
 | |
|  	bool
 | |
|  	help
 | |
| --- a/net/core/dev.c
 | |
| +++ b/net/core/dev.c
 | |
| @@ -2364,9 +2364,19 @@ int dev_hard_start_xmit(struct sk_buff *
 | |
|  		if (!list_empty(&ptype_all))
 | |
|  			dev_queue_xmit_nit(skb, dev);
 | |
|  
 | |
| -		skb_len = skb->len;
 | |
| -		rc = ops->ndo_start_xmit(skb, dev);
 | |
| -		trace_net_dev_xmit(skb, rc, dev, skb_len);
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +		if (!dev->eth_mangle_tx ||
 | |
| +		    (skb = dev->eth_mangle_tx(dev, skb)) != NULL)
 | |
| +#else
 | |
| +		if (1)
 | |
| +#endif
 | |
| +		{
 | |
| +			skb_len = skb->len;
 | |
| +			rc = ops->ndo_start_xmit(skb, dev);
 | |
| +			trace_net_dev_xmit(skb, rc, dev, skb_len);
 | |
| +		} else {
 | |
| +			rc = NETDEV_TX_OK;
 | |
| +		}
 | |
|  		if (rc == NETDEV_TX_OK)
 | |
|  			txq_trans_update(txq);
 | |
|  		return rc;
 | |
| @@ -2389,9 +2399,19 @@ gso:
 | |
|  		if (!list_empty(&ptype_all))
 | |
|  			dev_queue_xmit_nit(nskb, dev);
 | |
|  
 | |
| -		skb_len = nskb->len;
 | |
| -		rc = ops->ndo_start_xmit(nskb, dev);
 | |
| -		trace_net_dev_xmit(nskb, rc, dev, skb_len);
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +		if (!dev->eth_mangle_tx ||
 | |
| +		    (nskb = dev->eth_mangle_tx(dev, nskb)) != NULL)
 | |
| +#else
 | |
| +		if (1)
 | |
| +#endif
 | |
| +		{
 | |
| +			skb_len = nskb->len;
 | |
| +			rc = ops->ndo_start_xmit(nskb, dev);
 | |
| +			trace_net_dev_xmit(nskb, rc, dev, skb_len);
 | |
| +		} else {
 | |
| +			rc = NETDEV_TX_OK;
 | |
| +		}
 | |
|  		if (unlikely(rc != NETDEV_TX_OK)) {
 | |
|  			if (rc & ~NETDEV_TX_MASK)
 | |
|  				goto out_kfree_gso_skb;
 | |
| --- a/net/core/skbuff.c
 | |
| +++ b/net/core/skbuff.c
 | |
| @@ -60,6 +60,7 @@
 | |
|  #include <linux/scatterlist.h>
 | |
|  #include <linux/errqueue.h>
 | |
|  #include <linux/prefetch.h>
 | |
| +#include <linux/if.h>
 | |
|  
 | |
|  #include <net/protocol.h>
 | |
|  #include <net/dst.h>
 | |
| @@ -455,6 +456,22 @@ struct sk_buff *__netdev_alloc_skb(struc
 | |
|  }
 | |
|  EXPORT_SYMBOL(__netdev_alloc_skb);
 | |
|  
 | |
| +struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
 | |
| +		unsigned int length, gfp_t gfp)
 | |
| +{
 | |
| +	struct sk_buff *skb = __netdev_alloc_skb(dev, length + NET_IP_ALIGN, gfp);
 | |
| +
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +	if (dev && (dev->priv_flags & IFF_NO_IP_ALIGN))
 | |
| +		return skb;
 | |
| +#endif
 | |
| +
 | |
| +	if (NET_IP_ALIGN && skb)
 | |
| +		skb_reserve(skb, NET_IP_ALIGN);
 | |
| +	return skb;
 | |
| +}
 | |
| +EXPORT_SYMBOL(__netdev_alloc_skb_ip_align);
 | |
| +
 | |
|  void skb_add_rx_frag(struct sk_buff *skb, int i, struct page *page, int off,
 | |
|  		     int size, unsigned int truesize)
 | |
|  {
 | |
| --- a/net/ethernet/eth.c
 | |
| +++ b/net/ethernet/eth.c
 | |
| @@ -159,6 +159,12 @@ __be16 eth_type_trans(struct sk_buff *sk
 | |
|  	struct ethhdr *eth;
 | |
|  
 | |
|  	skb->dev = dev;
 | |
| +
 | |
| +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 | |
| +	if (dev->eth_mangle_rx)
 | |
| +		dev->eth_mangle_rx(dev, skb);
 | |
| +#endif
 | |
| +
 | |
|  	skb_reset_mac_header(skb);
 | |
|  	skb_pull_inline(skb, ETH_HLEN);
 | |
|  	eth = eth_hdr(skb);
 |