1
2
3
4
5
6
7
8
9
10
11
12#ifndef _LINUX_IF_VLAN_H_
13#define _LINUX_IF_VLAN_H_
14
15#include <linux/netdevice.h>
16#include <linux/etherdevice.h>
17#include <linux/rtnetlink.h>
18#include <linux/bug.h>
19#include <uapi/linux/if_vlan.h>
20
21#define VLAN_HLEN 4
22
23
24#define VLAN_ETH_HLEN 18
25#define VLAN_ETH_ZLEN 64
26
27
28
29
30#define VLAN_ETH_DATA_LEN 1500
31#define VLAN_ETH_FRAME_LEN 1518
32
33
34
35
36
37
38struct vlan_hdr {
39 __be16 h_vlan_TCI;
40 __be16 h_vlan_encapsulated_proto;
41};
42
43
44
45
46
47
48
49
50
51struct vlan_ethhdr {
52 unsigned char h_dest[ETH_ALEN];
53 unsigned char h_source[ETH_ALEN];
54 __be16 h_vlan_proto;
55 __be16 h_vlan_TCI;
56 __be16 h_vlan_encapsulated_proto;
57};
58
59#include <linux/skbuff.h>
60
61static inline struct vlan_ethhdr *vlan_eth_hdr(const struct sk_buff *skb)
62{
63 return (struct vlan_ethhdr *)skb_mac_header(skb);
64}
65
66#define VLAN_PRIO_MASK 0xe000
67#define VLAN_PRIO_SHIFT 13
68#define VLAN_CFI_MASK 0x1000
69#define VLAN_TAG_PRESENT VLAN_CFI_MASK
70#define VLAN_VID_MASK 0x0fff
71#define VLAN_N_VID 4096
72
73
74extern void vlan_ioctl_set(int (*hook)(struct net *, void __user *));
75
76static inline int is_vlan_dev(struct net_device *dev)
77{
78 return dev->priv_flags & IFF_802_1Q_VLAN;
79}
80
81#define vlan_tx_tag_present(__skb) ((__skb)->vlan_tci & VLAN_TAG_PRESENT)
82#define vlan_tx_tag_get(__skb) ((__skb)->vlan_tci & ~VLAN_TAG_PRESENT)
83#define vlan_tx_tag_get_id(__skb) ((__skb)->vlan_tci & VLAN_VID_MASK)
84
85#if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
86
87extern struct net_device *__vlan_find_dev_deep(struct net_device *real_dev,
88 __be16 vlan_proto, u16 vlan_id);
89extern struct net_device *vlan_dev_real_dev(const struct net_device *dev);
90extern u16 vlan_dev_vlan_id(const struct net_device *dev);
91
92extern bool vlan_do_receive(struct sk_buff **skb);
93extern struct sk_buff *vlan_untag(struct sk_buff *skb);
94
95extern int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid);
96extern void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid);
97
98extern int vlan_vids_add_by_dev(struct net_device *dev,
99 const struct net_device *by_dev);
100extern void vlan_vids_del_by_dev(struct net_device *dev,
101 const struct net_device *by_dev);
102
103extern bool vlan_uses_dev(const struct net_device *dev);
104#else
105static inline struct net_device *
106__vlan_find_dev_deep(struct net_device *real_dev,
107 __be16 vlan_proto, u16 vlan_id)
108{
109 return NULL;
110}
111
112static inline struct net_device *vlan_dev_real_dev(const struct net_device *dev)
113{
114 BUG();
115 return NULL;
116}
117
118static inline u16 vlan_dev_vlan_id(const struct net_device *dev)
119{
120 BUG();
121 return 0;
122}
123
124static inline bool vlan_do_receive(struct sk_buff **skb)
125{
126 return false;
127}
128
129static inline struct sk_buff *vlan_untag(struct sk_buff *skb)
130{
131 return skb;
132}
133
134static inline int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid)
135{
136 return 0;
137}
138
139static inline void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid)
140{
141}
142
143static inline int vlan_vids_add_by_dev(struct net_device *dev,
144 const struct net_device *by_dev)
145{
146 return 0;
147}
148
149static inline void vlan_vids_del_by_dev(struct net_device *dev,
150 const struct net_device *by_dev)
151{
152}
153
154static inline bool vlan_uses_dev(const struct net_device *dev)
155{
156 return false;
157}
158#endif
159
160static inline bool vlan_hw_offload_capable(netdev_features_t features,
161 __be16 proto)
162{
163 if (proto == htons(ETH_P_8021Q) && features & NETIF_F_HW_VLAN_CTAG_TX)
164 return true;
165 if (proto == htons(ETH_P_8021AD) && features & NETIF_F_HW_VLAN_STAG_TX)
166 return true;
167 return false;
168}
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184static inline struct sk_buff *vlan_insert_tag(struct sk_buff *skb,
185 __be16 vlan_proto, u16 vlan_tci)
186{
187 struct vlan_ethhdr *veth;
188
189 if (skb_cow_head(skb, VLAN_HLEN) < 0) {
190 kfree_skb(skb);
191 return NULL;
192 }
193 veth = (struct vlan_ethhdr *)skb_push(skb, VLAN_HLEN);
194
195
196 memmove(skb->data, skb->data + VLAN_HLEN, 2 * ETH_ALEN);
197 skb->mac_header -= VLAN_HLEN;
198
199
200 veth->h_vlan_proto = vlan_proto;
201
202
203 veth->h_vlan_TCI = htons(vlan_tci);
204
205 return skb;
206}
207
208
209
210
211
212
213
214
215
216
217
218
219static inline struct sk_buff *__vlan_put_tag(struct sk_buff *skb,
220 __be16 vlan_proto, u16 vlan_tci)
221{
222 skb = vlan_insert_tag(skb, vlan_proto, vlan_tci);
223 if (skb)
224 skb->protocol = vlan_proto;
225 return skb;
226}
227
228
229
230
231
232
233
234
235
236static inline struct sk_buff *__vlan_hwaccel_put_tag(struct sk_buff *skb,
237 __be16 vlan_proto,
238 u16 vlan_tci)
239{
240 skb->vlan_proto = vlan_proto;
241 skb->vlan_tci = VLAN_TAG_PRESENT | vlan_tci;
242 return skb;
243}
244
245
246
247
248
249
250
251
252
253static inline struct sk_buff *vlan_put_tag(struct sk_buff *skb,
254 __be16 vlan_proto, u16 vlan_tci)
255{
256 if (vlan_hw_offload_capable(skb->dev->features, vlan_proto)) {
257 return __vlan_hwaccel_put_tag(skb, vlan_proto, vlan_tci);
258 } else {
259 return __vlan_put_tag(skb, vlan_proto, vlan_tci);
260 }
261}
262
263
264
265
266
267
268
269
270static inline int __vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
271{
272 struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb->data;
273
274 if (veth->h_vlan_proto != htons(ETH_P_8021Q) &&
275 veth->h_vlan_proto != htons(ETH_P_8021AD))
276 return -EINVAL;
277
278 *vlan_tci = ntohs(veth->h_vlan_TCI);
279 return 0;
280}
281
282
283
284
285
286
287
288
289static inline int __vlan_hwaccel_get_tag(const struct sk_buff *skb,
290 u16 *vlan_tci)
291{
292 if (vlan_tx_tag_present(skb)) {
293 *vlan_tci = vlan_tx_tag_get(skb);
294 return 0;
295 } else {
296 *vlan_tci = 0;
297 return -EINVAL;
298 }
299}
300
301#define HAVE_VLAN_GET_TAG
302
303
304
305
306
307
308
309
310static inline int vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
311{
312 if (skb->dev->features & NETIF_F_HW_VLAN_CTAG_TX) {
313 return __vlan_hwaccel_get_tag(skb, vlan_tci);
314 } else {
315 return __vlan_get_tag(skb, vlan_tci);
316 }
317}
318
319
320
321
322
323
324
325
326static inline __be16 vlan_get_protocol(const struct sk_buff *skb)
327{
328 __be16 protocol = 0;
329
330 if (vlan_tx_tag_present(skb) ||
331 skb->protocol != cpu_to_be16(ETH_P_8021Q))
332 protocol = skb->protocol;
333 else {
334 __be16 proto, *protop;
335 protop = skb_header_pointer(skb, offsetof(struct vlan_ethhdr,
336 h_vlan_encapsulated_proto),
337 sizeof(proto), &proto);
338 if (likely(protop))
339 protocol = *protop;
340 }
341
342 return protocol;
343}
344
345static inline void vlan_set_encap_proto(struct sk_buff *skb,
346 struct vlan_hdr *vhdr)
347{
348 __be16 proto;
349 unsigned short *rawp;
350
351
352
353
354
355
356 proto = vhdr->h_vlan_encapsulated_proto;
357 if (ntohs(proto) >= ETH_P_802_3_MIN) {
358 skb->protocol = proto;
359 return;
360 }
361
362 rawp = (unsigned short *)(vhdr + 1);
363 if (*rawp == 0xFFFF)
364
365
366
367
368
369
370
371 skb->protocol = htons(ETH_P_802_3);
372 else
373
374
375
376 skb->protocol = htons(ETH_P_802_2);
377}
378#endif
379