xref: /linux/net/8021q/vlan_core.c (revision 0c93ea4064a209cdc36de8a9a3003d43d08f46f7)
1 #include <linux/skbuff.h>
2 #include <linux/netdevice.h>
3 #include <linux/if_vlan.h>
4 #include <linux/netpoll.h>
5 #include "vlan.h"
6 
7 /* VLAN rx hw acceleration helper.  This acts like netif_{rx,receive_skb}(). */
8 int __vlan_hwaccel_rx(struct sk_buff *skb, struct vlan_group *grp,
9 		      u16 vlan_tci, int polling)
10 {
11 	if (netpoll_rx(skb))
12 		return NET_RX_DROP;
13 
14 	if (skb_bond_should_drop(skb))
15 		goto drop;
16 
17 	skb->vlan_tci = vlan_tci;
18 	skb->dev = vlan_group_get_device(grp, vlan_tci & VLAN_VID_MASK);
19 
20 	if (!skb->dev)
21 		goto drop;
22 
23 	return (polling ? netif_receive_skb(skb) : netif_rx(skb));
24 
25 drop:
26 	dev_kfree_skb_any(skb);
27 	return NET_RX_DROP;
28 }
29 EXPORT_SYMBOL(__vlan_hwaccel_rx);
30 
31 int vlan_hwaccel_do_receive(struct sk_buff *skb)
32 {
33 	struct net_device *dev = skb->dev;
34 	struct net_device_stats *stats;
35 
36 	skb->dev = vlan_dev_info(dev)->real_dev;
37 	netif_nit_deliver(skb);
38 
39 	skb->dev = dev;
40 	skb->priority = vlan_get_ingress_priority(dev, skb->vlan_tci);
41 	skb->vlan_tci = 0;
42 
43 	stats = &dev->stats;
44 	stats->rx_packets++;
45 	stats->rx_bytes += skb->len;
46 
47 	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,
58 					dev->dev_addr))
59 			skb->pkt_type = PACKET_HOST;
60 		break;
61 	};
62 	return 0;
63 }
64 
65 struct net_device *vlan_dev_real_dev(const struct net_device *dev)
66 {
67 	return vlan_dev_info(dev)->real_dev;
68 }
69 EXPORT_SYMBOL(vlan_dev_real_dev);
70 
71 u16 vlan_dev_vlan_id(const struct net_device *dev)
72 {
73 	return vlan_dev_info(dev)->vlan_id;
74 }
75 EXPORT_SYMBOL(vlan_dev_vlan_id);
76 
77 static 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 
98 drop:
99 	return 2;
100 }
101 
102 int 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 
107 	if (netpoll_receive_skb(skb))
108 		return NET_RX_DROP;
109 
110 	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 }
125 EXPORT_SYMBOL(vlan_gro_receive);
126 
127 int 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 
136 	if (netpoll_receive_skb(skb))
137 		goto out;
138 
139 	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 
154 out:
155 	return err;
156 }
157 EXPORT_SYMBOL(vlan_gro_frags);
158