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