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_rx_stats
*rx_stats
;
148 skb
= skb_share_check(skb
, GFP_ATOMIC
);
152 if (unlikely(!pskb_may_pull(skb
, VLAN_HLEN
)))
155 vhdr
= (struct vlan_hdr
*)skb
->data
;
156 vlan_tci
= ntohs(vhdr
->h_vlan_TCI
);
157 vlan_id
= vlan_tci
& VLAN_VID_MASK
;
160 skb
->dev
= __find_vlan_dev(dev
, vlan_id
);
162 pr_debug("%s: ERROR: No net_device for VID: %u on dev: %s\n",
163 __func__
, vlan_id
, dev
->name
);
167 rx_stats
= per_cpu_ptr(vlan_dev_info(skb
->dev
)->vlan_rx_stats
,
169 u64_stats_update_begin(&rx_stats
->syncp
);
170 rx_stats
->rx_packets
++;
171 rx_stats
->rx_bytes
+= skb
->len
;
173 skb_pull_rcsum(skb
, VLAN_HLEN
);
175 skb
->priority
= vlan_get_ingress_priority(skb
->dev
, vlan_tci
);
177 pr_debug("%s: priority: %u for TCI: %hu\n",
178 __func__
, skb
->priority
, vlan_tci
);
180 switch (skb
->pkt_type
) {
181 case PACKET_BROADCAST
: /* Yeah, stats collect these together.. */
182 /* stats->broadcast ++; // no such counter :-( */
185 case PACKET_MULTICAST
:
186 rx_stats
->rx_multicast
++;
189 case PACKET_OTHERHOST
:
190 /* Our lower layer thinks this is not local, let's make sure.
191 * This allows the VLAN to have a different MAC than the
192 * underlying device, and still route correctly.
194 if (!compare_ether_addr(eth_hdr(skb
)->h_dest
,
196 skb
->pkt_type
= PACKET_HOST
;
201 u64_stats_update_end(&rx_stats
->syncp
);
203 vlan_set_encap_proto(skb
, vhdr
);
205 skb
= vlan_check_reorder_header(skb
);
207 rx_stats
->rx_errors
++;
213 return NET_RX_SUCCESS
;
223 vlan_dev_get_egress_qos_mask(struct net_device
*dev
, struct sk_buff
*skb
)
225 struct vlan_priority_tci_mapping
*mp
;
227 mp
= vlan_dev_info(dev
)->egress_priority_map
[(skb
->priority
& 0xF)];
229 if (mp
->priority
== skb
->priority
) {
230 return mp
->vlan_qos
; /* This should already be shifted
231 * to mask correctly with the
240 * Create the VLAN header for an arbitrary protocol layer
242 * saddr=NULL means use device source address
243 * daddr=NULL means leave destination address (eg unresolved arp)
245 * This is called when the SKB is moving down the stack towards the
248 static int vlan_dev_hard_header(struct sk_buff
*skb
, struct net_device
*dev
,
250 const void *daddr
, const void *saddr
,
253 struct vlan_hdr
*vhdr
;
254 unsigned int vhdrlen
= 0;
258 if (WARN_ON(skb_headroom(skb
) < dev
->hard_header_len
))
261 if (!(vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
)) {
262 vhdr
= (struct vlan_hdr
*) skb_push(skb
, VLAN_HLEN
);
264 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
265 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
266 vhdr
->h_vlan_TCI
= htons(vlan_tci
);
269 * Set the protocol type. For a packet of type ETH_P_802_3/2 we
270 * put the length in here instead.
272 if (type
!= ETH_P_802_3
&& type
!= ETH_P_802_2
)
273 vhdr
->h_vlan_encapsulated_proto
= htons(type
);
275 vhdr
->h_vlan_encapsulated_proto
= htons(len
);
277 skb
->protocol
= htons(ETH_P_8021Q
);
282 /* Before delegating work to the lower layer, enter our MAC-address */
284 saddr
= dev
->dev_addr
;
286 /* Now make the underlying real hard header */
287 dev
= vlan_dev_info(dev
)->real_dev
;
288 rc
= dev_hard_header(skb
, dev
, type
, daddr
, saddr
, len
+ vhdrlen
);
294 static netdev_tx_t
vlan_dev_hard_start_xmit(struct sk_buff
*skb
,
295 struct net_device
*dev
)
297 int i
= skb_get_queue_mapping(skb
);
298 struct netdev_queue
*txq
= netdev_get_tx_queue(dev
, i
);
299 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)(skb
->data
);
303 /* Handle non-VLAN frames if they are sent to us, for example by DHCP.
305 * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING
306 * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs...
308 if (veth
->h_vlan_proto
!= htons(ETH_P_8021Q
) ||
309 vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
) {
310 unsigned int orig_headroom
= skb_headroom(skb
);
313 vlan_dev_info(dev
)->cnt_encap_on_xmit
++;
315 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
316 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
317 skb
= __vlan_put_tag(skb
, vlan_tci
);
323 if (orig_headroom
< VLAN_HLEN
)
324 vlan_dev_info(dev
)->cnt_inc_headroom_on_tx
++;
328 skb_set_dev(skb
, vlan_dev_info(dev
)->real_dev
);
330 ret
= dev_queue_xmit(skb
);
332 if (likely(ret
== NET_XMIT_SUCCESS
|| ret
== NET_XMIT_CN
)) {
334 txq
->tx_bytes
+= len
;
341 static netdev_tx_t
vlan_dev_hwaccel_hard_start_xmit(struct sk_buff
*skb
,
342 struct net_device
*dev
)
344 int i
= skb_get_queue_mapping(skb
);
345 struct netdev_queue
*txq
= netdev_get_tx_queue(dev
, i
);
350 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
351 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
352 skb
= __vlan_hwaccel_put_tag(skb
, vlan_tci
);
354 skb
->dev
= vlan_dev_info(dev
)->real_dev
;
356 ret
= dev_queue_xmit(skb
);
358 if (likely(ret
== NET_XMIT_SUCCESS
|| ret
== NET_XMIT_CN
)) {
360 txq
->tx_bytes
+= len
;
367 static u16
vlan_dev_select_queue(struct net_device
*dev
, struct sk_buff
*skb
)
369 struct net_device
*rdev
= vlan_dev_info(dev
)->real_dev
;
370 const struct net_device_ops
*ops
= rdev
->netdev_ops
;
372 return ops
->ndo_select_queue(rdev
, skb
);
375 static int vlan_dev_change_mtu(struct net_device
*dev
, int new_mtu
)
377 /* TODO: gotta make sure the underlying layer can handle it,
378 * maybe an IFF_VLAN_CAPABLE flag for devices?
380 if (vlan_dev_info(dev
)->real_dev
->mtu
< new_mtu
)
388 void vlan_dev_set_ingress_priority(const struct net_device
*dev
,
389 u32 skb_prio
, u16 vlan_prio
)
391 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
393 if (vlan
->ingress_priority_map
[vlan_prio
& 0x7] && !skb_prio
)
394 vlan
->nr_ingress_mappings
--;
395 else if (!vlan
->ingress_priority_map
[vlan_prio
& 0x7] && skb_prio
)
396 vlan
->nr_ingress_mappings
++;
398 vlan
->ingress_priority_map
[vlan_prio
& 0x7] = skb_prio
;
401 int vlan_dev_set_egress_priority(const struct net_device
*dev
,
402 u32 skb_prio
, u16 vlan_prio
)
404 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
405 struct vlan_priority_tci_mapping
*mp
= NULL
;
406 struct vlan_priority_tci_mapping
*np
;
407 u32 vlan_qos
= (vlan_prio
<< VLAN_PRIO_SHIFT
) & VLAN_PRIO_MASK
;
409 /* See if a priority mapping exists.. */
410 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
412 if (mp
->priority
== skb_prio
) {
413 if (mp
->vlan_qos
&& !vlan_qos
)
414 vlan
->nr_egress_mappings
--;
415 else if (!mp
->vlan_qos
&& vlan_qos
)
416 vlan
->nr_egress_mappings
++;
417 mp
->vlan_qos
= vlan_qos
;
423 /* Create a new mapping then. */
424 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
425 np
= kmalloc(sizeof(struct vlan_priority_tci_mapping
), GFP_KERNEL
);
430 np
->priority
= skb_prio
;
431 np
->vlan_qos
= vlan_qos
;
432 vlan
->egress_priority_map
[skb_prio
& 0xF] = np
;
434 vlan
->nr_egress_mappings
++;
438 /* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */
439 int vlan_dev_change_flags(const struct net_device
*dev
, u32 flags
, u32 mask
)
441 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
442 u32 old_flags
= vlan
->flags
;
444 if (mask
& ~(VLAN_FLAG_REORDER_HDR
| VLAN_FLAG_GVRP
|
445 VLAN_FLAG_LOOSE_BINDING
))
448 vlan
->flags
= (old_flags
& ~mask
) | (flags
& mask
);
450 if (netif_running(dev
) && (vlan
->flags
^ old_flags
) & VLAN_FLAG_GVRP
) {
451 if (vlan
->flags
& VLAN_FLAG_GVRP
)
452 vlan_gvrp_request_join(dev
);
454 vlan_gvrp_request_leave(dev
);
459 void vlan_dev_get_realdev_name(const struct net_device
*dev
, char *result
)
461 strncpy(result
, vlan_dev_info(dev
)->real_dev
->name
, 23);
464 static int vlan_dev_open(struct net_device
*dev
)
466 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
467 struct net_device
*real_dev
= vlan
->real_dev
;
470 if (!(real_dev
->flags
& IFF_UP
) &&
471 !(vlan
->flags
& VLAN_FLAG_LOOSE_BINDING
))
474 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
)) {
475 err
= dev_uc_add(real_dev
, dev
->dev_addr
);
480 if (dev
->flags
& IFF_ALLMULTI
) {
481 err
= dev_set_allmulti(real_dev
, 1);
485 if (dev
->flags
& IFF_PROMISC
) {
486 err
= dev_set_promiscuity(real_dev
, 1);
491 memcpy(vlan
->real_dev_addr
, real_dev
->dev_addr
, ETH_ALEN
);
493 if (vlan
->flags
& VLAN_FLAG_GVRP
)
494 vlan_gvrp_request_join(dev
);
496 netif_carrier_on(dev
);
500 if (dev
->flags
& IFF_ALLMULTI
)
501 dev_set_allmulti(real_dev
, -1);
503 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
504 dev_uc_del(real_dev
, dev
->dev_addr
);
506 netif_carrier_off(dev
);
510 static int vlan_dev_stop(struct net_device
*dev
)
512 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
513 struct net_device
*real_dev
= vlan
->real_dev
;
515 if (vlan
->flags
& VLAN_FLAG_GVRP
)
516 vlan_gvrp_request_leave(dev
);
518 dev_mc_unsync(real_dev
, dev
);
519 dev_uc_unsync(real_dev
, dev
);
520 if (dev
->flags
& IFF_ALLMULTI
)
521 dev_set_allmulti(real_dev
, -1);
522 if (dev
->flags
& IFF_PROMISC
)
523 dev_set_promiscuity(real_dev
, -1);
525 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
526 dev_uc_del(real_dev
, dev
->dev_addr
);
528 netif_carrier_off(dev
);
532 static int vlan_dev_set_mac_address(struct net_device
*dev
, void *p
)
534 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
535 struct sockaddr
*addr
= p
;
538 if (!is_valid_ether_addr(addr
->sa_data
))
539 return -EADDRNOTAVAIL
;
541 if (!(dev
->flags
& IFF_UP
))
544 if (compare_ether_addr(addr
->sa_data
, real_dev
->dev_addr
)) {
545 err
= dev_uc_add(real_dev
, addr
->sa_data
);
550 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
551 dev_uc_del(real_dev
, dev
->dev_addr
);
554 memcpy(dev
->dev_addr
, addr
->sa_data
, ETH_ALEN
);
558 static int vlan_dev_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
560 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
561 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
563 int err
= -EOPNOTSUPP
;
565 strncpy(ifrr
.ifr_name
, real_dev
->name
, IFNAMSIZ
);
566 ifrr
.ifr_ifru
= ifr
->ifr_ifru
;
572 if (netif_device_present(real_dev
) && ops
->ndo_do_ioctl
)
573 err
= ops
->ndo_do_ioctl(real_dev
, &ifrr
, cmd
);
578 ifr
->ifr_ifru
= ifrr
.ifr_ifru
;
583 static int vlan_dev_neigh_setup(struct net_device
*dev
, struct neigh_parms
*pa
)
585 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
586 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
589 if (netif_device_present(real_dev
) && ops
->ndo_neigh_setup
)
590 err
= ops
->ndo_neigh_setup(real_dev
, pa
);
595 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
596 static int vlan_dev_fcoe_ddp_setup(struct net_device
*dev
, u16 xid
,
597 struct scatterlist
*sgl
, unsigned int sgc
)
599 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
600 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
603 if (ops
->ndo_fcoe_ddp_setup
)
604 rc
= ops
->ndo_fcoe_ddp_setup(real_dev
, xid
, sgl
, sgc
);
609 static int vlan_dev_fcoe_ddp_done(struct net_device
*dev
, u16 xid
)
611 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
612 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
615 if (ops
->ndo_fcoe_ddp_done
)
616 len
= ops
->ndo_fcoe_ddp_done(real_dev
, xid
);
621 static int vlan_dev_fcoe_enable(struct net_device
*dev
)
623 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
624 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
627 if (ops
->ndo_fcoe_enable
)
628 rc
= ops
->ndo_fcoe_enable(real_dev
);
632 static int vlan_dev_fcoe_disable(struct net_device
*dev
)
634 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
635 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
638 if (ops
->ndo_fcoe_disable
)
639 rc
= ops
->ndo_fcoe_disable(real_dev
);
643 static int vlan_dev_fcoe_get_wwn(struct net_device
*dev
, u64
*wwn
, int type
)
645 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
646 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
649 if (ops
->ndo_fcoe_get_wwn
)
650 rc
= ops
->ndo_fcoe_get_wwn(real_dev
, wwn
, type
);
655 static void vlan_dev_change_rx_flags(struct net_device
*dev
, int change
)
657 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
659 if (change
& IFF_ALLMULTI
)
660 dev_set_allmulti(real_dev
, dev
->flags
& IFF_ALLMULTI
? 1 : -1);
661 if (change
& IFF_PROMISC
)
662 dev_set_promiscuity(real_dev
, dev
->flags
& IFF_PROMISC
? 1 : -1);
665 static void vlan_dev_set_rx_mode(struct net_device
*vlan_dev
)
667 dev_mc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
668 dev_uc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
672 * vlan network devices have devices nesting below it, and are a special
673 * "super class" of normal network devices; split their locks off into a
674 * separate class since they always nest.
676 static struct lock_class_key vlan_netdev_xmit_lock_key
;
677 static struct lock_class_key vlan_netdev_addr_lock_key
;
679 static void vlan_dev_set_lockdep_one(struct net_device
*dev
,
680 struct netdev_queue
*txq
,
683 lockdep_set_class_and_subclass(&txq
->_xmit_lock
,
684 &vlan_netdev_xmit_lock_key
,
688 static void vlan_dev_set_lockdep_class(struct net_device
*dev
, int subclass
)
690 lockdep_set_class_and_subclass(&dev
->addr_list_lock
,
691 &vlan_netdev_addr_lock_key
,
693 netdev_for_each_tx_queue(dev
, vlan_dev_set_lockdep_one
, &subclass
);
696 static const struct header_ops vlan_header_ops
= {
697 .create
= vlan_dev_hard_header
,
698 .rebuild
= vlan_dev_rebuild_header
,
699 .parse
= eth_header_parse
,
702 static const struct net_device_ops vlan_netdev_ops
, vlan_netdev_accel_ops
,
703 vlan_netdev_ops_sq
, vlan_netdev_accel_ops_sq
;
705 static int vlan_dev_init(struct net_device
*dev
)
707 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
710 netif_carrier_off(dev
);
712 /* IFF_BROADCAST|IFF_MULTICAST; ??? */
713 dev
->flags
= real_dev
->flags
& ~(IFF_UP
| IFF_PROMISC
| IFF_ALLMULTI
|
714 IFF_MASTER
| IFF_SLAVE
);
715 dev
->iflink
= real_dev
->ifindex
;
716 dev
->state
= (real_dev
->state
& ((1<<__LINK_STATE_NOCARRIER
) |
717 (1<<__LINK_STATE_DORMANT
))) |
718 (1<<__LINK_STATE_PRESENT
);
720 dev
->features
|= real_dev
->features
& real_dev
->vlan_features
;
721 dev
->gso_max_size
= real_dev
->gso_max_size
;
723 /* ipv6 shared card related stuff */
724 dev
->dev_id
= real_dev
->dev_id
;
726 if (is_zero_ether_addr(dev
->dev_addr
))
727 memcpy(dev
->dev_addr
, real_dev
->dev_addr
, dev
->addr_len
);
728 if (is_zero_ether_addr(dev
->broadcast
))
729 memcpy(dev
->broadcast
, real_dev
->broadcast
, dev
->addr_len
);
731 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
732 dev
->fcoe_ddp_xid
= real_dev
->fcoe_ddp_xid
;
735 if (real_dev
->features
& NETIF_F_HW_VLAN_TX
) {
736 dev
->header_ops
= real_dev
->header_ops
;
737 dev
->hard_header_len
= real_dev
->hard_header_len
;
738 if (real_dev
->netdev_ops
->ndo_select_queue
)
739 dev
->netdev_ops
= &vlan_netdev_accel_ops_sq
;
741 dev
->netdev_ops
= &vlan_netdev_accel_ops
;
743 dev
->header_ops
= &vlan_header_ops
;
744 dev
->hard_header_len
= real_dev
->hard_header_len
+ VLAN_HLEN
;
745 if (real_dev
->netdev_ops
->ndo_select_queue
)
746 dev
->netdev_ops
= &vlan_netdev_ops_sq
;
748 dev
->netdev_ops
= &vlan_netdev_ops
;
751 if (is_vlan_dev(real_dev
))
754 vlan_dev_set_lockdep_class(dev
, subclass
);
756 vlan_dev_info(dev
)->vlan_rx_stats
= alloc_percpu(struct vlan_rx_stats
);
757 if (!vlan_dev_info(dev
)->vlan_rx_stats
)
763 static void vlan_dev_uninit(struct net_device
*dev
)
765 struct vlan_priority_tci_mapping
*pm
;
766 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
769 free_percpu(vlan
->vlan_rx_stats
);
770 vlan
->vlan_rx_stats
= NULL
;
771 for (i
= 0; i
< ARRAY_SIZE(vlan
->egress_priority_map
); i
++) {
772 while ((pm
= vlan
->egress_priority_map
[i
]) != NULL
) {
773 vlan
->egress_priority_map
[i
] = pm
->next
;
779 static int vlan_ethtool_get_settings(struct net_device
*dev
,
780 struct ethtool_cmd
*cmd
)
782 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
783 return dev_ethtool_get_settings(vlan
->real_dev
, cmd
);
786 static void vlan_ethtool_get_drvinfo(struct net_device
*dev
,
787 struct ethtool_drvinfo
*info
)
789 strcpy(info
->driver
, vlan_fullname
);
790 strcpy(info
->version
, vlan_version
);
791 strcpy(info
->fw_version
, "N/A");
794 static u32
vlan_ethtool_get_rx_csum(struct net_device
*dev
)
796 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
797 return dev_ethtool_get_rx_csum(vlan
->real_dev
);
800 static u32
vlan_ethtool_get_flags(struct net_device
*dev
)
802 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
803 return dev_ethtool_get_flags(vlan
->real_dev
);
806 static struct rtnl_link_stats64
*vlan_dev_get_stats64(struct net_device
*dev
, struct rtnl_link_stats64
*stats
)
808 dev_txq_stats_fold(dev
, (struct net_device_stats
*)stats
);
810 if (vlan_dev_info(dev
)->vlan_rx_stats
) {
811 struct vlan_rx_stats
*p
, accum
= {0};
814 for_each_possible_cpu(i
) {
815 u64 rxpackets
, rxbytes
, rxmulticast
;
818 p
= per_cpu_ptr(vlan_dev_info(dev
)->vlan_rx_stats
, i
);
820 start
= u64_stats_fetch_begin_bh(&p
->syncp
);
821 rxpackets
= p
->rx_packets
;
822 rxbytes
= p
->rx_bytes
;
823 rxmulticast
= p
->rx_multicast
;
824 } while (u64_stats_fetch_retry_bh(&p
->syncp
, start
));
825 accum
.rx_packets
+= rxpackets
;
826 accum
.rx_bytes
+= rxbytes
;
827 accum
.rx_multicast
+= rxmulticast
;
828 /* rx_errors is an ulong, not protected by syncp */
829 accum
.rx_errors
+= p
->rx_errors
;
831 stats
->rx_packets
= accum
.rx_packets
;
832 stats
->rx_bytes
= accum
.rx_bytes
;
833 stats
->rx_errors
= accum
.rx_errors
;
834 stats
->multicast
= accum
.rx_multicast
;
839 static const struct ethtool_ops vlan_ethtool_ops
= {
840 .get_settings
= vlan_ethtool_get_settings
,
841 .get_drvinfo
= vlan_ethtool_get_drvinfo
,
842 .get_link
= ethtool_op_get_link
,
843 .get_rx_csum
= vlan_ethtool_get_rx_csum
,
844 .get_flags
= vlan_ethtool_get_flags
,
847 static const struct net_device_ops vlan_netdev_ops
= {
848 .ndo_change_mtu
= vlan_dev_change_mtu
,
849 .ndo_init
= vlan_dev_init
,
850 .ndo_uninit
= vlan_dev_uninit
,
851 .ndo_open
= vlan_dev_open
,
852 .ndo_stop
= vlan_dev_stop
,
853 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
854 .ndo_validate_addr
= eth_validate_addr
,
855 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
856 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
857 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
858 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
859 .ndo_do_ioctl
= vlan_dev_ioctl
,
860 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
861 .ndo_get_stats64
= vlan_dev_get_stats64
,
862 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
863 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
864 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
865 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
866 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
867 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
871 static const struct net_device_ops vlan_netdev_accel_ops
= {
872 .ndo_change_mtu
= vlan_dev_change_mtu
,
873 .ndo_init
= vlan_dev_init
,
874 .ndo_uninit
= vlan_dev_uninit
,
875 .ndo_open
= vlan_dev_open
,
876 .ndo_stop
= vlan_dev_stop
,
877 .ndo_start_xmit
= vlan_dev_hwaccel_hard_start_xmit
,
878 .ndo_validate_addr
= eth_validate_addr
,
879 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
880 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
881 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
882 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
883 .ndo_do_ioctl
= vlan_dev_ioctl
,
884 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
885 .ndo_get_stats64
= vlan_dev_get_stats64
,
886 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
887 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
888 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
889 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
890 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
891 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
895 static const struct net_device_ops vlan_netdev_ops_sq
= {
896 .ndo_select_queue
= vlan_dev_select_queue
,
897 .ndo_change_mtu
= vlan_dev_change_mtu
,
898 .ndo_init
= vlan_dev_init
,
899 .ndo_uninit
= vlan_dev_uninit
,
900 .ndo_open
= vlan_dev_open
,
901 .ndo_stop
= vlan_dev_stop
,
902 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
903 .ndo_validate_addr
= eth_validate_addr
,
904 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
905 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
906 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
907 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
908 .ndo_do_ioctl
= vlan_dev_ioctl
,
909 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
910 .ndo_get_stats64
= vlan_dev_get_stats64
,
911 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
912 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
913 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
914 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
915 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
916 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
920 static const struct net_device_ops vlan_netdev_accel_ops_sq
= {
921 .ndo_select_queue
= vlan_dev_select_queue
,
922 .ndo_change_mtu
= vlan_dev_change_mtu
,
923 .ndo_init
= vlan_dev_init
,
924 .ndo_uninit
= vlan_dev_uninit
,
925 .ndo_open
= vlan_dev_open
,
926 .ndo_stop
= vlan_dev_stop
,
927 .ndo_start_xmit
= vlan_dev_hwaccel_hard_start_xmit
,
928 .ndo_validate_addr
= eth_validate_addr
,
929 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
930 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
931 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
932 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
933 .ndo_do_ioctl
= vlan_dev_ioctl
,
934 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
935 .ndo_get_stats64
= vlan_dev_get_stats64
,
936 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
937 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
938 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
939 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
940 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
941 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
945 void vlan_setup(struct net_device
*dev
)
949 dev
->priv_flags
|= IFF_802_1Q_VLAN
;
950 dev
->priv_flags
&= ~IFF_XMIT_DST_RELEASE
;
951 dev
->tx_queue_len
= 0;
953 dev
->netdev_ops
= &vlan_netdev_ops
;
954 dev
->destructor
= free_netdev
;
955 dev
->ethtool_ops
= &vlan_ethtool_ops
;
957 memset(dev
->broadcast
, 0, ETH_ALEN
);