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 bool is_vlan_dev(const struct net_device *dev)
77{
78 return dev->priv_flags & IFF_802_1Q_VLAN;
79}
80
81#define skb_vlan_tag_present(__skb) ((__skb)->vlan_tci & VLAN_TAG_PRESENT)
82#define skb_vlan_tag_get(__skb) ((__skb)->vlan_tci & ~VLAN_TAG_PRESENT)
83#define skb_vlan_tag_get_id(__skb) ((__skb)->vlan_tci & VLAN_VID_MASK)
84
85
86
87
88
89
90
91
92
93
94
95
96struct vlan_pcpu_stats {
97 u64 rx_packets;
98 u64 rx_bytes;
99 u64 rx_multicast;
100 u64 tx_packets;
101 u64 tx_bytes;
102 struct u64_stats_sync syncp;
103 u32 rx_errors;
104 u32 tx_dropped;
105};
106
107#if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
108
109extern struct net_device *__vlan_find_dev_deep_rcu(struct net_device *real_dev,
110 __be16 vlan_proto, u16 vlan_id);
111extern struct net_device *vlan_dev_real_dev(const struct net_device *dev);
112extern u16 vlan_dev_vlan_id(const struct net_device *dev);
113extern __be16 vlan_dev_vlan_proto(const struct net_device *dev);
114
115
116
117
118
119
120
121struct vlan_priority_tci_mapping {
122 u32 priority;
123 u16 vlan_qos;
124 struct vlan_priority_tci_mapping *next;
125};
126
127struct proc_dir_entry;
128struct netpoll;
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144struct vlan_dev_priv {
145 unsigned int nr_ingress_mappings;
146 u32 ingress_priority_map[8];
147 unsigned int nr_egress_mappings;
148 struct vlan_priority_tci_mapping *egress_priority_map[16];
149
150 __be16 vlan_proto;
151 u16 vlan_id;
152 u16 flags;
153
154 struct net_device *real_dev;
155 unsigned char real_dev_addr[ETH_ALEN];
156
157 struct proc_dir_entry *dent;
158 struct vlan_pcpu_stats __percpu *vlan_pcpu_stats;
159#ifdef CONFIG_NET_POLL_CONTROLLER
160 struct netpoll *netpoll;
161#endif
162 unsigned int nest_level;
163};
164
165static inline struct vlan_dev_priv *vlan_dev_priv(const struct net_device *dev)
166{
167 return netdev_priv(dev);
168}
169
170static inline u16
171vlan_dev_get_egress_qos_mask(struct net_device *dev, u32 skprio)
172{
173 struct vlan_priority_tci_mapping *mp;
174
175 smp_rmb();
176
177 mp = vlan_dev_priv(dev)->egress_priority_map[(skprio & 0xF)];
178 while (mp) {
179 if (mp->priority == skprio) {
180 return mp->vlan_qos;
181
182
183 }
184 mp = mp->next;
185 }
186 return 0;
187}
188
189extern bool vlan_do_receive(struct sk_buff **skb);
190
191extern int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid);
192extern void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid);
193
194extern int vlan_vids_add_by_dev(struct net_device *dev,
195 const struct net_device *by_dev);
196extern void vlan_vids_del_by_dev(struct net_device *dev,
197 const struct net_device *by_dev);
198
199extern bool vlan_uses_dev(const struct net_device *dev);
200
201static inline int vlan_get_encap_level(struct net_device *dev)
202{
203 BUG_ON(!is_vlan_dev(dev));
204 return vlan_dev_priv(dev)->nest_level;
205}
206#else
207static inline struct net_device *
208__vlan_find_dev_deep_rcu(struct net_device *real_dev,
209 __be16 vlan_proto, u16 vlan_id)
210{
211 return NULL;
212}
213
214static inline struct net_device *vlan_dev_real_dev(const struct net_device *dev)
215{
216 BUG();
217 return NULL;
218}
219
220static inline u16 vlan_dev_vlan_id(const struct net_device *dev)
221{
222 BUG();
223 return 0;
224}
225
226static inline __be16 vlan_dev_vlan_proto(const struct net_device *dev)
227{
228 BUG();
229 return 0;
230}
231
232static inline u16 vlan_dev_get_egress_qos_mask(struct net_device *dev,
233 u32 skprio)
234{
235 return 0;
236}
237
238static inline bool vlan_do_receive(struct sk_buff **skb)
239{
240 return false;
241}
242
243static inline int vlan_vid_add(struct net_device *dev, __be16 proto, u16 vid)
244{
245 return 0;
246}
247
248static inline void vlan_vid_del(struct net_device *dev, __be16 proto, u16 vid)
249{
250}
251
252static inline int vlan_vids_add_by_dev(struct net_device *dev,
253 const struct net_device *by_dev)
254{
255 return 0;
256}
257
258static inline void vlan_vids_del_by_dev(struct net_device *dev,
259 const struct net_device *by_dev)
260{
261}
262
263static inline bool vlan_uses_dev(const struct net_device *dev)
264{
265 return false;
266}
267static inline int vlan_get_encap_level(struct net_device *dev)
268{
269 BUG();
270 return 0;
271}
272#endif
273
274static inline bool vlan_hw_offload_capable(netdev_features_t features,
275 __be16 proto)
276{
277 if (proto == htons(ETH_P_8021Q) && features & NETIF_F_HW_VLAN_CTAG_TX)
278 return true;
279 if (proto == htons(ETH_P_8021AD) && features & NETIF_F_HW_VLAN_STAG_TX)
280 return true;
281 return false;
282}
283
284
285
286
287
288
289
290
291
292
293
294
295static inline int __vlan_insert_tag(struct sk_buff *skb,
296 __be16 vlan_proto, u16 vlan_tci)
297{
298 struct vlan_ethhdr *veth;
299
300 if (skb_cow_head(skb, VLAN_HLEN) < 0)
301 return -ENOMEM;
302
303 veth = (struct vlan_ethhdr *)skb_push(skb, VLAN_HLEN);
304
305
306 memmove(skb->data, skb->data + VLAN_HLEN, 2 * ETH_ALEN);
307 skb->mac_header -= VLAN_HLEN;
308
309
310 veth->h_vlan_proto = vlan_proto;
311
312
313 veth->h_vlan_TCI = htons(vlan_tci);
314
315 return 0;
316}
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332static inline struct sk_buff *vlan_insert_tag(struct sk_buff *skb,
333 __be16 vlan_proto, u16 vlan_tci)
334{
335 int err;
336
337 err = __vlan_insert_tag(skb, vlan_proto, vlan_tci);
338 if (err) {
339 dev_kfree_skb_any(skb);
340 return NULL;
341 }
342 return skb;
343}
344
345
346
347
348
349
350
351
352
353
354
355
356
357static inline struct sk_buff *vlan_insert_tag_set_proto(struct sk_buff *skb,
358 __be16 vlan_proto,
359 u16 vlan_tci)
360{
361 skb = vlan_insert_tag(skb, vlan_proto, vlan_tci);
362 if (skb)
363 skb->protocol = vlan_proto;
364 return skb;
365}
366
367
368
369
370
371
372
373
374
375
376static inline struct sk_buff *__vlan_hwaccel_push_inside(struct sk_buff *skb)
377{
378 skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto,
379 skb_vlan_tag_get(skb));
380 if (likely(skb))
381 skb->vlan_tci = 0;
382 return skb;
383}
384
385
386
387
388
389
390
391
392
393
394static inline struct sk_buff *vlan_hwaccel_push_inside(struct sk_buff *skb)
395{
396 if (skb_vlan_tag_present(skb))
397 skb = __vlan_hwaccel_push_inside(skb);
398 return skb;
399}
400
401
402
403
404
405
406
407
408
409static inline void __vlan_hwaccel_put_tag(struct sk_buff *skb,
410 __be16 vlan_proto, u16 vlan_tci)
411{
412 skb->vlan_proto = vlan_proto;
413 skb->vlan_tci = VLAN_TAG_PRESENT | vlan_tci;
414}
415
416
417
418
419
420
421
422
423static inline int __vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
424{
425 struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb->data;
426
427 if (veth->h_vlan_proto != htons(ETH_P_8021Q) &&
428 veth->h_vlan_proto != htons(ETH_P_8021AD))
429 return -EINVAL;
430
431 *vlan_tci = ntohs(veth->h_vlan_TCI);
432 return 0;
433}
434
435
436
437
438
439
440
441
442static inline int __vlan_hwaccel_get_tag(const struct sk_buff *skb,
443 u16 *vlan_tci)
444{
445 if (skb_vlan_tag_present(skb)) {
446 *vlan_tci = skb_vlan_tag_get(skb);
447 return 0;
448 } else {
449 *vlan_tci = 0;
450 return -EINVAL;
451 }
452}
453
454#define HAVE_VLAN_GET_TAG
455
456
457
458
459
460
461
462
463static inline int vlan_get_tag(const struct sk_buff *skb, u16 *vlan_tci)
464{
465 if (skb->dev->features & NETIF_F_HW_VLAN_CTAG_TX) {
466 return __vlan_hwaccel_get_tag(skb, vlan_tci);
467 } else {
468 return __vlan_get_tag(skb, vlan_tci);
469 }
470}
471
472
473
474
475
476
477
478
479
480
481static inline __be16 __vlan_get_protocol(struct sk_buff *skb, __be16 type,
482 int *depth)
483{
484 unsigned int vlan_depth = skb->mac_len;
485
486
487
488
489
490 if (type == htons(ETH_P_8021Q) || type == htons(ETH_P_8021AD)) {
491 if (vlan_depth) {
492 if (WARN_ON(vlan_depth < VLAN_HLEN))
493 return 0;
494 vlan_depth -= VLAN_HLEN;
495 } else {
496 vlan_depth = ETH_HLEN;
497 }
498 do {
499 struct vlan_hdr *vh;
500
501 if (unlikely(!pskb_may_pull(skb,
502 vlan_depth + VLAN_HLEN)))
503 return 0;
504
505 vh = (struct vlan_hdr *)(skb->data + vlan_depth);
506 type = vh->h_vlan_encapsulated_proto;
507 vlan_depth += VLAN_HLEN;
508 } while (type == htons(ETH_P_8021Q) ||
509 type == htons(ETH_P_8021AD));
510 }
511
512 if (depth)
513 *depth = vlan_depth;
514
515 return type;
516}
517
518
519
520
521
522
523
524
525static inline __be16 vlan_get_protocol(struct sk_buff *skb)
526{
527 return __vlan_get_protocol(skb, skb->protocol, NULL);
528}
529
530static inline void vlan_set_encap_proto(struct sk_buff *skb,
531 struct vlan_hdr *vhdr)
532{
533 __be16 proto;
534 unsigned short *rawp;
535
536
537
538
539
540
541 proto = vhdr->h_vlan_encapsulated_proto;
542 if (eth_proto_is_802_3(proto)) {
543 skb->protocol = proto;
544 return;
545 }
546
547 rawp = (unsigned short *)(vhdr + 1);
548 if (*rawp == 0xFFFF)
549
550
551
552
553
554
555
556 skb->protocol = htons(ETH_P_802_3);
557 else
558
559
560
561 skb->protocol = htons(ETH_P_802_2);
562}
563
564
565
566
567
568
569
570
571static inline bool skb_vlan_tagged(const struct sk_buff *skb)
572{
573 if (!skb_vlan_tag_present(skb) &&
574 likely(skb->protocol != htons(ETH_P_8021Q) &&
575 skb->protocol != htons(ETH_P_8021AD)))
576 return false;
577
578 return true;
579}
580
581
582
583
584
585
586
587
588static inline bool skb_vlan_tagged_multi(const struct sk_buff *skb)
589{
590 __be16 protocol = skb->protocol;
591
592 if (!skb_vlan_tag_present(skb)) {
593 struct vlan_ethhdr *veh;
594
595 if (likely(protocol != htons(ETH_P_8021Q) &&
596 protocol != htons(ETH_P_8021AD)))
597 return false;
598
599 veh = (struct vlan_ethhdr *)skb->data;
600 protocol = veh->h_vlan_encapsulated_proto;
601 }
602
603 if (protocol != htons(ETH_P_8021Q) && protocol != htons(ETH_P_8021AD))
604 return false;
605
606 return true;
607}
608
609
610
611
612
613
614
615
616static inline netdev_features_t vlan_features_check(const struct sk_buff *skb,
617 netdev_features_t features)
618{
619 if (skb_vlan_tagged_multi(skb))
620 features = netdev_intersect_features(features,
621 NETIF_F_SG |
622 NETIF_F_HIGHDMA |
623 NETIF_F_FRAGLIST |
624 NETIF_F_HW_CSUM |
625 NETIF_F_HW_VLAN_CTAG_TX |
626 NETIF_F_HW_VLAN_STAG_TX);
627
628 return features;
629}
630
631
632
633
634
635
636
637
638
639
640static inline unsigned long compare_vlan_header(const struct vlan_hdr *h1,
641 const struct vlan_hdr *h2)
642{
643#if defined(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)
644 return *(u32 *)h1 ^ *(u32 *)h2;
645#else
646 return ((__force u32)h1->h_vlan_TCI ^ (__force u32)h2->h_vlan_TCI) |
647 ((__force u32)h1->h_vlan_encapsulated_proto ^
648 (__force u32)h2->h_vlan_encapsulated_proto);
649#endif
650}
651#endif
652