1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * INET An implementation of the TCP/IP protocol suite for the LINUX 4 * operating system. INET is implemented using the BSD Socket 5 * interface as the means of communication with the user level. 6 * 7 * Routing netlink socket interface: protocol independent part. 8 * 9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> 10 * 11 * Fixes: 12 * Vitaly E. Lavrov RTA_OK arithmetics was wrong. 13 */ 14 15 #include <linux/bitops.h> 16 #include <linux/errno.h> 17 #include <linux/module.h> 18 #include <linux/types.h> 19 #include <linux/socket.h> 20 #include <linux/kernel.h> 21 #include <linux/timer.h> 22 #include <linux/string.h> 23 #include <linux/sockios.h> 24 #include <linux/net.h> 25 #include <linux/fcntl.h> 26 #include <linux/mm.h> 27 #include <linux/slab.h> 28 #include <linux/interrupt.h> 29 #include <linux/capability.h> 30 #include <linux/skbuff.h> 31 #include <linux/init.h> 32 #include <linux/security.h> 33 #include <linux/mutex.h> 34 #include <linux/if_addr.h> 35 #include <linux/if_bridge.h> 36 #include <linux/if_vlan.h> 37 #include <linux/pci.h> 38 #include <linux/etherdevice.h> 39 #include <linux/bpf.h> 40 41 #include <linux/uaccess.h> 42 43 #include <linux/inet.h> 44 #include <linux/netdevice.h> 45 #include <net/ip.h> 46 #include <net/protocol.h> 47 #include <net/arp.h> 48 #include <net/route.h> 49 #include <net/udp.h> 50 #include <net/tcp.h> 51 #include <net/sock.h> 52 #include <net/pkt_sched.h> 53 #include <net/fib_rules.h> 54 #include <net/rtnetlink.h> 55 #include <net/net_namespace.h> 56 57 #define RTNL_MAX_TYPE 50 58 #define RTNL_SLAVE_MAX_TYPE 36 59 60 struct rtnl_link { 61 rtnl_doit_func doit; 62 rtnl_dumpit_func dumpit; 63 struct module *owner; 64 unsigned int flags; 65 struct rcu_head rcu; 66 }; 67 68 static DEFINE_MUTEX(rtnl_mutex); 69 70 void rtnl_lock(void) 71 { 72 mutex_lock(&rtnl_mutex); 73 } 74 EXPORT_SYMBOL(rtnl_lock); 75 76 int rtnl_lock_killable(void) 77 { 78 return mutex_lock_killable(&rtnl_mutex); 79 } 80 EXPORT_SYMBOL(rtnl_lock_killable); 81 82 static struct sk_buff *defer_kfree_skb_list; 83 void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail) 84 { 85 if (head && tail) { 86 tail->next = defer_kfree_skb_list; 87 defer_kfree_skb_list = head; 88 } 89 } 90 EXPORT_SYMBOL(rtnl_kfree_skbs); 91 92 void __rtnl_unlock(void) 93 { 94 struct sk_buff *head = defer_kfree_skb_list; 95 96 defer_kfree_skb_list = NULL; 97 98 mutex_unlock(&rtnl_mutex); 99 100 while (head) { 101 struct sk_buff *next = head->next; 102 103 kfree_skb(head); 104 cond_resched(); 105 head = next; 106 } 107 } 108 109 void rtnl_unlock(void) 110 { 111 /* This fellow will unlock it for us. */ 112 netdev_run_todo(); 113 } 114 EXPORT_SYMBOL(rtnl_unlock); 115 116 int rtnl_trylock(void) 117 { 118 return mutex_trylock(&rtnl_mutex); 119 } 120 EXPORT_SYMBOL(rtnl_trylock); 121 122 int rtnl_is_locked(void) 123 { 124 return mutex_is_locked(&rtnl_mutex); 125 } 126 EXPORT_SYMBOL(rtnl_is_locked); 127 128 bool refcount_dec_and_rtnl_lock(refcount_t *r) 129 { 130 return refcount_dec_and_mutex_lock(r, &rtnl_mutex); 131 } 132 EXPORT_SYMBOL(refcount_dec_and_rtnl_lock); 133 134 #ifdef CONFIG_PROVE_LOCKING 135 bool lockdep_rtnl_is_held(void) 136 { 137 return lockdep_is_held(&rtnl_mutex); 138 } 139 EXPORT_SYMBOL(lockdep_rtnl_is_held); 140 #endif /* #ifdef CONFIG_PROVE_LOCKING */ 141 142 static struct rtnl_link *__rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1]; 143 144 static inline int rtm_msgindex(int msgtype) 145 { 146 int msgindex = msgtype - RTM_BASE; 147 148 /* 149 * msgindex < 0 implies someone tried to register a netlink 150 * control code. msgindex >= RTM_NR_MSGTYPES may indicate that 151 * the message type has not been added to linux/rtnetlink.h 152 */ 153 BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES); 154 155 return msgindex; 156 } 157 158 static struct rtnl_link *rtnl_get_link(int protocol, int msgtype) 159 { 160 struct rtnl_link **tab; 161 162 if (protocol >= ARRAY_SIZE(rtnl_msg_handlers)) 163 protocol = PF_UNSPEC; 164 165 tab = rcu_dereference_rtnl(rtnl_msg_handlers[protocol]); 166 if (!tab) 167 tab = rcu_dereference_rtnl(rtnl_msg_handlers[PF_UNSPEC]); 168 169 return tab[msgtype]; 170 } 171 172 static int rtnl_register_internal(struct module *owner, 173 int protocol, int msgtype, 174 rtnl_doit_func doit, rtnl_dumpit_func dumpit, 175 unsigned int flags) 176 { 177 struct rtnl_link *link, *old; 178 struct rtnl_link __rcu **tab; 179 int msgindex; 180 int ret = -ENOBUFS; 181 182 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 183 msgindex = rtm_msgindex(msgtype); 184 185 rtnl_lock(); 186 tab = rtnl_msg_handlers[protocol]; 187 if (tab == NULL) { 188 tab = kcalloc(RTM_NR_MSGTYPES, sizeof(void *), GFP_KERNEL); 189 if (!tab) 190 goto unlock; 191 192 /* ensures we see the 0 stores */ 193 rcu_assign_pointer(rtnl_msg_handlers[protocol], tab); 194 } 195 196 old = rtnl_dereference(tab[msgindex]); 197 if (old) { 198 link = kmemdup(old, sizeof(*old), GFP_KERNEL); 199 if (!link) 200 goto unlock; 201 } else { 202 link = kzalloc(sizeof(*link), GFP_KERNEL); 203 if (!link) 204 goto unlock; 205 } 206 207 WARN_ON(link->owner && link->owner != owner); 208 link->owner = owner; 209 210 WARN_ON(doit && link->doit && link->doit != doit); 211 if (doit) 212 link->doit = doit; 213 WARN_ON(dumpit && link->dumpit && link->dumpit != dumpit); 214 if (dumpit) 215 link->dumpit = dumpit; 216 217 link->flags |= flags; 218 219 /* publish protocol:msgtype */ 220 rcu_assign_pointer(tab[msgindex], link); 221 ret = 0; 222 if (old) 223 kfree_rcu(old, rcu); 224 unlock: 225 rtnl_unlock(); 226 return ret; 227 } 228 229 /** 230 * rtnl_register_module - Register a rtnetlink message type 231 * 232 * @owner: module registering the hook (THIS_MODULE) 233 * @protocol: Protocol family or PF_UNSPEC 234 * @msgtype: rtnetlink message type 235 * @doit: Function pointer called for each request message 236 * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message 237 * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions 238 * 239 * Like rtnl_register, but for use by removable modules. 240 */ 241 int rtnl_register_module(struct module *owner, 242 int protocol, int msgtype, 243 rtnl_doit_func doit, rtnl_dumpit_func dumpit, 244 unsigned int flags) 245 { 246 return rtnl_register_internal(owner, protocol, msgtype, 247 doit, dumpit, flags); 248 } 249 EXPORT_SYMBOL_GPL(rtnl_register_module); 250 251 /** 252 * rtnl_register - Register a rtnetlink message type 253 * @protocol: Protocol family or PF_UNSPEC 254 * @msgtype: rtnetlink message type 255 * @doit: Function pointer called for each request message 256 * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message 257 * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions 258 * 259 * Registers the specified function pointers (at least one of them has 260 * to be non-NULL) to be called whenever a request message for the 261 * specified protocol family and message type is received. 262 * 263 * The special protocol family PF_UNSPEC may be used to define fallback 264 * function pointers for the case when no entry for the specific protocol 265 * family exists. 266 */ 267 void rtnl_register(int protocol, int msgtype, 268 rtnl_doit_func doit, rtnl_dumpit_func dumpit, 269 unsigned int flags) 270 { 271 int err; 272 273 err = rtnl_register_internal(NULL, protocol, msgtype, doit, dumpit, 274 flags); 275 if (err) 276 pr_err("Unable to register rtnetlink message handler, " 277 "protocol = %d, message type = %d\n", protocol, msgtype); 278 } 279 280 /** 281 * rtnl_unregister - Unregister a rtnetlink message type 282 * @protocol: Protocol family or PF_UNSPEC 283 * @msgtype: rtnetlink message type 284 * 285 * Returns 0 on success or a negative error code. 286 */ 287 int rtnl_unregister(int protocol, int msgtype) 288 { 289 struct rtnl_link **tab, *link; 290 int msgindex; 291 292 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 293 msgindex = rtm_msgindex(msgtype); 294 295 rtnl_lock(); 296 tab = rtnl_dereference(rtnl_msg_handlers[protocol]); 297 if (!tab) { 298 rtnl_unlock(); 299 return -ENOENT; 300 } 301 302 link = tab[msgindex]; 303 rcu_assign_pointer(tab[msgindex], NULL); 304 rtnl_unlock(); 305 306 kfree_rcu(link, rcu); 307 308 return 0; 309 } 310 EXPORT_SYMBOL_GPL(rtnl_unregister); 311 312 /** 313 * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol 314 * @protocol : Protocol family or PF_UNSPEC 315 * 316 * Identical to calling rtnl_unregster() for all registered message types 317 * of a certain protocol family. 318 */ 319 void rtnl_unregister_all(int protocol) 320 { 321 struct rtnl_link **tab, *link; 322 int msgindex; 323 324 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 325 326 rtnl_lock(); 327 tab = rtnl_msg_handlers[protocol]; 328 if (!tab) { 329 rtnl_unlock(); 330 return; 331 } 332 RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL); 333 for (msgindex = 0; msgindex < RTM_NR_MSGTYPES; msgindex++) { 334 link = tab[msgindex]; 335 if (!link) 336 continue; 337 338 rcu_assign_pointer(tab[msgindex], NULL); 339 kfree_rcu(link, rcu); 340 } 341 rtnl_unlock(); 342 343 synchronize_net(); 344 345 kfree(tab); 346 } 347 EXPORT_SYMBOL_GPL(rtnl_unregister_all); 348 349 static LIST_HEAD(link_ops); 350 351 static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind) 352 { 353 const struct rtnl_link_ops *ops; 354 355 list_for_each_entry(ops, &link_ops, list) { 356 if (!strcmp(ops->kind, kind)) 357 return ops; 358 } 359 return NULL; 360 } 361 362 /** 363 * __rtnl_link_register - Register rtnl_link_ops with rtnetlink. 364 * @ops: struct rtnl_link_ops * to register 365 * 366 * The caller must hold the rtnl_mutex. This function should be used 367 * by drivers that create devices during module initialization. It 368 * must be called before registering the devices. 369 * 370 * Returns 0 on success or a negative error code. 371 */ 372 int __rtnl_link_register(struct rtnl_link_ops *ops) 373 { 374 if (rtnl_link_ops_get(ops->kind)) 375 return -EEXIST; 376 377 /* The check for setup is here because if ops 378 * does not have that filled up, it is not possible 379 * to use the ops for creating device. So do not 380 * fill up dellink as well. That disables rtnl_dellink. 381 */ 382 if (ops->setup && !ops->dellink) 383 ops->dellink = unregister_netdevice_queue; 384 385 list_add_tail(&ops->list, &link_ops); 386 return 0; 387 } 388 EXPORT_SYMBOL_GPL(__rtnl_link_register); 389 390 /** 391 * rtnl_link_register - Register rtnl_link_ops with rtnetlink. 392 * @ops: struct rtnl_link_ops * to register 393 * 394 * Returns 0 on success or a negative error code. 395 */ 396 int rtnl_link_register(struct rtnl_link_ops *ops) 397 { 398 int err; 399 400 /* Sanity-check max sizes to avoid stack buffer overflow. */ 401 if (WARN_ON(ops->maxtype > RTNL_MAX_TYPE || 402 ops->slave_maxtype > RTNL_SLAVE_MAX_TYPE)) 403 return -EINVAL; 404 405 rtnl_lock(); 406 err = __rtnl_link_register(ops); 407 rtnl_unlock(); 408 return err; 409 } 410 EXPORT_SYMBOL_GPL(rtnl_link_register); 411 412 static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops) 413 { 414 struct net_device *dev; 415 LIST_HEAD(list_kill); 416 417 for_each_netdev(net, dev) { 418 if (dev->rtnl_link_ops == ops) 419 ops->dellink(dev, &list_kill); 420 } 421 unregister_netdevice_many(&list_kill); 422 } 423 424 /** 425 * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 426 * @ops: struct rtnl_link_ops * to unregister 427 * 428 * The caller must hold the rtnl_mutex and guarantee net_namespace_list 429 * integrity (hold pernet_ops_rwsem for writing to close the race 430 * with setup_net() and cleanup_net()). 431 */ 432 void __rtnl_link_unregister(struct rtnl_link_ops *ops) 433 { 434 struct net *net; 435 436 for_each_net(net) { 437 __rtnl_kill_links(net, ops); 438 } 439 list_del(&ops->list); 440 } 441 EXPORT_SYMBOL_GPL(__rtnl_link_unregister); 442 443 /* Return with the rtnl_lock held when there are no network 444 * devices unregistering in any network namespace. 445 */ 446 static void rtnl_lock_unregistering_all(void) 447 { 448 struct net *net; 449 bool unregistering; 450 DEFINE_WAIT_FUNC(wait, woken_wake_function); 451 452 add_wait_queue(&netdev_unregistering_wq, &wait); 453 for (;;) { 454 unregistering = false; 455 rtnl_lock(); 456 /* We held write locked pernet_ops_rwsem, and parallel 457 * setup_net() and cleanup_net() are not possible. 458 */ 459 for_each_net(net) { 460 if (net->dev_unreg_count > 0) { 461 unregistering = true; 462 break; 463 } 464 } 465 if (!unregistering) 466 break; 467 __rtnl_unlock(); 468 469 wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT); 470 } 471 remove_wait_queue(&netdev_unregistering_wq, &wait); 472 } 473 474 /** 475 * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 476 * @ops: struct rtnl_link_ops * to unregister 477 */ 478 void rtnl_link_unregister(struct rtnl_link_ops *ops) 479 { 480 /* Close the race with setup_net() and cleanup_net() */ 481 down_write(&pernet_ops_rwsem); 482 rtnl_lock_unregistering_all(); 483 __rtnl_link_unregister(ops); 484 rtnl_unlock(); 485 up_write(&pernet_ops_rwsem); 486 } 487 EXPORT_SYMBOL_GPL(rtnl_link_unregister); 488 489 static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev) 490 { 491 struct net_device *master_dev; 492 const struct rtnl_link_ops *ops; 493 size_t size = 0; 494 495 rcu_read_lock(); 496 497 master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 498 if (!master_dev) 499 goto out; 500 501 ops = master_dev->rtnl_link_ops; 502 if (!ops || !ops->get_slave_size) 503 goto out; 504 /* IFLA_INFO_SLAVE_DATA + nested data */ 505 size = nla_total_size(sizeof(struct nlattr)) + 506 ops->get_slave_size(master_dev, dev); 507 508 out: 509 rcu_read_unlock(); 510 return size; 511 } 512 513 static size_t rtnl_link_get_size(const struct net_device *dev) 514 { 515 const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 516 size_t size; 517 518 if (!ops) 519 return 0; 520 521 size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */ 522 nla_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */ 523 524 if (ops->get_size) 525 /* IFLA_INFO_DATA + nested data */ 526 size += nla_total_size(sizeof(struct nlattr)) + 527 ops->get_size(dev); 528 529 if (ops->get_xstats_size) 530 /* IFLA_INFO_XSTATS */ 531 size += nla_total_size(ops->get_xstats_size(dev)); 532 533 size += rtnl_link_get_slave_info_data_size(dev); 534 535 return size; 536 } 537 538 static LIST_HEAD(rtnl_af_ops); 539 540 static const struct rtnl_af_ops *rtnl_af_lookup(const int family) 541 { 542 const struct rtnl_af_ops *ops; 543 544 list_for_each_entry_rcu(ops, &rtnl_af_ops, list) { 545 if (ops->family == family) 546 return ops; 547 } 548 549 return NULL; 550 } 551 552 /** 553 * rtnl_af_register - Register rtnl_af_ops with rtnetlink. 554 * @ops: struct rtnl_af_ops * to register 555 * 556 * Returns 0 on success or a negative error code. 557 */ 558 void rtnl_af_register(struct rtnl_af_ops *ops) 559 { 560 rtnl_lock(); 561 list_add_tail_rcu(&ops->list, &rtnl_af_ops); 562 rtnl_unlock(); 563 } 564 EXPORT_SYMBOL_GPL(rtnl_af_register); 565 566 /** 567 * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink. 568 * @ops: struct rtnl_af_ops * to unregister 569 */ 570 void rtnl_af_unregister(struct rtnl_af_ops *ops) 571 { 572 rtnl_lock(); 573 list_del_rcu(&ops->list); 574 rtnl_unlock(); 575 576 synchronize_rcu(); 577 } 578 EXPORT_SYMBOL_GPL(rtnl_af_unregister); 579 580 static size_t rtnl_link_get_af_size(const struct net_device *dev, 581 u32 ext_filter_mask) 582 { 583 struct rtnl_af_ops *af_ops; 584 size_t size; 585 586 /* IFLA_AF_SPEC */ 587 size = nla_total_size(sizeof(struct nlattr)); 588 589 rcu_read_lock(); 590 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 591 if (af_ops->get_link_af_size) { 592 /* AF_* + nested data */ 593 size += nla_total_size(sizeof(struct nlattr)) + 594 af_ops->get_link_af_size(dev, ext_filter_mask); 595 } 596 } 597 rcu_read_unlock(); 598 599 return size; 600 } 601 602 static bool rtnl_have_link_slave_info(const struct net_device *dev) 603 { 604 struct net_device *master_dev; 605 bool ret = false; 606 607 rcu_read_lock(); 608 609 master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 610 if (master_dev && master_dev->rtnl_link_ops) 611 ret = true; 612 rcu_read_unlock(); 613 return ret; 614 } 615 616 static int rtnl_link_slave_info_fill(struct sk_buff *skb, 617 const struct net_device *dev) 618 { 619 struct net_device *master_dev; 620 const struct rtnl_link_ops *ops; 621 struct nlattr *slave_data; 622 int err; 623 624 master_dev = netdev_master_upper_dev_get((struct net_device *) dev); 625 if (!master_dev) 626 return 0; 627 ops = master_dev->rtnl_link_ops; 628 if (!ops) 629 return 0; 630 if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0) 631 return -EMSGSIZE; 632 if (ops->fill_slave_info) { 633 slave_data = nla_nest_start_noflag(skb, IFLA_INFO_SLAVE_DATA); 634 if (!slave_data) 635 return -EMSGSIZE; 636 err = ops->fill_slave_info(skb, master_dev, dev); 637 if (err < 0) 638 goto err_cancel_slave_data; 639 nla_nest_end(skb, slave_data); 640 } 641 return 0; 642 643 err_cancel_slave_data: 644 nla_nest_cancel(skb, slave_data); 645 return err; 646 } 647 648 static int rtnl_link_info_fill(struct sk_buff *skb, 649 const struct net_device *dev) 650 { 651 const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 652 struct nlattr *data; 653 int err; 654 655 if (!ops) 656 return 0; 657 if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0) 658 return -EMSGSIZE; 659 if (ops->fill_xstats) { 660 err = ops->fill_xstats(skb, dev); 661 if (err < 0) 662 return err; 663 } 664 if (ops->fill_info) { 665 data = nla_nest_start_noflag(skb, IFLA_INFO_DATA); 666 if (data == NULL) 667 return -EMSGSIZE; 668 err = ops->fill_info(skb, dev); 669 if (err < 0) 670 goto err_cancel_data; 671 nla_nest_end(skb, data); 672 } 673 return 0; 674 675 err_cancel_data: 676 nla_nest_cancel(skb, data); 677 return err; 678 } 679 680 static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev) 681 { 682 struct nlattr *linkinfo; 683 int err = -EMSGSIZE; 684 685 linkinfo = nla_nest_start_noflag(skb, IFLA_LINKINFO); 686 if (linkinfo == NULL) 687 goto out; 688 689 err = rtnl_link_info_fill(skb, dev); 690 if (err < 0) 691 goto err_cancel_link; 692 693 err = rtnl_link_slave_info_fill(skb, dev); 694 if (err < 0) 695 goto err_cancel_link; 696 697 nla_nest_end(skb, linkinfo); 698 return 0; 699 700 err_cancel_link: 701 nla_nest_cancel(skb, linkinfo); 702 out: 703 return err; 704 } 705 706 int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo) 707 { 708 struct sock *rtnl = net->rtnl; 709 int err = 0; 710 711 NETLINK_CB(skb).dst_group = group; 712 if (echo) 713 refcount_inc(&skb->users); 714 netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL); 715 if (echo) 716 err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT); 717 return err; 718 } 719 720 int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid) 721 { 722 struct sock *rtnl = net->rtnl; 723 724 return nlmsg_unicast(rtnl, skb, pid); 725 } 726 EXPORT_SYMBOL(rtnl_unicast); 727 728 void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group, 729 struct nlmsghdr *nlh, gfp_t flags) 730 { 731 struct sock *rtnl = net->rtnl; 732 int report = 0; 733 734 if (nlh) 735 report = nlmsg_report(nlh); 736 737 nlmsg_notify(rtnl, skb, pid, group, report, flags); 738 } 739 EXPORT_SYMBOL(rtnl_notify); 740 741 void rtnl_set_sk_err(struct net *net, u32 group, int error) 742 { 743 struct sock *rtnl = net->rtnl; 744 745 netlink_set_err(rtnl, 0, group, error); 746 } 747 EXPORT_SYMBOL(rtnl_set_sk_err); 748 749 int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics) 750 { 751 struct nlattr *mx; 752 int i, valid = 0; 753 754 /* nothing is dumped for dst_default_metrics, so just skip the loop */ 755 if (metrics == dst_default_metrics.metrics) 756 return 0; 757 758 mx = nla_nest_start_noflag(skb, RTA_METRICS); 759 if (mx == NULL) 760 return -ENOBUFS; 761 762 for (i = 0; i < RTAX_MAX; i++) { 763 if (metrics[i]) { 764 if (i == RTAX_CC_ALGO - 1) { 765 char tmp[TCP_CA_NAME_MAX], *name; 766 767 name = tcp_ca_get_name_by_key(metrics[i], tmp); 768 if (!name) 769 continue; 770 if (nla_put_string(skb, i + 1, name)) 771 goto nla_put_failure; 772 } else if (i == RTAX_FEATURES - 1) { 773 u32 user_features = metrics[i] & RTAX_FEATURE_MASK; 774 775 if (!user_features) 776 continue; 777 BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK); 778 if (nla_put_u32(skb, i + 1, user_features)) 779 goto nla_put_failure; 780 } else { 781 if (nla_put_u32(skb, i + 1, metrics[i])) 782 goto nla_put_failure; 783 } 784 valid++; 785 } 786 } 787 788 if (!valid) { 789 nla_nest_cancel(skb, mx); 790 return 0; 791 } 792 793 return nla_nest_end(skb, mx); 794 795 nla_put_failure: 796 nla_nest_cancel(skb, mx); 797 return -EMSGSIZE; 798 } 799 EXPORT_SYMBOL(rtnetlink_put_metrics); 800 801 int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id, 802 long expires, u32 error) 803 { 804 struct rta_cacheinfo ci = { 805 .rta_error = error, 806 .rta_id = id, 807 }; 808 809 if (dst) { 810 ci.rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse); 811 ci.rta_used = dst->__use; 812 ci.rta_clntref = atomic_read(&dst->__refcnt); 813 } 814 if (expires) { 815 unsigned long clock; 816 817 clock = jiffies_to_clock_t(abs(expires)); 818 clock = min_t(unsigned long, clock, INT_MAX); 819 ci.rta_expires = (expires > 0) ? clock : -clock; 820 } 821 return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci); 822 } 823 EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo); 824 825 static void set_operstate(struct net_device *dev, unsigned char transition) 826 { 827 unsigned char operstate = dev->operstate; 828 829 switch (transition) { 830 case IF_OPER_UP: 831 if ((operstate == IF_OPER_DORMANT || 832 operstate == IF_OPER_UNKNOWN) && 833 !netif_dormant(dev)) 834 operstate = IF_OPER_UP; 835 break; 836 837 case IF_OPER_DORMANT: 838 if (operstate == IF_OPER_UP || 839 operstate == IF_OPER_UNKNOWN) 840 operstate = IF_OPER_DORMANT; 841 break; 842 } 843 844 if (dev->operstate != operstate) { 845 write_lock_bh(&dev_base_lock); 846 dev->operstate = operstate; 847 write_unlock_bh(&dev_base_lock); 848 netdev_state_change(dev); 849 } 850 } 851 852 static unsigned int rtnl_dev_get_flags(const struct net_device *dev) 853 { 854 return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) | 855 (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI)); 856 } 857 858 static unsigned int rtnl_dev_combine_flags(const struct net_device *dev, 859 const struct ifinfomsg *ifm) 860 { 861 unsigned int flags = ifm->ifi_flags; 862 863 /* bugwards compatibility: ifi_change == 0 is treated as ~0 */ 864 if (ifm->ifi_change) 865 flags = (flags & ifm->ifi_change) | 866 (rtnl_dev_get_flags(dev) & ~ifm->ifi_change); 867 868 return flags; 869 } 870 871 static void copy_rtnl_link_stats(struct rtnl_link_stats *a, 872 const struct rtnl_link_stats64 *b) 873 { 874 a->rx_packets = b->rx_packets; 875 a->tx_packets = b->tx_packets; 876 a->rx_bytes = b->rx_bytes; 877 a->tx_bytes = b->tx_bytes; 878 a->rx_errors = b->rx_errors; 879 a->tx_errors = b->tx_errors; 880 a->rx_dropped = b->rx_dropped; 881 a->tx_dropped = b->tx_dropped; 882 883 a->multicast = b->multicast; 884 a->collisions = b->collisions; 885 886 a->rx_length_errors = b->rx_length_errors; 887 a->rx_over_errors = b->rx_over_errors; 888 a->rx_crc_errors = b->rx_crc_errors; 889 a->rx_frame_errors = b->rx_frame_errors; 890 a->rx_fifo_errors = b->rx_fifo_errors; 891 a->rx_missed_errors = b->rx_missed_errors; 892 893 a->tx_aborted_errors = b->tx_aborted_errors; 894 a->tx_carrier_errors = b->tx_carrier_errors; 895 a->tx_fifo_errors = b->tx_fifo_errors; 896 a->tx_heartbeat_errors = b->tx_heartbeat_errors; 897 a->tx_window_errors = b->tx_window_errors; 898 899 a->rx_compressed = b->rx_compressed; 900 a->tx_compressed = b->tx_compressed; 901 902 a->rx_nohandler = b->rx_nohandler; 903 } 904 905 /* All VF info */ 906 static inline int rtnl_vfinfo_size(const struct net_device *dev, 907 u32 ext_filter_mask) 908 { 909 if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) { 910 int num_vfs = dev_num_vf(dev->dev.parent); 911 size_t size = nla_total_size(0); 912 size += num_vfs * 913 (nla_total_size(0) + 914 nla_total_size(sizeof(struct ifla_vf_mac)) + 915 nla_total_size(sizeof(struct ifla_vf_broadcast)) + 916 nla_total_size(sizeof(struct ifla_vf_vlan)) + 917 nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */ 918 nla_total_size(MAX_VLAN_LIST_LEN * 919 sizeof(struct ifla_vf_vlan_info)) + 920 nla_total_size(sizeof(struct ifla_vf_spoofchk)) + 921 nla_total_size(sizeof(struct ifla_vf_tx_rate)) + 922 nla_total_size(sizeof(struct ifla_vf_rate)) + 923 nla_total_size(sizeof(struct ifla_vf_link_state)) + 924 nla_total_size(sizeof(struct ifla_vf_rss_query_en)) + 925 nla_total_size(0) + /* nest IFLA_VF_STATS */ 926 /* IFLA_VF_STATS_RX_PACKETS */ 927 nla_total_size_64bit(sizeof(__u64)) + 928 /* IFLA_VF_STATS_TX_PACKETS */ 929 nla_total_size_64bit(sizeof(__u64)) + 930 /* IFLA_VF_STATS_RX_BYTES */ 931 nla_total_size_64bit(sizeof(__u64)) + 932 /* IFLA_VF_STATS_TX_BYTES */ 933 nla_total_size_64bit(sizeof(__u64)) + 934 /* IFLA_VF_STATS_BROADCAST */ 935 nla_total_size_64bit(sizeof(__u64)) + 936 /* IFLA_VF_STATS_MULTICAST */ 937 nla_total_size_64bit(sizeof(__u64)) + 938 /* IFLA_VF_STATS_RX_DROPPED */ 939 nla_total_size_64bit(sizeof(__u64)) + 940 /* IFLA_VF_STATS_TX_DROPPED */ 941 nla_total_size_64bit(sizeof(__u64)) + 942 nla_total_size(sizeof(struct ifla_vf_trust))); 943 return size; 944 } else 945 return 0; 946 } 947 948 static size_t rtnl_port_size(const struct net_device *dev, 949 u32 ext_filter_mask) 950 { 951 size_t port_size = nla_total_size(4) /* PORT_VF */ 952 + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ 953 + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ 954 + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ 955 + nla_total_size(1) /* PROT_VDP_REQUEST */ 956 + nla_total_size(2); /* PORT_VDP_RESPONSE */ 957 size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); 958 size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) 959 + port_size; 960 size_t port_self_size = nla_total_size(sizeof(struct nlattr)) 961 + port_size; 962 963 if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 964 !(ext_filter_mask & RTEXT_FILTER_VF)) 965 return 0; 966 if (dev_num_vf(dev->dev.parent)) 967 return port_self_size + vf_ports_size + 968 vf_port_size * dev_num_vf(dev->dev.parent); 969 else 970 return port_self_size; 971 } 972 973 static size_t rtnl_xdp_size(void) 974 { 975 size_t xdp_size = nla_total_size(0) + /* nest IFLA_XDP */ 976 nla_total_size(1) + /* XDP_ATTACHED */ 977 nla_total_size(4) + /* XDP_PROG_ID (or 1st mode) */ 978 nla_total_size(4); /* XDP_<mode>_PROG_ID */ 979 980 return xdp_size; 981 } 982 983 static size_t rtnl_prop_list_size(const struct net_device *dev) 984 { 985 struct netdev_name_node *name_node; 986 size_t size; 987 988 if (list_empty(&dev->name_node->list)) 989 return 0; 990 size = nla_total_size(0); 991 list_for_each_entry(name_node, &dev->name_node->list, list) 992 size += nla_total_size(ALTIFNAMSIZ); 993 return size; 994 } 995 996 static noinline size_t if_nlmsg_size(const struct net_device *dev, 997 u32 ext_filter_mask) 998 { 999 return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 1000 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 1001 + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ 1002 + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ 1003 + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap)) 1004 + nla_total_size(sizeof(struct rtnl_link_stats)) 1005 + nla_total_size_64bit(sizeof(struct rtnl_link_stats64)) 1006 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 1007 + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ 1008 + nla_total_size(4) /* IFLA_TXQLEN */ 1009 + nla_total_size(4) /* IFLA_WEIGHT */ 1010 + nla_total_size(4) /* IFLA_MTU */ 1011 + nla_total_size(4) /* IFLA_LINK */ 1012 + nla_total_size(4) /* IFLA_MASTER */ 1013 + nla_total_size(1) /* IFLA_CARRIER */ 1014 + nla_total_size(4) /* IFLA_PROMISCUITY */ 1015 + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */ 1016 + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */ 1017 + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */ 1018 + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */ 1019 + nla_total_size(1) /* IFLA_OPERSTATE */ 1020 + nla_total_size(1) /* IFLA_LINKMODE */ 1021 + nla_total_size(4) /* IFLA_CARRIER_CHANGES */ 1022 + nla_total_size(4) /* IFLA_LINK_NETNSID */ 1023 + nla_total_size(4) /* IFLA_GROUP */ 1024 + nla_total_size(ext_filter_mask 1025 & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */ 1026 + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */ 1027 + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ 1028 + rtnl_link_get_size(dev) /* IFLA_LINKINFO */ 1029 + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */ 1030 + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */ 1031 + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */ 1032 + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */ 1033 + rtnl_xdp_size() /* IFLA_XDP */ 1034 + nla_total_size(4) /* IFLA_EVENT */ 1035 + nla_total_size(4) /* IFLA_NEW_NETNSID */ 1036 + nla_total_size(4) /* IFLA_NEW_IFINDEX */ 1037 + nla_total_size(1) /* IFLA_PROTO_DOWN */ 1038 + nla_total_size(4) /* IFLA_TARGET_NETNSID */ 1039 + nla_total_size(4) /* IFLA_CARRIER_UP_COUNT */ 1040 + nla_total_size(4) /* IFLA_CARRIER_DOWN_COUNT */ 1041 + nla_total_size(4) /* IFLA_MIN_MTU */ 1042 + nla_total_size(4) /* IFLA_MAX_MTU */ 1043 + rtnl_prop_list_size(dev) 1044 + nla_total_size(MAX_ADDR_LEN) /* IFLA_PERM_ADDRESS */ 1045 + 0; 1046 } 1047 1048 static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) 1049 { 1050 struct nlattr *vf_ports; 1051 struct nlattr *vf_port; 1052 int vf; 1053 int err; 1054 1055 vf_ports = nla_nest_start_noflag(skb, IFLA_VF_PORTS); 1056 if (!vf_ports) 1057 return -EMSGSIZE; 1058 1059 for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { 1060 vf_port = nla_nest_start_noflag(skb, IFLA_VF_PORT); 1061 if (!vf_port) 1062 goto nla_put_failure; 1063 if (nla_put_u32(skb, IFLA_PORT_VF, vf)) 1064 goto nla_put_failure; 1065 err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); 1066 if (err == -EMSGSIZE) 1067 goto nla_put_failure; 1068 if (err) { 1069 nla_nest_cancel(skb, vf_port); 1070 continue; 1071 } 1072 nla_nest_end(skb, vf_port); 1073 } 1074 1075 nla_nest_end(skb, vf_ports); 1076 1077 return 0; 1078 1079 nla_put_failure: 1080 nla_nest_cancel(skb, vf_ports); 1081 return -EMSGSIZE; 1082 } 1083 1084 static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) 1085 { 1086 struct nlattr *port_self; 1087 int err; 1088 1089 port_self = nla_nest_start_noflag(skb, IFLA_PORT_SELF); 1090 if (!port_self) 1091 return -EMSGSIZE; 1092 1093 err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); 1094 if (err) { 1095 nla_nest_cancel(skb, port_self); 1096 return (err == -EMSGSIZE) ? err : 0; 1097 } 1098 1099 nla_nest_end(skb, port_self); 1100 1101 return 0; 1102 } 1103 1104 static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev, 1105 u32 ext_filter_mask) 1106 { 1107 int err; 1108 1109 if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 1110 !(ext_filter_mask & RTEXT_FILTER_VF)) 1111 return 0; 1112 1113 err = rtnl_port_self_fill(skb, dev); 1114 if (err) 1115 return err; 1116 1117 if (dev_num_vf(dev->dev.parent)) { 1118 err = rtnl_vf_ports_fill(skb, dev); 1119 if (err) 1120 return err; 1121 } 1122 1123 return 0; 1124 } 1125 1126 static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev) 1127 { 1128 int err; 1129 struct netdev_phys_item_id ppid; 1130 1131 err = dev_get_phys_port_id(dev, &ppid); 1132 if (err) { 1133 if (err == -EOPNOTSUPP) 1134 return 0; 1135 return err; 1136 } 1137 1138 if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id)) 1139 return -EMSGSIZE; 1140 1141 return 0; 1142 } 1143 1144 static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev) 1145 { 1146 char name[IFNAMSIZ]; 1147 int err; 1148 1149 err = dev_get_phys_port_name(dev, name, sizeof(name)); 1150 if (err) { 1151 if (err == -EOPNOTSUPP) 1152 return 0; 1153 return err; 1154 } 1155 1156 if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name)) 1157 return -EMSGSIZE; 1158 1159 return 0; 1160 } 1161 1162 static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev) 1163 { 1164 struct netdev_phys_item_id ppid = { }; 1165 int err; 1166 1167 err = dev_get_port_parent_id(dev, &ppid, false); 1168 if (err) { 1169 if (err == -EOPNOTSUPP) 1170 return 0; 1171 return err; 1172 } 1173 1174 if (nla_put(skb, IFLA_PHYS_SWITCH_ID, ppid.id_len, ppid.id)) 1175 return -EMSGSIZE; 1176 1177 return 0; 1178 } 1179 1180 static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb, 1181 struct net_device *dev) 1182 { 1183 struct rtnl_link_stats64 *sp; 1184 struct nlattr *attr; 1185 1186 attr = nla_reserve_64bit(skb, IFLA_STATS64, 1187 sizeof(struct rtnl_link_stats64), IFLA_PAD); 1188 if (!attr) 1189 return -EMSGSIZE; 1190 1191 sp = nla_data(attr); 1192 dev_get_stats(dev, sp); 1193 1194 attr = nla_reserve(skb, IFLA_STATS, 1195 sizeof(struct rtnl_link_stats)); 1196 if (!attr) 1197 return -EMSGSIZE; 1198 1199 copy_rtnl_link_stats(nla_data(attr), sp); 1200 1201 return 0; 1202 } 1203 1204 static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb, 1205 struct net_device *dev, 1206 int vfs_num, 1207 struct nlattr *vfinfo) 1208 { 1209 struct ifla_vf_rss_query_en vf_rss_query_en; 1210 struct nlattr *vf, *vfstats, *vfvlanlist; 1211 struct ifla_vf_link_state vf_linkstate; 1212 struct ifla_vf_vlan_info vf_vlan_info; 1213 struct ifla_vf_spoofchk vf_spoofchk; 1214 struct ifla_vf_tx_rate vf_tx_rate; 1215 struct ifla_vf_stats vf_stats; 1216 struct ifla_vf_trust vf_trust; 1217 struct ifla_vf_vlan vf_vlan; 1218 struct ifla_vf_rate vf_rate; 1219 struct ifla_vf_mac vf_mac; 1220 struct ifla_vf_broadcast vf_broadcast; 1221 struct ifla_vf_info ivi; 1222 struct ifla_vf_guid node_guid; 1223 struct ifla_vf_guid port_guid; 1224 1225 memset(&ivi, 0, sizeof(ivi)); 1226 1227 /* Not all SR-IOV capable drivers support the 1228 * spoofcheck and "RSS query enable" query. Preset to 1229 * -1 so the user space tool can detect that the driver 1230 * didn't report anything. 1231 */ 1232 ivi.spoofchk = -1; 1233 ivi.rss_query_en = -1; 1234 ivi.trusted = -1; 1235 /* The default value for VF link state is "auto" 1236 * IFLA_VF_LINK_STATE_AUTO which equals zero 1237 */ 1238 ivi.linkstate = 0; 1239 /* VLAN Protocol by default is 802.1Q */ 1240 ivi.vlan_proto = htons(ETH_P_8021Q); 1241 if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi)) 1242 return 0; 1243 1244 memset(&vf_vlan_info, 0, sizeof(vf_vlan_info)); 1245 1246 vf_mac.vf = 1247 vf_vlan.vf = 1248 vf_vlan_info.vf = 1249 vf_rate.vf = 1250 vf_tx_rate.vf = 1251 vf_spoofchk.vf = 1252 vf_linkstate.vf = 1253 vf_rss_query_en.vf = 1254 vf_trust.vf = 1255 node_guid.vf = 1256 port_guid.vf = ivi.vf; 1257 1258 memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); 1259 memcpy(vf_broadcast.broadcast, dev->broadcast, dev->addr_len); 1260 vf_vlan.vlan = ivi.vlan; 1261 vf_vlan.qos = ivi.qos; 1262 vf_vlan_info.vlan = ivi.vlan; 1263 vf_vlan_info.qos = ivi.qos; 1264 vf_vlan_info.vlan_proto = ivi.vlan_proto; 1265 vf_tx_rate.rate = ivi.max_tx_rate; 1266 vf_rate.min_tx_rate = ivi.min_tx_rate; 1267 vf_rate.max_tx_rate = ivi.max_tx_rate; 1268 vf_spoofchk.setting = ivi.spoofchk; 1269 vf_linkstate.link_state = ivi.linkstate; 1270 vf_rss_query_en.setting = ivi.rss_query_en; 1271 vf_trust.setting = ivi.trusted; 1272 vf = nla_nest_start_noflag(skb, IFLA_VF_INFO); 1273 if (!vf) 1274 goto nla_put_vfinfo_failure; 1275 if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) || 1276 nla_put(skb, IFLA_VF_BROADCAST, sizeof(vf_broadcast), &vf_broadcast) || 1277 nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) || 1278 nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate), 1279 &vf_rate) || 1280 nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), 1281 &vf_tx_rate) || 1282 nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk), 1283 &vf_spoofchk) || 1284 nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate), 1285 &vf_linkstate) || 1286 nla_put(skb, IFLA_VF_RSS_QUERY_EN, 1287 sizeof(vf_rss_query_en), 1288 &vf_rss_query_en) || 1289 nla_put(skb, IFLA_VF_TRUST, 1290 sizeof(vf_trust), &vf_trust)) 1291 goto nla_put_vf_failure; 1292 1293 memset(&node_guid, 0, sizeof(node_guid)); 1294 memset(&port_guid, 0, sizeof(port_guid)); 1295 if (dev->netdev_ops->ndo_get_vf_guid && 1296 !dev->netdev_ops->ndo_get_vf_guid(dev, vfs_num, &node_guid, 1297 &port_guid)) { 1298 if (nla_put(skb, IFLA_VF_IB_NODE_GUID, sizeof(node_guid), 1299 &node_guid) || 1300 nla_put(skb, IFLA_VF_IB_PORT_GUID, sizeof(port_guid), 1301 &port_guid)) 1302 goto nla_put_vf_failure; 1303 } 1304 vfvlanlist = nla_nest_start_noflag(skb, IFLA_VF_VLAN_LIST); 1305 if (!vfvlanlist) 1306 goto nla_put_vf_failure; 1307 if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info), 1308 &vf_vlan_info)) { 1309 nla_nest_cancel(skb, vfvlanlist); 1310 goto nla_put_vf_failure; 1311 } 1312 nla_nest_end(skb, vfvlanlist); 1313 memset(&vf_stats, 0, sizeof(vf_stats)); 1314 if (dev->netdev_ops->ndo_get_vf_stats) 1315 dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num, 1316 &vf_stats); 1317 vfstats = nla_nest_start_noflag(skb, IFLA_VF_STATS); 1318 if (!vfstats) 1319 goto nla_put_vf_failure; 1320 if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS, 1321 vf_stats.rx_packets, IFLA_VF_STATS_PAD) || 1322 nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS, 1323 vf_stats.tx_packets, IFLA_VF_STATS_PAD) || 1324 nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES, 1325 vf_stats.rx_bytes, IFLA_VF_STATS_PAD) || 1326 nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES, 1327 vf_stats.tx_bytes, IFLA_VF_STATS_PAD) || 1328 nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST, 1329 vf_stats.broadcast, IFLA_VF_STATS_PAD) || 1330 nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST, 1331 vf_stats.multicast, IFLA_VF_STATS_PAD) || 1332 nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_DROPPED, 1333 vf_stats.rx_dropped, IFLA_VF_STATS_PAD) || 1334 nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_DROPPED, 1335 vf_stats.tx_dropped, IFLA_VF_STATS_PAD)) { 1336 nla_nest_cancel(skb, vfstats); 1337 goto nla_put_vf_failure; 1338 } 1339 nla_nest_end(skb, vfstats); 1340 nla_nest_end(skb, vf); 1341 return 0; 1342 1343 nla_put_vf_failure: 1344 nla_nest_cancel(skb, vf); 1345 nla_put_vfinfo_failure: 1346 nla_nest_cancel(skb, vfinfo); 1347 return -EMSGSIZE; 1348 } 1349 1350 static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb, 1351 struct net_device *dev, 1352 u32 ext_filter_mask) 1353 { 1354 struct nlattr *vfinfo; 1355 int i, num_vfs; 1356 1357 if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0)) 1358 return 0; 1359 1360 num_vfs = dev_num_vf(dev->dev.parent); 1361 if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs)) 1362 return -EMSGSIZE; 1363 1364 if (!dev->netdev_ops->ndo_get_vf_config) 1365 return 0; 1366 1367 vfinfo = nla_nest_start_noflag(skb, IFLA_VFINFO_LIST); 1368 if (!vfinfo) 1369 return -EMSGSIZE; 1370 1371 for (i = 0; i < num_vfs; i++) { 1372 if (rtnl_fill_vfinfo(skb, dev, i, vfinfo)) 1373 return -EMSGSIZE; 1374 } 1375 1376 nla_nest_end(skb, vfinfo); 1377 return 0; 1378 } 1379 1380 static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev) 1381 { 1382 struct rtnl_link_ifmap map; 1383 1384 memset(&map, 0, sizeof(map)); 1385 map.mem_start = dev->mem_start; 1386 map.mem_end = dev->mem_end; 1387 map.base_addr = dev->base_addr; 1388 map.irq = dev->irq; 1389 map.dma = dev->dma; 1390 map.port = dev->if_port; 1391 1392 if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD)) 1393 return -EMSGSIZE; 1394 1395 return 0; 1396 } 1397 1398 static u32 rtnl_xdp_prog_skb(struct net_device *dev) 1399 { 1400 const struct bpf_prog *generic_xdp_prog; 1401 1402 ASSERT_RTNL(); 1403 1404 generic_xdp_prog = rtnl_dereference(dev->xdp_prog); 1405 if (!generic_xdp_prog) 1406 return 0; 1407 return generic_xdp_prog->aux->id; 1408 } 1409 1410 static u32 rtnl_xdp_prog_drv(struct net_device *dev) 1411 { 1412 return __dev_xdp_query(dev, dev->netdev_ops->ndo_bpf, XDP_QUERY_PROG); 1413 } 1414 1415 static u32 rtnl_xdp_prog_hw(struct net_device *dev) 1416 { 1417 return __dev_xdp_query(dev, dev->netdev_ops->ndo_bpf, 1418 XDP_QUERY_PROG_HW); 1419 } 1420 1421 static int rtnl_xdp_report_one(struct sk_buff *skb, struct net_device *dev, 1422 u32 *prog_id, u8 *mode, u8 tgt_mode, u32 attr, 1423 u32 (*get_prog_id)(struct net_device *dev)) 1424 { 1425 u32 curr_id; 1426 int err; 1427 1428 curr_id = get_prog_id(dev); 1429 if (!curr_id) 1430 return 0; 1431 1432 *prog_id = curr_id; 1433 err = nla_put_u32(skb, attr, curr_id); 1434 if (err) 1435 return err; 1436 1437 if (*mode != XDP_ATTACHED_NONE) 1438 *mode = XDP_ATTACHED_MULTI; 1439 else 1440 *mode = tgt_mode; 1441 1442 return 0; 1443 } 1444 1445 static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev) 1446 { 1447 struct nlattr *xdp; 1448 u32 prog_id; 1449 int err; 1450 u8 mode; 1451 1452 xdp = nla_nest_start_noflag(skb, IFLA_XDP); 1453 if (!xdp) 1454 return -EMSGSIZE; 1455 1456 prog_id = 0; 1457 mode = XDP_ATTACHED_NONE; 1458 err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_SKB, 1459 IFLA_XDP_SKB_PROG_ID, rtnl_xdp_prog_skb); 1460 if (err) 1461 goto err_cancel; 1462 err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_DRV, 1463 IFLA_XDP_DRV_PROG_ID, rtnl_xdp_prog_drv); 1464 if (err) 1465 goto err_cancel; 1466 err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_HW, 1467 IFLA_XDP_HW_PROG_ID, rtnl_xdp_prog_hw); 1468 if (err) 1469 goto err_cancel; 1470 1471 err = nla_put_u8(skb, IFLA_XDP_ATTACHED, mode); 1472 if (err) 1473 goto err_cancel; 1474 1475 if (prog_id && mode != XDP_ATTACHED_MULTI) { 1476 err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id); 1477 if (err) 1478 goto err_cancel; 1479 } 1480 1481 nla_nest_end(skb, xdp); 1482 return 0; 1483 1484 err_cancel: 1485 nla_nest_cancel(skb, xdp); 1486 return err; 1487 } 1488 1489 static u32 rtnl_get_event(unsigned long event) 1490 { 1491 u32 rtnl_event_type = IFLA_EVENT_NONE; 1492 1493 switch (event) { 1494 case NETDEV_REBOOT: 1495 rtnl_event_type = IFLA_EVENT_REBOOT; 1496 break; 1497 case NETDEV_FEAT_CHANGE: 1498 rtnl_event_type = IFLA_EVENT_FEATURES; 1499 break; 1500 case NETDEV_BONDING_FAILOVER: 1501 rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER; 1502 break; 1503 case NETDEV_NOTIFY_PEERS: 1504 rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS; 1505 break; 1506 case NETDEV_RESEND_IGMP: 1507 rtnl_event_type = IFLA_EVENT_IGMP_RESEND; 1508 break; 1509 case NETDEV_CHANGEINFODATA: 1510 rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS; 1511 break; 1512 default: 1513 break; 1514 } 1515 1516 return rtnl_event_type; 1517 } 1518 1519 static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev) 1520 { 1521 const struct net_device *upper_dev; 1522 int ret = 0; 1523 1524 rcu_read_lock(); 1525 1526 upper_dev = netdev_master_upper_dev_get_rcu(dev); 1527 if (upper_dev) 1528 ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex); 1529 1530 rcu_read_unlock(); 1531 return ret; 1532 } 1533 1534 static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev, 1535 bool force) 1536 { 1537 int ifindex = dev_get_iflink(dev); 1538 1539 if (force || dev->ifindex != ifindex) 1540 return nla_put_u32(skb, IFLA_LINK, ifindex); 1541 1542 return 0; 1543 } 1544 1545 static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb, 1546 struct net_device *dev) 1547 { 1548 char buf[IFALIASZ]; 1549 int ret; 1550 1551 ret = dev_get_alias(dev, buf, sizeof(buf)); 1552 return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0; 1553 } 1554 1555 static int rtnl_fill_link_netnsid(struct sk_buff *skb, 1556 const struct net_device *dev, 1557 struct net *src_net, gfp_t gfp) 1558 { 1559 bool put_iflink = false; 1560 1561 if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) { 1562 struct net *link_net = dev->rtnl_link_ops->get_link_net(dev); 1563 1564 if (!net_eq(dev_net(dev), link_net)) { 1565 int id = peernet2id_alloc(src_net, link_net, gfp); 1566 1567 if (nla_put_s32(skb, IFLA_LINK_NETNSID, id)) 1568 return -EMSGSIZE; 1569 1570 put_iflink = true; 1571 } 1572 } 1573 1574 return nla_put_iflink(skb, dev, put_iflink); 1575 } 1576 1577 static int rtnl_fill_link_af(struct sk_buff *skb, 1578 const struct net_device *dev, 1579 u32 ext_filter_mask) 1580 { 1581 const struct rtnl_af_ops *af_ops; 1582 struct nlattr *af_spec; 1583 1584 af_spec = nla_nest_start_noflag(skb, IFLA_AF_SPEC); 1585 if (!af_spec) 1586 return -EMSGSIZE; 1587 1588 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 1589 struct nlattr *af; 1590 int err; 1591 1592 if (!af_ops->fill_link_af) 1593 continue; 1594 1595 af = nla_nest_start_noflag(skb, af_ops->family); 1596 if (!af) 1597 return -EMSGSIZE; 1598 1599 err = af_ops->fill_link_af(skb, dev, ext_filter_mask); 1600 /* 1601 * Caller may return ENODATA to indicate that there 1602 * was no data to be dumped. This is not an error, it 1603 * means we should trim the attribute header and 1604 * continue. 1605 */ 1606 if (err == -ENODATA) 1607 nla_nest_cancel(skb, af); 1608 else if (err < 0) 1609 return -EMSGSIZE; 1610 1611 nla_nest_end(skb, af); 1612 } 1613 1614 nla_nest_end(skb, af_spec); 1615 return 0; 1616 } 1617 1618 static int rtnl_fill_alt_ifnames(struct sk_buff *skb, 1619 const struct net_device *dev) 1620 { 1621 struct netdev_name_node *name_node; 1622 int count = 0; 1623 1624 list_for_each_entry(name_node, &dev->name_node->list, list) { 1625 if (nla_put_string(skb, IFLA_ALT_IFNAME, name_node->name)) 1626 return -EMSGSIZE; 1627 count++; 1628 } 1629 return count; 1630 } 1631 1632 static int rtnl_fill_prop_list(struct sk_buff *skb, 1633 const struct net_device *dev) 1634 { 1635 struct nlattr *prop_list; 1636 int ret; 1637 1638 prop_list = nla_nest_start(skb, IFLA_PROP_LIST); 1639 if (!prop_list) 1640 return -EMSGSIZE; 1641 1642 ret = rtnl_fill_alt_ifnames(skb, dev); 1643 if (ret <= 0) 1644 goto nest_cancel; 1645 1646 nla_nest_end(skb, prop_list); 1647 return 0; 1648 1649 nest_cancel: 1650 nla_nest_cancel(skb, prop_list); 1651 return ret; 1652 } 1653 1654 static int rtnl_fill_ifinfo(struct sk_buff *skb, 1655 struct net_device *dev, struct net *src_net, 1656 int type, u32 pid, u32 seq, u32 change, 1657 unsigned int flags, u32 ext_filter_mask, 1658 u32 event, int *new_nsid, int new_ifindex, 1659 int tgt_netnsid, gfp_t gfp) 1660 { 1661 struct ifinfomsg *ifm; 1662 struct nlmsghdr *nlh; 1663 1664 ASSERT_RTNL(); 1665 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); 1666 if (nlh == NULL) 1667 return -EMSGSIZE; 1668 1669 ifm = nlmsg_data(nlh); 1670 ifm->ifi_family = AF_UNSPEC; 1671 ifm->__ifi_pad = 0; 1672 ifm->ifi_type = dev->type; 1673 ifm->ifi_index = dev->ifindex; 1674 ifm->ifi_flags = dev_get_flags(dev); 1675 ifm->ifi_change = change; 1676 1677 if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_TARGET_NETNSID, tgt_netnsid)) 1678 goto nla_put_failure; 1679 1680 if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 1681 nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) || 1682 nla_put_u8(skb, IFLA_OPERSTATE, 1683 netif_running(dev) ? dev->operstate : IF_OPER_DOWN) || 1684 nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) || 1685 nla_put_u32(skb, IFLA_MTU, dev->mtu) || 1686 nla_put_u32(skb, IFLA_MIN_MTU, dev->min_mtu) || 1687 nla_put_u32(skb, IFLA_MAX_MTU, dev->max_mtu) || 1688 nla_put_u32(skb, IFLA_GROUP, dev->group) || 1689 nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) || 1690 nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) || 1691 nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) || 1692 nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) || 1693 #ifdef CONFIG_RPS 1694 nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) || 1695 #endif 1696 put_master_ifindex(skb, dev) || 1697 nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) || 1698 (dev->qdisc && 1699 nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) || 1700 nla_put_ifalias(skb, dev) || 1701 nla_put_u32(skb, IFLA_CARRIER_CHANGES, 1702 atomic_read(&dev->carrier_up_count) + 1703 atomic_read(&dev->carrier_down_count)) || 1704 nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down) || 1705 nla_put_u32(skb, IFLA_CARRIER_UP_COUNT, 1706 atomic_read(&dev->carrier_up_count)) || 1707 nla_put_u32(skb, IFLA_CARRIER_DOWN_COUNT, 1708 atomic_read(&dev->carrier_down_count))) 1709 goto nla_put_failure; 1710 1711 if (event != IFLA_EVENT_NONE) { 1712 if (nla_put_u32(skb, IFLA_EVENT, event)) 1713 goto nla_put_failure; 1714 } 1715 1716 if (rtnl_fill_link_ifmap(skb, dev)) 1717 goto nla_put_failure; 1718 1719 if (dev->addr_len) { 1720 if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) || 1721 nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast)) 1722 goto nla_put_failure; 1723 } 1724 1725 if (rtnl_phys_port_id_fill(skb, dev)) 1726 goto nla_put_failure; 1727 1728 if (rtnl_phys_port_name_fill(skb, dev)) 1729 goto nla_put_failure; 1730 1731 if (rtnl_phys_switch_id_fill(skb, dev)) 1732 goto nla_put_failure; 1733 1734 if (rtnl_fill_stats(skb, dev)) 1735 goto nla_put_failure; 1736 1737 if (rtnl_fill_vf(skb, dev, ext_filter_mask)) 1738 goto nla_put_failure; 1739 1740 if (rtnl_port_fill(skb, dev, ext_filter_mask)) 1741 goto nla_put_failure; 1742 1743 if (rtnl_xdp_fill(skb, dev)) 1744 goto nla_put_failure; 1745 1746 if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) { 1747 if (rtnl_link_fill(skb, dev) < 0) 1748 goto nla_put_failure; 1749 } 1750 1751 if (rtnl_fill_link_netnsid(skb, dev, src_net, gfp)) 1752 goto nla_put_failure; 1753 1754 if (new_nsid && 1755 nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0) 1756 goto nla_put_failure; 1757 if (new_ifindex && 1758 nla_put_s32(skb, IFLA_NEW_IFINDEX, new_ifindex) < 0) 1759 goto nla_put_failure; 1760 1761 if (memchr_inv(dev->perm_addr, '\0', dev->addr_len) && 1762 nla_put(skb, IFLA_PERM_ADDRESS, dev->addr_len, dev->perm_addr)) 1763 goto nla_put_failure; 1764 1765 rcu_read_lock(); 1766 if (rtnl_fill_link_af(skb, dev, ext_filter_mask)) 1767 goto nla_put_failure_rcu; 1768 rcu_read_unlock(); 1769 1770 if (rtnl_fill_prop_list(skb, dev)) 1771 goto nla_put_failure; 1772 1773 nlmsg_end(skb, nlh); 1774 return 0; 1775 1776 nla_put_failure_rcu: 1777 rcu_read_unlock(); 1778 nla_put_failure: 1779 nlmsg_cancel(skb, nlh); 1780 return -EMSGSIZE; 1781 } 1782 1783 static const struct nla_policy ifla_policy[IFLA_MAX+1] = { 1784 [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, 1785 [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1786 [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1787 [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, 1788 [IFLA_MTU] = { .type = NLA_U32 }, 1789 [IFLA_LINK] = { .type = NLA_U32 }, 1790 [IFLA_MASTER] = { .type = NLA_U32 }, 1791 [IFLA_CARRIER] = { .type = NLA_U8 }, 1792 [IFLA_TXQLEN] = { .type = NLA_U32 }, 1793 [IFLA_WEIGHT] = { .type = NLA_U32 }, 1794 [IFLA_OPERSTATE] = { .type = NLA_U8 }, 1795 [IFLA_LINKMODE] = { .type = NLA_U8 }, 1796 [IFLA_LINKINFO] = { .type = NLA_NESTED }, 1797 [IFLA_NET_NS_PID] = { .type = NLA_U32 }, 1798 [IFLA_NET_NS_FD] = { .type = NLA_U32 }, 1799 /* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to 1800 * allow 0-length string (needed to remove an alias). 1801 */ 1802 [IFLA_IFALIAS] = { .type = NLA_BINARY, .len = IFALIASZ - 1 }, 1803 [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, 1804 [IFLA_VF_PORTS] = { .type = NLA_NESTED }, 1805 [IFLA_PORT_SELF] = { .type = NLA_NESTED }, 1806 [IFLA_AF_SPEC] = { .type = NLA_NESTED }, 1807 [IFLA_EXT_MASK] = { .type = NLA_U32 }, 1808 [IFLA_PROMISCUITY] = { .type = NLA_U32 }, 1809 [IFLA_NUM_TX_QUEUES] = { .type = NLA_U32 }, 1810 [IFLA_NUM_RX_QUEUES] = { .type = NLA_U32 }, 1811 [IFLA_GSO_MAX_SEGS] = { .type = NLA_U32 }, 1812 [IFLA_GSO_MAX_SIZE] = { .type = NLA_U32 }, 1813 [IFLA_PHYS_PORT_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 1814 [IFLA_CARRIER_CHANGES] = { .type = NLA_U32 }, /* ignored */ 1815 [IFLA_PHYS_SWITCH_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 1816 [IFLA_LINK_NETNSID] = { .type = NLA_S32 }, 1817 [IFLA_PROTO_DOWN] = { .type = NLA_U8 }, 1818 [IFLA_XDP] = { .type = NLA_NESTED }, 1819 [IFLA_EVENT] = { .type = NLA_U32 }, 1820 [IFLA_GROUP] = { .type = NLA_U32 }, 1821 [IFLA_TARGET_NETNSID] = { .type = NLA_S32 }, 1822 [IFLA_CARRIER_UP_COUNT] = { .type = NLA_U32 }, 1823 [IFLA_CARRIER_DOWN_COUNT] = { .type = NLA_U32 }, 1824 [IFLA_MIN_MTU] = { .type = NLA_U32 }, 1825 [IFLA_MAX_MTU] = { .type = NLA_U32 }, 1826 [IFLA_PROP_LIST] = { .type = NLA_NESTED }, 1827 [IFLA_ALT_IFNAME] = { .type = NLA_STRING, 1828 .len = ALTIFNAMSIZ - 1 }, 1829 [IFLA_PERM_ADDRESS] = { .type = NLA_REJECT }, 1830 }; 1831 1832 static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { 1833 [IFLA_INFO_KIND] = { .type = NLA_STRING }, 1834 [IFLA_INFO_DATA] = { .type = NLA_NESTED }, 1835 [IFLA_INFO_SLAVE_KIND] = { .type = NLA_STRING }, 1836 [IFLA_INFO_SLAVE_DATA] = { .type = NLA_NESTED }, 1837 }; 1838 1839 static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { 1840 [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) }, 1841 [IFLA_VF_BROADCAST] = { .type = NLA_REJECT }, 1842 [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) }, 1843 [IFLA_VF_VLAN_LIST] = { .type = NLA_NESTED }, 1844 [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) }, 1845 [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) }, 1846 [IFLA_VF_RATE] = { .len = sizeof(struct ifla_vf_rate) }, 1847 [IFLA_VF_LINK_STATE] = { .len = sizeof(struct ifla_vf_link_state) }, 1848 [IFLA_VF_RSS_QUERY_EN] = { .len = sizeof(struct ifla_vf_rss_query_en) }, 1849 [IFLA_VF_STATS] = { .type = NLA_NESTED }, 1850 [IFLA_VF_TRUST] = { .len = sizeof(struct ifla_vf_trust) }, 1851 [IFLA_VF_IB_NODE_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 1852 [IFLA_VF_IB_PORT_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 1853 }; 1854 1855 static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { 1856 [IFLA_PORT_VF] = { .type = NLA_U32 }, 1857 [IFLA_PORT_PROFILE] = { .type = NLA_STRING, 1858 .len = PORT_PROFILE_MAX }, 1859 [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, 1860 .len = PORT_UUID_MAX }, 1861 [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, 1862 .len = PORT_UUID_MAX }, 1863 [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, 1864 [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, 1865 1866 /* Unused, but we need to keep it here since user space could 1867 * fill it. It's also broken with regard to NLA_BINARY use in 1868 * combination with structs. 1869 */ 1870 [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, 1871 .len = sizeof(struct ifla_port_vsi) }, 1872 }; 1873 1874 static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = { 1875 [IFLA_XDP_FD] = { .type = NLA_S32 }, 1876 [IFLA_XDP_ATTACHED] = { .type = NLA_U8 }, 1877 [IFLA_XDP_FLAGS] = { .type = NLA_U32 }, 1878 [IFLA_XDP_PROG_ID] = { .type = NLA_U32 }, 1879 }; 1880 1881 static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla) 1882 { 1883 const struct rtnl_link_ops *ops = NULL; 1884 struct nlattr *linfo[IFLA_INFO_MAX + 1]; 1885 1886 if (nla_parse_nested_deprecated(linfo, IFLA_INFO_MAX, nla, ifla_info_policy, NULL) < 0) 1887 return NULL; 1888 1889 if (linfo[IFLA_INFO_KIND]) { 1890 char kind[MODULE_NAME_LEN]; 1891 1892 nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind)); 1893 ops = rtnl_link_ops_get(kind); 1894 } 1895 1896 return ops; 1897 } 1898 1899 static bool link_master_filtered(struct net_device *dev, int master_idx) 1900 { 1901 struct net_device *master; 1902 1903 if (!master_idx) 1904 return false; 1905 1906 master = netdev_master_upper_dev_get(dev); 1907 if (!master || master->ifindex != master_idx) 1908 return true; 1909 1910 return false; 1911 } 1912 1913 static bool link_kind_filtered(const struct net_device *dev, 1914 const struct rtnl_link_ops *kind_ops) 1915 { 1916 if (kind_ops && dev->rtnl_link_ops != kind_ops) 1917 return true; 1918 1919 return false; 1920 } 1921 1922 static bool link_dump_filtered(struct net_device *dev, 1923 int master_idx, 1924 const struct rtnl_link_ops *kind_ops) 1925 { 1926 if (link_master_filtered(dev, master_idx) || 1927 link_kind_filtered(dev, kind_ops)) 1928 return true; 1929 1930 return false; 1931 } 1932 1933 /** 1934 * rtnl_get_net_ns_capable - Get netns if sufficiently privileged. 1935 * @sk: netlink socket 1936 * @netnsid: network namespace identifier 1937 * 1938 * Returns the network namespace identified by netnsid on success or an error 1939 * pointer on failure. 1940 */ 1941 struct net *rtnl_get_net_ns_capable(struct sock *sk, int netnsid) 1942 { 1943 struct net *net; 1944 1945 net = get_net_ns_by_id(sock_net(sk), netnsid); 1946 if (!net) 1947 return ERR_PTR(-EINVAL); 1948 1949 /* For now, the caller is required to have CAP_NET_ADMIN in 1950 * the user namespace owning the target net ns. 1951 */ 1952 if (!sk_ns_capable(sk, net->user_ns, CAP_NET_ADMIN)) { 1953 put_net(net); 1954 return ERR_PTR(-EACCES); 1955 } 1956 return net; 1957 } 1958 EXPORT_SYMBOL_GPL(rtnl_get_net_ns_capable); 1959 1960 static int rtnl_valid_dump_ifinfo_req(const struct nlmsghdr *nlh, 1961 bool strict_check, struct nlattr **tb, 1962 struct netlink_ext_ack *extack) 1963 { 1964 int hdrlen; 1965 1966 if (strict_check) { 1967 struct ifinfomsg *ifm; 1968 1969 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) { 1970 NL_SET_ERR_MSG(extack, "Invalid header for link dump"); 1971 return -EINVAL; 1972 } 1973 1974 ifm = nlmsg_data(nlh); 1975 if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags || 1976 ifm->ifi_change) { 1977 NL_SET_ERR_MSG(extack, "Invalid values in header for link dump request"); 1978 return -EINVAL; 1979 } 1980 if (ifm->ifi_index) { 1981 NL_SET_ERR_MSG(extack, "Filter by device index not supported for link dumps"); 1982 return -EINVAL; 1983 } 1984 1985 return nlmsg_parse_deprecated_strict(nlh, sizeof(*ifm), tb, 1986 IFLA_MAX, ifla_policy, 1987 extack); 1988 } 1989 1990 /* A hack to preserve kernel<->userspace interface. 1991 * The correct header is ifinfomsg. It is consistent with rtnl_getlink. 1992 * However, before Linux v3.9 the code here assumed rtgenmsg and that's 1993 * what iproute2 < v3.9.0 used. 1994 * We can detect the old iproute2. Even including the IFLA_EXT_MASK 1995 * attribute, its netlink message is shorter than struct ifinfomsg. 1996 */ 1997 hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ? 1998 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 1999 2000 return nlmsg_parse_deprecated(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, 2001 extack); 2002 } 2003 2004 static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) 2005 { 2006 struct netlink_ext_ack *extack = cb->extack; 2007 const struct nlmsghdr *nlh = cb->nlh; 2008 struct net *net = sock_net(skb->sk); 2009 struct net *tgt_net = net; 2010 int h, s_h; 2011 int idx = 0, s_idx; 2012 struct net_device *dev; 2013 struct hlist_head *head; 2014 struct nlattr *tb[IFLA_MAX+1]; 2015 u32 ext_filter_mask = 0; 2016 const struct rtnl_link_ops *kind_ops = NULL; 2017 unsigned int flags = NLM_F_MULTI; 2018 int master_idx = 0; 2019 int netnsid = -1; 2020 int err, i; 2021 2022 s_h = cb->args[0]; 2023 s_idx = cb->args[1]; 2024 2025 err = rtnl_valid_dump_ifinfo_req(nlh, cb->strict_check, tb, extack); 2026 if (err < 0) { 2027 if (cb->strict_check) 2028 return err; 2029 2030 goto walk_entries; 2031 } 2032 2033 for (i = 0; i <= IFLA_MAX; ++i) { 2034 if (!tb[i]) 2035 continue; 2036 2037 /* new attributes should only be added with strict checking */ 2038 switch (i) { 2039 case IFLA_TARGET_NETNSID: 2040 netnsid = nla_get_s32(tb[i]); 2041 tgt_net = rtnl_get_net_ns_capable(skb->sk, netnsid); 2042 if (IS_ERR(tgt_net)) { 2043 NL_SET_ERR_MSG(extack, "Invalid target network namespace id"); 2044 return PTR_ERR(tgt_net); 2045 } 2046 break; 2047 case IFLA_EXT_MASK: 2048 ext_filter_mask = nla_get_u32(tb[i]); 2049 break; 2050 case IFLA_MASTER: 2051 master_idx = nla_get_u32(tb[i]); 2052 break; 2053 case IFLA_LINKINFO: 2054 kind_ops = linkinfo_to_kind_ops(tb[i]); 2055 break; 2056 default: 2057 if (cb->strict_check) { 2058 NL_SET_ERR_MSG(extack, "Unsupported attribute in link dump request"); 2059 return -EINVAL; 2060 } 2061 } 2062 } 2063 2064 if (master_idx || kind_ops) 2065 flags |= NLM_F_DUMP_FILTERED; 2066 2067 walk_entries: 2068 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 2069 idx = 0; 2070 head = &tgt_net->dev_index_head[h]; 2071 hlist_for_each_entry(dev, head, index_hlist) { 2072 if (link_dump_filtered(dev, master_idx, kind_ops)) 2073 goto cont; 2074 if (idx < s_idx) 2075 goto cont; 2076 err = rtnl_fill_ifinfo(skb, dev, net, 2077 RTM_NEWLINK, 2078 NETLINK_CB(cb->skb).portid, 2079 nlh->nlmsg_seq, 0, flags, 2080 ext_filter_mask, 0, NULL, 0, 2081 netnsid, GFP_KERNEL); 2082 2083 if (err < 0) { 2084 if (likely(skb->len)) 2085 goto out; 2086 2087 goto out_err; 2088 } 2089 cont: 2090 idx++; 2091 } 2092 } 2093 out: 2094 err = skb->len; 2095 out_err: 2096 cb->args[1] = idx; 2097 cb->args[0] = h; 2098 cb->seq = net->dev_base_seq; 2099 nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 2100 if (netnsid >= 0) 2101 put_net(tgt_net); 2102 2103 return err; 2104 } 2105 2106 int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len, 2107 struct netlink_ext_ack *exterr) 2108 { 2109 return nla_parse_deprecated(tb, IFLA_MAX, head, len, ifla_policy, 2110 exterr); 2111 } 2112 EXPORT_SYMBOL(rtnl_nla_parse_ifla); 2113 2114 struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) 2115 { 2116 struct net *net; 2117 /* Examine the link attributes and figure out which 2118 * network namespace we are talking about. 2119 */ 2120 if (tb[IFLA_NET_NS_PID]) 2121 net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); 2122 else if (tb[IFLA_NET_NS_FD]) 2123 net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD])); 2124 else 2125 net = get_net(src_net); 2126 return net; 2127 } 2128 EXPORT_SYMBOL(rtnl_link_get_net); 2129 2130 /* Figure out which network namespace we are talking about by 2131 * examining the link attributes in the following order: 2132 * 2133 * 1. IFLA_NET_NS_PID 2134 * 2. IFLA_NET_NS_FD 2135 * 3. IFLA_TARGET_NETNSID 2136 */ 2137 static struct net *rtnl_link_get_net_by_nlattr(struct net *src_net, 2138 struct nlattr *tb[]) 2139 { 2140 struct net *net; 2141 2142 if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) 2143 return rtnl_link_get_net(src_net, tb); 2144 2145 if (!tb[IFLA_TARGET_NETNSID]) 2146 return get_net(src_net); 2147 2148 net = get_net_ns_by_id(src_net, nla_get_u32(tb[IFLA_TARGET_NETNSID])); 2149 if (!net) 2150 return ERR_PTR(-EINVAL); 2151 2152 return net; 2153 } 2154 2155 static struct net *rtnl_link_get_net_capable(const struct sk_buff *skb, 2156 struct net *src_net, 2157 struct nlattr *tb[], int cap) 2158 { 2159 struct net *net; 2160 2161 net = rtnl_link_get_net_by_nlattr(src_net, tb); 2162 if (IS_ERR(net)) 2163 return net; 2164 2165 if (!netlink_ns_capable(skb, net->user_ns, cap)) { 2166 put_net(net); 2167 return ERR_PTR(-EPERM); 2168 } 2169 2170 return net; 2171 } 2172 2173 /* Verify that rtnetlink requests do not pass additional properties 2174 * potentially referring to different network namespaces. 2175 */ 2176 static int rtnl_ensure_unique_netns(struct nlattr *tb[], 2177 struct netlink_ext_ack *extack, 2178 bool netns_id_only) 2179 { 2180 2181 if (netns_id_only) { 2182 if (!tb[IFLA_NET_NS_PID] && !tb[IFLA_NET_NS_FD]) 2183 return 0; 2184 2185 NL_SET_ERR_MSG(extack, "specified netns attribute not supported"); 2186 return -EOPNOTSUPP; 2187 } 2188 2189 if (tb[IFLA_TARGET_NETNSID] && (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD])) 2190 goto invalid_attr; 2191 2192 if (tb[IFLA_NET_NS_PID] && (tb[IFLA_TARGET_NETNSID] || tb[IFLA_NET_NS_FD])) 2193 goto invalid_attr; 2194 2195 if (tb[IFLA_NET_NS_FD] && (tb[IFLA_TARGET_NETNSID] || tb[IFLA_NET_NS_PID])) 2196 goto invalid_attr; 2197 2198 return 0; 2199 2200 invalid_attr: 2201 NL_SET_ERR_MSG(extack, "multiple netns identifying attributes specified"); 2202 return -EINVAL; 2203 } 2204 2205 static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) 2206 { 2207 if (dev) { 2208 if (tb[IFLA_ADDRESS] && 2209 nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) 2210 return -EINVAL; 2211 2212 if (tb[IFLA_BROADCAST] && 2213 nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) 2214 return -EINVAL; 2215 } 2216 2217 if (tb[IFLA_AF_SPEC]) { 2218 struct nlattr *af; 2219 int rem, err; 2220 2221 nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 2222 const struct rtnl_af_ops *af_ops; 2223 2224 rcu_read_lock(); 2225 af_ops = rtnl_af_lookup(nla_type(af)); 2226 if (!af_ops) { 2227 rcu_read_unlock(); 2228 return -EAFNOSUPPORT; 2229 } 2230 2231 if (!af_ops->set_link_af) { 2232 rcu_read_unlock(); 2233 return -EOPNOTSUPP; 2234 } 2235 2236 if (af_ops->validate_link_af) { 2237 err = af_ops->validate_link_af(dev, af); 2238 if (err < 0) { 2239 rcu_read_unlock(); 2240 return err; 2241 } 2242 } 2243 2244 rcu_read_unlock(); 2245 } 2246 } 2247 2248 return 0; 2249 } 2250 2251 static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt, 2252 int guid_type) 2253 { 2254 const struct net_device_ops *ops = dev->netdev_ops; 2255 2256 return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type); 2257 } 2258 2259 static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type) 2260 { 2261 if (dev->type != ARPHRD_INFINIBAND) 2262 return -EOPNOTSUPP; 2263 2264 return handle_infiniband_guid(dev, ivt, guid_type); 2265 } 2266 2267 static int do_setvfinfo(struct net_device *dev, struct nlattr **tb) 2268 { 2269 const struct net_device_ops *ops = dev->netdev_ops; 2270 int err = -EINVAL; 2271 2272 if (tb[IFLA_VF_MAC]) { 2273 struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]); 2274 2275 if (ivm->vf >= INT_MAX) 2276 return -EINVAL; 2277 err = -EOPNOTSUPP; 2278 if (ops->ndo_set_vf_mac) 2279 err = ops->ndo_set_vf_mac(dev, ivm->vf, 2280 ivm->mac); 2281 if (err < 0) 2282 return err; 2283 } 2284 2285 if (tb[IFLA_VF_VLAN]) { 2286 struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]); 2287 2288 if (ivv->vf >= INT_MAX) 2289 return -EINVAL; 2290 err = -EOPNOTSUPP; 2291 if (ops->ndo_set_vf_vlan) 2292 err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan, 2293 ivv->qos, 2294 htons(ETH_P_8021Q)); 2295 if (err < 0) 2296 return err; 2297 } 2298 2299 if (tb[IFLA_VF_VLAN_LIST]) { 2300 struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN]; 2301 struct nlattr *attr; 2302 int rem, len = 0; 2303 2304 err = -EOPNOTSUPP; 2305 if (!ops->ndo_set_vf_vlan) 2306 return err; 2307 2308 nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) { 2309 if (nla_type(attr) != IFLA_VF_VLAN_INFO || 2310 nla_len(attr) < NLA_HDRLEN) { 2311 return -EINVAL; 2312 } 2313 if (len >= MAX_VLAN_LIST_LEN) 2314 return -EOPNOTSUPP; 2315 ivvl[len] = nla_data(attr); 2316 2317 len++; 2318 } 2319 if (len == 0) 2320 return -EINVAL; 2321 2322 if (ivvl[0]->vf >= INT_MAX) 2323 return -EINVAL; 2324 err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan, 2325 ivvl[0]->qos, ivvl[0]->vlan_proto); 2326 if (err < 0) 2327 return err; 2328 } 2329 2330 if (tb[IFLA_VF_TX_RATE]) { 2331 struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]); 2332 struct ifla_vf_info ivf; 2333 2334 if (ivt->vf >= INT_MAX) 2335 return -EINVAL; 2336 err = -EOPNOTSUPP; 2337 if (ops->ndo_get_vf_config) 2338 err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf); 2339 if (err < 0) 2340 return err; 2341 2342 err = -EOPNOTSUPP; 2343 if (ops->ndo_set_vf_rate) 2344 err = ops->ndo_set_vf_rate(dev, ivt->vf, 2345 ivf.min_tx_rate, 2346 ivt->rate); 2347 if (err < 0) 2348 return err; 2349 } 2350 2351 if (tb[IFLA_VF_RATE]) { 2352 struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]); 2353 2354 if (ivt->vf >= INT_MAX) 2355 return -EINVAL; 2356 err = -EOPNOTSUPP; 2357 if (ops->ndo_set_vf_rate) 2358 err = ops->ndo_set_vf_rate(dev, ivt->vf, 2359 ivt->min_tx_rate, 2360 ivt->max_tx_rate); 2361 if (err < 0) 2362 return err; 2363 } 2364 2365 if (tb[IFLA_VF_SPOOFCHK]) { 2366 struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]); 2367 2368 if (ivs->vf >= INT_MAX) 2369 return -EINVAL; 2370 err = -EOPNOTSUPP; 2371 if (ops->ndo_set_vf_spoofchk) 2372 err = ops->ndo_set_vf_spoofchk(dev, ivs->vf, 2373 ivs->setting); 2374 if (err < 0) 2375 return err; 2376 } 2377 2378 if (tb[IFLA_VF_LINK_STATE]) { 2379 struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]); 2380 2381 if (ivl->vf >= INT_MAX) 2382 return -EINVAL; 2383 err = -EOPNOTSUPP; 2384 if (ops->ndo_set_vf_link_state) 2385 err = ops->ndo_set_vf_link_state(dev, ivl->vf, 2386 ivl->link_state); 2387 if (err < 0) 2388 return err; 2389 } 2390 2391 if (tb[IFLA_VF_RSS_QUERY_EN]) { 2392 struct ifla_vf_rss_query_en *ivrssq_en; 2393 2394 err = -EOPNOTSUPP; 2395 ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]); 2396 if (ivrssq_en->vf >= INT_MAX) 2397 return -EINVAL; 2398 if (ops->ndo_set_vf_rss_query_en) 2399 err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf, 2400 ivrssq_en->setting); 2401 if (err < 0) 2402 return err; 2403 } 2404 2405 if (tb[IFLA_VF_TRUST]) { 2406 struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]); 2407 2408 if (ivt->vf >= INT_MAX) 2409 return -EINVAL; 2410 err = -EOPNOTSUPP; 2411 if (ops->ndo_set_vf_trust) 2412 err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting); 2413 if (err < 0) 2414 return err; 2415 } 2416 2417 if (tb[IFLA_VF_IB_NODE_GUID]) { 2418 struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]); 2419 2420 if (ivt->vf >= INT_MAX) 2421 return -EINVAL; 2422 if (!ops->ndo_set_vf_guid) 2423 return -EOPNOTSUPP; 2424 return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID); 2425 } 2426 2427 if (tb[IFLA_VF_IB_PORT_GUID]) { 2428 struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]); 2429 2430 if (ivt->vf >= INT_MAX) 2431 return -EINVAL; 2432 if (!ops->ndo_set_vf_guid) 2433 return -EOPNOTSUPP; 2434 2435 return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID); 2436 } 2437 2438 return err; 2439 } 2440 2441 static int do_set_master(struct net_device *dev, int ifindex, 2442 struct netlink_ext_ack *extack) 2443 { 2444 struct net_device *upper_dev = netdev_master_upper_dev_get(dev); 2445 const struct net_device_ops *ops; 2446 int err; 2447 2448 if (upper_dev) { 2449 if (upper_dev->ifindex == ifindex) 2450 return 0; 2451 ops = upper_dev->netdev_ops; 2452 if (ops->ndo_del_slave) { 2453 err = ops->ndo_del_slave(upper_dev, dev); 2454 if (err) 2455 return err; 2456 netdev_update_lockdep_key(dev); 2457 } else { 2458 return -EOPNOTSUPP; 2459 } 2460 } 2461 2462 if (ifindex) { 2463 upper_dev = __dev_get_by_index(dev_net(dev), ifindex); 2464 if (!upper_dev) 2465 return -EINVAL; 2466 ops = upper_dev->netdev_ops; 2467 if (ops->ndo_add_slave) { 2468 err = ops->ndo_add_slave(upper_dev, dev, extack); 2469 if (err) 2470 return err; 2471 } else { 2472 return -EOPNOTSUPP; 2473 } 2474 } 2475 return 0; 2476 } 2477 2478 #define DO_SETLINK_MODIFIED 0x01 2479 /* notify flag means notify + modified. */ 2480 #define DO_SETLINK_NOTIFY 0x03 2481 static int do_setlink(const struct sk_buff *skb, 2482 struct net_device *dev, struct ifinfomsg *ifm, 2483 struct netlink_ext_ack *extack, 2484 struct nlattr **tb, char *ifname, int status) 2485 { 2486 const struct net_device_ops *ops = dev->netdev_ops; 2487 int err; 2488 2489 err = validate_linkmsg(dev, tb); 2490 if (err < 0) 2491 return err; 2492 2493 if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD] || tb[IFLA_TARGET_NETNSID]) { 2494 struct net *net = rtnl_link_get_net_capable(skb, dev_net(dev), 2495 tb, CAP_NET_ADMIN); 2496 if (IS_ERR(net)) { 2497 err = PTR_ERR(net); 2498 goto errout; 2499 } 2500 2501 err = dev_change_net_namespace(dev, net, ifname); 2502 put_net(net); 2503 if (err) 2504 goto errout; 2505 status |= DO_SETLINK_MODIFIED; 2506 } 2507 2508 if (tb[IFLA_MAP]) { 2509 struct rtnl_link_ifmap *u_map; 2510 struct ifmap k_map; 2511 2512 if (!ops->ndo_set_config) { 2513 err = -EOPNOTSUPP; 2514 goto errout; 2515 } 2516 2517 if (!netif_device_present(dev)) { 2518 err = -ENODEV; 2519 goto errout; 2520 } 2521 2522 u_map = nla_data(tb[IFLA_MAP]); 2523 k_map.mem_start = (unsigned long) u_map->mem_start; 2524 k_map.mem_end = (unsigned long) u_map->mem_end; 2525 k_map.base_addr = (unsigned short) u_map->base_addr; 2526 k_map.irq = (unsigned char) u_map->irq; 2527 k_map.dma = (unsigned char) u_map->dma; 2528 k_map.port = (unsigned char) u_map->port; 2529 2530 err = ops->ndo_set_config(dev, &k_map); 2531 if (err < 0) 2532 goto errout; 2533 2534 status |= DO_SETLINK_NOTIFY; 2535 } 2536 2537 if (tb[IFLA_ADDRESS]) { 2538 struct sockaddr *sa; 2539 int len; 2540 2541 len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len, 2542 sizeof(*sa)); 2543 sa = kmalloc(len, GFP_KERNEL); 2544 if (!sa) { 2545 err = -ENOMEM; 2546 goto errout; 2547 } 2548 sa->sa_family = dev->type; 2549 memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), 2550 dev->addr_len); 2551 err = dev_set_mac_address(dev, sa, extack); 2552 kfree(sa); 2553 if (err) 2554 goto errout; 2555 status |= DO_SETLINK_MODIFIED; 2556 } 2557 2558 if (tb[IFLA_MTU]) { 2559 err = dev_set_mtu_ext(dev, nla_get_u32(tb[IFLA_MTU]), extack); 2560 if (err < 0) 2561 goto errout; 2562 status |= DO_SETLINK_MODIFIED; 2563 } 2564 2565 if (tb[IFLA_GROUP]) { 2566 dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2567 status |= DO_SETLINK_NOTIFY; 2568 } 2569 2570 /* 2571 * Interface selected by interface index but interface 2572 * name provided implies that a name change has been 2573 * requested. 2574 */ 2575 if (ifm->ifi_index > 0 && ifname[0]) { 2576 err = dev_change_name(dev, ifname); 2577 if (err < 0) 2578 goto errout; 2579 status |= DO_SETLINK_MODIFIED; 2580 } 2581 2582 if (tb[IFLA_IFALIAS]) { 2583 err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), 2584 nla_len(tb[IFLA_IFALIAS])); 2585 if (err < 0) 2586 goto errout; 2587 status |= DO_SETLINK_NOTIFY; 2588 } 2589 2590 if (tb[IFLA_BROADCAST]) { 2591 nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); 2592 call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); 2593 } 2594 2595 if (ifm->ifi_flags || ifm->ifi_change) { 2596 err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm), 2597 extack); 2598 if (err < 0) 2599 goto errout; 2600 } 2601 2602 if (tb[IFLA_MASTER]) { 2603 err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack); 2604 if (err) 2605 goto errout; 2606 status |= DO_SETLINK_MODIFIED; 2607 } 2608 2609 if (tb[IFLA_CARRIER]) { 2610 err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER])); 2611 if (err) 2612 goto errout; 2613 status |= DO_SETLINK_MODIFIED; 2614 } 2615 2616 if (tb[IFLA_TXQLEN]) { 2617 unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]); 2618 2619 err = dev_change_tx_queue_len(dev, value); 2620 if (err) 2621 goto errout; 2622 status |= DO_SETLINK_MODIFIED; 2623 } 2624 2625 if (tb[IFLA_GSO_MAX_SIZE]) { 2626 u32 max_size = nla_get_u32(tb[IFLA_GSO_MAX_SIZE]); 2627 2628 if (max_size > GSO_MAX_SIZE) { 2629 err = -EINVAL; 2630 goto errout; 2631 } 2632 2633 if (dev->gso_max_size ^ max_size) { 2634 netif_set_gso_max_size(dev, max_size); 2635 status |= DO_SETLINK_MODIFIED; 2636 } 2637 } 2638 2639 if (tb[IFLA_GSO_MAX_SEGS]) { 2640 u32 max_segs = nla_get_u32(tb[IFLA_GSO_MAX_SEGS]); 2641 2642 if (max_segs > GSO_MAX_SEGS) { 2643 err = -EINVAL; 2644 goto errout; 2645 } 2646 2647 if (dev->gso_max_segs ^ max_segs) { 2648 dev->gso_max_segs = max_segs; 2649 status |= DO_SETLINK_MODIFIED; 2650 } 2651 } 2652 2653 if (tb[IFLA_OPERSTATE]) 2654 set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 2655 2656 if (tb[IFLA_LINKMODE]) { 2657 unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]); 2658 2659 write_lock_bh(&dev_base_lock); 2660 if (dev->link_mode ^ value) 2661 status |= DO_SETLINK_NOTIFY; 2662 dev->link_mode = value; 2663 write_unlock_bh(&dev_base_lock); 2664 } 2665 2666 if (tb[IFLA_VFINFO_LIST]) { 2667 struct nlattr *vfinfo[IFLA_VF_MAX + 1]; 2668 struct nlattr *attr; 2669 int rem; 2670 2671 nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { 2672 if (nla_type(attr) != IFLA_VF_INFO || 2673 nla_len(attr) < NLA_HDRLEN) { 2674 err = -EINVAL; 2675 goto errout; 2676 } 2677 err = nla_parse_nested_deprecated(vfinfo, IFLA_VF_MAX, 2678 attr, 2679 ifla_vf_policy, 2680 NULL); 2681 if (err < 0) 2682 goto errout; 2683 err = do_setvfinfo(dev, vfinfo); 2684 if (err < 0) 2685 goto errout; 2686 status |= DO_SETLINK_NOTIFY; 2687 } 2688 } 2689 err = 0; 2690 2691 if (tb[IFLA_VF_PORTS]) { 2692 struct nlattr *port[IFLA_PORT_MAX+1]; 2693 struct nlattr *attr; 2694 int vf; 2695 int rem; 2696 2697 err = -EOPNOTSUPP; 2698 if (!ops->ndo_set_vf_port) 2699 goto errout; 2700 2701 nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { 2702 if (nla_type(attr) != IFLA_VF_PORT || 2703 nla_len(attr) < NLA_HDRLEN) { 2704 err = -EINVAL; 2705 goto errout; 2706 } 2707 err = nla_parse_nested_deprecated(port, IFLA_PORT_MAX, 2708 attr, 2709 ifla_port_policy, 2710 NULL); 2711 if (err < 0) 2712 goto errout; 2713 if (!port[IFLA_PORT_VF]) { 2714 err = -EOPNOTSUPP; 2715 goto errout; 2716 } 2717 vf = nla_get_u32(port[IFLA_PORT_VF]); 2718 err = ops->ndo_set_vf_port(dev, vf, port); 2719 if (err < 0) 2720 goto errout; 2721 status |= DO_SETLINK_NOTIFY; 2722 } 2723 } 2724 err = 0; 2725 2726 if (tb[IFLA_PORT_SELF]) { 2727 struct nlattr *port[IFLA_PORT_MAX+1]; 2728 2729 err = nla_parse_nested_deprecated(port, IFLA_PORT_MAX, 2730 tb[IFLA_PORT_SELF], 2731 ifla_port_policy, NULL); 2732 if (err < 0) 2733 goto errout; 2734 2735 err = -EOPNOTSUPP; 2736 if (ops->ndo_set_vf_port) 2737 err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); 2738 if (err < 0) 2739 goto errout; 2740 status |= DO_SETLINK_NOTIFY; 2741 } 2742 2743 if (tb[IFLA_AF_SPEC]) { 2744 struct nlattr *af; 2745 int rem; 2746 2747 nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 2748 const struct rtnl_af_ops *af_ops; 2749 2750 rcu_read_lock(); 2751 2752 BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af)))); 2753 2754 err = af_ops->set_link_af(dev, af); 2755 if (err < 0) { 2756 rcu_read_unlock(); 2757 goto errout; 2758 } 2759 2760 rcu_read_unlock(); 2761 status |= DO_SETLINK_NOTIFY; 2762 } 2763 } 2764 err = 0; 2765 2766 if (tb[IFLA_PROTO_DOWN]) { 2767 err = dev_change_proto_down(dev, 2768 nla_get_u8(tb[IFLA_PROTO_DOWN])); 2769 if (err) 2770 goto errout; 2771 status |= DO_SETLINK_NOTIFY; 2772 } 2773 2774 if (tb[IFLA_XDP]) { 2775 struct nlattr *xdp[IFLA_XDP_MAX + 1]; 2776 u32 xdp_flags = 0; 2777 2778 err = nla_parse_nested_deprecated(xdp, IFLA_XDP_MAX, 2779 tb[IFLA_XDP], 2780 ifla_xdp_policy, NULL); 2781 if (err < 0) 2782 goto errout; 2783 2784 if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) { 2785 err = -EINVAL; 2786 goto errout; 2787 } 2788 2789 if (xdp[IFLA_XDP_FLAGS]) { 2790 xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]); 2791 if (xdp_flags & ~XDP_FLAGS_MASK) { 2792 err = -EINVAL; 2793 goto errout; 2794 } 2795 if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) { 2796 err = -EINVAL; 2797 goto errout; 2798 } 2799 } 2800 2801 if (xdp[IFLA_XDP_FD]) { 2802 err = dev_change_xdp_fd(dev, extack, 2803 nla_get_s32(xdp[IFLA_XDP_FD]), 2804 xdp_flags); 2805 if (err) 2806 goto errout; 2807 status |= DO_SETLINK_NOTIFY; 2808 } 2809 } 2810 2811 errout: 2812 if (status & DO_SETLINK_MODIFIED) { 2813 if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY) 2814 netdev_state_change(dev); 2815 2816 if (err < 0) 2817 net_warn_ratelimited("A link change request failed with some changes committed already. Interface %s may have been left with an inconsistent configuration, please check.\n", 2818 dev->name); 2819 } 2820 2821 return err; 2822 } 2823 2824 static struct net_device *rtnl_dev_get(struct net *net, 2825 struct nlattr *ifname_attr, 2826 struct nlattr *altifname_attr, 2827 char *ifname) 2828 { 2829 char buffer[ALTIFNAMSIZ]; 2830 2831 if (!ifname) { 2832 ifname = buffer; 2833 if (ifname_attr) 2834 nla_strlcpy(ifname, ifname_attr, IFNAMSIZ); 2835 else if (altifname_attr) 2836 nla_strlcpy(ifname, altifname_attr, ALTIFNAMSIZ); 2837 else 2838 return NULL; 2839 } 2840 2841 return __dev_get_by_name(net, ifname); 2842 } 2843 2844 static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2845 struct netlink_ext_ack *extack) 2846 { 2847 struct net *net = sock_net(skb->sk); 2848 struct ifinfomsg *ifm; 2849 struct net_device *dev; 2850 int err; 2851 struct nlattr *tb[IFLA_MAX+1]; 2852 char ifname[IFNAMSIZ]; 2853 2854 err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX, 2855 ifla_policy, extack); 2856 if (err < 0) 2857 goto errout; 2858 2859 err = rtnl_ensure_unique_netns(tb, extack, false); 2860 if (err < 0) 2861 goto errout; 2862 2863 if (tb[IFLA_IFNAME]) 2864 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 2865 else 2866 ifname[0] = '\0'; 2867 2868 err = -EINVAL; 2869 ifm = nlmsg_data(nlh); 2870 if (ifm->ifi_index > 0) 2871 dev = __dev_get_by_index(net, ifm->ifi_index); 2872 else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) 2873 dev = rtnl_dev_get(net, NULL, tb[IFLA_ALT_IFNAME], ifname); 2874 else 2875 goto errout; 2876 2877 if (dev == NULL) { 2878 err = -ENODEV; 2879 goto errout; 2880 } 2881 2882 err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0); 2883 errout: 2884 return err; 2885 } 2886 2887 static int rtnl_group_dellink(const struct net *net, int group) 2888 { 2889 struct net_device *dev, *aux; 2890 LIST_HEAD(list_kill); 2891 bool found = false; 2892 2893 if (!group) 2894 return -EPERM; 2895 2896 for_each_netdev(net, dev) { 2897 if (dev->group == group) { 2898 const struct rtnl_link_ops *ops; 2899 2900 found = true; 2901 ops = dev->rtnl_link_ops; 2902 if (!ops || !ops->dellink) 2903 return -EOPNOTSUPP; 2904 } 2905 } 2906 2907 if (!found) 2908 return -ENODEV; 2909 2910 for_each_netdev_safe(net, dev, aux) { 2911 if (dev->group == group) { 2912 const struct rtnl_link_ops *ops; 2913 2914 ops = dev->rtnl_link_ops; 2915 ops->dellink(dev, &list_kill); 2916 } 2917 } 2918 unregister_netdevice_many(&list_kill); 2919 2920 return 0; 2921 } 2922 2923 int rtnl_delete_link(struct net_device *dev) 2924 { 2925 const struct rtnl_link_ops *ops; 2926 LIST_HEAD(list_kill); 2927 2928 ops = dev->rtnl_link_ops; 2929 if (!ops || !ops->dellink) 2930 return -EOPNOTSUPP; 2931 2932 ops->dellink(dev, &list_kill); 2933 unregister_netdevice_many(&list_kill); 2934 2935 return 0; 2936 } 2937 EXPORT_SYMBOL_GPL(rtnl_delete_link); 2938 2939 static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 2940 struct netlink_ext_ack *extack) 2941 { 2942 struct net *net = sock_net(skb->sk); 2943 struct net *tgt_net = net; 2944 struct net_device *dev = NULL; 2945 struct ifinfomsg *ifm; 2946 struct nlattr *tb[IFLA_MAX+1]; 2947 int err; 2948 int netnsid = -1; 2949 2950 err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX, 2951 ifla_policy, extack); 2952 if (err < 0) 2953 return err; 2954 2955 err = rtnl_ensure_unique_netns(tb, extack, true); 2956 if (err < 0) 2957 return err; 2958 2959 if (tb[IFLA_TARGET_NETNSID]) { 2960 netnsid = nla_get_s32(tb[IFLA_TARGET_NETNSID]); 2961 tgt_net = rtnl_get_net_ns_capable(NETLINK_CB(skb).sk, netnsid); 2962 if (IS_ERR(tgt_net)) 2963 return PTR_ERR(tgt_net); 2964 } 2965 2966 err = -EINVAL; 2967 ifm = nlmsg_data(nlh); 2968 if (ifm->ifi_index > 0) 2969 dev = __dev_get_by_index(tgt_net, ifm->ifi_index); 2970 else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) 2971 dev = rtnl_dev_get(net, tb[IFLA_IFNAME], 2972 tb[IFLA_ALT_IFNAME], NULL); 2973 else if (tb[IFLA_GROUP]) 2974 err = rtnl_group_dellink(tgt_net, nla_get_u32(tb[IFLA_GROUP])); 2975 else 2976 goto out; 2977 2978 if (!dev) { 2979 if (tb[IFLA_IFNAME] || ifm->ifi_index > 0) 2980 err = -ENODEV; 2981 2982 goto out; 2983 } 2984 2985 err = rtnl_delete_link(dev); 2986 2987 out: 2988 if (netnsid >= 0) 2989 put_net(tgt_net); 2990 2991 return err; 2992 } 2993 2994 int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) 2995 { 2996 unsigned int old_flags; 2997 int err; 2998 2999 old_flags = dev->flags; 3000 if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { 3001 err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm), 3002 NULL); 3003 if (err < 0) 3004 return err; 3005 } 3006 3007 if (dev->rtnl_link_state == RTNL_LINK_INITIALIZED) { 3008 __dev_notify_flags(dev, old_flags, (old_flags ^ dev->flags)); 3009 } else { 3010 dev->rtnl_link_state = RTNL_LINK_INITIALIZED; 3011 __dev_notify_flags(dev, old_flags, ~0U); 3012 } 3013 return 0; 3014 } 3015 EXPORT_SYMBOL(rtnl_configure_link); 3016 3017 struct net_device *rtnl_create_link(struct net *net, const char *ifname, 3018 unsigned char name_assign_type, 3019 const struct rtnl_link_ops *ops, 3020 struct nlattr *tb[], 3021 struct netlink_ext_ack *extack) 3022 { 3023 struct net_device *dev; 3024 unsigned int num_tx_queues = 1; 3025 unsigned int num_rx_queues = 1; 3026 3027 if (tb[IFLA_NUM_TX_QUEUES]) 3028 num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]); 3029 else if (ops->get_num_tx_queues) 3030 num_tx_queues = ops->get_num_tx_queues(); 3031 3032 if (tb[IFLA_NUM_RX_QUEUES]) 3033 num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]); 3034 else if (ops->get_num_rx_queues) 3035 num_rx_queues = ops->get_num_rx_queues(); 3036 3037 if (num_tx_queues < 1 || num_tx_queues > 4096) { 3038 NL_SET_ERR_MSG(extack, "Invalid number of transmit queues"); 3039 return ERR_PTR(-EINVAL); 3040 } 3041 3042 if (num_rx_queues < 1 || num_rx_queues > 4096) { 3043 NL_SET_ERR_MSG(extack, "Invalid number of receive queues"); 3044 return ERR_PTR(-EINVAL); 3045 } 3046 3047 dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type, 3048 ops->setup, num_tx_queues, num_rx_queues); 3049 if (!dev) 3050 return ERR_PTR(-ENOMEM); 3051 3052 dev_net_set(dev, net); 3053 dev->rtnl_link_ops = ops; 3054 dev->rtnl_link_state = RTNL_LINK_INITIALIZING; 3055 3056 if (tb[IFLA_MTU]) 3057 dev->mtu = nla_get_u32(tb[IFLA_MTU]); 3058 if (tb[IFLA_ADDRESS]) { 3059 memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), 3060 nla_len(tb[IFLA_ADDRESS])); 3061 dev->addr_assign_type = NET_ADDR_SET; 3062 } 3063 if (tb[IFLA_BROADCAST]) 3064 memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), 3065 nla_len(tb[IFLA_BROADCAST])); 3066 if (tb[IFLA_TXQLEN]) 3067 dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); 3068 if (tb[IFLA_OPERSTATE]) 3069 set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 3070 if (tb[IFLA_LINKMODE]) 3071 dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); 3072 if (tb[IFLA_GROUP]) 3073 dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 3074 if (tb[IFLA_GSO_MAX_SIZE]) 3075 netif_set_gso_max_size(dev, nla_get_u32(tb[IFLA_GSO_MAX_SIZE])); 3076 if (tb[IFLA_GSO_MAX_SEGS]) 3077 dev->gso_max_segs = nla_get_u32(tb[IFLA_GSO_MAX_SEGS]); 3078 3079 return dev; 3080 } 3081 EXPORT_SYMBOL(rtnl_create_link); 3082 3083 static int rtnl_group_changelink(const struct sk_buff *skb, 3084 struct net *net, int group, 3085 struct ifinfomsg *ifm, 3086 struct netlink_ext_ack *extack, 3087 struct nlattr **tb) 3088 { 3089 struct net_device *dev, *aux; 3090 int err; 3091 3092 for_each_netdev_safe(net, dev, aux) { 3093 if (dev->group == group) { 3094 err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0); 3095 if (err < 0) 3096 return err; 3097 } 3098 } 3099 3100 return 0; 3101 } 3102 3103 static int __rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3104 struct nlattr **attr, struct netlink_ext_ack *extack) 3105 { 3106 struct nlattr *slave_attr[RTNL_SLAVE_MAX_TYPE + 1]; 3107 unsigned char name_assign_type = NET_NAME_USER; 3108 struct nlattr *linkinfo[IFLA_INFO_MAX + 1]; 3109 const struct rtnl_link_ops *m_ops = NULL; 3110 struct net_device *master_dev = NULL; 3111 struct net *net = sock_net(skb->sk); 3112 const struct rtnl_link_ops *ops; 3113 struct nlattr *tb[IFLA_MAX + 1]; 3114 struct net *dest_net, *link_net; 3115 struct nlattr **slave_data; 3116 char kind[MODULE_NAME_LEN]; 3117 struct net_device *dev; 3118 struct ifinfomsg *ifm; 3119 char ifname[IFNAMSIZ]; 3120 struct nlattr **data; 3121 int err; 3122 3123 #ifdef CONFIG_MODULES 3124 replay: 3125 #endif 3126 err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX, 3127 ifla_policy, extack); 3128 if (err < 0) 3129 return err; 3130 3131 err = rtnl_ensure_unique_netns(tb, extack, false); 3132 if (err < 0) 3133 return err; 3134 3135 if (tb[IFLA_IFNAME]) 3136 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 3137 else 3138 ifname[0] = '\0'; 3139 3140 ifm = nlmsg_data(nlh); 3141 if (ifm->ifi_index > 0) 3142 dev = __dev_get_by_index(net, ifm->ifi_index); 3143 else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) 3144 dev = rtnl_dev_get(net, NULL, tb[IFLA_ALT_IFNAME], ifname); 3145 else 3146 dev = NULL; 3147 3148 if (dev) { 3149 master_dev = netdev_master_upper_dev_get(dev); 3150 if (master_dev) 3151 m_ops = master_dev->rtnl_link_ops; 3152 } 3153 3154 err = validate_linkmsg(dev, tb); 3155 if (err < 0) 3156 return err; 3157 3158 if (tb[IFLA_LINKINFO]) { 3159 err = nla_parse_nested_deprecated(linkinfo, IFLA_INFO_MAX, 3160 tb[IFLA_LINKINFO], 3161 ifla_info_policy, NULL); 3162 if (err < 0) 3163 return err; 3164 } else 3165 memset(linkinfo, 0, sizeof(linkinfo)); 3166 3167 if (linkinfo[IFLA_INFO_KIND]) { 3168 nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); 3169 ops = rtnl_link_ops_get(kind); 3170 } else { 3171 kind[0] = '\0'; 3172 ops = NULL; 3173 } 3174 3175 data = NULL; 3176 if (ops) { 3177 if (ops->maxtype > RTNL_MAX_TYPE) 3178 return -EINVAL; 3179 3180 if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { 3181 err = nla_parse_nested_deprecated(attr, ops->maxtype, 3182 linkinfo[IFLA_INFO_DATA], 3183 ops->policy, extack); 3184 if (err < 0) 3185 return err; 3186 data = attr; 3187 } 3188 if (ops->validate) { 3189 err = ops->validate(tb, data, extack); 3190 if (err < 0) 3191 return err; 3192 } 3193 } 3194 3195 slave_data = NULL; 3196 if (m_ops) { 3197 if (m_ops->slave_maxtype > RTNL_SLAVE_MAX_TYPE) 3198 return -EINVAL; 3199 3200 if (m_ops->slave_maxtype && 3201 linkinfo[IFLA_INFO_SLAVE_DATA]) { 3202 err = nla_parse_nested_deprecated(slave_attr, 3203 m_ops->slave_maxtype, 3204 linkinfo[IFLA_INFO_SLAVE_DATA], 3205 m_ops->slave_policy, 3206 extack); 3207 if (err < 0) 3208 return err; 3209 slave_data = slave_attr; 3210 } 3211 } 3212 3213 if (dev) { 3214 int status = 0; 3215 3216 if (nlh->nlmsg_flags & NLM_F_EXCL) 3217 return -EEXIST; 3218 if (nlh->nlmsg_flags & NLM_F_REPLACE) 3219 return -EOPNOTSUPP; 3220 3221 if (linkinfo[IFLA_INFO_DATA]) { 3222 if (!ops || ops != dev->rtnl_link_ops || 3223 !ops->changelink) 3224 return -EOPNOTSUPP; 3225 3226 err = ops->changelink(dev, tb, data, extack); 3227 if (err < 0) 3228 return err; 3229 status |= DO_SETLINK_NOTIFY; 3230 } 3231 3232 if (linkinfo[IFLA_INFO_SLAVE_DATA]) { 3233 if (!m_ops || !m_ops->slave_changelink) 3234 return -EOPNOTSUPP; 3235 3236 err = m_ops->slave_changelink(master_dev, dev, tb, 3237 slave_data, extack); 3238 if (err < 0) 3239 return err; 3240 status |= DO_SETLINK_NOTIFY; 3241 } 3242 3243 return do_setlink(skb, dev, ifm, extack, tb, ifname, status); 3244 } 3245 3246 if (!(nlh->nlmsg_flags & NLM_F_CREATE)) { 3247 if (ifm->ifi_index == 0 && tb[IFLA_GROUP]) 3248 return rtnl_group_changelink(skb, net, 3249 nla_get_u32(tb[IFLA_GROUP]), 3250 ifm, extack, tb); 3251 return -ENODEV; 3252 } 3253 3254 if (tb[IFLA_MAP] || tb[IFLA_PROTINFO]) 3255 return -EOPNOTSUPP; 3256 3257 if (!ops) { 3258 #ifdef CONFIG_MODULES 3259 if (kind[0]) { 3260 __rtnl_unlock(); 3261 request_module("rtnl-link-%s", kind); 3262 rtnl_lock(); 3263 ops = rtnl_link_ops_get(kind); 3264 if (ops) 3265 goto replay; 3266 } 3267 #endif 3268 NL_SET_ERR_MSG(extack, "Unknown device type"); 3269 return -EOPNOTSUPP; 3270 } 3271 3272 if (!ops->setup) 3273 return -EOPNOTSUPP; 3274 3275 if (!ifname[0]) { 3276 snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); 3277 name_assign_type = NET_NAME_ENUM; 3278 } 3279 3280 dest_net = rtnl_link_get_net_capable(skb, net, tb, CAP_NET_ADMIN); 3281 if (IS_ERR(dest_net)) 3282 return PTR_ERR(dest_net); 3283 3284 if (tb[IFLA_LINK_NETNSID]) { 3285 int id = nla_get_s32(tb[IFLA_LINK_NETNSID]); 3286 3287 link_net = get_net_ns_by_id(dest_net, id); 3288 if (!link_net) { 3289 NL_SET_ERR_MSG(extack, "Unknown network namespace id"); 3290 err = -EINVAL; 3291 goto out; 3292 } 3293 err = -EPERM; 3294 if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN)) 3295 goto out; 3296 } else { 3297 link_net = NULL; 3298 } 3299 3300 dev = rtnl_create_link(link_net ? : dest_net, ifname, 3301 name_assign_type, ops, tb, extack); 3302 if (IS_ERR(dev)) { 3303 err = PTR_ERR(dev); 3304 goto out; 3305 } 3306 3307 dev->ifindex = ifm->ifi_index; 3308 3309 if (ops->newlink) { 3310 err = ops->newlink(link_net ? : net, dev, tb, data, extack); 3311 /* Drivers should call free_netdev() in ->destructor 3312 * and unregister it on failure after registration 3313 * so that device could be finally freed in rtnl_unlock. 3314 */ 3315 if (err < 0) { 3316 /* If device is not registered at all, free it now */ 3317 if (dev->reg_state == NETREG_UNINITIALIZED) 3318 free_netdev(dev); 3319 goto out; 3320 } 3321 } else { 3322 err = register_netdevice(dev); 3323 if (err < 0) { 3324 free_netdev(dev); 3325 goto out; 3326 } 3327 } 3328 err = rtnl_configure_link(dev, ifm); 3329 if (err < 0) 3330 goto out_unregister; 3331 if (link_net) { 3332 err = dev_change_net_namespace(dev, dest_net, ifname); 3333 if (err < 0) 3334 goto out_unregister; 3335 } 3336 if (tb[IFLA_MASTER]) { 3337 err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack); 3338 if (err) 3339 goto out_unregister; 3340 } 3341 out: 3342 if (link_net) 3343 put_net(link_net); 3344 put_net(dest_net); 3345 return err; 3346 out_unregister: 3347 if (ops->newlink) { 3348 LIST_HEAD(list_kill); 3349 3350 ops->dellink(dev, &list_kill); 3351 unregister_netdevice_many(&list_kill); 3352 } else { 3353 unregister_netdevice(dev); 3354 } 3355 goto out; 3356 } 3357 3358 static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3359 struct netlink_ext_ack *extack) 3360 { 3361 struct nlattr **attr; 3362 int ret; 3363 3364 attr = kmalloc_array(RTNL_MAX_TYPE + 1, sizeof(*attr), GFP_KERNEL); 3365 if (!attr) 3366 return -ENOMEM; 3367 3368 ret = __rtnl_newlink(skb, nlh, attr, extack); 3369 kfree(attr); 3370 return ret; 3371 } 3372 3373 static int rtnl_valid_getlink_req(struct sk_buff *skb, 3374 const struct nlmsghdr *nlh, 3375 struct nlattr **tb, 3376 struct netlink_ext_ack *extack) 3377 { 3378 struct ifinfomsg *ifm; 3379 int i, err; 3380 3381 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) { 3382 NL_SET_ERR_MSG(extack, "Invalid header for get link"); 3383 return -EINVAL; 3384 } 3385 3386 if (!netlink_strict_get_check(skb)) 3387 return nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX, 3388 ifla_policy, extack); 3389 3390 ifm = nlmsg_data(nlh); 3391 if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags || 3392 ifm->ifi_change) { 3393 NL_SET_ERR_MSG(extack, "Invalid values in header for get link request"); 3394 return -EINVAL; 3395 } 3396 3397 err = nlmsg_parse_deprecated_strict(nlh, sizeof(*ifm), tb, IFLA_MAX, 3398 ifla_policy, extack); 3399 if (err) 3400 return err; 3401 3402 for (i = 0; i <= IFLA_MAX; i++) { 3403 if (!tb[i]) 3404 continue; 3405 3406 switch (i) { 3407 case IFLA_IFNAME: 3408 case IFLA_ALT_IFNAME: 3409 case IFLA_EXT_MASK: 3410 case IFLA_TARGET_NETNSID: 3411 break; 3412 default: 3413 NL_SET_ERR_MSG(extack, "Unsupported attribute in get link request"); 3414 return -EINVAL; 3415 } 3416 } 3417 3418 return 0; 3419 } 3420 3421 static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3422 struct netlink_ext_ack *extack) 3423 { 3424 struct net *net = sock_net(skb->sk); 3425 struct net *tgt_net = net; 3426 struct ifinfomsg *ifm; 3427 struct nlattr *tb[IFLA_MAX+1]; 3428 struct net_device *dev = NULL; 3429 struct sk_buff *nskb; 3430 int netnsid = -1; 3431 int err; 3432 u32 ext_filter_mask = 0; 3433 3434 err = rtnl_valid_getlink_req(skb, nlh, tb, extack); 3435 if (err < 0) 3436 return err; 3437 3438 err = rtnl_ensure_unique_netns(tb, extack, true); 3439 if (err < 0) 3440 return err; 3441 3442 if (tb[IFLA_TARGET_NETNSID]) { 3443 netnsid = nla_get_s32(tb[IFLA_TARGET_NETNSID]); 3444 tgt_net = rtnl_get_net_ns_capable(NETLINK_CB(skb).sk, netnsid); 3445 if (IS_ERR(tgt_net)) 3446 return PTR_ERR(tgt_net); 3447 } 3448 3449 if (tb[IFLA_EXT_MASK]) 3450 ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 3451 3452 err = -EINVAL; 3453 ifm = nlmsg_data(nlh); 3454 if (ifm->ifi_index > 0) 3455 dev = __dev_get_by_index(tgt_net, ifm->ifi_index); 3456 else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) 3457 dev = rtnl_dev_get(tgt_net, tb[IFLA_IFNAME], 3458 tb[IFLA_ALT_IFNAME], NULL); 3459 else 3460 goto out; 3461 3462 err = -ENODEV; 3463 if (dev == NULL) 3464 goto out; 3465 3466 err = -ENOBUFS; 3467 nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL); 3468 if (nskb == NULL) 3469 goto out; 3470 3471 err = rtnl_fill_ifinfo(nskb, dev, net, 3472 RTM_NEWLINK, NETLINK_CB(skb).portid, 3473 nlh->nlmsg_seq, 0, 0, ext_filter_mask, 3474 0, NULL, 0, netnsid, GFP_KERNEL); 3475 if (err < 0) { 3476 /* -EMSGSIZE implies BUG in if_nlmsg_size */ 3477 WARN_ON(err == -EMSGSIZE); 3478 kfree_skb(nskb); 3479 } else 3480 err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 3481 out: 3482 if (netnsid >= 0) 3483 put_net(tgt_net); 3484 3485 return err; 3486 } 3487 3488 static int rtnl_alt_ifname(int cmd, struct net_device *dev, struct nlattr *attr, 3489 bool *changed, struct netlink_ext_ack *extack) 3490 { 3491 char *alt_ifname; 3492 int err; 3493 3494 err = nla_validate(attr, attr->nla_len, IFLA_MAX, ifla_policy, extack); 3495 if (err) 3496 return err; 3497 3498 alt_ifname = nla_data(attr); 3499 if (cmd == RTM_NEWLINKPROP) { 3500 alt_ifname = kstrdup(alt_ifname, GFP_KERNEL); 3501 if (!alt_ifname) 3502 return -ENOMEM; 3503 err = netdev_name_node_alt_create(dev, alt_ifname); 3504 if (err) { 3505 kfree(alt_ifname); 3506 return err; 3507 } 3508 } else if (cmd == RTM_DELLINKPROP) { 3509 err = netdev_name_node_alt_destroy(dev, alt_ifname); 3510 if (err) 3511 return err; 3512 } else { 3513 WARN_ON(1); 3514 return 0; 3515 } 3516 3517 *changed = true; 3518 return 0; 3519 } 3520 3521 static int rtnl_linkprop(int cmd, struct sk_buff *skb, struct nlmsghdr *nlh, 3522 struct netlink_ext_ack *extack) 3523 { 3524 struct net *net = sock_net(skb->sk); 3525 struct nlattr *tb[IFLA_MAX + 1]; 3526 struct net_device *dev; 3527 struct ifinfomsg *ifm; 3528 bool changed = false; 3529 struct nlattr *attr; 3530 int err, rem; 3531 3532 err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 3533 if (err) 3534 return err; 3535 3536 err = rtnl_ensure_unique_netns(tb, extack, true); 3537 if (err) 3538 return err; 3539 3540 ifm = nlmsg_data(nlh); 3541 if (ifm->ifi_index > 0) 3542 dev = __dev_get_by_index(net, ifm->ifi_index); 3543 else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) 3544 dev = rtnl_dev_get(net, tb[IFLA_IFNAME], 3545 tb[IFLA_ALT_IFNAME], NULL); 3546 else 3547 return -EINVAL; 3548 3549 if (!dev) 3550 return -ENODEV; 3551 3552 if (!tb[IFLA_PROP_LIST]) 3553 return 0; 3554 3555 nla_for_each_nested(attr, tb[IFLA_PROP_LIST], rem) { 3556 switch (nla_type(attr)) { 3557 case IFLA_ALT_IFNAME: 3558 err = rtnl_alt_ifname(cmd, dev, attr, &changed, extack); 3559 if (err) 3560 return err; 3561 break; 3562 } 3563 } 3564 3565 if (changed) 3566 netdev_state_change(dev); 3567 return 0; 3568 } 3569 3570 static int rtnl_newlinkprop(struct sk_buff *skb, struct nlmsghdr *nlh, 3571 struct netlink_ext_ack *extack) 3572 { 3573 return rtnl_linkprop(RTM_NEWLINKPROP, skb, nlh, extack); 3574 } 3575 3576 static int rtnl_dellinkprop(struct sk_buff *skb, struct nlmsghdr *nlh, 3577 struct netlink_ext_ack *extack) 3578 { 3579 return rtnl_linkprop(RTM_DELLINKPROP, skb, nlh, extack); 3580 } 3581 3582 static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh) 3583 { 3584 struct net *net = sock_net(skb->sk); 3585 struct net_device *dev; 3586 struct nlattr *tb[IFLA_MAX+1]; 3587 u32 ext_filter_mask = 0; 3588 u16 min_ifinfo_dump_size = 0; 3589 int hdrlen; 3590 3591 /* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */ 3592 hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ? 3593 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 3594 3595 if (nlmsg_parse_deprecated(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) { 3596 if (tb[IFLA_EXT_MASK]) 3597 ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 3598 } 3599 3600 if (!ext_filter_mask) 3601 return NLMSG_GOODSIZE; 3602 /* 3603 * traverse the list of net devices and compute the minimum 3604 * buffer size based upon the filter mask. 3605 */ 3606 rcu_read_lock(); 3607 for_each_netdev_rcu(net, dev) { 3608 min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size, 3609 if_nlmsg_size(dev, 3610 ext_filter_mask)); 3611 } 3612 rcu_read_unlock(); 3613 3614 return nlmsg_total_size(min_ifinfo_dump_size); 3615 } 3616 3617 static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) 3618 { 3619 int idx; 3620 int s_idx = cb->family; 3621 int type = cb->nlh->nlmsg_type - RTM_BASE; 3622 int ret = 0; 3623 3624 if (s_idx == 0) 3625 s_idx = 1; 3626 3627 for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { 3628 struct rtnl_link **tab; 3629 struct rtnl_link *link; 3630 rtnl_dumpit_func dumpit; 3631 3632 if (idx < s_idx || idx == PF_PACKET) 3633 continue; 3634 3635 if (type < 0 || type >= RTM_NR_MSGTYPES) 3636 continue; 3637 3638 tab = rcu_dereference_rtnl(rtnl_msg_handlers[idx]); 3639 if (!tab) 3640 continue; 3641 3642 link = tab[type]; 3643 if (!link) 3644 continue; 3645 3646 dumpit = link->dumpit; 3647 if (!dumpit) 3648 continue; 3649 3650 if (idx > s_idx) { 3651 memset(&cb->args[0], 0, sizeof(cb->args)); 3652 cb->prev_seq = 0; 3653 cb->seq = 0; 3654 } 3655 ret = dumpit(skb, cb); 3656 if (ret) 3657 break; 3658 } 3659 cb->family = idx; 3660 3661 return skb->len ? : ret; 3662 } 3663 3664 struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev, 3665 unsigned int change, 3666 u32 event, gfp_t flags, int *new_nsid, 3667 int new_ifindex) 3668 { 3669 struct net *net = dev_net(dev); 3670 struct sk_buff *skb; 3671 int err = -ENOBUFS; 3672 size_t if_info_size; 3673 3674 skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags); 3675 if (skb == NULL) 3676 goto errout; 3677 3678 err = rtnl_fill_ifinfo(skb, dev, dev_net(dev), 3679 type, 0, 0, change, 0, 0, event, 3680 new_nsid, new_ifindex, -1, flags); 3681 if (err < 0) { 3682 /* -EMSGSIZE implies BUG in if_nlmsg_size() */ 3683 WARN_ON(err == -EMSGSIZE); 3684 kfree_skb(skb); 3685 goto errout; 3686 } 3687 return skb; 3688 errout: 3689 if (err < 0) 3690 rtnl_set_sk_err(net, RTNLGRP_LINK, err); 3691 return NULL; 3692 } 3693 3694 void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags) 3695 { 3696 struct net *net = dev_net(dev); 3697 3698 rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags); 3699 } 3700 3701 static void rtmsg_ifinfo_event(int type, struct net_device *dev, 3702 unsigned int change, u32 event, 3703 gfp_t flags, int *new_nsid, int new_ifindex) 3704 { 3705 struct sk_buff *skb; 3706 3707 if (dev->reg_state != NETREG_REGISTERED) 3708 return; 3709 3710 skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid, 3711 new_ifindex); 3712 if (skb) 3713 rtmsg_ifinfo_send(skb, dev, flags); 3714 } 3715 3716 void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change, 3717 gfp_t flags) 3718 { 3719 rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, 3720 NULL, 0); 3721 } 3722 3723 void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change, 3724 gfp_t flags, int *new_nsid, int new_ifindex) 3725 { 3726 rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, 3727 new_nsid, new_ifindex); 3728 } 3729 3730 static int nlmsg_populate_fdb_fill(struct sk_buff *skb, 3731 struct net_device *dev, 3732 u8 *addr, u16 vid, u32 pid, u32 seq, 3733 int type, unsigned int flags, 3734 int nlflags, u16 ndm_state) 3735 { 3736 struct nlmsghdr *nlh; 3737 struct ndmsg *ndm; 3738 3739 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags); 3740 if (!nlh) 3741 return -EMSGSIZE; 3742 3743 ndm = nlmsg_data(nlh); 3744 ndm->ndm_family = AF_BRIDGE; 3745 ndm->ndm_pad1 = 0; 3746 ndm->ndm_pad2 = 0; 3747 ndm->ndm_flags = flags; 3748 ndm->ndm_type = 0; 3749 ndm->ndm_ifindex = dev->ifindex; 3750 ndm->ndm_state = ndm_state; 3751 3752 if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr)) 3753 goto nla_put_failure; 3754 if (vid) 3755 if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid)) 3756 goto nla_put_failure; 3757 3758 nlmsg_end(skb, nlh); 3759 return 0; 3760 3761 nla_put_failure: 3762 nlmsg_cancel(skb, nlh); 3763 return -EMSGSIZE; 3764 } 3765 3766 static inline size_t rtnl_fdb_nlmsg_size(void) 3767 { 3768 return NLMSG_ALIGN(sizeof(struct ndmsg)) + 3769 nla_total_size(ETH_ALEN) + /* NDA_LLADDR */ 3770 nla_total_size(sizeof(u16)) + /* NDA_VLAN */ 3771 0; 3772 } 3773 3774 static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type, 3775 u16 ndm_state) 3776 { 3777 struct net *net = dev_net(dev); 3778 struct sk_buff *skb; 3779 int err = -ENOBUFS; 3780 3781 skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC); 3782 if (!skb) 3783 goto errout; 3784 3785 err = nlmsg_populate_fdb_fill(skb, dev, addr, vid, 3786 0, 0, type, NTF_SELF, 0, ndm_state); 3787 if (err < 0) { 3788 kfree_skb(skb); 3789 goto errout; 3790 } 3791 3792 rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC); 3793 return; 3794 errout: 3795 rtnl_set_sk_err(net, RTNLGRP_NEIGH, err); 3796 } 3797 3798 /* 3799 * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry 3800 */ 3801 int ndo_dflt_fdb_add(struct ndmsg *ndm, 3802 struct nlattr *tb[], 3803 struct net_device *dev, 3804 const unsigned char *addr, u16 vid, 3805 u16 flags) 3806 { 3807 int err = -EINVAL; 3808 3809 /* If aging addresses are supported device will need to 3810 * implement its own handler for this. 3811 */ 3812 if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) { 3813 pr_info("%s: FDB only supports static addresses\n", dev->name); 3814 return err; 3815 } 3816 3817 if (vid) { 3818 pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name); 3819 return err; 3820 } 3821 3822 if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3823 err = dev_uc_add_excl(dev, addr); 3824 else if (is_multicast_ether_addr(addr)) 3825 err = dev_mc_add_excl(dev, addr); 3826 3827 /* Only return duplicate errors if NLM_F_EXCL is set */ 3828 if (err == -EEXIST && !(flags & NLM_F_EXCL)) 3829 err = 0; 3830 3831 return err; 3832 } 3833 EXPORT_SYMBOL(ndo_dflt_fdb_add); 3834 3835 static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid, 3836 struct netlink_ext_ack *extack) 3837 { 3838 u16 vid = 0; 3839 3840 if (vlan_attr) { 3841 if (nla_len(vlan_attr) != sizeof(u16)) { 3842 NL_SET_ERR_MSG(extack, "invalid vlan attribute size"); 3843 return -EINVAL; 3844 } 3845 3846 vid = nla_get_u16(vlan_attr); 3847 3848 if (!vid || vid >= VLAN_VID_MASK) { 3849 NL_SET_ERR_MSG(extack, "invalid vlan id"); 3850 return -EINVAL; 3851 } 3852 } 3853 *p_vid = vid; 3854 return 0; 3855 } 3856 3857 static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh, 3858 struct netlink_ext_ack *extack) 3859 { 3860 struct net *net = sock_net(skb->sk); 3861 struct ndmsg *ndm; 3862 struct nlattr *tb[NDA_MAX+1]; 3863 struct net_device *dev; 3864 u8 *addr; 3865 u16 vid; 3866 int err; 3867 3868 err = nlmsg_parse_deprecated(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, 3869 extack); 3870 if (err < 0) 3871 return err; 3872 3873 ndm = nlmsg_data(nlh); 3874 if (ndm->ndm_ifindex == 0) { 3875 NL_SET_ERR_MSG(extack, "invalid ifindex"); 3876 return -EINVAL; 3877 } 3878 3879 dev = __dev_get_by_index(net, ndm->ndm_ifindex); 3880 if (dev == NULL) { 3881 NL_SET_ERR_MSG(extack, "unknown ifindex"); 3882 return -ENODEV; 3883 } 3884 3885 if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 3886 NL_SET_ERR_MSG(extack, "invalid address"); 3887 return -EINVAL; 3888 } 3889 3890 if (dev->type != ARPHRD_ETHER) { 3891 NL_SET_ERR_MSG(extack, "FDB add only supported for Ethernet devices"); 3892 return -EINVAL; 3893 } 3894 3895 addr = nla_data(tb[NDA_LLADDR]); 3896 3897 err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack); 3898 if (err) 3899 return err; 3900 3901 err = -EOPNOTSUPP; 3902 3903 /* Support fdb on master device the net/bridge default case */ 3904 if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 3905 (dev->priv_flags & IFF_BRIDGE_PORT)) { 3906 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3907 const struct net_device_ops *ops = br_dev->netdev_ops; 3908 3909 err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid, 3910 nlh->nlmsg_flags, extack); 3911 if (err) 3912 goto out; 3913 else 3914 ndm->ndm_flags &= ~NTF_MASTER; 3915 } 3916 3917 /* Embedded bridge, macvlan, and any other device support */ 3918 if ((ndm->ndm_flags & NTF_SELF)) { 3919 if (dev->netdev_ops->ndo_fdb_add) 3920 err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr, 3921 vid, 3922 nlh->nlmsg_flags, 3923 extack); 3924 else 3925 err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, 3926 nlh->nlmsg_flags); 3927 3928 if (!err) { 3929 rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH, 3930 ndm->ndm_state); 3931 ndm->ndm_flags &= ~NTF_SELF; 3932 } 3933 } 3934 out: 3935 return err; 3936 } 3937 3938 /* 3939 * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry 3940 */ 3941 int ndo_dflt_fdb_del(struct ndmsg *ndm, 3942 struct nlattr *tb[], 3943 struct net_device *dev, 3944 const unsigned char *addr, u16 vid) 3945 { 3946 int err = -EINVAL; 3947 3948 /* If aging addresses are supported device will need to 3949 * implement its own handler for this. 3950 */ 3951 if (!(ndm->ndm_state & NUD_PERMANENT)) { 3952 pr_info("%s: FDB only supports static addresses\n", dev->name); 3953 return err; 3954 } 3955 3956 if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3957 err = dev_uc_del(dev, addr); 3958 else if (is_multicast_ether_addr(addr)) 3959 err = dev_mc_del(dev, addr); 3960 3961 return err; 3962 } 3963 EXPORT_SYMBOL(ndo_dflt_fdb_del); 3964 3965 static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh, 3966 struct netlink_ext_ack *extack) 3967 { 3968 struct net *net = sock_net(skb->sk); 3969 struct ndmsg *ndm; 3970 struct nlattr *tb[NDA_MAX+1]; 3971 struct net_device *dev; 3972 int err = -EINVAL; 3973 __u8 *addr; 3974 u16 vid; 3975 3976 if (!netlink_capable(skb, CAP_NET_ADMIN)) 3977 return -EPERM; 3978 3979 err = nlmsg_parse_deprecated(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, 3980 extack); 3981 if (err < 0) 3982 return err; 3983 3984 ndm = nlmsg_data(nlh); 3985 if (ndm->ndm_ifindex == 0) { 3986 NL_SET_ERR_MSG(extack, "invalid ifindex"); 3987 return -EINVAL; 3988 } 3989 3990 dev = __dev_get_by_index(net, ndm->ndm_ifindex); 3991 if (dev == NULL) { 3992 NL_SET_ERR_MSG(extack, "unknown ifindex"); 3993 return -ENODEV; 3994 } 3995 3996 if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 3997 NL_SET_ERR_MSG(extack, "invalid address"); 3998 return -EINVAL; 3999 } 4000 4001 if (dev->type != ARPHRD_ETHER) { 4002 NL_SET_ERR_MSG(extack, "FDB delete only supported for Ethernet devices"); 4003 return -EINVAL; 4004 } 4005 4006 addr = nla_data(tb[NDA_LLADDR]); 4007 4008 err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack); 4009 if (err) 4010 return err; 4011 4012 err = -EOPNOTSUPP; 4013 4014 /* Support fdb on master device the net/bridge default case */ 4015 if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 4016 (dev->priv_flags & IFF_BRIDGE_PORT)) { 4017 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 4018 const struct net_device_ops *ops = br_dev->netdev_ops; 4019 4020 if (ops->ndo_fdb_del) 4021 err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid); 4022 4023 if (err) 4024 goto out; 4025 else 4026 ndm->ndm_flags &= ~NTF_MASTER; 4027 } 4028 4029 /* Embedded bridge, macvlan, and any other device support */ 4030 if (ndm->ndm_flags & NTF_SELF) { 4031 if (dev->netdev_ops->ndo_fdb_del) 4032 err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr, 4033 vid); 4034 else 4035 err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid); 4036 4037 if (!err) { 4038 rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH, 4039 ndm->ndm_state); 4040 ndm->ndm_flags &= ~NTF_SELF; 4041 } 4042 } 4043 out: 4044 return err; 4045 } 4046 4047 static int nlmsg_populate_fdb(struct sk_buff *skb, 4048 struct netlink_callback *cb, 4049 struct net_device *dev, 4050 int *idx, 4051 struct netdev_hw_addr_list *list) 4052 { 4053 struct netdev_hw_addr *ha; 4054 int err; 4055 u32 portid, seq; 4056 4057 portid = NETLINK_CB(cb->skb).portid; 4058 seq = cb->nlh->nlmsg_seq; 4059 4060 list_for_each_entry(ha, &list->list, list) { 4061 if (*idx < cb->args[2]) 4062 goto skip; 4063 4064 err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0, 4065 portid, seq, 4066 RTM_NEWNEIGH, NTF_SELF, 4067 NLM_F_MULTI, NUD_PERMANENT); 4068 if (err < 0) 4069 return err; 4070 skip: 4071 *idx += 1; 4072 } 4073 return 0; 4074 } 4075 4076 /** 4077 * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table. 4078 * @skb: socket buffer to store message in 4079 * @cb: netlink callback 4080 * @dev: netdevice 4081 * @filter_dev: ignored 4082 * @idx: the number of FDB table entries dumped is added to *@idx 4083 * 4084 * Default netdevice operation to dump the existing unicast address list. 4085 * Returns number of addresses from list put in skb. 4086 */ 4087 int ndo_dflt_fdb_dump(struct sk_buff *skb, 4088 struct netlink_callback *cb, 4089 struct net_device *dev, 4090 struct net_device *filter_dev, 4091 int *idx) 4092 { 4093 int err; 4094 4095 if (dev->type != ARPHRD_ETHER) 4096 return -EINVAL; 4097 4098 netif_addr_lock_bh(dev); 4099 err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc); 4100 if (err) 4101 goto out; 4102 err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc); 4103 out: 4104 netif_addr_unlock_bh(dev); 4105 return err; 4106 } 4107 EXPORT_SYMBOL(ndo_dflt_fdb_dump); 4108 4109 static int valid_fdb_dump_strict(const struct nlmsghdr *nlh, 4110 int *br_idx, int *brport_idx, 4111 struct netlink_ext_ack *extack) 4112 { 4113 struct nlattr *tb[NDA_MAX + 1]; 4114 struct ndmsg *ndm; 4115 int err, i; 4116 4117 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ndm))) { 4118 NL_SET_ERR_MSG(extack, "Invalid header for fdb dump request"); 4119 return -EINVAL; 4120 } 4121 4122 ndm = nlmsg_data(nlh); 4123 if (ndm->ndm_pad1 || ndm->ndm_pad2 || ndm->ndm_state || 4124 ndm->ndm_flags || ndm->ndm_type) { 4125 NL_SET_ERR_MSG(extack, "Invalid values in header for fdb dump request"); 4126 return -EINVAL; 4127 } 4128 4129 err = nlmsg_parse_deprecated_strict(nlh, sizeof(struct ndmsg), tb, 4130 NDA_MAX, NULL, extack); 4131 if (err < 0) 4132 return err; 4133 4134 *brport_idx = ndm->ndm_ifindex; 4135 for (i = 0; i <= NDA_MAX; ++i) { 4136 if (!tb[i]) 4137 continue; 4138 4139 switch (i) { 4140 case NDA_IFINDEX: 4141 if (nla_len(tb[i]) != sizeof(u32)) { 4142 NL_SET_ERR_MSG(extack, "Invalid IFINDEX attribute in fdb dump request"); 4143 return -EINVAL; 4144 } 4145 *brport_idx = nla_get_u32(tb[NDA_IFINDEX]); 4146 break; 4147 case NDA_MASTER: 4148 if (nla_len(tb[i]) != sizeof(u32)) { 4149 NL_SET_ERR_MSG(extack, "Invalid MASTER attribute in fdb dump request"); 4150 return -EINVAL; 4151 } 4152 *br_idx = nla_get_u32(tb[NDA_MASTER]); 4153 break; 4154 default: 4155 NL_SET_ERR_MSG(extack, "Unsupported attribute in fdb dump request"); 4156 return -EINVAL; 4157 } 4158 } 4159 4160 return 0; 4161 } 4162 4163 static int valid_fdb_dump_legacy(const struct nlmsghdr *nlh, 4164 int *br_idx, int *brport_idx, 4165 struct netlink_ext_ack *extack) 4166 { 4167 struct nlattr *tb[IFLA_MAX+1]; 4168 int err; 4169 4170 /* A hack to preserve kernel<->userspace interface. 4171 * Before Linux v4.12 this code accepted ndmsg since iproute2 v3.3.0. 4172 * However, ndmsg is shorter than ifinfomsg thus nlmsg_parse() bails. 4173 * So, check for ndmsg with an optional u32 attribute (not used here). 4174 * Fortunately these sizes don't conflict with the size of ifinfomsg 4175 * with an optional attribute. 4176 */ 4177 if (nlmsg_len(nlh) != sizeof(struct ndmsg) && 4178 (nlmsg_len(nlh) != sizeof(struct ndmsg) + 4179 nla_attr_size(sizeof(u32)))) { 4180 struct ifinfomsg *ifm; 4181 4182 err = nlmsg_parse_deprecated(nlh, sizeof(struct ifinfomsg), 4183 tb, IFLA_MAX, ifla_policy, 4184 extack); 4185 if (err < 0) { 4186 return -EINVAL; 4187 } else if (err == 0) { 4188 if (tb[IFLA_MASTER]) 4189 *br_idx = nla_get_u32(tb[IFLA_MASTER]); 4190 } 4191 4192 ifm = nlmsg_data(nlh); 4193 *brport_idx = ifm->ifi_index; 4194 } 4195 return 0; 4196 } 4197 4198 static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb) 4199 { 4200 struct net_device *dev; 4201 struct net_device *br_dev = NULL; 4202 const struct net_device_ops *ops = NULL; 4203 const struct net_device_ops *cops = NULL; 4204 struct net *net = sock_net(skb->sk); 4205 struct hlist_head *head; 4206 int brport_idx = 0; 4207 int br_idx = 0; 4208 int h, s_h; 4209 int idx = 0, s_idx; 4210 int err = 0; 4211 int fidx = 0; 4212 4213 if (cb->strict_check) 4214 err = valid_fdb_dump_strict(cb->nlh, &br_idx, &brport_idx, 4215 cb->extack); 4216 else 4217 err = valid_fdb_dump_legacy(cb->nlh, &br_idx, &brport_idx, 4218 cb->extack); 4219 if (err < 0) 4220 return err; 4221 4222 if (br_idx) { 4223 br_dev = __dev_get_by_index(net, br_idx); 4224 if (!br_dev) 4225 return -ENODEV; 4226 4227 ops = br_dev->netdev_ops; 4228 } 4229 4230 s_h = cb->args[0]; 4231 s_idx = cb->args[1]; 4232 4233 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 4234 idx = 0; 4235 head = &net->dev_index_head[h]; 4236 hlist_for_each_entry(dev, head, index_hlist) { 4237 4238 if (brport_idx && (dev->ifindex != brport_idx)) 4239 continue; 4240 4241 if (!br_idx) { /* user did not specify a specific bridge */ 4242 if (dev->priv_flags & IFF_BRIDGE_PORT) { 4243 br_dev = netdev_master_upper_dev_get(dev); 4244 cops = br_dev->netdev_ops; 4245 } 4246 } else { 4247 if (dev != br_dev && 4248 !(dev->priv_flags & IFF_BRIDGE_PORT)) 4249 continue; 4250 4251 if (br_dev != netdev_master_upper_dev_get(dev) && 4252 !(dev->priv_flags & IFF_EBRIDGE)) 4253 continue; 4254 cops = ops; 4255 } 4256 4257 if (idx < s_idx) 4258 goto cont; 4259 4260 if (dev->priv_flags & IFF_BRIDGE_PORT) { 4261 if (cops && cops->ndo_fdb_dump) { 4262 err = cops->ndo_fdb_dump(skb, cb, 4263 br_dev, dev, 4264 &fidx); 4265 if (err == -EMSGSIZE) 4266 goto out; 4267 } 4268 } 4269 4270 if (dev->netdev_ops->ndo_fdb_dump) 4271 err = dev->netdev_ops->ndo_fdb_dump(skb, cb, 4272 dev, NULL, 4273 &fidx); 4274 else 4275 err = ndo_dflt_fdb_dump(skb, cb, dev, NULL, 4276 &fidx); 4277 if (err == -EMSGSIZE) 4278 goto out; 4279 4280 cops = NULL; 4281 4282 /* reset fdb offset to 0 for rest of the interfaces */ 4283 cb->args[2] = 0; 4284 fidx = 0; 4285 cont: 4286 idx++; 4287 } 4288 } 4289 4290 out: 4291 cb->args[0] = h; 4292 cb->args[1] = idx; 4293 cb->args[2] = fidx; 4294 4295 return skb->len; 4296 } 4297 4298 static int valid_fdb_get_strict(const struct nlmsghdr *nlh, 4299 struct nlattr **tb, u8 *ndm_flags, 4300 int *br_idx, int *brport_idx, u8 **addr, 4301 u16 *vid, struct netlink_ext_ack *extack) 4302 { 4303 struct ndmsg *ndm; 4304 int err, i; 4305 4306 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ndm))) { 4307 NL_SET_ERR_MSG(extack, "Invalid header for fdb get request"); 4308 return -EINVAL; 4309 } 4310 4311 ndm = nlmsg_data(nlh); 4312 if (ndm->ndm_pad1 || ndm->ndm_pad2 || ndm->ndm_state || 4313 ndm->ndm_type) { 4314 NL_SET_ERR_MSG(extack, "Invalid values in header for fdb get request"); 4315 return -EINVAL; 4316 } 4317 4318 if (ndm->ndm_flags & ~(NTF_MASTER | NTF_SELF)) { 4319 NL_SET_ERR_MSG(extack, "Invalid flags in header for fdb get request"); 4320 return -EINVAL; 4321 } 4322 4323 err = nlmsg_parse_deprecated_strict(nlh, sizeof(struct ndmsg), tb, 4324 NDA_MAX, nda_policy, extack); 4325 if (err < 0) 4326 return err; 4327 4328 *ndm_flags = ndm->ndm_flags; 4329 *brport_idx = ndm->ndm_ifindex; 4330 for (i = 0; i <= NDA_MAX; ++i) { 4331 if (!tb[i]) 4332 continue; 4333 4334 switch (i) { 4335 case NDA_MASTER: 4336 *br_idx = nla_get_u32(tb[i]); 4337 break; 4338 case NDA_LLADDR: 4339 if (nla_len(tb[i]) != ETH_ALEN) { 4340 NL_SET_ERR_MSG(extack, "Invalid address in fdb get request"); 4341 return -EINVAL; 4342 } 4343 *addr = nla_data(tb[i]); 4344 break; 4345 case NDA_VLAN: 4346 err = fdb_vid_parse(tb[i], vid, extack); 4347 if (err) 4348 return err; 4349 break; 4350 case NDA_VNI: 4351 break; 4352 default: 4353 NL_SET_ERR_MSG(extack, "Unsupported attribute in fdb get request"); 4354 return -EINVAL; 4355 } 4356 } 4357 4358 return 0; 4359 } 4360 4361 static int rtnl_fdb_get(struct sk_buff *in_skb, struct nlmsghdr *nlh, 4362 struct netlink_ext_ack *extack) 4363 { 4364 struct net_device *dev = NULL, *br_dev = NULL; 4365 const struct net_device_ops *ops = NULL; 4366 struct net *net = sock_net(in_skb->sk); 4367 struct nlattr *tb[NDA_MAX + 1]; 4368 struct sk_buff *skb; 4369 int brport_idx = 0; 4370 u8 ndm_flags = 0; 4371 int br_idx = 0; 4372 u8 *addr = NULL; 4373 u16 vid = 0; 4374 int err; 4375 4376 err = valid_fdb_get_strict(nlh, tb, &ndm_flags, &br_idx, 4377 &brport_idx, &addr, &vid, extack); 4378 if (err < 0) 4379 return err; 4380 4381 if (!addr) { 4382 NL_SET_ERR_MSG(extack, "Missing lookup address for fdb get request"); 4383 return -EINVAL; 4384 } 4385 4386 if (brport_idx) { 4387 dev = __dev_get_by_index(net, brport_idx); 4388 if (!dev) { 4389 NL_SET_ERR_MSG(extack, "Unknown device ifindex"); 4390 return -ENODEV; 4391 } 4392 } 4393 4394 if (br_idx) { 4395 if (dev) { 4396 NL_SET_ERR_MSG(extack, "Master and device are mutually exclusive"); 4397 return -EINVAL; 4398 } 4399 4400 br_dev = __dev_get_by_index(net, br_idx); 4401 if (!br_dev) { 4402 NL_SET_ERR_MSG(extack, "Invalid master ifindex"); 4403 return -EINVAL; 4404 } 4405 ops = br_dev->netdev_ops; 4406 } 4407 4408 if (dev) { 4409 if (!ndm_flags || (ndm_flags & NTF_MASTER)) { 4410 if (!(dev->priv_flags & IFF_BRIDGE_PORT)) { 4411 NL_SET_ERR_MSG(extack, "Device is not a bridge port"); 4412 return -EINVAL; 4413 } 4414 br_dev = netdev_master_upper_dev_get(dev); 4415 if (!br_dev) { 4416 NL_SET_ERR_MSG(extack, "Master of device not found"); 4417 return -EINVAL; 4418 } 4419 ops = br_dev->netdev_ops; 4420 } else { 4421 if (!(ndm_flags & NTF_SELF)) { 4422 NL_SET_ERR_MSG(extack, "Missing NTF_SELF"); 4423 return -EINVAL; 4424 } 4425 ops = dev->netdev_ops; 4426 } 4427 } 4428 4429 if (!br_dev && !dev) { 4430 NL_SET_ERR_MSG(extack, "No device specified"); 4431 return -ENODEV; 4432 } 4433 4434 if (!ops || !ops->ndo_fdb_get) { 4435 NL_SET_ERR_MSG(extack, "Fdb get operation not supported by device"); 4436 return -EOPNOTSUPP; 4437 } 4438 4439 skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL); 4440 if (!skb) 4441 return -ENOBUFS; 4442 4443 if (br_dev) 4444 dev = br_dev; 4445 err = ops->ndo_fdb_get(skb, tb, dev, addr, vid, 4446 NETLINK_CB(in_skb).portid, 4447 nlh->nlmsg_seq, extack); 4448 if (err) 4449 goto out; 4450 4451 return rtnl_unicast(skb, net, NETLINK_CB(in_skb).portid); 4452 out: 4453 kfree_skb(skb); 4454 return err; 4455 } 4456 4457 static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask, 4458 unsigned int attrnum, unsigned int flag) 4459 { 4460 if (mask & flag) 4461 return nla_put_u8(skb, attrnum, !!(flags & flag)); 4462 return 0; 4463 } 4464 4465 int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq, 4466 struct net_device *dev, u16 mode, 4467 u32 flags, u32 mask, int nlflags, 4468 u32 filter_mask, 4469 int (*vlan_fill)(struct sk_buff *skb, 4470 struct net_device *dev, 4471 u32 filter_mask)) 4472 { 4473 struct nlmsghdr *nlh; 4474 struct ifinfomsg *ifm; 4475 struct nlattr *br_afspec; 4476 struct nlattr *protinfo; 4477 u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN; 4478 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 4479 int err = 0; 4480 4481 nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags); 4482 if (nlh == NULL) 4483 return -EMSGSIZE; 4484 4485 ifm = nlmsg_data(nlh); 4486 ifm->ifi_family = AF_BRIDGE; 4487 ifm->__ifi_pad = 0; 4488 ifm->ifi_type = dev->type; 4489 ifm->ifi_index = dev->ifindex; 4490 ifm->ifi_flags = dev_get_flags(dev); 4491 ifm->ifi_change = 0; 4492 4493 4494 if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 4495 nla_put_u32(skb, IFLA_MTU, dev->mtu) || 4496 nla_put_u8(skb, IFLA_OPERSTATE, operstate) || 4497 (br_dev && 4498 nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) || 4499 (dev->addr_len && 4500 nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) || 4501 (dev->ifindex != dev_get_iflink(dev) && 4502 nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev)))) 4503 goto nla_put_failure; 4504 4505 br_afspec = nla_nest_start_noflag(skb, IFLA_AF_SPEC); 4506 if (!br_afspec) 4507 goto nla_put_failure; 4508 4509 if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) { 4510 nla_nest_cancel(skb, br_afspec); 4511 goto nla_put_failure; 4512 } 4513 4514 if (mode != BRIDGE_MODE_UNDEF) { 4515 if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) { 4516 nla_nest_cancel(skb, br_afspec); 4517 goto nla_put_failure; 4518 } 4519 } 4520 if (vlan_fill) { 4521 err = vlan_fill(skb, dev, filter_mask); 4522 if (err) { 4523 nla_nest_cancel(skb, br_afspec); 4524 goto nla_put_failure; 4525 } 4526 } 4527 nla_nest_end(skb, br_afspec); 4528 4529 protinfo = nla_nest_start(skb, IFLA_PROTINFO); 4530 if (!protinfo) 4531 goto nla_put_failure; 4532 4533 if (brport_nla_put_flag(skb, flags, mask, 4534 IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) || 4535 brport_nla_put_flag(skb, flags, mask, 4536 IFLA_BRPORT_GUARD, BR_BPDU_GUARD) || 4537 brport_nla_put_flag(skb, flags, mask, 4538 IFLA_BRPORT_FAST_LEAVE, 4539 BR_MULTICAST_FAST_LEAVE) || 4540 brport_nla_put_flag(skb, flags, mask, 4541 IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) || 4542 brport_nla_put_flag(skb, flags, mask, 4543 IFLA_BRPORT_LEARNING, BR_LEARNING) || 4544 brport_nla_put_flag(skb, flags, mask, 4545 IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) || 4546 brport_nla_put_flag(skb, flags, mask, 4547 IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) || 4548 brport_nla_put_flag(skb, flags, mask, 4549 IFLA_BRPORT_PROXYARP, BR_PROXYARP)) { 4550 nla_nest_cancel(skb, protinfo); 4551 goto nla_put_failure; 4552 } 4553 4554 nla_nest_end(skb, protinfo); 4555 4556 nlmsg_end(skb, nlh); 4557 return 0; 4558 nla_put_failure: 4559 nlmsg_cancel(skb, nlh); 4560 return err ? err : -EMSGSIZE; 4561 } 4562 EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink); 4563 4564 static int valid_bridge_getlink_req(const struct nlmsghdr *nlh, 4565 bool strict_check, u32 *filter_mask, 4566 struct netlink_ext_ack *extack) 4567 { 4568 struct nlattr *tb[IFLA_MAX+1]; 4569 int err, i; 4570 4571 if (strict_check) { 4572 struct ifinfomsg *ifm; 4573 4574 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) { 4575 NL_SET_ERR_MSG(extack, "Invalid header for bridge link dump"); 4576 return -EINVAL; 4577 } 4578 4579 ifm = nlmsg_data(nlh); 4580 if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags || 4581 ifm->ifi_change || ifm->ifi_index) { 4582 NL_SET_ERR_MSG(extack, "Invalid values in header for bridge link dump request"); 4583 return -EINVAL; 4584 } 4585 4586 err = nlmsg_parse_deprecated_strict(nlh, 4587 sizeof(struct ifinfomsg), 4588 tb, IFLA_MAX, ifla_policy, 4589 extack); 4590 } else { 4591 err = nlmsg_parse_deprecated(nlh, sizeof(struct ifinfomsg), 4592 tb, IFLA_MAX, ifla_policy, 4593 extack); 4594 } 4595 if (err < 0) 4596 return err; 4597 4598 /* new attributes should only be added with strict checking */ 4599 for (i = 0; i <= IFLA_MAX; ++i) { 4600 if (!tb[i]) 4601 continue; 4602 4603 switch (i) { 4604 case IFLA_EXT_MASK: 4605 *filter_mask = nla_get_u32(tb[i]); 4606 break; 4607 default: 4608 if (strict_check) { 4609 NL_SET_ERR_MSG(extack, "Unsupported attribute in bridge link dump request"); 4610 return -EINVAL; 4611 } 4612 } 4613 } 4614 4615 return 0; 4616 } 4617 4618 static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb) 4619 { 4620 const struct nlmsghdr *nlh = cb->nlh; 4621 struct net *net = sock_net(skb->sk); 4622 struct net_device *dev; 4623 int idx = 0; 4624 u32 portid = NETLINK_CB(cb->skb).portid; 4625 u32 seq = nlh->nlmsg_seq; 4626 u32 filter_mask = 0; 4627 int err; 4628 4629 err = valid_bridge_getlink_req(nlh, cb->strict_check, &filter_mask, 4630 cb->extack); 4631 if (err < 0 && cb->strict_check) 4632 return err; 4633 4634 rcu_read_lock(); 4635 for_each_netdev_rcu(net, dev) { 4636 const struct net_device_ops *ops = dev->netdev_ops; 4637 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 4638 4639 if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) { 4640 if (idx >= cb->args[0]) { 4641 err = br_dev->netdev_ops->ndo_bridge_getlink( 4642 skb, portid, seq, dev, 4643 filter_mask, NLM_F_MULTI); 4644 if (err < 0 && err != -EOPNOTSUPP) { 4645 if (likely(skb->len)) 4646 break; 4647 4648 goto out_err; 4649 } 4650 } 4651 idx++; 4652 } 4653 4654 if (ops->ndo_bridge_getlink) { 4655 if (idx >= cb->args[0]) { 4656 err = ops->ndo_bridge_getlink(skb, portid, 4657 seq, dev, 4658 filter_mask, 4659 NLM_F_MULTI); 4660 if (err < 0 && err != -EOPNOTSUPP) { 4661 if (likely(skb->len)) 4662 break; 4663 4664 goto out_err; 4665 } 4666 } 4667 idx++; 4668 } 4669 } 4670 err = skb->len; 4671 out_err: 4672 rcu_read_unlock(); 4673 cb->args[0] = idx; 4674 4675 return err; 4676 } 4677 4678 static inline size_t bridge_nlmsg_size(void) 4679 { 4680 return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 4681 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 4682 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 4683 + nla_total_size(sizeof(u32)) /* IFLA_MASTER */ 4684 + nla_total_size(sizeof(u32)) /* IFLA_MTU */ 4685 + nla_total_size(sizeof(u32)) /* IFLA_LINK */ 4686 + nla_total_size(sizeof(u32)) /* IFLA_OPERSTATE */ 4687 + nla_total_size(sizeof(u8)) /* IFLA_PROTINFO */ 4688 + nla_total_size(sizeof(struct nlattr)) /* IFLA_AF_SPEC */ 4689 + nla_total_size(sizeof(u16)) /* IFLA_BRIDGE_FLAGS */ 4690 + nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_MODE */ 4691 } 4692 4693 static int rtnl_bridge_notify(struct net_device *dev) 4694 { 4695 struct net *net = dev_net(dev); 4696 struct sk_buff *skb; 4697 int err = -EOPNOTSUPP; 4698 4699 if (!dev->netdev_ops->ndo_bridge_getlink) 4700 return 0; 4701 4702 skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC); 4703 if (!skb) { 4704 err = -ENOMEM; 4705 goto errout; 4706 } 4707 4708 err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0); 4709 if (err < 0) 4710 goto errout; 4711 4712 if (!skb->len) 4713 goto errout; 4714 4715 rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC); 4716 return 0; 4717 errout: 4718 WARN_ON(err == -EMSGSIZE); 4719 kfree_skb(skb); 4720 if (err) 4721 rtnl_set_sk_err(net, RTNLGRP_LINK, err); 4722 return err; 4723 } 4724 4725 static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 4726 struct netlink_ext_ack *extack) 4727 { 4728 struct net *net = sock_net(skb->sk); 4729 struct ifinfomsg *ifm; 4730 struct net_device *dev; 4731 struct nlattr *br_spec, *attr = NULL; 4732 int rem, err = -EOPNOTSUPP; 4733 u16 flags = 0; 4734 bool have_flags = false; 4735 4736 if (nlmsg_len(nlh) < sizeof(*ifm)) 4737 return -EINVAL; 4738 4739 ifm = nlmsg_data(nlh); 4740 if (ifm->ifi_family != AF_BRIDGE) 4741 return -EPFNOSUPPORT; 4742 4743 dev = __dev_get_by_index(net, ifm->ifi_index); 4744 if (!dev) { 4745 NL_SET_ERR_MSG(extack, "unknown ifindex"); 4746 return -ENODEV; 4747 } 4748 4749 br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 4750 if (br_spec) { 4751 nla_for_each_nested(attr, br_spec, rem) { 4752 if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 4753 if (nla_len(attr) < sizeof(flags)) 4754 return -EINVAL; 4755 4756 have_flags = true; 4757 flags = nla_get_u16(attr); 4758 break; 4759 } 4760 } 4761 } 4762 4763 if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 4764 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 4765 4766 if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) { 4767 err = -EOPNOTSUPP; 4768 goto out; 4769 } 4770 4771 err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags, 4772 extack); 4773 if (err) 4774 goto out; 4775 4776 flags &= ~BRIDGE_FLAGS_MASTER; 4777 } 4778 4779 if ((flags & BRIDGE_FLAGS_SELF)) { 4780 if (!dev->netdev_ops->ndo_bridge_setlink) 4781 err = -EOPNOTSUPP; 4782 else 4783 err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh, 4784 flags, 4785 extack); 4786 if (!err) { 4787 flags &= ~BRIDGE_FLAGS_SELF; 4788 4789 /* Generate event to notify upper layer of bridge 4790 * change 4791 */ 4792 err = rtnl_bridge_notify(dev); 4793 } 4794 } 4795 4796 if (have_flags) 4797 memcpy(nla_data(attr), &flags, sizeof(flags)); 4798 out: 4799 return err; 4800 } 4801 4802 static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 4803 struct netlink_ext_ack *extack) 4804 { 4805 struct net *net = sock_net(skb->sk); 4806 struct ifinfomsg *ifm; 4807 struct net_device *dev; 4808 struct nlattr *br_spec, *attr = NULL; 4809 int rem, err = -EOPNOTSUPP; 4810 u16 flags = 0; 4811 bool have_flags = false; 4812 4813 if (nlmsg_len(nlh) < sizeof(*ifm)) 4814 return -EINVAL; 4815 4816 ifm = nlmsg_data(nlh); 4817 if (ifm->ifi_family != AF_BRIDGE) 4818 return -EPFNOSUPPORT; 4819 4820 dev = __dev_get_by_index(net, ifm->ifi_index); 4821 if (!dev) { 4822 NL_SET_ERR_MSG(extack, "unknown ifindex"); 4823 return -ENODEV; 4824 } 4825 4826 br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 4827 if (br_spec) { 4828 nla_for_each_nested(attr, br_spec, rem) { 4829 if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 4830 if (nla_len(attr) < sizeof(flags)) 4831 return -EINVAL; 4832 4833 have_flags = true; 4834 flags = nla_get_u16(attr); 4835 break; 4836 } 4837 } 4838 } 4839 4840 if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 4841 struct net_device *br_dev = netdev_master_upper_dev_get(dev); 4842 4843 if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) { 4844 err = -EOPNOTSUPP; 4845 goto out; 4846 } 4847 4848 err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags); 4849 if (err) 4850 goto out; 4851 4852 flags &= ~BRIDGE_FLAGS_MASTER; 4853 } 4854 4855 if ((flags & BRIDGE_FLAGS_SELF)) { 4856 if (!dev->netdev_ops->ndo_bridge_dellink) 4857 err = -EOPNOTSUPP; 4858 else 4859 err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh, 4860 flags); 4861 4862 if (!err) { 4863 flags &= ~BRIDGE_FLAGS_SELF; 4864 4865 /* Generate event to notify upper layer of bridge 4866 * change 4867 */ 4868 err = rtnl_bridge_notify(dev); 4869 } 4870 } 4871 4872 if (have_flags) 4873 memcpy(nla_data(attr), &flags, sizeof(flags)); 4874 out: 4875 return err; 4876 } 4877 4878 static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr) 4879 { 4880 return (mask & IFLA_STATS_FILTER_BIT(attrid)) && 4881 (!idxattr || idxattr == attrid); 4882 } 4883 4884 #define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1) 4885 static int rtnl_get_offload_stats_attr_size(int attr_id) 4886 { 4887 switch (attr_id) { 4888 case IFLA_OFFLOAD_XSTATS_CPU_HIT: 4889 return sizeof(struct rtnl_link_stats64); 4890 } 4891 4892 return 0; 4893 } 4894 4895 static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev, 4896 int *prividx) 4897 { 4898 struct nlattr *attr = NULL; 4899 int attr_id, size; 4900 void *attr_data; 4901 int err; 4902 4903 if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 4904 dev->netdev_ops->ndo_get_offload_stats)) 4905 return -ENODATA; 4906 4907 for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 4908 attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 4909 if (attr_id < *prividx) 4910 continue; 4911 4912 size = rtnl_get_offload_stats_attr_size(attr_id); 4913 if (!size) 4914 continue; 4915 4916 if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 4917 continue; 4918 4919 attr = nla_reserve_64bit(skb, attr_id, size, 4920 IFLA_OFFLOAD_XSTATS_UNSPEC); 4921 if (!attr) 4922 goto nla_put_failure; 4923 4924 attr_data = nla_data(attr); 4925 memset(attr_data, 0, size); 4926 err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev, 4927 attr_data); 4928 if (err) 4929 goto get_offload_stats_failure; 4930 } 4931 4932 if (!attr) 4933 return -ENODATA; 4934 4935 *prividx = 0; 4936 return 0; 4937 4938 nla_put_failure: 4939 err = -EMSGSIZE; 4940 get_offload_stats_failure: 4941 *prividx = attr_id; 4942 return err; 4943 } 4944 4945 static int rtnl_get_offload_stats_size(const struct net_device *dev) 4946 { 4947 int nla_size = 0; 4948 int attr_id; 4949 int size; 4950 4951 if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 4952 dev->netdev_ops->ndo_get_offload_stats)) 4953 return 0; 4954 4955 for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 4956 attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 4957 if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 4958 continue; 4959 size = rtnl_get_offload_stats_attr_size(attr_id); 4960 nla_size += nla_total_size_64bit(size); 4961 } 4962 4963 if (nla_size != 0) 4964 nla_size += nla_total_size(0); 4965 4966 return nla_size; 4967 } 4968 4969 static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev, 4970 int type, u32 pid, u32 seq, u32 change, 4971 unsigned int flags, unsigned int filter_mask, 4972 int *idxattr, int *prividx) 4973 { 4974 struct if_stats_msg *ifsm; 4975 struct nlmsghdr *nlh; 4976 struct nlattr *attr; 4977 int s_prividx = *prividx; 4978 int err; 4979 4980 ASSERT_RTNL(); 4981 4982 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags); 4983 if (!nlh) 4984 return -EMSGSIZE; 4985 4986 ifsm = nlmsg_data(nlh); 4987 ifsm->family = PF_UNSPEC; 4988 ifsm->pad1 = 0; 4989 ifsm->pad2 = 0; 4990 ifsm->ifindex = dev->ifindex; 4991 ifsm->filter_mask = filter_mask; 4992 4993 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) { 4994 struct rtnl_link_stats64 *sp; 4995 4996 attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64, 4997 sizeof(struct rtnl_link_stats64), 4998 IFLA_STATS_UNSPEC); 4999 if (!attr) 5000 goto nla_put_failure; 5001 5002 sp = nla_data(attr); 5003 dev_get_stats(dev, sp); 5004 } 5005 5006 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) { 5007 const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 5008 5009 if (ops && ops->fill_linkxstats) { 5010 *idxattr = IFLA_STATS_LINK_XSTATS; 5011 attr = nla_nest_start_noflag(skb, 5012 IFLA_STATS_LINK_XSTATS); 5013 if (!attr) 5014 goto nla_put_failure; 5015 5016 err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 5017 nla_nest_end(skb, attr); 5018 if (err) 5019 goto nla_put_failure; 5020 *idxattr = 0; 5021 } 5022 } 5023 5024 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 5025 *idxattr)) { 5026 const struct rtnl_link_ops *ops = NULL; 5027 const struct net_device *master; 5028 5029 master = netdev_master_upper_dev_get(dev); 5030 if (master) 5031 ops = master->rtnl_link_ops; 5032 if (ops && ops->fill_linkxstats) { 5033 *idxattr = IFLA_STATS_LINK_XSTATS_SLAVE; 5034 attr = nla_nest_start_noflag(skb, 5035 IFLA_STATS_LINK_XSTATS_SLAVE); 5036 if (!attr) 5037 goto nla_put_failure; 5038 5039 err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 5040 nla_nest_end(skb, attr); 5041 if (err) 5042 goto nla_put_failure; 5043 *idxattr = 0; 5044 } 5045 } 5046 5047 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 5048 *idxattr)) { 5049 *idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS; 5050 attr = nla_nest_start_noflag(skb, 5051 IFLA_STATS_LINK_OFFLOAD_XSTATS); 5052 if (!attr) 5053 goto nla_put_failure; 5054 5055 err = rtnl_get_offload_stats(skb, dev, prividx); 5056 if (err == -ENODATA) 5057 nla_nest_cancel(skb, attr); 5058 else 5059 nla_nest_end(skb, attr); 5060 5061 if (err && err != -ENODATA) 5062 goto nla_put_failure; 5063 *idxattr = 0; 5064 } 5065 5066 if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) { 5067 struct rtnl_af_ops *af_ops; 5068 5069 *idxattr = IFLA_STATS_AF_SPEC; 5070 attr = nla_nest_start_noflag(skb, IFLA_STATS_AF_SPEC); 5071 if (!attr) 5072 goto nla_put_failure; 5073 5074 rcu_read_lock(); 5075 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 5076 if (af_ops->fill_stats_af) { 5077 struct nlattr *af; 5078 int err; 5079 5080 af = nla_nest_start_noflag(skb, 5081 af_ops->family); 5082 if (!af) { 5083 rcu_read_unlock(); 5084 goto nla_put_failure; 5085 } 5086 err = af_ops->fill_stats_af(skb, dev); 5087 5088 if (err == -ENODATA) { 5089 nla_nest_cancel(skb, af); 5090 } else if (err < 0) { 5091 rcu_read_unlock(); 5092 goto nla_put_failure; 5093 } 5094 5095 nla_nest_end(skb, af); 5096 } 5097 } 5098 rcu_read_unlock(); 5099 5100 nla_nest_end(skb, attr); 5101 5102 *idxattr = 0; 5103 } 5104 5105 nlmsg_end(skb, nlh); 5106 5107 return 0; 5108 5109 nla_put_failure: 5110 /* not a multi message or no progress mean a real error */ 5111 if (!(flags & NLM_F_MULTI) || s_prividx == *prividx) 5112 nlmsg_cancel(skb, nlh); 5113 else 5114 nlmsg_end(skb, nlh); 5115 5116 return -EMSGSIZE; 5117 } 5118 5119 static size_t if_nlmsg_stats_size(const struct net_device *dev, 5120 u32 filter_mask) 5121 { 5122 size_t size = 0; 5123 5124 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0)) 5125 size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64)); 5126 5127 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) { 5128 const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 5129 int attr = IFLA_STATS_LINK_XSTATS; 5130 5131 if (ops && ops->get_linkxstats_size) { 5132 size += nla_total_size(ops->get_linkxstats_size(dev, 5133 attr)); 5134 /* for IFLA_STATS_LINK_XSTATS */ 5135 size += nla_total_size(0); 5136 } 5137 } 5138 5139 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) { 5140 struct net_device *_dev = (struct net_device *)dev; 5141 const struct rtnl_link_ops *ops = NULL; 5142 const struct net_device *master; 5143 5144 /* netdev_master_upper_dev_get can't take const */ 5145 master = netdev_master_upper_dev_get(_dev); 5146 if (master) 5147 ops = master->rtnl_link_ops; 5148 if (ops && ops->get_linkxstats_size) { 5149 int attr = IFLA_STATS_LINK_XSTATS_SLAVE; 5150 5151 size += nla_total_size(ops->get_linkxstats_size(dev, 5152 attr)); 5153 /* for IFLA_STATS_LINK_XSTATS_SLAVE */ 5154 size += nla_total_size(0); 5155 } 5156 } 5157 5158 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0)) 5159 size += rtnl_get_offload_stats_size(dev); 5160 5161 if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) { 5162 struct rtnl_af_ops *af_ops; 5163 5164 /* for IFLA_STATS_AF_SPEC */ 5165 size += nla_total_size(0); 5166 5167 rcu_read_lock(); 5168 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 5169 if (af_ops->get_stats_af_size) { 5170 size += nla_total_size( 5171 af_ops->get_stats_af_size(dev)); 5172 5173 /* for AF_* */ 5174 size += nla_total_size(0); 5175 } 5176 } 5177 rcu_read_unlock(); 5178 } 5179 5180 return size; 5181 } 5182 5183 static int rtnl_valid_stats_req(const struct nlmsghdr *nlh, bool strict_check, 5184 bool is_dump, struct netlink_ext_ack *extack) 5185 { 5186 struct if_stats_msg *ifsm; 5187 5188 if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifsm))) { 5189 NL_SET_ERR_MSG(extack, "Invalid header for stats dump"); 5190 return -EINVAL; 5191 } 5192 5193 if (!strict_check) 5194 return 0; 5195 5196 ifsm = nlmsg_data(nlh); 5197 5198 /* only requests using strict checks can pass data to influence 5199 * the dump. The legacy exception is filter_mask. 5200 */ 5201 if (ifsm->pad1 || ifsm->pad2 || (is_dump && ifsm->ifindex)) { 5202 NL_SET_ERR_MSG(extack, "Invalid values in header for stats dump request"); 5203 return -EINVAL; 5204 } 5205 if (nlmsg_attrlen(nlh, sizeof(*ifsm))) { 5206 NL_SET_ERR_MSG(extack, "Invalid attributes after stats header"); 5207 return -EINVAL; 5208 } 5209 if (ifsm->filter_mask >= IFLA_STATS_FILTER_BIT(IFLA_STATS_MAX + 1)) { 5210 NL_SET_ERR_MSG(extack, "Invalid stats requested through filter mask"); 5211 return -EINVAL; 5212 } 5213 5214 return 0; 5215 } 5216 5217 static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh, 5218 struct netlink_ext_ack *extack) 5219 { 5220 struct net *net = sock_net(skb->sk); 5221 struct net_device *dev = NULL; 5222 int idxattr = 0, prividx = 0; 5223 struct if_stats_msg *ifsm; 5224 struct sk_buff *nskb; 5225 u32 filter_mask; 5226 int err; 5227 5228 err = rtnl_valid_stats_req(nlh, netlink_strict_get_check(skb), 5229 false, extack); 5230 if (err) 5231 return err; 5232 5233 ifsm = nlmsg_data(nlh); 5234 if (ifsm->ifindex > 0) 5235 dev = __dev_get_by_index(net, ifsm->ifindex); 5236 else 5237 return -EINVAL; 5238 5239 if (!dev) 5240 return -ENODEV; 5241 5242 filter_mask = ifsm->filter_mask; 5243 if (!filter_mask) 5244 return -EINVAL; 5245 5246 nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL); 5247 if (!nskb) 5248 return -ENOBUFS; 5249 5250 err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS, 5251 NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0, 5252 0, filter_mask, &idxattr, &prividx); 5253 if (err < 0) { 5254 /* -EMSGSIZE implies BUG in if_nlmsg_stats_size */ 5255 WARN_ON(err == -EMSGSIZE); 5256 kfree_skb(nskb); 5257 } else { 5258 err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 5259 } 5260 5261 return err; 5262 } 5263 5264 static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb) 5265 { 5266 struct netlink_ext_ack *extack = cb->extack; 5267 int h, s_h, err, s_idx, s_idxattr, s_prividx; 5268 struct net *net = sock_net(skb->sk); 5269 unsigned int flags = NLM_F_MULTI; 5270 struct if_stats_msg *ifsm; 5271 struct hlist_head *head; 5272 struct net_device *dev; 5273 u32 filter_mask = 0; 5274 int idx = 0; 5275 5276 s_h = cb->args[0]; 5277 s_idx = cb->args[1]; 5278 s_idxattr = cb->args[2]; 5279 s_prividx = cb->args[3]; 5280 5281 cb->seq = net->dev_base_seq; 5282 5283 err = rtnl_valid_stats_req(cb->nlh, cb->strict_check, true, extack); 5284 if (err) 5285 return err; 5286 5287 ifsm = nlmsg_data(cb->nlh); 5288 filter_mask = ifsm->filter_mask; 5289 if (!filter_mask) { 5290 NL_SET_ERR_MSG(extack, "Filter mask must be set for stats dump"); 5291 return -EINVAL; 5292 } 5293 5294 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 5295 idx = 0; 5296 head = &net->dev_index_head[h]; 5297 hlist_for_each_entry(dev, head, index_hlist) { 5298 if (idx < s_idx) 5299 goto cont; 5300 err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS, 5301 NETLINK_CB(cb->skb).portid, 5302 cb->nlh->nlmsg_seq, 0, 5303 flags, filter_mask, 5304 &s_idxattr, &s_prividx); 5305 /* If we ran out of room on the first message, 5306 * we're in trouble 5307 */ 5308 WARN_ON((err == -EMSGSIZE) && (skb->len == 0)); 5309 5310 if (err < 0) 5311 goto out; 5312 s_prividx = 0; 5313 s_idxattr = 0; 5314 nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 5315 cont: 5316 idx++; 5317 } 5318 } 5319 out: 5320 cb->args[3] = s_prividx; 5321 cb->args[2] = s_idxattr; 5322 cb->args[1] = idx; 5323 cb->args[0] = h; 5324 5325 return skb->len; 5326 } 5327 5328 /* Process one rtnetlink message. */ 5329 5330 static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, 5331 struct netlink_ext_ack *extack) 5332 { 5333 struct net *net = sock_net(skb->sk); 5334 struct rtnl_link *link; 5335 struct module *owner; 5336 int err = -EOPNOTSUPP; 5337 rtnl_doit_func doit; 5338 unsigned int flags; 5339 int kind; 5340 int family; 5341 int type; 5342 5343 type = nlh->nlmsg_type; 5344 if (type > RTM_MAX) 5345 return -EOPNOTSUPP; 5346 5347 type -= RTM_BASE; 5348 5349 /* All the messages must have at least 1 byte length */ 5350 if (nlmsg_len(nlh) < sizeof(struct rtgenmsg)) 5351 return 0; 5352 5353 family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family; 5354 kind = type&3; 5355 5356 if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN)) 5357 return -EPERM; 5358 5359 rcu_read_lock(); 5360 if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { 5361 struct sock *rtnl; 5362 rtnl_dumpit_func dumpit; 5363 u16 min_dump_alloc = 0; 5364 5365 link = rtnl_get_link(family, type); 5366 if (!link || !link->dumpit) { 5367 family = PF_UNSPEC; 5368 link = rtnl_get_link(family, type); 5369 if (!link || !link->dumpit) 5370 goto err_unlock; 5371 } 5372 owner = link->owner; 5373 dumpit = link->dumpit; 5374 5375 if (type == RTM_GETLINK - RTM_BASE) 5376 min_dump_alloc = rtnl_calcit(skb, nlh); 5377 5378 err = 0; 5379 /* need to do this before rcu_read_unlock() */ 5380 if (!try_module_get(owner)) 5381 err = -EPROTONOSUPPORT; 5382 5383 rcu_read_unlock(); 5384 5385 rtnl = net->rtnl; 5386 if (err == 0) { 5387 struct netlink_dump_control c = { 5388 .dump = dumpit, 5389 .min_dump_alloc = min_dump_alloc, 5390 .module = owner, 5391 }; 5392 err = netlink_dump_start(rtnl, skb, nlh, &c); 5393 /* netlink_dump_start() will keep a reference on 5394 * module if dump is still in progress. 5395 */ 5396 module_put(owner); 5397 } 5398 return err; 5399 } 5400 5401 link = rtnl_get_link(family, type); 5402 if (!link || !link->doit) { 5403 family = PF_UNSPEC; 5404 link = rtnl_get_link(PF_UNSPEC, type); 5405 if (!link || !link->doit) 5406 goto out_unlock; 5407 } 5408 5409 owner = link->owner; 5410 if (!try_module_get(owner)) { 5411 err = -EPROTONOSUPPORT; 5412 goto out_unlock; 5413 } 5414 5415 flags = link->flags; 5416 if (flags & RTNL_FLAG_DOIT_UNLOCKED) { 5417 doit = link->doit; 5418 rcu_read_unlock(); 5419 if (doit) 5420 err = doit(skb, nlh, extack); 5421 module_put(owner); 5422 return err; 5423 } 5424 rcu_read_unlock(); 5425 5426 rtnl_lock(); 5427 link = rtnl_get_link(family, type); 5428 if (link && link->doit) 5429 err = link->doit(skb, nlh, extack); 5430 rtnl_unlock(); 5431 5432 module_put(owner); 5433 5434 return err; 5435 5436 out_unlock: 5437 rcu_read_unlock(); 5438 return err; 5439 5440 err_unlock: 5441 rcu_read_unlock(); 5442 return -EOPNOTSUPP; 5443 } 5444 5445 static void rtnetlink_rcv(struct sk_buff *skb) 5446 { 5447 netlink_rcv_skb(skb, &rtnetlink_rcv_msg); 5448 } 5449 5450 static int rtnetlink_bind(struct net *net, int group) 5451 { 5452 switch (group) { 5453 case RTNLGRP_IPV4_MROUTE_R: 5454 case RTNLGRP_IPV6_MROUTE_R: 5455 if (!ns_capable(net->user_ns, CAP_NET_ADMIN)) 5456 return -EPERM; 5457 break; 5458 } 5459 return 0; 5460 } 5461 5462 static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) 5463 { 5464 struct net_device *dev = netdev_notifier_info_to_dev(ptr); 5465 5466 switch (event) { 5467 case NETDEV_REBOOT: 5468 case NETDEV_CHANGEMTU: 5469 case NETDEV_CHANGEADDR: 5470 case NETDEV_CHANGENAME: 5471 case NETDEV_FEAT_CHANGE: 5472 case NETDEV_BONDING_FAILOVER: 5473 case NETDEV_POST_TYPE_CHANGE: 5474 case NETDEV_NOTIFY_PEERS: 5475 case NETDEV_CHANGEUPPER: 5476 case NETDEV_RESEND_IGMP: 5477 case NETDEV_CHANGEINFODATA: 5478 case NETDEV_CHANGELOWERSTATE: 5479 case NETDEV_CHANGE_TX_QUEUE_LEN: 5480 rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event), 5481 GFP_KERNEL, NULL, 0); 5482 break; 5483 default: 5484 break; 5485 } 5486 return NOTIFY_DONE; 5487 } 5488 5489 static struct notifier_block rtnetlink_dev_notifier = { 5490 .notifier_call = rtnetlink_event, 5491 }; 5492 5493 5494 static int __net_init rtnetlink_net_init(struct net *net) 5495 { 5496 struct sock *sk; 5497 struct netlink_kernel_cfg cfg = { 5498 .groups = RTNLGRP_MAX, 5499 .input = rtnetlink_rcv, 5500 .cb_mutex = &rtnl_mutex, 5501 .flags = NL_CFG_F_NONROOT_RECV, 5502 .bind = rtnetlink_bind, 5503 }; 5504 5505 sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg); 5506 if (!sk) 5507 return -ENOMEM; 5508 net->rtnl = sk; 5509 return 0; 5510 } 5511 5512 static void __net_exit rtnetlink_net_exit(struct net *net) 5513 { 5514 netlink_kernel_release(net->rtnl); 5515 net->rtnl = NULL; 5516 } 5517 5518 static struct pernet_operations rtnetlink_net_ops = { 5519 .init = rtnetlink_net_init, 5520 .exit = rtnetlink_net_exit, 5521 }; 5522 5523 void __init rtnetlink_init(void) 5524 { 5525 if (register_pernet_subsys(&rtnetlink_net_ops)) 5526 panic("rtnetlink_init: cannot initialize rtnetlink\n"); 5527 5528 register_netdevice_notifier(&rtnetlink_dev_notifier); 5529 5530 rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, 5531 rtnl_dump_ifinfo, 0); 5532 rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0); 5533 rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0); 5534 rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0); 5535 5536 rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0); 5537 rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0); 5538 rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0); 5539 5540 rtnl_register(PF_UNSPEC, RTM_NEWLINKPROP, rtnl_newlinkprop, NULL, 0); 5541 rtnl_register(PF_UNSPEC, RTM_DELLINKPROP, rtnl_dellinkprop, NULL, 0); 5542 5543 rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0); 5544 rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0); 5545 rtnl_register(PF_BRIDGE, RTM_GETNEIGH, rtnl_fdb_get, rtnl_fdb_dump, 0); 5546 5547 rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0); 5548 rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0); 5549 rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0); 5550 5551 rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump, 5552 0); 5553 } 5554