blob: 7f7de1a04de6a1a05e07ab2c7d93d5f8cc3e72c0 [file] [log] [blame]
Patrick McHardy7750f402008-07-08 03:23:36 -07001#include <linux/skbuff.h>
2#include <linux/netdevice.h>
3#include <linux/if_vlan.h>
Herbert Xu4ead4432009-03-01 00:11:52 -08004#include <linux/netpoll.h>
Patrick McHardy7750f402008-07-08 03:23:36 -07005#include "vlan.h"
6
7/* VLAN rx hw acceleration helper. This acts like netif_{rx,receive_skb}(). */
8int __vlan_hwaccel_rx(struct sk_buff *skb, struct vlan_group *grp,
Patrick McHardy9bb85822008-07-08 03:24:44 -07009 u16 vlan_tci, int polling)
Patrick McHardy7750f402008-07-08 03:23:36 -070010{
Herbert Xu4ead4432009-03-01 00:11:52 -080011 if (netpoll_rx(skb))
12 return NET_RX_DROP;
13
Herbert Xue1c096e2009-01-06 10:50:09 -080014 if (skb_bond_should_drop(skb))
15 goto drop;
Patrick McHardy7750f402008-07-08 03:23:36 -070016
Patrick McHardybc1d0412008-07-14 22:49:30 -070017 skb->vlan_tci = vlan_tci;
Herbert Xue1c096e2009-01-06 10:50:09 -080018 skb->dev = vlan_group_get_device(grp, vlan_tci & VLAN_VID_MASK);
19
20 if (!skb->dev)
21 goto drop;
Patrick McHardy9b22ea52008-11-04 14:49:57 -080022
23 return (polling ? netif_receive_skb(skb) : netif_rx(skb));
Herbert Xue1c096e2009-01-06 10:50:09 -080024
25drop:
26 dev_kfree_skb_any(skb);
27 return NET_RX_DROP;
Patrick McHardy9b22ea52008-11-04 14:49:57 -080028}
29EXPORT_SYMBOL(__vlan_hwaccel_rx);
30
31int vlan_hwaccel_do_receive(struct sk_buff *skb)
32{
Herbert Xue1c096e2009-01-06 10:50:09 -080033 struct net_device *dev = skb->dev;
Patrick McHardy9b22ea52008-11-04 14:49:57 -080034 struct net_device_stats *stats;
35
Herbert Xue1c096e2009-01-06 10:50:09 -080036 skb->dev = vlan_dev_info(dev)->real_dev;
Patrick McHardybc1d0412008-07-14 22:49:30 -070037 netif_nit_deliver(skb);
38
Patrick McHardy9b22ea52008-11-04 14:49:57 -080039 skb->dev = dev;
40 skb->priority = vlan_get_ingress_priority(dev, skb->vlan_tci);
Patrick McHardybc1d0412008-07-14 22:49:30 -070041 skb->vlan_tci = 0;
Patrick McHardy7750f402008-07-08 03:23:36 -070042
Patrick McHardy9b22ea52008-11-04 14:49:57 -080043 stats = &dev->stats;
Patrick McHardy7750f402008-07-08 03:23:36 -070044 stats->rx_packets++;
45 stats->rx_bytes += skb->len;
46
Patrick McHardy7750f402008-07-08 03:23:36 -070047 switch (skb->pkt_type) {
48 case PACKET_BROADCAST:
49 break;
50 case PACKET_MULTICAST:
51 stats->multicast++;
52 break;
53 case PACKET_OTHERHOST:
54 /* Our lower layer thinks this is not local, let's make sure.
55 * This allows the VLAN to have a different MAC than the
56 * underlying device, and still route correctly. */
57 if (!compare_ether_addr(eth_hdr(skb)->h_dest,
Patrick McHardy9b22ea52008-11-04 14:49:57 -080058 dev->dev_addr))
Patrick McHardy7750f402008-07-08 03:23:36 -070059 skb->pkt_type = PACKET_HOST;
60 break;
61 };
Patrick McHardy9b22ea52008-11-04 14:49:57 -080062 return 0;
Patrick McHardy7750f402008-07-08 03:23:36 -070063}
Patrick McHardy22d1ba72008-07-08 03:23:57 -070064
65struct net_device *vlan_dev_real_dev(const struct net_device *dev)
66{
67 return vlan_dev_info(dev)->real_dev;
68}
Ben Greear116cb422009-01-26 12:37:53 -080069EXPORT_SYMBOL(vlan_dev_real_dev);
Patrick McHardy22d1ba72008-07-08 03:23:57 -070070
71u16 vlan_dev_vlan_id(const struct net_device *dev)
72{
73 return vlan_dev_info(dev)->vlan_id;
74}
Ben Greear116cb422009-01-26 12:37:53 -080075EXPORT_SYMBOL(vlan_dev_vlan_id);
Herbert Xue1c096e2009-01-06 10:50:09 -080076
77static int vlan_gro_common(struct napi_struct *napi, struct vlan_group *grp,
78 unsigned int vlan_tci, struct sk_buff *skb)
79{
80 struct sk_buff *p;
81
82 if (skb_bond_should_drop(skb))
83 goto drop;
84
85 skb->vlan_tci = vlan_tci;
86 skb->dev = vlan_group_get_device(grp, vlan_tci & VLAN_VID_MASK);
87
88 if (!skb->dev)
89 goto drop;
90
91 for (p = napi->gro_list; p; p = p->next) {
Herbert Xuaa4b9f52009-02-08 18:00:37 +000092 NAPI_GRO_CB(p)->same_flow =
93 p->dev == skb->dev && !compare_ether_header(
94 skb_mac_header(p), skb_gro_mac_header(skb));
Herbert Xue1c096e2009-01-06 10:50:09 -080095 NAPI_GRO_CB(p)->flush = 0;
96 }
97
98 return dev_gro_receive(napi, skb);
99
100drop:
Herbert Xud1c76af2009-03-16 10:50:02 -0700101 return GRO_DROP;
Herbert Xue1c096e2009-01-06 10:50:09 -0800102}
103
104int vlan_gro_receive(struct napi_struct *napi, struct vlan_group *grp,
105 unsigned int vlan_tci, struct sk_buff *skb)
106{
Herbert Xu2ffb4552009-03-17 13:10:52 -0700107 if (netpoll_rx_on(skb))
108 return vlan_hwaccel_receive_skb(skb, grp, vlan_tci);
109
Herbert Xu86911732009-01-29 14:19:50 +0000110 skb_gro_reset_offset(skb);
111
Herbert Xu5d0d9be2009-01-29 14:19:48 +0000112 return napi_skb_finish(vlan_gro_common(napi, grp, vlan_tci, skb), skb);
Herbert Xue1c096e2009-01-06 10:50:09 -0800113}
114EXPORT_SYMBOL(vlan_gro_receive);
115
116int vlan_gro_frags(struct napi_struct *napi, struct vlan_group *grp,
Herbert Xu76620aa2009-04-16 02:02:07 -0700117 unsigned int vlan_tci)
Herbert Xue1c096e2009-01-06 10:50:09 -0800118{
Herbert Xu76620aa2009-04-16 02:02:07 -0700119 struct sk_buff *skb = napi_frags_skb(napi);
Herbert Xue1c096e2009-01-06 10:50:09 -0800120
121 if (!skb)
Herbert Xu5d0d9be2009-01-29 14:19:48 +0000122 return NET_RX_DROP;
Herbert Xue1c096e2009-01-06 10:50:09 -0800123
Herbert Xu1db9e292009-04-13 04:41:01 +0000124 if (netpoll_rx_on(skb)) {
125 skb->protocol = eth_type_trans(skb, skb->dev);
Herbert Xu2ffb4552009-03-17 13:10:52 -0700126 return vlan_hwaccel_receive_skb(skb, grp, vlan_tci);
Herbert Xu1db9e292009-04-13 04:41:01 +0000127 }
Herbert Xu2ffb4552009-03-17 13:10:52 -0700128
Herbert Xu5d0d9be2009-01-29 14:19:48 +0000129 return napi_frags_finish(napi, skb,
130 vlan_gro_common(napi, grp, vlan_tci, skb));
Herbert Xue1c096e2009-01-06 10:50:09 -0800131}
132EXPORT_SYMBOL(vlan_gro_frags);