Version:  2.0.40 2.2.26 2.4.37 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0

Linux/net/8021q/vlan_dev.c

  1 /* -*- linux-c -*-
  2  * INET         802.1Q VLAN
  3  *              Ethernet-type device handling.
  4  *
  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
  8  *
  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.
 15  *
 16  *
 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.
 21  */
 22 
 23 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 24 
 25 #include <linux/module.h>
 26 #include <linux/slab.h>
 27 #include <linux/skbuff.h>
 28 #include <linux/netdevice.h>
 29 #include <linux/net_tstamp.h>
 30 #include <linux/etherdevice.h>
 31 #include <linux/ethtool.h>
 32 #include <net/arp.h>
 33 
 34 #include "vlan.h"
 35 #include "vlanproc.h"
 36 #include <linux/if_vlan.h>
 37 #include <linux/netpoll.h>
 38 
 39 /*
 40  *      Rebuild the Ethernet MAC header. This is called after an ARP
 41  *      (or in future other address resolution) has completed on this
 42  *      sk_buff. We now let ARP fill in the other fields.
 43  *
 44  *      This routine CANNOT use cached dst->neigh!
 45  *      Really, it is used only when dst->neigh is wrong.
 46  *
 47  * TODO:  This needs a checkup, I'm ignorant here. --BLG
 48  */
 49 static int vlan_dev_rebuild_header(struct sk_buff *skb)
 50 {
 51         struct net_device *dev = skb->dev;
 52         struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data);
 53 
 54         switch (veth->h_vlan_encapsulated_proto) {
 55 #ifdef CONFIG_INET
 56         case htons(ETH_P_IP):
 57 
 58                 /* TODO:  Confirm this will work with VLAN headers... */
 59                 return arp_find(veth->h_dest, skb);
 60 #endif
 61         default:
 62                 pr_debug("%s: unable to resolve type %X addresses\n",
 63                          dev->name, ntohs(veth->h_vlan_encapsulated_proto));
 64 
 65                 ether_addr_copy(veth->h_source, dev->dev_addr);
 66                 break;
 67         }
 68 
 69         return 0;
 70 }
 71 
 72 /*
 73  *      Create the VLAN header for an arbitrary protocol layer
 74  *
 75  *      saddr=NULL      means use device source address
 76  *      daddr=NULL      means leave destination address (eg unresolved arp)
 77  *
 78  *  This is called when the SKB is moving down the stack towards the
 79  *  physical devices.
 80  */
 81 static int vlan_dev_hard_header(struct sk_buff *skb, struct net_device *dev,
 82                                 unsigned short type,
 83                                 const void *daddr, const void *saddr,
 84                                 unsigned int len)
 85 {
 86         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
 87         struct vlan_hdr *vhdr;
 88         unsigned int vhdrlen = 0;
 89         u16 vlan_tci = 0;
 90         int rc;
 91 
 92         if (!(vlan->flags & VLAN_FLAG_REORDER_HDR)) {
 93                 vhdr = (struct vlan_hdr *) skb_push(skb, VLAN_HLEN);
 94 
 95                 vlan_tci = vlan->vlan_id;
 96                 vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority);
 97                 vhdr->h_vlan_TCI = htons(vlan_tci);
 98 
 99                 /*
100                  *  Set the protocol type. For a packet of type ETH_P_802_3/2 we
101                  *  put the length in here instead.
102                  */
103                 if (type != ETH_P_802_3 && type != ETH_P_802_2)
104                         vhdr->h_vlan_encapsulated_proto = htons(type);
105                 else
106                         vhdr->h_vlan_encapsulated_proto = htons(len);
107 
108                 skb->protocol = vlan->vlan_proto;
109                 type = ntohs(vlan->vlan_proto);
110                 vhdrlen = VLAN_HLEN;
111         }
112 
113         /* Before delegating work to the lower layer, enter our MAC-address */
114         if (saddr == NULL)
115                 saddr = dev->dev_addr;
116 
117         /* Now make the underlying real hard header */
118         dev = vlan->real_dev;
119         rc = dev_hard_header(skb, dev, type, daddr, saddr, len + vhdrlen);
120         if (rc > 0)
121                 rc += vhdrlen;
122         return rc;
123 }
124 
125 static inline netdev_tx_t vlan_netpoll_send_skb(struct vlan_dev_priv *vlan, struct sk_buff *skb)
126 {
127 #ifdef CONFIG_NET_POLL_CONTROLLER
128         if (vlan->netpoll)
129                 netpoll_send_skb(vlan->netpoll, skb);
130 #else
131         BUG();
132 #endif
133         return NETDEV_TX_OK;
134 }
135 
136 static netdev_tx_t vlan_dev_hard_start_xmit(struct sk_buff *skb,
137                                             struct net_device *dev)
138 {
139         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
140         struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data);
141         unsigned int len;
142         int ret;
143 
144         /* Handle non-VLAN frames if they are sent to us, for example by DHCP.
145          *
146          * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING
147          * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs...
148          */
149         if (veth->h_vlan_proto != vlan->vlan_proto ||
150             vlan->flags & VLAN_FLAG_REORDER_HDR) {
151                 u16 vlan_tci;
152                 vlan_tci = vlan->vlan_id;
153                 vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority);
154                 __vlan_hwaccel_put_tag(skb, vlan->vlan_proto, vlan_tci);
155         }
156 
157         skb->dev = vlan->real_dev;
158         len = skb->len;
159         if (unlikely(netpoll_tx_running(dev)))
160                 return vlan_netpoll_send_skb(vlan, skb);
161 
162         ret = dev_queue_xmit(skb);
163 
164         if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
165                 struct vlan_pcpu_stats *stats;
166 
167                 stats = this_cpu_ptr(vlan->vlan_pcpu_stats);
168                 u64_stats_update_begin(&stats->syncp);
169                 stats->tx_packets++;
170                 stats->tx_bytes += len;
171                 u64_stats_update_end(&stats->syncp);
172         } else {
173                 this_cpu_inc(vlan->vlan_pcpu_stats->tx_dropped);
174         }
175 
176         return ret;
177 }
178 
179 static int vlan_dev_change_mtu(struct net_device *dev, int new_mtu)
180 {
181         /* TODO: gotta make sure the underlying layer can handle it,
182          * maybe an IFF_VLAN_CAPABLE flag for devices?
183          */
184         if (vlan_dev_priv(dev)->real_dev->mtu < new_mtu)
185                 return -ERANGE;
186 
187         dev->mtu = new_mtu;
188 
189         return 0;
190 }
191 
192 void vlan_dev_set_ingress_priority(const struct net_device *dev,
193                                    u32 skb_prio, u16 vlan_prio)
194 {
195         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
196 
197         if (vlan->ingress_priority_map[vlan_prio & 0x7] && !skb_prio)
198                 vlan->nr_ingress_mappings--;
199         else if (!vlan->ingress_priority_map[vlan_prio & 0x7] && skb_prio)
200                 vlan->nr_ingress_mappings++;
201 
202         vlan->ingress_priority_map[vlan_prio & 0x7] = skb_prio;
203 }
204 
205 int vlan_dev_set_egress_priority(const struct net_device *dev,
206                                  u32 skb_prio, u16 vlan_prio)
207 {
208         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
209         struct vlan_priority_tci_mapping *mp = NULL;
210         struct vlan_priority_tci_mapping *np;
211         u32 vlan_qos = (vlan_prio << VLAN_PRIO_SHIFT) & VLAN_PRIO_MASK;
212 
213         /* See if a priority mapping exists.. */
214         mp = vlan->egress_priority_map[skb_prio & 0xF];
215         while (mp) {
216                 if (mp->priority == skb_prio) {
217                         if (mp->vlan_qos && !vlan_qos)
218                                 vlan->nr_egress_mappings--;
219                         else if (!mp->vlan_qos && vlan_qos)
220                                 vlan->nr_egress_mappings++;
221                         mp->vlan_qos = vlan_qos;
222                         return 0;
223                 }
224                 mp = mp->next;
225         }
226 
227         /* Create a new mapping then. */
228         mp = vlan->egress_priority_map[skb_prio & 0xF];
229         np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL);
230         if (!np)
231                 return -ENOBUFS;
232 
233         np->next = mp;
234         np->priority = skb_prio;
235         np->vlan_qos = vlan_qos;
236         /* Before inserting this element in hash table, make sure all its fields
237          * are committed to memory.
238          * coupled with smp_rmb() in vlan_dev_get_egress_qos_mask()
239          */
240         smp_wmb();
241         vlan->egress_priority_map[skb_prio & 0xF] = np;
242         if (vlan_qos)
243                 vlan->nr_egress_mappings++;
244         return 0;
245 }
246 
247 /* Flags are defined in the vlan_flags enum in include/linux/if_vlan.h file. */
248 int vlan_dev_change_flags(const struct net_device *dev, u32 flags, u32 mask)
249 {
250         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
251         u32 old_flags = vlan->flags;
252 
253         if (mask & ~(VLAN_FLAG_REORDER_HDR | VLAN_FLAG_GVRP |
254                      VLAN_FLAG_LOOSE_BINDING | VLAN_FLAG_MVRP))
255                 return -EINVAL;
256 
257         vlan->flags = (old_flags & ~mask) | (flags & mask);
258 
259         if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_GVRP) {
260                 if (vlan->flags & VLAN_FLAG_GVRP)
261                         vlan_gvrp_request_join(dev);
262                 else
263                         vlan_gvrp_request_leave(dev);
264         }
265 
266         if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_MVRP) {
267                 if (vlan->flags & VLAN_FLAG_MVRP)
268                         vlan_mvrp_request_join(dev);
269                 else
270                         vlan_mvrp_request_leave(dev);
271         }
272         return 0;
273 }
274 
275 void vlan_dev_get_realdev_name(const struct net_device *dev, char *result)
276 {
277         strncpy(result, vlan_dev_priv(dev)->real_dev->name, 23);
278 }
279 
280 static int vlan_dev_open(struct net_device *dev)
281 {
282         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
283         struct net_device *real_dev = vlan->real_dev;
284         int err;
285 
286         if (!(real_dev->flags & IFF_UP) &&
287             !(vlan->flags & VLAN_FLAG_LOOSE_BINDING))
288                 return -ENETDOWN;
289 
290         if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) {
291                 err = dev_uc_add(real_dev, dev->dev_addr);
292                 if (err < 0)
293                         goto out;
294         }
295 
296         if (dev->flags & IFF_ALLMULTI) {
297                 err = dev_set_allmulti(real_dev, 1);
298                 if (err < 0)
299                         goto del_unicast;
300         }
301         if (dev->flags & IFF_PROMISC) {
302                 err = dev_set_promiscuity(real_dev, 1);
303                 if (err < 0)
304                         goto clear_allmulti;
305         }
306 
307         ether_addr_copy(vlan->real_dev_addr, real_dev->dev_addr);
308 
309         if (vlan->flags & VLAN_FLAG_GVRP)
310                 vlan_gvrp_request_join(dev);
311 
312         if (vlan->flags & VLAN_FLAG_MVRP)
313                 vlan_mvrp_request_join(dev);
314 
315         if (netif_carrier_ok(real_dev))
316                 netif_carrier_on(dev);
317         return 0;
318 
319 clear_allmulti:
320         if (dev->flags & IFF_ALLMULTI)
321                 dev_set_allmulti(real_dev, -1);
322 del_unicast:
323         if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr))
324                 dev_uc_del(real_dev, dev->dev_addr);
325 out:
326         netif_carrier_off(dev);
327         return err;
328 }
329 
330 static int vlan_dev_stop(struct net_device *dev)
331 {
332         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
333         struct net_device *real_dev = vlan->real_dev;
334 
335         dev_mc_unsync(real_dev, dev);
336         dev_uc_unsync(real_dev, dev);
337         if (dev->flags & IFF_ALLMULTI)
338                 dev_set_allmulti(real_dev, -1);
339         if (dev->flags & IFF_PROMISC)
340                 dev_set_promiscuity(real_dev, -1);
341 
342         if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr))
343                 dev_uc_del(real_dev, dev->dev_addr);
344 
345         netif_carrier_off(dev);
346         return 0;
347 }
348 
349 static int vlan_dev_set_mac_address(struct net_device *dev, void *p)
350 {
351         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
352         struct sockaddr *addr = p;
353         int err;
354 
355         if (!is_valid_ether_addr(addr->sa_data))
356                 return -EADDRNOTAVAIL;
357 
358         if (!(dev->flags & IFF_UP))
359                 goto out;
360 
361         if (!ether_addr_equal(addr->sa_data, real_dev->dev_addr)) {
362                 err = dev_uc_add(real_dev, addr->sa_data);
363                 if (err < 0)
364                         return err;
365         }
366 
367         if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr))
368                 dev_uc_del(real_dev, dev->dev_addr);
369 
370 out:
371         ether_addr_copy(dev->dev_addr, addr->sa_data);
372         return 0;
373 }
374 
375 static int vlan_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
376 {
377         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
378         const struct net_device_ops *ops = real_dev->netdev_ops;
379         struct ifreq ifrr;
380         int err = -EOPNOTSUPP;
381 
382         strncpy(ifrr.ifr_name, real_dev->name, IFNAMSIZ);
383         ifrr.ifr_ifru = ifr->ifr_ifru;
384 
385         switch (cmd) {
386         case SIOCGMIIPHY:
387         case SIOCGMIIREG:
388         case SIOCSMIIREG:
389         case SIOCSHWTSTAMP:
390         case SIOCGHWTSTAMP:
391                 if (netif_device_present(real_dev) && ops->ndo_do_ioctl)
392                         err = ops->ndo_do_ioctl(real_dev, &ifrr, cmd);
393                 break;
394         }
395 
396         if (!err)
397                 ifr->ifr_ifru = ifrr.ifr_ifru;
398 
399         return err;
400 }
401 
402 static int vlan_dev_neigh_setup(struct net_device *dev, struct neigh_parms *pa)
403 {
404         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
405         const struct net_device_ops *ops = real_dev->netdev_ops;
406         int err = 0;
407 
408         if (netif_device_present(real_dev) && ops->ndo_neigh_setup)
409                 err = ops->ndo_neigh_setup(real_dev, pa);
410 
411         return err;
412 }
413 
414 #if IS_ENABLED(CONFIG_FCOE)
415 static int vlan_dev_fcoe_ddp_setup(struct net_device *dev, u16 xid,
416                                    struct scatterlist *sgl, unsigned int sgc)
417 {
418         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
419         const struct net_device_ops *ops = real_dev->netdev_ops;
420         int rc = 0;
421 
422         if (ops->ndo_fcoe_ddp_setup)
423                 rc = ops->ndo_fcoe_ddp_setup(real_dev, xid, sgl, sgc);
424 
425         return rc;
426 }
427 
428 static int vlan_dev_fcoe_ddp_done(struct net_device *dev, u16 xid)
429 {
430         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
431         const struct net_device_ops *ops = real_dev->netdev_ops;
432         int len = 0;
433 
434         if (ops->ndo_fcoe_ddp_done)
435                 len = ops->ndo_fcoe_ddp_done(real_dev, xid);
436 
437         return len;
438 }
439 
440 static int vlan_dev_fcoe_enable(struct net_device *dev)
441 {
442         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
443         const struct net_device_ops *ops = real_dev->netdev_ops;
444         int rc = -EINVAL;
445 
446         if (ops->ndo_fcoe_enable)
447                 rc = ops->ndo_fcoe_enable(real_dev);
448         return rc;
449 }
450 
451 static int vlan_dev_fcoe_disable(struct net_device *dev)
452 {
453         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
454         const struct net_device_ops *ops = real_dev->netdev_ops;
455         int rc = -EINVAL;
456 
457         if (ops->ndo_fcoe_disable)
458                 rc = ops->ndo_fcoe_disable(real_dev);
459         return rc;
460 }
461 
462 static int vlan_dev_fcoe_get_wwn(struct net_device *dev, u64 *wwn, int type)
463 {
464         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
465         const struct net_device_ops *ops = real_dev->netdev_ops;
466         int rc = -EINVAL;
467 
468         if (ops->ndo_fcoe_get_wwn)
469                 rc = ops->ndo_fcoe_get_wwn(real_dev, wwn, type);
470         return rc;
471 }
472 
473 static int vlan_dev_fcoe_ddp_target(struct net_device *dev, u16 xid,
474                                     struct scatterlist *sgl, unsigned int sgc)
475 {
476         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
477         const struct net_device_ops *ops = real_dev->netdev_ops;
478         int rc = 0;
479 
480         if (ops->ndo_fcoe_ddp_target)
481                 rc = ops->ndo_fcoe_ddp_target(real_dev, xid, sgl, sgc);
482 
483         return rc;
484 }
485 #endif
486 
487 static void vlan_dev_change_rx_flags(struct net_device *dev, int change)
488 {
489         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
490 
491         if (dev->flags & IFF_UP) {
492                 if (change & IFF_ALLMULTI)
493                         dev_set_allmulti(real_dev, dev->flags & IFF_ALLMULTI ? 1 : -1);
494                 if (change & IFF_PROMISC)
495                         dev_set_promiscuity(real_dev, dev->flags & IFF_PROMISC ? 1 : -1);
496         }
497 }
498 
499 static void vlan_dev_set_rx_mode(struct net_device *vlan_dev)
500 {
501         dev_mc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev);
502         dev_uc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev);
503 }
504 
505 /*
506  * vlan network devices have devices nesting below it, and are a special
507  * "super class" of normal network devices; split their locks off into a
508  * separate class since they always nest.
509  */
510 static struct lock_class_key vlan_netdev_xmit_lock_key;
511 static struct lock_class_key vlan_netdev_addr_lock_key;
512 
513 static void vlan_dev_set_lockdep_one(struct net_device *dev,
514                                      struct netdev_queue *txq,
515                                      void *_subclass)
516 {
517         lockdep_set_class_and_subclass(&txq->_xmit_lock,
518                                        &vlan_netdev_xmit_lock_key,
519                                        *(int *)_subclass);
520 }
521 
522 static void vlan_dev_set_lockdep_class(struct net_device *dev, int subclass)
523 {
524         lockdep_set_class_and_subclass(&dev->addr_list_lock,
525                                        &vlan_netdev_addr_lock_key,
526                                        subclass);
527         netdev_for_each_tx_queue(dev, vlan_dev_set_lockdep_one, &subclass);
528 }
529 
530 static int vlan_dev_get_lock_subclass(struct net_device *dev)
531 {
532         return vlan_dev_priv(dev)->nest_level;
533 }
534 
535 static const struct header_ops vlan_header_ops = {
536         .create  = vlan_dev_hard_header,
537         .rebuild = vlan_dev_rebuild_header,
538         .parse   = eth_header_parse,
539 };
540 
541 static int vlan_passthru_hard_header(struct sk_buff *skb, struct net_device *dev,
542                                      unsigned short type,
543                                      const void *daddr, const void *saddr,
544                                      unsigned int len)
545 {
546         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
547         struct net_device *real_dev = vlan->real_dev;
548 
549         if (saddr == NULL)
550                 saddr = dev->dev_addr;
551 
552         return dev_hard_header(skb, real_dev, type, daddr, saddr, len);
553 }
554 
555 static const struct header_ops vlan_passthru_header_ops = {
556         .create  = vlan_passthru_hard_header,
557         .rebuild = dev_rebuild_header,
558         .parse   = eth_header_parse,
559 };
560 
561 static struct device_type vlan_type = {
562         .name   = "vlan",
563 };
564 
565 static const struct net_device_ops vlan_netdev_ops;
566 
567 static int vlan_dev_init(struct net_device *dev)
568 {
569         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
570 
571         netif_carrier_off(dev);
572 
573         /* IFF_BROADCAST|IFF_MULTICAST; ??? */
574         dev->flags  = real_dev->flags & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI |
575                                           IFF_MASTER | IFF_SLAVE);
576         dev->iflink = real_dev->ifindex;
577         dev->state  = (real_dev->state & ((1<<__LINK_STATE_NOCARRIER) |
578                                           (1<<__LINK_STATE_DORMANT))) |
579                       (1<<__LINK_STATE_PRESENT);
580 
581         dev->hw_features = NETIF_F_ALL_CSUM | NETIF_F_SG |
582                            NETIF_F_FRAGLIST | NETIF_F_GSO_SOFTWARE |
583                            NETIF_F_HIGHDMA | NETIF_F_SCTP_CSUM |
584                            NETIF_F_ALL_FCOE;
585 
586         dev->features |= real_dev->vlan_features | NETIF_F_LLTX |
587                          NETIF_F_GSO_SOFTWARE;
588         dev->gso_max_size = real_dev->gso_max_size;
589         if (dev->features & NETIF_F_VLAN_FEATURES)
590                 netdev_warn(real_dev, "VLAN features are set incorrectly.  Q-in-Q configurations may not work correctly.\n");
591 
592 
593         /* ipv6 shared card related stuff */
594         dev->dev_id = real_dev->dev_id;
595 
596         if (is_zero_ether_addr(dev->dev_addr))
597                 eth_hw_addr_inherit(dev, real_dev);
598         if (is_zero_ether_addr(dev->broadcast))
599                 memcpy(dev->broadcast, real_dev->broadcast, dev->addr_len);
600 
601 #if IS_ENABLED(CONFIG_FCOE)
602         dev->fcoe_ddp_xid = real_dev->fcoe_ddp_xid;
603 #endif
604 
605         dev->needed_headroom = real_dev->needed_headroom;
606         if (vlan_hw_offload_capable(real_dev->features,
607                                     vlan_dev_priv(dev)->vlan_proto)) {
608                 dev->header_ops      = &vlan_passthru_header_ops;
609                 dev->hard_header_len = real_dev->hard_header_len;
610         } else {
611                 dev->header_ops      = &vlan_header_ops;
612                 dev->hard_header_len = real_dev->hard_header_len + VLAN_HLEN;
613         }
614 
615         dev->netdev_ops = &vlan_netdev_ops;
616 
617         SET_NETDEV_DEVTYPE(dev, &vlan_type);
618 
619         vlan_dev_set_lockdep_class(dev, vlan_dev_get_lock_subclass(dev));
620 
621         vlan_dev_priv(dev)->vlan_pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats);
622         if (!vlan_dev_priv(dev)->vlan_pcpu_stats)
623                 return -ENOMEM;
624 
625         return 0;
626 }
627 
628 static void vlan_dev_uninit(struct net_device *dev)
629 {
630         struct vlan_priority_tci_mapping *pm;
631         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
632         int i;
633 
634         for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) {
635                 while ((pm = vlan->egress_priority_map[i]) != NULL) {
636                         vlan->egress_priority_map[i] = pm->next;
637                         kfree(pm);
638                 }
639         }
640 }
641 
642 static netdev_features_t vlan_dev_fix_features(struct net_device *dev,
643         netdev_features_t features)
644 {
645         struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
646         netdev_features_t old_features = features;
647 
648         features = netdev_intersect_features(features, real_dev->vlan_features);
649         features |= NETIF_F_RXCSUM;
650         features = netdev_intersect_features(features, real_dev->features);
651 
652         features |= old_features & (NETIF_F_SOFT_FEATURES | NETIF_F_GSO_SOFTWARE);
653         features |= NETIF_F_LLTX;
654 
655         return features;
656 }
657 
658 static int vlan_ethtool_get_settings(struct net_device *dev,
659                                      struct ethtool_cmd *cmd)
660 {
661         const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
662 
663         return __ethtool_get_settings(vlan->real_dev, cmd);
664 }
665 
666 static void vlan_ethtool_get_drvinfo(struct net_device *dev,
667                                      struct ethtool_drvinfo *info)
668 {
669         strlcpy(info->driver, vlan_fullname, sizeof(info->driver));
670         strlcpy(info->version, vlan_version, sizeof(info->version));
671         strlcpy(info->fw_version, "N/A", sizeof(info->fw_version));
672 }
673 
674 static int vlan_ethtool_get_ts_info(struct net_device *dev,
675                                     struct ethtool_ts_info *info)
676 {
677         const struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
678         const struct ethtool_ops *ops = vlan->real_dev->ethtool_ops;
679 
680         if (ops->get_ts_info) {
681                 return ops->get_ts_info(vlan->real_dev, info);
682         } else {
683                 info->so_timestamping = SOF_TIMESTAMPING_RX_SOFTWARE |
684                         SOF_TIMESTAMPING_SOFTWARE;
685                 info->phc_index = -1;
686         }
687 
688         return 0;
689 }
690 
691 static struct rtnl_link_stats64 *vlan_dev_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
692 {
693         struct vlan_pcpu_stats *p;
694         u32 rx_errors = 0, tx_dropped = 0;
695         int i;
696 
697         for_each_possible_cpu(i) {
698                 u64 rxpackets, rxbytes, rxmulticast, txpackets, txbytes;
699                 unsigned int start;
700 
701                 p = per_cpu_ptr(vlan_dev_priv(dev)->vlan_pcpu_stats, i);
702                 do {
703                         start = u64_stats_fetch_begin_irq(&p->syncp);
704                         rxpackets       = p->rx_packets;
705                         rxbytes         = p->rx_bytes;
706                         rxmulticast     = p->rx_multicast;
707                         txpackets       = p->tx_packets;
708                         txbytes         = p->tx_bytes;
709                 } while (u64_stats_fetch_retry_irq(&p->syncp, start));
710 
711                 stats->rx_packets       += rxpackets;
712                 stats->rx_bytes         += rxbytes;
713                 stats->multicast        += rxmulticast;
714                 stats->tx_packets       += txpackets;
715                 stats->tx_bytes         += txbytes;
716                 /* rx_errors & tx_dropped are u32 */
717                 rx_errors       += p->rx_errors;
718                 tx_dropped      += p->tx_dropped;
719         }
720         stats->rx_errors  = rx_errors;
721         stats->tx_dropped = tx_dropped;
722 
723         return stats;
724 }
725 
726 #ifdef CONFIG_NET_POLL_CONTROLLER
727 static void vlan_dev_poll_controller(struct net_device *dev)
728 {
729         return;
730 }
731 
732 static int vlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo)
733 {
734         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
735         struct net_device *real_dev = vlan->real_dev;
736         struct netpoll *netpoll;
737         int err = 0;
738 
739         netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL);
740         err = -ENOMEM;
741         if (!netpoll)
742                 goto out;
743 
744         err = __netpoll_setup(netpoll, real_dev);
745         if (err) {
746                 kfree(netpoll);
747                 goto out;
748         }
749 
750         vlan->netpoll = netpoll;
751 
752 out:
753         return err;
754 }
755 
756 static void vlan_dev_netpoll_cleanup(struct net_device *dev)
757 {
758         struct vlan_dev_priv *vlan= vlan_dev_priv(dev);
759         struct netpoll *netpoll = vlan->netpoll;
760 
761         if (!netpoll)
762                 return;
763 
764         vlan->netpoll = NULL;
765 
766         __netpoll_free_async(netpoll);
767 }
768 #endif /* CONFIG_NET_POLL_CONTROLLER */
769 
770 static const struct ethtool_ops vlan_ethtool_ops = {
771         .get_settings           = vlan_ethtool_get_settings,
772         .get_drvinfo            = vlan_ethtool_get_drvinfo,
773         .get_link               = ethtool_op_get_link,
774         .get_ts_info            = vlan_ethtool_get_ts_info,
775 };
776 
777 static const struct net_device_ops vlan_netdev_ops = {
778         .ndo_change_mtu         = vlan_dev_change_mtu,
779         .ndo_init               = vlan_dev_init,
780         .ndo_uninit             = vlan_dev_uninit,
781         .ndo_open               = vlan_dev_open,
782         .ndo_stop               = vlan_dev_stop,
783         .ndo_start_xmit =  vlan_dev_hard_start_xmit,
784         .ndo_validate_addr      = eth_validate_addr,
785         .ndo_set_mac_address    = vlan_dev_set_mac_address,
786         .ndo_set_rx_mode        = vlan_dev_set_rx_mode,
787         .ndo_change_rx_flags    = vlan_dev_change_rx_flags,
788         .ndo_do_ioctl           = vlan_dev_ioctl,
789         .ndo_neigh_setup        = vlan_dev_neigh_setup,
790         .ndo_get_stats64        = vlan_dev_get_stats64,
791 #if IS_ENABLED(CONFIG_FCOE)
792         .ndo_fcoe_ddp_setup     = vlan_dev_fcoe_ddp_setup,
793         .ndo_fcoe_ddp_done      = vlan_dev_fcoe_ddp_done,
794         .ndo_fcoe_enable        = vlan_dev_fcoe_enable,
795         .ndo_fcoe_disable       = vlan_dev_fcoe_disable,
796         .ndo_fcoe_get_wwn       = vlan_dev_fcoe_get_wwn,
797         .ndo_fcoe_ddp_target    = vlan_dev_fcoe_ddp_target,
798 #endif
799 #ifdef CONFIG_NET_POLL_CONTROLLER
800         .ndo_poll_controller    = vlan_dev_poll_controller,
801         .ndo_netpoll_setup      = vlan_dev_netpoll_setup,
802         .ndo_netpoll_cleanup    = vlan_dev_netpoll_cleanup,
803 #endif
804         .ndo_fix_features       = vlan_dev_fix_features,
805         .ndo_get_lock_subclass  = vlan_dev_get_lock_subclass,
806 };
807 
808 static void vlan_dev_free(struct net_device *dev)
809 {
810         struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
811 
812         free_percpu(vlan->vlan_pcpu_stats);
813         vlan->vlan_pcpu_stats = NULL;
814         free_netdev(dev);
815 }
816 
817 void vlan_setup(struct net_device *dev)
818 {
819         ether_setup(dev);
820 
821         dev->priv_flags         |= IFF_802_1Q_VLAN;
822         dev->priv_flags         &= ~IFF_TX_SKB_SHARING;
823         netif_keep_dst(dev);
824         dev->tx_queue_len       = 0;
825 
826         dev->netdev_ops         = &vlan_netdev_ops;
827         dev->destructor         = vlan_dev_free;
828         dev->ethtool_ops        = &vlan_ethtool_ops;
829 
830         memset(dev->broadcast, 0, ETH_ALEN);
831 }
832 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us