3 * Ethernet-type device handling.
5 * Authors: Ben Greear <greearb@candelatech.com>
6 * Please send support related email to: netdev@vger.kernel.org
7 * VLAN Home Page: http://www.candelatech.com/~greear/vlan.html
9 * Fixes: Mar 22 2001: Martin Bokaemper <mbokaemper@unispherenetworks.com>
10 * - reset skb->pkt_type on incoming packets when MAC was changed
11 * - see that changed MAC is saddr for outgoing packets
12 * Oct 20, 2001: Ard van Breeman:
13 * - Fix MC-list, finally.
14 * - Flush MC-list on VLAN destroy.
17 * This program is free software; you can redistribute it and/or
18 * modify it under the terms of the GNU General Public License
19 * as published by the Free Software Foundation; either version
20 * 2 of the License, or (at your option) any later version.
23 #include <linux/module.h>
24 #include <linux/slab.h>
25 #include <linux/skbuff.h>
26 #include <linux/netdevice.h>
27 #include <linux/etherdevice.h>
28 #include <linux/ethtool.h>
33 #include <linux/if_vlan.h>
36 * Rebuild the Ethernet MAC header. This is called after an ARP
37 * (or in future other address resolution) has completed on this
38 * sk_buff. We now let ARP fill in the other fields.
40 * This routine CANNOT use cached dst->neigh!
41 * Really, it is used only when dst->neigh is wrong.
43 * TODO: This needs a checkup, I'm ignorant here. --BLG
45 static int vlan_dev_rebuild_header(struct sk_buff
*skb
)
47 struct net_device
*dev
= skb
->dev
;
48 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)(skb
->data
);
50 switch (veth
->h_vlan_encapsulated_proto
) {
54 /* TODO: Confirm this will work with VLAN headers... */
55 return arp_find(veth
->h_dest
, skb
);
58 pr_debug("%s: unable to resolve type %X addresses.\n",
59 dev
->name
, ntohs(veth
->h_vlan_encapsulated_proto
));
61 memcpy(veth
->h_source
, dev
->dev_addr
, ETH_ALEN
);
68 static inline struct sk_buff
*vlan_check_reorder_header(struct sk_buff
*skb
)
70 if (vlan_dev_info(skb
->dev
)->flags
& VLAN_FLAG_REORDER_HDR
) {
71 if (skb_cow(skb
, skb_headroom(skb
)) < 0)
74 /* Lifted from Gleb's VLAN code... */
75 memmove(skb
->data
- ETH_HLEN
,
76 skb
->data
- VLAN_ETH_HLEN
, 12);
77 skb
->mac_header
+= VLAN_HLEN
;
84 static inline void vlan_set_encap_proto(struct sk_buff
*skb
,
85 struct vlan_hdr
*vhdr
)
91 * Was a VLAN packet, grab the encapsulated protocol, which the layer
92 * three protocols care about.
95 proto
= vhdr
->h_vlan_encapsulated_proto
;
96 if (ntohs(proto
) >= 1536) {
97 skb
->protocol
= proto
;
102 if (*(unsigned short *)rawp
== 0xFFFF)
104 * This is a magic hack to spot IPX packets. Older Novell
105 * breaks the protocol design and runs IPX over 802.3 without
106 * an 802.2 LLC layer. We look for FFFF which isn't a used
107 * 802.2 SSAP/DSAP. This won't work for fault tolerant netware
108 * but does for the rest.
110 skb
->protocol
= htons(ETH_P_802_3
);
115 skb
->protocol
= htons(ETH_P_802_2
);
119 * Determine the packet's protocol ID. The rule here is that we
120 * assume 802.3 if the type field is short enough to be a length.
121 * This is normal practice and works for any 'now in use' protocol.
123 * Also, at this point we assume that we ARE dealing exclusively with
124 * VLAN packets, or packets that should be made into VLAN packets based
125 * on a default VLAN ID.
127 * NOTE: Should be similar to ethernet/eth.c.
129 * SANITY NOTE: This method is called when a packet is moving up the stack
130 * towards userland. To get here, it would have already passed
131 * through the ethernet/eth.c eth_type_trans() method.
132 * SANITY NOTE 2: We are referencing to the VLAN_HDR frields, which MAY be
133 * stored UNALIGNED in the memory. RISC systems don't like
134 * such cases very much...
135 * SANITY NOTE 2a: According to Dave Miller & Alexey, it will always be
136 * aligned, so there doesn't need to be any of the unaligned
137 * stuff. It has been commented out now... --Ben
140 int vlan_skb_recv(struct sk_buff
*skb
, struct net_device
*dev
,
141 struct packet_type
*ptype
, struct net_device
*orig_dev
)
143 struct vlan_hdr
*vhdr
;
144 struct vlan_pcpu_stats
*rx_stats
;
145 struct net_device
*vlan_dev
;
149 skb
= skb_share_check(skb
, GFP_ATOMIC
);
153 if (unlikely(!pskb_may_pull(skb
, VLAN_HLEN
)))
156 vhdr
= (struct vlan_hdr
*)skb
->data
;
157 vlan_tci
= ntohs(vhdr
->h_vlan_TCI
);
158 vlan_id
= vlan_tci
& VLAN_VID_MASK
;
161 vlan_dev
= vlan_find_dev(dev
, vlan_id
);
163 /* If the VLAN device is defined, we use it.
164 * If not, and the VID is 0, it is a 802.1p packet (not
165 * really a VLAN), so we will just netif_rx it later to the
166 * original interface, but with the skb->proto set to the
167 * wrapped proto: we do nothing here.
172 pr_debug("%s: ERROR: No net_device for VID: %u on dev: %s\n",
173 __func__
, vlan_id
, dev
->name
);
180 rx_stats
= this_cpu_ptr(vlan_dev_info(skb
->dev
)->vlan_pcpu_stats
);
182 u64_stats_update_begin(&rx_stats
->syncp
);
183 rx_stats
->rx_packets
++;
184 rx_stats
->rx_bytes
+= skb
->len
;
186 skb
->priority
= vlan_get_ingress_priority(skb
->dev
, vlan_tci
);
188 pr_debug("%s: priority: %u for TCI: %hu\n",
189 __func__
, skb
->priority
, vlan_tci
);
191 switch (skb
->pkt_type
) {
192 case PACKET_BROADCAST
:
193 /* Yeah, stats collect these together.. */
194 /* stats->broadcast ++; // no such counter :-( */
197 case PACKET_MULTICAST
:
198 rx_stats
->rx_multicast
++;
201 case PACKET_OTHERHOST
:
202 /* Our lower layer thinks this is not local, let's make
204 * This allows the VLAN to have a different MAC than the
205 * underlying device, and still route correctly.
207 if (!compare_ether_addr(eth_hdr(skb
)->h_dest
,
209 skb
->pkt_type
= PACKET_HOST
;
214 u64_stats_update_end(&rx_stats
->syncp
);
217 skb_pull_rcsum(skb
, VLAN_HLEN
);
218 vlan_set_encap_proto(skb
, vhdr
);
221 skb
= vlan_check_reorder_header(skb
);
223 rx_stats
->rx_errors
++;
231 return NET_RX_SUCCESS
;
236 atomic_long_inc(&dev
->rx_dropped
);
242 vlan_dev_get_egress_qos_mask(struct net_device
*dev
, struct sk_buff
*skb
)
244 struct vlan_priority_tci_mapping
*mp
;
246 mp
= vlan_dev_info(dev
)->egress_priority_map
[(skb
->priority
& 0xF)];
248 if (mp
->priority
== skb
->priority
) {
249 return mp
->vlan_qos
; /* This should already be shifted
250 * to mask correctly with the
259 * Create the VLAN header for an arbitrary protocol layer
261 * saddr=NULL means use device source address
262 * daddr=NULL means leave destination address (eg unresolved arp)
264 * This is called when the SKB is moving down the stack towards the
267 static int vlan_dev_hard_header(struct sk_buff
*skb
, struct net_device
*dev
,
269 const void *daddr
, const void *saddr
,
272 struct vlan_hdr
*vhdr
;
273 unsigned int vhdrlen
= 0;
277 if (!(vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
)) {
278 vhdr
= (struct vlan_hdr
*) skb_push(skb
, VLAN_HLEN
);
280 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
281 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
282 vhdr
->h_vlan_TCI
= htons(vlan_tci
);
285 * Set the protocol type. For a packet of type ETH_P_802_3/2 we
286 * put the length in here instead.
288 if (type
!= ETH_P_802_3
&& type
!= ETH_P_802_2
)
289 vhdr
->h_vlan_encapsulated_proto
= htons(type
);
291 vhdr
->h_vlan_encapsulated_proto
= htons(len
);
293 skb
->protocol
= htons(ETH_P_8021Q
);
298 /* Before delegating work to the lower layer, enter our MAC-address */
300 saddr
= dev
->dev_addr
;
302 /* Now make the underlying real hard header */
303 dev
= vlan_dev_info(dev
)->real_dev
;
304 rc
= dev_hard_header(skb
, dev
, type
, daddr
, saddr
, len
+ vhdrlen
);
310 static netdev_tx_t
vlan_dev_hard_start_xmit(struct sk_buff
*skb
,
311 struct net_device
*dev
)
313 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)(skb
->data
);
317 /* Handle non-VLAN frames if they are sent to us, for example by DHCP.
319 * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING
320 * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs...
322 if (veth
->h_vlan_proto
!= htons(ETH_P_8021Q
) ||
323 vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
) {
325 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
326 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
327 skb
= __vlan_hwaccel_put_tag(skb
, vlan_tci
);
330 skb_set_dev(skb
, vlan_dev_info(dev
)->real_dev
);
332 ret
= dev_queue_xmit(skb
);
334 if (likely(ret
== NET_XMIT_SUCCESS
|| ret
== NET_XMIT_CN
)) {
335 struct vlan_pcpu_stats
*stats
;
337 stats
= this_cpu_ptr(vlan_dev_info(dev
)->vlan_pcpu_stats
);
338 u64_stats_update_begin(&stats
->syncp
);
340 stats
->tx_bytes
+= len
;
341 u64_stats_update_begin(&stats
->syncp
);
343 this_cpu_inc(vlan_dev_info(dev
)->vlan_pcpu_stats
->tx_dropped
);
349 static u16
vlan_dev_select_queue(struct net_device
*dev
, struct sk_buff
*skb
)
351 struct net_device
*rdev
= vlan_dev_info(dev
)->real_dev
;
352 const struct net_device_ops
*ops
= rdev
->netdev_ops
;
354 return ops
->ndo_select_queue(rdev
, skb
);
357 static int vlan_dev_change_mtu(struct net_device
*dev
, int new_mtu
)
359 /* TODO: gotta make sure the underlying layer can handle it,
360 * maybe an IFF_VLAN_CAPABLE flag for devices?
362 if (vlan_dev_info(dev
)->real_dev
->mtu
< new_mtu
)
370 void vlan_dev_set_ingress_priority(const struct net_device
*dev
,
371 u32 skb_prio
, u16 vlan_prio
)
373 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
375 if (vlan
->ingress_priority_map
[vlan_prio
& 0x7] && !skb_prio
)
376 vlan
->nr_ingress_mappings
--;
377 else if (!vlan
->ingress_priority_map
[vlan_prio
& 0x7] && skb_prio
)
378 vlan
->nr_ingress_mappings
++;
380 vlan
->ingress_priority_map
[vlan_prio
& 0x7] = skb_prio
;
383 int vlan_dev_set_egress_priority(const struct net_device
*dev
,
384 u32 skb_prio
, u16 vlan_prio
)
386 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
387 struct vlan_priority_tci_mapping
*mp
= NULL
;
388 struct vlan_priority_tci_mapping
*np
;
389 u32 vlan_qos
= (vlan_prio
<< VLAN_PRIO_SHIFT
) & VLAN_PRIO_MASK
;
391 /* See if a priority mapping exists.. */
392 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
394 if (mp
->priority
== skb_prio
) {
395 if (mp
->vlan_qos
&& !vlan_qos
)
396 vlan
->nr_egress_mappings
--;
397 else if (!mp
->vlan_qos
&& vlan_qos
)
398 vlan
->nr_egress_mappings
++;
399 mp
->vlan_qos
= vlan_qos
;
405 /* Create a new mapping then. */
406 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
407 np
= kmalloc(sizeof(struct vlan_priority_tci_mapping
), GFP_KERNEL
);
412 np
->priority
= skb_prio
;
413 np
->vlan_qos
= vlan_qos
;
414 vlan
->egress_priority_map
[skb_prio
& 0xF] = np
;
416 vlan
->nr_egress_mappings
++;
420 /* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */
421 int vlan_dev_change_flags(const struct net_device
*dev
, u32 flags
, u32 mask
)
423 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
424 u32 old_flags
= vlan
->flags
;
426 if (mask
& ~(VLAN_FLAG_REORDER_HDR
| VLAN_FLAG_GVRP
|
427 VLAN_FLAG_LOOSE_BINDING
))
430 vlan
->flags
= (old_flags
& ~mask
) | (flags
& mask
);
432 if (netif_running(dev
) && (vlan
->flags
^ old_flags
) & VLAN_FLAG_GVRP
) {
433 if (vlan
->flags
& VLAN_FLAG_GVRP
)
434 vlan_gvrp_request_join(dev
);
436 vlan_gvrp_request_leave(dev
);
441 void vlan_dev_get_realdev_name(const struct net_device
*dev
, char *result
)
443 strncpy(result
, vlan_dev_info(dev
)->real_dev
->name
, 23);
446 static int vlan_dev_open(struct net_device
*dev
)
448 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
449 struct net_device
*real_dev
= vlan
->real_dev
;
452 if (!(real_dev
->flags
& IFF_UP
) &&
453 !(vlan
->flags
& VLAN_FLAG_LOOSE_BINDING
))
456 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
)) {
457 err
= dev_uc_add(real_dev
, dev
->dev_addr
);
462 if (dev
->flags
& IFF_ALLMULTI
) {
463 err
= dev_set_allmulti(real_dev
, 1);
467 if (dev
->flags
& IFF_PROMISC
) {
468 err
= dev_set_promiscuity(real_dev
, 1);
473 memcpy(vlan
->real_dev_addr
, real_dev
->dev_addr
, ETH_ALEN
);
475 if (vlan
->flags
& VLAN_FLAG_GVRP
)
476 vlan_gvrp_request_join(dev
);
478 if (netif_carrier_ok(real_dev
))
479 netif_carrier_on(dev
);
483 if (dev
->flags
& IFF_ALLMULTI
)
484 dev_set_allmulti(real_dev
, -1);
486 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
487 dev_uc_del(real_dev
, dev
->dev_addr
);
489 netif_carrier_off(dev
);
493 static int vlan_dev_stop(struct net_device
*dev
)
495 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
496 struct net_device
*real_dev
= vlan
->real_dev
;
498 if (vlan
->flags
& VLAN_FLAG_GVRP
)
499 vlan_gvrp_request_leave(dev
);
501 dev_mc_unsync(real_dev
, dev
);
502 dev_uc_unsync(real_dev
, dev
);
503 if (dev
->flags
& IFF_ALLMULTI
)
504 dev_set_allmulti(real_dev
, -1);
505 if (dev
->flags
& IFF_PROMISC
)
506 dev_set_promiscuity(real_dev
, -1);
508 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
509 dev_uc_del(real_dev
, dev
->dev_addr
);
511 netif_carrier_off(dev
);
515 static int vlan_dev_set_mac_address(struct net_device
*dev
, void *p
)
517 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
518 struct sockaddr
*addr
= p
;
521 if (!is_valid_ether_addr(addr
->sa_data
))
522 return -EADDRNOTAVAIL
;
524 if (!(dev
->flags
& IFF_UP
))
527 if (compare_ether_addr(addr
->sa_data
, real_dev
->dev_addr
)) {
528 err
= dev_uc_add(real_dev
, addr
->sa_data
);
533 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
534 dev_uc_del(real_dev
, dev
->dev_addr
);
537 memcpy(dev
->dev_addr
, addr
->sa_data
, ETH_ALEN
);
541 static int vlan_dev_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
543 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
544 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
546 int err
= -EOPNOTSUPP
;
548 strncpy(ifrr
.ifr_name
, real_dev
->name
, IFNAMSIZ
);
549 ifrr
.ifr_ifru
= ifr
->ifr_ifru
;
555 if (netif_device_present(real_dev
) && ops
->ndo_do_ioctl
)
556 err
= ops
->ndo_do_ioctl(real_dev
, &ifrr
, cmd
);
561 ifr
->ifr_ifru
= ifrr
.ifr_ifru
;
566 static int vlan_dev_neigh_setup(struct net_device
*dev
, struct neigh_parms
*pa
)
568 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
569 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
572 if (netif_device_present(real_dev
) && ops
->ndo_neigh_setup
)
573 err
= ops
->ndo_neigh_setup(real_dev
, pa
);
578 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
579 static int vlan_dev_fcoe_ddp_setup(struct net_device
*dev
, u16 xid
,
580 struct scatterlist
*sgl
, unsigned int sgc
)
582 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
583 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
586 if (ops
->ndo_fcoe_ddp_setup
)
587 rc
= ops
->ndo_fcoe_ddp_setup(real_dev
, xid
, sgl
, sgc
);
592 static int vlan_dev_fcoe_ddp_done(struct net_device
*dev
, u16 xid
)
594 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
595 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
598 if (ops
->ndo_fcoe_ddp_done
)
599 len
= ops
->ndo_fcoe_ddp_done(real_dev
, xid
);
604 static int vlan_dev_fcoe_enable(struct net_device
*dev
)
606 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
607 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
610 if (ops
->ndo_fcoe_enable
)
611 rc
= ops
->ndo_fcoe_enable(real_dev
);
615 static int vlan_dev_fcoe_disable(struct net_device
*dev
)
617 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
618 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
621 if (ops
->ndo_fcoe_disable
)
622 rc
= ops
->ndo_fcoe_disable(real_dev
);
626 static int vlan_dev_fcoe_get_wwn(struct net_device
*dev
, u64
*wwn
, int type
)
628 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
629 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
632 if (ops
->ndo_fcoe_get_wwn
)
633 rc
= ops
->ndo_fcoe_get_wwn(real_dev
, wwn
, type
);
638 static void vlan_dev_change_rx_flags(struct net_device
*dev
, int change
)
640 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
642 if (change
& IFF_ALLMULTI
)
643 dev_set_allmulti(real_dev
, dev
->flags
& IFF_ALLMULTI
? 1 : -1);
644 if (change
& IFF_PROMISC
)
645 dev_set_promiscuity(real_dev
, dev
->flags
& IFF_PROMISC
? 1 : -1);
648 static void vlan_dev_set_rx_mode(struct net_device
*vlan_dev
)
650 dev_mc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
651 dev_uc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
655 * vlan network devices have devices nesting below it, and are a special
656 * "super class" of normal network devices; split their locks off into a
657 * separate class since they always nest.
659 static struct lock_class_key vlan_netdev_xmit_lock_key
;
660 static struct lock_class_key vlan_netdev_addr_lock_key
;
662 static void vlan_dev_set_lockdep_one(struct net_device
*dev
,
663 struct netdev_queue
*txq
,
666 lockdep_set_class_and_subclass(&txq
->_xmit_lock
,
667 &vlan_netdev_xmit_lock_key
,
671 static void vlan_dev_set_lockdep_class(struct net_device
*dev
, int subclass
)
673 lockdep_set_class_and_subclass(&dev
->addr_list_lock
,
674 &vlan_netdev_addr_lock_key
,
676 netdev_for_each_tx_queue(dev
, vlan_dev_set_lockdep_one
, &subclass
);
679 static const struct header_ops vlan_header_ops
= {
680 .create
= vlan_dev_hard_header
,
681 .rebuild
= vlan_dev_rebuild_header
,
682 .parse
= eth_header_parse
,
685 static const struct net_device_ops vlan_netdev_ops
, vlan_netdev_ops_sq
;
687 static int vlan_dev_init(struct net_device
*dev
)
689 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
692 netif_carrier_off(dev
);
694 /* IFF_BROADCAST|IFF_MULTICAST; ??? */
695 dev
->flags
= real_dev
->flags
& ~(IFF_UP
| IFF_PROMISC
| IFF_ALLMULTI
|
696 IFF_MASTER
| IFF_SLAVE
);
697 dev
->iflink
= real_dev
->ifindex
;
698 dev
->state
= (real_dev
->state
& ((1<<__LINK_STATE_NOCARRIER
) |
699 (1<<__LINK_STATE_DORMANT
))) |
700 (1<<__LINK_STATE_PRESENT
);
702 dev
->features
|= real_dev
->features
& real_dev
->vlan_features
;
703 dev
->features
|= NETIF_F_LLTX
;
704 dev
->gso_max_size
= real_dev
->gso_max_size
;
706 /* ipv6 shared card related stuff */
707 dev
->dev_id
= real_dev
->dev_id
;
709 if (is_zero_ether_addr(dev
->dev_addr
))
710 memcpy(dev
->dev_addr
, real_dev
->dev_addr
, dev
->addr_len
);
711 if (is_zero_ether_addr(dev
->broadcast
))
712 memcpy(dev
->broadcast
, real_dev
->broadcast
, dev
->addr_len
);
714 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
715 dev
->fcoe_ddp_xid
= real_dev
->fcoe_ddp_xid
;
718 if (real_dev
->features
& NETIF_F_HW_VLAN_TX
) {
719 dev
->header_ops
= real_dev
->header_ops
;
720 dev
->hard_header_len
= real_dev
->hard_header_len
;
722 dev
->header_ops
= &vlan_header_ops
;
723 dev
->hard_header_len
= real_dev
->hard_header_len
+ VLAN_HLEN
;
726 if (real_dev
->netdev_ops
->ndo_select_queue
)
727 dev
->netdev_ops
= &vlan_netdev_ops_sq
;
729 dev
->netdev_ops
= &vlan_netdev_ops
;
731 if (is_vlan_dev(real_dev
))
734 vlan_dev_set_lockdep_class(dev
, subclass
);
736 vlan_dev_info(dev
)->vlan_pcpu_stats
= alloc_percpu(struct vlan_pcpu_stats
);
737 if (!vlan_dev_info(dev
)->vlan_pcpu_stats
)
743 static void vlan_dev_uninit(struct net_device
*dev
)
745 struct vlan_priority_tci_mapping
*pm
;
746 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
749 free_percpu(vlan
->vlan_pcpu_stats
);
750 vlan
->vlan_pcpu_stats
= NULL
;
751 for (i
= 0; i
< ARRAY_SIZE(vlan
->egress_priority_map
); i
++) {
752 while ((pm
= vlan
->egress_priority_map
[i
]) != NULL
) {
753 vlan
->egress_priority_map
[i
] = pm
->next
;
759 static int vlan_ethtool_get_settings(struct net_device
*dev
,
760 struct ethtool_cmd
*cmd
)
762 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
763 return dev_ethtool_get_settings(vlan
->real_dev
, cmd
);
766 static void vlan_ethtool_get_drvinfo(struct net_device
*dev
,
767 struct ethtool_drvinfo
*info
)
769 strcpy(info
->driver
, vlan_fullname
);
770 strcpy(info
->version
, vlan_version
);
771 strcpy(info
->fw_version
, "N/A");
774 static u32
vlan_ethtool_get_rx_csum(struct net_device
*dev
)
776 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
777 return dev_ethtool_get_rx_csum(vlan
->real_dev
);
780 static u32
vlan_ethtool_get_flags(struct net_device
*dev
)
782 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
783 return dev_ethtool_get_flags(vlan
->real_dev
);
786 static struct rtnl_link_stats64
*vlan_dev_get_stats64(struct net_device
*dev
, struct rtnl_link_stats64
*stats
)
789 if (vlan_dev_info(dev
)->vlan_pcpu_stats
) {
790 struct vlan_pcpu_stats
*p
;
791 u32 rx_errors
= 0, tx_dropped
= 0;
794 for_each_possible_cpu(i
) {
795 u64 rxpackets
, rxbytes
, rxmulticast
, txpackets
, txbytes
;
798 p
= per_cpu_ptr(vlan_dev_info(dev
)->vlan_pcpu_stats
, i
);
800 start
= u64_stats_fetch_begin_bh(&p
->syncp
);
801 rxpackets
= p
->rx_packets
;
802 rxbytes
= p
->rx_bytes
;
803 rxmulticast
= p
->rx_multicast
;
804 txpackets
= p
->tx_packets
;
805 txbytes
= p
->tx_bytes
;
806 } while (u64_stats_fetch_retry_bh(&p
->syncp
, start
));
808 stats
->rx_packets
+= rxpackets
;
809 stats
->rx_bytes
+= rxbytes
;
810 stats
->multicast
+= rxmulticast
;
811 stats
->tx_packets
+= txpackets
;
812 stats
->tx_bytes
+= txbytes
;
813 /* rx_errors & tx_dropped are u32 */
814 rx_errors
+= p
->rx_errors
;
815 tx_dropped
+= p
->tx_dropped
;
817 stats
->rx_errors
= rx_errors
;
818 stats
->tx_dropped
= tx_dropped
;
823 static int vlan_ethtool_set_tso(struct net_device
*dev
, u32 data
)
826 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
828 /* Underlying device must support TSO for VLAN-tagged packets
829 * and must have TSO enabled now.
831 if (!(real_dev
->vlan_features
& NETIF_F_TSO
))
833 if (!(real_dev
->features
& NETIF_F_TSO
))
835 dev
->features
|= NETIF_F_TSO
;
837 dev
->features
&= ~NETIF_F_TSO
;
842 static const struct ethtool_ops vlan_ethtool_ops
= {
843 .get_settings
= vlan_ethtool_get_settings
,
844 .get_drvinfo
= vlan_ethtool_get_drvinfo
,
845 .get_link
= ethtool_op_get_link
,
846 .get_rx_csum
= vlan_ethtool_get_rx_csum
,
847 .get_flags
= vlan_ethtool_get_flags
,
848 .set_tso
= vlan_ethtool_set_tso
,
851 static const struct net_device_ops vlan_netdev_ops
= {
852 .ndo_change_mtu
= vlan_dev_change_mtu
,
853 .ndo_init
= vlan_dev_init
,
854 .ndo_uninit
= vlan_dev_uninit
,
855 .ndo_open
= vlan_dev_open
,
856 .ndo_stop
= vlan_dev_stop
,
857 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
858 .ndo_validate_addr
= eth_validate_addr
,
859 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
860 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
861 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
862 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
863 .ndo_do_ioctl
= vlan_dev_ioctl
,
864 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
865 .ndo_get_stats64
= vlan_dev_get_stats64
,
866 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
867 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
868 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
869 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
870 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
871 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
875 static const struct net_device_ops vlan_netdev_ops_sq
= {
876 .ndo_select_queue
= vlan_dev_select_queue
,
877 .ndo_change_mtu
= vlan_dev_change_mtu
,
878 .ndo_init
= vlan_dev_init
,
879 .ndo_uninit
= vlan_dev_uninit
,
880 .ndo_open
= vlan_dev_open
,
881 .ndo_stop
= vlan_dev_stop
,
882 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
883 .ndo_validate_addr
= eth_validate_addr
,
884 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
885 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
886 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
887 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
888 .ndo_do_ioctl
= vlan_dev_ioctl
,
889 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
890 .ndo_get_stats64
= vlan_dev_get_stats64
,
891 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
892 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
893 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
894 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
895 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
896 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
900 void vlan_setup(struct net_device
*dev
)
904 dev
->priv_flags
|= IFF_802_1Q_VLAN
;
905 dev
->priv_flags
&= ~IFF_XMIT_DST_RELEASE
;
906 dev
->tx_queue_len
= 0;
908 dev
->netdev_ops
= &vlan_netdev_ops
;
909 dev
->destructor
= free_netdev
;
910 dev
->ethtool_ops
= &vlan_ethtool_ops
;
912 memset(dev
->broadcast
, 0, ETH_ALEN
);