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
;
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_rx_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 (WARN_ON(skb_headroom(skb
) < dev
->hard_header_len
))
280 if (!(vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
)) {
281 vhdr
= (struct vlan_hdr
*) skb_push(skb
, VLAN_HLEN
);
283 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
284 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
285 vhdr
->h_vlan_TCI
= htons(vlan_tci
);
288 * Set the protocol type. For a packet of type ETH_P_802_3/2 we
289 * put the length in here instead.
291 if (type
!= ETH_P_802_3
&& type
!= ETH_P_802_2
)
292 vhdr
->h_vlan_encapsulated_proto
= htons(type
);
294 vhdr
->h_vlan_encapsulated_proto
= htons(len
);
296 skb
->protocol
= htons(ETH_P_8021Q
);
301 /* Before delegating work to the lower layer, enter our MAC-address */
303 saddr
= dev
->dev_addr
;
305 /* Now make the underlying real hard header */
306 dev
= vlan_dev_info(dev
)->real_dev
;
307 rc
= dev_hard_header(skb
, dev
, type
, daddr
, saddr
, len
+ vhdrlen
);
313 static netdev_tx_t
vlan_dev_hard_start_xmit(struct sk_buff
*skb
,
314 struct net_device
*dev
)
316 int i
= skb_get_queue_mapping(skb
);
317 struct netdev_queue
*txq
= netdev_get_tx_queue(dev
, i
);
318 struct vlan_ethhdr
*veth
= (struct vlan_ethhdr
*)(skb
->data
);
322 /* Handle non-VLAN frames if they are sent to us, for example by DHCP.
324 * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING
325 * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs...
327 if (veth
->h_vlan_proto
!= htons(ETH_P_8021Q
) ||
328 vlan_dev_info(dev
)->flags
& VLAN_FLAG_REORDER_HDR
) {
329 unsigned int orig_headroom
= skb_headroom(skb
);
332 vlan_dev_info(dev
)->cnt_encap_on_xmit
++;
334 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
335 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
336 skb
= __vlan_put_tag(skb
, vlan_tci
);
342 if (orig_headroom
< VLAN_HLEN
)
343 vlan_dev_info(dev
)->cnt_inc_headroom_on_tx
++;
347 skb_set_dev(skb
, vlan_dev_info(dev
)->real_dev
);
349 ret
= dev_queue_xmit(skb
);
351 if (likely(ret
== NET_XMIT_SUCCESS
|| ret
== NET_XMIT_CN
)) {
353 txq
->tx_bytes
+= len
;
360 static netdev_tx_t
vlan_dev_hwaccel_hard_start_xmit(struct sk_buff
*skb
,
361 struct net_device
*dev
)
363 int i
= skb_get_queue_mapping(skb
);
364 struct netdev_queue
*txq
= netdev_get_tx_queue(dev
, i
);
369 vlan_tci
= vlan_dev_info(dev
)->vlan_id
;
370 vlan_tci
|= vlan_dev_get_egress_qos_mask(dev
, skb
);
371 skb
= __vlan_hwaccel_put_tag(skb
, vlan_tci
);
373 skb
->dev
= vlan_dev_info(dev
)->real_dev
;
375 ret
= dev_queue_xmit(skb
);
377 if (likely(ret
== NET_XMIT_SUCCESS
|| ret
== NET_XMIT_CN
)) {
379 txq
->tx_bytes
+= len
;
386 static u16
vlan_dev_select_queue(struct net_device
*dev
, struct sk_buff
*skb
)
388 struct net_device
*rdev
= vlan_dev_info(dev
)->real_dev
;
389 const struct net_device_ops
*ops
= rdev
->netdev_ops
;
391 return ops
->ndo_select_queue(rdev
, skb
);
394 static int vlan_dev_change_mtu(struct net_device
*dev
, int new_mtu
)
396 /* TODO: gotta make sure the underlying layer can handle it,
397 * maybe an IFF_VLAN_CAPABLE flag for devices?
399 if (vlan_dev_info(dev
)->real_dev
->mtu
< new_mtu
)
407 void vlan_dev_set_ingress_priority(const struct net_device
*dev
,
408 u32 skb_prio
, u16 vlan_prio
)
410 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
412 if (vlan
->ingress_priority_map
[vlan_prio
& 0x7] && !skb_prio
)
413 vlan
->nr_ingress_mappings
--;
414 else if (!vlan
->ingress_priority_map
[vlan_prio
& 0x7] && skb_prio
)
415 vlan
->nr_ingress_mappings
++;
417 vlan
->ingress_priority_map
[vlan_prio
& 0x7] = skb_prio
;
420 int vlan_dev_set_egress_priority(const struct net_device
*dev
,
421 u32 skb_prio
, u16 vlan_prio
)
423 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
424 struct vlan_priority_tci_mapping
*mp
= NULL
;
425 struct vlan_priority_tci_mapping
*np
;
426 u32 vlan_qos
= (vlan_prio
<< VLAN_PRIO_SHIFT
) & VLAN_PRIO_MASK
;
428 /* See if a priority mapping exists.. */
429 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
431 if (mp
->priority
== skb_prio
) {
432 if (mp
->vlan_qos
&& !vlan_qos
)
433 vlan
->nr_egress_mappings
--;
434 else if (!mp
->vlan_qos
&& vlan_qos
)
435 vlan
->nr_egress_mappings
++;
436 mp
->vlan_qos
= vlan_qos
;
442 /* Create a new mapping then. */
443 mp
= vlan
->egress_priority_map
[skb_prio
& 0xF];
444 np
= kmalloc(sizeof(struct vlan_priority_tci_mapping
), GFP_KERNEL
);
449 np
->priority
= skb_prio
;
450 np
->vlan_qos
= vlan_qos
;
451 vlan
->egress_priority_map
[skb_prio
& 0xF] = np
;
453 vlan
->nr_egress_mappings
++;
457 /* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */
458 int vlan_dev_change_flags(const struct net_device
*dev
, u32 flags
, u32 mask
)
460 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
461 u32 old_flags
= vlan
->flags
;
463 if (mask
& ~(VLAN_FLAG_REORDER_HDR
| VLAN_FLAG_GVRP
|
464 VLAN_FLAG_LOOSE_BINDING
))
467 vlan
->flags
= (old_flags
& ~mask
) | (flags
& mask
);
469 if (netif_running(dev
) && (vlan
->flags
^ old_flags
) & VLAN_FLAG_GVRP
) {
470 if (vlan
->flags
& VLAN_FLAG_GVRP
)
471 vlan_gvrp_request_join(dev
);
473 vlan_gvrp_request_leave(dev
);
478 void vlan_dev_get_realdev_name(const struct net_device
*dev
, char *result
)
480 strncpy(result
, vlan_dev_info(dev
)->real_dev
->name
, 23);
483 static int vlan_dev_open(struct net_device
*dev
)
485 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
486 struct net_device
*real_dev
= vlan
->real_dev
;
489 if (!(real_dev
->flags
& IFF_UP
) &&
490 !(vlan
->flags
& VLAN_FLAG_LOOSE_BINDING
))
493 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
)) {
494 err
= dev_uc_add(real_dev
, dev
->dev_addr
);
499 if (dev
->flags
& IFF_ALLMULTI
) {
500 err
= dev_set_allmulti(real_dev
, 1);
504 if (dev
->flags
& IFF_PROMISC
) {
505 err
= dev_set_promiscuity(real_dev
, 1);
510 memcpy(vlan
->real_dev_addr
, real_dev
->dev_addr
, ETH_ALEN
);
512 if (vlan
->flags
& VLAN_FLAG_GVRP
)
513 vlan_gvrp_request_join(dev
);
515 if (netif_carrier_ok(real_dev
))
516 netif_carrier_on(dev
);
520 if (dev
->flags
& IFF_ALLMULTI
)
521 dev_set_allmulti(real_dev
, -1);
523 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
524 dev_uc_del(real_dev
, dev
->dev_addr
);
526 netif_carrier_off(dev
);
530 static int vlan_dev_stop(struct net_device
*dev
)
532 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
533 struct net_device
*real_dev
= vlan
->real_dev
;
535 if (vlan
->flags
& VLAN_FLAG_GVRP
)
536 vlan_gvrp_request_leave(dev
);
538 dev_mc_unsync(real_dev
, dev
);
539 dev_uc_unsync(real_dev
, dev
);
540 if (dev
->flags
& IFF_ALLMULTI
)
541 dev_set_allmulti(real_dev
, -1);
542 if (dev
->flags
& IFF_PROMISC
)
543 dev_set_promiscuity(real_dev
, -1);
545 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
546 dev_uc_del(real_dev
, dev
->dev_addr
);
548 netif_carrier_off(dev
);
552 static int vlan_dev_set_mac_address(struct net_device
*dev
, void *p
)
554 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
555 struct sockaddr
*addr
= p
;
558 if (!is_valid_ether_addr(addr
->sa_data
))
559 return -EADDRNOTAVAIL
;
561 if (!(dev
->flags
& IFF_UP
))
564 if (compare_ether_addr(addr
->sa_data
, real_dev
->dev_addr
)) {
565 err
= dev_uc_add(real_dev
, addr
->sa_data
);
570 if (compare_ether_addr(dev
->dev_addr
, real_dev
->dev_addr
))
571 dev_uc_del(real_dev
, dev
->dev_addr
);
574 memcpy(dev
->dev_addr
, addr
->sa_data
, ETH_ALEN
);
578 static int vlan_dev_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
580 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
581 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
583 int err
= -EOPNOTSUPP
;
585 strncpy(ifrr
.ifr_name
, real_dev
->name
, IFNAMSIZ
);
586 ifrr
.ifr_ifru
= ifr
->ifr_ifru
;
592 if (netif_device_present(real_dev
) && ops
->ndo_do_ioctl
)
593 err
= ops
->ndo_do_ioctl(real_dev
, &ifrr
, cmd
);
598 ifr
->ifr_ifru
= ifrr
.ifr_ifru
;
603 static int vlan_dev_neigh_setup(struct net_device
*dev
, struct neigh_parms
*pa
)
605 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
606 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
609 if (netif_device_present(real_dev
) && ops
->ndo_neigh_setup
)
610 err
= ops
->ndo_neigh_setup(real_dev
, pa
);
615 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
616 static int vlan_dev_fcoe_ddp_setup(struct net_device
*dev
, u16 xid
,
617 struct scatterlist
*sgl
, unsigned int sgc
)
619 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
620 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
623 if (ops
->ndo_fcoe_ddp_setup
)
624 rc
= ops
->ndo_fcoe_ddp_setup(real_dev
, xid
, sgl
, sgc
);
629 static int vlan_dev_fcoe_ddp_done(struct net_device
*dev
, u16 xid
)
631 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
632 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
635 if (ops
->ndo_fcoe_ddp_done
)
636 len
= ops
->ndo_fcoe_ddp_done(real_dev
, xid
);
641 static int vlan_dev_fcoe_enable(struct net_device
*dev
)
643 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
644 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
647 if (ops
->ndo_fcoe_enable
)
648 rc
= ops
->ndo_fcoe_enable(real_dev
);
652 static int vlan_dev_fcoe_disable(struct net_device
*dev
)
654 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
655 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
658 if (ops
->ndo_fcoe_disable
)
659 rc
= ops
->ndo_fcoe_disable(real_dev
);
663 static int vlan_dev_fcoe_get_wwn(struct net_device
*dev
, u64
*wwn
, int type
)
665 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
666 const struct net_device_ops
*ops
= real_dev
->netdev_ops
;
669 if (ops
->ndo_fcoe_get_wwn
)
670 rc
= ops
->ndo_fcoe_get_wwn(real_dev
, wwn
, type
);
675 static void vlan_dev_change_rx_flags(struct net_device
*dev
, int change
)
677 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
679 if (change
& IFF_ALLMULTI
)
680 dev_set_allmulti(real_dev
, dev
->flags
& IFF_ALLMULTI
? 1 : -1);
681 if (change
& IFF_PROMISC
)
682 dev_set_promiscuity(real_dev
, dev
->flags
& IFF_PROMISC
? 1 : -1);
685 static void vlan_dev_set_rx_mode(struct net_device
*vlan_dev
)
687 dev_mc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
688 dev_uc_sync(vlan_dev_info(vlan_dev
)->real_dev
, vlan_dev
);
692 * vlan network devices have devices nesting below it, and are a special
693 * "super class" of normal network devices; split their locks off into a
694 * separate class since they always nest.
696 static struct lock_class_key vlan_netdev_xmit_lock_key
;
697 static struct lock_class_key vlan_netdev_addr_lock_key
;
699 static void vlan_dev_set_lockdep_one(struct net_device
*dev
,
700 struct netdev_queue
*txq
,
703 lockdep_set_class_and_subclass(&txq
->_xmit_lock
,
704 &vlan_netdev_xmit_lock_key
,
708 static void vlan_dev_set_lockdep_class(struct net_device
*dev
, int subclass
)
710 lockdep_set_class_and_subclass(&dev
->addr_list_lock
,
711 &vlan_netdev_addr_lock_key
,
713 netdev_for_each_tx_queue(dev
, vlan_dev_set_lockdep_one
, &subclass
);
716 static const struct header_ops vlan_header_ops
= {
717 .create
= vlan_dev_hard_header
,
718 .rebuild
= vlan_dev_rebuild_header
,
719 .parse
= eth_header_parse
,
722 static const struct net_device_ops vlan_netdev_ops
, vlan_netdev_accel_ops
,
723 vlan_netdev_ops_sq
, vlan_netdev_accel_ops_sq
;
725 static int vlan_dev_init(struct net_device
*dev
)
727 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
730 netif_carrier_off(dev
);
732 /* IFF_BROADCAST|IFF_MULTICAST; ??? */
733 dev
->flags
= real_dev
->flags
& ~(IFF_UP
| IFF_PROMISC
| IFF_ALLMULTI
|
734 IFF_MASTER
| IFF_SLAVE
);
735 dev
->iflink
= real_dev
->ifindex
;
736 dev
->state
= (real_dev
->state
& ((1<<__LINK_STATE_NOCARRIER
) |
737 (1<<__LINK_STATE_DORMANT
))) |
738 (1<<__LINK_STATE_PRESENT
);
740 dev
->features
|= real_dev
->features
& real_dev
->vlan_features
;
741 dev
->gso_max_size
= real_dev
->gso_max_size
;
743 /* ipv6 shared card related stuff */
744 dev
->dev_id
= real_dev
->dev_id
;
746 if (is_zero_ether_addr(dev
->dev_addr
))
747 memcpy(dev
->dev_addr
, real_dev
->dev_addr
, dev
->addr_len
);
748 if (is_zero_ether_addr(dev
->broadcast
))
749 memcpy(dev
->broadcast
, real_dev
->broadcast
, dev
->addr_len
);
751 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
752 dev
->fcoe_ddp_xid
= real_dev
->fcoe_ddp_xid
;
755 if (real_dev
->features
& NETIF_F_HW_VLAN_TX
) {
756 dev
->header_ops
= real_dev
->header_ops
;
757 dev
->hard_header_len
= real_dev
->hard_header_len
;
758 if (real_dev
->netdev_ops
->ndo_select_queue
)
759 dev
->netdev_ops
= &vlan_netdev_accel_ops_sq
;
761 dev
->netdev_ops
= &vlan_netdev_accel_ops
;
763 dev
->header_ops
= &vlan_header_ops
;
764 dev
->hard_header_len
= real_dev
->hard_header_len
+ VLAN_HLEN
;
765 if (real_dev
->netdev_ops
->ndo_select_queue
)
766 dev
->netdev_ops
= &vlan_netdev_ops_sq
;
768 dev
->netdev_ops
= &vlan_netdev_ops
;
771 if (is_vlan_dev(real_dev
))
774 vlan_dev_set_lockdep_class(dev
, subclass
);
776 vlan_dev_info(dev
)->vlan_rx_stats
= alloc_percpu(struct vlan_rx_stats
);
777 if (!vlan_dev_info(dev
)->vlan_rx_stats
)
783 static void vlan_dev_uninit(struct net_device
*dev
)
785 struct vlan_priority_tci_mapping
*pm
;
786 struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
789 free_percpu(vlan
->vlan_rx_stats
);
790 vlan
->vlan_rx_stats
= NULL
;
791 for (i
= 0; i
< ARRAY_SIZE(vlan
->egress_priority_map
); i
++) {
792 while ((pm
= vlan
->egress_priority_map
[i
]) != NULL
) {
793 vlan
->egress_priority_map
[i
] = pm
->next
;
799 static int vlan_ethtool_get_settings(struct net_device
*dev
,
800 struct ethtool_cmd
*cmd
)
802 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
803 return dev_ethtool_get_settings(vlan
->real_dev
, cmd
);
806 static void vlan_ethtool_get_drvinfo(struct net_device
*dev
,
807 struct ethtool_drvinfo
*info
)
809 strcpy(info
->driver
, vlan_fullname
);
810 strcpy(info
->version
, vlan_version
);
811 strcpy(info
->fw_version
, "N/A");
814 static u32
vlan_ethtool_get_rx_csum(struct net_device
*dev
)
816 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
817 return dev_ethtool_get_rx_csum(vlan
->real_dev
);
820 static u32
vlan_ethtool_get_flags(struct net_device
*dev
)
822 const struct vlan_dev_info
*vlan
= vlan_dev_info(dev
);
823 return dev_ethtool_get_flags(vlan
->real_dev
);
826 static struct rtnl_link_stats64
*vlan_dev_get_stats64(struct net_device
*dev
, struct rtnl_link_stats64
*stats
)
828 dev_txq_stats_fold(dev
, stats
);
830 if (vlan_dev_info(dev
)->vlan_rx_stats
) {
831 struct vlan_rx_stats
*p
, accum
= {0};
834 for_each_possible_cpu(i
) {
835 u64 rxpackets
, rxbytes
, rxmulticast
;
838 p
= per_cpu_ptr(vlan_dev_info(dev
)->vlan_rx_stats
, i
);
840 start
= u64_stats_fetch_begin_bh(&p
->syncp
);
841 rxpackets
= p
->rx_packets
;
842 rxbytes
= p
->rx_bytes
;
843 rxmulticast
= p
->rx_multicast
;
844 } while (u64_stats_fetch_retry_bh(&p
->syncp
, start
));
845 accum
.rx_packets
+= rxpackets
;
846 accum
.rx_bytes
+= rxbytes
;
847 accum
.rx_multicast
+= rxmulticast
;
848 /* rx_errors is ulong, not protected by syncp */
849 accum
.rx_errors
+= p
->rx_errors
;
851 stats
->rx_packets
= accum
.rx_packets
;
852 stats
->rx_bytes
= accum
.rx_bytes
;
853 stats
->rx_errors
= accum
.rx_errors
;
854 stats
->multicast
= accum
.rx_multicast
;
859 static int vlan_ethtool_set_tso(struct net_device
*dev
, u32 data
)
862 struct net_device
*real_dev
= vlan_dev_info(dev
)->real_dev
;
864 /* Underlying device must support TSO for VLAN-tagged packets
865 * and must have TSO enabled now.
867 if (!(real_dev
->vlan_features
& NETIF_F_TSO
))
869 if (!(real_dev
->features
& NETIF_F_TSO
))
871 dev
->features
|= NETIF_F_TSO
;
873 dev
->features
&= ~NETIF_F_TSO
;
878 static const struct ethtool_ops vlan_ethtool_ops
= {
879 .get_settings
= vlan_ethtool_get_settings
,
880 .get_drvinfo
= vlan_ethtool_get_drvinfo
,
881 .get_link
= ethtool_op_get_link
,
882 .get_rx_csum
= vlan_ethtool_get_rx_csum
,
883 .get_flags
= vlan_ethtool_get_flags
,
884 .set_tso
= vlan_ethtool_set_tso
,
887 static const struct net_device_ops vlan_netdev_ops
= {
888 .ndo_change_mtu
= vlan_dev_change_mtu
,
889 .ndo_init
= vlan_dev_init
,
890 .ndo_uninit
= vlan_dev_uninit
,
891 .ndo_open
= vlan_dev_open
,
892 .ndo_stop
= vlan_dev_stop
,
893 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
894 .ndo_validate_addr
= eth_validate_addr
,
895 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
896 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
897 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
898 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
899 .ndo_do_ioctl
= vlan_dev_ioctl
,
900 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
901 .ndo_get_stats64
= vlan_dev_get_stats64
,
902 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
903 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
904 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
905 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
906 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
907 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
911 static const struct net_device_ops vlan_netdev_accel_ops
= {
912 .ndo_change_mtu
= vlan_dev_change_mtu
,
913 .ndo_init
= vlan_dev_init
,
914 .ndo_uninit
= vlan_dev_uninit
,
915 .ndo_open
= vlan_dev_open
,
916 .ndo_stop
= vlan_dev_stop
,
917 .ndo_start_xmit
= vlan_dev_hwaccel_hard_start_xmit
,
918 .ndo_validate_addr
= eth_validate_addr
,
919 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
920 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
921 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
922 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
923 .ndo_do_ioctl
= vlan_dev_ioctl
,
924 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
925 .ndo_get_stats64
= vlan_dev_get_stats64
,
926 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
927 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
928 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
929 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
930 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
931 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
935 static const struct net_device_ops vlan_netdev_ops_sq
= {
936 .ndo_select_queue
= vlan_dev_select_queue
,
937 .ndo_change_mtu
= vlan_dev_change_mtu
,
938 .ndo_init
= vlan_dev_init
,
939 .ndo_uninit
= vlan_dev_uninit
,
940 .ndo_open
= vlan_dev_open
,
941 .ndo_stop
= vlan_dev_stop
,
942 .ndo_start_xmit
= vlan_dev_hard_start_xmit
,
943 .ndo_validate_addr
= eth_validate_addr
,
944 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
945 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
946 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
947 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
948 .ndo_do_ioctl
= vlan_dev_ioctl
,
949 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
950 .ndo_get_stats64
= vlan_dev_get_stats64
,
951 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
952 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
953 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
954 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
955 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
956 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
960 static const struct net_device_ops vlan_netdev_accel_ops_sq
= {
961 .ndo_select_queue
= vlan_dev_select_queue
,
962 .ndo_change_mtu
= vlan_dev_change_mtu
,
963 .ndo_init
= vlan_dev_init
,
964 .ndo_uninit
= vlan_dev_uninit
,
965 .ndo_open
= vlan_dev_open
,
966 .ndo_stop
= vlan_dev_stop
,
967 .ndo_start_xmit
= vlan_dev_hwaccel_hard_start_xmit
,
968 .ndo_validate_addr
= eth_validate_addr
,
969 .ndo_set_mac_address
= vlan_dev_set_mac_address
,
970 .ndo_set_rx_mode
= vlan_dev_set_rx_mode
,
971 .ndo_set_multicast_list
= vlan_dev_set_rx_mode
,
972 .ndo_change_rx_flags
= vlan_dev_change_rx_flags
,
973 .ndo_do_ioctl
= vlan_dev_ioctl
,
974 .ndo_neigh_setup
= vlan_dev_neigh_setup
,
975 .ndo_get_stats64
= vlan_dev_get_stats64
,
976 #if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
977 .ndo_fcoe_ddp_setup
= vlan_dev_fcoe_ddp_setup
,
978 .ndo_fcoe_ddp_done
= vlan_dev_fcoe_ddp_done
,
979 .ndo_fcoe_enable
= vlan_dev_fcoe_enable
,
980 .ndo_fcoe_disable
= vlan_dev_fcoe_disable
,
981 .ndo_fcoe_get_wwn
= vlan_dev_fcoe_get_wwn
,
985 void vlan_setup(struct net_device
*dev
)
989 dev
->priv_flags
|= IFF_802_1Q_VLAN
;
990 dev
->priv_flags
&= ~IFF_XMIT_DST_RELEASE
;
991 dev
->tx_queue_len
= 0;
993 dev
->netdev_ops
= &vlan_netdev_ops
;
994 dev
->destructor
= free_netdev
;
995 dev
->ethtool_ops
= &vlan_ethtool_ops
;
997 memset(dev
->broadcast
, 0, ETH_ALEN
);