blob: 2886d2fb9ab5d84dc8177a01778606a82904d6b5 [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) {
92 NAPI_GRO_CB(p)->same_flow = p->dev == skb->dev;
93 NAPI_GRO_CB(p)->flush = 0;
94 }
95
96 return dev_gro_receive(napi, skb);
97
98drop:
99 return 2;
100}
101
102int vlan_gro_receive(struct napi_struct *napi, struct vlan_group *grp,
103 unsigned int vlan_tci, struct sk_buff *skb)
104{
105 int err = NET_RX_SUCCESS;
106
Herbert Xu4ead4432009-03-01 00:11:52 -0800107 if (netpoll_receive_skb(skb))
108 return NET_RX_DROP;
109
Herbert Xue1c096e2009-01-06 10:50:09 -0800110 switch (vlan_gro_common(napi, grp, vlan_tci, skb)) {
111 case -1:
112 return netif_receive_skb(skb);
113
114 case 2:
115 err = NET_RX_DROP;
116 /* fall through */
117
118 case 1:
119 kfree_skb(skb);
120 break;
121 }
122
123 return err;
124}
125EXPORT_SYMBOL(vlan_gro_receive);
126
127int vlan_gro_frags(struct napi_struct *napi, struct vlan_group *grp,
128 unsigned int vlan_tci, struct napi_gro_fraginfo *info)
129{
130 struct sk_buff *skb = napi_fraginfo_skb(napi, info);
131 int err = NET_RX_DROP;
132
133 if (!skb)
134 goto out;
135
Herbert Xu4ead4432009-03-01 00:11:52 -0800136 if (netpoll_receive_skb(skb))
137 goto out;
138
Herbert Xue1c096e2009-01-06 10:50:09 -0800139 err = NET_RX_SUCCESS;
140
141 switch (vlan_gro_common(napi, grp, vlan_tci, skb)) {
142 case -1:
143 return netif_receive_skb(skb);
144
145 case 2:
146 err = NET_RX_DROP;
147 /* fall through */
148
149 case 1:
150 napi_reuse_skb(napi, skb);
151 break;
152 }
153
154out:
155 return err;
156}
157EXPORT_SYMBOL(vlan_gro_frags);