target/linux/generic/patches-3.3/721-phy_packets.patch

   1 --- a/include/linux/netdevice.h
   2 +++ b/include/linux/netdevice.h
   3 @@ -1078,6 +1078,11 @@ struct net_device {
   4         const struct net_device_ops *netdev_ops;
   5         const struct ethtool_ops *ethtool_ops;
   6
   7 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
   8 +       void (*eth_mangle_rx)(struct net_device *dev, struct sk_buff *skb);
   9 +       struct sk_buff *(*eth_mangle_tx)(struct net_device *dev, struct sk_buff *skb);
  10 +#endif
  11 +
  12         /* Hardware header description */
  13         const struct header_ops *header_ops;
  14
  15 @@ -1134,6 +1139,9 @@ struct net_device {
  16         void                    *ax25_ptr;      /* AX.25 specific data */
  17         struct wireless_dev     *ieee80211_ptr; /* IEEE 802.11 specific data,
  18                                                    assign before registering */
  19 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
  20 +       void                    *phy_ptr; /* PHY device specific data */
  21 +#endif
  22
  23  /*
  24   * Cache lines mostly used on receive path (including eth_type_trans())
  25 --- a/include/linux/if.h
  26 +++ b/include/linux/if.h
  27 @@ -80,6 +80,7 @@
  28                                          * skbs on transmit */
  29  #define IFF_UNICAST_FLT        0x20000         /* Supports unicast filtering   */
  30  #define IFF_TEAM_PORT  0x40000         /* device used as team port */
  31 +#define IFF_NO_IP_ALIGN        0x80000         /* do not ip-align allocated rx pkts */
  32
  33  #define IF_GET_IFACE   0x0001          /* for querying only */
  34  #define IF_GET_PROTO   0x0002
  35 --- a/include/linux/skbuff.h
  36 +++ b/include/linux/skbuff.h
  37 @@ -1661,6 +1661,10 @@ extern struct sk_buff *dev_alloc_skb(uns
  38  extern struct sk_buff *__netdev_alloc_skb(struct net_device *dev,
  39                 unsigned int length, gfp_t gfp_mask);
  40
  41 +extern struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
  42 +               unsigned int length, gfp_t gfp);
  43 +
  44 +
  45  /**
  46   *     netdev_alloc_skb - allocate an skbuff for rx on a specific device
  47   *     @dev: network device to receive on
  48 @@ -1680,16 +1684,6 @@ static inline struct sk_buff *netdev_all
  49         return __netdev_alloc_skb(dev, length, GFP_ATOMIC);
  50  }
  51
  52 -static inline struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
  53 -               unsigned int length, gfp_t gfp)
  54 -{
  55 -       struct sk_buff *skb = __netdev_alloc_skb(dev, length + NET_IP_ALIGN, gfp);
  56 -
  57 -       if (NET_IP_ALIGN && skb)
  58 -               skb_reserve(skb, NET_IP_ALIGN);
  59 -       return skb;
  60 -}
  61 -
  62  static inline struct sk_buff *netdev_alloc_skb_ip_align(struct net_device *dev,
  63                 unsigned int length)
  64  {
  65 --- a/net/Kconfig
  66 +++ b/net/Kconfig
  67 @@ -23,6 +23,12 @@ menuconfig NET
  68
  69  if NET
  70
  71 +config ETHERNET_PACKET_MANGLE
  72 +       bool
  73 +       help
  74 +         This option can be selected by phy drivers that need to mangle
  75 +         packets going in or out of an ethernet device.
  76 +
  77  config WANT_COMPAT_NETLINK_MESSAGES
  78         bool
  79         help
  80 --- a/net/core/dev.c
  81 +++ b/net/core/dev.c
  82 @@ -2246,9 +2246,19 @@ int dev_hard_start_xmit(struct sk_buff *
  83                         }
  84                 }
  85
  86 -               skb_len = skb->len;
  87 -               rc = ops->ndo_start_xmit(skb, dev);
  88 -               trace_net_dev_xmit(skb, rc, dev, skb_len);
  89 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
  90 +               if (!dev->eth_mangle_tx ||
  91 +                   (skb = dev->eth_mangle_tx(dev, skb)) != NULL)
  92 +#else
  93 +               if (1)
  94 +#endif
  95 +               {
  96 +                       skb_len = skb->len;
  97 +                       rc = ops->ndo_start_xmit(skb, dev);
  98 +                       trace_net_dev_xmit(skb, rc, dev, skb_len);
  99 +               } else {
 100 +                       rc = NETDEV_TX_OK;
 101 +               }
 102                 if (rc == NETDEV_TX_OK)
 103                         txq_trans_update(txq);
 104                 return rc;
 105 @@ -2268,9 +2278,19 @@ gso:
 106                 if (dev->priv_flags & IFF_XMIT_DST_RELEASE)
 107                         skb_dst_drop(nskb);
 108
 109 -               skb_len = nskb->len;
 110 -               rc = ops->ndo_start_xmit(nskb, dev);
 111 -               trace_net_dev_xmit(nskb, rc, dev, skb_len);
 112 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 113 +               if (!dev->eth_mangle_tx ||
 114 +                   (nskb = dev->eth_mangle_tx(dev, nskb)) != NULL)
 115 +#else
 116 +               if (1)
 117 +#endif
 118 +               {
 119 +                       skb_len = nskb->len;
 120 +                       rc = ops->ndo_start_xmit(nskb, dev);
 121 +                       trace_net_dev_xmit(nskb, rc, dev, skb_len);
 122 +               } else {
 123 +                       rc = NETDEV_TX_OK;
 124 +               }
 125                 if (unlikely(rc != NETDEV_TX_OK)) {
 126                         if (rc & ~NETDEV_TX_MASK)
 127                                 goto out_kfree_gso_skb;
 128 --- a/net/core/skbuff.c
 129 +++ b/net/core/skbuff.c
 130 @@ -58,6 +58,7 @@
 131  #include <linux/scatterlist.h>
 132  #include <linux/errqueue.h>
 133  #include <linux/prefetch.h>
 134 +#include <linux/if.h>
 135
 136  #include <net/protocol.h>
 137  #include <net/dst.h>
 138 @@ -320,6 +321,22 @@ struct sk_buff *__netdev_alloc_skb(struc
 139  }
 140  EXPORT_SYMBOL(__netdev_alloc_skb);
 141
 142 +struct sk_buff *__netdev_alloc_skb_ip_align(struct net_device *dev,
 143 +               unsigned int length, gfp_t gfp)
 144 +{
 145 +       struct sk_buff *skb = __netdev_alloc_skb(dev, length + NET_IP_ALIGN, gfp);
 146 +
 147 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 148 +       if (dev->priv_flags & IFF_NO_IP_ALIGN)
 149 +               return skb;
 150 +#endif
 151 +
 152 +       if (NET_IP_ALIGN && skb)
 153 +               skb_reserve(skb, NET_IP_ALIGN);
 154 +       return skb;
 155 +}
 156 +EXPORT_SYMBOL(__netdev_alloc_skb_ip_align);
 157 +
 158  void skb_add_rx_frag(struct sk_buff *skb, int i, struct page *page, int off,
 159                 int size)
 160  {
 161 --- a/net/ethernet/eth.c
 162 +++ b/net/ethernet/eth.c
 163 @@ -160,6 +160,12 @@ __be16 eth_type_trans(struct sk_buff *sk
 164         struct ethhdr *eth;
 165
 166         skb->dev = dev;
 167 +
 168 +#ifdef CONFIG_ETHERNET_PACKET_MANGLE
 169 +       if (dev->eth_mangle_rx)
 170 +               dev->eth_mangle_rx(dev, skb);
 171 +#endif
 172 +
 173         skb_reset_mac_header(skb);
 174         skb_pull_inline(skb, ETH_HLEN);
 175         eth = eth_hdr(skb);