devlink: validate length of region addr/len
[platform/kernel/linux-rpi.git] / net / core / net-sysfs.c
1 /*
2  * net-sysfs.c - network device class and attributes
3  *
4  * Copyright (c) 2003 Stephen Hemminger <shemminger@osdl.org>
5  *
6  *      This program is free software; you can redistribute it and/or
7  *      modify it under the terms of the GNU General Public License
8  *      as published by the Free Software Foundation; either version
9  *      2 of the License, or (at your option) any later version.
10  */
11
12 #include <linux/capability.h>
13 #include <linux/kernel.h>
14 #include <linux/netdevice.h>
15 #include <net/switchdev.h>
16 #include <linux/if_arp.h>
17 #include <linux/slab.h>
18 #include <linux/sched/signal.h>
19 #include <linux/nsproxy.h>
20 #include <net/sock.h>
21 #include <net/net_namespace.h>
22 #include <linux/rtnetlink.h>
23 #include <linux/vmalloc.h>
24 #include <linux/export.h>
25 #include <linux/jiffies.h>
26 #include <linux/pm_runtime.h>
27 #include <linux/of.h>
28 #include <linux/of_net.h>
29 #include <linux/cpu.h>
30
31 #include "net-sysfs.h"
32
33 #ifdef CONFIG_SYSFS
34 static const char fmt_hex[] = "%#x\n";
35 static const char fmt_dec[] = "%d\n";
36 static const char fmt_ulong[] = "%lu\n";
37 static const char fmt_u64[] = "%llu\n";
38
39 static inline int dev_isalive(const struct net_device *dev)
40 {
41         return dev->reg_state <= NETREG_REGISTERED;
42 }
43
44 /* use same locking rules as GIF* ioctl's */
45 static ssize_t netdev_show(const struct device *dev,
46                            struct device_attribute *attr, char *buf,
47                            ssize_t (*format)(const struct net_device *, char *))
48 {
49         struct net_device *ndev = to_net_dev(dev);
50         ssize_t ret = -EINVAL;
51
52         read_lock(&dev_base_lock);
53         if (dev_isalive(ndev))
54                 ret = (*format)(ndev, buf);
55         read_unlock(&dev_base_lock);
56
57         return ret;
58 }
59
60 /* generate a show function for simple field */
61 #define NETDEVICE_SHOW(field, format_string)                            \
62 static ssize_t format_##field(const struct net_device *dev, char *buf)  \
63 {                                                                       \
64         return sprintf(buf, format_string, dev->field);                 \
65 }                                                                       \
66 static ssize_t field##_show(struct device *dev,                         \
67                             struct device_attribute *attr, char *buf)   \
68 {                                                                       \
69         return netdev_show(dev, attr, buf, format_##field);             \
70 }                                                                       \
71
72 #define NETDEVICE_SHOW_RO(field, format_string)                         \
73 NETDEVICE_SHOW(field, format_string);                                   \
74 static DEVICE_ATTR_RO(field)
75
76 #define NETDEVICE_SHOW_RW(field, format_string)                         \
77 NETDEVICE_SHOW(field, format_string);                                   \
78 static DEVICE_ATTR_RW(field)
79
80 /* use same locking and permission rules as SIF* ioctl's */
81 static ssize_t netdev_store(struct device *dev, struct device_attribute *attr,
82                             const char *buf, size_t len,
83                             int (*set)(struct net_device *, unsigned long))
84 {
85         struct net_device *netdev = to_net_dev(dev);
86         struct net *net = dev_net(netdev);
87         unsigned long new;
88         int ret = -EINVAL;
89
90         if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
91                 return -EPERM;
92
93         ret = kstrtoul(buf, 0, &new);
94         if (ret)
95                 goto err;
96
97         if (!rtnl_trylock())
98                 return restart_syscall();
99
100         if (dev_isalive(netdev)) {
101                 ret = (*set)(netdev, new);
102                 if (ret == 0)
103                         ret = len;
104         }
105         rtnl_unlock();
106  err:
107         return ret;
108 }
109
110 NETDEVICE_SHOW_RO(dev_id, fmt_hex);
111 NETDEVICE_SHOW_RO(dev_port, fmt_dec);
112 NETDEVICE_SHOW_RO(addr_assign_type, fmt_dec);
113 NETDEVICE_SHOW_RO(addr_len, fmt_dec);
114 NETDEVICE_SHOW_RO(ifindex, fmt_dec);
115 NETDEVICE_SHOW_RO(type, fmt_dec);
116 NETDEVICE_SHOW_RO(link_mode, fmt_dec);
117
118 static ssize_t iflink_show(struct device *dev, struct device_attribute *attr,
119                            char *buf)
120 {
121         struct net_device *ndev = to_net_dev(dev);
122
123         return sprintf(buf, fmt_dec, dev_get_iflink(ndev));
124 }
125 static DEVICE_ATTR_RO(iflink);
126
127 static ssize_t format_name_assign_type(const struct net_device *dev, char *buf)
128 {
129         return sprintf(buf, fmt_dec, dev->name_assign_type);
130 }
131
132 static ssize_t name_assign_type_show(struct device *dev,
133                                      struct device_attribute *attr,
134                                      char *buf)
135 {
136         struct net_device *ndev = to_net_dev(dev);
137         ssize_t ret = -EINVAL;
138
139         if (ndev->name_assign_type != NET_NAME_UNKNOWN)
140                 ret = netdev_show(dev, attr, buf, format_name_assign_type);
141
142         return ret;
143 }
144 static DEVICE_ATTR_RO(name_assign_type);
145
146 /* use same locking rules as GIFHWADDR ioctl's */
147 static ssize_t address_show(struct device *dev, struct device_attribute *attr,
148                             char *buf)
149 {
150         struct net_device *ndev = to_net_dev(dev);
151         ssize_t ret = -EINVAL;
152
153         read_lock(&dev_base_lock);
154         if (dev_isalive(ndev))
155                 ret = sysfs_format_mac(buf, ndev->dev_addr, ndev->addr_len);
156         read_unlock(&dev_base_lock);
157         return ret;
158 }
159 static DEVICE_ATTR_RO(address);
160
161 static ssize_t broadcast_show(struct device *dev,
162                               struct device_attribute *attr, char *buf)
163 {
164         struct net_device *ndev = to_net_dev(dev);
165
166         if (dev_isalive(ndev))
167                 return sysfs_format_mac(buf, ndev->broadcast, ndev->addr_len);
168         return -EINVAL;
169 }
170 static DEVICE_ATTR_RO(broadcast);
171
172 static int change_carrier(struct net_device *dev, unsigned long new_carrier)
173 {
174         if (!netif_running(dev))
175                 return -EINVAL;
176         return dev_change_carrier(dev, (bool)new_carrier);
177 }
178
179 static ssize_t carrier_store(struct device *dev, struct device_attribute *attr,
180                              const char *buf, size_t len)
181 {
182         return netdev_store(dev, attr, buf, len, change_carrier);
183 }
184
185 static ssize_t carrier_show(struct device *dev,
186                             struct device_attribute *attr, char *buf)
187 {
188         struct net_device *netdev = to_net_dev(dev);
189
190         if (netif_running(netdev))
191                 return sprintf(buf, fmt_dec, !!netif_carrier_ok(netdev));
192
193         return -EINVAL;
194 }
195 static DEVICE_ATTR_RW(carrier);
196
197 static ssize_t speed_show(struct device *dev,
198                           struct device_attribute *attr, char *buf)
199 {
200         struct net_device *netdev = to_net_dev(dev);
201         int ret = -EINVAL;
202
203         if (!rtnl_trylock())
204                 return restart_syscall();
205
206         if (netif_running(netdev)) {
207                 struct ethtool_link_ksettings cmd;
208
209                 if (!__ethtool_get_link_ksettings(netdev, &cmd))
210                         ret = sprintf(buf, fmt_dec, cmd.base.speed);
211         }
212         rtnl_unlock();
213         return ret;
214 }
215 static DEVICE_ATTR_RO(speed);
216
217 static ssize_t duplex_show(struct device *dev,
218                            struct device_attribute *attr, char *buf)
219 {
220         struct net_device *netdev = to_net_dev(dev);
221         int ret = -EINVAL;
222
223         if (!rtnl_trylock())
224                 return restart_syscall();
225
226         if (netif_running(netdev)) {
227                 struct ethtool_link_ksettings cmd;
228
229                 if (!__ethtool_get_link_ksettings(netdev, &cmd)) {
230                         const char *duplex;
231
232                         switch (cmd.base.duplex) {
233                         case DUPLEX_HALF:
234                                 duplex = "half";
235                                 break;
236                         case DUPLEX_FULL:
237                                 duplex = "full";
238                                 break;
239                         default:
240                                 duplex = "unknown";
241                                 break;
242                         }
243                         ret = sprintf(buf, "%s\n", duplex);
244                 }
245         }
246         rtnl_unlock();
247         return ret;
248 }
249 static DEVICE_ATTR_RO(duplex);
250
251 static ssize_t dormant_show(struct device *dev,
252                             struct device_attribute *attr, char *buf)
253 {
254         struct net_device *netdev = to_net_dev(dev);
255
256         if (netif_running(netdev))
257                 return sprintf(buf, fmt_dec, !!netif_dormant(netdev));
258
259         return -EINVAL;
260 }
261 static DEVICE_ATTR_RO(dormant);
262
263 static const char *const operstates[] = {
264         "unknown",
265         "notpresent", /* currently unused */
266         "down",
267         "lowerlayerdown",
268         "testing", /* currently unused */
269         "dormant",
270         "up"
271 };
272
273 static ssize_t operstate_show(struct device *dev,
274                               struct device_attribute *attr, char *buf)
275 {
276         const struct net_device *netdev = to_net_dev(dev);
277         unsigned char operstate;
278
279         read_lock(&dev_base_lock);
280         operstate = netdev->operstate;
281         if (!netif_running(netdev))
282                 operstate = IF_OPER_DOWN;
283         read_unlock(&dev_base_lock);
284
285         if (operstate >= ARRAY_SIZE(operstates))
286                 return -EINVAL; /* should not happen */
287
288         return sprintf(buf, "%s\n", operstates[operstate]);
289 }
290 static DEVICE_ATTR_RO(operstate);
291
292 static ssize_t carrier_changes_show(struct device *dev,
293                                     struct device_attribute *attr,
294                                     char *buf)
295 {
296         struct net_device *netdev = to_net_dev(dev);
297
298         return sprintf(buf, fmt_dec,
299                        atomic_read(&netdev->carrier_up_count) +
300                        atomic_read(&netdev->carrier_down_count));
301 }
302 static DEVICE_ATTR_RO(carrier_changes);
303
304 static ssize_t carrier_up_count_show(struct device *dev,
305                                      struct device_attribute *attr,
306                                      char *buf)
307 {
308         struct net_device *netdev = to_net_dev(dev);
309
310         return sprintf(buf, fmt_dec, atomic_read(&netdev->carrier_up_count));
311 }
312 static DEVICE_ATTR_RO(carrier_up_count);
313
314 static ssize_t carrier_down_count_show(struct device *dev,
315                                        struct device_attribute *attr,
316                                        char *buf)
317 {
318         struct net_device *netdev = to_net_dev(dev);
319
320         return sprintf(buf, fmt_dec, atomic_read(&netdev->carrier_down_count));
321 }
322 static DEVICE_ATTR_RO(carrier_down_count);
323
324 /* read-write attributes */
325
326 static int change_mtu(struct net_device *dev, unsigned long new_mtu)
327 {
328         return dev_set_mtu(dev, (int)new_mtu);
329 }
330
331 static ssize_t mtu_store(struct device *dev, struct device_attribute *attr,
332                          const char *buf, size_t len)
333 {
334         return netdev_store(dev, attr, buf, len, change_mtu);
335 }
336 NETDEVICE_SHOW_RW(mtu, fmt_dec);
337
338 static int change_flags(struct net_device *dev, unsigned long new_flags)
339 {
340         return dev_change_flags(dev, (unsigned int)new_flags);
341 }
342
343 static ssize_t flags_store(struct device *dev, struct device_attribute *attr,
344                            const char *buf, size_t len)
345 {
346         return netdev_store(dev, attr, buf, len, change_flags);
347 }
348 NETDEVICE_SHOW_RW(flags, fmt_hex);
349
350 static ssize_t tx_queue_len_store(struct device *dev,
351                                   struct device_attribute *attr,
352                                   const char *buf, size_t len)
353 {
354         if (!capable(CAP_NET_ADMIN))
355                 return -EPERM;
356
357         return netdev_store(dev, attr, buf, len, dev_change_tx_queue_len);
358 }
359 NETDEVICE_SHOW_RW(tx_queue_len, fmt_dec);
360
361 static int change_gro_flush_timeout(struct net_device *dev, unsigned long val)
362 {
363         dev->gro_flush_timeout = val;
364         return 0;
365 }
366
367 static ssize_t gro_flush_timeout_store(struct device *dev,
368                                        struct device_attribute *attr,
369                                        const char *buf, size_t len)
370 {
371         if (!capable(CAP_NET_ADMIN))
372                 return -EPERM;
373
374         return netdev_store(dev, attr, buf, len, change_gro_flush_timeout);
375 }
376 NETDEVICE_SHOW_RW(gro_flush_timeout, fmt_ulong);
377
378 static ssize_t ifalias_store(struct device *dev, struct device_attribute *attr,
379                              const char *buf, size_t len)
380 {
381         struct net_device *netdev = to_net_dev(dev);
382         struct net *net = dev_net(netdev);
383         size_t count = len;
384         ssize_t ret = 0;
385
386         if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
387                 return -EPERM;
388
389         /* ignore trailing newline */
390         if (len >  0 && buf[len - 1] == '\n')
391                 --count;
392
393         if (!rtnl_trylock())
394                 return restart_syscall();
395
396         if (dev_isalive(netdev)) {
397                 ret = dev_set_alias(netdev, buf, count);
398                 if (ret < 0)
399                         goto err;
400                 ret = len;
401                 netdev_state_change(netdev);
402         }
403 err:
404         rtnl_unlock();
405
406         return ret;
407 }
408
409 static ssize_t ifalias_show(struct device *dev,
410                             struct device_attribute *attr, char *buf)
411 {
412         const struct net_device *netdev = to_net_dev(dev);
413         char tmp[IFALIASZ];
414         ssize_t ret = 0;
415
416         ret = dev_get_alias(netdev, tmp, sizeof(tmp));
417         if (ret > 0)
418                 ret = sprintf(buf, "%s\n", tmp);
419         return ret;
420 }
421 static DEVICE_ATTR_RW(ifalias);
422
423 static int change_group(struct net_device *dev, unsigned long new_group)
424 {
425         dev_set_group(dev, (int)new_group);
426         return 0;
427 }
428
429 static ssize_t group_store(struct device *dev, struct device_attribute *attr,
430                            const char *buf, size_t len)
431 {
432         return netdev_store(dev, attr, buf, len, change_group);
433 }
434 NETDEVICE_SHOW(group, fmt_dec);
435 static DEVICE_ATTR(netdev_group, 0644, group_show, group_store);
436
437 static int change_proto_down(struct net_device *dev, unsigned long proto_down)
438 {
439         return dev_change_proto_down(dev, (bool)proto_down);
440 }
441
442 static ssize_t proto_down_store(struct device *dev,
443                                 struct device_attribute *attr,
444                                 const char *buf, size_t len)
445 {
446         return netdev_store(dev, attr, buf, len, change_proto_down);
447 }
448 NETDEVICE_SHOW_RW(proto_down, fmt_dec);
449
450 static ssize_t phys_port_id_show(struct device *dev,
451                                  struct device_attribute *attr, char *buf)
452 {
453         struct net_device *netdev = to_net_dev(dev);
454         ssize_t ret = -EINVAL;
455
456         if (!rtnl_trylock())
457                 return restart_syscall();
458
459         if (dev_isalive(netdev)) {
460                 struct netdev_phys_item_id ppid;
461
462                 ret = dev_get_phys_port_id(netdev, &ppid);
463                 if (!ret)
464                         ret = sprintf(buf, "%*phN\n", ppid.id_len, ppid.id);
465         }
466         rtnl_unlock();
467
468         return ret;
469 }
470 static DEVICE_ATTR_RO(phys_port_id);
471
472 static ssize_t phys_port_name_show(struct device *dev,
473                                    struct device_attribute *attr, char *buf)
474 {
475         struct net_device *netdev = to_net_dev(dev);
476         ssize_t ret = -EINVAL;
477
478         if (!rtnl_trylock())
479                 return restart_syscall();
480
481         if (dev_isalive(netdev)) {
482                 char name[IFNAMSIZ];
483
484                 ret = dev_get_phys_port_name(netdev, name, sizeof(name));
485                 if (!ret)
486                         ret = sprintf(buf, "%s\n", name);
487         }
488         rtnl_unlock();
489
490         return ret;
491 }
492 static DEVICE_ATTR_RO(phys_port_name);
493
494 static ssize_t phys_switch_id_show(struct device *dev,
495                                    struct device_attribute *attr, char *buf)
496 {
497         struct net_device *netdev = to_net_dev(dev);
498         ssize_t ret = -EINVAL;
499
500         if (!rtnl_trylock())
501                 return restart_syscall();
502
503         if (dev_isalive(netdev)) {
504                 struct switchdev_attr attr = {
505                         .orig_dev = netdev,
506                         .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID,
507                         .flags = SWITCHDEV_F_NO_RECURSE,
508                 };
509
510                 ret = switchdev_port_attr_get(netdev, &attr);
511                 if (!ret)
512                         ret = sprintf(buf, "%*phN\n", attr.u.ppid.id_len,
513                                       attr.u.ppid.id);
514         }
515         rtnl_unlock();
516
517         return ret;
518 }
519 static DEVICE_ATTR_RO(phys_switch_id);
520
521 static struct attribute *net_class_attrs[] __ro_after_init = {
522         &dev_attr_netdev_group.attr,
523         &dev_attr_type.attr,
524         &dev_attr_dev_id.attr,
525         &dev_attr_dev_port.attr,
526         &dev_attr_iflink.attr,
527         &dev_attr_ifindex.attr,
528         &dev_attr_name_assign_type.attr,
529         &dev_attr_addr_assign_type.attr,
530         &dev_attr_addr_len.attr,
531         &dev_attr_link_mode.attr,
532         &dev_attr_address.attr,
533         &dev_attr_broadcast.attr,
534         &dev_attr_speed.attr,
535         &dev_attr_duplex.attr,
536         &dev_attr_dormant.attr,
537         &dev_attr_operstate.attr,
538         &dev_attr_carrier_changes.attr,
539         &dev_attr_ifalias.attr,
540         &dev_attr_carrier.attr,
541         &dev_attr_mtu.attr,
542         &dev_attr_flags.attr,
543         &dev_attr_tx_queue_len.attr,
544         &dev_attr_gro_flush_timeout.attr,
545         &dev_attr_phys_port_id.attr,
546         &dev_attr_phys_port_name.attr,
547         &dev_attr_phys_switch_id.attr,
548         &dev_attr_proto_down.attr,
549         &dev_attr_carrier_up_count.attr,
550         &dev_attr_carrier_down_count.attr,
551         NULL,
552 };
553 ATTRIBUTE_GROUPS(net_class);
554
555 /* Show a given an attribute in the statistics group */
556 static ssize_t netstat_show(const struct device *d,
557                             struct device_attribute *attr, char *buf,
558                             unsigned long offset)
559 {
560         struct net_device *dev = to_net_dev(d);
561         ssize_t ret = -EINVAL;
562
563         WARN_ON(offset > sizeof(struct rtnl_link_stats64) ||
564                 offset % sizeof(u64) != 0);
565
566         read_lock(&dev_base_lock);
567         if (dev_isalive(dev)) {
568                 struct rtnl_link_stats64 temp;
569                 const struct rtnl_link_stats64 *stats = dev_get_stats(dev, &temp);
570
571                 ret = sprintf(buf, fmt_u64, *(u64 *)(((u8 *)stats) + offset));
572         }
573         read_unlock(&dev_base_lock);
574         return ret;
575 }
576
577 /* generate a read-only statistics attribute */
578 #define NETSTAT_ENTRY(name)                                             \
579 static ssize_t name##_show(struct device *d,                            \
580                            struct device_attribute *attr, char *buf)    \
581 {                                                                       \
582         return netstat_show(d, attr, buf,                               \
583                             offsetof(struct rtnl_link_stats64, name));  \
584 }                                                                       \
585 static DEVICE_ATTR_RO(name)
586
587 NETSTAT_ENTRY(rx_packets);
588 NETSTAT_ENTRY(tx_packets);
589 NETSTAT_ENTRY(rx_bytes);
590 NETSTAT_ENTRY(tx_bytes);
591 NETSTAT_ENTRY(rx_errors);
592 NETSTAT_ENTRY(tx_errors);
593 NETSTAT_ENTRY(rx_dropped);
594 NETSTAT_ENTRY(tx_dropped);
595 NETSTAT_ENTRY(multicast);
596 NETSTAT_ENTRY(collisions);
597 NETSTAT_ENTRY(rx_length_errors);
598 NETSTAT_ENTRY(rx_over_errors);
599 NETSTAT_ENTRY(rx_crc_errors);
600 NETSTAT_ENTRY(rx_frame_errors);
601 NETSTAT_ENTRY(rx_fifo_errors);
602 NETSTAT_ENTRY(rx_missed_errors);
603 NETSTAT_ENTRY(tx_aborted_errors);
604 NETSTAT_ENTRY(tx_carrier_errors);
605 NETSTAT_ENTRY(tx_fifo_errors);
606 NETSTAT_ENTRY(tx_heartbeat_errors);
607 NETSTAT_ENTRY(tx_window_errors);
608 NETSTAT_ENTRY(rx_compressed);
609 NETSTAT_ENTRY(tx_compressed);
610 NETSTAT_ENTRY(rx_nohandler);
611
612 static struct attribute *netstat_attrs[] __ro_after_init = {
613         &dev_attr_rx_packets.attr,
614         &dev_attr_tx_packets.attr,
615         &dev_attr_rx_bytes.attr,
616         &dev_attr_tx_bytes.attr,
617         &dev_attr_rx_errors.attr,
618         &dev_attr_tx_errors.attr,
619         &dev_attr_rx_dropped.attr,
620         &dev_attr_tx_dropped.attr,
621         &dev_attr_multicast.attr,
622         &dev_attr_collisions.attr,
623         &dev_attr_rx_length_errors.attr,
624         &dev_attr_rx_over_errors.attr,
625         &dev_attr_rx_crc_errors.attr,
626         &dev_attr_rx_frame_errors.attr,
627         &dev_attr_rx_fifo_errors.attr,
628         &dev_attr_rx_missed_errors.attr,
629         &dev_attr_tx_aborted_errors.attr,
630         &dev_attr_tx_carrier_errors.attr,
631         &dev_attr_tx_fifo_errors.attr,
632         &dev_attr_tx_heartbeat_errors.attr,
633         &dev_attr_tx_window_errors.attr,
634         &dev_attr_rx_compressed.attr,
635         &dev_attr_tx_compressed.attr,
636         &dev_attr_rx_nohandler.attr,
637         NULL
638 };
639
640 static const struct attribute_group netstat_group = {
641         .name  = "statistics",
642         .attrs  = netstat_attrs,
643 };
644
645 #if IS_ENABLED(CONFIG_WIRELESS_EXT) || IS_ENABLED(CONFIG_CFG80211)
646 static struct attribute *wireless_attrs[] = {
647         NULL
648 };
649
650 static const struct attribute_group wireless_group = {
651         .name = "wireless",
652         .attrs = wireless_attrs,
653 };
654 #endif
655
656 #else /* CONFIG_SYSFS */
657 #define net_class_groups        NULL
658 #endif /* CONFIG_SYSFS */
659
660 #ifdef CONFIG_SYSFS
661 #define to_rx_queue_attr(_attr) \
662         container_of(_attr, struct rx_queue_attribute, attr)
663
664 #define to_rx_queue(obj) container_of(obj, struct netdev_rx_queue, kobj)
665
666 static ssize_t rx_queue_attr_show(struct kobject *kobj, struct attribute *attr,
667                                   char *buf)
668 {
669         const struct rx_queue_attribute *attribute = to_rx_queue_attr(attr);
670         struct netdev_rx_queue *queue = to_rx_queue(kobj);
671
672         if (!attribute->show)
673                 return -EIO;
674
675         return attribute->show(queue, buf);
676 }
677
678 static ssize_t rx_queue_attr_store(struct kobject *kobj, struct attribute *attr,
679                                    const char *buf, size_t count)
680 {
681         const struct rx_queue_attribute *attribute = to_rx_queue_attr(attr);
682         struct netdev_rx_queue *queue = to_rx_queue(kobj);
683
684         if (!attribute->store)
685                 return -EIO;
686
687         return attribute->store(queue, buf, count);
688 }
689
690 static const struct sysfs_ops rx_queue_sysfs_ops = {
691         .show = rx_queue_attr_show,
692         .store = rx_queue_attr_store,
693 };
694
695 #ifdef CONFIG_RPS
696 static ssize_t show_rps_map(struct netdev_rx_queue *queue, char *buf)
697 {
698         struct rps_map *map;
699         cpumask_var_t mask;
700         int i, len;
701
702         if (!zalloc_cpumask_var(&mask, GFP_KERNEL))
703                 return -ENOMEM;
704
705         rcu_read_lock();
706         map = rcu_dereference(queue->rps_map);
707         if (map)
708                 for (i = 0; i < map->len; i++)
709                         cpumask_set_cpu(map->cpus[i], mask);
710
711         len = snprintf(buf, PAGE_SIZE, "%*pb\n", cpumask_pr_args(mask));
712         rcu_read_unlock();
713         free_cpumask_var(mask);
714
715         return len < PAGE_SIZE ? len : -EINVAL;
716 }
717
718 static ssize_t store_rps_map(struct netdev_rx_queue *queue,
719                              const char *buf, size_t len)
720 {
721         struct rps_map *old_map, *map;
722         cpumask_var_t mask;
723         int err, cpu, i;
724         static DEFINE_MUTEX(rps_map_mutex);
725
726         if (!capable(CAP_NET_ADMIN))
727                 return -EPERM;
728
729         if (!alloc_cpumask_var(&mask, GFP_KERNEL))
730                 return -ENOMEM;
731
732         err = bitmap_parse(buf, len, cpumask_bits(mask), nr_cpumask_bits);
733         if (err) {
734                 free_cpumask_var(mask);
735                 return err;
736         }
737
738         map = kzalloc(max_t(unsigned int,
739                             RPS_MAP_SIZE(cpumask_weight(mask)), L1_CACHE_BYTES),
740                       GFP_KERNEL);
741         if (!map) {
742                 free_cpumask_var(mask);
743                 return -ENOMEM;
744         }
745
746         i = 0;
747         for_each_cpu_and(cpu, mask, cpu_online_mask)
748                 map->cpus[i++] = cpu;
749
750         if (i) {
751                 map->len = i;
752         } else {
753                 kfree(map);
754                 map = NULL;
755         }
756
757         mutex_lock(&rps_map_mutex);
758         old_map = rcu_dereference_protected(queue->rps_map,
759                                             mutex_is_locked(&rps_map_mutex));
760         rcu_assign_pointer(queue->rps_map, map);
761
762         if (map)
763                 static_key_slow_inc(&rps_needed);
764         if (old_map)
765                 static_key_slow_dec(&rps_needed);
766
767         mutex_unlock(&rps_map_mutex);
768
769         if (old_map)
770                 kfree_rcu(old_map, rcu);
771
772         free_cpumask_var(mask);
773         return len;
774 }
775
776 static ssize_t show_rps_dev_flow_table_cnt(struct netdev_rx_queue *queue,
777                                            char *buf)
778 {
779         struct rps_dev_flow_table *flow_table;
780         unsigned long val = 0;
781
782         rcu_read_lock();
783         flow_table = rcu_dereference(queue->rps_flow_table);
784         if (flow_table)
785                 val = (unsigned long)flow_table->mask + 1;
786         rcu_read_unlock();
787
788         return sprintf(buf, "%lu\n", val);
789 }
790
791 static void rps_dev_flow_table_release(struct rcu_head *rcu)
792 {
793         struct rps_dev_flow_table *table = container_of(rcu,
794             struct rps_dev_flow_table, rcu);
795         vfree(table);
796 }
797
798 static ssize_t store_rps_dev_flow_table_cnt(struct netdev_rx_queue *queue,
799                                             const char *buf, size_t len)
800 {
801         unsigned long mask, count;
802         struct rps_dev_flow_table *table, *old_table;
803         static DEFINE_SPINLOCK(rps_dev_flow_lock);
804         int rc;
805
806         if (!capable(CAP_NET_ADMIN))
807                 return -EPERM;
808
809         rc = kstrtoul(buf, 0, &count);
810         if (rc < 0)
811                 return rc;
812
813         if (count) {
814                 mask = count - 1;
815                 /* mask = roundup_pow_of_two(count) - 1;
816                  * without overflows...
817                  */
818                 while ((mask | (mask >> 1)) != mask)
819                         mask |= (mask >> 1);
820                 /* On 64 bit arches, must check mask fits in table->mask (u32),
821                  * and on 32bit arches, must check
822                  * RPS_DEV_FLOW_TABLE_SIZE(mask + 1) doesn't overflow.
823                  */
824 #if BITS_PER_LONG > 32
825                 if (mask > (unsigned long)(u32)mask)
826                         return -EINVAL;
827 #else
828                 if (mask > (ULONG_MAX - RPS_DEV_FLOW_TABLE_SIZE(1))
829                                 / sizeof(struct rps_dev_flow)) {
830                         /* Enforce a limit to prevent overflow */
831                         return -EINVAL;
832                 }
833 #endif
834                 table = vmalloc(RPS_DEV_FLOW_TABLE_SIZE(mask + 1));
835                 if (!table)
836                         return -ENOMEM;
837
838                 table->mask = mask;
839                 for (count = 0; count <= mask; count++)
840                         table->flows[count].cpu = RPS_NO_CPU;
841         } else {
842                 table = NULL;
843         }
844
845         spin_lock(&rps_dev_flow_lock);
846         old_table = rcu_dereference_protected(queue->rps_flow_table,
847                                               lockdep_is_held(&rps_dev_flow_lock));
848         rcu_assign_pointer(queue->rps_flow_table, table);
849         spin_unlock(&rps_dev_flow_lock);
850
851         if (old_table)
852                 call_rcu(&old_table->rcu, rps_dev_flow_table_release);
853
854         return len;
855 }
856
857 static struct rx_queue_attribute rps_cpus_attribute __ro_after_init
858         = __ATTR(rps_cpus, 0644, show_rps_map, store_rps_map);
859
860 static struct rx_queue_attribute rps_dev_flow_table_cnt_attribute __ro_after_init
861         = __ATTR(rps_flow_cnt, 0644,
862                  show_rps_dev_flow_table_cnt, store_rps_dev_flow_table_cnt);
863 #endif /* CONFIG_RPS */
864
865 static struct attribute *rx_queue_default_attrs[] __ro_after_init = {
866 #ifdef CONFIG_RPS
867         &rps_cpus_attribute.attr,
868         &rps_dev_flow_table_cnt_attribute.attr,
869 #endif
870         NULL
871 };
872
873 static void rx_queue_release(struct kobject *kobj)
874 {
875         struct netdev_rx_queue *queue = to_rx_queue(kobj);
876 #ifdef CONFIG_RPS
877         struct rps_map *map;
878         struct rps_dev_flow_table *flow_table;
879
880         map = rcu_dereference_protected(queue->rps_map, 1);
881         if (map) {
882                 RCU_INIT_POINTER(queue->rps_map, NULL);
883                 kfree_rcu(map, rcu);
884         }
885
886         flow_table = rcu_dereference_protected(queue->rps_flow_table, 1);
887         if (flow_table) {
888                 RCU_INIT_POINTER(queue->rps_flow_table, NULL);
889                 call_rcu(&flow_table->rcu, rps_dev_flow_table_release);
890         }
891 #endif
892
893         memset(kobj, 0, sizeof(*kobj));
894         dev_put(queue->dev);
895 }
896
897 static const void *rx_queue_namespace(struct kobject *kobj)
898 {
899         struct netdev_rx_queue *queue = to_rx_queue(kobj);
900         struct device *dev = &queue->dev->dev;
901         const void *ns = NULL;
902
903         if (dev->class && dev->class->ns_type)
904                 ns = dev->class->namespace(dev);
905
906         return ns;
907 }
908
909 static void rx_queue_get_ownership(struct kobject *kobj,
910                                    kuid_t *uid, kgid_t *gid)
911 {
912         const struct net *net = rx_queue_namespace(kobj);
913
914         net_ns_get_ownership(net, uid, gid);
915 }
916
917 static struct kobj_type rx_queue_ktype __ro_after_init = {
918         .sysfs_ops = &rx_queue_sysfs_ops,
919         .release = rx_queue_release,
920         .default_attrs = rx_queue_default_attrs,
921         .namespace = rx_queue_namespace,
922         .get_ownership = rx_queue_get_ownership,
923 };
924
925 static int rx_queue_add_kobject(struct net_device *dev, int index)
926 {
927         struct netdev_rx_queue *queue = dev->_rx + index;
928         struct kobject *kobj = &queue->kobj;
929         int error = 0;
930
931         /* Kobject_put later will trigger rx_queue_release call which
932          * decreases dev refcount: Take that reference here
933          */
934         dev_hold(queue->dev);
935
936         kobj->kset = dev->queues_kset;
937         error = kobject_init_and_add(kobj, &rx_queue_ktype, NULL,
938                                      "rx-%u", index);
939         if (error)
940                 goto err;
941
942         if (dev->sysfs_rx_queue_group) {
943                 error = sysfs_create_group(kobj, dev->sysfs_rx_queue_group);
944                 if (error)
945                         goto err;
946         }
947
948         kobject_uevent(kobj, KOBJ_ADD);
949
950         return error;
951
952 err:
953         kobject_put(kobj);
954         return error;
955 }
956 #endif /* CONFIG_SYSFS */
957
958 int
959 net_rx_queue_update_kobjects(struct net_device *dev, int old_num, int new_num)
960 {
961 #ifdef CONFIG_SYSFS
962         int i;
963         int error = 0;
964
965 #ifndef CONFIG_RPS
966         if (!dev->sysfs_rx_queue_group)
967                 return 0;
968 #endif
969         for (i = old_num; i < new_num; i++) {
970                 error = rx_queue_add_kobject(dev, i);
971                 if (error) {
972                         new_num = old_num;
973                         break;
974                 }
975         }
976
977         while (--i >= new_num) {
978                 struct kobject *kobj = &dev->_rx[i].kobj;
979
980                 if (!refcount_read(&dev_net(dev)->count))
981                         kobj->uevent_suppress = 1;
982                 if (dev->sysfs_rx_queue_group)
983                         sysfs_remove_group(kobj, dev->sysfs_rx_queue_group);
984                 kobject_put(kobj);
985         }
986
987         return error;
988 #else
989         return 0;
990 #endif
991 }
992
993 #ifdef CONFIG_SYSFS
994 /*
995  * netdev_queue sysfs structures and functions.
996  */
997 struct netdev_queue_attribute {
998         struct attribute attr;
999         ssize_t (*show)(struct netdev_queue *queue, char *buf);
1000         ssize_t (*store)(struct netdev_queue *queue,
1001                          const char *buf, size_t len);
1002 };
1003 #define to_netdev_queue_attr(_attr) \
1004         container_of(_attr, struct netdev_queue_attribute, attr)
1005
1006 #define to_netdev_queue(obj) container_of(obj, struct netdev_queue, kobj)
1007
1008 static ssize_t netdev_queue_attr_show(struct kobject *kobj,
1009                                       struct attribute *attr, char *buf)
1010 {
1011         const struct netdev_queue_attribute *attribute
1012                 = to_netdev_queue_attr(attr);
1013         struct netdev_queue *queue = to_netdev_queue(kobj);
1014
1015         if (!attribute->show)
1016                 return -EIO;
1017
1018         return attribute->show(queue, buf);
1019 }
1020
1021 static ssize_t netdev_queue_attr_store(struct kobject *kobj,
1022                                        struct attribute *attr,
1023                                        const char *buf, size_t count)
1024 {
1025         const struct netdev_queue_attribute *attribute
1026                 = to_netdev_queue_attr(attr);
1027         struct netdev_queue *queue = to_netdev_queue(kobj);
1028
1029         if (!attribute->store)
1030                 return -EIO;
1031
1032         return attribute->store(queue, buf, count);
1033 }
1034
1035 static const struct sysfs_ops netdev_queue_sysfs_ops = {
1036         .show = netdev_queue_attr_show,
1037         .store = netdev_queue_attr_store,
1038 };
1039
1040 static ssize_t tx_timeout_show(struct netdev_queue *queue, char *buf)
1041 {
1042         unsigned long trans_timeout;
1043
1044         spin_lock_irq(&queue->_xmit_lock);
1045         trans_timeout = queue->trans_timeout;
1046         spin_unlock_irq(&queue->_xmit_lock);
1047
1048         return sprintf(buf, "%lu", trans_timeout);
1049 }
1050
1051 static unsigned int get_netdev_queue_index(struct netdev_queue *queue)
1052 {
1053         struct net_device *dev = queue->dev;
1054         unsigned int i;
1055
1056         i = queue - dev->_tx;
1057         BUG_ON(i >= dev->num_tx_queues);
1058
1059         return i;
1060 }
1061
1062 static ssize_t traffic_class_show(struct netdev_queue *queue,
1063                                   char *buf)
1064 {
1065         struct net_device *dev = queue->dev;
1066         int index;
1067         int tc;
1068
1069         if (!netif_is_multiqueue(dev))
1070                 return -ENOENT;
1071
1072         index = get_netdev_queue_index(queue);
1073
1074         /* If queue belongs to subordinate dev use its TC mapping */
1075         dev = netdev_get_tx_queue(dev, index)->sb_dev ? : dev;
1076
1077         tc = netdev_txq_to_tc(dev, index);
1078         if (tc < 0)
1079                 return -EINVAL;
1080
1081         /* We can report the traffic class one of two ways:
1082          * Subordinate device traffic classes are reported with the traffic
1083          * class first, and then the subordinate class so for example TC0 on
1084          * subordinate device 2 will be reported as "0-2". If the queue
1085          * belongs to the root device it will be reported with just the
1086          * traffic class, so just "0" for TC 0 for example.
1087          */
1088         return dev->num_tc < 0 ? sprintf(buf, "%u%d\n", tc, dev->num_tc) :
1089                                  sprintf(buf, "%u\n", tc);
1090 }
1091
1092 #ifdef CONFIG_XPS
1093 static ssize_t tx_maxrate_show(struct netdev_queue *queue,
1094                                char *buf)
1095 {
1096         return sprintf(buf, "%lu\n", queue->tx_maxrate);
1097 }
1098
1099 static ssize_t tx_maxrate_store(struct netdev_queue *queue,
1100                                 const char *buf, size_t len)
1101 {
1102         struct net_device *dev = queue->dev;
1103         int err, index = get_netdev_queue_index(queue);
1104         u32 rate = 0;
1105
1106         if (!capable(CAP_NET_ADMIN))
1107                 return -EPERM;
1108
1109         err = kstrtou32(buf, 10, &rate);
1110         if (err < 0)
1111                 return err;
1112
1113         if (!rtnl_trylock())
1114                 return restart_syscall();
1115
1116         err = -EOPNOTSUPP;
1117         if (dev->netdev_ops->ndo_set_tx_maxrate)
1118                 err = dev->netdev_ops->ndo_set_tx_maxrate(dev, index, rate);
1119
1120         rtnl_unlock();
1121         if (!err) {
1122                 queue->tx_maxrate = rate;
1123                 return len;
1124         }
1125         return err;
1126 }
1127
1128 static struct netdev_queue_attribute queue_tx_maxrate __ro_after_init
1129         = __ATTR_RW(tx_maxrate);
1130 #endif
1131
1132 static struct netdev_queue_attribute queue_trans_timeout __ro_after_init
1133         = __ATTR_RO(tx_timeout);
1134
1135 static struct netdev_queue_attribute queue_traffic_class __ro_after_init
1136         = __ATTR_RO(traffic_class);
1137
1138 #ifdef CONFIG_BQL
1139 /*
1140  * Byte queue limits sysfs structures and functions.
1141  */
1142 static ssize_t bql_show(char *buf, unsigned int value)
1143 {
1144         return sprintf(buf, "%u\n", value);
1145 }
1146
1147 static ssize_t bql_set(const char *buf, const size_t count,
1148                        unsigned int *pvalue)
1149 {
1150         unsigned int value;
1151         int err;
1152
1153         if (!strcmp(buf, "max") || !strcmp(buf, "max\n")) {
1154                 value = DQL_MAX_LIMIT;
1155         } else {
1156                 err = kstrtouint(buf, 10, &value);
1157                 if (err < 0)
1158                         return err;
1159                 if (value > DQL_MAX_LIMIT)
1160                         return -EINVAL;
1161         }
1162
1163         *pvalue = value;
1164
1165         return count;
1166 }
1167
1168 static ssize_t bql_show_hold_time(struct netdev_queue *queue,
1169                                   char *buf)
1170 {
1171         struct dql *dql = &queue->dql;
1172
1173         return sprintf(buf, "%u\n", jiffies_to_msecs(dql->slack_hold_time));
1174 }
1175
1176 static ssize_t bql_set_hold_time(struct netdev_queue *queue,
1177                                  const char *buf, size_t len)
1178 {
1179         struct dql *dql = &queue->dql;
1180         unsigned int value;
1181         int err;
1182
1183         err = kstrtouint(buf, 10, &value);
1184         if (err < 0)
1185                 return err;
1186
1187         dql->slack_hold_time = msecs_to_jiffies(value);
1188
1189         return len;
1190 }
1191
1192 static struct netdev_queue_attribute bql_hold_time_attribute __ro_after_init
1193         = __ATTR(hold_time, 0644,
1194                  bql_show_hold_time, bql_set_hold_time);
1195
1196 static ssize_t bql_show_inflight(struct netdev_queue *queue,
1197                                  char *buf)
1198 {
1199         struct dql *dql = &queue->dql;
1200
1201         return sprintf(buf, "%u\n", dql->num_queued - dql->num_completed);
1202 }
1203
1204 static struct netdev_queue_attribute bql_inflight_attribute __ro_after_init =
1205         __ATTR(inflight, 0444, bql_show_inflight, NULL);
1206
1207 #define BQL_ATTR(NAME, FIELD)                                           \
1208 static ssize_t bql_show_ ## NAME(struct netdev_queue *queue,            \
1209                                  char *buf)                             \
1210 {                                                                       \
1211         return bql_show(buf, queue->dql.FIELD);                         \
1212 }                                                                       \
1213                                                                         \
1214 static ssize_t bql_set_ ## NAME(struct netdev_queue *queue,             \
1215                                 const char *buf, size_t len)            \
1216 {                                                                       \
1217         return bql_set(buf, len, &queue->dql.FIELD);                    \
1218 }                                                                       \
1219                                                                         \
1220 static struct netdev_queue_attribute bql_ ## NAME ## _attribute __ro_after_init \
1221         = __ATTR(NAME, 0644,                            \
1222                  bql_show_ ## NAME, bql_set_ ## NAME)
1223
1224 BQL_ATTR(limit, limit);
1225 BQL_ATTR(limit_max, max_limit);
1226 BQL_ATTR(limit_min, min_limit);
1227
1228 static struct attribute *dql_attrs[] __ro_after_init = {
1229         &bql_limit_attribute.attr,
1230         &bql_limit_max_attribute.attr,
1231         &bql_limit_min_attribute.attr,
1232         &bql_hold_time_attribute.attr,
1233         &bql_inflight_attribute.attr,
1234         NULL
1235 };
1236
1237 static const struct attribute_group dql_group = {
1238         .name  = "byte_queue_limits",
1239         .attrs  = dql_attrs,
1240 };
1241 #endif /* CONFIG_BQL */
1242
1243 #ifdef CONFIG_XPS
1244 static ssize_t xps_cpus_show(struct netdev_queue *queue,
1245                              char *buf)
1246 {
1247         struct net_device *dev = queue->dev;
1248         int cpu, len, num_tc = 1, tc = 0;
1249         struct xps_dev_maps *dev_maps;
1250         cpumask_var_t mask;
1251         unsigned long index;
1252
1253         if (!netif_is_multiqueue(dev))
1254                 return -ENOENT;
1255
1256         index = get_netdev_queue_index(queue);
1257
1258         if (dev->num_tc) {
1259                 /* Do not allow XPS on subordinate device directly */
1260                 num_tc = dev->num_tc;
1261                 if (num_tc < 0)
1262                         return -EINVAL;
1263
1264                 /* If queue belongs to subordinate dev use its map */
1265                 dev = netdev_get_tx_queue(dev, index)->sb_dev ? : dev;
1266
1267                 tc = netdev_txq_to_tc(dev, index);
1268                 if (tc < 0)
1269                         return -EINVAL;
1270         }
1271
1272         if (!zalloc_cpumask_var(&mask, GFP_KERNEL))
1273                 return -ENOMEM;
1274
1275         rcu_read_lock();
1276         dev_maps = rcu_dereference(dev->xps_cpus_map);
1277         if (dev_maps) {
1278                 for_each_possible_cpu(cpu) {
1279                         int i, tci = cpu * num_tc + tc;
1280                         struct xps_map *map;
1281
1282                         map = rcu_dereference(dev_maps->attr_map[tci]);
1283                         if (!map)
1284                                 continue;
1285
1286                         for (i = map->len; i--;) {
1287                                 if (map->queues[i] == index) {
1288                                         cpumask_set_cpu(cpu, mask);
1289                                         break;
1290                                 }
1291                         }
1292                 }
1293         }
1294         rcu_read_unlock();
1295
1296         len = snprintf(buf, PAGE_SIZE, "%*pb\n", cpumask_pr_args(mask));
1297         free_cpumask_var(mask);
1298         return len < PAGE_SIZE ? len : -EINVAL;
1299 }
1300
1301 static ssize_t xps_cpus_store(struct netdev_queue *queue,
1302                               const char *buf, size_t len)
1303 {
1304         struct net_device *dev = queue->dev;
1305         unsigned long index;
1306         cpumask_var_t mask;
1307         int err;
1308
1309         if (!netif_is_multiqueue(dev))
1310                 return -ENOENT;
1311
1312         if (!capable(CAP_NET_ADMIN))
1313                 return -EPERM;
1314
1315         if (!alloc_cpumask_var(&mask, GFP_KERNEL))
1316                 return -ENOMEM;
1317
1318         index = get_netdev_queue_index(queue);
1319
1320         err = bitmap_parse(buf, len, cpumask_bits(mask), nr_cpumask_bits);
1321         if (err) {
1322                 free_cpumask_var(mask);
1323                 return err;
1324         }
1325
1326         err = netif_set_xps_queue(dev, mask, index);
1327
1328         free_cpumask_var(mask);
1329
1330         return err ? : len;
1331 }
1332
1333 static struct netdev_queue_attribute xps_cpus_attribute __ro_after_init
1334         = __ATTR_RW(xps_cpus);
1335
1336 static ssize_t xps_rxqs_show(struct netdev_queue *queue, char *buf)
1337 {
1338         struct net_device *dev = queue->dev;
1339         struct xps_dev_maps *dev_maps;
1340         unsigned long *mask, index;
1341         int j, len, num_tc = 1, tc = 0;
1342
1343         index = get_netdev_queue_index(queue);
1344
1345         if (dev->num_tc) {
1346                 num_tc = dev->num_tc;
1347                 tc = netdev_txq_to_tc(dev, index);
1348                 if (tc < 0)
1349                         return -EINVAL;
1350         }
1351         mask = kcalloc(BITS_TO_LONGS(dev->num_rx_queues), sizeof(long),
1352                        GFP_KERNEL);
1353         if (!mask)
1354                 return -ENOMEM;
1355
1356         rcu_read_lock();
1357         dev_maps = rcu_dereference(dev->xps_rxqs_map);
1358         if (!dev_maps)
1359                 goto out_no_maps;
1360
1361         for (j = -1; j = netif_attrmask_next(j, NULL, dev->num_rx_queues),
1362              j < dev->num_rx_queues;) {
1363                 int i, tci = j * num_tc + tc;
1364                 struct xps_map *map;
1365
1366                 map = rcu_dereference(dev_maps->attr_map[tci]);
1367                 if (!map)
1368                         continue;
1369
1370                 for (i = map->len; i--;) {
1371                         if (map->queues[i] == index) {
1372                                 set_bit(j, mask);
1373                                 break;
1374                         }
1375                 }
1376         }
1377 out_no_maps:
1378         rcu_read_unlock();
1379
1380         len = bitmap_print_to_pagebuf(false, buf, mask, dev->num_rx_queues);
1381         kfree(mask);
1382
1383         return len < PAGE_SIZE ? len : -EINVAL;
1384 }
1385
1386 static ssize_t xps_rxqs_store(struct netdev_queue *queue, const char *buf,
1387                               size_t len)
1388 {
1389         struct net_device *dev = queue->dev;
1390         struct net *net = dev_net(dev);
1391         unsigned long *mask, index;
1392         int err;
1393
1394         if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1395                 return -EPERM;
1396
1397         mask = kcalloc(BITS_TO_LONGS(dev->num_rx_queues), sizeof(long),
1398                        GFP_KERNEL);
1399         if (!mask)
1400                 return -ENOMEM;
1401
1402         index = get_netdev_queue_index(queue);
1403
1404         err = bitmap_parse(buf, len, mask, dev->num_rx_queues);
1405         if (err) {
1406                 kfree(mask);
1407                 return err;
1408         }
1409
1410         cpus_read_lock();
1411         err = __netif_set_xps_queue(dev, mask, index, true);
1412         cpus_read_unlock();
1413
1414         kfree(mask);
1415         return err ? : len;
1416 }
1417
1418 static struct netdev_queue_attribute xps_rxqs_attribute __ro_after_init
1419         = __ATTR_RW(xps_rxqs);
1420 #endif /* CONFIG_XPS */
1421
1422 static struct attribute *netdev_queue_default_attrs[] __ro_after_init = {
1423         &queue_trans_timeout.attr,
1424         &queue_traffic_class.attr,
1425 #ifdef CONFIG_XPS
1426         &xps_cpus_attribute.attr,
1427         &xps_rxqs_attribute.attr,
1428         &queue_tx_maxrate.attr,
1429 #endif
1430         NULL
1431 };
1432
1433 static void netdev_queue_release(struct kobject *kobj)
1434 {
1435         struct netdev_queue *queue = to_netdev_queue(kobj);
1436
1437         memset(kobj, 0, sizeof(*kobj));
1438         dev_put(queue->dev);
1439 }
1440
1441 static const void *netdev_queue_namespace(struct kobject *kobj)
1442 {
1443         struct netdev_queue *queue = to_netdev_queue(kobj);
1444         struct device *dev = &queue->dev->dev;
1445         const void *ns = NULL;
1446
1447         if (dev->class && dev->class->ns_type)
1448                 ns = dev->class->namespace(dev);
1449
1450         return ns;
1451 }
1452
1453 static void netdev_queue_get_ownership(struct kobject *kobj,
1454                                        kuid_t *uid, kgid_t *gid)
1455 {
1456         const struct net *net = netdev_queue_namespace(kobj);
1457
1458         net_ns_get_ownership(net, uid, gid);
1459 }
1460
1461 static struct kobj_type netdev_queue_ktype __ro_after_init = {
1462         .sysfs_ops = &netdev_queue_sysfs_ops,
1463         .release = netdev_queue_release,
1464         .default_attrs = netdev_queue_default_attrs,
1465         .namespace = netdev_queue_namespace,
1466         .get_ownership = netdev_queue_get_ownership,
1467 };
1468
1469 static int netdev_queue_add_kobject(struct net_device *dev, int index)
1470 {
1471         struct netdev_queue *queue = dev->_tx + index;
1472         struct kobject *kobj = &queue->kobj;
1473         int error = 0;
1474
1475         /* Kobject_put later will trigger netdev_queue_release call
1476          * which decreases dev refcount: Take that reference here
1477          */
1478         dev_hold(queue->dev);
1479
1480         kobj->kset = dev->queues_kset;
1481         error = kobject_init_and_add(kobj, &netdev_queue_ktype, NULL,
1482                                      "tx-%u", index);
1483         if (error)
1484                 goto err;
1485
1486 #ifdef CONFIG_BQL
1487         error = sysfs_create_group(kobj, &dql_group);
1488         if (error)
1489                 goto err;
1490 #endif
1491
1492         kobject_uevent(kobj, KOBJ_ADD);
1493         return 0;
1494
1495 err:
1496         kobject_put(kobj);
1497         return error;
1498 }
1499 #endif /* CONFIG_SYSFS */
1500
1501 int
1502 netdev_queue_update_kobjects(struct net_device *dev, int old_num, int new_num)
1503 {
1504 #ifdef CONFIG_SYSFS
1505         int i;
1506         int error = 0;
1507
1508         for (i = old_num; i < new_num; i++) {
1509                 error = netdev_queue_add_kobject(dev, i);
1510                 if (error) {
1511                         new_num = old_num;
1512                         break;
1513                 }
1514         }
1515
1516         while (--i >= new_num) {
1517                 struct netdev_queue *queue = dev->_tx + i;
1518
1519                 if (!refcount_read(&dev_net(dev)->count))
1520                         queue->kobj.uevent_suppress = 1;
1521 #ifdef CONFIG_BQL
1522                 sysfs_remove_group(&queue->kobj, &dql_group);
1523 #endif
1524                 kobject_put(&queue->kobj);
1525         }
1526
1527         return error;
1528 #else
1529         return 0;
1530 #endif /* CONFIG_SYSFS */
1531 }
1532
1533 static int register_queue_kobjects(struct net_device *dev)
1534 {
1535         int error = 0, txq = 0, rxq = 0, real_rx = 0, real_tx = 0;
1536
1537 #ifdef CONFIG_SYSFS
1538         dev->queues_kset = kset_create_and_add("queues",
1539                                                NULL, &dev->dev.kobj);
1540         if (!dev->queues_kset)
1541                 return -ENOMEM;
1542         real_rx = dev->real_num_rx_queues;
1543 #endif
1544         real_tx = dev->real_num_tx_queues;
1545
1546         error = net_rx_queue_update_kobjects(dev, 0, real_rx);
1547         if (error)
1548                 goto error;
1549         rxq = real_rx;
1550
1551         error = netdev_queue_update_kobjects(dev, 0, real_tx);
1552         if (error)
1553                 goto error;
1554         txq = real_tx;
1555
1556         return 0;
1557
1558 error:
1559         netdev_queue_update_kobjects(dev, txq, 0);
1560         net_rx_queue_update_kobjects(dev, rxq, 0);
1561 #ifdef CONFIG_SYSFS
1562         kset_unregister(dev->queues_kset);
1563 #endif
1564         return error;
1565 }
1566
1567 static void remove_queue_kobjects(struct net_device *dev)
1568 {
1569         int real_rx = 0, real_tx = 0;
1570
1571 #ifdef CONFIG_SYSFS
1572         real_rx = dev->real_num_rx_queues;
1573 #endif
1574         real_tx = dev->real_num_tx_queues;
1575
1576         net_rx_queue_update_kobjects(dev, real_rx, 0);
1577         netdev_queue_update_kobjects(dev, real_tx, 0);
1578 #ifdef CONFIG_SYSFS
1579         kset_unregister(dev->queues_kset);
1580 #endif
1581 }
1582
1583 static bool net_current_may_mount(void)
1584 {
1585         struct net *net = current->nsproxy->net_ns;
1586
1587         return ns_capable(net->user_ns, CAP_SYS_ADMIN);
1588 }
1589
1590 static void *net_grab_current_ns(void)
1591 {
1592         struct net *ns = current->nsproxy->net_ns;
1593 #ifdef CONFIG_NET_NS
1594         if (ns)
1595                 refcount_inc(&ns->passive);
1596 #endif
1597         return ns;
1598 }
1599
1600 static const void *net_initial_ns(void)
1601 {
1602         return &init_net;
1603 }
1604
1605 static const void *net_netlink_ns(struct sock *sk)
1606 {
1607         return sock_net(sk);
1608 }
1609
1610 const struct kobj_ns_type_operations net_ns_type_operations = {
1611         .type = KOBJ_NS_TYPE_NET,
1612         .current_may_mount = net_current_may_mount,
1613         .grab_current_ns = net_grab_current_ns,
1614         .netlink_ns = net_netlink_ns,
1615         .initial_ns = net_initial_ns,
1616         .drop_ns = net_drop_ns,
1617 };
1618 EXPORT_SYMBOL_GPL(net_ns_type_operations);
1619
1620 static int netdev_uevent(struct device *d, struct kobj_uevent_env *env)
1621 {
1622         struct net_device *dev = to_net_dev(d);
1623         int retval;
1624
1625         /* pass interface to uevent. */
1626         retval = add_uevent_var(env, "INTERFACE=%s", dev->name);
1627         if (retval)
1628                 goto exit;
1629
1630         /* pass ifindex to uevent.
1631          * ifindex is useful as it won't change (interface name may change)
1632          * and is what RtNetlink uses natively.
1633          */
1634         retval = add_uevent_var(env, "IFINDEX=%d", dev->ifindex);
1635
1636 exit:
1637         return retval;
1638 }
1639
1640 /*
1641  *      netdev_release -- destroy and free a dead device.
1642  *      Called when last reference to device kobject is gone.
1643  */
1644 static void netdev_release(struct device *d)
1645 {
1646         struct net_device *dev = to_net_dev(d);
1647
1648         BUG_ON(dev->reg_state != NETREG_RELEASED);
1649
1650         /* no need to wait for rcu grace period:
1651          * device is dead and about to be freed.
1652          */
1653         kfree(rcu_access_pointer(dev->ifalias));
1654         netdev_freemem(dev);
1655 }
1656
1657 static const void *net_namespace(struct device *d)
1658 {
1659         struct net_device *dev = to_net_dev(d);
1660
1661         return dev_net(dev);
1662 }
1663
1664 static void net_get_ownership(struct device *d, kuid_t *uid, kgid_t *gid)
1665 {
1666         struct net_device *dev = to_net_dev(d);
1667         const struct net *net = dev_net(dev);
1668
1669         net_ns_get_ownership(net, uid, gid);
1670 }
1671
1672 static struct class net_class __ro_after_init = {
1673         .name = "net",
1674         .dev_release = netdev_release,
1675         .dev_groups = net_class_groups,
1676         .dev_uevent = netdev_uevent,
1677         .ns_type = &net_ns_type_operations,
1678         .namespace = net_namespace,
1679         .get_ownership = net_get_ownership,
1680 };
1681
1682 #ifdef CONFIG_OF_NET
1683 static int of_dev_node_match(struct device *dev, const void *data)
1684 {
1685         int ret = 0;
1686
1687         if (dev->parent)
1688                 ret = dev->parent->of_node == data;
1689
1690         return ret == 0 ? dev->of_node == data : ret;
1691 }
1692
1693 /*
1694  * of_find_net_device_by_node - lookup the net device for the device node
1695  * @np: OF device node
1696  *
1697  * Looks up the net_device structure corresponding with the device node.
1698  * If successful, returns a pointer to the net_device with the embedded
1699  * struct device refcount incremented by one, or NULL on failure. The
1700  * refcount must be dropped when done with the net_device.
1701  */
1702 struct net_device *of_find_net_device_by_node(struct device_node *np)
1703 {
1704         struct device *dev;
1705
1706         dev = class_find_device(&net_class, NULL, np, of_dev_node_match);
1707         if (!dev)
1708                 return NULL;
1709
1710         return to_net_dev(dev);
1711 }
1712 EXPORT_SYMBOL(of_find_net_device_by_node);
1713 #endif
1714
1715 /* Delete sysfs entries but hold kobject reference until after all
1716  * netdev references are gone.
1717  */
1718 void netdev_unregister_kobject(struct net_device *ndev)
1719 {
1720         struct device *dev = &ndev->dev;
1721
1722         if (!refcount_read(&dev_net(ndev)->count))
1723                 dev_set_uevent_suppress(dev, 1);
1724
1725         kobject_get(&dev->kobj);
1726
1727         remove_queue_kobjects(ndev);
1728
1729         pm_runtime_set_memalloc_noio(dev, false);
1730
1731         device_del(dev);
1732 }
1733
1734 /* Create sysfs entries for network device. */
1735 int netdev_register_kobject(struct net_device *ndev)
1736 {
1737         struct device *dev = &ndev->dev;
1738         const struct attribute_group **groups = ndev->sysfs_groups;
1739         int error = 0;
1740
1741         device_initialize(dev);
1742         dev->class = &net_class;
1743         dev->platform_data = ndev;
1744         dev->groups = groups;
1745
1746         dev_set_name(dev, "%s", ndev->name);
1747
1748 #ifdef CONFIG_SYSFS
1749         /* Allow for a device specific group */
1750         if (*groups)
1751                 groups++;
1752
1753         *groups++ = &netstat_group;
1754
1755 #if IS_ENABLED(CONFIG_WIRELESS_EXT) || IS_ENABLED(CONFIG_CFG80211)
1756         if (ndev->ieee80211_ptr)
1757                 *groups++ = &wireless_group;
1758 #if IS_ENABLED(CONFIG_WIRELESS_EXT)
1759         else if (ndev->wireless_handlers)
1760                 *groups++ = &wireless_group;
1761 #endif
1762 #endif
1763 #endif /* CONFIG_SYSFS */
1764
1765         error = device_add(dev);
1766         if (error)
1767                 return error;
1768
1769         error = register_queue_kobjects(ndev);
1770         if (error) {
1771                 device_del(dev);
1772                 return error;
1773         }
1774
1775         pm_runtime_set_memalloc_noio(dev, true);
1776
1777         return error;
1778 }
1779
1780 int netdev_class_create_file_ns(const struct class_attribute *class_attr,
1781                                 const void *ns)
1782 {
1783         return class_create_file_ns(&net_class, class_attr, ns);
1784 }
1785 EXPORT_SYMBOL(netdev_class_create_file_ns);
1786
1787 void netdev_class_remove_file_ns(const struct class_attribute *class_attr,
1788                                  const void *ns)
1789 {
1790         class_remove_file_ns(&net_class, class_attr, ns);
1791 }
1792 EXPORT_SYMBOL(netdev_class_remove_file_ns);
1793
1794 int __init netdev_kobject_init(void)
1795 {
1796         kobj_ns_type_register(&net_ns_type_operations);
1797         return class_register(&net_class);
1798 }