Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/linville/wirel...
[firefly-linux-kernel-4.4.55.git] / net / core / dev.c
1 /*
2  *      NET3    Protocol independent device support routines.
3  *
4  *              This program is free software; you can redistribute it and/or
5  *              modify it under the terms of the GNU General Public License
6  *              as published by the Free Software Foundation; either version
7  *              2 of the License, or (at your option) any later version.
8  *
9  *      Derived from the non IP parts of dev.c 1.0.19
10  *              Authors:        Ross Biro
11  *                              Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
12  *                              Mark Evans, <evansmp@uhura.aston.ac.uk>
13  *
14  *      Additional Authors:
15  *              Florian la Roche <rzsfl@rz.uni-sb.de>
16  *              Alan Cox <gw4pts@gw4pts.ampr.org>
17  *              David Hinds <dahinds@users.sourceforge.net>
18  *              Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
19  *              Adam Sulmicki <adam@cfar.umd.edu>
20  *              Pekka Riikonen <priikone@poesidon.pspt.fi>
21  *
22  *      Changes:
23  *              D.J. Barrow     :       Fixed bug where dev->refcnt gets set
24  *                                      to 2 if register_netdev gets called
25  *                                      before net_dev_init & also removed a
26  *                                      few lines of code in the process.
27  *              Alan Cox        :       device private ioctl copies fields back.
28  *              Alan Cox        :       Transmit queue code does relevant
29  *                                      stunts to keep the queue safe.
30  *              Alan Cox        :       Fixed double lock.
31  *              Alan Cox        :       Fixed promisc NULL pointer trap
32  *              ????????        :       Support the full private ioctl range
33  *              Alan Cox        :       Moved ioctl permission check into
34  *                                      drivers
35  *              Tim Kordas      :       SIOCADDMULTI/SIOCDELMULTI
36  *              Alan Cox        :       100 backlog just doesn't cut it when
37  *                                      you start doing multicast video 8)
38  *              Alan Cox        :       Rewrote net_bh and list manager.
39  *              Alan Cox        :       Fix ETH_P_ALL echoback lengths.
40  *              Alan Cox        :       Took out transmit every packet pass
41  *                                      Saved a few bytes in the ioctl handler
42  *              Alan Cox        :       Network driver sets packet type before
43  *                                      calling netif_rx. Saves a function
44  *                                      call a packet.
45  *              Alan Cox        :       Hashed net_bh()
46  *              Richard Kooijman:       Timestamp fixes.
47  *              Alan Cox        :       Wrong field in SIOCGIFDSTADDR
48  *              Alan Cox        :       Device lock protection.
49  *              Alan Cox        :       Fixed nasty side effect of device close
50  *                                      changes.
51  *              Rudi Cilibrasi  :       Pass the right thing to
52  *                                      set_mac_address()
53  *              Dave Miller     :       32bit quantity for the device lock to
54  *                                      make it work out on a Sparc.
55  *              Bjorn Ekwall    :       Added KERNELD hack.
56  *              Alan Cox        :       Cleaned up the backlog initialise.
57  *              Craig Metz      :       SIOCGIFCONF fix if space for under
58  *                                      1 device.
59  *          Thomas Bogendoerfer :       Return ENODEV for dev_open, if there
60  *                                      is no device open function.
61  *              Andi Kleen      :       Fix error reporting for SIOCGIFCONF
62  *          Michael Chastain    :       Fix signed/unsigned for SIOCGIFCONF
63  *              Cyrus Durgin    :       Cleaned for KMOD
64  *              Adam Sulmicki   :       Bug Fix : Network Device Unload
65  *                                      A network device unload needs to purge
66  *                                      the backlog queue.
67  *      Paul Rusty Russell      :       SIOCSIFNAME
68  *              Pekka Riikonen  :       Netdev boot-time settings code
69  *              Andrew Morton   :       Make unregister_netdevice wait
70  *                                      indefinitely on dev->refcnt
71  *              J Hadi Salim    :       - Backlog queue sampling
72  *                                      - netif_rx() feedback
73  */
74
75 #include <asm/uaccess.h>
76 #include <linux/bitops.h>
77 #include <linux/capability.h>
78 #include <linux/cpu.h>
79 #include <linux/types.h>
80 #include <linux/kernel.h>
81 #include <linux/hash.h>
82 #include <linux/slab.h>
83 #include <linux/sched.h>
84 #include <linux/mutex.h>
85 #include <linux/string.h>
86 #include <linux/mm.h>
87 #include <linux/socket.h>
88 #include <linux/sockios.h>
89 #include <linux/errno.h>
90 #include <linux/interrupt.h>
91 #include <linux/if_ether.h>
92 #include <linux/netdevice.h>
93 #include <linux/etherdevice.h>
94 #include <linux/ethtool.h>
95 #include <linux/notifier.h>
96 #include <linux/skbuff.h>
97 #include <net/net_namespace.h>
98 #include <net/sock.h>
99 #include <linux/rtnetlink.h>
100 #include <linux/stat.h>
101 #include <net/dst.h>
102 #include <net/pkt_sched.h>
103 #include <net/checksum.h>
104 #include <net/xfrm.h>
105 #include <linux/highmem.h>
106 #include <linux/init.h>
107 #include <linux/module.h>
108 #include <linux/netpoll.h>
109 #include <linux/rcupdate.h>
110 #include <linux/delay.h>
111 #include <net/iw_handler.h>
112 #include <asm/current.h>
113 #include <linux/audit.h>
114 #include <linux/dmaengine.h>
115 #include <linux/err.h>
116 #include <linux/ctype.h>
117 #include <linux/if_arp.h>
118 #include <linux/if_vlan.h>
119 #include <linux/ip.h>
120 #include <net/ip.h>
121 #include <linux/ipv6.h>
122 #include <linux/in.h>
123 #include <linux/jhash.h>
124 #include <linux/random.h>
125 #include <trace/events/napi.h>
126 #include <trace/events/net.h>
127 #include <trace/events/skb.h>
128 #include <linux/pci.h>
129 #include <linux/inetdevice.h>
130 #include <linux/cpu_rmap.h>
131 #include <linux/static_key.h>
132 #include <linux/hashtable.h>
133 #include <linux/vmalloc.h>
134 #include <linux/if_macvlan.h>
135
136 #include "net-sysfs.h"
137
138 /* Instead of increasing this, you should create a hash table. */
139 #define MAX_GRO_SKBS 8
140
141 /* This should be increased if a protocol with a bigger head is added. */
142 #define GRO_MAX_HEAD (MAX_HEADER + 128)
143
144 static DEFINE_SPINLOCK(ptype_lock);
145 static DEFINE_SPINLOCK(offload_lock);
146 struct list_head ptype_base[PTYPE_HASH_SIZE] __read_mostly;
147 struct list_head ptype_all __read_mostly;       /* Taps */
148 static struct list_head offload_base __read_mostly;
149
150 /*
151  * The @dev_base_head list is protected by @dev_base_lock and the rtnl
152  * semaphore.
153  *
154  * Pure readers hold dev_base_lock for reading, or rcu_read_lock()
155  *
156  * Writers must hold the rtnl semaphore while they loop through the
157  * dev_base_head list, and hold dev_base_lock for writing when they do the
158  * actual updates.  This allows pure readers to access the list even
159  * while a writer is preparing to update it.
160  *
161  * To put it another way, dev_base_lock is held for writing only to
162  * protect against pure readers; the rtnl semaphore provides the
163  * protection against other writers.
164  *
165  * See, for example usages, register_netdevice() and
166  * unregister_netdevice(), which must be called with the rtnl
167  * semaphore held.
168  */
169 DEFINE_RWLOCK(dev_base_lock);
170 EXPORT_SYMBOL(dev_base_lock);
171
172 /* protects napi_hash addition/deletion and napi_gen_id */
173 static DEFINE_SPINLOCK(napi_hash_lock);
174
175 static unsigned int napi_gen_id;
176 static DEFINE_HASHTABLE(napi_hash, 8);
177
178 static seqcount_t devnet_rename_seq;
179
180 static inline void dev_base_seq_inc(struct net *net)
181 {
182         while (++net->dev_base_seq == 0);
183 }
184
185 static inline struct hlist_head *dev_name_hash(struct net *net, const char *name)
186 {
187         unsigned int hash = full_name_hash(name, strnlen(name, IFNAMSIZ));
188
189         return &net->dev_name_head[hash_32(hash, NETDEV_HASHBITS)];
190 }
191
192 static inline struct hlist_head *dev_index_hash(struct net *net, int ifindex)
193 {
194         return &net->dev_index_head[ifindex & (NETDEV_HASHENTRIES - 1)];
195 }
196
197 static inline void rps_lock(struct softnet_data *sd)
198 {
199 #ifdef CONFIG_RPS
200         spin_lock(&sd->input_pkt_queue.lock);
201 #endif
202 }
203
204 static inline void rps_unlock(struct softnet_data *sd)
205 {
206 #ifdef CONFIG_RPS
207         spin_unlock(&sd->input_pkt_queue.lock);
208 #endif
209 }
210
211 /* Device list insertion */
212 static void list_netdevice(struct net_device *dev)
213 {
214         struct net *net = dev_net(dev);
215
216         ASSERT_RTNL();
217
218         write_lock_bh(&dev_base_lock);
219         list_add_tail_rcu(&dev->dev_list, &net->dev_base_head);
220         hlist_add_head_rcu(&dev->name_hlist, dev_name_hash(net, dev->name));
221         hlist_add_head_rcu(&dev->index_hlist,
222                            dev_index_hash(net, dev->ifindex));
223         write_unlock_bh(&dev_base_lock);
224
225         dev_base_seq_inc(net);
226 }
227
228 /* Device list removal
229  * caller must respect a RCU grace period before freeing/reusing dev
230  */
231 static void unlist_netdevice(struct net_device *dev)
232 {
233         ASSERT_RTNL();
234
235         /* Unlink dev from the device chain */
236         write_lock_bh(&dev_base_lock);
237         list_del_rcu(&dev->dev_list);
238         hlist_del_rcu(&dev->name_hlist);
239         hlist_del_rcu(&dev->index_hlist);
240         write_unlock_bh(&dev_base_lock);
241
242         dev_base_seq_inc(dev_net(dev));
243 }
244
245 /*
246  *      Our notifier list
247  */
248
249 static RAW_NOTIFIER_HEAD(netdev_chain);
250
251 /*
252  *      Device drivers call our routines to queue packets here. We empty the
253  *      queue in the local softnet handler.
254  */
255
256 DEFINE_PER_CPU_ALIGNED(struct softnet_data, softnet_data);
257 EXPORT_PER_CPU_SYMBOL(softnet_data);
258
259 #ifdef CONFIG_LOCKDEP
260 /*
261  * register_netdevice() inits txq->_xmit_lock and sets lockdep class
262  * according to dev->type
263  */
264 static const unsigned short netdev_lock_type[] =
265         {ARPHRD_NETROM, ARPHRD_ETHER, ARPHRD_EETHER, ARPHRD_AX25,
266          ARPHRD_PRONET, ARPHRD_CHAOS, ARPHRD_IEEE802, ARPHRD_ARCNET,
267          ARPHRD_APPLETLK, ARPHRD_DLCI, ARPHRD_ATM, ARPHRD_METRICOM,
268          ARPHRD_IEEE1394, ARPHRD_EUI64, ARPHRD_INFINIBAND, ARPHRD_SLIP,
269          ARPHRD_CSLIP, ARPHRD_SLIP6, ARPHRD_CSLIP6, ARPHRD_RSRVD,
270          ARPHRD_ADAPT, ARPHRD_ROSE, ARPHRD_X25, ARPHRD_HWX25,
271          ARPHRD_PPP, ARPHRD_CISCO, ARPHRD_LAPB, ARPHRD_DDCMP,
272          ARPHRD_RAWHDLC, ARPHRD_TUNNEL, ARPHRD_TUNNEL6, ARPHRD_FRAD,
273          ARPHRD_SKIP, ARPHRD_LOOPBACK, ARPHRD_LOCALTLK, ARPHRD_FDDI,
274          ARPHRD_BIF, ARPHRD_SIT, ARPHRD_IPDDP, ARPHRD_IPGRE,
275          ARPHRD_PIMREG, ARPHRD_HIPPI, ARPHRD_ASH, ARPHRD_ECONET,
276          ARPHRD_IRDA, ARPHRD_FCPP, ARPHRD_FCAL, ARPHRD_FCPL,
277          ARPHRD_FCFABRIC, ARPHRD_IEEE80211, ARPHRD_IEEE80211_PRISM,
278          ARPHRD_IEEE80211_RADIOTAP, ARPHRD_PHONET, ARPHRD_PHONET_PIPE,
279          ARPHRD_IEEE802154, ARPHRD_VOID, ARPHRD_NONE};
280
281 static const char *const netdev_lock_name[] =
282         {"_xmit_NETROM", "_xmit_ETHER", "_xmit_EETHER", "_xmit_AX25",
283          "_xmit_PRONET", "_xmit_CHAOS", "_xmit_IEEE802", "_xmit_ARCNET",
284          "_xmit_APPLETLK", "_xmit_DLCI", "_xmit_ATM", "_xmit_METRICOM",
285          "_xmit_IEEE1394", "_xmit_EUI64", "_xmit_INFINIBAND", "_xmit_SLIP",
286          "_xmit_CSLIP", "_xmit_SLIP6", "_xmit_CSLIP6", "_xmit_RSRVD",
287          "_xmit_ADAPT", "_xmit_ROSE", "_xmit_X25", "_xmit_HWX25",
288          "_xmit_PPP", "_xmit_CISCO", "_xmit_LAPB", "_xmit_DDCMP",
289          "_xmit_RAWHDLC", "_xmit_TUNNEL", "_xmit_TUNNEL6", "_xmit_FRAD",
290          "_xmit_SKIP", "_xmit_LOOPBACK", "_xmit_LOCALTLK", "_xmit_FDDI",
291          "_xmit_BIF", "_xmit_SIT", "_xmit_IPDDP", "_xmit_IPGRE",
292          "_xmit_PIMREG", "_xmit_HIPPI", "_xmit_ASH", "_xmit_ECONET",
293          "_xmit_IRDA", "_xmit_FCPP", "_xmit_FCAL", "_xmit_FCPL",
294          "_xmit_FCFABRIC", "_xmit_IEEE80211", "_xmit_IEEE80211_PRISM",
295          "_xmit_IEEE80211_RADIOTAP", "_xmit_PHONET", "_xmit_PHONET_PIPE",
296          "_xmit_IEEE802154", "_xmit_VOID", "_xmit_NONE"};
297
298 static struct lock_class_key netdev_xmit_lock_key[ARRAY_SIZE(netdev_lock_type)];
299 static struct lock_class_key netdev_addr_lock_key[ARRAY_SIZE(netdev_lock_type)];
300
301 static inline unsigned short netdev_lock_pos(unsigned short dev_type)
302 {
303         int i;
304
305         for (i = 0; i < ARRAY_SIZE(netdev_lock_type); i++)
306                 if (netdev_lock_type[i] == dev_type)
307                         return i;
308         /* the last key is used by default */
309         return ARRAY_SIZE(netdev_lock_type) - 1;
310 }
311
312 static inline void netdev_set_xmit_lockdep_class(spinlock_t *lock,
313                                                  unsigned short dev_type)
314 {
315         int i;
316
317         i = netdev_lock_pos(dev_type);
318         lockdep_set_class_and_name(lock, &netdev_xmit_lock_key[i],
319                                    netdev_lock_name[i]);
320 }
321
322 static inline void netdev_set_addr_lockdep_class(struct net_device *dev)
323 {
324         int i;
325
326         i = netdev_lock_pos(dev->type);
327         lockdep_set_class_and_name(&dev->addr_list_lock,
328                                    &netdev_addr_lock_key[i],
329                                    netdev_lock_name[i]);
330 }
331 #else
332 static inline void netdev_set_xmit_lockdep_class(spinlock_t *lock,
333                                                  unsigned short dev_type)
334 {
335 }
336 static inline void netdev_set_addr_lockdep_class(struct net_device *dev)
337 {
338 }
339 #endif
340
341 /*******************************************************************************
342
343                 Protocol management and registration routines
344
345 *******************************************************************************/
346
347 /*
348  *      Add a protocol ID to the list. Now that the input handler is
349  *      smarter we can dispense with all the messy stuff that used to be
350  *      here.
351  *
352  *      BEWARE!!! Protocol handlers, mangling input packets,
353  *      MUST BE last in hash buckets and checking protocol handlers
354  *      MUST start from promiscuous ptype_all chain in net_bh.
355  *      It is true now, do not change it.
356  *      Explanation follows: if protocol handler, mangling packet, will
357  *      be the first on list, it is not able to sense, that packet
358  *      is cloned and should be copied-on-write, so that it will
359  *      change it and subsequent readers will get broken packet.
360  *                                                      --ANK (980803)
361  */
362
363 static inline struct list_head *ptype_head(const struct packet_type *pt)
364 {
365         if (pt->type == htons(ETH_P_ALL))
366                 return &ptype_all;
367         else
368                 return &ptype_base[ntohs(pt->type) & PTYPE_HASH_MASK];
369 }
370
371 /**
372  *      dev_add_pack - add packet handler
373  *      @pt: packet type declaration
374  *
375  *      Add a protocol handler to the networking stack. The passed &packet_type
376  *      is linked into kernel lists and may not be freed until it has been
377  *      removed from the kernel lists.
378  *
379  *      This call does not sleep therefore it can not
380  *      guarantee all CPU's that are in middle of receiving packets
381  *      will see the new packet type (until the next received packet).
382  */
383
384 void dev_add_pack(struct packet_type *pt)
385 {
386         struct list_head *head = ptype_head(pt);
387
388         spin_lock(&ptype_lock);
389         list_add_rcu(&pt->list, head);
390         spin_unlock(&ptype_lock);
391 }
392 EXPORT_SYMBOL(dev_add_pack);
393
394 /**
395  *      __dev_remove_pack        - remove packet handler
396  *      @pt: packet type declaration
397  *
398  *      Remove a protocol handler that was previously added to the kernel
399  *      protocol handlers by dev_add_pack(). The passed &packet_type is removed
400  *      from the kernel lists and can be freed or reused once this function
401  *      returns.
402  *
403  *      The packet type might still be in use by receivers
404  *      and must not be freed until after all the CPU's have gone
405  *      through a quiescent state.
406  */
407 void __dev_remove_pack(struct packet_type *pt)
408 {
409         struct list_head *head = ptype_head(pt);
410         struct packet_type *pt1;
411
412         spin_lock(&ptype_lock);
413
414         list_for_each_entry(pt1, head, list) {
415                 if (pt == pt1) {
416                         list_del_rcu(&pt->list);
417                         goto out;
418                 }
419         }
420
421         pr_warn("dev_remove_pack: %p not found\n", pt);
422 out:
423         spin_unlock(&ptype_lock);
424 }
425 EXPORT_SYMBOL(__dev_remove_pack);
426
427 /**
428  *      dev_remove_pack  - remove packet handler
429  *      @pt: packet type declaration
430  *
431  *      Remove a protocol handler that was previously added to the kernel
432  *      protocol handlers by dev_add_pack(). The passed &packet_type is removed
433  *      from the kernel lists and can be freed or reused once this function
434  *      returns.
435  *
436  *      This call sleeps to guarantee that no CPU is looking at the packet
437  *      type after return.
438  */
439 void dev_remove_pack(struct packet_type *pt)
440 {
441         __dev_remove_pack(pt);
442
443         synchronize_net();
444 }
445 EXPORT_SYMBOL(dev_remove_pack);
446
447
448 /**
449  *      dev_add_offload - register offload handlers
450  *      @po: protocol offload declaration
451  *
452  *      Add protocol offload handlers to the networking stack. The passed
453  *      &proto_offload is linked into kernel lists and may not be freed until
454  *      it has been removed from the kernel lists.
455  *
456  *      This call does not sleep therefore it can not
457  *      guarantee all CPU's that are in middle of receiving packets
458  *      will see the new offload handlers (until the next received packet).
459  */
460 void dev_add_offload(struct packet_offload *po)
461 {
462         struct list_head *head = &offload_base;
463
464         spin_lock(&offload_lock);
465         list_add_rcu(&po->list, head);
466         spin_unlock(&offload_lock);
467 }
468 EXPORT_SYMBOL(dev_add_offload);
469
470 /**
471  *      __dev_remove_offload     - remove offload handler
472  *      @po: packet offload declaration
473  *
474  *      Remove a protocol offload handler that was previously added to the
475  *      kernel offload handlers by dev_add_offload(). The passed &offload_type
476  *      is removed from the kernel lists and can be freed or reused once this
477  *      function returns.
478  *
479  *      The packet type might still be in use by receivers
480  *      and must not be freed until after all the CPU's have gone
481  *      through a quiescent state.
482  */
483 static void __dev_remove_offload(struct packet_offload *po)
484 {
485         struct list_head *head = &offload_base;
486         struct packet_offload *po1;
487
488         spin_lock(&offload_lock);
489
490         list_for_each_entry(po1, head, list) {
491                 if (po == po1) {
492                         list_del_rcu(&po->list);
493                         goto out;
494                 }
495         }
496
497         pr_warn("dev_remove_offload: %p not found\n", po);
498 out:
499         spin_unlock(&offload_lock);
500 }
501
502 /**
503  *      dev_remove_offload       - remove packet offload handler
504  *      @po: packet offload declaration
505  *
506  *      Remove a packet offload handler that was previously added to the kernel
507  *      offload handlers by dev_add_offload(). The passed &offload_type is
508  *      removed from the kernel lists and can be freed or reused once this
509  *      function returns.
510  *
511  *      This call sleeps to guarantee that no CPU is looking at the packet
512  *      type after return.
513  */
514 void dev_remove_offload(struct packet_offload *po)
515 {
516         __dev_remove_offload(po);
517
518         synchronize_net();
519 }
520 EXPORT_SYMBOL(dev_remove_offload);
521
522 /******************************************************************************
523
524                       Device Boot-time Settings Routines
525
526 *******************************************************************************/
527
528 /* Boot time configuration table */
529 static struct netdev_boot_setup dev_boot_setup[NETDEV_BOOT_SETUP_MAX];
530
531 /**
532  *      netdev_boot_setup_add   - add new setup entry
533  *      @name: name of the device
534  *      @map: configured settings for the device
535  *
536  *      Adds new setup entry to the dev_boot_setup list.  The function
537  *      returns 0 on error and 1 on success.  This is a generic routine to
538  *      all netdevices.
539  */
540 static int netdev_boot_setup_add(char *name, struct ifmap *map)
541 {
542         struct netdev_boot_setup *s;
543         int i;
544
545         s = dev_boot_setup;
546         for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++) {
547                 if (s[i].name[0] == '\0' || s[i].name[0] == ' ') {
548                         memset(s[i].name, 0, sizeof(s[i].name));
549                         strlcpy(s[i].name, name, IFNAMSIZ);
550                         memcpy(&s[i].map, map, sizeof(s[i].map));
551                         break;
552                 }
553         }
554
555         return i >= NETDEV_BOOT_SETUP_MAX ? 0 : 1;
556 }
557
558 /**
559  *      netdev_boot_setup_check - check boot time settings
560  *      @dev: the netdevice
561  *
562  *      Check boot time settings for the device.
563  *      The found settings are set for the device to be used
564  *      later in the device probing.
565  *      Returns 0 if no settings found, 1 if they are.
566  */
567 int netdev_boot_setup_check(struct net_device *dev)
568 {
569         struct netdev_boot_setup *s = dev_boot_setup;
570         int i;
571
572         for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++) {
573                 if (s[i].name[0] != '\0' && s[i].name[0] != ' ' &&
574                     !strcmp(dev->name, s[i].name)) {
575                         dev->irq        = s[i].map.irq;
576                         dev->base_addr  = s[i].map.base_addr;
577                         dev->mem_start  = s[i].map.mem_start;
578                         dev->mem_end    = s[i].map.mem_end;
579                         return 1;
580                 }
581         }
582         return 0;
583 }
584 EXPORT_SYMBOL(netdev_boot_setup_check);
585
586
587 /**
588  *      netdev_boot_base        - get address from boot time settings
589  *      @prefix: prefix for network device
590  *      @unit: id for network device
591  *
592  *      Check boot time settings for the base address of device.
593  *      The found settings are set for the device to be used
594  *      later in the device probing.
595  *      Returns 0 if no settings found.
596  */
597 unsigned long netdev_boot_base(const char *prefix, int unit)
598 {
599         const struct netdev_boot_setup *s = dev_boot_setup;
600         char name[IFNAMSIZ];
601         int i;
602
603         sprintf(name, "%s%d", prefix, unit);
604
605         /*
606          * If device already registered then return base of 1
607          * to indicate not to probe for this interface
608          */
609         if (__dev_get_by_name(&init_net, name))
610                 return 1;
611
612         for (i = 0; i < NETDEV_BOOT_SETUP_MAX; i++)
613                 if (!strcmp(name, s[i].name))
614                         return s[i].map.base_addr;
615         return 0;
616 }
617
618 /*
619  * Saves at boot time configured settings for any netdevice.
620  */
621 int __init netdev_boot_setup(char *str)
622 {
623         int ints[5];
624         struct ifmap map;
625
626         str = get_options(str, ARRAY_SIZE(ints), ints);
627         if (!str || !*str)
628                 return 0;
629
630         /* Save settings */
631         memset(&map, 0, sizeof(map));
632         if (ints[0] > 0)
633                 map.irq = ints[1];
634         if (ints[0] > 1)
635                 map.base_addr = ints[2];
636         if (ints[0] > 2)
637                 map.mem_start = ints[3];
638         if (ints[0] > 3)
639                 map.mem_end = ints[4];
640
641         /* Add new entry to the list */
642         return netdev_boot_setup_add(str, &map);
643 }
644
645 __setup("netdev=", netdev_boot_setup);
646
647 /*******************************************************************************
648
649                             Device Interface Subroutines
650
651 *******************************************************************************/
652
653 /**
654  *      __dev_get_by_name       - find a device by its name
655  *      @net: the applicable net namespace
656  *      @name: name to find
657  *
658  *      Find an interface by name. Must be called under RTNL semaphore
659  *      or @dev_base_lock. If the name is found a pointer to the device
660  *      is returned. If the name is not found then %NULL is returned. The
661  *      reference counters are not incremented so the caller must be
662  *      careful with locks.
663  */
664
665 struct net_device *__dev_get_by_name(struct net *net, const char *name)
666 {
667         struct net_device *dev;
668         struct hlist_head *head = dev_name_hash(net, name);
669
670         hlist_for_each_entry(dev, head, name_hlist)
671                 if (!strncmp(dev->name, name, IFNAMSIZ))
672                         return dev;
673
674         return NULL;
675 }
676 EXPORT_SYMBOL(__dev_get_by_name);
677
678 /**
679  *      dev_get_by_name_rcu     - find a device by its name
680  *      @net: the applicable net namespace
681  *      @name: name to find
682  *
683  *      Find an interface by name.
684  *      If the name is found a pointer to the device is returned.
685  *      If the name is not found then %NULL is returned.
686  *      The reference counters are not incremented so the caller must be
687  *      careful with locks. The caller must hold RCU lock.
688  */
689
690 struct net_device *dev_get_by_name_rcu(struct net *net, const char *name)
691 {
692         struct net_device *dev;
693         struct hlist_head *head = dev_name_hash(net, name);
694
695         hlist_for_each_entry_rcu(dev, head, name_hlist)
696                 if (!strncmp(dev->name, name, IFNAMSIZ))
697                         return dev;
698
699         return NULL;
700 }
701 EXPORT_SYMBOL(dev_get_by_name_rcu);
702
703 /**
704  *      dev_get_by_name         - find a device by its name
705  *      @net: the applicable net namespace
706  *      @name: name to find
707  *
708  *      Find an interface by name. This can be called from any
709  *      context and does its own locking. The returned handle has
710  *      the usage count incremented and the caller must use dev_put() to
711  *      release it when it is no longer needed. %NULL is returned if no
712  *      matching device is found.
713  */
714
715 struct net_device *dev_get_by_name(struct net *net, const char *name)
716 {
717         struct net_device *dev;
718
719         rcu_read_lock();
720         dev = dev_get_by_name_rcu(net, name);
721         if (dev)
722                 dev_hold(dev);
723         rcu_read_unlock();
724         return dev;
725 }
726 EXPORT_SYMBOL(dev_get_by_name);
727
728 /**
729  *      __dev_get_by_index - find a device by its ifindex
730  *      @net: the applicable net namespace
731  *      @ifindex: index of device
732  *
733  *      Search for an interface by index. Returns %NULL if the device
734  *      is not found or a pointer to the device. The device has not
735  *      had its reference counter increased so the caller must be careful
736  *      about locking. The caller must hold either the RTNL semaphore
737  *      or @dev_base_lock.
738  */
739
740 struct net_device *__dev_get_by_index(struct net *net, int ifindex)
741 {
742         struct net_device *dev;
743         struct hlist_head *head = dev_index_hash(net, ifindex);
744
745         hlist_for_each_entry(dev, head, index_hlist)
746                 if (dev->ifindex == ifindex)
747                         return dev;
748
749         return NULL;
750 }
751 EXPORT_SYMBOL(__dev_get_by_index);
752
753 /**
754  *      dev_get_by_index_rcu - find a device by its ifindex
755  *      @net: the applicable net namespace
756  *      @ifindex: index of device
757  *
758  *      Search for an interface by index. Returns %NULL if the device
759  *      is not found or a pointer to the device. The device has not
760  *      had its reference counter increased so the caller must be careful
761  *      about locking. The caller must hold RCU lock.
762  */
763
764 struct net_device *dev_get_by_index_rcu(struct net *net, int ifindex)
765 {
766         struct net_device *dev;
767         struct hlist_head *head = dev_index_hash(net, ifindex);
768
769         hlist_for_each_entry_rcu(dev, head, index_hlist)
770                 if (dev->ifindex == ifindex)
771                         return dev;
772
773         return NULL;
774 }
775 EXPORT_SYMBOL(dev_get_by_index_rcu);
776
777
778 /**
779  *      dev_get_by_index - find a device by its ifindex
780  *      @net: the applicable net namespace
781  *      @ifindex: index of device
782  *
783  *      Search for an interface by index. Returns NULL if the device
784  *      is not found or a pointer to the device. The device returned has
785  *      had a reference added and the pointer is safe until the user calls
786  *      dev_put to indicate they have finished with it.
787  */
788
789 struct net_device *dev_get_by_index(struct net *net, int ifindex)
790 {
791         struct net_device *dev;
792
793         rcu_read_lock();
794         dev = dev_get_by_index_rcu(net, ifindex);
795         if (dev)
796                 dev_hold(dev);
797         rcu_read_unlock();
798         return dev;
799 }
800 EXPORT_SYMBOL(dev_get_by_index);
801
802 /**
803  *      netdev_get_name - get a netdevice name, knowing its ifindex.
804  *      @net: network namespace
805  *      @name: a pointer to the buffer where the name will be stored.
806  *      @ifindex: the ifindex of the interface to get the name from.
807  *
808  *      The use of raw_seqcount_begin() and cond_resched() before
809  *      retrying is required as we want to give the writers a chance
810  *      to complete when CONFIG_PREEMPT is not set.
811  */
812 int netdev_get_name(struct net *net, char *name, int ifindex)
813 {
814         struct net_device *dev;
815         unsigned int seq;
816
817 retry:
818         seq = raw_seqcount_begin(&devnet_rename_seq);
819         rcu_read_lock();
820         dev = dev_get_by_index_rcu(net, ifindex);
821         if (!dev) {
822                 rcu_read_unlock();
823                 return -ENODEV;
824         }
825
826         strcpy(name, dev->name);
827         rcu_read_unlock();
828         if (read_seqcount_retry(&devnet_rename_seq, seq)) {
829                 cond_resched();
830                 goto retry;
831         }
832
833         return 0;
834 }
835
836 /**
837  *      dev_getbyhwaddr_rcu - find a device by its hardware address
838  *      @net: the applicable net namespace
839  *      @type: media type of device
840  *      @ha: hardware address
841  *
842  *      Search for an interface by MAC address. Returns NULL if the device
843  *      is not found or a pointer to the device.
844  *      The caller must hold RCU or RTNL.
845  *      The returned device has not had its ref count increased
846  *      and the caller must therefore be careful about locking
847  *
848  */
849
850 struct net_device *dev_getbyhwaddr_rcu(struct net *net, unsigned short type,
851                                        const char *ha)
852 {
853         struct net_device *dev;
854
855         for_each_netdev_rcu(net, dev)
856                 if (dev->type == type &&
857                     !memcmp(dev->dev_addr, ha, dev->addr_len))
858                         return dev;
859
860         return NULL;
861 }
862 EXPORT_SYMBOL(dev_getbyhwaddr_rcu);
863
864 struct net_device *__dev_getfirstbyhwtype(struct net *net, unsigned short type)
865 {
866         struct net_device *dev;
867
868         ASSERT_RTNL();
869         for_each_netdev(net, dev)
870                 if (dev->type == type)
871                         return dev;
872
873         return NULL;
874 }
875 EXPORT_SYMBOL(__dev_getfirstbyhwtype);
876
877 struct net_device *dev_getfirstbyhwtype(struct net *net, unsigned short type)
878 {
879         struct net_device *dev, *ret = NULL;
880
881         rcu_read_lock();
882         for_each_netdev_rcu(net, dev)
883                 if (dev->type == type) {
884                         dev_hold(dev);
885                         ret = dev;
886                         break;
887                 }
888         rcu_read_unlock();
889         return ret;
890 }
891 EXPORT_SYMBOL(dev_getfirstbyhwtype);
892
893 /**
894  *      dev_get_by_flags_rcu - find any device with given flags
895  *      @net: the applicable net namespace
896  *      @if_flags: IFF_* values
897  *      @mask: bitmask of bits in if_flags to check
898  *
899  *      Search for any interface with the given flags. Returns NULL if a device
900  *      is not found or a pointer to the device. Must be called inside
901  *      rcu_read_lock(), and result refcount is unchanged.
902  */
903
904 struct net_device *dev_get_by_flags_rcu(struct net *net, unsigned short if_flags,
905                                     unsigned short mask)
906 {
907         struct net_device *dev, *ret;
908
909         ret = NULL;
910         for_each_netdev_rcu(net, dev) {
911                 if (((dev->flags ^ if_flags) & mask) == 0) {
912                         ret = dev;
913                         break;
914                 }
915         }
916         return ret;
917 }
918 EXPORT_SYMBOL(dev_get_by_flags_rcu);
919
920 /**
921  *      dev_valid_name - check if name is okay for network device
922  *      @name: name string
923  *
924  *      Network device names need to be valid file names to
925  *      to allow sysfs to work.  We also disallow any kind of
926  *      whitespace.
927  */
928 bool dev_valid_name(const char *name)
929 {
930         if (*name == '\0')
931                 return false;
932         if (strlen(name) >= IFNAMSIZ)
933                 return false;
934         if (!strcmp(name, ".") || !strcmp(name, ".."))
935                 return false;
936
937         while (*name) {
938                 if (*name == '/' || isspace(*name))
939                         return false;
940                 name++;
941         }
942         return true;
943 }
944 EXPORT_SYMBOL(dev_valid_name);
945
946 /**
947  *      __dev_alloc_name - allocate a name for a device
948  *      @net: network namespace to allocate the device name in
949  *      @name: name format string
950  *      @buf:  scratch buffer and result name string
951  *
952  *      Passed a format string - eg "lt%d" it will try and find a suitable
953  *      id. It scans list of devices to build up a free map, then chooses
954  *      the first empty slot. The caller must hold the dev_base or rtnl lock
955  *      while allocating the name and adding the device in order to avoid
956  *      duplicates.
957  *      Limited to bits_per_byte * page size devices (ie 32K on most platforms).
958  *      Returns the number of the unit assigned or a negative errno code.
959  */
960
961 static int __dev_alloc_name(struct net *net, const char *name, char *buf)
962 {
963         int i = 0;
964         const char *p;
965         const int max_netdevices = 8*PAGE_SIZE;
966         unsigned long *inuse;
967         struct net_device *d;
968
969         p = strnchr(name, IFNAMSIZ-1, '%');
970         if (p) {
971                 /*
972                  * Verify the string as this thing may have come from
973                  * the user.  There must be either one "%d" and no other "%"
974                  * characters.
975                  */
976                 if (p[1] != 'd' || strchr(p + 2, '%'))
977                         return -EINVAL;
978
979                 /* Use one page as a bit array of possible slots */
980                 inuse = (unsigned long *) get_zeroed_page(GFP_ATOMIC);
981                 if (!inuse)
982                         return -ENOMEM;
983
984                 for_each_netdev(net, d) {
985                         if (!sscanf(d->name, name, &i))
986                                 continue;
987                         if (i < 0 || i >= max_netdevices)
988                                 continue;
989
990                         /*  avoid cases where sscanf is not exact inverse of printf */
991                         snprintf(buf, IFNAMSIZ, name, i);
992                         if (!strncmp(buf, d->name, IFNAMSIZ))
993                                 set_bit(i, inuse);
994                 }
995
996                 i = find_first_zero_bit(inuse, max_netdevices);
997                 free_page((unsigned long) inuse);
998         }
999
1000         if (buf != name)
1001                 snprintf(buf, IFNAMSIZ, name, i);
1002         if (!__dev_get_by_name(net, buf))
1003                 return i;
1004
1005         /* It is possible to run out of possible slots
1006          * when the name is long and there isn't enough space left
1007          * for the digits, or if all bits are used.
1008          */
1009         return -ENFILE;
1010 }
1011
1012 /**
1013  *      dev_alloc_name - allocate a name for a device
1014  *      @dev: device
1015  *      @name: name format string
1016  *
1017  *      Passed a format string - eg "lt%d" it will try and find a suitable
1018  *      id. It scans list of devices to build up a free map, then chooses
1019  *      the first empty slot. The caller must hold the dev_base or rtnl lock
1020  *      while allocating the name and adding the device in order to avoid
1021  *      duplicates.
1022  *      Limited to bits_per_byte * page size devices (ie 32K on most platforms).
1023  *      Returns the number of the unit assigned or a negative errno code.
1024  */
1025
1026 int dev_alloc_name(struct net_device *dev, const char *name)
1027 {
1028         char buf[IFNAMSIZ];
1029         struct net *net;
1030         int ret;
1031
1032         BUG_ON(!dev_net(dev));
1033         net = dev_net(dev);
1034         ret = __dev_alloc_name(net, name, buf);
1035         if (ret >= 0)
1036                 strlcpy(dev->name, buf, IFNAMSIZ);
1037         return ret;
1038 }
1039 EXPORT_SYMBOL(dev_alloc_name);
1040
1041 static int dev_alloc_name_ns(struct net *net,
1042                              struct net_device *dev,
1043                              const char *name)
1044 {
1045         char buf[IFNAMSIZ];
1046         int ret;
1047
1048         ret = __dev_alloc_name(net, name, buf);
1049         if (ret >= 0)
1050                 strlcpy(dev->name, buf, IFNAMSIZ);
1051         return ret;
1052 }
1053
1054 static int dev_get_valid_name(struct net *net,
1055                               struct net_device *dev,
1056                               const char *name)
1057 {
1058         BUG_ON(!net);
1059
1060         if (!dev_valid_name(name))
1061                 return -EINVAL;
1062
1063         if (strchr(name, '%'))
1064                 return dev_alloc_name_ns(net, dev, name);
1065         else if (__dev_get_by_name(net, name))
1066                 return -EEXIST;
1067         else if (dev->name != name)
1068                 strlcpy(dev->name, name, IFNAMSIZ);
1069
1070         return 0;
1071 }
1072
1073 /**
1074  *      dev_change_name - change name of a device
1075  *      @dev: device
1076  *      @newname: name (or format string) must be at least IFNAMSIZ
1077  *
1078  *      Change name of a device, can pass format strings "eth%d".
1079  *      for wildcarding.
1080  */
1081 int dev_change_name(struct net_device *dev, const char *newname)
1082 {
1083         char oldname[IFNAMSIZ];
1084         int err = 0;
1085         int ret;
1086         struct net *net;
1087
1088         ASSERT_RTNL();
1089         BUG_ON(!dev_net(dev));
1090
1091         net = dev_net(dev);
1092         if (dev->flags & IFF_UP)
1093                 return -EBUSY;
1094
1095         write_seqcount_begin(&devnet_rename_seq);
1096
1097         if (strncmp(newname, dev->name, IFNAMSIZ) == 0) {
1098                 write_seqcount_end(&devnet_rename_seq);
1099                 return 0;
1100         }
1101
1102         memcpy(oldname, dev->name, IFNAMSIZ);
1103
1104         err = dev_get_valid_name(net, dev, newname);
1105         if (err < 0) {
1106                 write_seqcount_end(&devnet_rename_seq);
1107                 return err;
1108         }
1109
1110 rollback:
1111         ret = device_rename(&dev->dev, dev->name);
1112         if (ret) {
1113                 memcpy(dev->name, oldname, IFNAMSIZ);
1114                 write_seqcount_end(&devnet_rename_seq);
1115                 return ret;
1116         }
1117
1118         write_seqcount_end(&devnet_rename_seq);
1119
1120         write_lock_bh(&dev_base_lock);
1121         hlist_del_rcu(&dev->name_hlist);
1122         write_unlock_bh(&dev_base_lock);
1123
1124         synchronize_rcu();
1125
1126         write_lock_bh(&dev_base_lock);
1127         hlist_add_head_rcu(&dev->name_hlist, dev_name_hash(net, dev->name));
1128         write_unlock_bh(&dev_base_lock);
1129
1130         ret = call_netdevice_notifiers(NETDEV_CHANGENAME, dev);
1131         ret = notifier_to_errno(ret);
1132
1133         if (ret) {
1134                 /* err >= 0 after dev_alloc_name() or stores the first errno */
1135                 if (err >= 0) {
1136                         err = ret;
1137                         write_seqcount_begin(&devnet_rename_seq);
1138                         memcpy(dev->name, oldname, IFNAMSIZ);
1139                         goto rollback;
1140                 } else {
1141                         pr_err("%s: name change rollback failed: %d\n",
1142                                dev->name, ret);
1143                 }
1144         }
1145
1146         return err;
1147 }
1148
1149 /**
1150  *      dev_set_alias - change ifalias of a device
1151  *      @dev: device
1152  *      @alias: name up to IFALIASZ
1153  *      @len: limit of bytes to copy from info
1154  *
1155  *      Set ifalias for a device,
1156  */
1157 int dev_set_alias(struct net_device *dev, const char *alias, size_t len)
1158 {
1159         char *new_ifalias;
1160
1161         ASSERT_RTNL();
1162
1163         if (len >= IFALIASZ)
1164                 return -EINVAL;
1165
1166         if (!len) {
1167                 kfree(dev->ifalias);
1168                 dev->ifalias = NULL;
1169                 return 0;
1170         }
1171
1172         new_ifalias = krealloc(dev->ifalias, len + 1, GFP_KERNEL);
1173         if (!new_ifalias)
1174                 return -ENOMEM;
1175         dev->ifalias = new_ifalias;
1176
1177         strlcpy(dev->ifalias, alias, len+1);
1178         return len;
1179 }
1180
1181
1182 /**
1183  *      netdev_features_change - device changes features
1184  *      @dev: device to cause notification
1185  *
1186  *      Called to indicate a device has changed features.
1187  */
1188 void netdev_features_change(struct net_device *dev)
1189 {
1190         call_netdevice_notifiers(NETDEV_FEAT_CHANGE, dev);
1191 }
1192 EXPORT_SYMBOL(netdev_features_change);
1193
1194 /**
1195  *      netdev_state_change - device changes state
1196  *      @dev: device to cause notification
1197  *
1198  *      Called to indicate a device has changed state. This function calls
1199  *      the notifier chains for netdev_chain and sends a NEWLINK message
1200  *      to the routing socket.
1201  */
1202 void netdev_state_change(struct net_device *dev)
1203 {
1204         if (dev->flags & IFF_UP) {
1205                 call_netdevice_notifiers(NETDEV_CHANGE, dev);
1206                 rtmsg_ifinfo(RTM_NEWLINK, dev, 0, GFP_KERNEL);
1207         }
1208 }
1209 EXPORT_SYMBOL(netdev_state_change);
1210
1211 /**
1212  *      netdev_notify_peers - notify network peers about existence of @dev
1213  *      @dev: network device
1214  *
1215  * Generate traffic such that interested network peers are aware of
1216  * @dev, such as by generating a gratuitous ARP. This may be used when
1217  * a device wants to inform the rest of the network about some sort of
1218  * reconfiguration such as a failover event or virtual machine
1219  * migration.
1220  */
1221 void netdev_notify_peers(struct net_device *dev)
1222 {
1223         rtnl_lock();
1224         call_netdevice_notifiers(NETDEV_NOTIFY_PEERS, dev);
1225         rtnl_unlock();
1226 }
1227 EXPORT_SYMBOL(netdev_notify_peers);
1228
1229 static int __dev_open(struct net_device *dev)
1230 {
1231         const struct net_device_ops *ops = dev->netdev_ops;
1232         int ret;
1233
1234         ASSERT_RTNL();
1235
1236         if (!netif_device_present(dev))
1237                 return -ENODEV;
1238
1239         /* Block netpoll from trying to do any rx path servicing.
1240          * If we don't do this there is a chance ndo_poll_controller
1241          * or ndo_poll may be running while we open the device
1242          */
1243         netpoll_rx_disable(dev);
1244
1245         ret = call_netdevice_notifiers(NETDEV_PRE_UP, dev);
1246         ret = notifier_to_errno(ret);
1247         if (ret)
1248                 return ret;
1249
1250         set_bit(__LINK_STATE_START, &dev->state);
1251
1252         if (ops->ndo_validate_addr)
1253                 ret = ops->ndo_validate_addr(dev);
1254
1255         if (!ret && ops->ndo_open)
1256                 ret = ops->ndo_open(dev);
1257
1258         netpoll_rx_enable(dev);
1259
1260         if (ret)
1261                 clear_bit(__LINK_STATE_START, &dev->state);
1262         else {
1263                 dev->flags |= IFF_UP;
1264                 net_dmaengine_get();
1265                 dev_set_rx_mode(dev);
1266                 dev_activate(dev);
1267                 add_device_randomness(dev->dev_addr, dev->addr_len);
1268         }
1269
1270         return ret;
1271 }
1272
1273 /**
1274  *      dev_open        - prepare an interface for use.
1275  *      @dev:   device to open
1276  *
1277  *      Takes a device from down to up state. The device's private open
1278  *      function is invoked and then the multicast lists are loaded. Finally
1279  *      the device is moved into the up state and a %NETDEV_UP message is
1280  *      sent to the netdev notifier chain.
1281  *
1282  *      Calling this function on an active interface is a nop. On a failure
1283  *      a negative errno code is returned.
1284  */
1285 int dev_open(struct net_device *dev)
1286 {
1287         int ret;
1288
1289         if (dev->flags & IFF_UP)
1290                 return 0;
1291
1292         ret = __dev_open(dev);
1293         if (ret < 0)
1294                 return ret;
1295
1296         rtmsg_ifinfo(RTM_NEWLINK, dev, IFF_UP|IFF_RUNNING, GFP_KERNEL);
1297         call_netdevice_notifiers(NETDEV_UP, dev);
1298
1299         return ret;
1300 }
1301 EXPORT_SYMBOL(dev_open);
1302
1303 static int __dev_close_many(struct list_head *head)
1304 {
1305         struct net_device *dev;
1306
1307         ASSERT_RTNL();
1308         might_sleep();
1309
1310         list_for_each_entry(dev, head, close_list) {
1311                 call_netdevice_notifiers(NETDEV_GOING_DOWN, dev);
1312
1313                 clear_bit(__LINK_STATE_START, &dev->state);
1314
1315                 /* Synchronize to scheduled poll. We cannot touch poll list, it
1316                  * can be even on different cpu. So just clear netif_running().
1317                  *
1318                  * dev->stop() will invoke napi_disable() on all of it's
1319                  * napi_struct instances on this device.
1320                  */
1321                 smp_mb__after_clear_bit(); /* Commit netif_running(). */
1322         }
1323
1324         dev_deactivate_many(head);
1325
1326         list_for_each_entry(dev, head, close_list) {
1327                 const struct net_device_ops *ops = dev->netdev_ops;
1328
1329                 /*
1330                  *      Call the device specific close. This cannot fail.
1331                  *      Only if device is UP
1332                  *
1333                  *      We allow it to be called even after a DETACH hot-plug
1334                  *      event.
1335                  */
1336                 if (ops->ndo_stop)
1337                         ops->ndo_stop(dev);
1338
1339                 dev->flags &= ~IFF_UP;
1340                 net_dmaengine_put();
1341         }
1342
1343         return 0;
1344 }
1345
1346 static int __dev_close(struct net_device *dev)
1347 {
1348         int retval;
1349         LIST_HEAD(single);
1350
1351         /* Temporarily disable netpoll until the interface is down */
1352         netpoll_rx_disable(dev);
1353
1354         list_add(&dev->close_list, &single);
1355         retval = __dev_close_many(&single);
1356         list_del(&single);
1357
1358         netpoll_rx_enable(dev);
1359         return retval;
1360 }
1361
1362 static int dev_close_many(struct list_head *head)
1363 {
1364         struct net_device *dev, *tmp;
1365
1366         /* Remove the devices that don't need to be closed */
1367         list_for_each_entry_safe(dev, tmp, head, close_list)
1368                 if (!(dev->flags & IFF_UP))
1369                         list_del_init(&dev->close_list);
1370
1371         __dev_close_many(head);
1372
1373         list_for_each_entry_safe(dev, tmp, head, close_list) {
1374                 rtmsg_ifinfo(RTM_NEWLINK, dev, IFF_UP|IFF_RUNNING, GFP_KERNEL);
1375                 call_netdevice_notifiers(NETDEV_DOWN, dev);
1376                 list_del_init(&dev->close_list);
1377         }
1378
1379         return 0;
1380 }
1381
1382 /**
1383  *      dev_close - shutdown an interface.
1384  *      @dev: device to shutdown
1385  *
1386  *      This function moves an active device into down state. A
1387  *      %NETDEV_GOING_DOWN is sent to the netdev notifier chain. The device
1388  *      is then deactivated and finally a %NETDEV_DOWN is sent to the notifier
1389  *      chain.
1390  */
1391 int dev_close(struct net_device *dev)
1392 {
1393         if (dev->flags & IFF_UP) {
1394                 LIST_HEAD(single);
1395
1396                 /* Block netpoll rx while the interface is going down */
1397                 netpoll_rx_disable(dev);
1398
1399                 list_add(&dev->close_list, &single);
1400                 dev_close_many(&single);
1401                 list_del(&single);
1402
1403                 netpoll_rx_enable(dev);
1404         }
1405         return 0;
1406 }
1407 EXPORT_SYMBOL(dev_close);
1408
1409
1410 /**
1411  *      dev_disable_lro - disable Large Receive Offload on a device
1412  *      @dev: device
1413  *
1414  *      Disable Large Receive Offload (LRO) on a net device.  Must be
1415  *      called under RTNL.  This is needed if received packets may be
1416  *      forwarded to another interface.
1417  */
1418 void dev_disable_lro(struct net_device *dev)
1419 {
1420         /*
1421          * If we're trying to disable lro on a vlan device
1422          * use the underlying physical device instead
1423          */
1424         if (is_vlan_dev(dev))
1425                 dev = vlan_dev_real_dev(dev);
1426
1427         /* the same for macvlan devices */
1428         if (netif_is_macvlan(dev))
1429                 dev = macvlan_dev_real_dev(dev);
1430
1431         dev->wanted_features &= ~NETIF_F_LRO;
1432         netdev_update_features(dev);
1433
1434         if (unlikely(dev->features & NETIF_F_LRO))
1435                 netdev_WARN(dev, "failed to disable LRO!\n");
1436 }
1437 EXPORT_SYMBOL(dev_disable_lro);
1438
1439 static int call_netdevice_notifier(struct notifier_block *nb, unsigned long val,
1440                                    struct net_device *dev)
1441 {
1442         struct netdev_notifier_info info;
1443
1444         netdev_notifier_info_init(&info, dev);
1445         return nb->notifier_call(nb, val, &info);
1446 }
1447
1448 static int dev_boot_phase = 1;
1449
1450 /**
1451  *      register_netdevice_notifier - register a network notifier block
1452  *      @nb: notifier
1453  *
1454  *      Register a notifier to be called when network device events occur.
1455  *      The notifier passed is linked into the kernel structures and must
1456  *      not be reused until it has been unregistered. A negative errno code
1457  *      is returned on a failure.
1458  *
1459  *      When registered all registration and up events are replayed
1460  *      to the new notifier to allow device to have a race free
1461  *      view of the network device list.
1462  */
1463
1464 int register_netdevice_notifier(struct notifier_block *nb)
1465 {
1466         struct net_device *dev;
1467         struct net_device *last;
1468         struct net *net;
1469         int err;
1470
1471         rtnl_lock();
1472         err = raw_notifier_chain_register(&netdev_chain, nb);
1473         if (err)
1474                 goto unlock;
1475         if (dev_boot_phase)
1476                 goto unlock;
1477         for_each_net(net) {
1478                 for_each_netdev(net, dev) {
1479                         err = call_netdevice_notifier(nb, NETDEV_REGISTER, dev);
1480                         err = notifier_to_errno(err);
1481                         if (err)
1482                                 goto rollback;
1483
1484                         if (!(dev->flags & IFF_UP))
1485                                 continue;
1486
1487                         call_netdevice_notifier(nb, NETDEV_UP, dev);
1488                 }
1489         }
1490
1491 unlock:
1492         rtnl_unlock();
1493         return err;
1494
1495 rollback:
1496         last = dev;
1497         for_each_net(net) {
1498                 for_each_netdev(net, dev) {
1499                         if (dev == last)
1500                                 goto outroll;
1501
1502                         if (dev->flags & IFF_UP) {
1503                                 call_netdevice_notifier(nb, NETDEV_GOING_DOWN,
1504                                                         dev);
1505                                 call_netdevice_notifier(nb, NETDEV_DOWN, dev);
1506                         }
1507                         call_netdevice_notifier(nb, NETDEV_UNREGISTER, dev);
1508                 }
1509         }
1510
1511 outroll:
1512         raw_notifier_chain_unregister(&netdev_chain, nb);
1513         goto unlock;
1514 }
1515 EXPORT_SYMBOL(register_netdevice_notifier);
1516
1517 /**
1518  *      unregister_netdevice_notifier - unregister a network notifier block
1519  *      @nb: notifier
1520  *
1521  *      Unregister a notifier previously registered by
1522  *      register_netdevice_notifier(). The notifier is unlinked into the
1523  *      kernel structures and may then be reused. A negative errno code
1524  *      is returned on a failure.
1525  *
1526  *      After unregistering unregister and down device events are synthesized
1527  *      for all devices on the device list to the removed notifier to remove
1528  *      the need for special case cleanup code.
1529  */
1530
1531 int unregister_netdevice_notifier(struct notifier_block *nb)
1532 {
1533         struct net_device *dev;
1534         struct net *net;
1535         int err;
1536
1537         rtnl_lock();
1538         err = raw_notifier_chain_unregister(&netdev_chain, nb);
1539         if (err)
1540                 goto unlock;
1541
1542         for_each_net(net) {
1543                 for_each_netdev(net, dev) {
1544                         if (dev->flags & IFF_UP) {
1545                                 call_netdevice_notifier(nb, NETDEV_GOING_DOWN,
1546                                                         dev);
1547                                 call_netdevice_notifier(nb, NETDEV_DOWN, dev);
1548                         }
1549                         call_netdevice_notifier(nb, NETDEV_UNREGISTER, dev);
1550                 }
1551         }
1552 unlock:
1553         rtnl_unlock();
1554         return err;
1555 }
1556 EXPORT_SYMBOL(unregister_netdevice_notifier);
1557
1558 /**
1559  *      call_netdevice_notifiers_info - call all network notifier blocks
1560  *      @val: value passed unmodified to notifier function
1561  *      @dev: net_device pointer passed unmodified to notifier function
1562  *      @info: notifier information data
1563  *
1564  *      Call all network notifier blocks.  Parameters and return value
1565  *      are as for raw_notifier_call_chain().
1566  */
1567
1568 static int call_netdevice_notifiers_info(unsigned long val,
1569                                          struct net_device *dev,
1570                                          struct netdev_notifier_info *info)
1571 {
1572         ASSERT_RTNL();
1573         netdev_notifier_info_init(info, dev);
1574         return raw_notifier_call_chain(&netdev_chain, val, info);
1575 }
1576
1577 /**
1578  *      call_netdevice_notifiers - call all network notifier blocks
1579  *      @val: value passed unmodified to notifier function
1580  *      @dev: net_device pointer passed unmodified to notifier function
1581  *
1582  *      Call all network notifier blocks.  Parameters and return value
1583  *      are as for raw_notifier_call_chain().
1584  */
1585
1586 int call_netdevice_notifiers(unsigned long val, struct net_device *dev)
1587 {
1588         struct netdev_notifier_info info;
1589
1590         return call_netdevice_notifiers_info(val, dev, &info);
1591 }
1592 EXPORT_SYMBOL(call_netdevice_notifiers);
1593
1594 static struct static_key netstamp_needed __read_mostly;
1595 #ifdef HAVE_JUMP_LABEL
1596 /* We are not allowed to call static_key_slow_dec() from irq context
1597  * If net_disable_timestamp() is called from irq context, defer the
1598  * static_key_slow_dec() calls.
1599  */
1600 static atomic_t netstamp_needed_deferred;
1601 #endif
1602
1603 void net_enable_timestamp(void)
1604 {
1605 #ifdef HAVE_JUMP_LABEL
1606         int deferred = atomic_xchg(&netstamp_needed_deferred, 0);
1607
1608         if (deferred) {
1609                 while (--deferred)
1610                         static_key_slow_dec(&netstamp_needed);
1611                 return;
1612         }
1613 #endif
1614         static_key_slow_inc(&netstamp_needed);
1615 }
1616 EXPORT_SYMBOL(net_enable_timestamp);
1617
1618 void net_disable_timestamp(void)
1619 {
1620 #ifdef HAVE_JUMP_LABEL
1621         if (in_interrupt()) {
1622                 atomic_inc(&netstamp_needed_deferred);
1623                 return;
1624         }
1625 #endif
1626         static_key_slow_dec(&netstamp_needed);
1627 }
1628 EXPORT_SYMBOL(net_disable_timestamp);
1629
1630 static inline void net_timestamp_set(struct sk_buff *skb)
1631 {
1632         skb->tstamp.tv64 = 0;
1633         if (static_key_false(&netstamp_needed))
1634                 __net_timestamp(skb);
1635 }
1636
1637 #define net_timestamp_check(COND, SKB)                  \
1638         if (static_key_false(&netstamp_needed)) {               \
1639                 if ((COND) && !(SKB)->tstamp.tv64)      \
1640                         __net_timestamp(SKB);           \
1641         }                                               \
1642
1643 static inline bool is_skb_forwardable(struct net_device *dev,
1644                                       struct sk_buff *skb)
1645 {
1646         unsigned int len;
1647
1648         if (!(dev->flags & IFF_UP))
1649                 return false;
1650
1651         len = dev->mtu + dev->hard_header_len + VLAN_HLEN;
1652         if (skb->len <= len)
1653                 return true;
1654
1655         /* if TSO is enabled, we don't care about the length as the packet
1656          * could be forwarded without being segmented before
1657          */
1658         if (skb_is_gso(skb))
1659                 return true;
1660
1661         return false;
1662 }
1663
1664 /**
1665  * dev_forward_skb - loopback an skb to another netif
1666  *
1667  * @dev: destination network device
1668  * @skb: buffer to forward
1669  *
1670  * return values:
1671  *      NET_RX_SUCCESS  (no congestion)
1672  *      NET_RX_DROP     (packet was dropped, but freed)
1673  *
1674  * dev_forward_skb can be used for injecting an skb from the
1675  * start_xmit function of one device into the receive queue
1676  * of another device.
1677  *
1678  * The receiving device may be in another namespace, so
1679  * we have to clear all information in the skb that could
1680  * impact namespace isolation.
1681  */
1682 int dev_forward_skb(struct net_device *dev, struct sk_buff *skb)
1683 {
1684         if (skb_shinfo(skb)->tx_flags & SKBTX_DEV_ZEROCOPY) {
1685                 if (skb_copy_ubufs(skb, GFP_ATOMIC)) {
1686                         atomic_long_inc(&dev->rx_dropped);
1687                         kfree_skb(skb);
1688                         return NET_RX_DROP;
1689                 }
1690         }
1691
1692         if (unlikely(!is_skb_forwardable(dev, skb))) {
1693                 atomic_long_inc(&dev->rx_dropped);
1694                 kfree_skb(skb);
1695                 return NET_RX_DROP;
1696         }
1697
1698         skb_scrub_packet(skb, true);
1699         skb->protocol = eth_type_trans(skb, dev);
1700
1701         return netif_rx(skb);
1702 }
1703 EXPORT_SYMBOL_GPL(dev_forward_skb);
1704
1705 static inline int deliver_skb(struct sk_buff *skb,
1706                               struct packet_type *pt_prev,
1707                               struct net_device *orig_dev)
1708 {
1709         if (unlikely(skb_orphan_frags(skb, GFP_ATOMIC)))
1710                 return -ENOMEM;
1711         atomic_inc(&skb->users);
1712         return pt_prev->func(skb, skb->dev, pt_prev, orig_dev);
1713 }
1714
1715 static inline bool skb_loop_sk(struct packet_type *ptype, struct sk_buff *skb)
1716 {
1717         if (!ptype->af_packet_priv || !skb->sk)
1718                 return false;
1719
1720         if (ptype->id_match)
1721                 return ptype->id_match(ptype, skb->sk);
1722         else if ((struct sock *)ptype->af_packet_priv == skb->sk)
1723                 return true;
1724
1725         return false;
1726 }
1727
1728 /*
1729  *      Support routine. Sends outgoing frames to any network
1730  *      taps currently in use.
1731  */
1732
1733 static void dev_queue_xmit_nit(struct sk_buff *skb, struct net_device *dev)
1734 {
1735         struct packet_type *ptype;
1736         struct sk_buff *skb2 = NULL;
1737         struct packet_type *pt_prev = NULL;
1738
1739         rcu_read_lock();
1740         list_for_each_entry_rcu(ptype, &ptype_all, list) {
1741                 /* Never send packets back to the socket
1742                  * they originated from - MvS (miquels@drinkel.ow.org)
1743                  */
1744                 if ((ptype->dev == dev || !ptype->dev) &&
1745                     (!skb_loop_sk(ptype, skb))) {
1746                         if (pt_prev) {
1747                                 deliver_skb(skb2, pt_prev, skb->dev);
1748                                 pt_prev = ptype;
1749                                 continue;
1750                         }
1751
1752                         skb2 = skb_clone(skb, GFP_ATOMIC);
1753                         if (!skb2)
1754                                 break;
1755
1756                         net_timestamp_set(skb2);
1757
1758                         /* skb->nh should be correctly
1759                            set by sender, so that the second statement is
1760                            just protection against buggy protocols.
1761                          */
1762                         skb_reset_mac_header(skb2);
1763
1764                         if (skb_network_header(skb2) < skb2->data ||
1765                             skb_network_header(skb2) > skb_tail_pointer(skb2)) {
1766                                 net_crit_ratelimited("protocol %04x is buggy, dev %s\n",
1767                                                      ntohs(skb2->protocol),
1768                                                      dev->name);
1769                                 skb_reset_network_header(skb2);
1770                         }
1771
1772                         skb2->transport_header = skb2->network_header;
1773                         skb2->pkt_type = PACKET_OUTGOING;
1774                         pt_prev = ptype;
1775                 }
1776         }
1777         if (pt_prev)
1778                 pt_prev->func(skb2, skb->dev, pt_prev, skb->dev);
1779         rcu_read_unlock();
1780 }
1781
1782 /**
1783  * netif_setup_tc - Handle tc mappings on real_num_tx_queues change
1784  * @dev: Network device
1785  * @txq: number of queues available
1786  *
1787  * If real_num_tx_queues is changed the tc mappings may no longer be
1788  * valid. To resolve this verify the tc mapping remains valid and if
1789  * not NULL the mapping. With no priorities mapping to this
1790  * offset/count pair it will no longer be used. In the worst case TC0
1791  * is invalid nothing can be done so disable priority mappings. If is
1792  * expected that drivers will fix this mapping if they can before
1793  * calling netif_set_real_num_tx_queues.
1794  */
1795 static void netif_setup_tc(struct net_device *dev, unsigned int txq)
1796 {
1797         int i;
1798         struct netdev_tc_txq *tc = &dev->tc_to_txq[0];
1799
1800         /* If TC0 is invalidated disable TC mapping */
1801         if (tc->offset + tc->count > txq) {
1802                 pr_warn("Number of in use tx queues changed invalidating tc mappings. Priority traffic classification disabled!\n");
1803                 dev->num_tc = 0;
1804                 return;
1805         }
1806
1807         /* Invalidated prio to tc mappings set to TC0 */
1808         for (i = 1; i < TC_BITMASK + 1; i++) {
1809                 int q = netdev_get_prio_tc_map(dev, i);
1810
1811                 tc = &dev->tc_to_txq[q];
1812                 if (tc->offset + tc->count > txq) {
1813                         pr_warn("Number of in use tx queues changed. Priority %i to tc mapping %i is no longer valid. Setting map to 0\n",
1814                                 i, q);
1815                         netdev_set_prio_tc_map(dev, i, 0);
1816                 }
1817         }
1818 }
1819
1820 #ifdef CONFIG_XPS
1821 static DEFINE_MUTEX(xps_map_mutex);
1822 #define xmap_dereference(P)             \
1823         rcu_dereference_protected((P), lockdep_is_held(&xps_map_mutex))
1824
1825 static struct xps_map *remove_xps_queue(struct xps_dev_maps *dev_maps,
1826                                         int cpu, u16 index)
1827 {
1828         struct xps_map *map = NULL;
1829         int pos;
1830
1831         if (dev_maps)
1832                 map = xmap_dereference(dev_maps->cpu_map[cpu]);
1833
1834         for (pos = 0; map && pos < map->len; pos++) {
1835                 if (map->queues[pos] == index) {
1836                         if (map->len > 1) {
1837                                 map->queues[pos] = map->queues[--map->len];
1838                         } else {
1839                                 RCU_INIT_POINTER(dev_maps->cpu_map[cpu], NULL);
1840                                 kfree_rcu(map, rcu);
1841                                 map = NULL;
1842                         }
1843                         break;
1844                 }
1845         }
1846
1847         return map;
1848 }
1849
1850 static void netif_reset_xps_queues_gt(struct net_device *dev, u16 index)
1851 {
1852         struct xps_dev_maps *dev_maps;
1853         int cpu, i;
1854         bool active = false;
1855
1856         mutex_lock(&xps_map_mutex);
1857         dev_maps = xmap_dereference(dev->xps_maps);
1858
1859         if (!dev_maps)
1860                 goto out_no_maps;
1861
1862         for_each_possible_cpu(cpu) {
1863                 for (i = index; i < dev->num_tx_queues; i++) {
1864                         if (!remove_xps_queue(dev_maps, cpu, i))
1865                                 break;
1866                 }
1867                 if (i == dev->num_tx_queues)
1868                         active = true;
1869         }
1870
1871         if (!active) {
1872                 RCU_INIT_POINTER(dev->xps_maps, NULL);
1873                 kfree_rcu(dev_maps, rcu);
1874         }
1875
1876         for (i = index; i < dev->num_tx_queues; i++)
1877                 netdev_queue_numa_node_write(netdev_get_tx_queue(dev, i),
1878                                              NUMA_NO_NODE);
1879
1880 out_no_maps:
1881         mutex_unlock(&xps_map_mutex);
1882 }
1883
1884 static struct xps_map *expand_xps_map(struct xps_map *map,
1885                                       int cpu, u16 index)
1886 {
1887         struct xps_map *new_map;
1888         int alloc_len = XPS_MIN_MAP_ALLOC;
1889         int i, pos;
1890
1891         for (pos = 0; map && pos < map->len; pos++) {
1892                 if (map->queues[pos] != index)
1893                         continue;
1894                 return map;
1895         }
1896
1897         /* Need to add queue to this CPU's existing map */
1898         if (map) {
1899                 if (pos < map->alloc_len)
1900                         return map;
1901
1902                 alloc_len = map->alloc_len * 2;
1903         }
1904
1905         /* Need to allocate new map to store queue on this CPU's map */
1906         new_map = kzalloc_node(XPS_MAP_SIZE(alloc_len), GFP_KERNEL,
1907                                cpu_to_node(cpu));
1908         if (!new_map)
1909                 return NULL;
1910
1911         for (i = 0; i < pos; i++)
1912                 new_map->queues[i] = map->queues[i];
1913         new_map->alloc_len = alloc_len;
1914         new_map->len = pos;
1915
1916         return new_map;
1917 }
1918
1919 int netif_set_xps_queue(struct net_device *dev, const struct cpumask *mask,
1920                         u16 index)
1921 {
1922         struct xps_dev_maps *dev_maps, *new_dev_maps = NULL;
1923         struct xps_map *map, *new_map;
1924         int maps_sz = max_t(unsigned int, XPS_DEV_MAPS_SIZE, L1_CACHE_BYTES);
1925         int cpu, numa_node_id = -2;
1926         bool active = false;
1927
1928         mutex_lock(&xps_map_mutex);
1929
1930         dev_maps = xmap_dereference(dev->xps_maps);
1931
1932         /* allocate memory for queue storage */
1933         for_each_online_cpu(cpu) {
1934                 if (!cpumask_test_cpu(cpu, mask))
1935                         continue;
1936
1937                 if (!new_dev_maps)
1938                         new_dev_maps = kzalloc(maps_sz, GFP_KERNEL);
1939                 if (!new_dev_maps) {
1940                         mutex_unlock(&xps_map_mutex);
1941                         return -ENOMEM;
1942                 }
1943
1944                 map = dev_maps ? xmap_dereference(dev_maps->cpu_map[cpu]) :
1945                                  NULL;
1946
1947                 map = expand_xps_map(map, cpu, index);
1948                 if (!map)
1949                         goto error;
1950
1951                 RCU_INIT_POINTER(new_dev_maps->cpu_map[cpu], map);
1952         }
1953
1954         if (!new_dev_maps)
1955                 goto out_no_new_maps;
1956
1957         for_each_possible_cpu(cpu) {
1958                 if (cpumask_test_cpu(cpu, mask) && cpu_online(cpu)) {
1959                         /* add queue to CPU maps */
1960                         int pos = 0;
1961
1962                         map = xmap_dereference(new_dev_maps->cpu_map[cpu]);
1963                         while ((pos < map->len) && (map->queues[pos] != index))
1964                                 pos++;
1965
1966                         if (pos == map->len)
1967                                 map->queues[map->len++] = index;
1968 #ifdef CONFIG_NUMA
1969                         if (numa_node_id == -2)
1970                                 numa_node_id = cpu_to_node(cpu);
1971                         else if (numa_node_id != cpu_to_node(cpu))
1972                                 numa_node_id = -1;
1973 #endif
1974                 } else if (dev_maps) {
1975                         /* fill in the new device map from the old device map */
1976                         map = xmap_dereference(dev_maps->cpu_map[cpu]);
1977                         RCU_INIT_POINTER(new_dev_maps->cpu_map[cpu], map);
1978                 }
1979
1980         }
1981
1982         rcu_assign_pointer(dev->xps_maps, new_dev_maps);
1983
1984         /* Cleanup old maps */
1985         if (dev_maps) {
1986                 for_each_possible_cpu(cpu) {
1987                         new_map = xmap_dereference(new_dev_maps->cpu_map[cpu]);
1988                         map = xmap_dereference(dev_maps->cpu_map[cpu]);
1989                         if (map && map != new_map)
1990                                 kfree_rcu(map, rcu);
1991                 }
1992
1993                 kfree_rcu(dev_maps, rcu);
1994         }
1995
1996         dev_maps = new_dev_maps;
1997         active = true;
1998
1999 out_no_new_maps:
2000         /* update Tx queue numa node */
2001         netdev_queue_numa_node_write(netdev_get_tx_queue(dev, index),
2002                                      (numa_node_id >= 0) ? numa_node_id :
2003                                      NUMA_NO_NODE);
2004
2005         if (!dev_maps)
2006                 goto out_no_maps;
2007
2008         /* removes queue from unused CPUs */
2009         for_each_possible_cpu(cpu) {
2010                 if (cpumask_test_cpu(cpu, mask) && cpu_online(cpu))
2011                         continue;
2012
2013                 if (remove_xps_queue(dev_maps, cpu, index))
2014                         active = true;
2015         }
2016
2017         /* free map if not active */
2018         if (!active) {
2019                 RCU_INIT_POINTER(dev->xps_maps, NULL);
2020                 kfree_rcu(dev_maps, rcu);
2021         }
2022
2023 out_no_maps:
2024         mutex_unlock(&xps_map_mutex);
2025
2026         return 0;
2027 error:
2028         /* remove any maps that we added */
2029         for_each_possible_cpu(cpu) {
2030                 new_map = xmap_dereference(new_dev_maps->cpu_map[cpu]);
2031                 map = dev_maps ? xmap_dereference(dev_maps->cpu_map[cpu]) :
2032                                  NULL;
2033                 if (new_map && new_map != map)
2034                         kfree(new_map);
2035         }
2036
2037         mutex_unlock(&xps_map_mutex);
2038
2039         kfree(new_dev_maps);
2040         return -ENOMEM;
2041 }
2042 EXPORT_SYMBOL(netif_set_xps_queue);
2043
2044 #endif
2045 /*
2046  * Routine to help set real_num_tx_queues. To avoid skbs mapped to queues
2047  * greater then real_num_tx_queues stale skbs on the qdisc must be flushed.
2048  */
2049 int netif_set_real_num_tx_queues(struct net_device *dev, unsigned int txq)
2050 {
2051         int rc;
2052
2053         if (txq < 1 || txq > dev->num_tx_queues)
2054                 return -EINVAL;
2055
2056         if (dev->reg_state == NETREG_REGISTERED ||
2057             dev->reg_state == NETREG_UNREGISTERING) {
2058                 ASSERT_RTNL();
2059
2060                 rc = netdev_queue_update_kobjects(dev, dev->real_num_tx_queues,
2061                                                   txq);
2062                 if (rc)
2063                         return rc;
2064
2065                 if (dev->num_tc)
2066                         netif_setup_tc(dev, txq);
2067
2068                 if (txq < dev->real_num_tx_queues) {
2069                         qdisc_reset_all_tx_gt(dev, txq);
2070 #ifdef CONFIG_XPS
2071                         netif_reset_xps_queues_gt(dev, txq);
2072 #endif
2073                 }
2074         }
2075
2076         dev->real_num_tx_queues = txq;
2077         return 0;
2078 }
2079 EXPORT_SYMBOL(netif_set_real_num_tx_queues);
2080
2081 #ifdef CONFIG_RPS
2082 /**
2083  *      netif_set_real_num_rx_queues - set actual number of RX queues used
2084  *      @dev: Network device
2085  *      @rxq: Actual number of RX queues
2086  *
2087  *      This must be called either with the rtnl_lock held or before
2088  *      registration of the net device.  Returns 0 on success, or a
2089  *      negative error code.  If called before registration, it always
2090  *      succeeds.
2091  */
2092 int netif_set_real_num_rx_queues(struct net_device *dev, unsigned int rxq)
2093 {
2094         int rc;
2095
2096         if (rxq < 1 || rxq > dev->num_rx_queues)
2097                 return -EINVAL;
2098
2099         if (dev->reg_state == NETREG_REGISTERED) {
2100                 ASSERT_RTNL();
2101
2102                 rc = net_rx_queue_update_kobjects(dev, dev->real_num_rx_queues,
2103                                                   rxq);
2104                 if (rc)
2105                         return rc;
2106         }
2107
2108         dev->real_num_rx_queues = rxq;
2109         return 0;
2110 }
2111 EXPORT_SYMBOL(netif_set_real_num_rx_queues);
2112 #endif
2113
2114 /**
2115  * netif_get_num_default_rss_queues - default number of RSS queues
2116  *
2117  * This routine should set an upper limit on the number of RSS queues
2118  * used by default by multiqueue devices.
2119  */
2120 int netif_get_num_default_rss_queues(void)
2121 {
2122         return min_t(int, DEFAULT_MAX_NUM_RSS_QUEUES, num_online_cpus());
2123 }
2124 EXPORT_SYMBOL(netif_get_num_default_rss_queues);
2125
2126 static inline void __netif_reschedule(struct Qdisc *q)
2127 {
2128         struct softnet_data *sd;
2129         unsigned long flags;
2130
2131         local_irq_save(flags);
2132         sd = &__get_cpu_var(softnet_data);
2133         q->next_sched = NULL;
2134         *sd->output_queue_tailp = q;
2135         sd->output_queue_tailp = &q->next_sched;
2136         raise_softirq_irqoff(NET_TX_SOFTIRQ);
2137         local_irq_restore(flags);
2138 }
2139
2140 void __netif_schedule(struct Qdisc *q)
2141 {
2142         if (!test_and_set_bit(__QDISC_STATE_SCHED, &q->state))
2143                 __netif_reschedule(q);
2144 }
2145 EXPORT_SYMBOL(__netif_schedule);
2146
2147 struct dev_kfree_skb_cb {
2148         enum skb_free_reason reason;
2149 };
2150
2151 static struct dev_kfree_skb_cb *get_kfree_skb_cb(const struct sk_buff *skb)
2152 {
2153         return (struct dev_kfree_skb_cb *)skb->cb;
2154 }
2155
2156 void __dev_kfree_skb_irq(struct sk_buff *skb, enum skb_free_reason reason)
2157 {
2158         unsigned long flags;
2159
2160         if (likely(atomic_read(&skb->users) == 1)) {
2161                 smp_rmb();
2162                 atomic_set(&skb->users, 0);
2163         } else if (likely(!atomic_dec_and_test(&skb->users))) {
2164                 return;
2165         }
2166         get_kfree_skb_cb(skb)->reason = reason;
2167         local_irq_save(flags);
2168         skb->next = __this_cpu_read(softnet_data.completion_queue);
2169         __this_cpu_write(softnet_data.completion_queue, skb);
2170         raise_softirq_irqoff(NET_TX_SOFTIRQ);
2171         local_irq_restore(flags);
2172 }
2173 EXPORT_SYMBOL(__dev_kfree_skb_irq);
2174
2175 void __dev_kfree_skb_any(struct sk_buff *skb, enum skb_free_reason reason)
2176 {
2177         if (in_irq() || irqs_disabled())
2178                 __dev_kfree_skb_irq(skb, reason);
2179         else
2180                 dev_kfree_skb(skb);
2181 }
2182 EXPORT_SYMBOL(__dev_kfree_skb_any);
2183
2184
2185 /**
2186  * netif_device_detach - mark device as removed
2187  * @dev: network device
2188  *
2189  * Mark device as removed from system and therefore no longer available.
2190  */
2191 void netif_device_detach(struct net_device *dev)
2192 {
2193         if (test_and_clear_bit(__LINK_STATE_PRESENT, &dev->state) &&
2194             netif_running(dev)) {
2195                 netif_tx_stop_all_queues(dev);
2196         }
2197 }
2198 EXPORT_SYMBOL(netif_device_detach);
2199
2200 /**
2201  * netif_device_attach - mark device as attached
2202  * @dev: network device
2203  *
2204  * Mark device as attached from system and restart if needed.
2205  */
2206 void netif_device_attach(struct net_device *dev)
2207 {
2208         if (!test_and_set_bit(__LINK_STATE_PRESENT, &dev->state) &&
2209             netif_running(dev)) {
2210                 netif_tx_wake_all_queues(dev);
2211                 __netdev_watchdog_up(dev);
2212         }
2213 }
2214 EXPORT_SYMBOL(netif_device_attach);
2215
2216 static void skb_warn_bad_offload(const struct sk_buff *skb)
2217 {
2218         static const netdev_features_t null_features = 0;
2219         struct net_device *dev = skb->dev;
2220         const char *driver = "";
2221
2222         if (!net_ratelimit())
2223                 return;
2224
2225         if (dev && dev->dev.parent)
2226                 driver = dev_driver_string(dev->dev.parent);
2227
2228         WARN(1, "%s: caps=(%pNF, %pNF) len=%d data_len=%d gso_size=%d "
2229              "gso_type=%d ip_summed=%d\n",
2230              driver, dev ? &dev->features : &null_features,
2231              skb->sk ? &skb->sk->sk_route_caps : &null_features,
2232              skb->len, skb->data_len, skb_shinfo(skb)->gso_size,
2233              skb_shinfo(skb)->gso_type, skb->ip_summed);
2234 }
2235
2236 /*
2237  * Invalidate hardware checksum when packet is to be mangled, and
2238  * complete checksum manually on outgoing path.
2239  */
2240 int skb_checksum_help(struct sk_buff *skb)
2241 {
2242         __wsum csum;
2243         int ret = 0, offset;
2244
2245         if (skb->ip_summed == CHECKSUM_COMPLETE)
2246                 goto out_set_summed;
2247
2248         if (unlikely(skb_shinfo(skb)->gso_size)) {
2249                 skb_warn_bad_offload(skb);
2250                 return -EINVAL;
2251         }
2252
2253         /* Before computing a checksum, we should make sure no frag could
2254          * be modified by an external entity : checksum could be wrong.
2255          */
2256         if (skb_has_shared_frag(skb)) {
2257                 ret = __skb_linearize(skb);
2258                 if (ret)
2259                         goto out;
2260         }
2261
2262         offset = skb_checksum_start_offset(skb);
2263         BUG_ON(offset >= skb_headlen(skb));
2264         csum = skb_checksum(skb, offset, skb->len - offset, 0);
2265
2266         offset += skb->csum_offset;
2267         BUG_ON(offset + sizeof(__sum16) > skb_headlen(skb));
2268
2269         if (skb_cloned(skb) &&
2270             !skb_clone_writable(skb, offset + sizeof(__sum16))) {
2271                 ret = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
2272                 if (ret)
2273                         goto out;
2274         }
2275
2276         *(__sum16 *)(skb->data + offset) = csum_fold(csum);
2277 out_set_summed:
2278         skb->ip_summed = CHECKSUM_NONE;
2279 out:
2280         return ret;
2281 }
2282 EXPORT_SYMBOL(skb_checksum_help);
2283
2284 __be16 skb_network_protocol(struct sk_buff *skb)
2285 {
2286         __be16 type = skb->protocol;
2287         int vlan_depth = ETH_HLEN;
2288
2289         /* Tunnel gso handlers can set protocol to ethernet. */
2290         if (type == htons(ETH_P_TEB)) {
2291                 struct ethhdr *eth;
2292
2293                 if (unlikely(!pskb_may_pull(skb, sizeof(struct ethhdr))))
2294                         return 0;
2295
2296                 eth = (struct ethhdr *)skb_mac_header(skb);
2297                 type = eth->h_proto;
2298         }
2299
2300         while (type == htons(ETH_P_8021Q) || type == htons(ETH_P_8021AD)) {
2301                 struct vlan_hdr *vh;
2302
2303                 if (unlikely(!pskb_may_pull(skb, vlan_depth + VLAN_HLEN)))
2304                         return 0;
2305
2306                 vh = (struct vlan_hdr *)(skb->data + vlan_depth);
2307                 type = vh->h_vlan_encapsulated_proto;
2308                 vlan_depth += VLAN_HLEN;
2309         }
2310
2311         return type;
2312 }
2313
2314 /**
2315  *      skb_mac_gso_segment - mac layer segmentation handler.
2316  *      @skb: buffer to segment
2317  *      @features: features for the output path (see dev->features)
2318  */
2319 struct sk_buff *skb_mac_gso_segment(struct sk_buff *skb,
2320                                     netdev_features_t features)
2321 {
2322         struct sk_buff *segs = ERR_PTR(-EPROTONOSUPPORT);
2323         struct packet_offload *ptype;
2324         __be16 type = skb_network_protocol(skb);
2325
2326         if (unlikely(!type))
2327                 return ERR_PTR(-EINVAL);
2328
2329         __skb_pull(skb, skb->mac_len);
2330
2331         rcu_read_lock();
2332         list_for_each_entry_rcu(ptype, &offload_base, list) {
2333                 if (ptype->type == type && ptype->callbacks.gso_segment) {
2334                         if (unlikely(skb->ip_summed != CHECKSUM_PARTIAL)) {
2335                                 int err;
2336
2337                                 err = ptype->callbacks.gso_send_check(skb);
2338                                 segs = ERR_PTR(err);
2339                                 if (err || skb_gso_ok(skb, features))
2340                                         break;
2341                                 __skb_push(skb, (skb->data -
2342                                                  skb_network_header(skb)));
2343                         }
2344                         segs = ptype->callbacks.gso_segment(skb, features);
2345                         break;
2346                 }
2347         }
2348         rcu_read_unlock();
2349
2350         __skb_push(skb, skb->data - skb_mac_header(skb));
2351
2352         return segs;
2353 }
2354 EXPORT_SYMBOL(skb_mac_gso_segment);
2355
2356
2357 /* openvswitch calls this on rx path, so we need a different check.
2358  */
2359 static inline bool skb_needs_check(struct sk_buff *skb, bool tx_path)
2360 {
2361         if (tx_path)
2362                 return skb->ip_summed != CHECKSUM_PARTIAL;
2363         else
2364                 return skb->ip_summed == CHECKSUM_NONE;
2365 }
2366
2367 /**
2368  *      __skb_gso_segment - Perform segmentation on skb.
2369  *      @skb: buffer to segment
2370  *      @features: features for the output path (see dev->features)
2371  *      @tx_path: whether it is called in TX path
2372  *
2373  *      This function segments the given skb and returns a list of segments.
2374  *
2375  *      It may return NULL if the skb requires no segmentation.  This is
2376  *      only possible when GSO is used for verifying header integrity.
2377  */
2378 struct sk_buff *__skb_gso_segment(struct sk_buff *skb,
2379                                   netdev_features_t features, bool tx_path)
2380 {
2381         if (unlikely(skb_needs_check(skb, tx_path))) {
2382                 int err;
2383
2384                 skb_warn_bad_offload(skb);
2385
2386                 if (skb_header_cloned(skb) &&
2387                     (err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC)))
2388                         return ERR_PTR(err);
2389         }
2390
2391         SKB_GSO_CB(skb)->mac_offset = skb_headroom(skb);
2392         SKB_GSO_CB(skb)->encap_level = 0;
2393
2394         skb_reset_mac_header(skb);
2395         skb_reset_mac_len(skb);
2396
2397         return skb_mac_gso_segment(skb, features);
2398 }
2399 EXPORT_SYMBOL(__skb_gso_segment);
2400
2401 /* Take action when hardware reception checksum errors are detected. */
2402 #ifdef CONFIG_BUG
2403 void netdev_rx_csum_fault(struct net_device *dev)
2404 {
2405         if (net_ratelimit()) {
2406                 pr_err("%s: hw csum failure\n", dev ? dev->name : "<unknown>");
2407                 dump_stack();
2408         }
2409 }
2410 EXPORT_SYMBOL(netdev_rx_csum_fault);
2411 #endif
2412
2413 /* Actually, we should eliminate this check as soon as we know, that:
2414  * 1. IOMMU is present and allows to map all the memory.
2415  * 2. No high memory really exists on this machine.
2416  */
2417
2418 static int illegal_highdma(struct net_device *dev, struct sk_buff *skb)
2419 {
2420 #ifdef CONFIG_HIGHMEM
2421         int i;
2422         if (!(dev->features & NETIF_F_HIGHDMA)) {
2423                 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
2424                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2425                         if (PageHighMem(skb_frag_page(frag)))
2426                                 return 1;
2427                 }
2428         }
2429
2430         if (PCI_DMA_BUS_IS_PHYS) {
2431                 struct device *pdev = dev->dev.parent;
2432
2433                 if (!pdev)
2434                         return 0;
2435                 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
2436                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2437                         dma_addr_t addr = page_to_phys(skb_frag_page(frag));
2438                         if (!pdev->dma_mask || addr + PAGE_SIZE - 1 > *pdev->dma_mask)
2439                                 return 1;
2440                 }
2441         }
2442 #endif
2443         return 0;
2444 }
2445
2446 struct dev_gso_cb {
2447         void (*destructor)(struct sk_buff *skb);
2448 };
2449
2450 #define DEV_GSO_CB(skb) ((struct dev_gso_cb *)(skb)->cb)
2451
2452 static void dev_gso_skb_destructor(struct sk_buff *skb)
2453 {
2454         struct dev_gso_cb *cb;
2455
2456         kfree_skb_list(skb->next);
2457         skb->next = NULL;
2458
2459         cb = DEV_GSO_CB(skb);
2460         if (cb->destructor)
2461                 cb->destructor(skb);
2462 }
2463
2464 /**
2465  *      dev_gso_segment - Perform emulated hardware segmentation on skb.
2466  *      @skb: buffer to segment
2467  *      @features: device features as applicable to this skb
2468  *
2469  *      This function segments the given skb and stores the list of segments
2470  *      in skb->next.
2471  */
2472 static int dev_gso_segment(struct sk_buff *skb, netdev_features_t features)
2473 {
2474         struct sk_buff *segs;
2475
2476         segs = skb_gso_segment(skb, features);
2477
2478         /* Verifying header integrity only. */
2479         if (!segs)
2480                 return 0;
2481
2482         if (IS_ERR(segs))
2483                 return PTR_ERR(segs);
2484
2485         skb->next = segs;
2486         DEV_GSO_CB(skb)->destructor = skb->destructor;
2487         skb->destructor = dev_gso_skb_destructor;
2488
2489         return 0;
2490 }
2491
2492 static netdev_features_t harmonize_features(struct sk_buff *skb,
2493         netdev_features_t features)
2494 {
2495         if (skb->ip_summed != CHECKSUM_NONE &&
2496             !can_checksum_protocol(features, skb_network_protocol(skb))) {
2497                 features &= ~NETIF_F_ALL_CSUM;
2498         } else if (illegal_highdma(skb->dev, skb)) {
2499                 features &= ~NETIF_F_SG;
2500         }
2501
2502         return features;
2503 }
2504
2505 netdev_features_t netif_skb_features(struct sk_buff *skb)
2506 {
2507         __be16 protocol = skb->protocol;
2508         netdev_features_t features = skb->dev->features;
2509
2510         if (skb_shinfo(skb)->gso_segs > skb->dev->gso_max_segs)
2511                 features &= ~NETIF_F_GSO_MASK;
2512
2513         if (protocol == htons(ETH_P_8021Q) || protocol == htons(ETH_P_8021AD)) {
2514                 struct vlan_ethhdr *veh = (struct vlan_ethhdr *)skb->data;
2515                 protocol = veh->h_vlan_encapsulated_proto;
2516         } else if (!vlan_tx_tag_present(skb)) {
2517                 return harmonize_features(skb, features);
2518         }
2519
2520         features &= (skb->dev->vlan_features | NETIF_F_HW_VLAN_CTAG_TX |
2521                                                NETIF_F_HW_VLAN_STAG_TX);
2522
2523         if (protocol == htons(ETH_P_8021Q) || protocol == htons(ETH_P_8021AD))
2524                 features &= NETIF_F_SG | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST |
2525                                 NETIF_F_GEN_CSUM | NETIF_F_HW_VLAN_CTAG_TX |
2526                                 NETIF_F_HW_VLAN_STAG_TX;
2527
2528         return harmonize_features(skb, features);
2529 }
2530 EXPORT_SYMBOL(netif_skb_features);
2531
2532 int dev_hard_start_xmit(struct sk_buff *skb, struct net_device *dev,
2533                         struct netdev_queue *txq, void *accel_priv)
2534 {
2535         const struct net_device_ops *ops = dev->netdev_ops;
2536         int rc = NETDEV_TX_OK;
2537         unsigned int skb_len;
2538
2539         if (likely(!skb->next)) {
2540                 netdev_features_t features;
2541
2542                 /*
2543                  * If device doesn't need skb->dst, release it right now while
2544                  * its hot in this cpu cache
2545                  */
2546                 if (dev->priv_flags & IFF_XMIT_DST_RELEASE)
2547                         skb_dst_drop(skb);
2548
2549                 features = netif_skb_features(skb);
2550
2551                 if (vlan_tx_tag_present(skb) &&
2552                     !vlan_hw_offload_capable(features, skb->vlan_proto)) {
2553                         skb = __vlan_put_tag(skb, skb->vlan_proto,
2554                                              vlan_tx_tag_get(skb));
2555                         if (unlikely(!skb))
2556                                 goto out;
2557
2558                         skb->vlan_tci = 0;
2559                 }
2560
2561                 /* If encapsulation offload request, verify we are testing
2562                  * hardware encapsulation features instead of standard
2563                  * features for the netdev
2564                  */
2565                 if (skb->encapsulation)
2566                         features &= dev->hw_enc_features;
2567
2568                 if (netif_needs_gso(skb, features)) {
2569                         if (unlikely(dev_gso_segment(skb, features)))
2570                                 goto out_kfree_skb;
2571                         if (skb->next)
2572                                 goto gso;
2573                 } else {
2574                         if (skb_needs_linearize(skb, features) &&
2575                             __skb_linearize(skb))
2576                                 goto out_kfree_skb;
2577
2578                         /* If packet is not checksummed and device does not
2579                          * support checksumming for this protocol, complete
2580                          * checksumming here.
2581                          */
2582                         if (skb->ip_summed == CHECKSUM_PARTIAL) {
2583                                 if (skb->encapsulation)
2584                                         skb_set_inner_transport_header(skb,
2585                                                 skb_checksum_start_offset(skb));
2586                                 else
2587                                         skb_set_transport_header(skb,
2588                                                 skb_checksum_start_offset(skb));
2589                                 if (!(features & NETIF_F_ALL_CSUM) &&
2590                                      skb_checksum_help(skb))
2591                                         goto out_kfree_skb;
2592                         }
2593                 }
2594
2595                 if (!list_empty(&ptype_all))
2596                         dev_queue_xmit_nit(skb, dev);
2597
2598                 skb_len = skb->len;
2599                 if (accel_priv)
2600                         rc = ops->ndo_dfwd_start_xmit(skb, dev, accel_priv);
2601                 else
2602                         rc = ops->ndo_start_xmit(skb, dev);
2603
2604                 trace_net_dev_xmit(skb, rc, dev, skb_len);
2605                 if (rc == NETDEV_TX_OK && txq)
2606                         txq_trans_update(txq);
2607                 return rc;
2608         }
2609
2610 gso:
2611         do {
2612                 struct sk_buff *nskb = skb->next;
2613
2614                 skb->next = nskb->next;
2615                 nskb->next = NULL;
2616
2617                 if (!list_empty(&ptype_all))
2618                         dev_queue_xmit_nit(nskb, dev);
2619
2620                 skb_len = nskb->len;
2621                 if (accel_priv)
2622                         rc = ops->ndo_dfwd_start_xmit(nskb, dev, accel_priv);
2623                 else
2624                         rc = ops->ndo_start_xmit(nskb, dev);
2625                 trace_net_dev_xmit(nskb, rc, dev, skb_len);
2626                 if (unlikely(rc != NETDEV_TX_OK)) {
2627                         if (rc & ~NETDEV_TX_MASK)
2628                                 goto out_kfree_gso_skb;
2629                         nskb->next = skb->next;
2630                         skb->next = nskb;
2631                         return rc;
2632                 }
2633                 txq_trans_update(txq);
2634                 if (unlikely(netif_xmit_stopped(txq) && skb->next))
2635                         return NETDEV_TX_BUSY;
2636         } while (skb->next);
2637
2638 out_kfree_gso_skb:
2639         if (likely(skb->next == NULL)) {
2640                 skb->destructor = DEV_GSO_CB(skb)->destructor;
2641                 consume_skb(skb);
2642                 return rc;
2643         }
2644 out_kfree_skb:
2645         kfree_skb(skb);
2646 out:
2647         return rc;
2648 }
2649 EXPORT_SYMBOL_GPL(dev_hard_start_xmit);
2650
2651 static void qdisc_pkt_len_init(struct sk_buff *skb)
2652 {
2653         const struct skb_shared_info *shinfo = skb_shinfo(skb);
2654
2655         qdisc_skb_cb(skb)->pkt_len = skb->len;
2656
2657         /* To get more precise estimation of bytes sent on wire,
2658          * we add to pkt_len the headers size of all segments
2659          */
2660         if (shinfo->gso_size)  {
2661                 unsigned int hdr_len;
2662                 u16 gso_segs = shinfo->gso_segs;
2663
2664                 /* mac layer + network layer */
2665                 hdr_len = skb_transport_header(skb) - skb_mac_header(skb);
2666
2667                 /* + transport layer */
2668                 if (likely(shinfo->gso_type & (SKB_GSO_TCPV4 | SKB_GSO_TCPV6)))
2669                         hdr_len += tcp_hdrlen(skb);
2670                 else
2671                         hdr_len += sizeof(struct udphdr);
2672
2673                 if (shinfo->gso_type & SKB_GSO_DODGY)
2674                         gso_segs = DIV_ROUND_UP(skb->len - hdr_len,
2675                                                 shinfo->gso_size);
2676
2677                 qdisc_skb_cb(skb)->pkt_len += (gso_segs - 1) * hdr_len;
2678         }
2679 }
2680
2681 static inline int __dev_xmit_skb(struct sk_buff *skb, struct Qdisc *q,
2682                                  struct net_device *dev,
2683                                  struct netdev_queue *txq)
2684 {
2685         spinlock_t *root_lock = qdisc_lock(q);
2686         bool contended;
2687         int rc;
2688
2689         qdisc_pkt_len_init(skb);
2690         qdisc_calculate_pkt_len(skb, q);
2691         /*
2692          * Heuristic to force contended enqueues to serialize on a
2693          * separate lock before trying to get qdisc main lock.
2694          * This permits __QDISC_STATE_RUNNING owner to get the lock more often
2695          * and dequeue packets faster.
2696          */
2697         contended = qdisc_is_running(q);
2698         if (unlikely(contended))
2699                 spin_lock(&q->busylock);
2700
2701         spin_lock(root_lock);
2702         if (unlikely(test_bit(__QDISC_STATE_DEACTIVATED, &q->state))) {
2703                 kfree_skb(skb);
2704                 rc = NET_XMIT_DROP;
2705         } else if ((q->flags & TCQ_F_CAN_BYPASS) && !qdisc_qlen(q) &&
2706                    qdisc_run_begin(q)) {
2707                 /*
2708                  * This is a work-conserving queue; there are no old skbs
2709                  * waiting to be sent out; and the qdisc is not running -
2710                  * xmit the skb directly.
2711                  */
2712                 if (!(dev->priv_flags & IFF_XMIT_DST_RELEASE))
2713                         skb_dst_force(skb);
2714
2715                 qdisc_bstats_update(q, skb);
2716
2717                 if (sch_direct_xmit(skb, q, dev, txq, root_lock)) {
2718                         if (unlikely(contended)) {
2719                                 spin_unlock(&q->busylock);
2720                                 contended = false;
2721                         }
2722                         __qdisc_run(q);
2723                 } else
2724                         qdisc_run_end(q);
2725
2726                 rc = NET_XMIT_SUCCESS;
2727         } else {
2728                 skb_dst_force(skb);
2729                 rc = q->enqueue(skb, q) & NET_XMIT_MASK;
2730                 if (qdisc_run_begin(q)) {
2731                         if (unlikely(contended)) {
2732                                 spin_unlock(&q->busylock);
2733                                 contended = false;
2734                         }
2735                         __qdisc_run(q);
2736                 }
2737         }
2738         spin_unlock(root_lock);
2739         if (unlikely(contended))
2740                 spin_unlock(&q->busylock);
2741         return rc;
2742 }
2743
2744 #if IS_ENABLED(CONFIG_CGROUP_NET_PRIO)
2745 static void skb_update_prio(struct sk_buff *skb)
2746 {
2747         struct netprio_map *map = rcu_dereference_bh(skb->dev->priomap);
2748
2749         if (!skb->priority && skb->sk && map) {
2750                 unsigned int prioidx = skb->sk->sk_cgrp_prioidx;
2751
2752                 if (prioidx < map->priomap_len)
2753                         skb->priority = map->priomap[prioidx];
2754         }
2755 }
2756 #else
2757 #define skb_update_prio(skb)
2758 #endif
2759
2760 static DEFINE_PER_CPU(int, xmit_recursion);
2761 #define RECURSION_LIMIT 10
2762
2763 /**
2764  *      dev_loopback_xmit - loop back @skb
2765  *      @skb: buffer to transmit
2766  */
2767 int dev_loopback_xmit(struct sk_buff *skb)
2768 {
2769         skb_reset_mac_header(skb);
2770         __skb_pull(skb, skb_network_offset(skb));
2771         skb->pkt_type = PACKET_LOOPBACK;
2772         skb->ip_summed = CHECKSUM_UNNECESSARY;
2773         WARN_ON(!skb_dst(skb));
2774         skb_dst_force(skb);
2775         netif_rx_ni(skb);
2776         return 0;
2777 }
2778 EXPORT_SYMBOL(dev_loopback_xmit);
2779
2780 /**
2781  *      dev_queue_xmit - transmit a buffer
2782  *      @skb: buffer to transmit
2783  *
2784  *      Queue a buffer for transmission to a network device. The caller must
2785  *      have set the device and priority and built the buffer before calling
2786  *      this function. The function can be called from an interrupt.
2787  *
2788  *      A negative errno code is returned on a failure. A success does not
2789  *      guarantee the frame will be transmitted as it may be dropped due
2790  *      to congestion or traffic shaping.
2791  *
2792  * -----------------------------------------------------------------------------------
2793  *      I notice this method can also return errors from the queue disciplines,
2794  *      including NET_XMIT_DROP, which is a positive value.  So, errors can also
2795  *      be positive.
2796  *
2797  *      Regardless of the return value, the skb is consumed, so it is currently
2798  *      difficult to retry a send to this method.  (You can bump the ref count
2799  *      before sending to hold a reference for retry if you are careful.)
2800  *
2801  *      When calling this method, interrupts MUST be enabled.  This is because
2802  *      the BH enable code must have IRQs enabled so that it will not deadlock.
2803  *          --BLG
2804  */
2805 int dev_queue_xmit(struct sk_buff *skb)
2806 {
2807         struct net_device *dev = skb->dev;
2808         struct netdev_queue *txq;
2809         struct Qdisc *q;
2810         int rc = -ENOMEM;
2811
2812         skb_reset_mac_header(skb);
2813
2814         /* Disable soft irqs for various locks below. Also
2815          * stops preemption for RCU.
2816          */
2817         rcu_read_lock_bh();
2818
2819         skb_update_prio(skb);
2820
2821         txq = netdev_pick_tx(dev, skb);
2822         q = rcu_dereference_bh(txq->qdisc);
2823
2824 #ifdef CONFIG_NET_CLS_ACT
2825         skb->tc_verd = SET_TC_AT(skb->tc_verd, AT_EGRESS);
2826 #endif
2827         trace_net_dev_queue(skb);
2828         if (q->enqueue) {
2829                 rc = __dev_xmit_skb(skb, q, dev, txq);
2830                 goto out;
2831         }
2832
2833         /* The device has no queue. Common case for software devices:
2834            loopback, all the sorts of tunnels...
2835
2836            Really, it is unlikely that netif_tx_lock protection is necessary
2837            here.  (f.e. loopback and IP tunnels are clean ignoring statistics
2838            counters.)
2839            However, it is possible, that they rely on protection
2840            made by us here.
2841
2842            Check this and shot the lock. It is not prone from deadlocks.
2843            Either shot noqueue qdisc, it is even simpler 8)
2844          */
2845         if (dev->flags & IFF_UP) {
2846                 int cpu = smp_processor_id(); /* ok because BHs are off */
2847
2848                 if (txq->xmit_lock_owner != cpu) {
2849
2850                         if (__this_cpu_read(xmit_recursion) > RECURSION_LIMIT)
2851                                 goto recursion_alert;
2852
2853                         HARD_TX_LOCK(dev, txq, cpu);
2854
2855                         if (!netif_xmit_stopped(txq)) {
2856                                 __this_cpu_inc(xmit_recursion);
2857                                 rc = dev_hard_start_xmit(skb, dev, txq, NULL);
2858                                 __this_cpu_dec(xmit_recursion);
2859                                 if (dev_xmit_complete(rc)) {
2860                                         HARD_TX_UNLOCK(dev, txq);
2861                                         goto out;
2862                                 }
2863                         }
2864                         HARD_TX_UNLOCK(dev, txq);
2865                         net_crit_ratelimited("Virtual device %s asks to queue packet!\n",
2866                                              dev->name);
2867                 } else {
2868                         /* Recursion is detected! It is possible,
2869                          * unfortunately
2870                          */
2871 recursion_alert:
2872                         net_crit_ratelimited("Dead loop on virtual device %s, fix it urgently!\n",
2873                                              dev->name);
2874                 }
2875         }
2876
2877         rc = -ENETDOWN;
2878         rcu_read_unlock_bh();
2879
2880         kfree_skb(skb);
2881         return rc;
2882 out:
2883         rcu_read_unlock_bh();
2884         return rc;
2885 }
2886 EXPORT_SYMBOL(dev_queue_xmit);
2887
2888
2889 /*=======================================================================
2890                         Receiver routines
2891   =======================================================================*/
2892
2893 int netdev_max_backlog __read_mostly = 1000;
2894 EXPORT_SYMBOL(netdev_max_backlog);
2895
2896 int netdev_tstamp_prequeue __read_mostly = 1;
2897 int netdev_budget __read_mostly = 300;
2898 int weight_p __read_mostly = 64;            /* old backlog weight */
2899
2900 /* Called with irq disabled */
2901 static inline void ____napi_schedule(struct softnet_data *sd,
2902                                      struct napi_struct *napi)
2903 {
2904         list_add_tail(&napi->poll_list, &sd->poll_list);
2905         __raise_softirq_irqoff(NET_RX_SOFTIRQ);
2906 }
2907
2908 #ifdef CONFIG_RPS
2909
2910 /* One global table that all flow-based protocols share. */
2911 struct rps_sock_flow_table __rcu *rps_sock_flow_table __read_mostly;
2912 EXPORT_SYMBOL(rps_sock_flow_table);
2913
2914 struct static_key rps_needed __read_mostly;
2915
2916 static struct rps_dev_flow *
2917 set_rps_cpu(struct net_device *dev, struct sk_buff *skb,
2918             struct rps_dev_flow *rflow, u16 next_cpu)
2919 {
2920         if (next_cpu != RPS_NO_CPU) {
2921 #ifdef CONFIG_RFS_ACCEL
2922                 struct netdev_rx_queue *rxqueue;
2923                 struct rps_dev_flow_table *flow_table;
2924                 struct rps_dev_flow *old_rflow;
2925                 u32 flow_id;
2926                 u16 rxq_index;
2927                 int rc;
2928
2929                 /* Should we steer this flow to a different hardware queue? */
2930                 if (!skb_rx_queue_recorded(skb) || !dev->rx_cpu_rmap ||
2931                     !(dev->features & NETIF_F_NTUPLE))
2932                         goto out;
2933                 rxq_index = cpu_rmap_lookup_index(dev->rx_cpu_rmap, next_cpu);
2934                 if (rxq_index == skb_get_rx_queue(skb))
2935                         goto out;
2936
2937                 rxqueue = dev->_rx + rxq_index;
2938                 flow_table = rcu_dereference(rxqueue->rps_flow_table);
2939                 if (!flow_table)
2940                         goto out;
2941                 flow_id = skb->rxhash & flow_table->mask;
2942                 rc = dev->netdev_ops->ndo_rx_flow_steer(dev, skb,
2943                                                         rxq_index, flow_id);
2944                 if (rc < 0)
2945                         goto out;
2946                 old_rflow = rflow;
2947                 rflow = &flow_table->flows[flow_id];
2948                 rflow->filter = rc;
2949                 if (old_rflow->filter == rflow->filter)
2950                         old_rflow->filter = RPS_NO_FILTER;
2951         out:
2952 #endif
2953                 rflow->last_qtail =
2954                         per_cpu(softnet_data, next_cpu).input_queue_head;
2955         }
2956
2957         rflow->cpu = next_cpu;
2958         return rflow;
2959 }
2960
2961 /*
2962  * get_rps_cpu is called from netif_receive_skb and returns the target
2963  * CPU from the RPS map of the receiving queue for a given skb.
2964  * rcu_read_lock must be held on entry.
2965  */
2966 static int get_rps_cpu(struct net_device *dev, struct sk_buff *skb,
2967                        struct rps_dev_flow **rflowp)
2968 {
2969         struct netdev_rx_queue *rxqueue;
2970         struct rps_map *map;
2971         struct rps_dev_flow_table *flow_table;
2972         struct rps_sock_flow_table *sock_flow_table;
2973         int cpu = -1;
2974         u16 tcpu;
2975
2976         if (skb_rx_queue_recorded(skb)) {
2977                 u16 index = skb_get_rx_queue(skb);
2978                 if (unlikely(index >= dev->real_num_rx_queues)) {
2979                         WARN_ONCE(dev->real_num_rx_queues > 1,
2980                                   "%s received packet on queue %u, but number "
2981                                   "of RX queues is %u\n",
2982                                   dev->name, index, dev->real_num_rx_queues);
2983                         goto done;
2984                 }
2985                 rxqueue = dev->_rx + index;
2986         } else
2987                 rxqueue = dev->_rx;
2988
2989         map = rcu_dereference(rxqueue->rps_map);
2990         if (map) {
2991                 if (map->len == 1 &&
2992                     !rcu_access_pointer(rxqueue->rps_flow_table)) {
2993                         tcpu = map->cpus[0];
2994                         if (cpu_online(tcpu))
2995                                 cpu = tcpu;
2996                         goto done;
2997                 }
2998         } else if (!rcu_access_pointer(rxqueue->rps_flow_table)) {
2999                 goto done;
3000         }
3001
3002         skb_reset_network_header(skb);
3003         if (!skb_get_hash(skb))
3004                 goto done;
3005
3006         flow_table = rcu_dereference(rxqueue->rps_flow_table);
3007         sock_flow_table = rcu_dereference(rps_sock_flow_table);
3008         if (flow_table && sock_flow_table) {
3009                 u16 next_cpu;
3010                 struct rps_dev_flow *rflow;
3011
3012                 rflow = &flow_table->flows[skb->rxhash & flow_table->mask];
3013                 tcpu = rflow->cpu;
3014
3015                 next_cpu = sock_flow_table->ents[skb->rxhash &
3016                     sock_flow_table->mask];
3017
3018                 /*
3019                  * If the desired CPU (where last recvmsg was done) is
3020                  * different from current CPU (one in the rx-queue flow
3021                  * table entry), switch if one of the following holds:
3022                  *   - Current CPU is unset (equal to RPS_NO_CPU).
3023                  *   - Current CPU is offline.
3024                  *   - The current CPU's queue tail has advanced beyond the
3025                  *     last packet that was enqueued using this table entry.
3026                  *     This guarantees that all previous packets for the flow
3027                  *     have been dequeued, thus preserving in order delivery.
3028                  */
3029                 if (unlikely(tcpu != next_cpu) &&
3030                     (tcpu == RPS_NO_CPU || !cpu_online(tcpu) ||
3031                      ((int)(per_cpu(softnet_data, tcpu).input_queue_head -
3032                       rflow->last_qtail)) >= 0)) {
3033                         tcpu = next_cpu;
3034                         rflow = set_rps_cpu(dev, skb, rflow, next_cpu);
3035                 }
3036
3037                 if (tcpu != RPS_NO_CPU && cpu_online(tcpu)) {
3038                         *rflowp = rflow;
3039                         cpu = tcpu;
3040                         goto done;
3041                 }
3042         }
3043
3044         if (map) {
3045                 tcpu = map->cpus[((u64) skb->rxhash * map->len) >> 32];
3046
3047                 if (cpu_online(tcpu)) {
3048                         cpu = tcpu;
3049                         goto done;
3050                 }
3051         }
3052
3053 done:
3054         return cpu;
3055 }
3056
3057 #ifdef CONFIG_RFS_ACCEL
3058
3059 /**
3060  * rps_may_expire_flow - check whether an RFS hardware filter may be removed
3061  * @dev: Device on which the filter was set
3062  * @rxq_index: RX queue index
3063  * @flow_id: Flow ID passed to ndo_rx_flow_steer()
3064  * @filter_id: Filter ID returned by ndo_rx_flow_steer()
3065  *
3066  * Drivers that implement ndo_rx_flow_steer() should periodically call
3067  * this function for each installed filter and remove the filters for
3068  * which it returns %true.
3069  */
3070 bool rps_may_expire_flow(struct net_device *dev, u16 rxq_index,
3071                          u32 flow_id, u16 filter_id)
3072 {
3073         struct netdev_rx_queue *rxqueue = dev->_rx + rxq_index;
3074         struct rps_dev_flow_table *flow_table;
3075         struct rps_dev_flow *rflow;
3076         bool expire = true;
3077         int cpu;
3078
3079         rcu_read_lock();
3080         flow_table = rcu_dereference(rxqueue->rps_flow_table);
3081         if (flow_table && flow_id <= flow_table->mask) {
3082                 rflow = &flow_table->flows[flow_id];
3083                 cpu = ACCESS_ONCE(rflow->cpu);
3084                 if (rflow->filter == filter_id && cpu != RPS_NO_CPU &&
3085                     ((int)(per_cpu(softnet_data, cpu).input_queue_head -
3086                            rflow->last_qtail) <
3087                      (int)(10 * flow_table->mask)))
3088                         expire = false;
3089         }
3090         rcu_read_unlock();
3091         return expire;
3092 }
3093 EXPORT_SYMBOL(rps_may_expire_flow);
3094
3095 #endif /* CONFIG_RFS_ACCEL */
3096
3097 /* Called from hardirq (IPI) context */
3098 static void rps_trigger_softirq(void *data)
3099 {
3100         struct softnet_data *sd = data;
3101
3102         ____napi_schedule(sd, &sd->backlog);
3103         sd->received_rps++;
3104 }
3105
3106 #endif /* CONFIG_RPS */
3107
3108 /*
3109  * Check if this softnet_data structure is another cpu one
3110  * If yes, queue it to our IPI list and return 1
3111  * If no, return 0
3112  */
3113 static int rps_ipi_queued(struct softnet_data *sd)
3114 {
3115 #ifdef CONFIG_RPS
3116         struct softnet_data *mysd = &__get_cpu_var(softnet_data);
3117
3118         if (sd != mysd) {
3119                 sd->rps_ipi_next = mysd->rps_ipi_list;
3120                 mysd->rps_ipi_list = sd;
3121
3122                 __raise_softirq_irqoff(NET_RX_SOFTIRQ);
3123                 return 1;
3124         }
3125 #endif /* CONFIG_RPS */
3126         return 0;
3127 }
3128
3129 #ifdef CONFIG_NET_FLOW_LIMIT
3130 int netdev_flow_limit_table_len __read_mostly = (1 << 12);
3131 #endif
3132
3133 static bool skb_flow_limit(struct sk_buff *skb, unsigned int qlen)
3134 {
3135 #ifdef CONFIG_NET_FLOW_LIMIT
3136         struct sd_flow_limit *fl;
3137         struct softnet_data *sd;
3138         unsigned int old_flow, new_flow;
3139
3140         if (qlen < (netdev_max_backlog >> 1))
3141                 return false;
3142
3143         sd = &__get_cpu_var(softnet_data);
3144
3145         rcu_read_lock();
3146         fl = rcu_dereference(sd->flow_limit);
3147         if (fl) {
3148                 new_flow = skb_get_hash(skb) & (fl->num_buckets - 1);
3149                 old_flow = fl->history[fl->history_head];
3150                 fl->history[fl->history_head] = new_flow;
3151
3152                 fl->history_head++;
3153                 fl->history_head &= FLOW_LIMIT_HISTORY - 1;
3154
3155                 if (likely(fl->buckets[old_flow]))
3156                         fl->buckets[old_flow]--;
3157
3158                 if (++fl->buckets[new_flow] > (FLOW_LIMIT_HISTORY >> 1)) {
3159                         fl->count++;
3160                         rcu_read_unlock();
3161                         return true;
3162                 }
3163         }
3164         rcu_read_unlock();
3165 #endif
3166         return false;
3167 }
3168
3169 /*
3170  * enqueue_to_backlog is called to queue an skb to a per CPU backlog
3171  * queue (may be a remote CPU queue).
3172  */
3173 static int enqueue_to_backlog(struct sk_buff *skb, int cpu,
3174                               unsigned int *qtail)
3175 {
3176         struct softnet_data *sd;
3177         unsigned long flags;
3178         unsigned int qlen;
3179
3180         sd = &per_cpu(softnet_data, cpu);
3181
3182         local_irq_save(flags);
3183
3184         rps_lock(sd);
3185         qlen = skb_queue_len(&sd->input_pkt_queue);
3186         if (qlen <= netdev_max_backlog && !skb_flow_limit(skb, qlen)) {
3187                 if (skb_queue_len(&sd->input_pkt_queue)) {
3188 enqueue:
3189                         __skb_queue_tail(&sd->input_pkt_queue, skb);
3190                         input_queue_tail_incr_save(sd, qtail);
3191                         rps_unlock(sd);
3192                         local_irq_restore(flags);
3193                         return NET_RX_SUCCESS;
3194                 }
3195
3196                 /* Schedule NAPI for backlog device
3197                  * We can use non atomic operation since we own the queue lock
3198                  */
3199                 if (!__test_and_set_bit(NAPI_STATE_SCHED, &sd->backlog.state)) {
3200                         if (!rps_ipi_queued(sd))
3201                                 ____napi_schedule(sd, &sd->backlog);
3202                 }
3203                 goto enqueue;
3204         }
3205
3206         sd->dropped++;
3207         rps_unlock(sd);
3208
3209         local_irq_restore(flags);
3210
3211         atomic_long_inc(&skb->dev->rx_dropped);
3212         kfree_skb(skb);
3213         return NET_RX_DROP;
3214 }
3215
3216 /**
3217  *      netif_rx        -       post buffer to the network code
3218  *      @skb: buffer to post
3219  *
3220  *      This function receives a packet from a device driver and queues it for
3221  *      the upper (protocol) levels to process.  It always succeeds. The buffer
3222  *      may be dropped during processing for congestion control or by the
3223  *      protocol layers.
3224  *
3225  *      return values:
3226  *      NET_RX_SUCCESS  (no congestion)
3227  *      NET_RX_DROP     (packet was dropped)
3228  *
3229  */
3230
3231 int netif_rx(struct sk_buff *skb)
3232 {
3233         int ret;
3234
3235         /* if netpoll wants it, pretend we never saw it */
3236         if (netpoll_rx(skb))
3237                 return NET_RX_DROP;
3238
3239         net_timestamp_check(netdev_tstamp_prequeue, skb);
3240
3241         trace_netif_rx(skb);
3242 #ifdef CONFIG_RPS
3243         if (static_key_false(&rps_needed)) {
3244                 struct rps_dev_flow voidflow, *rflow = &voidflow;
3245                 int cpu;
3246
3247                 preempt_disable();
3248                 rcu_read_lock();
3249
3250                 cpu = get_rps_cpu(skb->dev, skb, &rflow);
3251                 if (cpu < 0)
3252                         cpu = smp_processor_id();
3253
3254                 ret = enqueue_to_backlog(skb, cpu, &rflow->last_qtail);
3255
3256                 rcu_read_unlock();
3257                 preempt_enable();
3258         } else
3259 #endif
3260         {
3261                 unsigned int qtail;
3262                 ret = enqueue_to_backlog(skb, get_cpu(), &qtail);
3263                 put_cpu();
3264         }
3265         return ret;
3266 }
3267 EXPORT_SYMBOL(netif_rx);
3268
3269 int netif_rx_ni(struct sk_buff *skb)
3270 {
3271         int err;
3272
3273         preempt_disable();
3274         err = netif_rx(skb);
3275         if (local_softirq_pending())
3276                 do_softirq();
3277         preempt_enable();
3278
3279         return err;
3280 }
3281 EXPORT_SYMBOL(netif_rx_ni);
3282
3283 static void net_tx_action(struct softirq_action *h)
3284 {
3285         struct softnet_data *sd = &__get_cpu_var(softnet_data);
3286
3287         if (sd->completion_queue) {
3288                 struct sk_buff *clist;
3289
3290                 local_irq_disable();
3291                 clist = sd->completion_queue;
3292                 sd->completion_queue = NULL;
3293                 local_irq_enable();
3294
3295                 while (clist) {
3296                         struct sk_buff *skb = clist;
3297                         clist = clist->next;
3298
3299                         WARN_ON(atomic_read(&skb->users));
3300                         if (likely(get_kfree_skb_cb(skb)->reason == SKB_REASON_CONSUMED))
3301                                 trace_consume_skb(skb);
3302                         else
3303                                 trace_kfree_skb(skb, net_tx_action);
3304                         __kfree_skb(skb);
3305                 }
3306         }
3307
3308         if (sd->output_queue) {
3309                 struct Qdisc *head;
3310
3311                 local_irq_disable();
3312                 head = sd->output_queue;
3313                 sd->output_queue = NULL;
3314                 sd->output_queue_tailp = &sd->output_queue;
3315                 local_irq_enable();
3316
3317                 while (head) {
3318                         struct Qdisc *q = head;
3319                         spinlock_t *root_lock;
3320
3321                         head = head->next_sched;
3322
3323                         root_lock = qdisc_lock(q);
3324                         if (spin_trylock(root_lock)) {
3325                                 smp_mb__before_clear_bit();
3326                                 clear_bit(__QDISC_STATE_SCHED,
3327                                           &q->state);
3328                                 qdisc_run(q);
3329                                 spin_unlock(root_lock);
3330                         } else {
3331                                 if (!test_bit(__QDISC_STATE_DEACTIVATED,
3332                                               &q->state)) {
3333                                         __netif_reschedule(q);
3334                                 } else {
3335                                         smp_mb__before_clear_bit();
3336                                         clear_bit(__QDISC_STATE_SCHED,
3337                                                   &q->state);
3338                                 }
3339                         }
3340                 }
3341         }
3342 }
3343
3344 #if (defined(CONFIG_BRIDGE) || defined(CONFIG_BRIDGE_MODULE)) && \
3345     (defined(CONFIG_ATM_LANE) || defined(CONFIG_ATM_LANE_MODULE))
3346 /* This hook is defined here for ATM LANE */
3347 int (*br_fdb_test_addr_hook)(struct net_device *dev,
3348                              unsigned char *addr) __read_mostly;
3349 EXPORT_SYMBOL_GPL(br_fdb_test_addr_hook);
3350 #endif
3351
3352 #ifdef CONFIG_NET_CLS_ACT
3353 /* TODO: Maybe we should just force sch_ingress to be compiled in
3354  * when CONFIG_NET_CLS_ACT is? otherwise some useless instructions
3355  * a compare and 2 stores extra right now if we dont have it on
3356  * but have CONFIG_NET_CLS_ACT
3357  * NOTE: This doesn't stop any functionality; if you dont have
3358  * the ingress scheduler, you just can't add policies on ingress.
3359  *
3360  */
3361 static int ing_filter(struct sk_buff *skb, struct netdev_queue *rxq)
3362 {
3363         struct net_device *dev = skb->dev;
3364         u32 ttl = G_TC_RTTL(skb->tc_verd);
3365         int result = TC_ACT_OK;
3366         struct Qdisc *q;
3367
3368         if (unlikely(MAX_RED_LOOP < ttl++)) {
3369                 net_warn_ratelimited("Redir loop detected Dropping packet (%d->%d)\n",
3370                                      skb->skb_iif, dev->ifindex);
3371                 return TC_ACT_SHOT;
3372         }
3373
3374         skb->tc_verd = SET_TC_RTTL(skb->tc_verd, ttl);
3375         skb->tc_verd = SET_TC_AT(skb->tc_verd, AT_INGRESS);
3376
3377         q = rxq->qdisc;
3378         if (q != &noop_qdisc) {
3379                 spin_lock(qdisc_lock(q));
3380                 if (likely(!test_bit(__QDISC_STATE_DEACTIVATED, &q->state)))
3381                         result = qdisc_enqueue_root(skb, q);
3382                 spin_unlock(qdisc_lock(q));
3383         }
3384
3385         return result;
3386 }
3387
3388 static inline struct sk_buff *handle_ing(struct sk_buff *skb,
3389                                          struct packet_type **pt_prev,
3390                                          int *ret, struct net_device *orig_dev)
3391 {
3392         struct netdev_queue *rxq = rcu_dereference(skb->dev->ingress_queue);
3393
3394         if (!rxq || rxq->qdisc == &noop_qdisc)
3395                 goto out;
3396
3397         if (*pt_prev) {
3398                 *ret = deliver_skb(skb, *pt_prev, orig_dev);
3399                 *pt_prev = NULL;
3400         }
3401
3402         switch (ing_filter(skb, rxq)) {
3403         case TC_ACT_SHOT:
3404         case TC_ACT_STOLEN:
3405                 kfree_skb(skb);
3406                 return NULL;
3407         }
3408
3409 out:
3410         skb->tc_verd = 0;
3411         return skb;
3412 }
3413 #endif
3414
3415 /**
3416  *      netdev_rx_handler_register - register receive handler
3417  *      @dev: device to register a handler for
3418  *      @rx_handler: receive handler to register
3419  *      @rx_handler_data: data pointer that is used by rx handler
3420  *
3421  *      Register a receive hander for a device. This handler will then be
3422  *      called from __netif_receive_skb. A negative errno code is returned
3423  *      on a failure.
3424  *
3425  *      The caller must hold the rtnl_mutex.
3426  *
3427  *      For a general description of rx_handler, see enum rx_handler_result.
3428  */
3429 int netdev_rx_handler_register(struct net_device *dev,
3430                                rx_handler_func_t *rx_handler,
3431                                void *rx_handler_data)
3432 {
3433         ASSERT_RTNL();
3434
3435         if (dev->rx_handler)
3436                 return -EBUSY;
3437
3438         /* Note: rx_handler_data must be set before rx_handler */
3439         rcu_assign_pointer(dev->rx_handler_data, rx_handler_data);
3440         rcu_assign_pointer(dev->rx_handler, rx_handler);
3441
3442         return 0;
3443 }
3444 EXPORT_SYMBOL_GPL(netdev_rx_handler_register);
3445
3446 /**
3447  *      netdev_rx_handler_unregister - unregister receive handler
3448  *      @dev: device to unregister a handler from
3449  *
3450  *      Unregister a receive handler from a device.
3451  *
3452  *      The caller must hold the rtnl_mutex.
3453  */
3454 void netdev_rx_handler_unregister(struct net_device *dev)
3455 {
3456
3457         ASSERT_RTNL();
3458         RCU_INIT_POINTER(dev->rx_handler, NULL);
3459         /* a reader seeing a non NULL rx_handler in a rcu_read_lock()
3460          * section has a guarantee to see a non NULL rx_handler_data
3461          * as well.
3462          */
3463         synchronize_net();
3464         RCU_INIT_POINTER(dev->rx_handler_data, NULL);
3465 }
3466 EXPORT_SYMBOL_GPL(netdev_rx_handler_unregister);
3467
3468 /*
3469  * Limit the use of PFMEMALLOC reserves to those protocols that implement
3470  * the special handling of PFMEMALLOC skbs.
3471  */
3472 static bool skb_pfmemalloc_protocol(struct sk_buff *skb)
3473 {
3474         switch (skb->protocol) {
3475         case __constant_htons(ETH_P_ARP):
3476         case __constant_htons(ETH_P_IP):
3477         case __constant_htons(ETH_P_IPV6):
3478         case __constant_htons(ETH_P_8021Q):
3479         case __constant_htons(ETH_P_8021AD):
3480                 return true;
3481         default:
3482                 return false;
3483         }
3484 }
3485
3486 static int __netif_receive_skb_core(struct sk_buff *skb, bool pfmemalloc)
3487 {
3488         struct packet_type *ptype, *pt_prev;
3489         rx_handler_func_t *rx_handler;
3490         struct net_device *orig_dev;
3491         struct net_device *null_or_dev;
3492         bool deliver_exact = false;
3493         int ret = NET_RX_DROP;
3494         __be16 type;
3495
3496         net_timestamp_check(!netdev_tstamp_prequeue, skb);
3497
3498         trace_netif_receive_skb(skb);
3499
3500         /* if we've gotten here through NAPI, check netpoll */
3501         if (netpoll_receive_skb(skb))
3502                 goto out;
3503
3504         orig_dev = skb->dev;
3505
3506         skb_reset_network_header(skb);
3507         if (!skb_transport_header_was_set(skb))
3508                 skb_reset_transport_header(skb);
3509         skb_reset_mac_len(skb);
3510
3511         pt_prev = NULL;
3512
3513         rcu_read_lock();
3514
3515 another_round:
3516         skb->skb_iif = skb->dev->ifindex;
3517
3518         __this_cpu_inc(softnet_data.processed);
3519
3520         if (skb->protocol == cpu_to_be16(ETH_P_8021Q) ||
3521             skb->protocol == cpu_to_be16(ETH_P_8021AD)) {
3522                 skb = vlan_untag(skb);
3523                 if (unlikely(!skb))
3524                         goto unlock;
3525         }
3526
3527 #ifdef CONFIG_NET_CLS_ACT
3528         if (skb->tc_verd & TC_NCLS) {
3529                 skb->tc_verd = CLR_TC_NCLS(skb->tc_verd);
3530                 goto ncls;
3531         }
3532 #endif
3533
3534         if (pfmemalloc)
3535                 goto skip_taps;
3536
3537         list_for_each_entry_rcu(ptype, &ptype_all, list) {
3538                 if (!ptype->dev || ptype->dev == skb->dev) {
3539                         if (pt_prev)
3540                                 ret = deliver_skb(skb, pt_prev, orig_dev);
3541                         pt_prev = ptype;
3542                 }
3543         }
3544
3545 skip_taps:
3546 #ifdef CONFIG_NET_CLS_ACT
3547         skb = handle_ing(skb, &pt_prev, &ret, orig_dev);
3548         if (!skb)
3549                 goto unlock;
3550 ncls:
3551 #endif
3552
3553         if (pfmemalloc && !skb_pfmemalloc_protocol(skb))
3554                 goto drop;
3555
3556         if (vlan_tx_tag_present(skb)) {
3557                 if (pt_prev) {
3558                         ret = deliver_skb(skb, pt_prev, orig_dev);
3559                         pt_prev = NULL;
3560                 }
3561                 if (vlan_do_receive(&skb))
3562                         goto another_round;
3563                 else if (unlikely(!skb))
3564                         goto unlock;
3565         }
3566
3567         rx_handler = rcu_dereference(skb->dev->rx_handler);
3568         if (rx_handler) {
3569                 if (pt_prev) {
3570                         ret = deliver_skb(skb, pt_prev, orig_dev);
3571                         pt_prev = NULL;
3572                 }
3573                 switch (rx_handler(&skb)) {
3574                 case RX_HANDLER_CONSUMED:
3575                         ret = NET_RX_SUCCESS;
3576                         goto unlock;
3577                 case RX_HANDLER_ANOTHER:
3578                         goto another_round;
3579                 case RX_HANDLER_EXACT:
3580                         deliver_exact = true;
3581                 case RX_HANDLER_PASS:
3582                         break;
3583                 default:
3584                         BUG();
3585                 }
3586         }
3587
3588         if (unlikely(vlan_tx_tag_present(skb))) {
3589                 if (vlan_tx_tag_get_id(skb))
3590                         skb->pkt_type = PACKET_OTHERHOST;
3591                 /* Note: we might in the future use prio bits
3592                  * and set skb->priority like in vlan_do_receive()
3593                  * For the time being, just ignore Priority Code Point
3594                  */
3595                 skb->vlan_tci = 0;
3596         }
3597
3598         /* deliver only exact match when indicated */
3599         null_or_dev = deliver_exact ? skb->dev : NULL;
3600
3601         type = skb->protocol;
3602         list_for_each_entry_rcu(ptype,
3603                         &ptype_base[ntohs(type) & PTYPE_HASH_MASK], list) {
3604                 if (ptype->type == type &&
3605                     (ptype->dev == null_or_dev || ptype->dev == skb->dev ||
3606                      ptype->dev == orig_dev)) {
3607                         if (pt_prev)
3608                                 ret = deliver_skb(skb, pt_prev, orig_dev);
3609                         pt_prev = ptype;
3610                 }
3611         }
3612
3613         if (pt_prev) {
3614                 if (unlikely(skb_orphan_frags(skb, GFP_ATOMIC)))
3615                         goto drop;
3616                 else
3617                         ret = pt_prev->func(skb, skb->dev, pt_prev, orig_dev);
3618         } else {
3619 drop:
3620                 atomic_long_inc(&skb->dev->rx_dropped);
3621                 kfree_skb(skb);
3622                 /* Jamal, now you will not able to escape explaining
3623                  * me how you were going to use this. :-)
3624                  */
3625                 ret = NET_RX_DROP;
3626         }
3627
3628 unlock:
3629         rcu_read_unlock();
3630 out:
3631         return ret;
3632 }
3633
3634 static int __netif_receive_skb(struct sk_buff *skb)
3635 {
3636         int ret;
3637
3638         if (sk_memalloc_socks() && skb_pfmemalloc(skb)) {
3639                 unsigned long pflags = current->flags;
3640
3641                 /*
3642                  * PFMEMALLOC skbs are special, they should
3643                  * - be delivered to SOCK_MEMALLOC sockets only
3644                  * - stay away from userspace
3645                  * - have bounded memory usage
3646                  *
3647                  * Use PF_MEMALLOC as this saves us from propagating the allocation
3648                  * context down to all allocation sites.
3649                  */
3650                 current->flags |= PF_MEMALLOC;
3651                 ret = __netif_receive_skb_core(skb, true);
3652                 tsk_restore_flags(current, pflags, PF_MEMALLOC);
3653         } else
3654                 ret = __netif_receive_skb_core(skb, false);
3655
3656         return ret;
3657 }
3658
3659 /**
3660  *      netif_receive_skb - process receive buffer from network
3661  *      @skb: buffer to process
3662  *
3663  *      netif_receive_skb() is the main receive data processing function.
3664  *      It always succeeds. The buffer may be dropped during processing
3665  *      for congestion control or by the protocol layers.
3666  *
3667  *      This function may only be called from softirq context and interrupts
3668  *      should be enabled.
3669  *
3670  *      Return values (usually ignored):
3671  *      NET_RX_SUCCESS: no congestion
3672  *      NET_RX_DROP: packet was dropped
3673  */
3674 int netif_receive_skb(struct sk_buff *skb)
3675 {
3676         net_timestamp_check(netdev_tstamp_prequeue, skb);
3677
3678         if (skb_defer_rx_timestamp(skb))
3679                 return NET_RX_SUCCESS;
3680
3681 #ifdef CONFIG_RPS
3682         if (static_key_false(&rps_needed)) {
3683                 struct rps_dev_flow voidflow, *rflow = &voidflow;
3684                 int cpu, ret;
3685
3686                 rcu_read_lock();
3687
3688                 cpu = get_rps_cpu(skb->dev, skb, &rflow);
3689
3690                 if (cpu >= 0) {
3691                         ret = enqueue_to_backlog(skb, cpu, &rflow->last_qtail);
3692                         rcu_read_unlock();
3693                         return ret;
3694                 }
3695                 rcu_read_unlock();
3696         }
3697 #endif
3698         return __netif_receive_skb(skb);
3699 }
3700 EXPORT_SYMBOL(netif_receive_skb);
3701
3702 /* Network device is going away, flush any packets still pending
3703  * Called with irqs disabled.
3704  */
3705 static void flush_backlog(void *arg)
3706 {
3707         struct net_device *dev = arg;
3708         struct softnet_data *sd = &__get_cpu_var(softnet_data);
3709         struct sk_buff *skb, *tmp;
3710
3711         rps_lock(sd);
3712         skb_queue_walk_safe(&sd->input_pkt_queue, skb, tmp) {
3713                 if (skb->dev == dev) {
3714                         __skb_unlink(skb, &sd->input_pkt_queue);
3715                         kfree_skb(skb);
3716                         input_queue_head_incr(sd);
3717                 }
3718         }
3719         rps_unlock(sd);
3720
3721         skb_queue_walk_safe(&sd->process_queue, skb, tmp) {
3722                 if (skb->dev == dev) {
3723                         __skb_unlink(skb, &sd->process_queue);
3724                         kfree_skb(skb);
3725                         input_queue_head_incr(sd);
3726                 }
3727         }
3728 }
3729
3730 static int napi_gro_complete(struct sk_buff *skb)
3731 {
3732         struct packet_offload *ptype;
3733         __be16 type = skb->protocol;
3734         struct list_head *head = &offload_base;
3735         int err = -ENOENT;
3736
3737         BUILD_BUG_ON(sizeof(struct napi_gro_cb) > sizeof(skb->cb));
3738
3739         if (NAPI_GRO_CB(skb)->count == 1) {
3740                 skb_shinfo(skb)->gso_size = 0;
3741                 goto out;
3742         }
3743
3744         rcu_read_lock();
3745         list_for_each_entry_rcu(ptype, head, list) {
3746                 if (ptype->type != type || !ptype->callbacks.gro_complete)
3747                         continue;
3748
3749                 err = ptype->callbacks.gro_complete(skb, 0);
3750                 break;
3751         }
3752         rcu_read_unlock();
3753
3754         if (err) {
3755                 WARN_ON(&ptype->list == head);
3756                 kfree_skb(skb);
3757                 return NET_RX_SUCCESS;
3758         }
3759
3760 out:
3761         return netif_receive_skb(skb);
3762 }
3763
3764 /* napi->gro_list contains packets ordered by age.
3765  * youngest packets at the head of it.
3766  * Complete skbs in reverse order to reduce latencies.
3767  */
3768 void napi_gro_flush(struct napi_struct *napi, bool flush_old)
3769 {
3770         struct sk_buff *skb, *prev = NULL;
3771
3772         /* scan list and build reverse chain */
3773         for (skb = napi->gro_list; skb != NULL; skb = skb->next) {
3774                 skb->prev = prev;
3775                 prev = skb;
3776         }
3777
3778         for (skb = prev; skb; skb = prev) {
3779                 skb->next = NULL;
3780
3781                 if (flush_old && NAPI_GRO_CB(skb)->age == jiffies)
3782                         return;
3783
3784                 prev = skb->prev;
3785                 napi_gro_complete(skb);
3786                 napi->gro_count--;
3787         }
3788
3789         napi->gro_list = NULL;
3790 }
3791 EXPORT_SYMBOL(napi_gro_flush);
3792
3793 static void gro_list_prepare(struct napi_struct *napi, struct sk_buff *skb)
3794 {
3795         struct sk_buff *p;
3796         unsigned int maclen = skb->dev->hard_header_len;
3797
3798         for (p = napi->gro_list; p; p = p->next) {
3799                 unsigned long diffs;
3800
3801                 diffs = (unsigned long)p->dev ^ (unsigned long)skb->dev;
3802                 diffs |= p->vlan_tci ^ skb->vlan_tci;
3803                 if (maclen == ETH_HLEN)
3804                         diffs |= compare_ether_header(skb_mac_header(p),
3805                                                       skb_gro_mac_header(skb));
3806                 else if (!diffs)
3807                         diffs = memcmp(skb_mac_header(p),
3808                                        skb_gro_mac_header(skb),
3809                                        maclen);
3810                 NAPI_GRO_CB(p)->same_flow = !diffs;
3811                 NAPI_GRO_CB(p)->flush = 0;
3812         }
3813 }
3814
3815 static void skb_gro_reset_offset(struct sk_buff *skb)
3816 {
3817         const struct skb_shared_info *pinfo = skb_shinfo(skb);
3818         const skb_frag_t *frag0 = &pinfo->frags[0];
3819
3820         NAPI_GRO_CB(skb)->data_offset = 0;
3821         NAPI_GRO_CB(skb)->frag0 = NULL;
3822         NAPI_GRO_CB(skb)->frag0_len = 0;
3823
3824         if (skb_mac_header(skb) == skb_tail_pointer(skb) &&
3825             pinfo->nr_frags &&
3826             !PageHighMem(skb_frag_page(frag0))) {
3827                 NAPI_GRO_CB(skb)->frag0 = skb_frag_address(frag0);
3828                 NAPI_GRO_CB(skb)->frag0_len = skb_frag_size(frag0);
3829         }
3830 }
3831
3832 static enum gro_result dev_gro_receive(struct napi_struct *napi, struct sk_buff *skb)
3833 {
3834         struct sk_buff **pp = NULL;
3835         struct packet_offload *ptype;
3836         __be16 type = skb->protocol;
3837         struct list_head *head = &offload_base;
3838         int same_flow;
3839         enum gro_result ret;
3840
3841         if (!(skb->dev->features & NETIF_F_GRO) || netpoll_rx_on(skb))
3842                 goto normal;
3843
3844         if (skb_is_gso(skb) || skb_has_frag_list(skb))
3845                 goto normal;
3846
3847         skb_gro_reset_offset(skb);
3848         gro_list_prepare(napi, skb);
3849         NAPI_GRO_CB(skb)->csum = skb->csum; /* Needed for CHECKSUM_COMPLETE */
3850
3851         rcu_read_lock();
3852         list_for_each_entry_rcu(ptype, head, list) {
3853                 if (ptype->type != type || !ptype->callbacks.gro_receive)
3854                         continue;
3855
3856                 skb_set_network_header(skb, skb_gro_offset(skb));
3857                 skb_reset_mac_len(skb);
3858                 NAPI_GRO_CB(skb)->same_flow = 0;
3859                 NAPI_GRO_CB(skb)->flush = 0;
3860                 NAPI_GRO_CB(skb)->free = 0;
3861
3862                 pp = ptype->callbacks.gro_receive(&napi->gro_list, skb);
3863                 break;
3864         }
3865         rcu_read_unlock();
3866
3867         if (&ptype->list == head)
3868                 goto normal;
3869
3870         same_flow = NAPI_GRO_CB(skb)->same_flow;
3871         ret = NAPI_GRO_CB(skb)->free ? GRO_MERGED_FREE : GRO_MERGED;
3872
3873         if (pp) {
3874                 struct sk_buff *nskb = *pp;
3875
3876                 *pp = nskb->next;
3877                 nskb->next = NULL;
3878                 napi_gro_complete(nskb);
3879                 napi->gro_count--;
3880         }
3881
3882         if (same_flow)
3883                 goto ok;
3884
3885         if (NAPI_GRO_CB(skb)->flush || napi->gro_count >= MAX_GRO_SKBS)
3886                 goto normal;
3887
3888         napi->gro_count++;
3889         NAPI_GRO_CB(skb)->count = 1;
3890         NAPI_GRO_CB(skb)->age = jiffies;
3891         skb_shinfo(skb)->gso_size = skb_gro_len(skb);
3892         skb->next = napi->gro_list;
3893         napi->gro_list = skb;
3894         ret = GRO_HELD;
3895
3896 pull:
3897         if (skb_headlen(skb) < skb_gro_offset(skb)) {
3898                 int grow = skb_gro_offset(skb) - skb_headlen(skb);
3899
3900                 BUG_ON(skb->end - skb->tail < grow);
3901
3902                 memcpy(skb_tail_pointer(skb), NAPI_GRO_CB(skb)->frag0, grow);
3903
3904                 skb->tail += grow;
3905                 skb->data_len -= grow;
3906
3907                 skb_shinfo(skb)->frags[0].page_offset += grow;
3908                 skb_frag_size_sub(&skb_shinfo(skb)->frags[0], grow);
3909
3910                 if (unlikely(!skb_frag_size(&skb_shinfo(skb)->frags[0]))) {
3911                         skb_frag_unref(skb, 0);
3912                         memmove(skb_shinfo(skb)->frags,
3913                                 skb_shinfo(skb)->frags + 1,
3914                                 --skb_shinfo(skb)->nr_frags * sizeof(skb_frag_t));
3915                 }
3916         }
3917
3918 ok:
3919         return ret;
3920
3921 normal:
3922         ret = GRO_NORMAL;
3923         goto pull;
3924 }
3925
3926 struct packet_offload *gro_find_receive_by_type(__be16 type)
3927 {
3928         struct list_head *offload_head = &offload_base;
3929         struct packet_offload *ptype;
3930
3931         list_for_each_entry_rcu(ptype, offload_head, list) {
3932                 if (ptype->type != type || !ptype->callbacks.gro_receive)
3933                         continue;
3934                 return ptype;
3935         }
3936         return NULL;
3937 }
3938
3939 struct packet_offload *gro_find_complete_by_type(__be16 type)
3940 {
3941         struct list_head *offload_head = &offload_base;
3942         struct packet_offload *ptype;
3943
3944         list_for_each_entry_rcu(ptype, offload_head, list) {
3945                 if (ptype->type != type || !ptype->callbacks.gro_complete)
3946                         continue;
3947                 return ptype;
3948         }
3949         return NULL;
3950 }
3951
3952 static gro_result_t napi_skb_finish(gro_result_t ret, struct sk_buff *skb)
3953 {
3954         switch (ret) {
3955         case GRO_NORMAL:
3956                 if (netif_receive_skb(skb))
3957                         ret = GRO_DROP;
3958                 break;
3959
3960         case GRO_DROP:
3961                 kfree_skb(skb);
3962                 break;
3963
3964         case GRO_MERGED_FREE:
3965                 if (NAPI_GRO_CB(skb)->free == NAPI_GRO_FREE_STOLEN_HEAD)
3966                         kmem_cache_free(skbuff_head_cache, skb);
3967                 else
3968                         __kfree_skb(skb);
3969                 break;
3970
3971         case GRO_HELD:
3972         case GRO_MERGED:
3973                 break;
3974         }
3975
3976         return ret;
3977 }
3978
3979 gro_result_t napi_gro_receive(struct napi_struct *napi, struct sk_buff *skb)
3980 {
3981         return napi_skb_finish(dev_gro_receive(napi, skb), skb);
3982 }
3983 EXPORT_SYMBOL(napi_gro_receive);
3984
3985 static void napi_reuse_skb(struct napi_struct *napi, struct sk_buff *skb)
3986 {
3987         __skb_pull(skb, skb_headlen(skb));
3988         /* restore the reserve we had after netdev_alloc_skb_ip_align() */
3989         skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN - skb_headroom(skb));
3990         skb->vlan_tci = 0;
3991         skb->dev = napi->dev;
3992         skb->skb_iif = 0;
3993
3994         napi->skb = skb;
3995 }
3996
3997 struct sk_buff *napi_get_frags(struct napi_struct *napi)
3998 {
3999         struct sk_buff *skb = napi->skb;
4000
4001         if (!skb) {
4002                 skb = netdev_alloc_skb_ip_align(napi->dev, GRO_MAX_HEAD);
4003                 napi->skb = skb;
4004         }
4005         return skb;
4006 }
4007 EXPORT_SYMBOL(napi_get_frags);
4008
4009 static gro_result_t napi_frags_finish(struct napi_struct *napi, struct sk_buff *skb,
4010                                gro_result_t ret)
4011 {
4012         switch (ret) {
4013         case GRO_NORMAL:
4014                 if (netif_receive_skb(skb))
4015                         ret = GRO_DROP;
4016                 break;
4017
4018         case GRO_DROP:
4019         case GRO_MERGED_FREE:
4020                 napi_reuse_skb(napi, skb);
4021                 break;
4022
4023         case GRO_HELD:
4024         case GRO_MERGED:
4025                 break;
4026         }
4027
4028         return ret;
4029 }
4030
4031 static struct sk_buff *napi_frags_skb(struct napi_struct *napi)
4032 {
4033         struct sk_buff *skb = napi->skb;
4034
4035         napi->skb = NULL;
4036
4037         if (unlikely(!pskb_may_pull(skb, sizeof(struct ethhdr)))) {
4038                 napi_reuse_skb(napi, skb);
4039                 return NULL;
4040         }
4041         skb->protocol = eth_type_trans(skb, skb->dev);
4042
4043         return skb;
4044 }
4045
4046 gro_result_t napi_gro_frags(struct napi_struct *napi)
4047 {
4048         struct sk_buff *skb = napi_frags_skb(napi);
4049
4050         if (!skb)
4051                 return GRO_DROP;
4052
4053         return napi_frags_finish(napi, skb, dev_gro_receive(napi, skb));
4054 }
4055 EXPORT_SYMBOL(napi_gro_frags);
4056
4057 /*
4058  * net_rps_action_and_irq_enable sends any pending IPI's for rps.
4059  * Note: called with local irq disabled, but exits with local irq enabled.
4060  */
4061 static void net_rps_action_and_irq_enable(struct softnet_data *sd)
4062 {
4063 #ifdef CONFIG_RPS
4064         struct softnet_data *remsd = sd->rps_ipi_list;
4065
4066         if (remsd) {
4067                 sd->rps_ipi_list = NULL;
4068
4069                 local_irq_enable();
4070
4071                 /* Send pending IPI's to kick RPS processing on remote cpus. */
4072                 while (remsd) {
4073                         struct softnet_data *next = remsd->rps_ipi_next;
4074
4075                         if (cpu_online(remsd->cpu))
4076                                 __smp_call_function_single(remsd->cpu,
4077                                                            &remsd->csd, 0);
4078                         remsd = next;
4079                 }
4080         } else
4081 #endif
4082                 local_irq_enable();
4083 }
4084
4085 static int process_backlog(struct napi_struct *napi, int quota)
4086 {
4087         int work = 0;
4088         struct softnet_data *sd = container_of(napi, struct softnet_data, backlog);
4089
4090 #ifdef CONFIG_RPS
4091         /* Check if we have pending ipi, its better to send them now,
4092          * not waiting net_rx_action() end.
4093          */
4094         if (sd->rps_ipi_list) {
4095                 local_irq_disable();
4096                 net_rps_action_and_irq_enable(sd);
4097         }
4098 #endif
4099         napi->weight = weight_p;
4100         local_irq_disable();
4101         while (work < quota) {
4102                 struct sk_buff *skb;
4103                 unsigned int qlen;
4104
4105                 while ((skb = __skb_dequeue(&sd->process_queue))) {
4106                         local_irq_enable();
4107                         __netif_receive_skb(skb);
4108                         local_irq_disable();
4109                         input_queue_head_incr(sd);
4110                         if (++work >= quota) {
4111                                 local_irq_enable();
4112                                 return work;
4113                         }
4114                 }
4115
4116                 rps_lock(sd);
4117                 qlen = skb_queue_len(&sd->input_pkt_queue);
4118                 if (qlen)
4119                         skb_queue_splice_tail_init(&sd->input_pkt_queue,
4120                                                    &sd->process_queue);
4121
4122                 if (qlen < quota - work) {
4123                         /*
4124                          * Inline a custom version of __napi_complete().
4125                          * only current cpu owns and manipulates this napi,
4126                          * and NAPI_STATE_SCHED is the only possible flag set on backlog.
4127                          * we can use a plain write instead of clear_bit(),
4128                          * and we dont need an smp_mb() memory barrier.
4129                          */
4130                         list_del(&napi->poll_list);
4131                         napi->state = 0;
4132
4133                         quota = work + qlen;
4134                 }
4135                 rps_unlock(sd);
4136         }
4137         local_irq_enable();
4138
4139         return work;
4140 }
4141
4142 /**
4143  * __napi_schedule - schedule for receive
4144  * @n: entry to schedule
4145  *
4146  * The entry's receive function will be scheduled to run
4147  */
4148 void __napi_schedule(struct napi_struct *n)
4149 {
4150         unsigned long flags;
4151
4152         local_irq_save(flags);
4153         ____napi_schedule(&__get_cpu_var(softnet_data), n);
4154         local_irq_restore(flags);
4155 }
4156 EXPORT_SYMBOL(__napi_schedule);
4157
4158 void __napi_complete(struct napi_struct *n)
4159 {
4160         BUG_ON(!test_bit(NAPI_STATE_SCHED, &n->state));
4161         BUG_ON(n->gro_list);
4162
4163         list_del(&n->poll_list);
4164         smp_mb__before_clear_bit();
4165         clear_bit(NAPI_STATE_SCHED, &n->state);
4166 }
4167 EXPORT_SYMBOL(__napi_complete);
4168
4169 void napi_complete(struct napi_struct *n)
4170 {
4171         unsigned long flags;
4172
4173         /*
4174          * don't let napi dequeue from the cpu poll list
4175          * just in case its running on a different cpu
4176          */
4177         if (unlikely(test_bit(NAPI_STATE_NPSVC, &n->state)))
4178                 return;
4179
4180         napi_gro_flush(n, false);
4181         local_irq_save(flags);
4182         __napi_complete(n);
4183         local_irq_restore(flags);
4184 }
4185 EXPORT_SYMBOL(napi_complete);
4186
4187 /* must be called under rcu_read_lock(), as we dont take a reference */
4188 struct napi_struct *napi_by_id(unsigned int napi_id)
4189 {
4190         unsigned int hash = napi_id % HASH_SIZE(napi_hash);
4191         struct napi_struct *napi;
4192
4193         hlist_for_each_entry_rcu(napi, &napi_hash[hash], napi_hash_node)
4194                 if (napi->napi_id == napi_id)
4195                         return napi;
4196
4197         return NULL;
4198 }
4199 EXPORT_SYMBOL_GPL(napi_by_id);
4200
4201 void napi_hash_add(struct napi_struct *napi)
4202 {
4203         if (!test_and_set_bit(NAPI_STATE_HASHED, &napi->state)) {
4204
4205                 spin_lock(&napi_hash_lock);
4206
4207                 /* 0 is not a valid id, we also skip an id that is taken
4208                  * we expect both events to be extremely rare
4209                  */
4210                 napi->napi_id = 0;
4211                 while (!napi->napi_id) {
4212                         napi->napi_id = ++napi_gen_id;
4213                         if (napi_by_id(napi->napi_id))
4214                                 napi->napi_id = 0;
4215                 }
4216
4217                 hlist_add_head_rcu(&napi->napi_hash_node,
4218                         &napi_hash[napi->napi_id % HASH_SIZE(napi_hash)]);
4219
4220                 spin_unlock(&napi_hash_lock);
4221         }
4222 }
4223 EXPORT_SYMBOL_GPL(napi_hash_add);
4224
4225 /* Warning : caller is responsible to make sure rcu grace period
4226  * is respected before freeing memory containing @napi
4227  */
4228 void napi_hash_del(struct napi_struct *napi)
4229 {
4230         spin_lock(&napi_hash_lock);
4231
4232         if (test_and_clear_bit(NAPI_STATE_HASHED, &napi->state))
4233                 hlist_del_rcu(&napi->napi_hash_node);
4234
4235         spin_unlock(&napi_hash_lock);
4236 }
4237 EXPORT_SYMBOL_GPL(napi_hash_del);
4238
4239 void netif_napi_add(struct net_device *dev, struct napi_struct *napi,
4240                     int (*poll)(struct napi_struct *, int), int weight)
4241 {
4242         INIT_LIST_HEAD(&napi->poll_list);
4243         napi->gro_count = 0;
4244         napi->gro_list = NULL;
4245         napi->skb = NULL;
4246         napi->poll = poll;
4247         if (weight > NAPI_POLL_WEIGHT)
4248                 pr_err_once("netif_napi_add() called with weight %d on device %s\n",
4249                             weight, dev->name);
4250         napi->weight = weight;
4251         list_add(&napi->dev_list, &dev->napi_list);
4252         napi->dev = dev;
4253 #ifdef CONFIG_NETPOLL
4254         spin_lock_init(&napi->poll_lock);
4255         napi->poll_owner = -1;
4256 #endif
4257         set_bit(NAPI_STATE_SCHED, &napi->state);
4258 }
4259 EXPORT_SYMBOL(netif_napi_add);
4260
4261 void netif_napi_del(struct napi_struct *napi)
4262 {
4263         list_del_init(&napi->dev_list);
4264         napi_free_frags(napi);
4265
4266         kfree_skb_list(napi->gro_list);
4267         napi->gro_list = NULL;
4268         napi->gro_count = 0;
4269 }
4270 EXPORT_SYMBOL(netif_napi_del);
4271
4272 static void net_rx_action(struct softirq_action *h)
4273 {
4274         struct softnet_data *sd = &__get_cpu_var(softnet_data);
4275         unsigned long time_limit = jiffies + 2;
4276         int budget = netdev_budget;
4277         void *have;
4278
4279         local_irq_disable();
4280
4281         while (!list_empty(&sd->poll_list)) {
4282                 struct napi_struct *n;
4283                 int work, weight;
4284
4285                 /* If softirq window is exhuasted then punt.
4286                  * Allow this to run for 2 jiffies since which will allow
4287                  * an average latency of 1.5/HZ.
4288                  */
4289                 if (unlikely(budget <= 0 || time_after_eq(jiffies, time_limit)))
4290                         goto softnet_break;
4291
4292                 local_irq_enable();
4293
4294                 /* Even though interrupts have been re-enabled, this
4295                  * access is safe because interrupts can only add new
4296                  * entries to the tail of this list, and only ->poll()
4297                  * calls can remove this head entry from the list.
4298                  */
4299                 n = list_first_entry(&sd->poll_list, struct napi_struct, poll_list);
4300
4301                 have = netpoll_poll_lock(n);
4302
4303                 weight = n->weight;
4304
4305                 /* This NAPI_STATE_SCHED test is for avoiding a race
4306                  * with netpoll's poll_napi().  Only the entity which
4307                  * obtains the lock and sees NAPI_STATE_SCHED set will
4308                  * actually make the ->poll() call.  Therefore we avoid
4309                  * accidentally calling ->poll() when NAPI is not scheduled.
4310                  */
4311                 work = 0;
4312                 if (test_bit(NAPI_STATE_SCHED, &n->state)) {
4313                         work = n->poll(n, weight);
4314                         trace_napi_poll(n);
4315                 }
4316
4317                 WARN_ON_ONCE(work > weight);
4318
4319                 budget -= work;
4320
4321                 local_irq_disable();
4322
4323                 /* Drivers must not modify the NAPI state if they
4324                  * consume the entire weight.  In such cases this code
4325                  * still "owns" the NAPI instance and therefore can
4326                  * move the instance around on the list at-will.
4327                  */
4328                 if (unlikely(work == weight)) {
4329                         if (unlikely(napi_disable_pending(n))) {
4330                                 local_irq_enable();
4331                                 napi_complete(n);
4332                                 local_irq_disable();
4333                         } else {
4334                                 if (n->gro_list) {
4335                                         /* flush too old packets
4336                                          * If HZ < 1000, flush all packets.
4337                                          */
4338                                         local_irq_enable();
4339                                         napi_gro_flush(n, HZ >= 1000);
4340                                         local_irq_disable();
4341                                 }
4342                                 list_move_tail(&n->poll_list, &sd->poll_list);
4343                         }
4344                 }
4345
4346                 netpoll_poll_unlock(have);
4347         }
4348 out:
4349         net_rps_action_and_irq_enable(sd);
4350
4351 #ifdef CONFIG_NET_DMA
4352         /*
4353          * There may not be any more sk_buffs coming right now, so push
4354          * any pending DMA copies to hardware
4355          */
4356         dma_issue_pending_all();
4357 #endif
4358
4359         return;
4360
4361 softnet_break:
4362         sd->time_squeeze++;
4363         __raise_softirq_irqoff(NET_RX_SOFTIRQ);
4364         goto out;
4365 }
4366
4367 struct netdev_adjacent {
4368         struct net_device *dev;
4369
4370         /* upper master flag, there can only be one master device per list */
4371         bool master;
4372
4373         /* counter for the number of times this device was added to us */
4374         u16 ref_nr;
4375
4376         /* private field for the users */
4377         void *private;
4378
4379         struct list_head list;
4380         struct rcu_head rcu;
4381 };
4382
4383 static struct netdev_adjacent *__netdev_find_adj(struct net_device *dev,
4384                                                  struct net_device *adj_dev,
4385                                                  struct list_head *adj_list)
4386 {
4387         struct netdev_adjacent *adj;
4388
4389         list_for_each_entry(adj, adj_list, list) {
4390                 if (adj->dev == adj_dev)
4391                         return adj;
4392         }
4393         return NULL;
4394 }
4395
4396 /**
4397  * netdev_has_upper_dev - Check if device is linked to an upper device
4398  * @dev: device
4399  * @upper_dev: upper device to check
4400  *
4401  * Find out if a device is linked to specified upper device and return true
4402  * in case it is. Note that this checks only immediate upper device,
4403  * not through a complete stack of devices. The caller must hold the RTNL lock.
4404  */
4405 bool netdev_has_upper_dev(struct net_device *dev,
4406                           struct net_device *upper_dev)
4407 {
4408         ASSERT_RTNL();
4409
4410         return __netdev_find_adj(dev, upper_dev, &dev->all_adj_list.upper);
4411 }
4412 EXPORT_SYMBOL(netdev_has_upper_dev);
4413
4414 /**
4415  * netdev_has_any_upper_dev - Check if device is linked to some device
4416  * @dev: device
4417  *
4418  * Find out if a device is linked to an upper device and return true in case
4419  * it is. The caller must hold the RTNL lock.
4420  */
4421 static bool netdev_has_any_upper_dev(struct net_device *dev)
4422 {
4423         ASSERT_RTNL();
4424
4425         return !list_empty(&dev->all_adj_list.upper);
4426 }
4427
4428 /**
4429  * netdev_master_upper_dev_get - Get master upper device
4430  * @dev: device
4431  *
4432  * Find a master upper device and return pointer to it or NULL in case
4433  * it's not there. The caller must hold the RTNL lock.
4434  */
4435 struct net_device *netdev_master_upper_dev_get(struct net_device *dev)
4436 {
4437         struct netdev_adjacent *upper;
4438
4439         ASSERT_RTNL();
4440
4441         if (list_empty(&dev->adj_list.upper))
4442                 return NULL;
4443
4444         upper = list_first_entry(&dev->adj_list.upper,
4445                                  struct netdev_adjacent, list);
4446         if (likely(upper->master))
4447                 return upper->dev;
4448         return NULL;
4449 }
4450 EXPORT_SYMBOL(netdev_master_upper_dev_get);
4451
4452 void *netdev_adjacent_get_private(struct list_head *adj_list)
4453 {
4454         struct netdev_adjacent *adj;
4455
4456         adj = list_entry(adj_list, struct netdev_adjacent, list);
4457
4458         return adj->private;
4459 }
4460 EXPORT_SYMBOL(netdev_adjacent_get_private);
4461
4462 /**
4463  * netdev_all_upper_get_next_dev_rcu - Get the next dev from upper list
4464  * @dev: device
4465  * @iter: list_head ** of the current position
4466  *
4467  * Gets the next device from the dev's upper list, starting from iter
4468  * position. The caller must hold RCU read lock.
4469  */
4470 struct net_device *netdev_all_upper_get_next_dev_rcu(struct net_device *dev,
4471                                                      struct list_head **iter)
4472 {
4473         struct netdev_adjacent *upper;
4474
4475         WARN_ON_ONCE(!rcu_read_lock_held() && !lockdep_rtnl_is_held());
4476
4477         upper = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
4478
4479         if (&upper->list == &dev->all_adj_list.upper)
4480                 return NULL;
4481
4482         *iter = &upper->list;
4483
4484         return upper->dev;
4485 }
4486 EXPORT_SYMBOL(netdev_all_upper_get_next_dev_rcu);
4487
4488 /**
4489  * netdev_lower_get_next_private - Get the next ->private from the
4490  *                                 lower neighbour list
4491  * @dev: device
4492  * @iter: list_head ** of the current position
4493  *
4494  * Gets the next netdev_adjacent->private from the dev's lower neighbour
4495  * list, starting from iter position. The caller must hold either hold the
4496  * RTNL lock or its own locking that guarantees that the neighbour lower
4497  * list will remain unchainged.
4498  */
4499 void *netdev_lower_get_next_private(struct net_device *dev,
4500                                     struct list_head **iter)
4501 {
4502         struct netdev_adjacent *lower;
4503
4504         lower = list_entry(*iter, struct netdev_adjacent, list);
4505
4506         if (&lower->list == &dev->adj_list.lower)
4507                 return NULL;
4508
4509         if (iter)
4510                 *iter = lower->list.next;
4511
4512         return lower->private;
4513 }
4514 EXPORT_SYMBOL(netdev_lower_get_next_private);
4515
4516 /**
4517  * netdev_lower_get_next_private_rcu - Get the next ->private from the
4518  *                                     lower neighbour list, RCU
4519  *                                     variant
4520  * @dev: device
4521  * @iter: list_head ** of the current position
4522  *
4523  * Gets the next netdev_adjacent->private from the dev's lower neighbour
4524  * list, starting from iter position. The caller must hold RCU read lock.
4525  */
4526 void *netdev_lower_get_next_private_rcu(struct net_device *dev,
4527                                         struct list_head **iter)
4528 {
4529         struct netdev_adjacent *lower;
4530
4531         WARN_ON_ONCE(!rcu_read_lock_held());
4532
4533         lower = list_entry_rcu((*iter)->next, struct netdev_adjacent, list);
4534
4535         if (&lower->list == &dev->adj_list.lower)
4536                 return NULL;
4537
4538         if (iter)
4539                 *iter = &lower->list;
4540
4541         return lower->private;
4542 }
4543 EXPORT_SYMBOL(netdev_lower_get_next_private_rcu);
4544
4545 /**
4546  * netdev_lower_get_first_private_rcu - Get the first ->private from the
4547  *                                     lower neighbour list, RCU
4548  *                                     variant
4549  * @dev: device
4550  *
4551  * Gets the first netdev_adjacent->private from the dev's lower neighbour
4552  * list. The caller must hold RCU read lock.
4553  */
4554 void *netdev_lower_get_first_private_rcu(struct net_device *dev)
4555 {
4556         struct netdev_adjacent *lower;
4557
4558         lower = list_first_or_null_rcu(&dev->adj_list.lower,
4559                         struct netdev_adjacent, list);
4560         if (lower)
4561                 return lower->private;
4562         return NULL;
4563 }
4564 EXPORT_SYMBOL(netdev_lower_get_first_private_rcu);
4565
4566 /**
4567  * netdev_master_upper_dev_get_rcu - Get master upper device
4568  * @dev: device
4569  *
4570  * Find a master upper device and return pointer to it or NULL in case
4571  * it's not there. The caller must hold the RCU read lock.
4572  */
4573 struct net_device *netdev_master_upper_dev_get_rcu(struct net_device *dev)
4574 {
4575         struct netdev_adjacent *upper;
4576
4577         upper = list_first_or_null_rcu(&dev->adj_list.upper,
4578                                        struct netdev_adjacent, list);
4579         if (upper && likely(upper->master))
4580                 return upper->dev;
4581         return NULL;
4582 }
4583 EXPORT_SYMBOL(netdev_master_upper_dev_get_rcu);
4584
4585 static int __netdev_adjacent_dev_insert(struct net_device *dev,
4586                                         struct net_device *adj_dev,
4587                                         struct list_head *dev_list,
4588                                         void *private, bool master)
4589 {
4590         struct netdev_adjacent *adj;
4591         char linkname[IFNAMSIZ+7];
4592         int ret;
4593
4594         adj = __netdev_find_adj(dev, adj_dev, dev_list);
4595
4596         if (adj) {
4597                 adj->ref_nr++;
4598                 return 0;
4599         }
4600
4601         adj = kmalloc(sizeof(*adj), GFP_KERNEL);
4602         if (!adj)
4603                 return -ENOMEM;
4604
4605         adj->dev = adj_dev;
4606         adj->master = master;
4607         adj->ref_nr = 1;
4608         adj->private = private;
4609         dev_hold(adj_dev);
4610
4611         pr_debug("dev_hold for %s, because of link added from %s to %s\n",
4612                  adj_dev->name, dev->name, adj_dev->name);
4613
4614         if (dev_list == &dev->adj_list.lower) {
4615                 sprintf(linkname, "lower_%s", adj_dev->name);
4616                 ret = sysfs_create_link(&(dev->dev.kobj),
4617                                         &(adj_dev->dev.kobj), linkname);
4618                 if (ret)
4619                         goto free_adj;
4620         } else if (dev_list == &dev->adj_list.upper) {
4621                 sprintf(linkname, "upper_%s", adj_dev->name);
4622                 ret = sysfs_create_link(&(dev->dev.kobj),
4623                                         &(adj_dev->dev.kobj), linkname);
4624                 if (ret)
4625                         goto free_adj;
4626         }
4627
4628         /* Ensure that master link is always the first item in list. */
4629         if (master) {
4630                 ret = sysfs_create_link(&(dev->dev.kobj),
4631                                         &(adj_dev->dev.kobj), "master");
4632                 if (ret)
4633                         goto remove_symlinks;
4634
4635                 list_add_rcu(&adj->list, dev_list);
4636         } else {
4637                 list_add_tail_rcu(&adj->list, dev_list);
4638         }
4639
4640         return 0;
4641
4642 remove_symlinks:
4643         if (dev_list == &dev->adj_list.lower) {
4644                 sprintf(linkname, "lower_%s", adj_dev->name);
4645                 sysfs_remove_link(&(dev->dev.kobj), linkname);
4646         } else if (dev_list == &dev->adj_list.upper) {
4647                 sprintf(linkname, "upper_%s", adj_dev->name);
4648                 sysfs_remove_link(&(dev->dev.kobj), linkname);
4649         }
4650
4651 free_adj:
4652         kfree(adj);
4653         dev_put(adj_dev);
4654
4655         return ret;
4656 }
4657
4658 static void __netdev_adjacent_dev_remove(struct net_device *dev,
4659                                          struct net_device *adj_dev,
4660                                          struct list_head *dev_list)
4661 {
4662         struct netdev_adjacent *adj;
4663         char linkname[IFNAMSIZ+7];
4664
4665         adj = __netdev_find_adj(dev, adj_dev, dev_list);
4666
4667         if (!adj) {
4668                 pr_err("tried to remove device %s from %s\n",
4669                        dev->name, adj_dev->name);
4670                 BUG();
4671         }
4672
4673         if (adj->ref_nr > 1) {
4674                 pr_debug("%s to %s ref_nr-- = %d\n", dev->name, adj_dev->name,
4675                          adj->ref_nr-1);
4676                 adj->ref_nr--;
4677                 return;
4678         }
4679
4680         if (adj->master)
4681                 sysfs_remove_link(&(dev->dev.kobj), "master");
4682
4683         if (dev_list == &dev->adj_list.lower) {
4684                 sprintf(linkname, "lower_%s", adj_dev->name);
4685                 sysfs_remove_link(&(dev->dev.kobj), linkname);
4686         } else if (dev_list == &dev->adj_list.upper) {
4687                 sprintf(linkname, "upper_%s", adj_dev->name);
4688                 sysfs_remove_link(&(dev->dev.kobj), linkname);
4689         }
4690
4691         list_del_rcu(&adj->list);
4692         pr_debug("dev_put for %s, because link removed from %s to %s\n",
4693                  adj_dev->name, dev->name, adj_dev->name);
4694         dev_put(adj_dev);
4695         kfree_rcu(adj, rcu);
4696 }
4697
4698 static int __netdev_adjacent_dev_link_lists(struct net_device *dev,
4699                                             struct net_device *upper_dev,
4700                                             struct list_head *up_list,
4701                                             struct list_head *down_list,
4702                                             void *private, bool master)
4703 {
4704         int ret;
4705
4706         ret = __netdev_adjacent_dev_insert(dev, upper_dev, up_list, private,
4707                                            master);
4708         if (ret)
4709                 return ret;
4710
4711         ret = __netdev_adjacent_dev_insert(upper_dev, dev, down_list, private,
4712                                            false);
4713         if (ret) {
4714                 __netdev_adjacent_dev_remove(dev, upper_dev, up_list);
4715                 return ret;
4716         }
4717
4718         return 0;
4719 }
4720
4721 static int __netdev_adjacent_dev_link(struct net_device *dev,
4722                                       struct net_device *upper_dev)
4723 {
4724         return __netdev_adjacent_dev_link_lists(dev, upper_dev,
4725                                                 &dev->all_adj_list.upper,
4726                                                 &upper_dev->all_adj_list.lower,
4727                                                 NULL, false);
4728 }
4729
4730 static void __netdev_adjacent_dev_unlink_lists(struct net_device *dev,
4731                                                struct net_device *upper_dev,
4732                                                struct list_head *up_list,
4733                                                struct list_head *down_list)
4734 {
4735         __netdev_adjacent_dev_remove(dev, upper_dev, up_list);
4736         __netdev_adjacent_dev_remove(upper_dev, dev, down_list);
4737 }
4738
4739 static void __netdev_adjacent_dev_unlink(struct net_device *dev,
4740                                          struct net_device *upper_dev)
4741 {
4742         __netdev_adjacent_dev_unlink_lists(dev, upper_dev,
4743                                            &dev->all_adj_list.upper,
4744                                            &upper_dev->all_adj_list.lower);
4745 }
4746
4747 static int __netdev_adjacent_dev_link_neighbour(struct net_device *dev,
4748                                                 struct net_device *upper_dev,
4749                                                 void *private, bool master)
4750 {
4751         int ret = __netdev_adjacent_dev_link(dev, upper_dev);
4752
4753         if (ret)
4754                 return ret;
4755
4756         ret = __netdev_adjacent_dev_link_lists(dev, upper_dev,
4757                                                &dev->adj_list.upper,
4758                                                &upper_dev->adj_list.lower,
4759                                                private, master);
4760         if (ret) {
4761                 __netdev_adjacent_dev_unlink(dev, upper_dev);
4762                 return ret;
4763         }
4764
4765         return 0;
4766 }
4767
4768 static void __netdev_adjacent_dev_unlink_neighbour(struct net_device *dev,
4769                                                    struct net_device *upper_dev)
4770 {
4771         __netdev_adjacent_dev_unlink(dev, upper_dev);
4772         __netdev_adjacent_dev_unlink_lists(dev, upper_dev,
4773                                            &dev->adj_list.upper,
4774                                            &upper_dev->adj_list.lower);
4775 }
4776
4777 static int __netdev_upper_dev_link(struct net_device *dev,
4778                                    struct net_device *upper_dev, bool master,
4779                                    void *private)
4780 {
4781         struct netdev_adjacent *i, *j, *to_i, *to_j;
4782         int ret = 0;
4783
4784         ASSERT_RTNL();
4785
4786         if (dev == upper_dev)
4787                 return -EBUSY;
4788
4789         /* To prevent loops, check if dev is not upper device to upper_dev. */
4790         if (__netdev_find_adj(upper_dev, dev, &upper_dev->all_adj_list.upper))
4791                 return -EBUSY;
4792
4793         if (__netdev_find_adj(dev, upper_dev, &dev->all_adj_list.upper))
4794                 return -EEXIST;
4795
4796         if (master && netdev_master_upper_dev_get(dev))
4797                 return -EBUSY;
4798
4799         ret = __netdev_adjacent_dev_link_neighbour(dev, upper_dev, private,
4800                                                    master);
4801         if (ret)
4802                 return ret;
4803
4804         /* Now that we linked these devs, make all the upper_dev's
4805          * all_adj_list.upper visible to every dev's all_adj_list.lower an
4806          * versa, and don't forget the devices itself. All of these
4807          * links are non-neighbours.
4808          */
4809         list_for_each_entry(i, &dev->all_adj_list.lower, list) {
4810                 list_for_each_entry(j, &upper_dev->all_adj_list.upper, list) {
4811                         pr_debug("Interlinking %s with %s, non-neighbour\n",
4812                                  i->dev->name, j->dev->name);
4813                         ret = __netdev_adjacent_dev_link(i->dev, j->dev);
4814                         if (ret)
4815                                 goto rollback_mesh;
4816                 }
4817         }
4818
4819         /* add dev to every upper_dev's upper device */
4820         list_for_each_entry(i, &upper_dev->all_adj_list.upper, list) {
4821                 pr_debug("linking %s's upper device %s with %s\n",
4822                          upper_dev->name, i->dev->name, dev->name);
4823                 ret = __netdev_adjacent_dev_link(dev, i->dev);
4824                 if (ret)
4825                         goto rollback_upper_mesh;
4826         }
4827
4828         /* add upper_dev to every dev's lower device */
4829         list_for_each_entry(i, &dev->all_adj_list.lower, list) {
4830                 pr_debug("linking %s's lower device %s with %s\n", dev->name,
4831                          i->dev->name, upper_dev->name);
4832                 ret = __netdev_adjacent_dev_link(i->dev, upper_dev);
4833                 if (ret)
4834                         goto rollback_lower_mesh;
4835         }
4836
4837         call_netdevice_notifiers(NETDEV_CHANGEUPPER, dev);
4838         return 0;
4839
4840 rollback_lower_mesh:
4841         to_i = i;
4842         list_for_each_entry(i, &dev->all_adj_list.lower, list) {
4843                 if (i == to_i)
4844                         break;
4845                 __netdev_adjacent_dev_unlink(i->dev, upper_dev);
4846         }
4847
4848         i = NULL;
4849
4850 rollback_upper_mesh:
4851         to_i = i;
4852         list_for_each_entry(i, &upper_dev->all_adj_list.upper, list) {
4853                 if (i == to_i)
4854                         break;
4855                 __netdev_adjacent_dev_unlink(dev, i->dev);
4856         }
4857
4858         i = j = NULL;
4859
4860 rollback_mesh:
4861         to_i = i;
4862         to_j = j;
4863         list_for_each_entry(i, &dev->all_adj_list.lower, list) {
4864                 list_for_each_entry(j, &upper_dev->all_adj_list.upper, list) {
4865                         if (i == to_i && j == to_j)
4866                                 break;
4867                         __netdev_adjacent_dev_unlink(i->dev, j->dev);
4868                 }
4869                 if (i == to_i)
4870                         break;
4871         }
4872
4873         __netdev_adjacent_dev_unlink_neighbour(dev, upper_dev);
4874
4875         return ret;
4876 }
4877
4878 /**
4879  * netdev_upper_dev_link - Add a link to the upper device
4880  * @dev: device
4881  * @upper_dev: new upper device
4882  *
4883  * Adds a link to device which is upper to this one. The caller must hold
4884  * the RTNL lock. On a failure a negative errno code is returned.
4885  * On success the reference counts are adjusted and the function
4886  * returns zero.
4887  */
4888 int netdev_upper_dev_link(struct net_device *dev,
4889                           struct net_device *upper_dev)
4890 {
4891         return __netdev_upper_dev_link(dev, upper_dev, false, NULL);
4892 }
4893 EXPORT_SYMBOL(netdev_upper_dev_link);
4894
4895 /**
4896  * netdev_master_upper_dev_link - Add a master link to the upper device
4897  * @dev: device
4898  * @upper_dev: new upper device
4899  *
4900  * Adds a link to device which is upper to this one. In this case, only
4901  * one master upper device can be linked, although other non-master devices
4902  * might be linked as well. The caller must hold the RTNL lock.
4903  * On a failure a negative errno code is returned. On success the reference
4904  * counts are adjusted and the function returns zero.
4905  */
4906 int netdev_master_upper_dev_link(struct net_device *dev,
4907                                  struct net_device *upper_dev)
4908 {
4909         return __netdev_upper_dev_link(dev, upper_dev, true, NULL);
4910 }
4911 EXPORT_SYMBOL(netdev_master_upper_dev_link);
4912
4913 int netdev_master_upper_dev_link_private(struct net_device *dev,
4914                                          struct net_device *upper_dev,
4915                                          void *private)
4916 {
4917         return __netdev_upper_dev_link(dev, upper_dev, true, private);
4918 }
4919 EXPORT_SYMBOL(netdev_master_upper_dev_link_private);
4920
4921 /**
4922  * netdev_upper_dev_unlink - Removes a link to upper device
4923  * @dev: device
4924  * @upper_dev: new upper device
4925  *
4926  * Removes a link to device which is upper to this one. The caller must hold
4927  * the RTNL lock.
4928  */
4929 void netdev_upper_dev_unlink(struct net_device *dev,
4930                              struct net_device *upper_dev)
4931 {
4932         struct netdev_adjacent *i, *j;
4933         ASSERT_RTNL();
4934
4935         __netdev_adjacent_dev_unlink_neighbour(dev, upper_dev);
4936
4937         /* Here is the tricky part. We must remove all dev's lower
4938          * devices from all upper_dev's upper devices and vice
4939          * versa, to maintain the graph relationship.
4940          */
4941         list_for_each_entry(i, &dev->all_adj_list.lower, list)
4942                 list_for_each_entry(j, &upper_dev->all_adj_list.upper, list)
4943                         __netdev_adjacent_dev_unlink(i->dev, j->dev);
4944
4945         /* remove also the devices itself from lower/upper device
4946          * list
4947          */
4948         list_for_each_entry(i, &dev->all_adj_list.lower, list)
4949                 __netdev_adjacent_dev_unlink(i->dev, upper_dev);
4950
4951         list_for_each_entry(i, &upper_dev->all_adj_list.upper, list)
4952                 __netdev_adjacent_dev_unlink(dev, i->dev);
4953
4954         call_netdevice_notifiers(NETDEV_CHANGEUPPER, dev);
4955 }
4956 EXPORT_SYMBOL(netdev_upper_dev_unlink);
4957
4958 void *netdev_lower_dev_get_private(struct net_device *dev,
4959                                    struct net_device *lower_dev)
4960 {
4961         struct netdev_adjacent *lower;
4962
4963         if (!lower_dev)
4964                 return NULL;
4965         lower = __netdev_find_adj(dev, lower_dev, &dev->adj_list.lower);
4966         if (!lower)
4967                 return NULL;
4968
4969         return lower->private;
4970 }
4971 EXPORT_SYMBOL(netdev_lower_dev_get_private);
4972
4973 static void dev_change_rx_flags(struct net_device *dev, int flags)
4974 {
4975         const struct net_device_ops *ops = dev->netdev_ops;
4976
4977         if (ops->ndo_change_rx_flags)
4978                 ops->ndo_change_rx_flags(dev, flags);
4979 }
4980
4981 static int __dev_set_promiscuity(struct net_device *dev, int inc, bool notify)
4982 {
4983         unsigned int old_flags = dev->flags;
4984         kuid_t uid;
4985         kgid_t gid;
4986
4987         ASSERT_RTNL();
4988
4989         dev->flags |= IFF_PROMISC;
4990         dev->promiscuity += inc;
4991         if (dev->promiscuity == 0) {
4992                 /*
4993                  * Avoid overflow.
4994                  * If inc causes overflow, untouch promisc and return error.
4995                  */
4996                 if (inc < 0)
4997                         dev->flags &= ~IFF_PROMISC;
4998                 else {
4999                         dev->promiscuity -= inc;
5000                         pr_warn("%s: promiscuity touches roof, set promiscuity failed. promiscuity feature of device might be broken.\n",
5001                                 dev->name);
5002                         return -EOVERFLOW;
5003                 }
5004         }
5005         if (dev->flags != old_flags) {
5006                 pr_info("device %s %s promiscuous mode\n",
5007                         dev->name,
5008                         dev->flags & IFF_PROMISC ? "entered" : "left");
5009                 if (audit_enabled) {
5010                         current_uid_gid(&uid, &gid);
5011                         audit_log(current->audit_context, GFP_ATOMIC,
5012                                 AUDIT_ANOM_PROMISCUOUS,
5013                                 "dev=%s prom=%d old_prom=%d auid=%u uid=%u gid=%u ses=%u",
5014                                 dev->name, (dev->flags & IFF_PROMISC),
5015                                 (old_flags & IFF_PROMISC),
5016                                 from_kuid(&init_user_ns, audit_get_loginuid(current)),
5017                                 from_kuid(&init_user_ns, uid),
5018                                 from_kgid(&init_user_ns, gid),
5019                                 audit_get_sessionid(current));
5020                 }
5021
5022                 dev_change_rx_flags(dev, IFF_PROMISC);
5023         }
5024         if (notify)
5025                 __dev_notify_flags(dev, old_flags, IFF_PROMISC);
5026         return 0;
5027 }
5028
5029 /**
5030  *      dev_set_promiscuity     - update promiscuity count on a device
5031  *      @dev: device
5032  *      @inc: modifier
5033  *
5034  *      Add or remove promiscuity from a device. While the count in the device
5035  *      remains above zero the interface remains promiscuous. Once it hits zero
5036  *      the device reverts back to normal filtering operation. A negative inc
5037  *      value is used to drop promiscuity on the device.
5038  *      Return 0 if successful or a negative errno code on error.
5039  */
5040 int dev_set_promiscuity(struct net_device *dev, int inc)
5041 {
5042         unsigned int old_flags = dev->flags;
5043         int err;
5044
5045         err = __dev_set_promiscuity(dev, inc, true);
5046         if (err < 0)
5047                 return err;
5048         if (dev->flags != old_flags)
5049                 dev_set_rx_mode(dev);
5050         return err;
5051 }
5052 EXPORT_SYMBOL(dev_set_promiscuity);
5053
5054 static int __dev_set_allmulti(struct net_device *dev, int inc, bool notify)
5055 {
5056         unsigned int old_flags = dev->flags, old_gflags = dev->gflags;
5057
5058         ASSERT_RTNL();
5059
5060         dev->flags |= IFF_ALLMULTI;
5061         dev->allmulti += inc;
5062         if (dev->allmulti == 0) {
5063                 /*
5064                  * Avoid overflow.
5065                  * If inc causes overflow, untouch allmulti and return error.
5066                  */
5067                 if (inc < 0)
5068                         dev->flags &= ~IFF_ALLMULTI;
5069                 else {
5070                         dev->allmulti -= inc;
5071                         pr_warn("%s: allmulti touches roof, set allmulti failed. allmulti feature of device might be broken.\n",
5072                                 dev->name);
5073                         return -EOVERFLOW;
5074                 }
5075         }
5076         if (dev->flags ^ old_flags) {
5077                 dev_change_rx_flags(dev, IFF_ALLMULTI);
5078                 dev_set_rx_mode(dev);
5079                 if (notify)
5080                         __dev_notify_flags(dev, old_flags,
5081                                            dev->gflags ^ old_gflags);
5082         }
5083         return 0;
5084 }
5085
5086 /**
5087  *      dev_set_allmulti        - update allmulti count on a device
5088  *      @dev: device
5089  *      @inc: modifier
5090  *
5091  *      Add or remove reception of all multicast frames to a device. While the
5092  *      count in the device remains above zero the interface remains listening
5093  *      to all interfaces. Once it hits zero the device reverts back to normal
5094  *      filtering operation. A negative @inc value is used to drop the counter
5095  *      when releasing a resource needing all multicasts.
5096  *      Return 0 if successful or a negative errno code on error.
5097  */
5098
5099 int dev_set_allmulti(struct net_device *dev, int inc)
5100 {
5101         return __dev_set_allmulti(dev, inc, true);
5102 }
5103 EXPORT_SYMBOL(dev_set_allmulti);
5104
5105 /*
5106  *      Upload unicast and multicast address lists to device and
5107  *      configure RX filtering. When the device doesn't support unicast
5108  *      filtering it is put in promiscuous mode while unicast addresses
5109  *      are present.
5110  */
5111 void __dev_set_rx_mode(struct net_device *dev)
5112 {
5113         const struct net_device_ops *ops = dev->netdev_ops;
5114
5115         /* dev_open will call this function so the list will stay sane. */
5116         if (!(dev->flags&IFF_UP))
5117                 return;
5118
5119         if (!netif_device_present(dev))
5120                 return;
5121
5122         if (!(dev->priv_flags & IFF_UNICAST_FLT)) {
5123                 /* Unicast addresses changes may only happen under the rtnl,
5124                  * therefore calling __dev_set_promiscuity here is safe.
5125                  */
5126                 if (!netdev_uc_empty(dev) && !dev->uc_promisc) {
5127                         __dev_set_promiscuity(dev, 1, false);
5128                         dev->uc_promisc = true;
5129                 } else if (netdev_uc_empty(dev) && dev->uc_promisc) {
5130                         __dev_set_promiscuity(dev, -1, false);
5131                         dev->uc_promisc = false;
5132                 }
5133         }
5134
5135         if (ops->ndo_set_rx_mode)
5136                 ops->ndo_set_rx_mode(dev);
5137 }
5138
5139 void dev_set_rx_mode(struct net_device *dev)
5140 {
5141         netif_addr_lock_bh(dev);
5142         __dev_set_rx_mode(dev);
5143         netif_addr_unlock_bh(dev);
5144 }
5145
5146 /**
5147  *      dev_get_flags - get flags reported to userspace
5148  *      @dev: device
5149  *
5150  *      Get the combination of flag bits exported through APIs to userspace.
5151  */
5152 unsigned int dev_get_flags(const struct net_device *dev)
5153 {
5154         unsigned int flags;
5155
5156         flags = (dev->flags & ~(IFF_PROMISC |
5157                                 IFF_ALLMULTI |
5158                                 IFF_RUNNING |
5159                                 IFF_LOWER_UP |
5160                                 IFF_DORMANT)) |
5161                 (dev->gflags & (IFF_PROMISC |
5162                                 IFF_ALLMULTI));
5163
5164         if (netif_running(dev)) {
5165                 if (netif_oper_up(dev))
5166                         flags |= IFF_RUNNING;
5167                 if (netif_carrier_ok(dev))
5168                         flags |= IFF_LOWER_UP;
5169                 if (netif_dormant(dev))
5170                         flags |= IFF_DORMANT;
5171         }
5172
5173         return flags;
5174 }
5175 EXPORT_SYMBOL(dev_get_flags);
5176
5177 int __dev_change_flags(struct net_device *dev, unsigned int flags)
5178 {
5179         unsigned int old_flags = dev->flags;
5180         int ret;
5181
5182         ASSERT_RTNL();
5183
5184         /*
5185          *      Set the flags on our device.
5186          */
5187
5188         dev->flags = (flags & (IFF_DEBUG | IFF_NOTRAILERS | IFF_NOARP |
5189                                IFF_DYNAMIC | IFF_MULTICAST | IFF_PORTSEL |
5190                                IFF_AUTOMEDIA)) |
5191                      (dev->flags & (IFF_UP | IFF_VOLATILE | IFF_PROMISC |
5192                                     IFF_ALLMULTI));
5193
5194         /*
5195          *      Load in the correct multicast list now the flags have changed.
5196          */
5197
5198         if ((old_flags ^ flags) & IFF_MULTICAST)
5199                 dev_change_rx_flags(dev, IFF_MULTICAST);
5200
5201         dev_set_rx_mode(dev);
5202
5203         /*
5204          *      Have we downed the interface. We handle IFF_UP ourselves
5205          *      according to user attempts to set it, rather than blindly
5206          *      setting it.
5207          */
5208
5209         ret = 0;
5210         if ((old_flags ^ flags) & IFF_UP) {     /* Bit is different  ? */
5211                 ret = ((old_flags & IFF_UP) ? __dev_close : __dev_open)(dev);
5212
5213                 if (!ret)
5214                         dev_set_rx_mode(dev);
5215         }
5216
5217         if ((flags ^ dev->gflags) & IFF_PROMISC) {
5218                 int inc = (flags & IFF_PROMISC) ? 1 : -1;
5219                 unsigned int old_flags = dev->flags;
5220
5221                 dev->gflags ^= IFF_PROMISC;
5222
5223                 if (__dev_set_promiscuity(dev, inc, false) >= 0)
5224                         if (dev->flags != old_flags)
5225                                 dev_set_rx_mode(dev);
5226         }
5227
5228         /* NOTE: order of synchronization of IFF_PROMISC and IFF_ALLMULTI
5229            is important. Some (broken) drivers set IFF_PROMISC, when
5230            IFF_ALLMULTI is requested not asking us and not reporting.
5231          */
5232         if ((flags ^ dev->gflags) & IFF_ALLMULTI) {
5233                 int inc = (flags & IFF_ALLMULTI) ? 1 : -1;
5234
5235                 dev->gflags ^= IFF_ALLMULTI;
5236                 __dev_set_allmulti(dev, inc, false);
5237         }
5238
5239         return ret;
5240 }
5241
5242 void __dev_notify_flags(struct net_device *dev, unsigned int old_flags,
5243                         unsigned int gchanges)
5244 {
5245         unsigned int changes = dev->flags ^ old_flags;
5246
5247         if (gchanges)
5248                 rtmsg_ifinfo(RTM_NEWLINK, dev, gchanges, GFP_ATOMIC);
5249
5250         if (changes & IFF_UP) {
5251                 if (dev->flags & IFF_UP)
5252                         call_netdevice_notifiers(NETDEV_UP, dev);
5253                 else
5254                         call_netdevice_notifiers(NETDEV_DOWN, dev);
5255         }
5256
5257         if (dev->flags & IFF_UP &&
5258             (changes & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI | IFF_VOLATILE))) {
5259                 struct netdev_notifier_change_info change_info;
5260
5261                 change_info.flags_changed = changes;
5262                 call_netdevice_notifiers_info(NETDEV_CHANGE, dev,
5263                                               &change_info.info);
5264         }
5265 }
5266
5267 /**
5268  *      dev_change_flags - change device settings
5269  *      @dev: device
5270  *      @flags: device state flags
5271  *
5272  *      Change settings on device based state flags. The flags are
5273  *      in the userspace exported format.
5274  */
5275 int dev_change_flags(struct net_device *dev, unsigned int flags)
5276 {
5277         int ret;
5278         unsigned int changes, old_flags = dev->flags, old_gflags = dev->gflags;
5279
5280         ret = __dev_change_flags(dev, flags);
5281         if (ret < 0)
5282                 return ret;
5283
5284         changes = (old_flags ^ dev->flags) | (old_gflags ^ dev->gflags);
5285         __dev_notify_flags(dev, old_flags, changes);
5286         return ret;
5287 }
5288 EXPORT_SYMBOL(dev_change_flags);
5289
5290 /**
5291  *      dev_set_mtu - Change maximum transfer unit
5292  *      @dev: device
5293  *      @new_mtu: new transfer unit
5294  *
5295  *      Change the maximum transfer size of the network device.
5296  */
5297 int dev_set_mtu(struct net_device *dev, int new_mtu)
5298 {
5299         const struct net_device_ops *ops = dev->netdev_ops;
5300         int err;
5301
5302         if (new_mtu == dev->mtu)
5303                 return 0;
5304
5305         /*      MTU must be positive.    */
5306         if (new_mtu < 0)
5307                 return -EINVAL;
5308
5309         if (!netif_device_present(dev))
5310                 return -ENODEV;
5311
5312         err = 0;
5313         if (ops->ndo_change_mtu)
5314                 err = ops->ndo_change_mtu(dev, new_mtu);
5315         else
5316                 dev->mtu = new_mtu;
5317
5318         if (!err)
5319                 call_netdevice_notifiers(NETDEV_CHANGEMTU, dev);
5320         return err;
5321 }
5322 EXPORT_SYMBOL(dev_set_mtu);
5323
5324 /**
5325  *      dev_set_group - Change group this device belongs to
5326  *      @dev: device
5327  *      @new_group: group this device should belong to
5328  */
5329 void dev_set_group(struct net_device *dev, int new_group)
5330 {
5331         dev->group = new_group;
5332 }
5333 EXPORT_SYMBOL(dev_set_group);
5334
5335 /**
5336  *      dev_set_mac_address - Change Media Access Control Address
5337  *      @dev: device
5338  *      @sa: new address
5339  *
5340  *      Change the hardware (MAC) address of the device
5341  */
5342 int dev_set_mac_address(struct net_device *dev, struct sockaddr *sa)
5343 {
5344         const struct net_device_ops *ops = dev->netdev_ops;
5345         int err;
5346
5347         if (!ops->ndo_set_mac_address)
5348                 return -EOPNOTSUPP;
5349         if (sa->sa_family != dev->type)
5350                 return -EINVAL;
5351         if (!netif_device_present(dev))
5352                 return -ENODEV;
5353         err = ops->ndo_set_mac_address(dev, sa);
5354         if (err)
5355                 return err;
5356         dev->addr_assign_type = NET_ADDR_SET;
5357         call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
5358         add_device_randomness(dev->dev_addr, dev->addr_len);
5359         return 0;
5360 }
5361 EXPORT_SYMBOL(dev_set_mac_address);
5362
5363 /**
5364  *      dev_change_carrier - Change device carrier
5365  *      @dev: device
5366  *      @new_carrier: new value
5367  *
5368  *      Change device carrier
5369  */
5370 int dev_change_carrier(struct net_device *dev, bool new_carrier)
5371 {
5372         const struct net_device_ops *ops = dev->netdev_ops;
5373
5374         if (!ops->ndo_change_carrier)
5375                 return -EOPNOTSUPP;
5376         if (!netif_device_present(dev))
5377                 return -ENODEV;
5378         return ops->ndo_change_carrier(dev, new_carrier);
5379 }
5380 EXPORT_SYMBOL(dev_change_carrier);
5381
5382 /**
5383  *      dev_get_phys_port_id - Get device physical port ID
5384  *      @dev: device
5385  *      @ppid: port ID
5386  *
5387  *      Get device physical port ID
5388  */
5389 int dev_get_phys_port_id(struct net_device *dev,
5390                          struct netdev_phys_port_id *ppid)
5391 {
5392         const struct net_device_ops *ops = dev->netdev_ops;
5393
5394         if (!ops->ndo_get_phys_port_id)
5395                 return -EOPNOTSUPP;
5396         return ops->ndo_get_phys_port_id(dev, ppid);
5397 }
5398 EXPORT_SYMBOL(dev_get_phys_port_id);
5399
5400 /**
5401  *      dev_new_index   -       allocate an ifindex
5402  *      @net: the applicable net namespace
5403  *
5404  *      Returns a suitable unique value for a new device interface
5405  *      number.  The caller must hold the rtnl semaphore or the
5406  *      dev_base_lock to be sure it remains unique.
5407  */
5408 static int dev_new_index(struct net *net)
5409 {
5410         int ifindex = net->ifindex;
5411         for (;;) {
5412                 if (++ifindex <= 0)
5413                         ifindex = 1;
5414                 if (!__dev_get_by_index(net, ifindex))
5415                         return net->ifindex = ifindex;
5416         }
5417 }
5418
5419 /* Delayed registration/unregisteration */
5420 static LIST_HEAD(net_todo_list);
5421 static DECLARE_WAIT_QUEUE_HEAD(netdev_unregistering_wq);
5422
5423 static void net_set_todo(struct net_device *dev)
5424 {
5425         list_add_tail(&dev->todo_list, &net_todo_list);
5426         dev_net(dev)->dev_unreg_count++;
5427 }
5428
5429 static void rollback_registered_many(struct list_head *head)
5430 {
5431         struct net_device *dev, *tmp;
5432         LIST_HEAD(close_head);
5433
5434         BUG_ON(dev_boot_phase);
5435         ASSERT_RTNL();
5436
5437         list_for_each_entry_safe(dev, tmp, head, unreg_list) {
5438                 /* Some devices call without registering
5439                  * for initialization unwind. Remove those
5440                  * devices and proceed with the remaining.
5441                  */
5442                 if (dev->reg_state == NETREG_UNINITIALIZED) {
5443                         pr_debug("unregister_netdevice: device %s/%p never was registered\n",
5444                                  dev->name, dev);
5445
5446                         WARN_ON(1);
5447                         list_del(&dev->unreg_list);
5448                         continue;
5449                 }
5450                 dev->dismantle = true;
5451                 BUG_ON(dev->reg_state != NETREG_REGISTERED);
5452         }
5453
5454         /* If device is running, close it first. */
5455         list_for_each_entry(dev, head, unreg_list)
5456                 list_add_tail(&dev->close_list, &close_head);
5457         dev_close_many(&close_head);
5458
5459         list_for_each_entry(dev, head, unreg_list) {
5460                 /* And unlink it from device chain. */
5461                 unlist_netdevice(dev);
5462
5463                 dev->reg_state = NETREG_UNREGISTERING;
5464         }
5465
5466         synchronize_net();
5467
5468         list_for_each_entry(dev, head, unreg_list) {
5469                 /* Shutdown queueing discipline. */
5470                 dev_shutdown(dev);
5471
5472
5473                 /* Notify protocols, that we are about to destroy
5474                    this device. They should clean all the things.
5475                 */
5476                 call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
5477
5478                 if (!dev->rtnl_link_ops ||
5479                     dev->rtnl_link_state == RTNL_LINK_INITIALIZED)
5480                         rtmsg_ifinfo(RTM_DELLINK, dev, ~0U, GFP_KERNEL);
5481
5482                 /*
5483                  *      Flush the unicast and multicast chains
5484                  */
5485                 dev_uc_flush(dev);
5486                 dev_mc_flush(dev);
5487
5488                 if (dev->netdev_ops->ndo_uninit)
5489                         dev->netdev_ops->ndo_uninit(dev);
5490
5491                 /* Notifier chain MUST detach us all upper devices. */
5492                 WARN_ON(netdev_has_any_upper_dev(dev));
5493
5494                 /* Remove entries from kobject tree */
5495                 netdev_unregister_kobject(dev);
5496 #ifdef CONFIG_XPS
5497                 /* Remove XPS queueing entries */
5498                 netif_reset_xps_queues_gt(dev, 0);
5499 #endif
5500         }
5501
5502         synchronize_net();
5503
5504         list_for_each_entry(dev, head, unreg_list)
5505                 dev_put(dev);
5506 }
5507
5508 static void rollback_registered(struct net_device *dev)
5509 {
5510         LIST_HEAD(single);
5511
5512         list_add(&dev->unreg_list, &single);
5513         rollback_registered_many(&single);
5514         list_del(&single);
5515 }
5516
5517 static netdev_features_t netdev_fix_features(struct net_device *dev,
5518         netdev_features_t features)
5519 {
5520         /* Fix illegal checksum combinations */
5521         if ((features & NETIF_F_HW_CSUM) &&
5522             (features & (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM))) {
5523                 netdev_warn(dev, "mixed HW and IP checksum settings.\n");
5524                 features &= ~(NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM);
5525         }
5526
5527         /* TSO requires that SG is present as well. */
5528         if ((features & NETIF_F_ALL_TSO) && !(features & NETIF_F_SG)) {
5529                 netdev_dbg(dev, "Dropping TSO features since no SG feature.\n");
5530                 features &= ~NETIF_F_ALL_TSO;
5531         }
5532
5533         if ((features & NETIF_F_TSO) && !(features & NETIF_F_HW_CSUM) &&
5534                                         !(features & NETIF_F_IP_CSUM)) {
5535                 netdev_dbg(dev, "Dropping TSO features since no CSUM feature.\n");
5536                 features &= ~NETIF_F_TSO;
5537                 features &= ~NETIF_F_TSO_ECN;
5538         }
5539
5540         if ((features & NETIF_F_TSO6) && !(features & NETIF_F_HW_CSUM) &&
5541                                          !(features & NETIF_F_IPV6_CSUM)) {
5542                 netdev_dbg(dev, "Dropping TSO6 features since no CSUM feature.\n");
5543                 features &= ~NETIF_F_TSO6;
5544         }
5545
5546         /* TSO ECN requires that TSO is present as well. */
5547         if ((features & NETIF_F_ALL_TSO) == NETIF_F_TSO_ECN)
5548                 features &= ~NETIF_F_TSO_ECN;
5549
5550         /* Software GSO depends on SG. */
5551         if ((features & NETIF_F_GSO) && !(features & NETIF_F_SG)) {
5552                 netdev_dbg(dev, "Dropping NETIF_F_GSO since no SG feature.\n");
5553                 features &= ~NETIF_F_GSO;
5554         }
5555
5556         /* UFO needs SG and checksumming */
5557         if (features & NETIF_F_UFO) {
5558                 /* maybe split UFO into V4 and V6? */
5559                 if (!((features & NETIF_F_GEN_CSUM) ||
5560                     (features & (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM))
5561                             == (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM))) {
5562                         netdev_dbg(dev,
5563                                 "Dropping NETIF_F_UFO since no checksum offload features.\n");
5564                         features &= ~NETIF_F_UFO;
5565                 }
5566
5567                 if (!(features & NETIF_F_SG)) {
5568                         netdev_dbg(dev,
5569                                 "Dropping NETIF_F_UFO since no NETIF_F_SG feature.\n");
5570                         features &= ~NETIF_F_UFO;
5571                 }
5572         }
5573
5574         return features;
5575 }
5576
5577 int __netdev_update_features(struct net_device *dev)
5578 {
5579         netdev_features_t features;
5580         int err = 0;
5581
5582         ASSERT_RTNL();
5583
5584         features = netdev_get_wanted_features(dev);
5585
5586         if (dev->netdev_ops->ndo_fix_features)
5587                 features = dev->netdev_ops->ndo_fix_features(dev, features);
5588
5589         /* driver might be less strict about feature dependencies */
5590         features = netdev_fix_features(dev, features);
5591
5592         if (dev->features == features)
5593                 return 0;
5594
5595         netdev_dbg(dev, "Features changed: %pNF -> %pNF\n",
5596                 &dev->features, &features);
5597
5598         if (dev->netdev_ops->ndo_set_features)
5599                 err = dev->netdev_ops->ndo_set_features(dev, features);
5600
5601         if (unlikely(err < 0)) {
5602                 netdev_err(dev,
5603                         "set_features() failed (%d); wanted %pNF, left %pNF\n",
5604                         err, &features, &dev->features);
5605                 return -1;
5606         }
5607
5608         if (!err)
5609                 dev->features = features;
5610
5611         return 1;
5612 }
5613
5614 /**
5615  *      netdev_update_features - recalculate device features
5616  *      @dev: the device to check
5617  *
5618  *      Recalculate dev->features set and send notifications if it
5619  *      has changed. Should be called after driver or hardware dependent
5620  *      conditions might have changed that influence the features.
5621  */
5622 void netdev_update_features(struct net_device *dev)
5623 {
5624         if (__netdev_update_features(dev))
5625                 netdev_features_change(dev);
5626 }
5627 EXPORT_SYMBOL(netdev_update_features);
5628
5629 /**
5630  *      netdev_change_features - recalculate device features
5631  *      @dev: the device to check
5632  *
5633  *      Recalculate dev->features set and send notifications even
5634  *      if they have not changed. Should be called instead of
5635  *      netdev_update_features() if also dev->vlan_features might
5636  *      have changed to allow the changes to be propagated to stacked
5637  *      VLAN devices.
5638  */
5639 void netdev_change_features(struct net_device *dev)
5640 {
5641         __netdev_update_features(dev);
5642         netdev_features_change(dev);
5643 }
5644 EXPORT_SYMBOL(netdev_change_features);
5645
5646 /**
5647  *      netif_stacked_transfer_operstate -      transfer operstate
5648  *      @rootdev: the root or lower level device to transfer state from
5649  *      @dev: the device to transfer operstate to
5650  *
5651  *      Transfer operational state from root to device. This is normally
5652  *      called when a stacking relationship exists between the root
5653  *      device and the device(a leaf device).
5654  */
5655 void netif_stacked_transfer_operstate(const struct net_device *rootdev,
5656                                         struct net_device *dev)
5657 {
5658         if (rootdev->operstate == IF_OPER_DORMANT)
5659                 netif_dormant_on(dev);
5660         else
5661                 netif_dormant_off(dev);
5662
5663         if (netif_carrier_ok(rootdev)) {
5664                 if (!netif_carrier_ok(dev))
5665                         netif_carrier_on(dev);
5666         } else {
5667                 if (netif_carrier_ok(dev))
5668                         netif_carrier_off(dev);
5669         }
5670 }
5671 EXPORT_SYMBOL(netif_stacked_transfer_operstate);
5672
5673 #ifdef CONFIG_RPS
5674 static int netif_alloc_rx_queues(struct net_device *dev)
5675 {
5676         unsigned int i, count = dev->num_rx_queues;
5677         struct netdev_rx_queue *rx;
5678
5679         BUG_ON(count < 1);
5680
5681         rx = kcalloc(count, sizeof(struct netdev_rx_queue), GFP_KERNEL);
5682         if (!rx)
5683                 return -ENOMEM;
5684
5685         dev->_rx = rx;
5686
5687         for (i = 0; i < count; i++)
5688                 rx[i].dev = dev;
5689         return 0;
5690 }
5691 #endif
5692
5693 static void netdev_init_one_queue(struct net_device *dev,
5694                                   struct netdev_queue *queue, void *_unused)
5695 {
5696         /* Initialize queue lock */
5697         spin_lock_init(&queue->_xmit_lock);
5698         netdev_set_xmit_lockdep_class(&queue->_xmit_lock, dev->type);
5699         queue->xmit_lock_owner = -1;
5700         netdev_queue_numa_node_write(queue, NUMA_NO_NODE);
5701         queue->dev = dev;
5702 #ifdef CONFIG_BQL
5703         dql_init(&queue->dql, HZ);
5704 #endif
5705 }
5706
5707 static void netif_free_tx_queues(struct net_device *dev)
5708 {
5709         if (is_vmalloc_addr(dev->_tx))
5710                 vfree(dev->_tx);
5711         else
5712                 kfree(dev->_tx);
5713 }
5714
5715 static int netif_alloc_netdev_queues(struct net_device *dev)
5716 {
5717         unsigned int count = dev->num_tx_queues;
5718         struct netdev_queue *tx;
5719         size_t sz = count * sizeof(*tx);
5720
5721         BUG_ON(count < 1 || count > 0xffff);
5722
5723         tx = kzalloc(sz, GFP_KERNEL | __GFP_NOWARN | __GFP_REPEAT);
5724         if (!tx) {
5725                 tx = vzalloc(sz);
5726                 if (!tx)
5727                         return -ENOMEM;
5728         }
5729         dev->_tx = tx;
5730
5731         netdev_for_each_tx_queue(dev, netdev_init_one_queue, NULL);
5732         spin_lock_init(&dev->tx_global_lock);
5733
5734         return 0;
5735 }
5736
5737 /**
5738  *      register_netdevice      - register a network device
5739  *      @dev: device to register
5740  *
5741  *      Take a completed network device structure and add it to the kernel
5742  *      interfaces. A %NETDEV_REGISTER message is sent to the netdev notifier
5743  *      chain. 0 is returned on success. A negative errno code is returned
5744  *      on a failure to set up the device, or if the name is a duplicate.
5745  *
5746  *      Callers must hold the rtnl semaphore. You may want
5747  *      register_netdev() instead of this.
5748  *
5749  *      BUGS:
5750  *      The locking appears insufficient to guarantee two parallel registers
5751  *      will not get the same name.
5752  */
5753
5754 int register_netdevice(struct net_device *dev)
5755 {
5756         int ret;
5757         struct net *net = dev_net(dev);
5758
5759         BUG_ON(dev_boot_phase);
5760         ASSERT_RTNL();
5761
5762         might_sleep();
5763
5764         /* When net_device's are persistent, this will be fatal. */
5765         BUG_ON(dev->reg_state != NETREG_UNINITIALIZED);
5766         BUG_ON(!net);
5767
5768         spin_lock_init(&dev->addr_list_lock);
5769         netdev_set_addr_lockdep_class(dev);
5770
5771         dev->iflink = -1;
5772
5773         ret = dev_get_valid_name(net, dev, dev->name);
5774         if (ret < 0)
5775                 goto out;
5776
5777         /* Init, if this function is available */
5778         if (dev->netdev_ops->ndo_init) {
5779                 ret = dev->netdev_ops->ndo_init(dev);
5780                 if (ret) {
5781                         if (ret > 0)
5782                                 ret = -EIO;
5783                         goto out;
5784                 }
5785         }
5786
5787         if (((dev->hw_features | dev->features) &
5788              NETIF_F_HW_VLAN_CTAG_FILTER) &&
5789             (!dev->netdev_ops->ndo_vlan_rx_add_vid ||
5790              !dev->netdev_ops->ndo_vlan_rx_kill_vid)) {
5791                 netdev_WARN(dev, "Buggy VLAN acceleration in driver!\n");
5792                 ret = -EINVAL;
5793                 goto err_uninit;
5794         }
5795
5796         ret = -EBUSY;
5797         if (!dev->ifindex)
5798                 dev->ifindex = dev_new_index(net);
5799         else if (__dev_get_by_index(net, dev->ifindex))
5800                 goto err_uninit;
5801
5802         if (dev->iflink == -1)
5803                 dev->iflink = dev->ifindex;
5804
5805         /* Transfer changeable features to wanted_features and enable
5806          * software offloads (GSO and GRO).
5807          */
5808         dev->hw_features |= NETIF_F_SOFT_FEATURES;
5809         dev->features |= NETIF_F_SOFT_FEATURES;
5810         dev->wanted_features = dev->features & dev->hw_features;
5811
5812         if (!(dev->flags & IFF_LOOPBACK)) {
5813                 dev->hw_features |= NETIF_F_NOCACHE_COPY;
5814         }
5815
5816         /* Make NETIF_F_HIGHDMA inheritable to VLAN devices.
5817          */
5818         dev->vlan_features |= NETIF_F_HIGHDMA;
5819
5820         /* Make NETIF_F_SG inheritable to tunnel devices.
5821          */
5822         dev->hw_enc_features |= NETIF_F_SG;
5823
5824         /* Make NETIF_F_SG inheritable to MPLS.
5825          */
5826         dev->mpls_features |= NETIF_F_SG;
5827
5828         ret = call_netdevice_notifiers(NETDEV_POST_INIT, dev);
5829         ret = notifier_to_errno(ret);
5830         if (ret)
5831                 goto err_uninit;
5832
5833         ret = netdev_register_kobject(dev);
5834         if (ret)
5835                 goto err_uninit;
5836         dev->reg_state = NETREG_REGISTERED;
5837
5838         __netdev_update_features(dev);
5839
5840         /*
5841          *      Default initial state at registry is that the
5842          *      device is present.
5843          */
5844
5845         set_bit(__LINK_STATE_PRESENT, &dev->state);
5846
5847         linkwatch_init_dev(dev);
5848
5849         dev_init_scheduler(dev);
5850         dev_hold(dev);
5851         list_netdevice(dev);
5852         add_device_randomness(dev->dev_addr, dev->addr_len);
5853
5854         /* If the device has permanent device address, driver should
5855          * set dev_addr and also addr_assign_type should be set to
5856          * NET_ADDR_PERM (default value).
5857          */
5858         if (dev->addr_assign_type == NET_ADDR_PERM)
5859                 memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
5860
5861         /* Notify protocols, that a new device appeared. */
5862         ret = call_netdevice_notifiers(NETDEV_REGISTER, dev);
5863         ret = notifier_to_errno(ret);
5864         if (ret) {
5865                 rollback_registered(dev);
5866                 dev->reg_state = NETREG_UNREGISTERED;
5867         }
5868         /*
5869          *      Prevent userspace races by waiting until the network
5870          *      device is fully setup before sending notifications.
5871          */
5872         if (!dev->rtnl_link_ops ||
5873             dev->rtnl_link_state == RTNL_LINK_INITIALIZED)
5874                 rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U, GFP_KERNEL);
5875
5876 out:
5877         return ret;
5878
5879 err_uninit:
5880         if (dev->netdev_ops->ndo_uninit)
5881                 dev->netdev_ops->ndo_uninit(dev);
5882         goto out;
5883 }
5884 EXPORT_SYMBOL(register_netdevice);
5885
5886 /**
5887  *      init_dummy_netdev       - init a dummy network device for NAPI
5888  *      @dev: device to init
5889  *
5890  *      This takes a network device structure and initialize the minimum
5891  *      amount of fields so it can be used to schedule NAPI polls without
5892  *      registering a full blown interface. This is to be used by drivers
5893  *      that need to tie several hardware interfaces to a single NAPI
5894  *      poll scheduler due to HW limitations.
5895  */
5896 int init_dummy_netdev(struct net_device *dev)
5897 {
5898         /* Clear everything. Note we don't initialize spinlocks
5899          * are they aren't supposed to be taken by any of the
5900          * NAPI code and this dummy netdev is supposed to be
5901          * only ever used for NAPI polls
5902          */
5903         memset(dev, 0, sizeof(struct net_device));
5904
5905         /* make sure we BUG if trying to hit standard
5906          * register/unregister code path
5907          */
5908         dev->reg_state = NETREG_DUMMY;
5909
5910         /* NAPI wants this */
5911         INIT_LIST_HEAD(&dev->napi_list);
5912
5913         /* a dummy interface is started by default */
5914         set_bit(__LINK_STATE_PRESENT, &dev->state);
5915         set_bit(__LINK_STATE_START, &dev->state);
5916
5917         /* Note : We dont allocate pcpu_refcnt for dummy devices,
5918          * because users of this 'device' dont need to change
5919          * its refcount.
5920          */
5921
5922         return 0;
5923 }
5924 EXPORT_SYMBOL_GPL(init_dummy_netdev);
5925
5926
5927 /**
5928  *      register_netdev - register a network device
5929  *      @dev: device to register
5930  *
5931  *      Take a completed network device structure and add it to the kernel
5932  *      interfaces. A %NETDEV_REGISTER message is sent to the netdev notifier
5933  *      chain. 0 is returned on success. A negative errno code is returned
5934  *      on a failure to set up the device, or if the name is a duplicate.
5935  *
5936  *      This is a wrapper around register_netdevice that takes the rtnl semaphore
5937  *      and expands the device name if you passed a format string to
5938  *      alloc_netdev.
5939  */
5940 int register_netdev(struct net_device *dev)
5941 {
5942         int err;
5943
5944         rtnl_lock();
5945         err = register_netdevice(dev);
5946         rtnl_unlock();
5947         return err;
5948 }
5949 EXPORT_SYMBOL(register_netdev);
5950
5951 int netdev_refcnt_read(const struct net_device *dev)
5952 {
5953         int i, refcnt = 0;
5954
5955         for_each_possible_cpu(i)
5956                 refcnt += *per_cpu_ptr(dev->pcpu_refcnt, i);
5957         return refcnt;
5958 }
5959 EXPORT_SYMBOL(netdev_refcnt_read);
5960
5961 /**
5962  * netdev_wait_allrefs - wait until all references are gone.
5963  * @dev: target net_device
5964  *
5965  * This is called when unregistering network devices.
5966  *
5967  * Any protocol or device that holds a reference should register
5968  * for netdevice notification, and cleanup and put back the
5969  * reference if they receive an UNREGISTER event.
5970  * We can get stuck here if buggy protocols don't correctly
5971  * call dev_put.
5972  */
5973 static void netdev_wait_allrefs(struct net_device *dev)
5974 {
5975         unsigned long rebroadcast_time, warning_time;
5976         int refcnt;
5977
5978         linkwatch_forget_dev(dev);
5979
5980         rebroadcast_time = warning_time = jiffies;
5981         refcnt = netdev_refcnt_read(dev);
5982
5983         while (refcnt != 0) {
5984                 if (time_after(jiffies, rebroadcast_time + 1 * HZ)) {
5985                         rtnl_lock();
5986
5987                         /* Rebroadcast unregister notification */
5988                         call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
5989
5990                         __rtnl_unlock();
5991                         rcu_barrier();
5992                         rtnl_lock();
5993
5994                         call_netdevice_notifiers(NETDEV_UNREGISTER_FINAL, dev);
5995                         if (test_bit(__LINK_STATE_LINKWATCH_PENDING,
5996                                      &dev->state)) {
5997                                 /* We must not have linkwatch events
5998                                  * pending on unregister. If this
5999                                  * happens, we simply run the queue
6000                                  * unscheduled, resulting in a noop
6001                                  * for this device.
6002                                  */
6003                                 linkwatch_run_queue();
6004                         }
6005
6006                         __rtnl_unlock();
6007
6008                         rebroadcast_time = jiffies;
6009                 }
6010
6011                 msleep(250);
6012
6013                 refcnt = netdev_refcnt_read(dev);
6014
6015                 if (time_after(jiffies, warning_time + 10 * HZ)) {
6016                         pr_emerg("unregister_netdevice: waiting for %s to become free. Usage count = %d\n",
6017                                  dev->name, refcnt);
6018                         warning_time = jiffies;
6019                 }
6020         }
6021 }
6022
6023 /* The sequence is:
6024  *
6025  *      rtnl_lock();
6026  *      ...
6027  *      register_netdevice(x1);
6028  *      register_netdevice(x2);
6029  *      ...
6030  *      unregister_netdevice(y1);
6031  *      unregister_netdevice(y2);
6032  *      ...
6033  *      rtnl_unlock();
6034  *      free_netdev(y1);
6035  *      free_netdev(y2);
6036  *
6037  * We are invoked by rtnl_unlock().
6038  * This allows us to deal with problems:
6039  * 1) We can delete sysfs objects which invoke hotplug
6040  *    without deadlocking with linkwatch via keventd.
6041  * 2) Since we run with the RTNL semaphore not held, we can sleep
6042  *    safely in order to wait for the netdev refcnt to drop to zero.
6043  *
6044  * We must not return until all unregister events added during
6045  * the interval the lock was held have been completed.
6046  */
6047 void netdev_run_todo(void)
6048 {
6049         struct list_head list;
6050
6051         /* Snapshot list, allow later requests */
6052         list_replace_init(&net_todo_list, &list);
6053
6054         __rtnl_unlock();
6055
6056
6057         /* Wait for rcu callbacks to finish before next phase */
6058         if (!list_empty(&list))
6059                 rcu_barrier();
6060
6061         while (!list_empty(&list)) {
6062                 struct net_device *dev
6063                         = list_first_entry(&list, struct net_device, todo_list);
6064                 list_del(&dev->todo_list);
6065
6066                 rtnl_lock();
6067                 call_netdevice_notifiers(NETDEV_UNREGISTER_FINAL, dev);
6068                 __rtnl_unlock();
6069
6070                 if (unlikely(dev->reg_state != NETREG_UNREGISTERING)) {
6071                         pr_err("network todo '%s' but state %d\n",
6072                                dev->name, dev->reg_state);
6073                         dump_stack();
6074                         continue;
6075                 }
6076
6077                 dev->reg_state = NETREG_UNREGISTERED;
6078
6079                 on_each_cpu(flush_backlog, dev, 1);
6080
6081                 netdev_wait_allrefs(dev);
6082
6083                 /* paranoia */
6084                 BUG_ON(netdev_refcnt_read(dev));
6085                 WARN_ON(rcu_access_pointer(dev->ip_ptr));
6086                 WARN_ON(rcu_access_pointer(dev->ip6_ptr));
6087                 WARN_ON(dev->dn_ptr);
6088
6089                 if (dev->destructor)
6090                         dev->destructor(dev);
6091
6092                 /* Report a network device has been unregistered */
6093                 rtnl_lock();
6094                 dev_net(dev)->dev_unreg_count--;
6095                 __rtnl_unlock();
6096                 wake_up(&netdev_unregistering_wq);
6097
6098                 /* Free network device */
6099                 kobject_put(&dev->dev.kobj);
6100         }
6101 }
6102
6103 /* Convert net_device_stats to rtnl_link_stats64.  They have the same
6104  * fields in the same order, with only the type differing.
6105  */
6106 void netdev_stats_to_stats64(struct rtnl_link_stats64 *stats64,
6107                              const struct net_device_stats *netdev_stats)
6108 {
6109 #if BITS_PER_LONG == 64
6110         BUILD_BUG_ON(sizeof(*stats64) != sizeof(*netdev_stats));
6111         memcpy(stats64, netdev_stats, sizeof(*stats64));
6112 #else
6113         size_t i, n = sizeof(*stats64) / sizeof(u64);
6114         const unsigned long *src = (const unsigned long *)netdev_stats;
6115         u64 *dst = (u64 *)stats64;
6116
6117         BUILD_BUG_ON(sizeof(*netdev_stats) / sizeof(unsigned long) !=
6118                      sizeof(*stats64) / sizeof(u64));
6119         for (i = 0; i < n; i++)
6120                 dst[i] = src[i];
6121 #endif
6122 }
6123 EXPORT_SYMBOL(netdev_stats_to_stats64);
6124
6125 /**
6126  *      dev_get_stats   - get network device statistics
6127  *      @dev: device to get statistics from
6128  *      @storage: place to store stats
6129  *
6130  *      Get network statistics from device. Return @storage.
6131  *      The device driver may provide its own method by setting
6132  *      dev->netdev_ops->get_stats64 or dev->netdev_ops->get_stats;
6133  *      otherwise the internal statistics structure is used.
6134  */
6135 struct rtnl_link_stats64 *dev_get_stats(struct net_device *dev,
6136                                         struct rtnl_link_stats64 *storage)
6137 {
6138         const struct net_device_ops *ops = dev->netdev_ops;
6139
6140         if (ops->ndo_get_stats64) {
6141                 memset(storage, 0, sizeof(*storage));
6142                 ops->ndo_get_stats64(dev, storage);
6143         } else if (ops->ndo_get_stats) {
6144                 netdev_stats_to_stats64(storage, ops->ndo_get_stats(dev));
6145         } else {
6146                 netdev_stats_to_stats64(storage, &dev->stats);
6147         }
6148         storage->rx_dropped += atomic_long_read(&dev->rx_dropped);
6149         return storage;
6150 }
6151 EXPORT_SYMBOL(dev_get_stats);
6152
6153 struct netdev_queue *dev_ingress_queue_create(struct net_device *dev)
6154 {
6155         struct netdev_queue *queue = dev_ingress_queue(dev);
6156
6157 #ifdef CONFIG_NET_CLS_ACT
6158         if (queue)
6159                 return queue;
6160         queue = kzalloc(sizeof(*queue), GFP_KERNEL);
6161         if (!queue)
6162                 return NULL;
6163         netdev_init_one_queue(dev, queue, NULL);
6164         queue->qdisc = &noop_qdisc;
6165         queue->qdisc_sleeping = &noop_qdisc;
6166         rcu_assign_pointer(dev->ingress_queue, queue);
6167 #endif
6168         return queue;
6169 }
6170
6171 static const struct ethtool_ops default_ethtool_ops;
6172
6173 void netdev_set_default_ethtool_ops(struct net_device *dev,
6174                                     const struct ethtool_ops *ops)
6175 {
6176         if (dev->ethtool_ops == &default_ethtool_ops)
6177                 dev->ethtool_ops = ops;
6178 }
6179 EXPORT_SYMBOL_GPL(netdev_set_default_ethtool_ops);
6180
6181 void netdev_freemem(struct net_device *dev)
6182 {
6183         char *addr = (char *)dev - dev->padded;
6184
6185         if (is_vmalloc_addr(addr))
6186                 vfree(addr);
6187         else
6188                 kfree(addr);
6189 }
6190
6191 /**
6192  *      alloc_netdev_mqs - allocate network device
6193  *      @sizeof_priv:   size of private data to allocate space for
6194  *      @name:          device name format string
6195  *      @setup:         callback to initialize device
6196  *      @txqs:          the number of TX subqueues to allocate
6197  *      @rxqs:          the number of RX subqueues to allocate
6198  *
6199  *      Allocates a struct net_device with private data area for driver use
6200  *      and performs basic initialization.  Also allocates subquue structs
6201  *      for each queue on the device.
6202  */
6203 struct net_device *alloc_netdev_mqs(int sizeof_priv, const char *name,
6204                 void (*setup)(struct net_device *),
6205                 unsigned int txqs, unsigned int rxqs)
6206 {
6207         struct net_device *dev;
6208         size_t alloc_size;
6209         struct net_device *p;
6210
6211         BUG_ON(strlen(name) >= sizeof(dev->name));
6212
6213         if (txqs < 1) {
6214                 pr_err("alloc_netdev: Unable to allocate device with zero queues\n");
6215                 return NULL;
6216         }
6217
6218 #ifdef CONFIG_RPS
6219         if (rxqs < 1) {
6220                 pr_err("alloc_netdev: Unable to allocate device with zero RX queues\n");
6221                 return NULL;
6222         }
6223 #endif
6224
6225         alloc_size = sizeof(struct net_device);
6226         if (sizeof_priv) {
6227                 /* ensure 32-byte alignment of private area */
6228                 alloc_size = ALIGN(alloc_size, NETDEV_ALIGN);
6229                 alloc_size += sizeof_priv;
6230         }
6231         /* ensure 32-byte alignment of whole construct */
6232         alloc_size += NETDEV_ALIGN - 1;
6233
6234         p = kzalloc(alloc_size, GFP_KERNEL | __GFP_NOWARN | __GFP_REPEAT);
6235         if (!p)
6236                 p = vzalloc(alloc_size);
6237         if (!p)
6238                 return NULL;
6239
6240         dev = PTR_ALIGN(p, NETDEV_ALIGN);
6241         dev->padded = (char *)dev - (char *)p;
6242
6243         dev->pcpu_refcnt = alloc_percpu(int);
6244         if (!dev->pcpu_refcnt)
6245                 goto free_dev;
6246
6247         if (dev_addr_init(dev))
6248                 goto free_pcpu;
6249
6250         dev_mc_init(dev);
6251         dev_uc_init(dev);
6252
6253         dev_net_set(dev, &init_net);
6254
6255         dev->gso_max_size = GSO_MAX_SIZE;
6256         dev->gso_max_segs = GSO_MAX_SEGS;
6257
6258         INIT_LIST_HEAD(&dev->napi_list);
6259         INIT_LIST_HEAD(&dev->unreg_list);
6260         INIT_LIST_HEAD(&dev->close_list);
6261         INIT_LIST_HEAD(&dev->link_watch_list);
6262         INIT_LIST_HEAD(&dev->adj_list.upper);
6263         INIT_LIST_HEAD(&dev->adj_list.lower);
6264         INIT_LIST_HEAD(&dev->all_adj_list.upper);
6265         INIT_LIST_HEAD(&dev->all_adj_list.lower);
6266         dev->priv_flags = IFF_XMIT_DST_RELEASE;
6267         setup(dev);
6268
6269         dev->num_tx_queues = txqs;
6270         dev->real_num_tx_queues = txqs;
6271         if (netif_alloc_netdev_queues(dev))
6272                 goto free_all;
6273
6274 #ifdef CONFIG_RPS
6275         dev->num_rx_queues = rxqs;
6276         dev->real_num_rx_queues = rxqs;
6277         if (netif_alloc_rx_queues(dev))
6278                 goto free_all;
6279 #endif
6280
6281         strcpy(dev->name, name);
6282         dev->group = INIT_NETDEV_GROUP;
6283         if (!dev->ethtool_ops)
6284                 dev->ethtool_ops = &default_ethtool_ops;
6285         return dev;
6286
6287 free_all:
6288         free_netdev(dev);
6289         return NULL;
6290
6291 free_pcpu:
6292         free_percpu(dev->pcpu_refcnt);
6293         netif_free_tx_queues(dev);
6294 #ifdef CONFIG_RPS
6295         kfree(dev->_rx);
6296 #endif
6297
6298 free_dev:
6299         netdev_freemem(dev);
6300         return NULL;
6301 }
6302 EXPORT_SYMBOL(alloc_netdev_mqs);
6303
6304 /**
6305  *      free_netdev - free network device
6306  *      @dev: device
6307  *
6308  *      This function does the last stage of destroying an allocated device
6309  *      interface. The reference to the device object is released.
6310  *      If this is the last reference then it will be freed.
6311  */
6312 void free_netdev(struct net_device *dev)
6313 {
6314         struct napi_struct *p, *n;
6315
6316         release_net(dev_net(dev));
6317
6318         netif_free_tx_queues(dev);
6319 #ifdef CONFIG_RPS
6320         kfree(dev->_rx);
6321 #endif
6322
6323         kfree(rcu_dereference_protected(dev->ingress_queue, 1));
6324
6325         /* Flush device addresses */
6326         dev_addr_flush(dev);
6327
6328         list_for_each_entry_safe(p, n, &dev->napi_list, dev_list)
6329                 netif_napi_del(p);
6330
6331         free_percpu(dev->pcpu_refcnt);
6332         dev->pcpu_refcnt = NULL;
6333
6334         /*  Compatibility with error handling in drivers */
6335         if (dev->reg_state == NETREG_UNINITIALIZED) {
6336                 netdev_freemem(dev);
6337                 return;
6338         }
6339
6340         BUG_ON(dev->reg_state != NETREG_UNREGISTERED);
6341         dev->reg_state = NETREG_RELEASED;
6342
6343         /* will free via device release */
6344         put_device(&dev->dev);
6345 }
6346 EXPORT_SYMBOL(free_netdev);
6347
6348 /**
6349  *      synchronize_net -  Synchronize with packet receive processing
6350  *
6351  *      Wait for packets currently being received to be done.
6352  *      Does not block later packets from starting.
6353  */
6354 void synchronize_net(void)
6355 {
6356         might_sleep();
6357         if (rtnl_is_locked())
6358                 synchronize_rcu_expedited();
6359         else
6360                 synchronize_rcu();
6361 }
6362 EXPORT_SYMBOL(synchronize_net);
6363
6364 /**
6365  *      unregister_netdevice_queue - remove device from the kernel
6366  *      @dev: device
6367  *      @head: list
6368  *
6369  *      This function shuts down a device interface and removes it
6370  *      from the kernel tables.
6371  *      If head not NULL, device is queued to be unregistered later.
6372  *
6373  *      Callers must hold the rtnl semaphore.  You may want
6374  *      unregister_netdev() instead of this.
6375  */
6376
6377 void unregister_netdevice_queue(struct net_device *dev, struct list_head *head)
6378 {
6379         ASSERT_RTNL();
6380
6381         if (head) {
6382                 list_move_tail(&dev->unreg_list, head);
6383         } else {
6384                 rollback_registered(dev);
6385                 /* Finish processing unregister after unlock */
6386                 net_set_todo(dev);
6387         }
6388 }
6389 EXPORT_SYMBOL(unregister_netdevice_queue);
6390
6391 /**
6392  *      unregister_netdevice_many - unregister many devices
6393  *      @head: list of devices
6394  */
6395 void unregister_netdevice_many(struct list_head *head)
6396 {
6397         struct net_device *dev;
6398
6399         if (!list_empty(head)) {
6400                 rollback_registered_many(head);
6401                 list_for_each_entry(dev, head, unreg_list)
6402                         net_set_todo(dev);
6403         }
6404 }
6405 EXPORT_SYMBOL(unregister_netdevice_many);
6406
6407 /**
6408  *      unregister_netdev - remove device from the kernel
6409  *      @dev: device
6410  *
6411  *      This function shuts down a device interface and removes it
6412  *      from the kernel tables.
6413  *
6414  *      This is just a wrapper for unregister_netdevice that takes
6415  *      the rtnl semaphore.  In general you want to use this and not
6416  *      unregister_netdevice.
6417  */
6418 void unregister_netdev(struct net_device *dev)
6419 {
6420         rtnl_lock();
6421         unregister_netdevice(dev);
6422         rtnl_unlock();
6423 }
6424 EXPORT_SYMBOL(unregister_netdev);
6425
6426 /**
6427  *      dev_change_net_namespace - move device to different nethost namespace
6428  *      @dev: device
6429  *      @net: network namespace
6430  *      @pat: If not NULL name pattern to try if the current device name
6431  *            is already taken in the destination network namespace.
6432  *
6433  *      This function shuts down a device interface and moves it
6434  *      to a new network namespace. On success 0 is returned, on
6435  *      a failure a netagive errno code is returned.
6436  *
6437  *      Callers must hold the rtnl semaphore.
6438  */
6439
6440 int dev_change_net_namespace(struct net_device *dev, struct net *net, const char *pat)
6441 {
6442         int err;
6443
6444         ASSERT_RTNL();
6445
6446         /* Don't allow namespace local devices to be moved. */
6447         err = -EINVAL;
6448         if (dev->features & NETIF_F_NETNS_LOCAL)
6449                 goto out;
6450
6451         /* Ensure the device has been registrered */
6452         if (dev->reg_state != NETREG_REGISTERED)
6453                 goto out;
6454
6455         /* Get out if there is nothing todo */
6456         err = 0;
6457         if (net_eq(dev_net(dev), net))
6458                 goto out;
6459
6460         /* Pick the destination device name, and ensure
6461          * we can use it in the destination network namespace.
6462          */
6463         err = -EEXIST;
6464         if (__dev_get_by_name(net, dev->name)) {
6465                 /* We get here if we can't use the current device name */
6466                 if (!pat)
6467                         goto out;
6468                 if (dev_get_valid_name(net, dev, pat) < 0)
6469                         goto out;
6470         }
6471
6472         /*
6473          * And now a mini version of register_netdevice unregister_netdevice.
6474          */
6475
6476         /* If device is running close it first. */
6477         dev_close(dev);
6478
6479         /* And unlink it from device chain */
6480         err = -ENODEV;
6481         unlist_netdevice(dev);
6482
6483         synchronize_net();
6484
6485         /* Shutdown queueing discipline. */
6486         dev_shutdown(dev);
6487
6488         /* Notify protocols, that we are about to destroy
6489            this device. They should clean all the things.
6490
6491            Note that dev->reg_state stays at NETREG_REGISTERED.
6492            This is wanted because this way 8021q and macvlan know
6493            the device is just moving and can keep their slaves up.
6494         */
6495         call_netdevice_notifiers(NETDEV_UNREGISTER, dev);
6496         rcu_barrier();
6497         call_netdevice_notifiers(NETDEV_UNREGISTER_FINAL, dev);
6498         rtmsg_ifinfo(RTM_DELLINK, dev, ~0U, GFP_KERNEL);
6499
6500         /*
6501          *      Flush the unicast and multicast chains
6502          */
6503         dev_uc_flush(dev);
6504         dev_mc_flush(dev);
6505
6506         /* Send a netdev-removed uevent to the old namespace */
6507         kobject_uevent(&dev->dev.kobj, KOBJ_REMOVE);
6508
6509         /* Actually switch the network namespace */
6510         dev_net_set(dev, net);
6511
6512         /* If there is an ifindex conflict assign a new one */
6513         if (__dev_get_by_index(net, dev->ifindex)) {
6514                 int iflink = (dev->iflink == dev->ifindex);
6515                 dev->ifindex = dev_new_index(net);
6516                 if (iflink)
6517                         dev->iflink = dev->ifindex;
6518         }
6519
6520         /* Send a netdev-add uevent to the new namespace */
6521         kobject_uevent(&dev->dev.kobj, KOBJ_ADD);
6522
6523         /* Fixup kobjects */
6524         err = device_rename(&dev->dev, dev->name);
6525         WARN_ON(err);
6526
6527         /* Add the device back in the hashes */
6528         list_netdevice(dev);
6529
6530         /* Notify protocols, that a new device appeared. */
6531         call_netdevice_notifiers(NETDEV_REGISTER, dev);
6532
6533         /*
6534          *      Prevent userspace races by waiting until the network
6535          *      device is fully setup before sending notifications.
6536          */
6537         rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U, GFP_KERNEL);
6538
6539         synchronize_net();
6540         err = 0;
6541 out:
6542         return err;
6543 }
6544 EXPORT_SYMBOL_GPL(dev_change_net_namespace);
6545
6546 static int dev_cpu_callback(struct notifier_block *nfb,
6547                             unsigned long action,
6548                             void *ocpu)
6549 {
6550         struct sk_buff **list_skb;
6551         struct sk_buff *skb;
6552         unsigned int cpu, oldcpu = (unsigned long)ocpu;
6553         struct softnet_data *sd, *oldsd;
6554
6555         if (action != CPU_DEAD && action != CPU_DEAD_FROZEN)
6556                 return NOTIFY_OK;
6557
6558         local_irq_disable();
6559         cpu = smp_processor_id();
6560         sd = &per_cpu(softnet_data, cpu);
6561         oldsd = &per_cpu(softnet_data, oldcpu);
6562
6563         /* Find end of our completion_queue. */
6564         list_skb = &sd->completion_queue;
6565         while (*list_skb)
6566                 list_skb = &(*list_skb)->next;
6567         /* Append completion queue from offline CPU. */
6568         *list_skb = oldsd->completion_queue;
6569         oldsd->completion_queue = NULL;
6570
6571         /* Append output queue from offline CPU. */
6572         if (oldsd->output_queue) {
6573                 *sd->output_queue_tailp = oldsd->output_queue;
6574                 sd->output_queue_tailp = oldsd->output_queue_tailp;
6575                 oldsd->output_queue = NULL;
6576                 oldsd->output_queue_tailp = &oldsd->output_queue;
6577         }
6578         /* Append NAPI poll list from offline CPU. */
6579         if (!list_empty(&oldsd->poll_list)) {
6580                 list_splice_init(&oldsd->poll_list, &sd->poll_list);
6581                 raise_softirq_irqoff(NET_RX_SOFTIRQ);
6582         }
6583
6584         raise_softirq_irqoff(NET_TX_SOFTIRQ);
6585         local_irq_enable();
6586
6587         /* Process offline CPU's input_pkt_queue */
6588         while ((skb = __skb_dequeue(&oldsd->process_queue))) {
6589                 netif_rx(skb);
6590                 input_queue_head_incr(oldsd);
6591         }
6592         while ((skb = __skb_dequeue(&oldsd->input_pkt_queue))) {
6593                 netif_rx(skb);
6594                 input_queue_head_incr(oldsd);
6595         }
6596
6597         return NOTIFY_OK;
6598 }
6599
6600
6601 /**
6602  *      netdev_increment_features - increment feature set by one
6603  *      @all: current feature set
6604  *      @one: new feature set
6605  *      @mask: mask feature set
6606  *
6607  *      Computes a new feature set after adding a device with feature set
6608  *      @one to the master device with current feature set @all.  Will not
6609  *      enable anything that is off in @mask. Returns the new feature set.
6610  */
6611 netdev_features_t netdev_increment_features(netdev_features_t all,
6612         netdev_features_t one, netdev_features_t mask)
6613 {
6614         if (mask & NETIF_F_GEN_CSUM)
6615                 mask |= NETIF_F_ALL_CSUM;
6616         mask |= NETIF_F_VLAN_CHALLENGED;
6617
6618         all |= one & (NETIF_F_ONE_FOR_ALL|NETIF_F_ALL_CSUM) & mask;
6619         all &= one | ~NETIF_F_ALL_FOR_ALL;
6620
6621         /* If one device supports hw checksumming, set for all. */
6622         if (all & NETIF_F_GEN_CSUM)
6623                 all &= ~(NETIF_F_ALL_CSUM & ~NETIF_F_GEN_CSUM);
6624
6625         return all;
6626 }
6627 EXPORT_SYMBOL(netdev_increment_features);
6628
6629 static struct hlist_head * __net_init netdev_create_hash(void)
6630 {
6631         int i;
6632         struct hlist_head *hash;
6633
6634         hash = kmalloc(sizeof(*hash) * NETDEV_HASHENTRIES, GFP_KERNEL);
6635         if (hash != NULL)
6636                 for (i = 0; i < NETDEV_HASHENTRIES; i++)
6637                         INIT_HLIST_HEAD(&hash[i]);
6638
6639         return hash;
6640 }
6641
6642 /* Initialize per network namespace state */
6643 static int __net_init netdev_init(struct net *net)
6644 {
6645         if (net != &init_net)
6646                 INIT_LIST_HEAD(&net->dev_base_head);
6647
6648         net->dev_name_head = netdev_create_hash();
6649         if (net->dev_name_head == NULL)
6650                 goto err_name;
6651
6652         net->dev_index_head = netdev_create_hash();
6653         if (net->dev_index_head == NULL)
6654                 goto err_idx;
6655
6656         return 0;
6657
6658 err_idx:
6659         kfree(net->dev_name_head);
6660 err_name:
6661         return -ENOMEM;
6662 }
6663
6664 /**
6665  *      netdev_drivername - network driver for the device
6666  *      @dev: network device
6667  *
6668  *      Determine network driver for device.
6669  */
6670 const char *netdev_drivername(const struct net_device *dev)
6671 {
6672         const struct device_driver *driver;
6673         const struct device *parent;
6674         const char *empty = "";
6675
6676         parent = dev->dev.parent;
6677         if (!parent)
6678                 return empty;
6679
6680         driver = parent->driver;
6681         if (driver && driver->name)
6682                 return driver->name;
6683         return empty;
6684 }
6685
6686 static int __netdev_printk(const char *level, const struct net_device *dev,
6687                            struct va_format *vaf)
6688 {
6689         int r;
6690
6691         if (dev && dev->dev.parent) {
6692                 r = dev_printk_emit(level[1] - '0',
6693                                     dev->dev.parent,
6694                                     "%s %s %s: %pV",
6695                                     dev_driver_string(dev->dev.parent),
6696                                     dev_name(dev->dev.parent),
6697                                     netdev_name(dev), vaf);
6698         } else if (dev) {
6699                 r = printk("%s%s: %pV", level, netdev_name(dev), vaf);
6700         } else {
6701                 r = printk("%s(NULL net_device): %pV", level, vaf);
6702         }
6703
6704         return r;
6705 }
6706
6707 int netdev_printk(const char *level, const struct net_device *dev,
6708                   const char *format, ...)
6709 {
6710         struct va_format vaf;
6711         va_list args;
6712         int r;
6713
6714         va_start(args, format);
6715
6716         vaf.fmt = format;
6717         vaf.va = &args;
6718
6719         r = __netdev_printk(level, dev, &vaf);
6720
6721         va_end(args);
6722
6723         return r;
6724 }
6725 EXPORT_SYMBOL(netdev_printk);
6726
6727 #define define_netdev_printk_level(func, level)                 \
6728 int func(const struct net_device *dev, const char *fmt, ...)    \
6729 {                                                               \
6730         int r;                                                  \
6731         struct va_format vaf;                                   \
6732         va_list args;                                           \
6733                                                                 \
6734         va_start(args, fmt);                                    \
6735                                                                 \
6736         vaf.fmt = fmt;                                          \
6737         vaf.va = &args;                                         \
6738                                                                 \
6739         r = __netdev_printk(level, dev, &vaf);                  \
6740                                                                 \
6741         va_end(args);                                           \
6742                                                                 \
6743         return r;                                               \
6744 }                                                               \
6745 EXPORT_SYMBOL(func);
6746
6747 define_netdev_printk_level(netdev_emerg, KERN_EMERG);
6748 define_netdev_printk_level(netdev_alert, KERN_ALERT);
6749 define_netdev_printk_level(netdev_crit, KERN_CRIT);
6750 define_netdev_printk_level(netdev_err, KERN_ERR);
6751 define_netdev_printk_level(netdev_warn, KERN_WARNING);
6752 define_netdev_printk_level(netdev_notice, KERN_NOTICE);
6753 define_netdev_printk_level(netdev_info, KERN_INFO);
6754
6755 static void __net_exit netdev_exit(struct net *net)
6756 {
6757         kfree(net->dev_name_head);
6758         kfree(net->dev_index_head);
6759 }
6760
6761 static struct pernet_operations __net_initdata netdev_net_ops = {
6762         .init = netdev_init,
6763         .exit = netdev_exit,
6764 };
6765
6766 static void __net_exit default_device_exit(struct net *net)
6767 {
6768         struct net_device *dev, *aux;
6769         /*
6770          * Push all migratable network devices back to the
6771          * initial network namespace
6772          */
6773         rtnl_lock();
6774         for_each_netdev_safe(net, dev, aux) {
6775                 int err;
6776                 char fb_name[IFNAMSIZ];
6777
6778                 /* Ignore unmoveable devices (i.e. loopback) */
6779                 if (dev->features & NETIF_F_NETNS_LOCAL)
6780                         continue;
6781
6782                 /* Leave virtual devices for the generic cleanup */
6783                 if (dev->rtnl_link_ops)
6784                         continue;
6785
6786                 /* Push remaining network devices to init_net */
6787                 snprintf(fb_name, IFNAMSIZ, "dev%d", dev->ifindex);
6788                 err = dev_change_net_namespace(dev, &init_net, fb_name);
6789                 if (err) {
6790                         pr_emerg("%s: failed to move %s to init_net: %d\n",
6791                                  __func__, dev->name, err);
6792                         BUG();
6793                 }
6794         }
6795         rtnl_unlock();
6796 }
6797
6798 static void __net_exit rtnl_lock_unregistering(struct list_head *net_list)
6799 {
6800         /* Return with the rtnl_lock held when there are no network
6801          * devices unregistering in any network namespace in net_list.
6802          */
6803         struct net *net;
6804         bool unregistering;
6805         DEFINE_WAIT(wait);
6806
6807         for (;;) {
6808                 prepare_to_wait(&netdev_unregistering_wq, &wait,
6809                                 TASK_UNINTERRUPTIBLE);
6810                 unregistering = false;
6811                 rtnl_lock();
6812                 list_for_each_entry(net, net_list, exit_list) {
6813                         if (net->dev_unreg_count > 0) {
6814                                 unregistering = true;
6815                                 break;
6816                         }
6817                 }
6818                 if (!unregistering)
6819                         break;
6820                 __rtnl_unlock();
6821                 schedule();
6822         }
6823         finish_wait(&netdev_unregistering_wq, &wait);
6824 }
6825
6826 static void __net_exit default_device_exit_batch(struct list_head *net_list)
6827 {
6828         /* At exit all network devices most be removed from a network
6829          * namespace.  Do this in the reverse order of registration.
6830          * Do this across as many network namespaces as possible to
6831          * improve batching efficiency.
6832          */
6833         struct net_device *dev;
6834         struct net *net;
6835         LIST_HEAD(dev_kill_list);
6836
6837         /* To prevent network device cleanup code from dereferencing
6838          * loopback devices or network devices that have been freed
6839          * wait here for all pending unregistrations to complete,
6840          * before unregistring the loopback device and allowing the
6841          * network namespace be freed.
6842          *
6843          * The netdev todo list containing all network devices
6844          * unregistrations that happen in default_device_exit_batch
6845          * will run in the rtnl_unlock() at the end of
6846          * default_device_exit_batch.
6847          */
6848         rtnl_lock_unregistering(net_list);
6849         list_for_each_entry(net, net_list, exit_list) {
6850                 for_each_netdev_reverse(net, dev) {
6851                         if (dev->rtnl_link_ops)
6852                                 dev->rtnl_link_ops->dellink(dev, &dev_kill_list);
6853                         else
6854                                 unregister_netdevice_queue(dev, &dev_kill_list);
6855                 }
6856         }
6857         unregister_netdevice_many(&dev_kill_list);
6858         list_del(&dev_kill_list);
6859         rtnl_unlock();
6860 }
6861
6862 static struct pernet_operations __net_initdata default_device_ops = {
6863         .exit = default_device_exit,
6864         .exit_batch = default_device_exit_batch,
6865 };
6866
6867 /*
6868  *      Initialize the DEV module. At boot time this walks the device list and
6869  *      unhooks any devices that fail to initialise (normally hardware not
6870  *      present) and leaves us with a valid list of present and active devices.
6871  *
6872  */
6873
6874 /*
6875  *       This is called single threaded during boot, so no need
6876  *       to take the rtnl semaphore.
6877  */
6878 static int __init net_dev_init(void)
6879 {
6880         int i, rc = -ENOMEM;
6881
6882         BUG_ON(!dev_boot_phase);
6883
6884         if (dev_proc_init())
6885                 goto out;
6886
6887         if (netdev_kobject_init())
6888                 goto out;
6889
6890         INIT_LIST_HEAD(&ptype_all);
6891         for (i = 0; i < PTYPE_HASH_SIZE; i++)
6892                 INIT_LIST_HEAD(&ptype_base[i]);
6893
6894         INIT_LIST_HEAD(&offload_base);
6895
6896         if (register_pernet_subsys(&netdev_net_ops))
6897                 goto out;
6898
6899         /*
6900          *      Initialise the packet receive queues.
6901          */
6902
6903         for_each_possible_cpu(i) {
6904                 struct softnet_data *sd = &per_cpu(softnet_data, i);
6905
6906                 memset(sd, 0, sizeof(*sd));
6907                 skb_queue_head_init(&sd->input_pkt_queue);
6908                 skb_queue_head_init(&sd->process_queue);
6909                 sd->completion_queue = NULL;
6910                 INIT_LIST_HEAD(&sd->poll_list);
6911                 sd->output_queue = NULL;
6912                 sd->output_queue_tailp = &sd->output_queue;
6913 #ifdef CONFIG_RPS
6914                 sd->csd.func = rps_trigger_softirq;
6915                 sd->csd.info = sd;
6916                 sd->csd.flags = 0;
6917                 sd->cpu = i;
6918 #endif
6919
6920                 sd->backlog.poll = process_backlog;
6921                 sd->backlog.weight = weight_p;
6922                 sd->backlog.gro_list = NULL;
6923                 sd->backlog.gro_count = 0;
6924
6925 #ifdef CONFIG_NET_FLOW_LIMIT
6926                 sd->flow_limit = NULL;
6927 #endif
6928         }
6929
6930         dev_boot_phase = 0;
6931
6932         /* The loopback device is special if any other network devices
6933          * is present in a network namespace the loopback device must
6934          * be present. Since we now dynamically allocate and free the
6935          * loopback device ensure this invariant is maintained by
6936          * keeping the loopback device as the first device on the
6937          * list of network devices.  Ensuring the loopback devices
6938          * is the first device that appears and the last network device
6939          * that disappears.
6940          */
6941         if (register_pernet_device(&loopback_net_ops))
6942                 goto out;
6943
6944         if (register_pernet_device(&default_device_ops))
6945                 goto out;
6946
6947         open_softirq(NET_TX_SOFTIRQ, net_tx_action);
6948         open_softirq(NET_RX_SOFTIRQ, net_rx_action);
6949
6950         hotcpu_notifier(dev_cpu_callback, 0);
6951         dst_init();
6952         rc = 0;
6953 out:
6954         return rc;
6955 }
6956
6957 subsys_initcall(net_dev_init);