11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * INET An implementation of the TCP/IP protocol suite for the LINUX 31da177e4SLinus Torvalds * operating system. INET is implemented using the BSD Socket 41da177e4SLinus Torvalds * interface as the means of communication with the user level. 51da177e4SLinus Torvalds * 61da177e4SLinus Torvalds * Routing netlink socket interface: protocol independent part. 71da177e4SLinus Torvalds * 81da177e4SLinus Torvalds * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> 91da177e4SLinus Torvalds * 101da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 111da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 121da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 131da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 141da177e4SLinus Torvalds * 151da177e4SLinus Torvalds * Fixes: 161da177e4SLinus Torvalds * Vitaly E. Lavrov RTA_OK arithmetics was wrong. 171da177e4SLinus Torvalds */ 181da177e4SLinus Torvalds 19ee5d032fSJakub Kicinski #include <linux/bitops.h> 201da177e4SLinus Torvalds #include <linux/errno.h> 211da177e4SLinus Torvalds #include <linux/module.h> 221da177e4SLinus Torvalds #include <linux/types.h> 231da177e4SLinus Torvalds #include <linux/socket.h> 241da177e4SLinus Torvalds #include <linux/kernel.h> 251da177e4SLinus Torvalds #include <linux/timer.h> 261da177e4SLinus Torvalds #include <linux/string.h> 271da177e4SLinus Torvalds #include <linux/sockios.h> 281da177e4SLinus Torvalds #include <linux/net.h> 291da177e4SLinus Torvalds #include <linux/fcntl.h> 301da177e4SLinus Torvalds #include <linux/mm.h> 311da177e4SLinus Torvalds #include <linux/slab.h> 321da177e4SLinus Torvalds #include <linux/interrupt.h> 331da177e4SLinus Torvalds #include <linux/capability.h> 341da177e4SLinus Torvalds #include <linux/skbuff.h> 351da177e4SLinus Torvalds #include <linux/init.h> 361da177e4SLinus Torvalds #include <linux/security.h> 376756ae4bSStephen Hemminger #include <linux/mutex.h> 381823730fSThomas Graf #include <linux/if_addr.h> 3977162022SJohn Fastabend #include <linux/if_bridge.h> 40f6f6424bSJiri Pirko #include <linux/if_vlan.h> 41ebc08a6fSWilliams, Mitch A #include <linux/pci.h> 4277162022SJohn Fastabend #include <linux/etherdevice.h> 4358038695SMartin KaFai Lau #include <linux/bpf.h> 441da177e4SLinus Torvalds 457c0f6ba6SLinus Torvalds #include <linux/uaccess.h> 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds #include <linux/inet.h> 481da177e4SLinus Torvalds #include <linux/netdevice.h> 4982f28412SJiri Pirko #include <net/switchdev.h> 501da177e4SLinus Torvalds #include <net/ip.h> 511da177e4SLinus Torvalds #include <net/protocol.h> 521da177e4SLinus Torvalds #include <net/arp.h> 531da177e4SLinus Torvalds #include <net/route.h> 541da177e4SLinus Torvalds #include <net/udp.h> 55ea697639SDaniel Borkmann #include <net/tcp.h> 561da177e4SLinus Torvalds #include <net/sock.h> 571da177e4SLinus Torvalds #include <net/pkt_sched.h> 5814c0b97dSThomas Graf #include <net/fib_rules.h> 59e2849863SThomas Graf #include <net/rtnetlink.h> 6030ffee84SJohannes Berg #include <net/net_namespace.h> 611da177e4SLinus Torvalds 62e0d087afSEric Dumazet struct rtnl_link { 63e2849863SThomas Graf rtnl_doit_func doit; 64e2849863SThomas Graf rtnl_dumpit_func dumpit; 6562256f98SFlorian Westphal unsigned int flags; 66e2849863SThomas Graf }; 67e2849863SThomas Graf 686756ae4bSStephen Hemminger static DEFINE_MUTEX(rtnl_mutex); 691da177e4SLinus Torvalds 701da177e4SLinus Torvalds void rtnl_lock(void) 711da177e4SLinus Torvalds { 726756ae4bSStephen Hemminger mutex_lock(&rtnl_mutex); 731da177e4SLinus Torvalds } 74e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_lock); 751da177e4SLinus Torvalds 761b5c5493SEric Dumazet static struct sk_buff *defer_kfree_skb_list; 771b5c5493SEric Dumazet void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail) 781b5c5493SEric Dumazet { 791b5c5493SEric Dumazet if (head && tail) { 801b5c5493SEric Dumazet tail->next = defer_kfree_skb_list; 811b5c5493SEric Dumazet defer_kfree_skb_list = head; 821b5c5493SEric Dumazet } 831b5c5493SEric Dumazet } 841b5c5493SEric Dumazet EXPORT_SYMBOL(rtnl_kfree_skbs); 851b5c5493SEric Dumazet 866756ae4bSStephen Hemminger void __rtnl_unlock(void) 871da177e4SLinus Torvalds { 881b5c5493SEric Dumazet struct sk_buff *head = defer_kfree_skb_list; 891b5c5493SEric Dumazet 901b5c5493SEric Dumazet defer_kfree_skb_list = NULL; 911b5c5493SEric Dumazet 926756ae4bSStephen Hemminger mutex_unlock(&rtnl_mutex); 931b5c5493SEric Dumazet 941b5c5493SEric Dumazet while (head) { 951b5c5493SEric Dumazet struct sk_buff *next = head->next; 961b5c5493SEric Dumazet 971b5c5493SEric Dumazet kfree_skb(head); 981b5c5493SEric Dumazet cond_resched(); 991b5c5493SEric Dumazet head = next; 1001b5c5493SEric Dumazet } 1011da177e4SLinus Torvalds } 1021da177e4SLinus Torvalds 1031da177e4SLinus Torvalds void rtnl_unlock(void) 1041da177e4SLinus Torvalds { 10558ec3b4dSHerbert Xu /* This fellow will unlock it for us. */ 1061da177e4SLinus Torvalds netdev_run_todo(); 1071da177e4SLinus Torvalds } 108e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unlock); 1091da177e4SLinus Torvalds 1106756ae4bSStephen Hemminger int rtnl_trylock(void) 1116756ae4bSStephen Hemminger { 1126756ae4bSStephen Hemminger return mutex_trylock(&rtnl_mutex); 1136756ae4bSStephen Hemminger } 114e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_trylock); 1156756ae4bSStephen Hemminger 116c9c1014bSPatrick McHardy int rtnl_is_locked(void) 117c9c1014bSPatrick McHardy { 118c9c1014bSPatrick McHardy return mutex_is_locked(&rtnl_mutex); 119c9c1014bSPatrick McHardy } 120e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_is_locked); 121c9c1014bSPatrick McHardy 122a898def2SPaul E. McKenney #ifdef CONFIG_PROVE_LOCKING 1230cbf3343SYaowei Bai bool lockdep_rtnl_is_held(void) 124a898def2SPaul E. McKenney { 125a898def2SPaul E. McKenney return lockdep_is_held(&rtnl_mutex); 126a898def2SPaul E. McKenney } 127a898def2SPaul E. McKenney EXPORT_SYMBOL(lockdep_rtnl_is_held); 128a898def2SPaul E. McKenney #endif /* #ifdef CONFIG_PROVE_LOCKING */ 129a898def2SPaul E. McKenney 1306853dd48SFlorian Westphal static struct rtnl_link __rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1]; 131019a3169SFlorian Westphal static refcount_t rtnl_msg_handlers_ref[RTNL_FAMILY_MAX + 1]; 132e2849863SThomas Graf 133e2849863SThomas Graf static inline int rtm_msgindex(int msgtype) 134e2849863SThomas Graf { 135e2849863SThomas Graf int msgindex = msgtype - RTM_BASE; 136e2849863SThomas Graf 137e2849863SThomas Graf /* 138e2849863SThomas Graf * msgindex < 0 implies someone tried to register a netlink 139e2849863SThomas Graf * control code. msgindex >= RTM_NR_MSGTYPES may indicate that 140e2849863SThomas Graf * the message type has not been added to linux/rtnetlink.h 141e2849863SThomas Graf */ 142e2849863SThomas Graf BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES); 143e2849863SThomas Graf 144e2849863SThomas Graf return msgindex; 145e2849863SThomas Graf } 146e2849863SThomas Graf 147e2849863SThomas Graf /** 148e2849863SThomas Graf * __rtnl_register - Register a rtnetlink message type 149e2849863SThomas Graf * @protocol: Protocol family or PF_UNSPEC 150e2849863SThomas Graf * @msgtype: rtnetlink message type 151e2849863SThomas Graf * @doit: Function pointer called for each request message 152e2849863SThomas Graf * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message 153b97bac64SFlorian Westphal * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions 154e2849863SThomas Graf * 155e2849863SThomas Graf * Registers the specified function pointers (at least one of them has 156e2849863SThomas Graf * to be non-NULL) to be called whenever a request message for the 157e2849863SThomas Graf * specified protocol family and message type is received. 158e2849863SThomas Graf * 159e2849863SThomas Graf * The special protocol family PF_UNSPEC may be used to define fallback 160e2849863SThomas Graf * function pointers for the case when no entry for the specific protocol 161e2849863SThomas Graf * family exists. 162e2849863SThomas Graf * 163e2849863SThomas Graf * Returns 0 on success or a negative error code. 164e2849863SThomas Graf */ 165e2849863SThomas Graf int __rtnl_register(int protocol, int msgtype, 166c7ac8679SGreg Rose rtnl_doit_func doit, rtnl_dumpit_func dumpit, 167b97bac64SFlorian Westphal unsigned int flags) 168e2849863SThomas Graf { 169e2849863SThomas Graf struct rtnl_link *tab; 170e2849863SThomas Graf int msgindex; 171e2849863SThomas Graf 17225239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 173e2849863SThomas Graf msgindex = rtm_msgindex(msgtype); 174e2849863SThomas Graf 175377cb248SFlorian Westphal tab = rcu_dereference_raw(rtnl_msg_handlers[protocol]); 176e2849863SThomas Graf if (tab == NULL) { 177e2849863SThomas Graf tab = kcalloc(RTM_NR_MSGTYPES, sizeof(*tab), GFP_KERNEL); 178e2849863SThomas Graf if (tab == NULL) 179e2849863SThomas Graf return -ENOBUFS; 180e2849863SThomas Graf 1816853dd48SFlorian Westphal rcu_assign_pointer(rtnl_msg_handlers[protocol], tab); 182e2849863SThomas Graf } 183e2849863SThomas Graf 184e2849863SThomas Graf if (doit) 185e2849863SThomas Graf tab[msgindex].doit = doit; 186e2849863SThomas Graf if (dumpit) 187e2849863SThomas Graf tab[msgindex].dumpit = dumpit; 18862256f98SFlorian Westphal tab[msgindex].flags |= flags; 189e2849863SThomas Graf 190e2849863SThomas Graf return 0; 191e2849863SThomas Graf } 192e2849863SThomas Graf EXPORT_SYMBOL_GPL(__rtnl_register); 193e2849863SThomas Graf 194e2849863SThomas Graf /** 195e2849863SThomas Graf * rtnl_register - Register a rtnetlink message type 196e2849863SThomas Graf * 197e2849863SThomas Graf * Identical to __rtnl_register() but panics on failure. This is useful 198e2849863SThomas Graf * as failure of this function is very unlikely, it can only happen due 199e2849863SThomas Graf * to lack of memory when allocating the chain to store all message 200e2849863SThomas Graf * handlers for a protocol. Meant for use in init functions where lack 20125985edcSLucas De Marchi * of memory implies no sense in continuing. 202e2849863SThomas Graf */ 203e2849863SThomas Graf void rtnl_register(int protocol, int msgtype, 204c7ac8679SGreg Rose rtnl_doit_func doit, rtnl_dumpit_func dumpit, 205b97bac64SFlorian Westphal unsigned int flags) 206e2849863SThomas Graf { 207b97bac64SFlorian Westphal if (__rtnl_register(protocol, msgtype, doit, dumpit, flags) < 0) 208e2849863SThomas Graf panic("Unable to register rtnetlink message handler, " 209e2849863SThomas Graf "protocol = %d, message type = %d\n", 210e2849863SThomas Graf protocol, msgtype); 211e2849863SThomas Graf } 212e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_register); 213e2849863SThomas Graf 214e2849863SThomas Graf /** 215e2849863SThomas Graf * rtnl_unregister - Unregister a rtnetlink message type 216e2849863SThomas Graf * @protocol: Protocol family or PF_UNSPEC 217e2849863SThomas Graf * @msgtype: rtnetlink message type 218e2849863SThomas Graf * 219e2849863SThomas Graf * Returns 0 on success or a negative error code. 220e2849863SThomas Graf */ 221e2849863SThomas Graf int rtnl_unregister(int protocol, int msgtype) 222e2849863SThomas Graf { 2236853dd48SFlorian Westphal struct rtnl_link *handlers; 224e2849863SThomas Graf int msgindex; 225e2849863SThomas Graf 22625239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 227e2849863SThomas Graf msgindex = rtm_msgindex(msgtype); 228e2849863SThomas Graf 2296853dd48SFlorian Westphal rtnl_lock(); 2306853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[protocol]); 2316853dd48SFlorian Westphal if (!handlers) { 2326853dd48SFlorian Westphal rtnl_unlock(); 233e2849863SThomas Graf return -ENOENT; 2346853dd48SFlorian Westphal } 235e2849863SThomas Graf 2366853dd48SFlorian Westphal handlers[msgindex].doit = NULL; 2376853dd48SFlorian Westphal handlers[msgindex].dumpit = NULL; 23862256f98SFlorian Westphal handlers[msgindex].flags = 0; 2396853dd48SFlorian Westphal rtnl_unlock(); 240e2849863SThomas Graf 241e2849863SThomas Graf return 0; 242e2849863SThomas Graf } 243e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister); 244e2849863SThomas Graf 245e2849863SThomas Graf /** 246e2849863SThomas Graf * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol 247e2849863SThomas Graf * @protocol : Protocol family or PF_UNSPEC 248e2849863SThomas Graf * 249e2849863SThomas Graf * Identical to calling rtnl_unregster() for all registered message types 250e2849863SThomas Graf * of a certain protocol family. 251e2849863SThomas Graf */ 252e2849863SThomas Graf void rtnl_unregister_all(int protocol) 253e2849863SThomas Graf { 254019a3169SFlorian Westphal struct rtnl_link *handlers; 255019a3169SFlorian Westphal 25625239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 257e2849863SThomas Graf 258019a3169SFlorian Westphal rtnl_lock(); 2596853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[protocol]); 2606853dd48SFlorian Westphal RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL); 261019a3169SFlorian Westphal rtnl_unlock(); 262019a3169SFlorian Westphal 2636853dd48SFlorian Westphal synchronize_net(); 2646853dd48SFlorian Westphal 265d38a6512SFlorian Westphal while (refcount_read(&rtnl_msg_handlers_ref[protocol]) > 1) 266019a3169SFlorian Westphal schedule(); 267019a3169SFlorian Westphal kfree(handlers); 268e2849863SThomas Graf } 269e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister_all); 2701da177e4SLinus Torvalds 27138f7b870SPatrick McHardy static LIST_HEAD(link_ops); 27238f7b870SPatrick McHardy 273c63044f0SEric Dumazet static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind) 274c63044f0SEric Dumazet { 275c63044f0SEric Dumazet const struct rtnl_link_ops *ops; 276c63044f0SEric Dumazet 277c63044f0SEric Dumazet list_for_each_entry(ops, &link_ops, list) { 278c63044f0SEric Dumazet if (!strcmp(ops->kind, kind)) 279c63044f0SEric Dumazet return ops; 280c63044f0SEric Dumazet } 281c63044f0SEric Dumazet return NULL; 282c63044f0SEric Dumazet } 283c63044f0SEric Dumazet 28438f7b870SPatrick McHardy /** 28538f7b870SPatrick McHardy * __rtnl_link_register - Register rtnl_link_ops with rtnetlink. 28638f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to register 28738f7b870SPatrick McHardy * 28838f7b870SPatrick McHardy * The caller must hold the rtnl_mutex. This function should be used 28938f7b870SPatrick McHardy * by drivers that create devices during module initialization. It 29038f7b870SPatrick McHardy * must be called before registering the devices. 29138f7b870SPatrick McHardy * 29238f7b870SPatrick McHardy * Returns 0 on success or a negative error code. 29338f7b870SPatrick McHardy */ 29438f7b870SPatrick McHardy int __rtnl_link_register(struct rtnl_link_ops *ops) 29538f7b870SPatrick McHardy { 296c63044f0SEric Dumazet if (rtnl_link_ops_get(ops->kind)) 297c63044f0SEric Dumazet return -EEXIST; 298c63044f0SEric Dumazet 299b0ab2fabSJiri Pirko /* The check for setup is here because if ops 300b0ab2fabSJiri Pirko * does not have that filled up, it is not possible 301b0ab2fabSJiri Pirko * to use the ops for creating device. So do not 302b0ab2fabSJiri Pirko * fill up dellink as well. That disables rtnl_dellink. 303b0ab2fabSJiri Pirko */ 304b0ab2fabSJiri Pirko if (ops->setup && !ops->dellink) 30523289a37SEric Dumazet ops->dellink = unregister_netdevice_queue; 3062d85cba2SPatrick McHardy 30738f7b870SPatrick McHardy list_add_tail(&ops->list, &link_ops); 30838f7b870SPatrick McHardy return 0; 30938f7b870SPatrick McHardy } 31038f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_register); 31138f7b870SPatrick McHardy 31238f7b870SPatrick McHardy /** 31338f7b870SPatrick McHardy * rtnl_link_register - Register rtnl_link_ops with rtnetlink. 31438f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to register 31538f7b870SPatrick McHardy * 31638f7b870SPatrick McHardy * Returns 0 on success or a negative error code. 31738f7b870SPatrick McHardy */ 31838f7b870SPatrick McHardy int rtnl_link_register(struct rtnl_link_ops *ops) 31938f7b870SPatrick McHardy { 32038f7b870SPatrick McHardy int err; 32138f7b870SPatrick McHardy 32238f7b870SPatrick McHardy rtnl_lock(); 32338f7b870SPatrick McHardy err = __rtnl_link_register(ops); 32438f7b870SPatrick McHardy rtnl_unlock(); 32538f7b870SPatrick McHardy return err; 32638f7b870SPatrick McHardy } 32738f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_register); 32838f7b870SPatrick McHardy 329669f87baSPavel Emelyanov static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops) 330669f87baSPavel Emelyanov { 331669f87baSPavel Emelyanov struct net_device *dev; 33223289a37SEric Dumazet LIST_HEAD(list_kill); 33323289a37SEric Dumazet 334669f87baSPavel Emelyanov for_each_netdev(net, dev) { 33523289a37SEric Dumazet if (dev->rtnl_link_ops == ops) 33623289a37SEric Dumazet ops->dellink(dev, &list_kill); 337669f87baSPavel Emelyanov } 33823289a37SEric Dumazet unregister_netdevice_many(&list_kill); 339669f87baSPavel Emelyanov } 340669f87baSPavel Emelyanov 34138f7b870SPatrick McHardy /** 34238f7b870SPatrick McHardy * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 34338f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to unregister 34438f7b870SPatrick McHardy * 3452d85cba2SPatrick McHardy * The caller must hold the rtnl_mutex. 34638f7b870SPatrick McHardy */ 34738f7b870SPatrick McHardy void __rtnl_link_unregister(struct rtnl_link_ops *ops) 34838f7b870SPatrick McHardy { 349881d966bSEric W. Biederman struct net *net; 3502d85cba2SPatrick McHardy 351881d966bSEric W. Biederman for_each_net(net) { 352669f87baSPavel Emelyanov __rtnl_kill_links(net, ops); 353881d966bSEric W. Biederman } 35438f7b870SPatrick McHardy list_del(&ops->list); 35538f7b870SPatrick McHardy } 35638f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_unregister); 35738f7b870SPatrick McHardy 358200b916fSCong Wang /* Return with the rtnl_lock held when there are no network 359200b916fSCong Wang * devices unregistering in any network namespace. 360200b916fSCong Wang */ 361200b916fSCong Wang static void rtnl_lock_unregistering_all(void) 362200b916fSCong Wang { 363200b916fSCong Wang struct net *net; 364200b916fSCong Wang bool unregistering; 365ff960a73SPeter Zijlstra DEFINE_WAIT_FUNC(wait, woken_wake_function); 366200b916fSCong Wang 367ff960a73SPeter Zijlstra add_wait_queue(&netdev_unregistering_wq, &wait); 368200b916fSCong Wang for (;;) { 369200b916fSCong Wang unregistering = false; 370200b916fSCong Wang rtnl_lock(); 371200b916fSCong Wang for_each_net(net) { 372200b916fSCong Wang if (net->dev_unreg_count > 0) { 373200b916fSCong Wang unregistering = true; 374200b916fSCong Wang break; 375200b916fSCong Wang } 376200b916fSCong Wang } 377200b916fSCong Wang if (!unregistering) 378200b916fSCong Wang break; 379200b916fSCong Wang __rtnl_unlock(); 380ff960a73SPeter Zijlstra 381ff960a73SPeter Zijlstra wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT); 382200b916fSCong Wang } 383ff960a73SPeter Zijlstra remove_wait_queue(&netdev_unregistering_wq, &wait); 384200b916fSCong Wang } 385200b916fSCong Wang 38638f7b870SPatrick McHardy /** 38738f7b870SPatrick McHardy * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 38838f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to unregister 38938f7b870SPatrick McHardy */ 39038f7b870SPatrick McHardy void rtnl_link_unregister(struct rtnl_link_ops *ops) 39138f7b870SPatrick McHardy { 392200b916fSCong Wang /* Close the race with cleanup_net() */ 393200b916fSCong Wang mutex_lock(&net_mutex); 394200b916fSCong Wang rtnl_lock_unregistering_all(); 39538f7b870SPatrick McHardy __rtnl_link_unregister(ops); 39638f7b870SPatrick McHardy rtnl_unlock(); 397200b916fSCong Wang mutex_unlock(&net_mutex); 39838f7b870SPatrick McHardy } 39938f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_unregister); 40038f7b870SPatrick McHardy 401ba7d49b1SJiri Pirko static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev) 402ba7d49b1SJiri Pirko { 403ba7d49b1SJiri Pirko struct net_device *master_dev; 404ba7d49b1SJiri Pirko const struct rtnl_link_ops *ops; 4058515ae38SFlorian Westphal size_t size = 0; 406ba7d49b1SJiri Pirko 4078515ae38SFlorian Westphal rcu_read_lock(); 4088515ae38SFlorian Westphal 4098515ae38SFlorian Westphal master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 410ba7d49b1SJiri Pirko if (!master_dev) 4118515ae38SFlorian Westphal goto out; 4128515ae38SFlorian Westphal 413ba7d49b1SJiri Pirko ops = master_dev->rtnl_link_ops; 4146049f253SFernando Luis Vazquez Cao if (!ops || !ops->get_slave_size) 4158515ae38SFlorian Westphal goto out; 416ba7d49b1SJiri Pirko /* IFLA_INFO_SLAVE_DATA + nested data */ 4178515ae38SFlorian Westphal size = nla_total_size(sizeof(struct nlattr)) + 418ba7d49b1SJiri Pirko ops->get_slave_size(master_dev, dev); 4198515ae38SFlorian Westphal 4208515ae38SFlorian Westphal out: 4218515ae38SFlorian Westphal rcu_read_unlock(); 4228515ae38SFlorian Westphal return size; 423ba7d49b1SJiri Pirko } 424ba7d49b1SJiri Pirko 42538f7b870SPatrick McHardy static size_t rtnl_link_get_size(const struct net_device *dev) 42638f7b870SPatrick McHardy { 42738f7b870SPatrick McHardy const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 42838f7b870SPatrick McHardy size_t size; 42938f7b870SPatrick McHardy 43038f7b870SPatrick McHardy if (!ops) 43138f7b870SPatrick McHardy return 0; 43238f7b870SPatrick McHardy 433369cf77aSThomas Graf size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */ 434369cf77aSThomas Graf nla_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */ 43538f7b870SPatrick McHardy 43638f7b870SPatrick McHardy if (ops->get_size) 43738f7b870SPatrick McHardy /* IFLA_INFO_DATA + nested data */ 438369cf77aSThomas Graf size += nla_total_size(sizeof(struct nlattr)) + 43938f7b870SPatrick McHardy ops->get_size(dev); 44038f7b870SPatrick McHardy 44138f7b870SPatrick McHardy if (ops->get_xstats_size) 442369cf77aSThomas Graf /* IFLA_INFO_XSTATS */ 443369cf77aSThomas Graf size += nla_total_size(ops->get_xstats_size(dev)); 44438f7b870SPatrick McHardy 445ba7d49b1SJiri Pirko size += rtnl_link_get_slave_info_data_size(dev); 446ba7d49b1SJiri Pirko 44738f7b870SPatrick McHardy return size; 44838f7b870SPatrick McHardy } 44938f7b870SPatrick McHardy 450f8ff182cSThomas Graf static LIST_HEAD(rtnl_af_ops); 451f8ff182cSThomas Graf 452f8ff182cSThomas Graf static const struct rtnl_af_ops *rtnl_af_lookup(const int family) 453f8ff182cSThomas Graf { 454f8ff182cSThomas Graf const struct rtnl_af_ops *ops; 455f8ff182cSThomas Graf 456f8ff182cSThomas Graf list_for_each_entry(ops, &rtnl_af_ops, list) { 457f8ff182cSThomas Graf if (ops->family == family) 458f8ff182cSThomas Graf return ops; 459f8ff182cSThomas Graf } 460f8ff182cSThomas Graf 461f8ff182cSThomas Graf return NULL; 462f8ff182cSThomas Graf } 463f8ff182cSThomas Graf 464f8ff182cSThomas Graf /** 465f8ff182cSThomas Graf * rtnl_af_register - Register rtnl_af_ops with rtnetlink. 466f8ff182cSThomas Graf * @ops: struct rtnl_af_ops * to register 467f8ff182cSThomas Graf * 468f8ff182cSThomas Graf * Returns 0 on success or a negative error code. 469f8ff182cSThomas Graf */ 4703678a9d8Sstephen hemminger void rtnl_af_register(struct rtnl_af_ops *ops) 471f8ff182cSThomas Graf { 472f8ff182cSThomas Graf rtnl_lock(); 4733678a9d8Sstephen hemminger list_add_tail(&ops->list, &rtnl_af_ops); 474f8ff182cSThomas Graf rtnl_unlock(); 475f8ff182cSThomas Graf } 476f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_register); 477f8ff182cSThomas Graf 478f8ff182cSThomas Graf /** 479f8ff182cSThomas Graf * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink. 480f8ff182cSThomas Graf * @ops: struct rtnl_af_ops * to unregister 481f8ff182cSThomas Graf */ 482f8ff182cSThomas Graf void rtnl_af_unregister(struct rtnl_af_ops *ops) 483f8ff182cSThomas Graf { 484f8ff182cSThomas Graf rtnl_lock(); 485*5c45121dSFlorian Westphal list_del(&ops->list); 486f8ff182cSThomas Graf rtnl_unlock(); 487f8ff182cSThomas Graf } 488f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_unregister); 489f8ff182cSThomas Graf 490b1974ed0SArad, Ronen static size_t rtnl_link_get_af_size(const struct net_device *dev, 491b1974ed0SArad, Ronen u32 ext_filter_mask) 492f8ff182cSThomas Graf { 493f8ff182cSThomas Graf struct rtnl_af_ops *af_ops; 494f8ff182cSThomas Graf size_t size; 495f8ff182cSThomas Graf 496f8ff182cSThomas Graf /* IFLA_AF_SPEC */ 497f8ff182cSThomas Graf size = nla_total_size(sizeof(struct nlattr)); 498f8ff182cSThomas Graf 499f8ff182cSThomas Graf list_for_each_entry(af_ops, &rtnl_af_ops, list) { 500f8ff182cSThomas Graf if (af_ops->get_link_af_size) { 501f8ff182cSThomas Graf /* AF_* + nested data */ 502f8ff182cSThomas Graf size += nla_total_size(sizeof(struct nlattr)) + 503b1974ed0SArad, Ronen af_ops->get_link_af_size(dev, ext_filter_mask); 504f8ff182cSThomas Graf } 505f8ff182cSThomas Graf } 506f8ff182cSThomas Graf 507f8ff182cSThomas Graf return size; 508f8ff182cSThomas Graf } 509f8ff182cSThomas Graf 510ba7d49b1SJiri Pirko static bool rtnl_have_link_slave_info(const struct net_device *dev) 511ba7d49b1SJiri Pirko { 512ba7d49b1SJiri Pirko struct net_device *master_dev; 5134c82a95eSFlorian Westphal bool ret = false; 514ba7d49b1SJiri Pirko 5154c82a95eSFlorian Westphal rcu_read_lock(); 5164c82a95eSFlorian Westphal 5174c82a95eSFlorian Westphal master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 518813f020cSJiri Pirko if (master_dev && master_dev->rtnl_link_ops) 5194c82a95eSFlorian Westphal ret = true; 5204c82a95eSFlorian Westphal rcu_read_unlock(); 5214c82a95eSFlorian Westphal return ret; 522ba7d49b1SJiri Pirko } 523ba7d49b1SJiri Pirko 524ba7d49b1SJiri Pirko static int rtnl_link_slave_info_fill(struct sk_buff *skb, 525ba7d49b1SJiri Pirko const struct net_device *dev) 526ba7d49b1SJiri Pirko { 527ba7d49b1SJiri Pirko struct net_device *master_dev; 528ba7d49b1SJiri Pirko const struct rtnl_link_ops *ops; 529ba7d49b1SJiri Pirko struct nlattr *slave_data; 530ba7d49b1SJiri Pirko int err; 531ba7d49b1SJiri Pirko 532ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get((struct net_device *) dev); 533ba7d49b1SJiri Pirko if (!master_dev) 534ba7d49b1SJiri Pirko return 0; 535ba7d49b1SJiri Pirko ops = master_dev->rtnl_link_ops; 536ba7d49b1SJiri Pirko if (!ops) 537ba7d49b1SJiri Pirko return 0; 538ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0) 539ba7d49b1SJiri Pirko return -EMSGSIZE; 540ba7d49b1SJiri Pirko if (ops->fill_slave_info) { 541ba7d49b1SJiri Pirko slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA); 542ba7d49b1SJiri Pirko if (!slave_data) 543ba7d49b1SJiri Pirko return -EMSGSIZE; 544ba7d49b1SJiri Pirko err = ops->fill_slave_info(skb, master_dev, dev); 545ba7d49b1SJiri Pirko if (err < 0) 546ba7d49b1SJiri Pirko goto err_cancel_slave_data; 547ba7d49b1SJiri Pirko nla_nest_end(skb, slave_data); 548ba7d49b1SJiri Pirko } 549ba7d49b1SJiri Pirko return 0; 550ba7d49b1SJiri Pirko 551ba7d49b1SJiri Pirko err_cancel_slave_data: 552ba7d49b1SJiri Pirko nla_nest_cancel(skb, slave_data); 553ba7d49b1SJiri Pirko return err; 554ba7d49b1SJiri Pirko } 555ba7d49b1SJiri Pirko 556ba7d49b1SJiri Pirko static int rtnl_link_info_fill(struct sk_buff *skb, 557ba7d49b1SJiri Pirko const struct net_device *dev) 55838f7b870SPatrick McHardy { 55938f7b870SPatrick McHardy const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 560ba7d49b1SJiri Pirko struct nlattr *data; 561ba7d49b1SJiri Pirko int err; 562ba7d49b1SJiri Pirko 563ba7d49b1SJiri Pirko if (!ops) 564ba7d49b1SJiri Pirko return 0; 565ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0) 566ba7d49b1SJiri Pirko return -EMSGSIZE; 567ba7d49b1SJiri Pirko if (ops->fill_xstats) { 568ba7d49b1SJiri Pirko err = ops->fill_xstats(skb, dev); 569ba7d49b1SJiri Pirko if (err < 0) 570ba7d49b1SJiri Pirko return err; 571ba7d49b1SJiri Pirko } 572ba7d49b1SJiri Pirko if (ops->fill_info) { 573ba7d49b1SJiri Pirko data = nla_nest_start(skb, IFLA_INFO_DATA); 574ba7d49b1SJiri Pirko if (data == NULL) 575ba7d49b1SJiri Pirko return -EMSGSIZE; 576ba7d49b1SJiri Pirko err = ops->fill_info(skb, dev); 577ba7d49b1SJiri Pirko if (err < 0) 578ba7d49b1SJiri Pirko goto err_cancel_data; 579ba7d49b1SJiri Pirko nla_nest_end(skb, data); 580ba7d49b1SJiri Pirko } 581ba7d49b1SJiri Pirko return 0; 582ba7d49b1SJiri Pirko 583ba7d49b1SJiri Pirko err_cancel_data: 584ba7d49b1SJiri Pirko nla_nest_cancel(skb, data); 585ba7d49b1SJiri Pirko return err; 586ba7d49b1SJiri Pirko } 587ba7d49b1SJiri Pirko 588ba7d49b1SJiri Pirko static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev) 589ba7d49b1SJiri Pirko { 590ba7d49b1SJiri Pirko struct nlattr *linkinfo; 59138f7b870SPatrick McHardy int err = -EMSGSIZE; 59238f7b870SPatrick McHardy 59338f7b870SPatrick McHardy linkinfo = nla_nest_start(skb, IFLA_LINKINFO); 59438f7b870SPatrick McHardy if (linkinfo == NULL) 59538f7b870SPatrick McHardy goto out; 59638f7b870SPatrick McHardy 597ba7d49b1SJiri Pirko err = rtnl_link_info_fill(skb, dev); 59838f7b870SPatrick McHardy if (err < 0) 59938f7b870SPatrick McHardy goto err_cancel_link; 600ba7d49b1SJiri Pirko 601ba7d49b1SJiri Pirko err = rtnl_link_slave_info_fill(skb, dev); 60238f7b870SPatrick McHardy if (err < 0) 603ba7d49b1SJiri Pirko goto err_cancel_link; 60438f7b870SPatrick McHardy 60538f7b870SPatrick McHardy nla_nest_end(skb, linkinfo); 60638f7b870SPatrick McHardy return 0; 60738f7b870SPatrick McHardy 60838f7b870SPatrick McHardy err_cancel_link: 60938f7b870SPatrick McHardy nla_nest_cancel(skb, linkinfo); 61038f7b870SPatrick McHardy out: 61138f7b870SPatrick McHardy return err; 61238f7b870SPatrick McHardy } 61338f7b870SPatrick McHardy 61495c96174SEric Dumazet int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo) 6151da177e4SLinus Torvalds { 61697c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 6171da177e4SLinus Torvalds int err = 0; 6181da177e4SLinus Torvalds 619ac6d439dSPatrick McHardy NETLINK_CB(skb).dst_group = group; 6201da177e4SLinus Torvalds if (echo) 62163354797SReshetova, Elena refcount_inc(&skb->users); 6221da177e4SLinus Torvalds netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL); 6231da177e4SLinus Torvalds if (echo) 6241da177e4SLinus Torvalds err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT); 6251da177e4SLinus Torvalds return err; 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds 62897c53cacSDenis V. Lunev int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid) 6292942e900SThomas Graf { 63097c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 63197c53cacSDenis V. Lunev 6322942e900SThomas Graf return nlmsg_unicast(rtnl, skb, pid); 6332942e900SThomas Graf } 634e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unicast); 6352942e900SThomas Graf 6361ce85fe4SPablo Neira Ayuso void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group, 63797676b6bSThomas Graf struct nlmsghdr *nlh, gfp_t flags) 63897676b6bSThomas Graf { 63997c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 64097676b6bSThomas Graf int report = 0; 64197676b6bSThomas Graf 64297676b6bSThomas Graf if (nlh) 64397676b6bSThomas Graf report = nlmsg_report(nlh); 64497676b6bSThomas Graf 6451ce85fe4SPablo Neira Ayuso nlmsg_notify(rtnl, skb, pid, group, report, flags); 64697676b6bSThomas Graf } 647e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_notify); 64897676b6bSThomas Graf 64997c53cacSDenis V. Lunev void rtnl_set_sk_err(struct net *net, u32 group, int error) 65097676b6bSThomas Graf { 65197c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 65297c53cacSDenis V. Lunev 65397676b6bSThomas Graf netlink_set_err(rtnl, 0, group, error); 65497676b6bSThomas Graf } 655e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_set_sk_err); 65697676b6bSThomas Graf 6571da177e4SLinus Torvalds int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics) 6581da177e4SLinus Torvalds { 6592d7202bfSThomas Graf struct nlattr *mx; 6602d7202bfSThomas Graf int i, valid = 0; 6611da177e4SLinus Torvalds 6622d7202bfSThomas Graf mx = nla_nest_start(skb, RTA_METRICS); 6632d7202bfSThomas Graf if (mx == NULL) 6642d7202bfSThomas Graf return -ENOBUFS; 6652d7202bfSThomas Graf 6661da177e4SLinus Torvalds for (i = 0; i < RTAX_MAX; i++) { 6672d7202bfSThomas Graf if (metrics[i]) { 668ea697639SDaniel Borkmann if (i == RTAX_CC_ALGO - 1) { 669ea697639SDaniel Borkmann char tmp[TCP_CA_NAME_MAX], *name; 670ea697639SDaniel Borkmann 671ea697639SDaniel Borkmann name = tcp_ca_get_name_by_key(metrics[i], tmp); 672ea697639SDaniel Borkmann if (!name) 673ea697639SDaniel Borkmann continue; 674ea697639SDaniel Borkmann if (nla_put_string(skb, i + 1, name)) 675ea697639SDaniel Borkmann goto nla_put_failure; 676c3a8d947SDaniel Borkmann } else if (i == RTAX_FEATURES - 1) { 677c3a8d947SDaniel Borkmann u32 user_features = metrics[i] & RTAX_FEATURE_MASK; 678c3a8d947SDaniel Borkmann 679f8edcd12SPhil Sutter if (!user_features) 680f8edcd12SPhil Sutter continue; 681c3a8d947SDaniel Borkmann BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK); 682c3a8d947SDaniel Borkmann if (nla_put_u32(skb, i + 1, user_features)) 683c3a8d947SDaniel Borkmann goto nla_put_failure; 684ea697639SDaniel Borkmann } else { 685a6574349SDavid S. Miller if (nla_put_u32(skb, i + 1, metrics[i])) 686a6574349SDavid S. Miller goto nla_put_failure; 6871da177e4SLinus Torvalds } 688ea697639SDaniel Borkmann valid++; 689ea697639SDaniel Borkmann } 6902d7202bfSThomas Graf } 6911da177e4SLinus Torvalds 692a57d27fcSDavid S. Miller if (!valid) { 693a57d27fcSDavid S. Miller nla_nest_cancel(skb, mx); 694a57d27fcSDavid S. Miller return 0; 695a57d27fcSDavid S. Miller } 6962d7202bfSThomas Graf 6972d7202bfSThomas Graf return nla_nest_end(skb, mx); 6982d7202bfSThomas Graf 6992d7202bfSThomas Graf nla_put_failure: 700bc3ed28cSThomas Graf nla_nest_cancel(skb, mx); 701bc3ed28cSThomas Graf return -EMSGSIZE; 7021da177e4SLinus Torvalds } 703e0d087afSEric Dumazet EXPORT_SYMBOL(rtnetlink_put_metrics); 7041da177e4SLinus Torvalds 705e3703b3dSThomas Graf int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id, 70687a50699SDavid S. Miller long expires, u32 error) 707e3703b3dSThomas Graf { 708e3703b3dSThomas Graf struct rta_cacheinfo ci = { 709a399a805SEric Dumazet .rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse), 710e3703b3dSThomas Graf .rta_used = dst->__use, 711e3703b3dSThomas Graf .rta_clntref = atomic_read(&(dst->__refcnt)), 712e3703b3dSThomas Graf .rta_error = error, 713e3703b3dSThomas Graf .rta_id = id, 714e3703b3dSThomas Graf }; 715e3703b3dSThomas Graf 7168253947eSLi Wei if (expires) { 7178253947eSLi Wei unsigned long clock; 718e3703b3dSThomas Graf 7198253947eSLi Wei clock = jiffies_to_clock_t(abs(expires)); 7208253947eSLi Wei clock = min_t(unsigned long, clock, INT_MAX); 7218253947eSLi Wei ci.rta_expires = (expires > 0) ? clock : -clock; 7228253947eSLi Wei } 723e3703b3dSThomas Graf return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci); 724e3703b3dSThomas Graf } 725e3703b3dSThomas Graf EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo); 7261da177e4SLinus Torvalds 72793b2d4a2SDavid S. Miller static void set_operstate(struct net_device *dev, unsigned char transition) 728b00055aaSStefan Rompf { 729b00055aaSStefan Rompf unsigned char operstate = dev->operstate; 730b00055aaSStefan Rompf 731b00055aaSStefan Rompf switch (transition) { 732b00055aaSStefan Rompf case IF_OPER_UP: 733b00055aaSStefan Rompf if ((operstate == IF_OPER_DORMANT || 734b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) && 735b00055aaSStefan Rompf !netif_dormant(dev)) 736b00055aaSStefan Rompf operstate = IF_OPER_UP; 737b00055aaSStefan Rompf break; 738b00055aaSStefan Rompf 739b00055aaSStefan Rompf case IF_OPER_DORMANT: 740b00055aaSStefan Rompf if (operstate == IF_OPER_UP || 741b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) 742b00055aaSStefan Rompf operstate = IF_OPER_DORMANT; 743b00055aaSStefan Rompf break; 7443ff50b79SStephen Hemminger } 745b00055aaSStefan Rompf 746b00055aaSStefan Rompf if (dev->operstate != operstate) { 747b00055aaSStefan Rompf write_lock_bh(&dev_base_lock); 748b00055aaSStefan Rompf dev->operstate = operstate; 749b00055aaSStefan Rompf write_unlock_bh(&dev_base_lock); 750b00055aaSStefan Rompf netdev_state_change(dev); 75193b2d4a2SDavid S. Miller } 752b00055aaSStefan Rompf } 753b00055aaSStefan Rompf 754b1beb681SJiri Benc static unsigned int rtnl_dev_get_flags(const struct net_device *dev) 755b1beb681SJiri Benc { 756b1beb681SJiri Benc return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) | 757b1beb681SJiri Benc (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI)); 758b1beb681SJiri Benc } 759b1beb681SJiri Benc 7603729d502SPatrick McHardy static unsigned int rtnl_dev_combine_flags(const struct net_device *dev, 7613729d502SPatrick McHardy const struct ifinfomsg *ifm) 7623729d502SPatrick McHardy { 7633729d502SPatrick McHardy unsigned int flags = ifm->ifi_flags; 7643729d502SPatrick McHardy 7653729d502SPatrick McHardy /* bugwards compatibility: ifi_change == 0 is treated as ~0 */ 7663729d502SPatrick McHardy if (ifm->ifi_change) 7673729d502SPatrick McHardy flags = (flags & ifm->ifi_change) | 768b1beb681SJiri Benc (rtnl_dev_get_flags(dev) & ~ifm->ifi_change); 7693729d502SPatrick McHardy 7703729d502SPatrick McHardy return flags; 7713729d502SPatrick McHardy } 7723729d502SPatrick McHardy 773b60c5115SThomas Graf static void copy_rtnl_link_stats(struct rtnl_link_stats *a, 774be1f3c2cSBen Hutchings const struct rtnl_link_stats64 *b) 7751da177e4SLinus Torvalds { 776b60c5115SThomas Graf a->rx_packets = b->rx_packets; 777b60c5115SThomas Graf a->tx_packets = b->tx_packets; 778b60c5115SThomas Graf a->rx_bytes = b->rx_bytes; 779b60c5115SThomas Graf a->tx_bytes = b->tx_bytes; 780b60c5115SThomas Graf a->rx_errors = b->rx_errors; 781b60c5115SThomas Graf a->tx_errors = b->tx_errors; 782b60c5115SThomas Graf a->rx_dropped = b->rx_dropped; 783b60c5115SThomas Graf a->tx_dropped = b->tx_dropped; 784b60c5115SThomas Graf 785b60c5115SThomas Graf a->multicast = b->multicast; 786b60c5115SThomas Graf a->collisions = b->collisions; 787b60c5115SThomas Graf 788b60c5115SThomas Graf a->rx_length_errors = b->rx_length_errors; 789b60c5115SThomas Graf a->rx_over_errors = b->rx_over_errors; 790b60c5115SThomas Graf a->rx_crc_errors = b->rx_crc_errors; 791b60c5115SThomas Graf a->rx_frame_errors = b->rx_frame_errors; 792b60c5115SThomas Graf a->rx_fifo_errors = b->rx_fifo_errors; 793b60c5115SThomas Graf a->rx_missed_errors = b->rx_missed_errors; 794b60c5115SThomas Graf 795b60c5115SThomas Graf a->tx_aborted_errors = b->tx_aborted_errors; 796b60c5115SThomas Graf a->tx_carrier_errors = b->tx_carrier_errors; 797b60c5115SThomas Graf a->tx_fifo_errors = b->tx_fifo_errors; 798b60c5115SThomas Graf a->tx_heartbeat_errors = b->tx_heartbeat_errors; 799b60c5115SThomas Graf a->tx_window_errors = b->tx_window_errors; 800b60c5115SThomas Graf 801b60c5115SThomas Graf a->rx_compressed = b->rx_compressed; 802b60c5115SThomas Graf a->tx_compressed = b->tx_compressed; 8036e7333d3SJarod Wilson 8046e7333d3SJarod Wilson a->rx_nohandler = b->rx_nohandler; 80510708f37SJan Engelhardt } 80610708f37SJan Engelhardt 807c02db8c6SChris Wright /* All VF info */ 808115c9b81SGreg Rose static inline int rtnl_vfinfo_size(const struct net_device *dev, 809115c9b81SGreg Rose u32 ext_filter_mask) 810ebc08a6fSWilliams, Mitch A { 8119af15c38SPhil Sutter if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) { 812c02db8c6SChris Wright int num_vfs = dev_num_vf(dev->dev.parent); 8137e75f74aSSabrina Dubroca size_t size = nla_total_size(0); 814045de01aSScott Feldman size += num_vfs * 8157e75f74aSSabrina Dubroca (nla_total_size(0) + 8167e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_mac)) + 8177e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_vlan)) + 8187e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */ 81979aab093SMoshe Shemesh nla_total_size(MAX_VLAN_LIST_LEN * 82079aab093SMoshe Shemesh sizeof(struct ifla_vf_vlan_info)) + 821ed616689SSucheta Chakraborty nla_total_size(sizeof(struct ifla_vf_spoofchk)) + 8227e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_tx_rate)) + 823945a3676SJiri Benc nla_total_size(sizeof(struct ifla_vf_rate)) + 82401a3d796SVlad Zolotarov nla_total_size(sizeof(struct ifla_vf_link_state)) + 8253b766cd8SEran Ben Elisha nla_total_size(sizeof(struct ifla_vf_rss_query_en)) + 8267e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_STATS */ 8273b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_PACKETS */ 828343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8293b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_PACKETS */ 830343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8313b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_BYTES */ 832343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8333b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_BYTES */ 834343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8353b766cd8SEran Ben Elisha /* IFLA_VF_STATS_BROADCAST */ 836343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8373b766cd8SEran Ben Elisha /* IFLA_VF_STATS_MULTICAST */ 838343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 839dd461d6aSHiroshi Shimamoto nla_total_size(sizeof(struct ifla_vf_trust))); 840c02db8c6SChris Wright return size; 841c02db8c6SChris Wright } else 842ebc08a6fSWilliams, Mitch A return 0; 843ebc08a6fSWilliams, Mitch A } 844ebc08a6fSWilliams, Mitch A 845c53864fdSDavid Gibson static size_t rtnl_port_size(const struct net_device *dev, 846c53864fdSDavid Gibson u32 ext_filter_mask) 84757b61080SScott Feldman { 84857b61080SScott Feldman size_t port_size = nla_total_size(4) /* PORT_VF */ 84957b61080SScott Feldman + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ 85057b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ 85157b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ 85257b61080SScott Feldman + nla_total_size(1) /* PROT_VDP_REQUEST */ 85357b61080SScott Feldman + nla_total_size(2); /* PORT_VDP_RESPONSE */ 85457b61080SScott Feldman size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); 85557b61080SScott Feldman size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) 85657b61080SScott Feldman + port_size; 85757b61080SScott Feldman size_t port_self_size = nla_total_size(sizeof(struct nlattr)) 85857b61080SScott Feldman + port_size; 85957b61080SScott Feldman 860c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 861c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 86257b61080SScott Feldman return 0; 86357b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) 86457b61080SScott Feldman return port_self_size + vf_ports_size + 86557b61080SScott Feldman vf_port_size * dev_num_vf(dev->dev.parent); 86657b61080SScott Feldman else 86757b61080SScott Feldman return port_self_size; 86857b61080SScott Feldman } 86957b61080SScott Feldman 870b5cdae32SDavid S. Miller static size_t rtnl_xdp_size(void) 871d1fdd913SBrenden Blanco { 872b3cfaa31SSabrina Dubroca size_t xdp_size = nla_total_size(0) + /* nest IFLA_XDP */ 87358038695SMartin KaFai Lau nla_total_size(1) + /* XDP_ATTACHED */ 87458038695SMartin KaFai Lau nla_total_size(4); /* XDP_PROG_ID */ 875d1fdd913SBrenden Blanco 876d1fdd913SBrenden Blanco return xdp_size; 877d1fdd913SBrenden Blanco } 878d1fdd913SBrenden Blanco 879115c9b81SGreg Rose static noinline size_t if_nlmsg_size(const struct net_device *dev, 880115c9b81SGreg Rose u32 ext_filter_mask) 881339bf98fSThomas Graf { 882339bf98fSThomas Graf return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 883339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 8840b815a1aSStephen Hemminger + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ 885339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ 886270cb4d0SNicolas Dichtel + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap)) 887339bf98fSThomas Graf + nla_total_size(sizeof(struct rtnl_link_stats)) 88835c58459SDavid S. Miller + nla_total_size_64bit(sizeof(struct rtnl_link_stats64)) 889339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 890339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ 891339bf98fSThomas Graf + nla_total_size(4) /* IFLA_TXQLEN */ 892339bf98fSThomas Graf + nla_total_size(4) /* IFLA_WEIGHT */ 893339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MTU */ 894339bf98fSThomas Graf + nla_total_size(4) /* IFLA_LINK */ 895339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MASTER */ 8969a57247fSJiri Pirko + nla_total_size(1) /* IFLA_CARRIER */ 897edbc0bb3SBen Greear + nla_total_size(4) /* IFLA_PROMISCUITY */ 89876ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */ 89976ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */ 9006919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */ 9016919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */ 902339bf98fSThomas Graf + nla_total_size(1) /* IFLA_OPERSTATE */ 90338f7b870SPatrick McHardy + nla_total_size(1) /* IFLA_LINKMODE */ 9042d3b479dSdavid decotigny + nla_total_size(4) /* IFLA_CARRIER_CHANGES */ 905d37512a2SNicolas Dichtel + nla_total_size(4) /* IFLA_LINK_NETNSID */ 906db833d40SSerhey Popovych + nla_total_size(4) /* IFLA_GROUP */ 907115c9b81SGreg Rose + nla_total_size(ext_filter_mask 908115c9b81SGreg Rose & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */ 909115c9b81SGreg Rose + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */ 910c53864fdSDavid Gibson + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ 911f8ff182cSThomas Graf + rtnl_link_get_size(dev) /* IFLA_LINKINFO */ 912b1974ed0SArad, Ronen + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */ 91382f28412SJiri Pirko + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */ 91488d6378bSAnuradha Karuppiah + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */ 915c57c7a95SNicolas Dichtel + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */ 916b5cdae32SDavid S. Miller + rtnl_xdp_size() /* IFLA_XDP */ 9173d3ea5afSVlad Yasevich + nla_total_size(4) /* IFLA_EVENT */ 91888d6378bSAnuradha Karuppiah + nla_total_size(1); /* IFLA_PROTO_DOWN */ 91988d6378bSAnuradha Karuppiah 920339bf98fSThomas Graf } 921339bf98fSThomas Graf 92257b61080SScott Feldman static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) 92357b61080SScott Feldman { 92457b61080SScott Feldman struct nlattr *vf_ports; 92557b61080SScott Feldman struct nlattr *vf_port; 92657b61080SScott Feldman int vf; 92757b61080SScott Feldman int err; 92857b61080SScott Feldman 92957b61080SScott Feldman vf_ports = nla_nest_start(skb, IFLA_VF_PORTS); 93057b61080SScott Feldman if (!vf_ports) 93157b61080SScott Feldman return -EMSGSIZE; 93257b61080SScott Feldman 93357b61080SScott Feldman for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { 93457b61080SScott Feldman vf_port = nla_nest_start(skb, IFLA_VF_PORT); 9358ca94183SScott Feldman if (!vf_port) 9368ca94183SScott Feldman goto nla_put_failure; 937a6574349SDavid S. Miller if (nla_put_u32(skb, IFLA_PORT_VF, vf)) 938a6574349SDavid S. Miller goto nla_put_failure; 93957b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); 9408ca94183SScott Feldman if (err == -EMSGSIZE) 9418ca94183SScott Feldman goto nla_put_failure; 94257b61080SScott Feldman if (err) { 94357b61080SScott Feldman nla_nest_cancel(skb, vf_port); 94457b61080SScott Feldman continue; 94557b61080SScott Feldman } 94657b61080SScott Feldman nla_nest_end(skb, vf_port); 94757b61080SScott Feldman } 94857b61080SScott Feldman 94957b61080SScott Feldman nla_nest_end(skb, vf_ports); 95057b61080SScott Feldman 95157b61080SScott Feldman return 0; 9528ca94183SScott Feldman 9538ca94183SScott Feldman nla_put_failure: 9548ca94183SScott Feldman nla_nest_cancel(skb, vf_ports); 9558ca94183SScott Feldman return -EMSGSIZE; 95657b61080SScott Feldman } 95757b61080SScott Feldman 95857b61080SScott Feldman static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) 95957b61080SScott Feldman { 96057b61080SScott Feldman struct nlattr *port_self; 96157b61080SScott Feldman int err; 96257b61080SScott Feldman 96357b61080SScott Feldman port_self = nla_nest_start(skb, IFLA_PORT_SELF); 96457b61080SScott Feldman if (!port_self) 96557b61080SScott Feldman return -EMSGSIZE; 96657b61080SScott Feldman 96757b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); 96857b61080SScott Feldman if (err) { 96957b61080SScott Feldman nla_nest_cancel(skb, port_self); 9708ca94183SScott Feldman return (err == -EMSGSIZE) ? err : 0; 97157b61080SScott Feldman } 97257b61080SScott Feldman 97357b61080SScott Feldman nla_nest_end(skb, port_self); 97457b61080SScott Feldman 97557b61080SScott Feldman return 0; 97657b61080SScott Feldman } 97757b61080SScott Feldman 978c53864fdSDavid Gibson static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev, 979c53864fdSDavid Gibson u32 ext_filter_mask) 98057b61080SScott Feldman { 98157b61080SScott Feldman int err; 98257b61080SScott Feldman 983c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 984c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 98557b61080SScott Feldman return 0; 98657b61080SScott Feldman 98757b61080SScott Feldman err = rtnl_port_self_fill(skb, dev); 98857b61080SScott Feldman if (err) 98957b61080SScott Feldman return err; 99057b61080SScott Feldman 99157b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) { 99257b61080SScott Feldman err = rtnl_vf_ports_fill(skb, dev); 99357b61080SScott Feldman if (err) 99457b61080SScott Feldman return err; 99557b61080SScott Feldman } 99657b61080SScott Feldman 99757b61080SScott Feldman return 0; 99857b61080SScott Feldman } 99957b61080SScott Feldman 100066cae9edSJiri Pirko static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev) 100166cae9edSJiri Pirko { 100266cae9edSJiri Pirko int err; 100302637fceSJiri Pirko struct netdev_phys_item_id ppid; 100466cae9edSJiri Pirko 100566cae9edSJiri Pirko err = dev_get_phys_port_id(dev, &ppid); 100666cae9edSJiri Pirko if (err) { 100766cae9edSJiri Pirko if (err == -EOPNOTSUPP) 100866cae9edSJiri Pirko return 0; 100966cae9edSJiri Pirko return err; 101066cae9edSJiri Pirko } 101166cae9edSJiri Pirko 101266cae9edSJiri Pirko if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id)) 101366cae9edSJiri Pirko return -EMSGSIZE; 101466cae9edSJiri Pirko 101566cae9edSJiri Pirko return 0; 101666cae9edSJiri Pirko } 101766cae9edSJiri Pirko 1018db24a904SDavid Ahern static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev) 1019db24a904SDavid Ahern { 1020db24a904SDavid Ahern char name[IFNAMSIZ]; 1021db24a904SDavid Ahern int err; 1022db24a904SDavid Ahern 1023db24a904SDavid Ahern err = dev_get_phys_port_name(dev, name, sizeof(name)); 1024db24a904SDavid Ahern if (err) { 1025db24a904SDavid Ahern if (err == -EOPNOTSUPP) 1026db24a904SDavid Ahern return 0; 1027db24a904SDavid Ahern return err; 1028db24a904SDavid Ahern } 1029db24a904SDavid Ahern 103077ef033bSMichal Schmidt if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name)) 1031db24a904SDavid Ahern return -EMSGSIZE; 1032db24a904SDavid Ahern 1033db24a904SDavid Ahern return 0; 1034db24a904SDavid Ahern } 1035db24a904SDavid Ahern 103682f28412SJiri Pirko static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev) 103782f28412SJiri Pirko { 103882f28412SJiri Pirko int err; 1039f8e20a9fSScott Feldman struct switchdev_attr attr = { 10406ff64f6fSIdo Schimmel .orig_dev = dev, 10411f868398SJiri Pirko .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID, 1042f8e20a9fSScott Feldman .flags = SWITCHDEV_F_NO_RECURSE, 1043f8e20a9fSScott Feldman }; 104482f28412SJiri Pirko 1045f8e20a9fSScott Feldman err = switchdev_port_attr_get(dev, &attr); 104682f28412SJiri Pirko if (err) { 104782f28412SJiri Pirko if (err == -EOPNOTSUPP) 104882f28412SJiri Pirko return 0; 104982f28412SJiri Pirko return err; 105082f28412SJiri Pirko } 105182f28412SJiri Pirko 105242275bd8SScott Feldman if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len, 105342275bd8SScott Feldman attr.u.ppid.id)) 105482f28412SJiri Pirko return -EMSGSIZE; 105582f28412SJiri Pirko 105682f28412SJiri Pirko return 0; 105782f28412SJiri Pirko } 105882f28412SJiri Pirko 1059b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb, 1060b22b941bSHannes Frederic Sowa struct net_device *dev) 1061b22b941bSHannes Frederic Sowa { 1062550bce59SRoopa Prabhu struct rtnl_link_stats64 *sp; 1063b22b941bSHannes Frederic Sowa struct nlattr *attr; 1064b22b941bSHannes Frederic Sowa 106558414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS64, 106658414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), IFLA_PAD); 1067b22b941bSHannes Frederic Sowa if (!attr) 1068b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1069b22b941bSHannes Frederic Sowa 1070550bce59SRoopa Prabhu sp = nla_data(attr); 1071550bce59SRoopa Prabhu dev_get_stats(dev, sp); 1072550bce59SRoopa Prabhu 1073550bce59SRoopa Prabhu attr = nla_reserve(skb, IFLA_STATS, 1074550bce59SRoopa Prabhu sizeof(struct rtnl_link_stats)); 1075550bce59SRoopa Prabhu if (!attr) 1076550bce59SRoopa Prabhu return -EMSGSIZE; 1077550bce59SRoopa Prabhu 1078550bce59SRoopa Prabhu copy_rtnl_link_stats(nla_data(attr), sp); 1079b22b941bSHannes Frederic Sowa 1080b22b941bSHannes Frederic Sowa return 0; 1081b22b941bSHannes Frederic Sowa } 1082b22b941bSHannes Frederic Sowa 1083b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb, 1084b22b941bSHannes Frederic Sowa struct net_device *dev, 1085b22b941bSHannes Frederic Sowa int vfs_num, 1086b22b941bSHannes Frederic Sowa struct nlattr *vfinfo) 1087b22b941bSHannes Frederic Sowa { 1088b22b941bSHannes Frederic Sowa struct ifla_vf_rss_query_en vf_rss_query_en; 108979aab093SMoshe Shemesh struct nlattr *vf, *vfstats, *vfvlanlist; 1090b22b941bSHannes Frederic Sowa struct ifla_vf_link_state vf_linkstate; 109179aab093SMoshe Shemesh struct ifla_vf_vlan_info vf_vlan_info; 1092b22b941bSHannes Frederic Sowa struct ifla_vf_spoofchk vf_spoofchk; 1093b22b941bSHannes Frederic Sowa struct ifla_vf_tx_rate vf_tx_rate; 1094b22b941bSHannes Frederic Sowa struct ifla_vf_stats vf_stats; 1095b22b941bSHannes Frederic Sowa struct ifla_vf_trust vf_trust; 1096b22b941bSHannes Frederic Sowa struct ifla_vf_vlan vf_vlan; 1097b22b941bSHannes Frederic Sowa struct ifla_vf_rate vf_rate; 1098b22b941bSHannes Frederic Sowa struct ifla_vf_mac vf_mac; 1099b22b941bSHannes Frederic Sowa struct ifla_vf_info ivi; 1100b22b941bSHannes Frederic Sowa 11010eed9cf5SMintz, Yuval memset(&ivi, 0, sizeof(ivi)); 11020eed9cf5SMintz, Yuval 1103b22b941bSHannes Frederic Sowa /* Not all SR-IOV capable drivers support the 1104b22b941bSHannes Frederic Sowa * spoofcheck and "RSS query enable" query. Preset to 1105b22b941bSHannes Frederic Sowa * -1 so the user space tool can detect that the driver 1106b22b941bSHannes Frederic Sowa * didn't report anything. 1107b22b941bSHannes Frederic Sowa */ 1108b22b941bSHannes Frederic Sowa ivi.spoofchk = -1; 1109b22b941bSHannes Frederic Sowa ivi.rss_query_en = -1; 1110b22b941bSHannes Frederic Sowa ivi.trusted = -1; 1111b22b941bSHannes Frederic Sowa /* The default value for VF link state is "auto" 1112b22b941bSHannes Frederic Sowa * IFLA_VF_LINK_STATE_AUTO which equals zero 1113b22b941bSHannes Frederic Sowa */ 1114b22b941bSHannes Frederic Sowa ivi.linkstate = 0; 111579aab093SMoshe Shemesh /* VLAN Protocol by default is 802.1Q */ 111679aab093SMoshe Shemesh ivi.vlan_proto = htons(ETH_P_8021Q); 1117b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi)) 1118b22b941bSHannes Frederic Sowa return 0; 1119b22b941bSHannes Frederic Sowa 1120775f4f05SDan Carpenter memset(&vf_vlan_info, 0, sizeof(vf_vlan_info)); 1121775f4f05SDan Carpenter 1122b22b941bSHannes Frederic Sowa vf_mac.vf = 1123b22b941bSHannes Frederic Sowa vf_vlan.vf = 112479aab093SMoshe Shemesh vf_vlan_info.vf = 1125b22b941bSHannes Frederic Sowa vf_rate.vf = 1126b22b941bSHannes Frederic Sowa vf_tx_rate.vf = 1127b22b941bSHannes Frederic Sowa vf_spoofchk.vf = 1128b22b941bSHannes Frederic Sowa vf_linkstate.vf = 1129b22b941bSHannes Frederic Sowa vf_rss_query_en.vf = 1130b22b941bSHannes Frederic Sowa vf_trust.vf = ivi.vf; 1131b22b941bSHannes Frederic Sowa 1132b22b941bSHannes Frederic Sowa memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); 1133b22b941bSHannes Frederic Sowa vf_vlan.vlan = ivi.vlan; 1134b22b941bSHannes Frederic Sowa vf_vlan.qos = ivi.qos; 113579aab093SMoshe Shemesh vf_vlan_info.vlan = ivi.vlan; 113679aab093SMoshe Shemesh vf_vlan_info.qos = ivi.qos; 113779aab093SMoshe Shemesh vf_vlan_info.vlan_proto = ivi.vlan_proto; 1138b22b941bSHannes Frederic Sowa vf_tx_rate.rate = ivi.max_tx_rate; 1139b22b941bSHannes Frederic Sowa vf_rate.min_tx_rate = ivi.min_tx_rate; 1140b22b941bSHannes Frederic Sowa vf_rate.max_tx_rate = ivi.max_tx_rate; 1141b22b941bSHannes Frederic Sowa vf_spoofchk.setting = ivi.spoofchk; 1142b22b941bSHannes Frederic Sowa vf_linkstate.link_state = ivi.linkstate; 1143b22b941bSHannes Frederic Sowa vf_rss_query_en.setting = ivi.rss_query_en; 1144b22b941bSHannes Frederic Sowa vf_trust.setting = ivi.trusted; 1145b22b941bSHannes Frederic Sowa vf = nla_nest_start(skb, IFLA_VF_INFO); 114679aab093SMoshe Shemesh if (!vf) 114779aab093SMoshe Shemesh goto nla_put_vfinfo_failure; 1148b22b941bSHannes Frederic Sowa if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) || 1149b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) || 1150b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate), 1151b22b941bSHannes Frederic Sowa &vf_rate) || 1152b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), 1153b22b941bSHannes Frederic Sowa &vf_tx_rate) || 1154b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk), 1155b22b941bSHannes Frederic Sowa &vf_spoofchk) || 1156b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate), 1157b22b941bSHannes Frederic Sowa &vf_linkstate) || 1158b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RSS_QUERY_EN, 1159b22b941bSHannes Frederic Sowa sizeof(vf_rss_query_en), 1160b22b941bSHannes Frederic Sowa &vf_rss_query_en) || 1161b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TRUST, 1162b22b941bSHannes Frederic Sowa sizeof(vf_trust), &vf_trust)) 116379aab093SMoshe Shemesh goto nla_put_vf_failure; 116479aab093SMoshe Shemesh vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST); 116579aab093SMoshe Shemesh if (!vfvlanlist) 116679aab093SMoshe Shemesh goto nla_put_vf_failure; 116779aab093SMoshe Shemesh if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info), 116879aab093SMoshe Shemesh &vf_vlan_info)) { 116979aab093SMoshe Shemesh nla_nest_cancel(skb, vfvlanlist); 117079aab093SMoshe Shemesh goto nla_put_vf_failure; 117179aab093SMoshe Shemesh } 117279aab093SMoshe Shemesh nla_nest_end(skb, vfvlanlist); 1173b22b941bSHannes Frederic Sowa memset(&vf_stats, 0, sizeof(vf_stats)); 1174b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_stats) 1175b22b941bSHannes Frederic Sowa dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num, 1176b22b941bSHannes Frederic Sowa &vf_stats); 1177b22b941bSHannes Frederic Sowa vfstats = nla_nest_start(skb, IFLA_VF_STATS); 117879aab093SMoshe Shemesh if (!vfstats) 117979aab093SMoshe Shemesh goto nla_put_vf_failure; 1180343a6d8eSNicolas Dichtel if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS, 1181343a6d8eSNicolas Dichtel vf_stats.rx_packets, IFLA_VF_STATS_PAD) || 1182343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS, 1183343a6d8eSNicolas Dichtel vf_stats.tx_packets, IFLA_VF_STATS_PAD) || 1184343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES, 1185343a6d8eSNicolas Dichtel vf_stats.rx_bytes, IFLA_VF_STATS_PAD) || 1186343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES, 1187343a6d8eSNicolas Dichtel vf_stats.tx_bytes, IFLA_VF_STATS_PAD) || 1188343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST, 1189343a6d8eSNicolas Dichtel vf_stats.broadcast, IFLA_VF_STATS_PAD) || 1190343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST, 119179aab093SMoshe Shemesh vf_stats.multicast, IFLA_VF_STATS_PAD)) { 119279aab093SMoshe Shemesh nla_nest_cancel(skb, vfstats); 119379aab093SMoshe Shemesh goto nla_put_vf_failure; 119479aab093SMoshe Shemesh } 1195b22b941bSHannes Frederic Sowa nla_nest_end(skb, vfstats); 1196b22b941bSHannes Frederic Sowa nla_nest_end(skb, vf); 1197b22b941bSHannes Frederic Sowa return 0; 119879aab093SMoshe Shemesh 119979aab093SMoshe Shemesh nla_put_vf_failure: 120079aab093SMoshe Shemesh nla_nest_cancel(skb, vf); 120179aab093SMoshe Shemesh nla_put_vfinfo_failure: 120279aab093SMoshe Shemesh nla_nest_cancel(skb, vfinfo); 120379aab093SMoshe Shemesh return -EMSGSIZE; 1204b22b941bSHannes Frederic Sowa } 1205b22b941bSHannes Frederic Sowa 1206250fc3dfSFlorian Westphal static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb, 1207250fc3dfSFlorian Westphal struct net_device *dev, 1208250fc3dfSFlorian Westphal u32 ext_filter_mask) 1209250fc3dfSFlorian Westphal { 1210250fc3dfSFlorian Westphal struct nlattr *vfinfo; 1211250fc3dfSFlorian Westphal int i, num_vfs; 1212250fc3dfSFlorian Westphal 1213250fc3dfSFlorian Westphal if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0)) 1214250fc3dfSFlorian Westphal return 0; 1215250fc3dfSFlorian Westphal 1216250fc3dfSFlorian Westphal num_vfs = dev_num_vf(dev->dev.parent); 1217250fc3dfSFlorian Westphal if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs)) 1218250fc3dfSFlorian Westphal return -EMSGSIZE; 1219250fc3dfSFlorian Westphal 1220250fc3dfSFlorian Westphal if (!dev->netdev_ops->ndo_get_vf_config) 1221250fc3dfSFlorian Westphal return 0; 1222250fc3dfSFlorian Westphal 1223250fc3dfSFlorian Westphal vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST); 1224250fc3dfSFlorian Westphal if (!vfinfo) 1225250fc3dfSFlorian Westphal return -EMSGSIZE; 1226250fc3dfSFlorian Westphal 1227250fc3dfSFlorian Westphal for (i = 0; i < num_vfs; i++) { 1228250fc3dfSFlorian Westphal if (rtnl_fill_vfinfo(skb, dev, i, vfinfo)) 1229250fc3dfSFlorian Westphal return -EMSGSIZE; 1230250fc3dfSFlorian Westphal } 1231250fc3dfSFlorian Westphal 1232250fc3dfSFlorian Westphal nla_nest_end(skb, vfinfo); 1233250fc3dfSFlorian Westphal return 0; 1234250fc3dfSFlorian Westphal } 1235250fc3dfSFlorian Westphal 1236b22b941bSHannes Frederic Sowa static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev) 1237b22b941bSHannes Frederic Sowa { 12385f8e4474SKangjie Lu struct rtnl_link_ifmap map; 12395f8e4474SKangjie Lu 12405f8e4474SKangjie Lu memset(&map, 0, sizeof(map)); 12415f8e4474SKangjie Lu map.mem_start = dev->mem_start; 12425f8e4474SKangjie Lu map.mem_end = dev->mem_end; 12435f8e4474SKangjie Lu map.base_addr = dev->base_addr; 12445f8e4474SKangjie Lu map.irq = dev->irq; 12455f8e4474SKangjie Lu map.dma = dev->dma; 12465f8e4474SKangjie Lu map.port = dev->if_port; 12475f8e4474SKangjie Lu 1248270cb4d0SNicolas Dichtel if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD)) 1249b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1250b22b941bSHannes Frederic Sowa 1251b22b941bSHannes Frederic Sowa return 0; 1252b22b941bSHannes Frederic Sowa } 1253b22b941bSHannes Frederic Sowa 125458038695SMartin KaFai Lau static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id) 1255d67b9cd2SDaniel Borkmann { 1256d67b9cd2SDaniel Borkmann const struct net_device_ops *ops = dev->netdev_ops; 125758038695SMartin KaFai Lau const struct bpf_prog *generic_xdp_prog; 1258d67b9cd2SDaniel Borkmann 1259d67b9cd2SDaniel Borkmann ASSERT_RTNL(); 1260d67b9cd2SDaniel Borkmann 126158038695SMartin KaFai Lau *prog_id = 0; 126258038695SMartin KaFai Lau generic_xdp_prog = rtnl_dereference(dev->xdp_prog); 126358038695SMartin KaFai Lau if (generic_xdp_prog) { 126458038695SMartin KaFai Lau *prog_id = generic_xdp_prog->aux->id; 1265d67b9cd2SDaniel Borkmann return XDP_ATTACHED_SKB; 126658038695SMartin KaFai Lau } 1267ce158e58SJakub Kicinski if (!ops->ndo_xdp) 1268d67b9cd2SDaniel Borkmann return XDP_ATTACHED_NONE; 1269ce158e58SJakub Kicinski 1270ce158e58SJakub Kicinski return __dev_xdp_attached(dev, ops->ndo_xdp, prog_id); 1271d67b9cd2SDaniel Borkmann } 1272d67b9cd2SDaniel Borkmann 1273d1fdd913SBrenden Blanco static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev) 1274d1fdd913SBrenden Blanco { 1275d1fdd913SBrenden Blanco struct nlattr *xdp; 127658038695SMartin KaFai Lau u32 prog_id; 1277d1fdd913SBrenden Blanco int err; 1278d1fdd913SBrenden Blanco 1279d1fdd913SBrenden Blanco xdp = nla_nest_start(skb, IFLA_XDP); 1280d1fdd913SBrenden Blanco if (!xdp) 1281d1fdd913SBrenden Blanco return -EMSGSIZE; 1282b5cdae32SDavid S. Miller 1283d67b9cd2SDaniel Borkmann err = nla_put_u8(skb, IFLA_XDP_ATTACHED, 128458038695SMartin KaFai Lau rtnl_xdp_attached_mode(dev, &prog_id)); 1285d1fdd913SBrenden Blanco if (err) 1286d1fdd913SBrenden Blanco goto err_cancel; 1287d1fdd913SBrenden Blanco 128858038695SMartin KaFai Lau if (prog_id) { 128958038695SMartin KaFai Lau err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id); 129058038695SMartin KaFai Lau if (err) 129158038695SMartin KaFai Lau goto err_cancel; 129258038695SMartin KaFai Lau } 129358038695SMartin KaFai Lau 1294d1fdd913SBrenden Blanco nla_nest_end(skb, xdp); 1295d1fdd913SBrenden Blanco return 0; 1296d1fdd913SBrenden Blanco 1297d1fdd913SBrenden Blanco err_cancel: 1298d1fdd913SBrenden Blanco nla_nest_cancel(skb, xdp); 1299d1fdd913SBrenden Blanco return err; 1300d1fdd913SBrenden Blanco } 1301d1fdd913SBrenden Blanco 13023d3ea5afSVlad Yasevich static u32 rtnl_get_event(unsigned long event) 13033d3ea5afSVlad Yasevich { 13043d3ea5afSVlad Yasevich u32 rtnl_event_type = IFLA_EVENT_NONE; 13053d3ea5afSVlad Yasevich 13063d3ea5afSVlad Yasevich switch (event) { 13073d3ea5afSVlad Yasevich case NETDEV_REBOOT: 13083d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_REBOOT; 13093d3ea5afSVlad Yasevich break; 13103d3ea5afSVlad Yasevich case NETDEV_FEAT_CHANGE: 13113d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_FEATURES; 13123d3ea5afSVlad Yasevich break; 13133d3ea5afSVlad Yasevich case NETDEV_BONDING_FAILOVER: 13143d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER; 13153d3ea5afSVlad Yasevich break; 13163d3ea5afSVlad Yasevich case NETDEV_NOTIFY_PEERS: 13173d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS; 13183d3ea5afSVlad Yasevich break; 13193d3ea5afSVlad Yasevich case NETDEV_RESEND_IGMP: 13203d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_IGMP_RESEND; 13213d3ea5afSVlad Yasevich break; 13223d3ea5afSVlad Yasevich case NETDEV_CHANGEINFODATA: 13233d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS; 13243d3ea5afSVlad Yasevich break; 13253d3ea5afSVlad Yasevich default: 13263d3ea5afSVlad Yasevich break; 13273d3ea5afSVlad Yasevich } 13283d3ea5afSVlad Yasevich 13293d3ea5afSVlad Yasevich return rtnl_event_type; 13303d3ea5afSVlad Yasevich } 13313d3ea5afSVlad Yasevich 133279110a04SFlorian Westphal static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev) 133379110a04SFlorian Westphal { 133479110a04SFlorian Westphal const struct net_device *upper_dev; 133579110a04SFlorian Westphal int ret = 0; 133679110a04SFlorian Westphal 133779110a04SFlorian Westphal rcu_read_lock(); 133879110a04SFlorian Westphal 133979110a04SFlorian Westphal upper_dev = netdev_master_upper_dev_get_rcu(dev); 134079110a04SFlorian Westphal if (upper_dev) 134179110a04SFlorian Westphal ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex); 134279110a04SFlorian Westphal 134379110a04SFlorian Westphal rcu_read_unlock(); 134479110a04SFlorian Westphal return ret; 134579110a04SFlorian Westphal } 134679110a04SFlorian Westphal 134779110a04SFlorian Westphal static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev) 134879110a04SFlorian Westphal { 134979110a04SFlorian Westphal int ifindex = dev_get_iflink(dev); 135079110a04SFlorian Westphal 135179110a04SFlorian Westphal if (dev->ifindex == ifindex) 135279110a04SFlorian Westphal return 0; 135379110a04SFlorian Westphal 135479110a04SFlorian Westphal return nla_put_u32(skb, IFLA_LINK, ifindex); 135579110a04SFlorian Westphal } 135679110a04SFlorian Westphal 13576c557001SFlorian Westphal static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb, 13586c557001SFlorian Westphal struct net_device *dev) 13596c557001SFlorian Westphal { 13606c557001SFlorian Westphal char buf[IFALIASZ]; 13616c557001SFlorian Westphal int ret; 13626c557001SFlorian Westphal 13636c557001SFlorian Westphal ret = dev_get_alias(dev, buf, sizeof(buf)); 13646c557001SFlorian Westphal return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0; 13656c557001SFlorian Westphal } 13666c557001SFlorian Westphal 1367b1e66b9aSFlorian Westphal static int rtnl_fill_link_netnsid(struct sk_buff *skb, 1368b1e66b9aSFlorian Westphal const struct net_device *dev) 1369b1e66b9aSFlorian Westphal { 1370b1e66b9aSFlorian Westphal if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) { 1371b1e66b9aSFlorian Westphal struct net *link_net = dev->rtnl_link_ops->get_link_net(dev); 1372b1e66b9aSFlorian Westphal 1373b1e66b9aSFlorian Westphal if (!net_eq(dev_net(dev), link_net)) { 1374b1e66b9aSFlorian Westphal int id = peernet2id_alloc(dev_net(dev), link_net); 1375b1e66b9aSFlorian Westphal 1376b1e66b9aSFlorian Westphal if (nla_put_s32(skb, IFLA_LINK_NETNSID, id)) 1377b1e66b9aSFlorian Westphal return -EMSGSIZE; 1378b1e66b9aSFlorian Westphal } 1379b1e66b9aSFlorian Westphal } 1380b1e66b9aSFlorian Westphal 1381b1e66b9aSFlorian Westphal return 0; 1382b1e66b9aSFlorian Westphal } 1383b1e66b9aSFlorian Westphal 1384b60c5115SThomas Graf static int rtnl_fill_ifinfo(struct sk_buff *skb, struct net_device *dev, 1385575c3e2aSPatrick McHardy int type, u32 pid, u32 seq, u32 change, 13863d3ea5afSVlad Yasevich unsigned int flags, u32 ext_filter_mask, 13873d3ea5afSVlad Yasevich u32 event) 1388b60c5115SThomas Graf { 1389b60c5115SThomas Graf struct ifinfomsg *ifm; 13901da177e4SLinus Torvalds struct nlmsghdr *nlh; 1391b22b941bSHannes Frederic Sowa struct nlattr *af_spec; 1392f8ff182cSThomas Graf struct rtnl_af_ops *af_ops; 13931da177e4SLinus Torvalds 13942907c35fSEric Dumazet ASSERT_RTNL(); 1395b60c5115SThomas Graf nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); 1396b60c5115SThomas Graf if (nlh == NULL) 139726932566SPatrick McHardy return -EMSGSIZE; 13981da177e4SLinus Torvalds 1399b60c5115SThomas Graf ifm = nlmsg_data(nlh); 1400b60c5115SThomas Graf ifm->ifi_family = AF_UNSPEC; 1401b60c5115SThomas Graf ifm->__ifi_pad = 0; 1402b60c5115SThomas Graf ifm->ifi_type = dev->type; 1403b60c5115SThomas Graf ifm->ifi_index = dev->ifindex; 1404b60c5115SThomas Graf ifm->ifi_flags = dev_get_flags(dev); 1405b60c5115SThomas Graf ifm->ifi_change = change; 14061da177e4SLinus Torvalds 1407a6574349SDavid S. Miller if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 1408a6574349SDavid S. Miller nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) || 1409a6574349SDavid S. Miller nla_put_u8(skb, IFLA_OPERSTATE, 1410a6574349SDavid S. Miller netif_running(dev) ? dev->operstate : IF_OPER_DOWN) || 1411a6574349SDavid S. Miller nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) || 1412a6574349SDavid S. Miller nla_put_u32(skb, IFLA_MTU, dev->mtu) || 1413a6574349SDavid S. Miller nla_put_u32(skb, IFLA_GROUP, dev->group) || 1414edbc0bb3SBen Greear nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) || 141576ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) || 1416c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) || 1417c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) || 14181d69c2b3SMark A. Greer #ifdef CONFIG_RPS 141976ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) || 14201d69c2b3SMark A. Greer #endif 142179110a04SFlorian Westphal nla_put_iflink(skb, dev) || 142279110a04SFlorian Westphal put_master_ifindex(skb, dev) || 14239a57247fSJiri Pirko nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) || 1424a6574349SDavid S. Miller (dev->qdisc && 1425a6574349SDavid S. Miller nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) || 14266c557001SFlorian Westphal nla_put_ifalias(skb, dev) || 14272d3b479dSdavid decotigny nla_put_u32(skb, IFLA_CARRIER_CHANGES, 142888d6378bSAnuradha Karuppiah atomic_read(&dev->carrier_changes)) || 142988d6378bSAnuradha Karuppiah nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down)) 1430a6574349SDavid S. Miller goto nla_put_failure; 14310b815a1aSStephen Hemminger 14323d3ea5afSVlad Yasevich if (event != IFLA_EVENT_NONE) { 14333d3ea5afSVlad Yasevich if (nla_put_u32(skb, IFLA_EVENT, event)) 14343d3ea5afSVlad Yasevich goto nla_put_failure; 14353d3ea5afSVlad Yasevich } 14363d3ea5afSVlad Yasevich 1437b22b941bSHannes Frederic Sowa if (rtnl_fill_link_ifmap(skb, dev)) 1438a6574349SDavid S. Miller goto nla_put_failure; 14391da177e4SLinus Torvalds 14401da177e4SLinus Torvalds if (dev->addr_len) { 1441a6574349SDavid S. Miller if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) || 1442a6574349SDavid S. Miller nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast)) 1443a6574349SDavid S. Miller goto nla_put_failure; 14441da177e4SLinus Torvalds } 14451da177e4SLinus Torvalds 144666cae9edSJiri Pirko if (rtnl_phys_port_id_fill(skb, dev)) 144766cae9edSJiri Pirko goto nla_put_failure; 144866cae9edSJiri Pirko 1449db24a904SDavid Ahern if (rtnl_phys_port_name_fill(skb, dev)) 1450db24a904SDavid Ahern goto nla_put_failure; 1451db24a904SDavid Ahern 145282f28412SJiri Pirko if (rtnl_phys_switch_id_fill(skb, dev)) 145382f28412SJiri Pirko goto nla_put_failure; 145482f28412SJiri Pirko 1455b22b941bSHannes Frederic Sowa if (rtnl_fill_stats(skb, dev)) 1456b60c5115SThomas Graf goto nla_put_failure; 1457b60c5115SThomas Graf 1458250fc3dfSFlorian Westphal if (rtnl_fill_vf(skb, dev, ext_filter_mask)) 1459a6574349SDavid S. Miller goto nla_put_failure; 146057b61080SScott Feldman 1461c53864fdSDavid Gibson if (rtnl_port_fill(skb, dev, ext_filter_mask)) 146257b61080SScott Feldman goto nla_put_failure; 146357b61080SScott Feldman 1464d1fdd913SBrenden Blanco if (rtnl_xdp_fill(skb, dev)) 1465d1fdd913SBrenden Blanco goto nla_put_failure; 1466d1fdd913SBrenden Blanco 1467ba7d49b1SJiri Pirko if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) { 146838f7b870SPatrick McHardy if (rtnl_link_fill(skb, dev) < 0) 146938f7b870SPatrick McHardy goto nla_put_failure; 147038f7b870SPatrick McHardy } 147138f7b870SPatrick McHardy 1472b1e66b9aSFlorian Westphal if (rtnl_fill_link_netnsid(skb, dev)) 1473d37512a2SNicolas Dichtel goto nla_put_failure; 1474d37512a2SNicolas Dichtel 1475f8ff182cSThomas Graf if (!(af_spec = nla_nest_start(skb, IFLA_AF_SPEC))) 1476f8ff182cSThomas Graf goto nla_put_failure; 1477f8ff182cSThomas Graf 1478f8ff182cSThomas Graf list_for_each_entry(af_ops, &rtnl_af_ops, list) { 1479f8ff182cSThomas Graf if (af_ops->fill_link_af) { 1480f8ff182cSThomas Graf struct nlattr *af; 1481f8ff182cSThomas Graf int err; 1482f8ff182cSThomas Graf 1483f8ff182cSThomas Graf if (!(af = nla_nest_start(skb, af_ops->family))) 1484f8ff182cSThomas Graf goto nla_put_failure; 1485f8ff182cSThomas Graf 1486d5566fd7SSowmini Varadhan err = af_ops->fill_link_af(skb, dev, ext_filter_mask); 1487f8ff182cSThomas Graf 1488f8ff182cSThomas Graf /* 1489f8ff182cSThomas Graf * Caller may return ENODATA to indicate that there 1490f8ff182cSThomas Graf * was no data to be dumped. This is not an error, it 1491f8ff182cSThomas Graf * means we should trim the attribute header and 1492f8ff182cSThomas Graf * continue. 1493f8ff182cSThomas Graf */ 1494f8ff182cSThomas Graf if (err == -ENODATA) 1495f8ff182cSThomas Graf nla_nest_cancel(skb, af); 1496f8ff182cSThomas Graf else if (err < 0) 1497f8ff182cSThomas Graf goto nla_put_failure; 1498f8ff182cSThomas Graf 1499f8ff182cSThomas Graf nla_nest_end(skb, af); 1500f8ff182cSThomas Graf } 1501f8ff182cSThomas Graf } 1502f8ff182cSThomas Graf 1503f8ff182cSThomas Graf nla_nest_end(skb, af_spec); 1504f8ff182cSThomas Graf 1505053c095aSJohannes Berg nlmsg_end(skb, nlh); 1506053c095aSJohannes Berg return 0; 1507b60c5115SThomas Graf 1508b60c5115SThomas Graf nla_put_failure: 150926932566SPatrick McHardy nlmsg_cancel(skb, nlh); 151026932566SPatrick McHardy return -EMSGSIZE; 15111da177e4SLinus Torvalds } 15121da177e4SLinus Torvalds 1513f7b12606SJiri Pirko static const struct nla_policy ifla_policy[IFLA_MAX+1] = { 1514f7b12606SJiri Pirko [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, 1515f7b12606SJiri Pirko [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1516f7b12606SJiri Pirko [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1517f7b12606SJiri Pirko [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, 1518f7b12606SJiri Pirko [IFLA_MTU] = { .type = NLA_U32 }, 1519f7b12606SJiri Pirko [IFLA_LINK] = { .type = NLA_U32 }, 1520f7b12606SJiri Pirko [IFLA_MASTER] = { .type = NLA_U32 }, 1521f7b12606SJiri Pirko [IFLA_CARRIER] = { .type = NLA_U8 }, 1522f7b12606SJiri Pirko [IFLA_TXQLEN] = { .type = NLA_U32 }, 1523f7b12606SJiri Pirko [IFLA_WEIGHT] = { .type = NLA_U32 }, 1524f7b12606SJiri Pirko [IFLA_OPERSTATE] = { .type = NLA_U8 }, 1525f7b12606SJiri Pirko [IFLA_LINKMODE] = { .type = NLA_U8 }, 1526f7b12606SJiri Pirko [IFLA_LINKINFO] = { .type = NLA_NESTED }, 1527f7b12606SJiri Pirko [IFLA_NET_NS_PID] = { .type = NLA_U32 }, 1528f7b12606SJiri Pirko [IFLA_NET_NS_FD] = { .type = NLA_U32 }, 1529f7b12606SJiri Pirko [IFLA_IFALIAS] = { .type = NLA_STRING, .len = IFALIASZ-1 }, 1530f7b12606SJiri Pirko [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, 1531f7b12606SJiri Pirko [IFLA_VF_PORTS] = { .type = NLA_NESTED }, 1532f7b12606SJiri Pirko [IFLA_PORT_SELF] = { .type = NLA_NESTED }, 1533f7b12606SJiri Pirko [IFLA_AF_SPEC] = { .type = NLA_NESTED }, 1534f7b12606SJiri Pirko [IFLA_EXT_MASK] = { .type = NLA_U32 }, 1535f7b12606SJiri Pirko [IFLA_PROMISCUITY] = { .type = NLA_U32 }, 1536f7b12606SJiri Pirko [IFLA_NUM_TX_QUEUES] = { .type = NLA_U32 }, 1537f7b12606SJiri Pirko [IFLA_NUM_RX_QUEUES] = { .type = NLA_U32 }, 153802637fceSJiri Pirko [IFLA_PHYS_PORT_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 15392d3b479dSdavid decotigny [IFLA_CARRIER_CHANGES] = { .type = NLA_U32 }, /* ignored */ 154082f28412SJiri Pirko [IFLA_PHYS_SWITCH_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 1541317f4810SNicolas Dichtel [IFLA_LINK_NETNSID] = { .type = NLA_S32 }, 154288d6378bSAnuradha Karuppiah [IFLA_PROTO_DOWN] = { .type = NLA_U8 }, 1543d1fdd913SBrenden Blanco [IFLA_XDP] = { .type = NLA_NESTED }, 15443d3ea5afSVlad Yasevich [IFLA_EVENT] = { .type = NLA_U32 }, 1545db833d40SSerhey Popovych [IFLA_GROUP] = { .type = NLA_U32 }, 1546f7b12606SJiri Pirko }; 1547f7b12606SJiri Pirko 1548f7b12606SJiri Pirko static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { 1549f7b12606SJiri Pirko [IFLA_INFO_KIND] = { .type = NLA_STRING }, 1550f7b12606SJiri Pirko [IFLA_INFO_DATA] = { .type = NLA_NESTED }, 1551f7b12606SJiri Pirko [IFLA_INFO_SLAVE_KIND] = { .type = NLA_STRING }, 1552f7b12606SJiri Pirko [IFLA_INFO_SLAVE_DATA] = { .type = NLA_NESTED }, 1553f7b12606SJiri Pirko }; 1554f7b12606SJiri Pirko 1555f7b12606SJiri Pirko static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { 1556364d5716SDaniel Borkmann [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) }, 1557364d5716SDaniel Borkmann [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) }, 155879aab093SMoshe Shemesh [IFLA_VF_VLAN_LIST] = { .type = NLA_NESTED }, 1559364d5716SDaniel Borkmann [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) }, 1560364d5716SDaniel Borkmann [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) }, 1561364d5716SDaniel Borkmann [IFLA_VF_RATE] = { .len = sizeof(struct ifla_vf_rate) }, 1562364d5716SDaniel Borkmann [IFLA_VF_LINK_STATE] = { .len = sizeof(struct ifla_vf_link_state) }, 156301a3d796SVlad Zolotarov [IFLA_VF_RSS_QUERY_EN] = { .len = sizeof(struct ifla_vf_rss_query_en) }, 15643b766cd8SEran Ben Elisha [IFLA_VF_STATS] = { .type = NLA_NESTED }, 1565dd461d6aSHiroshi Shimamoto [IFLA_VF_TRUST] = { .len = sizeof(struct ifla_vf_trust) }, 1566cc8e27ccSEli Cohen [IFLA_VF_IB_NODE_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 1567cc8e27ccSEli Cohen [IFLA_VF_IB_PORT_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 15683b766cd8SEran Ben Elisha }; 15693b766cd8SEran Ben Elisha 1570f7b12606SJiri Pirko static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { 1571f7b12606SJiri Pirko [IFLA_PORT_VF] = { .type = NLA_U32 }, 1572f7b12606SJiri Pirko [IFLA_PORT_PROFILE] = { .type = NLA_STRING, 1573f7b12606SJiri Pirko .len = PORT_PROFILE_MAX }, 1574f7b12606SJiri Pirko [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, 1575f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1576f7b12606SJiri Pirko [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, 1577f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1578f7b12606SJiri Pirko [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, 1579f7b12606SJiri Pirko [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, 1580025331dfSDaniel Borkmann 1581025331dfSDaniel Borkmann /* Unused, but we need to keep it here since user space could 1582025331dfSDaniel Borkmann * fill it. It's also broken with regard to NLA_BINARY use in 1583025331dfSDaniel Borkmann * combination with structs. 1584025331dfSDaniel Borkmann */ 1585025331dfSDaniel Borkmann [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, 1586025331dfSDaniel Borkmann .len = sizeof(struct ifla_port_vsi) }, 1587f7b12606SJiri Pirko }; 1588f7b12606SJiri Pirko 1589d1fdd913SBrenden Blanco static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = { 1590d1fdd913SBrenden Blanco [IFLA_XDP_FD] = { .type = NLA_S32 }, 1591d1fdd913SBrenden Blanco [IFLA_XDP_ATTACHED] = { .type = NLA_U8 }, 159285de8576SDaniel Borkmann [IFLA_XDP_FLAGS] = { .type = NLA_U32 }, 159358038695SMartin KaFai Lau [IFLA_XDP_PROG_ID] = { .type = NLA_U32 }, 1594d1fdd913SBrenden Blanco }; 1595d1fdd913SBrenden Blanco 1596dc599f76SDavid Ahern static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla) 1597dc599f76SDavid Ahern { 1598dc599f76SDavid Ahern const struct rtnl_link_ops *ops = NULL; 1599dc599f76SDavid Ahern struct nlattr *linfo[IFLA_INFO_MAX + 1]; 1600dc599f76SDavid Ahern 1601fceb6435SJohannes Berg if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla, 1602fceb6435SJohannes Berg ifla_info_policy, NULL) < 0) 1603dc599f76SDavid Ahern return NULL; 1604dc599f76SDavid Ahern 1605dc599f76SDavid Ahern if (linfo[IFLA_INFO_KIND]) { 1606dc599f76SDavid Ahern char kind[MODULE_NAME_LEN]; 1607dc599f76SDavid Ahern 1608dc599f76SDavid Ahern nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind)); 1609dc599f76SDavid Ahern ops = rtnl_link_ops_get(kind); 1610dc599f76SDavid Ahern } 1611dc599f76SDavid Ahern 1612dc599f76SDavid Ahern return ops; 1613dc599f76SDavid Ahern } 1614dc599f76SDavid Ahern 1615dc599f76SDavid Ahern static bool link_master_filtered(struct net_device *dev, int master_idx) 1616dc599f76SDavid Ahern { 1617dc599f76SDavid Ahern struct net_device *master; 1618dc599f76SDavid Ahern 1619dc599f76SDavid Ahern if (!master_idx) 1620dc599f76SDavid Ahern return false; 1621dc599f76SDavid Ahern 1622dc599f76SDavid Ahern master = netdev_master_upper_dev_get(dev); 1623dc599f76SDavid Ahern if (!master || master->ifindex != master_idx) 1624dc599f76SDavid Ahern return true; 1625dc599f76SDavid Ahern 1626dc599f76SDavid Ahern return false; 1627dc599f76SDavid Ahern } 1628dc599f76SDavid Ahern 1629dc599f76SDavid Ahern static bool link_kind_filtered(const struct net_device *dev, 1630dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1631dc599f76SDavid Ahern { 1632dc599f76SDavid Ahern if (kind_ops && dev->rtnl_link_ops != kind_ops) 1633dc599f76SDavid Ahern return true; 1634dc599f76SDavid Ahern 1635dc599f76SDavid Ahern return false; 1636dc599f76SDavid Ahern } 1637dc599f76SDavid Ahern 1638dc599f76SDavid Ahern static bool link_dump_filtered(struct net_device *dev, 1639dc599f76SDavid Ahern int master_idx, 1640dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1641dc599f76SDavid Ahern { 1642dc599f76SDavid Ahern if (link_master_filtered(dev, master_idx) || 1643dc599f76SDavid Ahern link_kind_filtered(dev, kind_ops)) 1644dc599f76SDavid Ahern return true; 1645dc599f76SDavid Ahern 1646dc599f76SDavid Ahern return false; 1647dc599f76SDavid Ahern } 1648dc599f76SDavid Ahern 1649b60c5115SThomas Graf static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) 16501da177e4SLinus Torvalds { 16513b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 16527c28bd0bSEric Dumazet int h, s_h; 16537c28bd0bSEric Dumazet int idx = 0, s_idx; 16541da177e4SLinus Torvalds struct net_device *dev; 16557c28bd0bSEric Dumazet struct hlist_head *head; 1656115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 1657115c9b81SGreg Rose u32 ext_filter_mask = 0; 1658dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops = NULL; 1659dc599f76SDavid Ahern unsigned int flags = NLM_F_MULTI; 1660dc599f76SDavid Ahern int master_idx = 0; 1661973462bbSDavid Gibson int err; 1662e5eca6d4SMichal Schmidt int hdrlen; 16631da177e4SLinus Torvalds 16647c28bd0bSEric Dumazet s_h = cb->args[0]; 16657c28bd0bSEric Dumazet s_idx = cb->args[1]; 16667c28bd0bSEric Dumazet 1667e5eca6d4SMichal Schmidt /* A hack to preserve kernel<->userspace interface. 1668e5eca6d4SMichal Schmidt * The correct header is ifinfomsg. It is consistent with rtnl_getlink. 1669e5eca6d4SMichal Schmidt * However, before Linux v3.9 the code here assumed rtgenmsg and that's 1670e5eca6d4SMichal Schmidt * what iproute2 < v3.9.0 used. 1671e5eca6d4SMichal Schmidt * We can detect the old iproute2. Even including the IFLA_EXT_MASK 1672e5eca6d4SMichal Schmidt * attribute, its netlink message is shorter than struct ifinfomsg. 1673e5eca6d4SMichal Schmidt */ 1674e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ? 1675e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 1676e5eca6d4SMichal Schmidt 1677fceb6435SJohannes Berg if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX, 1678fceb6435SJohannes Berg ifla_policy, NULL) >= 0) { 1679115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 1680115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 1681dc599f76SDavid Ahern 1682dc599f76SDavid Ahern if (tb[IFLA_MASTER]) 1683dc599f76SDavid Ahern master_idx = nla_get_u32(tb[IFLA_MASTER]); 1684dc599f76SDavid Ahern 1685dc599f76SDavid Ahern if (tb[IFLA_LINKINFO]) 1686dc599f76SDavid Ahern kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]); 1687dc599f76SDavid Ahern 1688dc599f76SDavid Ahern if (master_idx || kind_ops) 1689dc599f76SDavid Ahern flags |= NLM_F_DUMP_FILTERED; 1690a4b64fbeSEric Dumazet } 1691115c9b81SGreg Rose 16927c28bd0bSEric Dumazet for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 16937562f876SPavel Emelianov idx = 0; 16947c28bd0bSEric Dumazet head = &net->dev_index_head[h]; 1695cac5e65eSEric Dumazet hlist_for_each_entry(dev, head, index_hlist) { 1696dc599f76SDavid Ahern if (link_dump_filtered(dev, master_idx, kind_ops)) 16973f0ae05dSZhang Shengju goto cont; 16981da177e4SLinus Torvalds if (idx < s_idx) 16997562f876SPavel Emelianov goto cont; 1700973462bbSDavid Gibson err = rtnl_fill_ifinfo(skb, dev, RTM_NEWLINK, 170115e47304SEric W. Biederman NETLINK_CB(cb->skb).portid, 17027c28bd0bSEric Dumazet cb->nlh->nlmsg_seq, 0, 1703dc599f76SDavid Ahern flags, 17043d3ea5afSVlad Yasevich ext_filter_mask, 0); 1705973462bbSDavid Gibson 1706f6c5775fSDavid Ahern if (err < 0) { 1707f6c5775fSDavid Ahern if (likely(skb->len)) 17087c28bd0bSEric Dumazet goto out; 17094e985adaSThomas Graf 1710f6c5775fSDavid Ahern goto out_err; 1711f6c5775fSDavid Ahern } 17127562f876SPavel Emelianov cont: 17137562f876SPavel Emelianov idx++; 17141da177e4SLinus Torvalds } 17157c28bd0bSEric Dumazet } 17167c28bd0bSEric Dumazet out: 1717f6c5775fSDavid Ahern err = skb->len; 1718f6c5775fSDavid Ahern out_err: 17197c28bd0bSEric Dumazet cb->args[1] = idx; 17207c28bd0bSEric Dumazet cb->args[0] = h; 1721d0225784SJakub Sitnicki cb->seq = net->dev_base_seq; 1722d0225784SJakub Sitnicki nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 17231da177e4SLinus Torvalds 1724f6c5775fSDavid Ahern return err; 17251da177e4SLinus Torvalds } 17261da177e4SLinus Torvalds 1727fceb6435SJohannes Berg int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len, 1728fceb6435SJohannes Berg struct netlink_ext_ack *exterr) 1729f7b12606SJiri Pirko { 1730fceb6435SJohannes Berg return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr); 1731f7b12606SJiri Pirko } 1732f7b12606SJiri Pirko EXPORT_SYMBOL(rtnl_nla_parse_ifla); 173357b61080SScott Feldman 173481adee47SEric W. Biederman struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) 173581adee47SEric W. Biederman { 173681adee47SEric W. Biederman struct net *net; 173781adee47SEric W. Biederman /* Examine the link attributes and figure out which 173881adee47SEric W. Biederman * network namespace we are talking about. 173981adee47SEric W. Biederman */ 174081adee47SEric W. Biederman if (tb[IFLA_NET_NS_PID]) 174181adee47SEric W. Biederman net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); 1742f0630529SEric W. Biederman else if (tb[IFLA_NET_NS_FD]) 1743f0630529SEric W. Biederman net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD])); 174481adee47SEric W. Biederman else 174581adee47SEric W. Biederman net = get_net(src_net); 174681adee47SEric W. Biederman return net; 174781adee47SEric W. Biederman } 174881adee47SEric W. Biederman EXPORT_SYMBOL(rtnl_link_get_net); 174981adee47SEric W. Biederman 17501840bb13SThomas Graf static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) 17511840bb13SThomas Graf { 17521840bb13SThomas Graf if (dev) { 17531840bb13SThomas Graf if (tb[IFLA_ADDRESS] && 17541840bb13SThomas Graf nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) 17551840bb13SThomas Graf return -EINVAL; 17561840bb13SThomas Graf 17571840bb13SThomas Graf if (tb[IFLA_BROADCAST] && 17581840bb13SThomas Graf nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) 17591840bb13SThomas Graf return -EINVAL; 17601840bb13SThomas Graf } 17611840bb13SThomas Graf 1762cf7afbfeSThomas Graf if (tb[IFLA_AF_SPEC]) { 1763cf7afbfeSThomas Graf struct nlattr *af; 1764cf7afbfeSThomas Graf int rem, err; 1765cf7afbfeSThomas Graf 1766cf7afbfeSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 1767cf7afbfeSThomas Graf const struct rtnl_af_ops *af_ops; 1768cf7afbfeSThomas Graf 1769cf7afbfeSThomas Graf if (!(af_ops = rtnl_af_lookup(nla_type(af)))) 1770cf7afbfeSThomas Graf return -EAFNOSUPPORT; 1771cf7afbfeSThomas Graf 1772cf7afbfeSThomas Graf if (!af_ops->set_link_af) 1773cf7afbfeSThomas Graf return -EOPNOTSUPP; 1774cf7afbfeSThomas Graf 1775cf7afbfeSThomas Graf if (af_ops->validate_link_af) { 17766d3a9a68SKurt Van Dijck err = af_ops->validate_link_af(dev, af); 1777cf7afbfeSThomas Graf if (err < 0) 1778cf7afbfeSThomas Graf return err; 1779cf7afbfeSThomas Graf } 1780cf7afbfeSThomas Graf } 1781cf7afbfeSThomas Graf } 1782cf7afbfeSThomas Graf 17831840bb13SThomas Graf return 0; 17841840bb13SThomas Graf } 17851840bb13SThomas Graf 1786cc8e27ccSEli Cohen static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt, 1787cc8e27ccSEli Cohen int guid_type) 1788cc8e27ccSEli Cohen { 1789cc8e27ccSEli Cohen const struct net_device_ops *ops = dev->netdev_ops; 1790cc8e27ccSEli Cohen 1791cc8e27ccSEli Cohen return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type); 1792cc8e27ccSEli Cohen } 1793cc8e27ccSEli Cohen 1794cc8e27ccSEli Cohen static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type) 1795cc8e27ccSEli Cohen { 1796cc8e27ccSEli Cohen if (dev->type != ARPHRD_INFINIBAND) 1797cc8e27ccSEli Cohen return -EOPNOTSUPP; 1798cc8e27ccSEli Cohen 1799cc8e27ccSEli Cohen return handle_infiniband_guid(dev, ivt, guid_type); 1800cc8e27ccSEli Cohen } 1801cc8e27ccSEli Cohen 18024f7d2cdfSDaniel Borkmann static int do_setvfinfo(struct net_device *dev, struct nlattr **tb) 1803c02db8c6SChris Wright { 1804c02db8c6SChris Wright const struct net_device_ops *ops = dev->netdev_ops; 18054f7d2cdfSDaniel Borkmann int err = -EINVAL; 1806c02db8c6SChris Wright 18074f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_MAC]) { 18084f7d2cdfSDaniel Borkmann struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]); 18094f7d2cdfSDaniel Borkmann 1810c02db8c6SChris Wright err = -EOPNOTSUPP; 1811c02db8c6SChris Wright if (ops->ndo_set_vf_mac) 1812c02db8c6SChris Wright err = ops->ndo_set_vf_mac(dev, ivm->vf, 1813c02db8c6SChris Wright ivm->mac); 18144f7d2cdfSDaniel Borkmann if (err < 0) 18154f7d2cdfSDaniel Borkmann return err; 1816c02db8c6SChris Wright } 18174f7d2cdfSDaniel Borkmann 18184f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_VLAN]) { 18194f7d2cdfSDaniel Borkmann struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]); 18204f7d2cdfSDaniel Borkmann 1821c02db8c6SChris Wright err = -EOPNOTSUPP; 1822c02db8c6SChris Wright if (ops->ndo_set_vf_vlan) 18234f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan, 182479aab093SMoshe Shemesh ivv->qos, 182579aab093SMoshe Shemesh htons(ETH_P_8021Q)); 182679aab093SMoshe Shemesh if (err < 0) 182779aab093SMoshe Shemesh return err; 182879aab093SMoshe Shemesh } 182979aab093SMoshe Shemesh 183079aab093SMoshe Shemesh if (tb[IFLA_VF_VLAN_LIST]) { 183179aab093SMoshe Shemesh struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN]; 183279aab093SMoshe Shemesh struct nlattr *attr; 183379aab093SMoshe Shemesh int rem, len = 0; 183479aab093SMoshe Shemesh 183579aab093SMoshe Shemesh err = -EOPNOTSUPP; 183679aab093SMoshe Shemesh if (!ops->ndo_set_vf_vlan) 183779aab093SMoshe Shemesh return err; 183879aab093SMoshe Shemesh 183979aab093SMoshe Shemesh nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) { 184079aab093SMoshe Shemesh if (nla_type(attr) != IFLA_VF_VLAN_INFO || 184179aab093SMoshe Shemesh nla_len(attr) < NLA_HDRLEN) { 184279aab093SMoshe Shemesh return -EINVAL; 184379aab093SMoshe Shemesh } 184479aab093SMoshe Shemesh if (len >= MAX_VLAN_LIST_LEN) 184579aab093SMoshe Shemesh return -EOPNOTSUPP; 184679aab093SMoshe Shemesh ivvl[len] = nla_data(attr); 184779aab093SMoshe Shemesh 184879aab093SMoshe Shemesh len++; 184979aab093SMoshe Shemesh } 1850fa34cd94SArnd Bergmann if (len == 0) 1851fa34cd94SArnd Bergmann return -EINVAL; 1852fa34cd94SArnd Bergmann 185379aab093SMoshe Shemesh err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan, 185479aab093SMoshe Shemesh ivvl[0]->qos, ivvl[0]->vlan_proto); 18554f7d2cdfSDaniel Borkmann if (err < 0) 18564f7d2cdfSDaniel Borkmann return err; 1857c02db8c6SChris Wright } 18584f7d2cdfSDaniel Borkmann 18594f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_TX_RATE]) { 18604f7d2cdfSDaniel Borkmann struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]); 1861ed616689SSucheta Chakraborty struct ifla_vf_info ivf; 18624f7d2cdfSDaniel Borkmann 1863c02db8c6SChris Wright err = -EOPNOTSUPP; 1864ed616689SSucheta Chakraborty if (ops->ndo_get_vf_config) 18654f7d2cdfSDaniel Borkmann err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf); 18664f7d2cdfSDaniel Borkmann if (err < 0) 18674f7d2cdfSDaniel Borkmann return err; 18684f7d2cdfSDaniel Borkmann 1869ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 1870ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 1871ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 1872ed616689SSucheta Chakraborty ivf.min_tx_rate, 1873c02db8c6SChris Wright ivt->rate); 18744f7d2cdfSDaniel Borkmann if (err < 0) 18754f7d2cdfSDaniel Borkmann return err; 1876c02db8c6SChris Wright } 18774f7d2cdfSDaniel Borkmann 18784f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RATE]) { 18794f7d2cdfSDaniel Borkmann struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]); 18804f7d2cdfSDaniel Borkmann 1881ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 1882ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 1883ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 1884ed616689SSucheta Chakraborty ivt->min_tx_rate, 1885ed616689SSucheta Chakraborty ivt->max_tx_rate); 18864f7d2cdfSDaniel Borkmann if (err < 0) 18874f7d2cdfSDaniel Borkmann return err; 1888ed616689SSucheta Chakraborty } 18894f7d2cdfSDaniel Borkmann 18904f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_SPOOFCHK]) { 18914f7d2cdfSDaniel Borkmann struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]); 18924f7d2cdfSDaniel Borkmann 18935f8444a3SGreg Rose err = -EOPNOTSUPP; 18945f8444a3SGreg Rose if (ops->ndo_set_vf_spoofchk) 18955f8444a3SGreg Rose err = ops->ndo_set_vf_spoofchk(dev, ivs->vf, 18965f8444a3SGreg Rose ivs->setting); 18974f7d2cdfSDaniel Borkmann if (err < 0) 18984f7d2cdfSDaniel Borkmann return err; 18995f8444a3SGreg Rose } 19004f7d2cdfSDaniel Borkmann 19014f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_LINK_STATE]) { 19024f7d2cdfSDaniel Borkmann struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]); 19034f7d2cdfSDaniel Borkmann 19041d8faf48SRony Efraim err = -EOPNOTSUPP; 19051d8faf48SRony Efraim if (ops->ndo_set_vf_link_state) 19061d8faf48SRony Efraim err = ops->ndo_set_vf_link_state(dev, ivl->vf, 19071d8faf48SRony Efraim ivl->link_state); 19084f7d2cdfSDaniel Borkmann if (err < 0) 19094f7d2cdfSDaniel Borkmann return err; 19101d8faf48SRony Efraim } 19114f7d2cdfSDaniel Borkmann 19124f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RSS_QUERY_EN]) { 191301a3d796SVlad Zolotarov struct ifla_vf_rss_query_en *ivrssq_en; 191401a3d796SVlad Zolotarov 191501a3d796SVlad Zolotarov err = -EOPNOTSUPP; 19164f7d2cdfSDaniel Borkmann ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]); 191701a3d796SVlad Zolotarov if (ops->ndo_set_vf_rss_query_en) 19184f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf, 191901a3d796SVlad Zolotarov ivrssq_en->setting); 19204f7d2cdfSDaniel Borkmann if (err < 0) 19214f7d2cdfSDaniel Borkmann return err; 192201a3d796SVlad Zolotarov } 19234f7d2cdfSDaniel Borkmann 1924dd461d6aSHiroshi Shimamoto if (tb[IFLA_VF_TRUST]) { 1925dd461d6aSHiroshi Shimamoto struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]); 1926dd461d6aSHiroshi Shimamoto 1927dd461d6aSHiroshi Shimamoto err = -EOPNOTSUPP; 1928dd461d6aSHiroshi Shimamoto if (ops->ndo_set_vf_trust) 1929dd461d6aSHiroshi Shimamoto err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting); 1930dd461d6aSHiroshi Shimamoto if (err < 0) 1931dd461d6aSHiroshi Shimamoto return err; 1932dd461d6aSHiroshi Shimamoto } 1933dd461d6aSHiroshi Shimamoto 1934cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_NODE_GUID]) { 1935cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]); 1936cc8e27ccSEli Cohen 1937cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 1938cc8e27ccSEli Cohen return -EOPNOTSUPP; 1939cc8e27ccSEli Cohen 1940cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID); 1941cc8e27ccSEli Cohen } 1942cc8e27ccSEli Cohen 1943cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_PORT_GUID]) { 1944cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]); 1945cc8e27ccSEli Cohen 1946cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 1947cc8e27ccSEli Cohen return -EOPNOTSUPP; 1948cc8e27ccSEli Cohen 1949cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID); 1950cc8e27ccSEli Cohen } 1951cc8e27ccSEli Cohen 1952c02db8c6SChris Wright return err; 1953c02db8c6SChris Wright } 1954c02db8c6SChris Wright 1955fbaec0eaSJiri Pirko static int do_set_master(struct net_device *dev, int ifindex) 1956fbaec0eaSJiri Pirko { 1957898e5061SJiri Pirko struct net_device *upper_dev = netdev_master_upper_dev_get(dev); 1958fbaec0eaSJiri Pirko const struct net_device_ops *ops; 1959fbaec0eaSJiri Pirko int err; 1960fbaec0eaSJiri Pirko 1961898e5061SJiri Pirko if (upper_dev) { 1962898e5061SJiri Pirko if (upper_dev->ifindex == ifindex) 1963fbaec0eaSJiri Pirko return 0; 1964898e5061SJiri Pirko ops = upper_dev->netdev_ops; 1965fbaec0eaSJiri Pirko if (ops->ndo_del_slave) { 1966898e5061SJiri Pirko err = ops->ndo_del_slave(upper_dev, dev); 1967fbaec0eaSJiri Pirko if (err) 1968fbaec0eaSJiri Pirko return err; 1969fbaec0eaSJiri Pirko } else { 1970fbaec0eaSJiri Pirko return -EOPNOTSUPP; 1971fbaec0eaSJiri Pirko } 1972fbaec0eaSJiri Pirko } 1973fbaec0eaSJiri Pirko 1974fbaec0eaSJiri Pirko if (ifindex) { 1975898e5061SJiri Pirko upper_dev = __dev_get_by_index(dev_net(dev), ifindex); 1976898e5061SJiri Pirko if (!upper_dev) 1977fbaec0eaSJiri Pirko return -EINVAL; 1978898e5061SJiri Pirko ops = upper_dev->netdev_ops; 1979fbaec0eaSJiri Pirko if (ops->ndo_add_slave) { 1980898e5061SJiri Pirko err = ops->ndo_add_slave(upper_dev, dev); 1981fbaec0eaSJiri Pirko if (err) 1982fbaec0eaSJiri Pirko return err; 1983fbaec0eaSJiri Pirko } else { 1984fbaec0eaSJiri Pirko return -EOPNOTSUPP; 1985fbaec0eaSJiri Pirko } 1986fbaec0eaSJiri Pirko } 1987fbaec0eaSJiri Pirko return 0; 1988fbaec0eaSJiri Pirko } 1989fbaec0eaSJiri Pirko 199090c325e3SNicolas Dichtel #define DO_SETLINK_MODIFIED 0x01 1991ba998906SNicolas Dichtel /* notify flag means notify + modified. */ 1992ba998906SNicolas Dichtel #define DO_SETLINK_NOTIFY 0x03 199390f62cf3SEric W. Biederman static int do_setlink(const struct sk_buff *skb, 199490f62cf3SEric W. Biederman struct net_device *dev, struct ifinfomsg *ifm, 1995ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 199690c325e3SNicolas Dichtel struct nlattr **tb, char *ifname, int status) 19970157f60cSPatrick McHardy { 1998d314774cSStephen Hemminger const struct net_device_ops *ops = dev->netdev_ops; 19990157f60cSPatrick McHardy int err; 20000157f60cSPatrick McHardy 2001f0630529SEric W. Biederman if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) { 200281adee47SEric W. Biederman struct net *net = rtnl_link_get_net(dev_net(dev), tb); 2003d8a5ec67SEric W. Biederman if (IS_ERR(net)) { 2004d8a5ec67SEric W. Biederman err = PTR_ERR(net); 2005d8a5ec67SEric W. Biederman goto errout; 2006d8a5ec67SEric W. Biederman } 200790f62cf3SEric W. Biederman if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) { 2008e0ebde0eSNicolas Dichtel put_net(net); 2009b51642f6SEric W. Biederman err = -EPERM; 2010b51642f6SEric W. Biederman goto errout; 2011b51642f6SEric W. Biederman } 2012d8a5ec67SEric W. Biederman err = dev_change_net_namespace(dev, net, ifname); 2013d8a5ec67SEric W. Biederman put_net(net); 2014d8a5ec67SEric W. Biederman if (err) 2015d8a5ec67SEric W. Biederman goto errout; 201690c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 2017d8a5ec67SEric W. Biederman } 2018d8a5ec67SEric W. Biederman 20190157f60cSPatrick McHardy if (tb[IFLA_MAP]) { 20200157f60cSPatrick McHardy struct rtnl_link_ifmap *u_map; 20210157f60cSPatrick McHardy struct ifmap k_map; 20220157f60cSPatrick McHardy 2023d314774cSStephen Hemminger if (!ops->ndo_set_config) { 20240157f60cSPatrick McHardy err = -EOPNOTSUPP; 20250157f60cSPatrick McHardy goto errout; 20260157f60cSPatrick McHardy } 20270157f60cSPatrick McHardy 20280157f60cSPatrick McHardy if (!netif_device_present(dev)) { 20290157f60cSPatrick McHardy err = -ENODEV; 20300157f60cSPatrick McHardy goto errout; 20310157f60cSPatrick McHardy } 20320157f60cSPatrick McHardy 20330157f60cSPatrick McHardy u_map = nla_data(tb[IFLA_MAP]); 20340157f60cSPatrick McHardy k_map.mem_start = (unsigned long) u_map->mem_start; 20350157f60cSPatrick McHardy k_map.mem_end = (unsigned long) u_map->mem_end; 20360157f60cSPatrick McHardy k_map.base_addr = (unsigned short) u_map->base_addr; 20370157f60cSPatrick McHardy k_map.irq = (unsigned char) u_map->irq; 20380157f60cSPatrick McHardy k_map.dma = (unsigned char) u_map->dma; 20390157f60cSPatrick McHardy k_map.port = (unsigned char) u_map->port; 20400157f60cSPatrick McHardy 2041d314774cSStephen Hemminger err = ops->ndo_set_config(dev, &k_map); 20420157f60cSPatrick McHardy if (err < 0) 20430157f60cSPatrick McHardy goto errout; 20440157f60cSPatrick McHardy 2045ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 20460157f60cSPatrick McHardy } 20470157f60cSPatrick McHardy 20480157f60cSPatrick McHardy if (tb[IFLA_ADDRESS]) { 20490157f60cSPatrick McHardy struct sockaddr *sa; 20500157f60cSPatrick McHardy int len; 20510157f60cSPatrick McHardy 2052153711f9SWANG Cong len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len, 2053153711f9SWANG Cong sizeof(*sa)); 20540157f60cSPatrick McHardy sa = kmalloc(len, GFP_KERNEL); 20550157f60cSPatrick McHardy if (!sa) { 20560157f60cSPatrick McHardy err = -ENOMEM; 20570157f60cSPatrick McHardy goto errout; 20580157f60cSPatrick McHardy } 20590157f60cSPatrick McHardy sa->sa_family = dev->type; 20600157f60cSPatrick McHardy memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), 20610157f60cSPatrick McHardy dev->addr_len); 2062e7c3273eSJiri Pirko err = dev_set_mac_address(dev, sa); 20630157f60cSPatrick McHardy kfree(sa); 20640157f60cSPatrick McHardy if (err) 20650157f60cSPatrick McHardy goto errout; 206690c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20670157f60cSPatrick McHardy } 20680157f60cSPatrick McHardy 20690157f60cSPatrick McHardy if (tb[IFLA_MTU]) { 20700157f60cSPatrick McHardy err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU])); 20710157f60cSPatrick McHardy if (err < 0) 20720157f60cSPatrick McHardy goto errout; 207390c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20740157f60cSPatrick McHardy } 20750157f60cSPatrick McHardy 2076cbda10faSVlad Dogaru if (tb[IFLA_GROUP]) { 2077cbda10faSVlad Dogaru dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2078ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2079cbda10faSVlad Dogaru } 2080cbda10faSVlad Dogaru 20810157f60cSPatrick McHardy /* 20820157f60cSPatrick McHardy * Interface selected by interface index but interface 20830157f60cSPatrick McHardy * name provided implies that a name change has been 20840157f60cSPatrick McHardy * requested. 20850157f60cSPatrick McHardy */ 20860157f60cSPatrick McHardy if (ifm->ifi_index > 0 && ifname[0]) { 20870157f60cSPatrick McHardy err = dev_change_name(dev, ifname); 20880157f60cSPatrick McHardy if (err < 0) 20890157f60cSPatrick McHardy goto errout; 209090c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20910157f60cSPatrick McHardy } 20920157f60cSPatrick McHardy 20930b815a1aSStephen Hemminger if (tb[IFLA_IFALIAS]) { 20940b815a1aSStephen Hemminger err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), 20950b815a1aSStephen Hemminger nla_len(tb[IFLA_IFALIAS])); 20960b815a1aSStephen Hemminger if (err < 0) 20970b815a1aSStephen Hemminger goto errout; 2098ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 20990b815a1aSStephen Hemminger } 21000b815a1aSStephen Hemminger 21010157f60cSPatrick McHardy if (tb[IFLA_BROADCAST]) { 21020157f60cSPatrick McHardy nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); 2103e7c3273eSJiri Pirko call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); 21040157f60cSPatrick McHardy } 21050157f60cSPatrick McHardy 21060157f60cSPatrick McHardy if (ifm->ifi_flags || ifm->ifi_change) { 21073729d502SPatrick McHardy err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 21085f9021cfSJohannes Berg if (err < 0) 21095f9021cfSJohannes Berg goto errout; 21100157f60cSPatrick McHardy } 21110157f60cSPatrick McHardy 2112fbaec0eaSJiri Pirko if (tb[IFLA_MASTER]) { 2113fbaec0eaSJiri Pirko err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER])); 2114fbaec0eaSJiri Pirko if (err) 2115fbaec0eaSJiri Pirko goto errout; 211690c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 2117fbaec0eaSJiri Pirko } 2118fbaec0eaSJiri Pirko 21199a57247fSJiri Pirko if (tb[IFLA_CARRIER]) { 21209a57247fSJiri Pirko err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER])); 21219a57247fSJiri Pirko if (err) 21229a57247fSJiri Pirko goto errout; 212390c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 21249a57247fSJiri Pirko } 21259a57247fSJiri Pirko 21265d1180fcSNicolas Dichtel if (tb[IFLA_TXQLEN]) { 21270cd29503SAlexey Dobriyan unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]); 21280cd29503SAlexey Dobriyan unsigned int orig_len = dev->tx_queue_len; 21295d1180fcSNicolas Dichtel 213008294a26SJason Wang if (dev->tx_queue_len ^ value) { 21315d1180fcSNicolas Dichtel dev->tx_queue_len = value; 213208294a26SJason Wang err = call_netdevice_notifiers( 213308294a26SJason Wang NETDEV_CHANGE_TX_QUEUE_LEN, dev); 213408294a26SJason Wang err = notifier_to_errno(err); 213508294a26SJason Wang if (err) { 213608294a26SJason Wang dev->tx_queue_len = orig_len; 213708294a26SJason Wang goto errout; 213808294a26SJason Wang } 213908294a26SJason Wang status |= DO_SETLINK_NOTIFY; 214008294a26SJason Wang } 21415d1180fcSNicolas Dichtel } 21420157f60cSPatrick McHardy 21430157f60cSPatrick McHardy if (tb[IFLA_OPERSTATE]) 214493b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 21450157f60cSPatrick McHardy 21460157f60cSPatrick McHardy if (tb[IFLA_LINKMODE]) { 21471889b0e7SNicolas Dichtel unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]); 21481889b0e7SNicolas Dichtel 21490157f60cSPatrick McHardy write_lock_bh(&dev_base_lock); 21501889b0e7SNicolas Dichtel if (dev->link_mode ^ value) 2151ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 21521889b0e7SNicolas Dichtel dev->link_mode = value; 215393b2d4a2SDavid S. Miller write_unlock_bh(&dev_base_lock); 21540157f60cSPatrick McHardy } 21550157f60cSPatrick McHardy 2156c02db8c6SChris Wright if (tb[IFLA_VFINFO_LIST]) { 21574f7d2cdfSDaniel Borkmann struct nlattr *vfinfo[IFLA_VF_MAX + 1]; 2158c02db8c6SChris Wright struct nlattr *attr; 2159c02db8c6SChris Wright int rem; 21604f7d2cdfSDaniel Borkmann 2161c02db8c6SChris Wright nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { 21624f7d2cdfSDaniel Borkmann if (nla_type(attr) != IFLA_VF_INFO || 21634f7d2cdfSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2164253683bbSDavid Howells err = -EINVAL; 2165c02db8c6SChris Wright goto errout; 2166253683bbSDavid Howells } 21674f7d2cdfSDaniel Borkmann err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr, 2168fceb6435SJohannes Berg ifla_vf_policy, NULL); 21694f7d2cdfSDaniel Borkmann if (err < 0) 21704f7d2cdfSDaniel Borkmann goto errout; 21714f7d2cdfSDaniel Borkmann err = do_setvfinfo(dev, vfinfo); 2172ebc08a6fSWilliams, Mitch A if (err < 0) 2173ebc08a6fSWilliams, Mitch A goto errout; 2174ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2175ebc08a6fSWilliams, Mitch A } 2176ebc08a6fSWilliams, Mitch A } 21770157f60cSPatrick McHardy err = 0; 21780157f60cSPatrick McHardy 217957b61080SScott Feldman if (tb[IFLA_VF_PORTS]) { 218057b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 218157b61080SScott Feldman struct nlattr *attr; 218257b61080SScott Feldman int vf; 218357b61080SScott Feldman int rem; 218457b61080SScott Feldman 218557b61080SScott Feldman err = -EOPNOTSUPP; 218657b61080SScott Feldman if (!ops->ndo_set_vf_port) 218757b61080SScott Feldman goto errout; 218857b61080SScott Feldman 218957b61080SScott Feldman nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { 2190035d210fSDaniel Borkmann if (nla_type(attr) != IFLA_VF_PORT || 2191035d210fSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2192035d210fSDaniel Borkmann err = -EINVAL; 2193035d210fSDaniel Borkmann goto errout; 2194035d210fSDaniel Borkmann } 2195035d210fSDaniel Borkmann err = nla_parse_nested(port, IFLA_PORT_MAX, attr, 2196fceb6435SJohannes Berg ifla_port_policy, NULL); 219757b61080SScott Feldman if (err < 0) 219857b61080SScott Feldman goto errout; 219957b61080SScott Feldman if (!port[IFLA_PORT_VF]) { 220057b61080SScott Feldman err = -EOPNOTSUPP; 220157b61080SScott Feldman goto errout; 220257b61080SScott Feldman } 220357b61080SScott Feldman vf = nla_get_u32(port[IFLA_PORT_VF]); 220457b61080SScott Feldman err = ops->ndo_set_vf_port(dev, vf, port); 220557b61080SScott Feldman if (err < 0) 220657b61080SScott Feldman goto errout; 2207ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 220857b61080SScott Feldman } 220957b61080SScott Feldman } 221057b61080SScott Feldman err = 0; 221157b61080SScott Feldman 221257b61080SScott Feldman if (tb[IFLA_PORT_SELF]) { 221357b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 221457b61080SScott Feldman 221557b61080SScott Feldman err = nla_parse_nested(port, IFLA_PORT_MAX, 2216fceb6435SJohannes Berg tb[IFLA_PORT_SELF], ifla_port_policy, 2217fceb6435SJohannes Berg NULL); 221857b61080SScott Feldman if (err < 0) 221957b61080SScott Feldman goto errout; 222057b61080SScott Feldman 222157b61080SScott Feldman err = -EOPNOTSUPP; 222257b61080SScott Feldman if (ops->ndo_set_vf_port) 222357b61080SScott Feldman err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); 222457b61080SScott Feldman if (err < 0) 222557b61080SScott Feldman goto errout; 2226ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 222757b61080SScott Feldman } 2228f8ff182cSThomas Graf 2229f8ff182cSThomas Graf if (tb[IFLA_AF_SPEC]) { 2230f8ff182cSThomas Graf struct nlattr *af; 2231f8ff182cSThomas Graf int rem; 2232f8ff182cSThomas Graf 2233f8ff182cSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 2234f8ff182cSThomas Graf const struct rtnl_af_ops *af_ops; 2235f8ff182cSThomas Graf 2236f8ff182cSThomas Graf if (!(af_ops = rtnl_af_lookup(nla_type(af)))) 2237cf7afbfeSThomas Graf BUG(); 2238f8ff182cSThomas Graf 2239cf7afbfeSThomas Graf err = af_ops->set_link_af(dev, af); 2240f8ff182cSThomas Graf if (err < 0) 2241f8ff182cSThomas Graf goto errout; 2242f8ff182cSThomas Graf 2243ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2244f8ff182cSThomas Graf } 2245f8ff182cSThomas Graf } 224657b61080SScott Feldman err = 0; 224757b61080SScott Feldman 224888d6378bSAnuradha Karuppiah if (tb[IFLA_PROTO_DOWN]) { 224988d6378bSAnuradha Karuppiah err = dev_change_proto_down(dev, 225088d6378bSAnuradha Karuppiah nla_get_u8(tb[IFLA_PROTO_DOWN])); 225188d6378bSAnuradha Karuppiah if (err) 225288d6378bSAnuradha Karuppiah goto errout; 225388d6378bSAnuradha Karuppiah status |= DO_SETLINK_NOTIFY; 225488d6378bSAnuradha Karuppiah } 225588d6378bSAnuradha Karuppiah 2256d1fdd913SBrenden Blanco if (tb[IFLA_XDP]) { 2257d1fdd913SBrenden Blanco struct nlattr *xdp[IFLA_XDP_MAX + 1]; 225885de8576SDaniel Borkmann u32 xdp_flags = 0; 2259d1fdd913SBrenden Blanco 2260d1fdd913SBrenden Blanco err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP], 2261fceb6435SJohannes Berg ifla_xdp_policy, NULL); 2262d1fdd913SBrenden Blanco if (err < 0) 2263d1fdd913SBrenden Blanco goto errout; 2264d1fdd913SBrenden Blanco 226558038695SMartin KaFai Lau if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) { 2266262d8625SBrenden Blanco err = -EINVAL; 2267262d8625SBrenden Blanco goto errout; 2268262d8625SBrenden Blanco } 226985de8576SDaniel Borkmann 227085de8576SDaniel Borkmann if (xdp[IFLA_XDP_FLAGS]) { 227185de8576SDaniel Borkmann xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]); 227285de8576SDaniel Borkmann if (xdp_flags & ~XDP_FLAGS_MASK) { 227385de8576SDaniel Borkmann err = -EINVAL; 227485de8576SDaniel Borkmann goto errout; 227585de8576SDaniel Borkmann } 2276ee5d032fSJakub Kicinski if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) { 22770489df9aSDaniel Borkmann err = -EINVAL; 22780489df9aSDaniel Borkmann goto errout; 22790489df9aSDaniel Borkmann } 228085de8576SDaniel Borkmann } 228185de8576SDaniel Borkmann 2282d1fdd913SBrenden Blanco if (xdp[IFLA_XDP_FD]) { 2283ddf9f970SJakub Kicinski err = dev_change_xdp_fd(dev, extack, 228485de8576SDaniel Borkmann nla_get_s32(xdp[IFLA_XDP_FD]), 228585de8576SDaniel Borkmann xdp_flags); 2286d1fdd913SBrenden Blanco if (err) 2287d1fdd913SBrenden Blanco goto errout; 2288d1fdd913SBrenden Blanco status |= DO_SETLINK_NOTIFY; 2289d1fdd913SBrenden Blanco } 2290d1fdd913SBrenden Blanco } 2291d1fdd913SBrenden Blanco 22920157f60cSPatrick McHardy errout: 2293ba998906SNicolas Dichtel if (status & DO_SETLINK_MODIFIED) { 2294ba998906SNicolas Dichtel if (status & DO_SETLINK_NOTIFY) 2295ba998906SNicolas Dichtel netdev_state_change(dev); 2296ba998906SNicolas Dichtel 2297ba998906SNicolas Dichtel if (err < 0) 2298e87cc472SJoe Perches 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", 2299e87cc472SJoe Perches dev->name); 2300ba998906SNicolas Dichtel } 23010157f60cSPatrick McHardy 23020157f60cSPatrick McHardy return err; 23030157f60cSPatrick McHardy } 23040157f60cSPatrick McHardy 2305c21ef3e3SDavid Ahern static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2306c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2307da5e0494SThomas Graf { 23083b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 2309da5e0494SThomas Graf struct ifinfomsg *ifm; 2310da5e0494SThomas Graf struct net_device *dev; 23110157f60cSPatrick McHardy int err; 2312da5e0494SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 23131da177e4SLinus Torvalds char ifname[IFNAMSIZ]; 23141da177e4SLinus Torvalds 2315c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, 2316c21ef3e3SDavid Ahern extack); 2317da5e0494SThomas Graf if (err < 0) 2318da5e0494SThomas Graf goto errout; 23191da177e4SLinus Torvalds 23205176f91eSThomas Graf if (tb[IFLA_IFNAME]) 23215176f91eSThomas Graf nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 232278e5b891SPatrick McHardy else 232378e5b891SPatrick McHardy ifname[0] = '\0'; 23241da177e4SLinus Torvalds 23251da177e4SLinus Torvalds err = -EINVAL; 2326da5e0494SThomas Graf ifm = nlmsg_data(nlh); 232751055be8SPatrick McHardy if (ifm->ifi_index > 0) 2328a3d12891SEric Dumazet dev = __dev_get_by_index(net, ifm->ifi_index); 2329da5e0494SThomas Graf else if (tb[IFLA_IFNAME]) 2330a3d12891SEric Dumazet dev = __dev_get_by_name(net, ifname); 2331da5e0494SThomas Graf else 2332da5e0494SThomas Graf goto errout; 23331da177e4SLinus Torvalds 2334da5e0494SThomas Graf if (dev == NULL) { 2335da5e0494SThomas Graf err = -ENODEV; 2336da5e0494SThomas Graf goto errout; 2337da5e0494SThomas Graf } 23381da177e4SLinus Torvalds 2339e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2340e0d087afSEric Dumazet if (err < 0) 2341a3d12891SEric Dumazet goto errout; 2342da5e0494SThomas Graf 2343ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0); 2344da5e0494SThomas Graf errout: 23451da177e4SLinus Torvalds return err; 23461da177e4SLinus Torvalds } 23471da177e4SLinus Torvalds 234866400d54SWANG Cong static int rtnl_group_dellink(const struct net *net, int group) 234966400d54SWANG Cong { 235066400d54SWANG Cong struct net_device *dev, *aux; 235166400d54SWANG Cong LIST_HEAD(list_kill); 235266400d54SWANG Cong bool found = false; 235366400d54SWANG Cong 235466400d54SWANG Cong if (!group) 235566400d54SWANG Cong return -EPERM; 235666400d54SWANG Cong 235766400d54SWANG Cong for_each_netdev(net, dev) { 235866400d54SWANG Cong if (dev->group == group) { 235966400d54SWANG Cong const struct rtnl_link_ops *ops; 236066400d54SWANG Cong 236166400d54SWANG Cong found = true; 236266400d54SWANG Cong ops = dev->rtnl_link_ops; 236366400d54SWANG Cong if (!ops || !ops->dellink) 236466400d54SWANG Cong return -EOPNOTSUPP; 236566400d54SWANG Cong } 236666400d54SWANG Cong } 236766400d54SWANG Cong 236866400d54SWANG Cong if (!found) 236966400d54SWANG Cong return -ENODEV; 237066400d54SWANG Cong 237166400d54SWANG Cong for_each_netdev_safe(net, dev, aux) { 237266400d54SWANG Cong if (dev->group == group) { 237366400d54SWANG Cong const struct rtnl_link_ops *ops; 237466400d54SWANG Cong 237566400d54SWANG Cong ops = dev->rtnl_link_ops; 237666400d54SWANG Cong ops->dellink(dev, &list_kill); 237766400d54SWANG Cong } 237866400d54SWANG Cong } 237966400d54SWANG Cong unregister_netdevice_many(&list_kill); 238066400d54SWANG Cong 238166400d54SWANG Cong return 0; 238266400d54SWANG Cong } 238366400d54SWANG Cong 2384614732eaSThomas Graf int rtnl_delete_link(struct net_device *dev) 2385614732eaSThomas Graf { 2386614732eaSThomas Graf const struct rtnl_link_ops *ops; 2387614732eaSThomas Graf LIST_HEAD(list_kill); 2388614732eaSThomas Graf 2389614732eaSThomas Graf ops = dev->rtnl_link_ops; 2390614732eaSThomas Graf if (!ops || !ops->dellink) 2391614732eaSThomas Graf return -EOPNOTSUPP; 2392614732eaSThomas Graf 2393614732eaSThomas Graf ops->dellink(dev, &list_kill); 2394614732eaSThomas Graf unregister_netdevice_many(&list_kill); 2395614732eaSThomas Graf 2396614732eaSThomas Graf return 0; 2397614732eaSThomas Graf } 2398614732eaSThomas Graf EXPORT_SYMBOL_GPL(rtnl_delete_link); 2399614732eaSThomas Graf 2400c21ef3e3SDavid Ahern static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 2401c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 240238f7b870SPatrick McHardy { 24033b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 240438f7b870SPatrick McHardy struct net_device *dev; 240538f7b870SPatrick McHardy struct ifinfomsg *ifm; 240638f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 240738f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 240838f7b870SPatrick McHardy int err; 240938f7b870SPatrick McHardy 2410c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 241138f7b870SPatrick McHardy if (err < 0) 241238f7b870SPatrick McHardy return err; 241338f7b870SPatrick McHardy 241438f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 241538f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 241638f7b870SPatrick McHardy 241738f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 241838f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2419881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 242038f7b870SPatrick McHardy else if (tb[IFLA_IFNAME]) 2421881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 242266400d54SWANG Cong else if (tb[IFLA_GROUP]) 242366400d54SWANG Cong return rtnl_group_dellink(net, nla_get_u32(tb[IFLA_GROUP])); 242438f7b870SPatrick McHardy else 242538f7b870SPatrick McHardy return -EINVAL; 242638f7b870SPatrick McHardy 242738f7b870SPatrick McHardy if (!dev) 242838f7b870SPatrick McHardy return -ENODEV; 242938f7b870SPatrick McHardy 2430614732eaSThomas Graf return rtnl_delete_link(dev); 243138f7b870SPatrick McHardy } 243238f7b870SPatrick McHardy 24333729d502SPatrick McHardy int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) 24343729d502SPatrick McHardy { 24353729d502SPatrick McHardy unsigned int old_flags; 24363729d502SPatrick McHardy int err; 24373729d502SPatrick McHardy 24383729d502SPatrick McHardy old_flags = dev->flags; 24393729d502SPatrick McHardy if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { 24403729d502SPatrick McHardy err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 24413729d502SPatrick McHardy if (err < 0) 24423729d502SPatrick McHardy return err; 24433729d502SPatrick McHardy } 24443729d502SPatrick McHardy 24453729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZED; 24463729d502SPatrick McHardy 2447a528c219SNicolas Dichtel __dev_notify_flags(dev, old_flags, ~0U); 24483729d502SPatrick McHardy return 0; 24493729d502SPatrick McHardy } 24503729d502SPatrick McHardy EXPORT_SYMBOL(rtnl_configure_link); 24513729d502SPatrick McHardy 2452c0713563SRami Rosen struct net_device *rtnl_create_link(struct net *net, 245378ebb0d0SThomas Graf const char *ifname, unsigned char name_assign_type, 24545517750fSTom Gundersen const struct rtnl_link_ops *ops, struct nlattr *tb[]) 2455e7199288SPavel Emelianov { 2456e7199288SPavel Emelianov struct net_device *dev; 2457d40156aaSJiri Pirko unsigned int num_tx_queues = 1; 2458d40156aaSJiri Pirko unsigned int num_rx_queues = 1; 2459e7199288SPavel Emelianov 246076ff5cc9SJiri Pirko if (tb[IFLA_NUM_TX_QUEUES]) 246176ff5cc9SJiri Pirko num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]); 246276ff5cc9SJiri Pirko else if (ops->get_num_tx_queues) 2463d40156aaSJiri Pirko num_tx_queues = ops->get_num_tx_queues(); 246476ff5cc9SJiri Pirko 246576ff5cc9SJiri Pirko if (tb[IFLA_NUM_RX_QUEUES]) 246676ff5cc9SJiri Pirko num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]); 246776ff5cc9SJiri Pirko else if (ops->get_num_rx_queues) 2468d40156aaSJiri Pirko num_rx_queues = ops->get_num_rx_queues(); 2469efacb309Sstephen hemminger 24705517750fSTom Gundersen dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type, 2471c835a677STom Gundersen ops->setup, num_tx_queues, num_rx_queues); 2472e7199288SPavel Emelianov if (!dev) 2473d1892e4eSTobias Klauser return ERR_PTR(-ENOMEM); 2474e7199288SPavel Emelianov 247581adee47SEric W. Biederman dev_net_set(dev, net); 247681adee47SEric W. Biederman dev->rtnl_link_ops = ops; 24773729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZING; 247881adee47SEric W. Biederman 2479e7199288SPavel Emelianov if (tb[IFLA_MTU]) 2480e7199288SPavel Emelianov dev->mtu = nla_get_u32(tb[IFLA_MTU]); 24812afb9b53SJiri Pirko if (tb[IFLA_ADDRESS]) { 2482e7199288SPavel Emelianov memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), 2483e7199288SPavel Emelianov nla_len(tb[IFLA_ADDRESS])); 24842afb9b53SJiri Pirko dev->addr_assign_type = NET_ADDR_SET; 24852afb9b53SJiri Pirko } 2486e7199288SPavel Emelianov if (tb[IFLA_BROADCAST]) 2487e7199288SPavel Emelianov memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), 2488e7199288SPavel Emelianov nla_len(tb[IFLA_BROADCAST])); 2489e7199288SPavel Emelianov if (tb[IFLA_TXQLEN]) 2490e7199288SPavel Emelianov dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); 2491e7199288SPavel Emelianov if (tb[IFLA_OPERSTATE]) 249293b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 2493e7199288SPavel Emelianov if (tb[IFLA_LINKMODE]) 2494e7199288SPavel Emelianov dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); 2495ffa934f1SPatrick McHardy if (tb[IFLA_GROUP]) 2496ffa934f1SPatrick McHardy dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2497e7199288SPavel Emelianov 2498e7199288SPavel Emelianov return dev; 2499e7199288SPavel Emelianov } 2500e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_create_link); 2501e7199288SPavel Emelianov 250290f62cf3SEric W. Biederman static int rtnl_group_changelink(const struct sk_buff *skb, 250390f62cf3SEric W. Biederman struct net *net, int group, 2504e7ed828fSVlad Dogaru struct ifinfomsg *ifm, 2505ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 2506e7ed828fSVlad Dogaru struct nlattr **tb) 2507e7ed828fSVlad Dogaru { 2508d079535dSWANG Cong struct net_device *dev, *aux; 2509e7ed828fSVlad Dogaru int err; 2510e7ed828fSVlad Dogaru 2511d079535dSWANG Cong for_each_netdev_safe(net, dev, aux) { 2512e7ed828fSVlad Dogaru if (dev->group == group) { 2513ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0); 2514e7ed828fSVlad Dogaru if (err < 0) 2515e7ed828fSVlad Dogaru return err; 2516e7ed828fSVlad Dogaru } 2517e7ed828fSVlad Dogaru } 2518e7ed828fSVlad Dogaru 2519e7ed828fSVlad Dogaru return 0; 2520e7ed828fSVlad Dogaru } 2521e7ed828fSVlad Dogaru 2522c21ef3e3SDavid Ahern static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2523c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 252438f7b870SPatrick McHardy { 25253b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 252638f7b870SPatrick McHardy const struct rtnl_link_ops *ops; 2527ba7d49b1SJiri Pirko const struct rtnl_link_ops *m_ops = NULL; 252838f7b870SPatrick McHardy struct net_device *dev; 2529ba7d49b1SJiri Pirko struct net_device *master_dev = NULL; 253038f7b870SPatrick McHardy struct ifinfomsg *ifm; 253138f7b870SPatrick McHardy char kind[MODULE_NAME_LEN]; 253238f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 253338f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 253438f7b870SPatrick McHardy struct nlattr *linkinfo[IFLA_INFO_MAX+1]; 25355517750fSTom Gundersen unsigned char name_assign_type = NET_NAME_USER; 253638f7b870SPatrick McHardy int err; 253738f7b870SPatrick McHardy 253895a5afcaSJohannes Berg #ifdef CONFIG_MODULES 253938f7b870SPatrick McHardy replay: 25408072f085SThomas Graf #endif 2541c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 254238f7b870SPatrick McHardy if (err < 0) 254338f7b870SPatrick McHardy return err; 254438f7b870SPatrick McHardy 254538f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 254638f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 254738f7b870SPatrick McHardy else 254838f7b870SPatrick McHardy ifname[0] = '\0'; 254938f7b870SPatrick McHardy 255038f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 255138f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2552881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 2553e7ed828fSVlad Dogaru else { 2554e7ed828fSVlad Dogaru if (ifname[0]) 2555881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 255638f7b870SPatrick McHardy else 255738f7b870SPatrick McHardy dev = NULL; 2558e7ed828fSVlad Dogaru } 255938f7b870SPatrick McHardy 2560ba7d49b1SJiri Pirko if (dev) { 2561ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get(dev); 2562ba7d49b1SJiri Pirko if (master_dev) 2563ba7d49b1SJiri Pirko m_ops = master_dev->rtnl_link_ops; 2564ba7d49b1SJiri Pirko } 2565ba7d49b1SJiri Pirko 2566e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2567e0d087afSEric Dumazet if (err < 0) 25681840bb13SThomas Graf return err; 25691840bb13SThomas Graf 257038f7b870SPatrick McHardy if (tb[IFLA_LINKINFO]) { 257138f7b870SPatrick McHardy err = nla_parse_nested(linkinfo, IFLA_INFO_MAX, 2572fceb6435SJohannes Berg tb[IFLA_LINKINFO], ifla_info_policy, 2573fceb6435SJohannes Berg NULL); 257438f7b870SPatrick McHardy if (err < 0) 257538f7b870SPatrick McHardy return err; 257638f7b870SPatrick McHardy } else 257738f7b870SPatrick McHardy memset(linkinfo, 0, sizeof(linkinfo)); 257838f7b870SPatrick McHardy 257938f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_KIND]) { 258038f7b870SPatrick McHardy nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); 258138f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 258238f7b870SPatrick McHardy } else { 258338f7b870SPatrick McHardy kind[0] = '\0'; 258438f7b870SPatrick McHardy ops = NULL; 258538f7b870SPatrick McHardy } 258638f7b870SPatrick McHardy 258738f7b870SPatrick McHardy if (1) { 25884e10fd5bSSasha Levin struct nlattr *attr[ops ? ops->maxtype + 1 : 1]; 25894e10fd5bSSasha Levin struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1]; 2590ba7d49b1SJiri Pirko struct nlattr **data = NULL; 2591ba7d49b1SJiri Pirko struct nlattr **slave_data = NULL; 2592317f4810SNicolas Dichtel struct net *dest_net, *link_net = NULL; 259338f7b870SPatrick McHardy 259438f7b870SPatrick McHardy if (ops) { 259538f7b870SPatrick McHardy if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { 259638f7b870SPatrick McHardy err = nla_parse_nested(attr, ops->maxtype, 259738f7b870SPatrick McHardy linkinfo[IFLA_INFO_DATA], 2598fceb6435SJohannes Berg ops->policy, NULL); 259938f7b870SPatrick McHardy if (err < 0) 260038f7b870SPatrick McHardy return err; 260138f7b870SPatrick McHardy data = attr; 260238f7b870SPatrick McHardy } 260338f7b870SPatrick McHardy if (ops->validate) { 2604a8b8a889SMatthias Schiffer err = ops->validate(tb, data, extack); 260538f7b870SPatrick McHardy if (err < 0) 260638f7b870SPatrick McHardy return err; 260738f7b870SPatrick McHardy } 260838f7b870SPatrick McHardy } 260938f7b870SPatrick McHardy 2610ba7d49b1SJiri Pirko if (m_ops) { 2611ba7d49b1SJiri Pirko if (m_ops->slave_maxtype && 2612ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA]) { 2613ba7d49b1SJiri Pirko err = nla_parse_nested(slave_attr, 2614ba7d49b1SJiri Pirko m_ops->slave_maxtype, 2615ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA], 2616fceb6435SJohannes Berg m_ops->slave_policy, 2617fceb6435SJohannes Berg NULL); 2618ba7d49b1SJiri Pirko if (err < 0) 2619ba7d49b1SJiri Pirko return err; 2620ba7d49b1SJiri Pirko slave_data = slave_attr; 2621ba7d49b1SJiri Pirko } 2622ba7d49b1SJiri Pirko } 2623ba7d49b1SJiri Pirko 262438f7b870SPatrick McHardy if (dev) { 262590c325e3SNicolas Dichtel int status = 0; 262638f7b870SPatrick McHardy 262738f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_EXCL) 262838f7b870SPatrick McHardy return -EEXIST; 262938f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_REPLACE) 263038f7b870SPatrick McHardy return -EOPNOTSUPP; 263138f7b870SPatrick McHardy 263238f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_DATA]) { 263338f7b870SPatrick McHardy if (!ops || ops != dev->rtnl_link_ops || 263438f7b870SPatrick McHardy !ops->changelink) 263538f7b870SPatrick McHardy return -EOPNOTSUPP; 263638f7b870SPatrick McHardy 2637ad744b22SMatthias Schiffer err = ops->changelink(dev, tb, data, extack); 263838f7b870SPatrick McHardy if (err < 0) 263938f7b870SPatrick McHardy return err; 2640ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 264138f7b870SPatrick McHardy } 264238f7b870SPatrick McHardy 2643ba7d49b1SJiri Pirko if (linkinfo[IFLA_INFO_SLAVE_DATA]) { 2644ba7d49b1SJiri Pirko if (!m_ops || !m_ops->slave_changelink) 2645ba7d49b1SJiri Pirko return -EOPNOTSUPP; 2646ba7d49b1SJiri Pirko 2647ba7d49b1SJiri Pirko err = m_ops->slave_changelink(master_dev, dev, 264817dd0ec4SMatthias Schiffer tb, slave_data, 264917dd0ec4SMatthias Schiffer extack); 2650ba7d49b1SJiri Pirko if (err < 0) 2651ba7d49b1SJiri Pirko return err; 2652ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2653ba7d49b1SJiri Pirko } 2654ba7d49b1SJiri Pirko 2655ddf9f970SJakub Kicinski return do_setlink(skb, dev, ifm, extack, tb, ifname, 2656ddf9f970SJakub Kicinski status); 265738f7b870SPatrick McHardy } 265838f7b870SPatrick McHardy 2659ffa934f1SPatrick McHardy if (!(nlh->nlmsg_flags & NLM_F_CREATE)) { 2660ffa934f1SPatrick McHardy if (ifm->ifi_index == 0 && tb[IFLA_GROUP]) 266190f62cf3SEric W. Biederman return rtnl_group_changelink(skb, net, 2662ffa934f1SPatrick McHardy nla_get_u32(tb[IFLA_GROUP]), 2663ddf9f970SJakub Kicinski ifm, extack, tb); 266438f7b870SPatrick McHardy return -ENODEV; 2665ffa934f1SPatrick McHardy } 266638f7b870SPatrick McHardy 2667160ca014STheuns Verwoerd if (tb[IFLA_MAP] || tb[IFLA_PROTINFO]) 266838f7b870SPatrick McHardy return -EOPNOTSUPP; 266938f7b870SPatrick McHardy 267038f7b870SPatrick McHardy if (!ops) { 267195a5afcaSJohannes Berg #ifdef CONFIG_MODULES 267238f7b870SPatrick McHardy if (kind[0]) { 267338f7b870SPatrick McHardy __rtnl_unlock(); 267438f7b870SPatrick McHardy request_module("rtnl-link-%s", kind); 267538f7b870SPatrick McHardy rtnl_lock(); 267638f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 267738f7b870SPatrick McHardy if (ops) 267838f7b870SPatrick McHardy goto replay; 267938f7b870SPatrick McHardy } 268038f7b870SPatrick McHardy #endif 268138f7b870SPatrick McHardy return -EOPNOTSUPP; 268238f7b870SPatrick McHardy } 268338f7b870SPatrick McHardy 2684b0ab2fabSJiri Pirko if (!ops->setup) 2685b0ab2fabSJiri Pirko return -EOPNOTSUPP; 2686b0ab2fabSJiri Pirko 26875517750fSTom Gundersen if (!ifname[0]) { 268838f7b870SPatrick McHardy snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); 26895517750fSTom Gundersen name_assign_type = NET_NAME_ENUM; 26905517750fSTom Gundersen } 269138f7b870SPatrick McHardy 269281adee47SEric W. Biederman dest_net = rtnl_link_get_net(net, tb); 269313ad1774SEric W. Biederman if (IS_ERR(dest_net)) 269413ad1774SEric W. Biederman return PTR_ERR(dest_net); 269513ad1774SEric W. Biederman 2696505ce415SEric W. Biederman err = -EPERM; 2697505ce415SEric W. Biederman if (!netlink_ns_capable(skb, dest_net->user_ns, CAP_NET_ADMIN)) 2698505ce415SEric W. Biederman goto out; 2699505ce415SEric W. Biederman 2700317f4810SNicolas Dichtel if (tb[IFLA_LINK_NETNSID]) { 2701317f4810SNicolas Dichtel int id = nla_get_s32(tb[IFLA_LINK_NETNSID]); 2702317f4810SNicolas Dichtel 2703317f4810SNicolas Dichtel link_net = get_net_ns_by_id(dest_net, id); 2704317f4810SNicolas Dichtel if (!link_net) { 2705317f4810SNicolas Dichtel err = -EINVAL; 2706317f4810SNicolas Dichtel goto out; 2707317f4810SNicolas Dichtel } 270806615bedSEric W. Biederman err = -EPERM; 270906615bedSEric W. Biederman if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN)) 271006615bedSEric W. Biederman goto out; 2711317f4810SNicolas Dichtel } 2712317f4810SNicolas Dichtel 2713317f4810SNicolas Dichtel dev = rtnl_create_link(link_net ? : dest_net, ifname, 2714317f4810SNicolas Dichtel name_assign_type, ops, tb); 27159c7dafbfSPavel Emelyanov if (IS_ERR(dev)) { 2716e7199288SPavel Emelianov err = PTR_ERR(dev); 27179c7dafbfSPavel Emelyanov goto out; 27189c7dafbfSPavel Emelyanov } 27199c7dafbfSPavel Emelyanov 27209c7dafbfSPavel Emelyanov dev->ifindex = ifm->ifi_index; 27219c7dafbfSPavel Emelyanov 27220e0eee24SCong Wang if (ops->newlink) { 27237a3f4a18SMatthias Schiffer err = ops->newlink(link_net ? : net, dev, tb, data, 27247a3f4a18SMatthias Schiffer extack); 27250e0eee24SCong Wang /* Drivers should call free_netdev() in ->destructor 2726e51fb152SCong Wang * and unregister it on failure after registration 2727e51fb152SCong Wang * so that device could be finally freed in rtnl_unlock. 27280e0eee24SCong Wang */ 2729e51fb152SCong Wang if (err < 0) { 2730e51fb152SCong Wang /* If device is not registered at all, free it now */ 2731e51fb152SCong Wang if (dev->reg_state == NETREG_UNINITIALIZED) 2732e51fb152SCong Wang free_netdev(dev); 27330e0eee24SCong Wang goto out; 2734e51fb152SCong Wang } 27350e0eee24SCong Wang } else { 27362d85cba2SPatrick McHardy err = register_netdevice(dev); 2737fce9b9beSDan Carpenter if (err < 0) { 273838f7b870SPatrick McHardy free_netdev(dev); 27393729d502SPatrick McHardy goto out; 2740fce9b9beSDan Carpenter } 27410e0eee24SCong Wang } 27423729d502SPatrick McHardy err = rtnl_configure_link(dev, ifm); 274343638900SDavid S. Miller if (err < 0) 274443638900SDavid S. Miller goto out_unregister; 274543638900SDavid S. Miller if (link_net) { 274643638900SDavid S. Miller err = dev_change_net_namespace(dev, dest_net, ifname); 274743638900SDavid S. Miller if (err < 0) 274843638900SDavid S. Miller goto out_unregister; 274943638900SDavid S. Miller } 2750160ca014STheuns Verwoerd if (tb[IFLA_MASTER]) { 2751160ca014STheuns Verwoerd err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER])); 2752160ca014STheuns Verwoerd if (err) 2753160ca014STheuns Verwoerd goto out_unregister; 2754160ca014STheuns Verwoerd } 275543638900SDavid S. Miller out: 275643638900SDavid S. Miller if (link_net) 275743638900SDavid S. Miller put_net(link_net); 275843638900SDavid S. Miller put_net(dest_net); 275943638900SDavid S. Miller return err; 276043638900SDavid S. Miller out_unregister: 27617afb8886SWANG Cong if (ops->newlink) { 27627afb8886SWANG Cong LIST_HEAD(list_kill); 27637afb8886SWANG Cong 27647afb8886SWANG Cong ops->dellink(dev, &list_kill); 27657afb8886SWANG Cong unregister_netdevice_many(&list_kill); 27667afb8886SWANG Cong } else { 27673729d502SPatrick McHardy unregister_netdevice(dev); 27687afb8886SWANG Cong } 2769317f4810SNicolas Dichtel goto out; 2770317f4810SNicolas Dichtel } 277138f7b870SPatrick McHardy } 277238f7b870SPatrick McHardy 2773c21ef3e3SDavid Ahern static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2774c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2775711e2c33SJean Tourrilhes { 27763b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 2777b60c5115SThomas Graf struct ifinfomsg *ifm; 2778a3d12891SEric Dumazet char ifname[IFNAMSIZ]; 2779b60c5115SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 2780b60c5115SThomas Graf struct net_device *dev = NULL; 2781b60c5115SThomas Graf struct sk_buff *nskb; 2782339bf98fSThomas Graf int err; 2783115c9b81SGreg Rose u32 ext_filter_mask = 0; 2784711e2c33SJean Tourrilhes 2785c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 2786b60c5115SThomas Graf if (err < 0) 27879918f230SEric Sesterhenn return err; 2788b60c5115SThomas Graf 2789a3d12891SEric Dumazet if (tb[IFLA_IFNAME]) 2790a3d12891SEric Dumazet nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 2791a3d12891SEric Dumazet 2792115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2793115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2794115c9b81SGreg Rose 2795b60c5115SThomas Graf ifm = nlmsg_data(nlh); 2796a3d12891SEric Dumazet if (ifm->ifi_index > 0) 2797a3d12891SEric Dumazet dev = __dev_get_by_index(net, ifm->ifi_index); 2798a3d12891SEric Dumazet else if (tb[IFLA_IFNAME]) 2799a3d12891SEric Dumazet dev = __dev_get_by_name(net, ifname); 2800a3d12891SEric Dumazet else 2801b60c5115SThomas Graf return -EINVAL; 2802b60c5115SThomas Graf 2803a3d12891SEric Dumazet if (dev == NULL) 2804a3d12891SEric Dumazet return -ENODEV; 2805a3d12891SEric Dumazet 2806115c9b81SGreg Rose nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL); 2807a3d12891SEric Dumazet if (nskb == NULL) 2808a3d12891SEric Dumazet return -ENOBUFS; 2809711e2c33SJean Tourrilhes 281015e47304SEric W. Biederman err = rtnl_fill_ifinfo(nskb, dev, RTM_NEWLINK, NETLINK_CB(skb).portid, 28113d3ea5afSVlad Yasevich nlh->nlmsg_seq, 0, 0, ext_filter_mask, 0); 281226932566SPatrick McHardy if (err < 0) { 281326932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size */ 281426932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 281526932566SPatrick McHardy kfree_skb(nskb); 2816a3d12891SEric Dumazet } else 281715e47304SEric W. Biederman err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 2818b60c5115SThomas Graf 2819711e2c33SJean Tourrilhes return err; 2820711e2c33SJean Tourrilhes } 2821711e2c33SJean Tourrilhes 2822115c9b81SGreg Rose static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh) 2823c7ac8679SGreg Rose { 2824115c9b81SGreg Rose struct net *net = sock_net(skb->sk); 2825115c9b81SGreg Rose struct net_device *dev; 2826115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 2827115c9b81SGreg Rose u32 ext_filter_mask = 0; 2828115c9b81SGreg Rose u16 min_ifinfo_dump_size = 0; 2829e5eca6d4SMichal Schmidt int hdrlen; 2830115c9b81SGreg Rose 2831e5eca6d4SMichal Schmidt /* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */ 2832e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ? 2833e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 2834e5eca6d4SMichal Schmidt 2835fceb6435SJohannes Berg if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) { 2836115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2837115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2838a4b64fbeSEric Dumazet } 2839115c9b81SGreg Rose 2840115c9b81SGreg Rose if (!ext_filter_mask) 2841115c9b81SGreg Rose return NLMSG_GOODSIZE; 2842115c9b81SGreg Rose /* 2843115c9b81SGreg Rose * traverse the list of net devices and compute the minimum 2844115c9b81SGreg Rose * buffer size based upon the filter mask. 2845115c9b81SGreg Rose */ 28466853dd48SFlorian Westphal rcu_read_lock(); 28476853dd48SFlorian Westphal for_each_netdev_rcu(net, dev) { 2848115c9b81SGreg Rose min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size, 2849115c9b81SGreg Rose if_nlmsg_size(dev, 2850115c9b81SGreg Rose ext_filter_mask)); 2851115c9b81SGreg Rose } 28526853dd48SFlorian Westphal rcu_read_unlock(); 2853115c9b81SGreg Rose 285493af2056SZhang Shengju return nlmsg_total_size(min_ifinfo_dump_size); 2855c7ac8679SGreg Rose } 2856c7ac8679SGreg Rose 285742bad1daSAdrian Bunk static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) 28581da177e4SLinus Torvalds { 28591da177e4SLinus Torvalds int idx; 28601da177e4SLinus Torvalds int s_idx = cb->family; 28611da177e4SLinus Torvalds 28621da177e4SLinus Torvalds if (s_idx == 0) 28631da177e4SLinus Torvalds s_idx = 1; 28646853dd48SFlorian Westphal 286525239ceeSPatrick McHardy for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { 28661da177e4SLinus Torvalds int type = cb->nlh->nlmsg_type-RTM_BASE; 28676853dd48SFlorian Westphal struct rtnl_link *handlers; 28686853dd48SFlorian Westphal rtnl_dumpit_func dumpit; 28696853dd48SFlorian Westphal 28701da177e4SLinus Torvalds if (idx < s_idx || idx == PF_PACKET) 28711da177e4SLinus Torvalds continue; 28726853dd48SFlorian Westphal 28736853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[idx]); 28746853dd48SFlorian Westphal if (!handlers) 28751da177e4SLinus Torvalds continue; 28766853dd48SFlorian Westphal 28776853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 28786853dd48SFlorian Westphal if (!dumpit) 28796853dd48SFlorian Westphal continue; 28806853dd48SFlorian Westphal 28810465277fSNicolas Dichtel if (idx > s_idx) { 28821da177e4SLinus Torvalds memset(&cb->args[0], 0, sizeof(cb->args)); 28830465277fSNicolas Dichtel cb->prev_seq = 0; 28840465277fSNicolas Dichtel cb->seq = 0; 28850465277fSNicolas Dichtel } 28866853dd48SFlorian Westphal if (dumpit(skb, cb)) 28871da177e4SLinus Torvalds break; 28881da177e4SLinus Torvalds } 28891da177e4SLinus Torvalds cb->family = idx; 28901da177e4SLinus Torvalds 28911da177e4SLinus Torvalds return skb->len; 28921da177e4SLinus Torvalds } 28931da177e4SLinus Torvalds 2894395eea6cSMahesh Bandewar struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev, 28953d3ea5afSVlad Yasevich unsigned int change, 28963d3ea5afSVlad Yasevich u32 event, gfp_t flags) 28971da177e4SLinus Torvalds { 2898c346dca1SYOSHIFUJI Hideaki struct net *net = dev_net(dev); 28991da177e4SLinus Torvalds struct sk_buff *skb; 29000ec6d3f4SThomas Graf int err = -ENOBUFS; 2901c7ac8679SGreg Rose size_t if_info_size; 29021da177e4SLinus Torvalds 29037f294054SAlexei Starovoitov skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags); 29040ec6d3f4SThomas Graf if (skb == NULL) 29050ec6d3f4SThomas Graf goto errout; 29061da177e4SLinus Torvalds 29073d3ea5afSVlad Yasevich err = rtnl_fill_ifinfo(skb, dev, type, 0, 0, change, 0, 0, event); 290826932566SPatrick McHardy if (err < 0) { 290926932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size() */ 291026932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 291126932566SPatrick McHardy kfree_skb(skb); 291226932566SPatrick McHardy goto errout; 291326932566SPatrick McHardy } 2914395eea6cSMahesh Bandewar return skb; 29150ec6d3f4SThomas Graf errout: 29160ec6d3f4SThomas Graf if (err < 0) 29174b3da706SEric W. Biederman rtnl_set_sk_err(net, RTNLGRP_LINK, err); 2918395eea6cSMahesh Bandewar return NULL; 2919395eea6cSMahesh Bandewar } 2920395eea6cSMahesh Bandewar 2921395eea6cSMahesh Bandewar void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags) 2922395eea6cSMahesh Bandewar { 2923395eea6cSMahesh Bandewar struct net *net = dev_net(dev); 2924395eea6cSMahesh Bandewar 2925395eea6cSMahesh Bandewar rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags); 2926395eea6cSMahesh Bandewar } 2927395eea6cSMahesh Bandewar 29283d3ea5afSVlad Yasevich static void rtmsg_ifinfo_event(int type, struct net_device *dev, 29293d3ea5afSVlad Yasevich unsigned int change, u32 event, 2930395eea6cSMahesh Bandewar gfp_t flags) 2931395eea6cSMahesh Bandewar { 2932395eea6cSMahesh Bandewar struct sk_buff *skb; 2933395eea6cSMahesh Bandewar 2934ed2a80abSNicolas Dichtel if (dev->reg_state != NETREG_REGISTERED) 2935ed2a80abSNicolas Dichtel return; 2936ed2a80abSNicolas Dichtel 29373d3ea5afSVlad Yasevich skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags); 2938395eea6cSMahesh Bandewar if (skb) 2939395eea6cSMahesh Bandewar rtmsg_ifinfo_send(skb, dev, flags); 29401da177e4SLinus Torvalds } 29413d3ea5afSVlad Yasevich 29423d3ea5afSVlad Yasevich void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change, 29433d3ea5afSVlad Yasevich gfp_t flags) 29443d3ea5afSVlad Yasevich { 29458c6c918dSVlad Yasevich rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags); 29463d3ea5afSVlad Yasevich } 2947471cb5a3SJiri Pirko EXPORT_SYMBOL(rtmsg_ifinfo); 29481da177e4SLinus Torvalds 2949d83b0603SJohn Fastabend static int nlmsg_populate_fdb_fill(struct sk_buff *skb, 2950d83b0603SJohn Fastabend struct net_device *dev, 29511e53d5bbSHubert Sokolowski u8 *addr, u16 vid, u32 pid, u32 seq, 29521c104a6bSNicolas Dichtel int type, unsigned int flags, 2953b3379041SHubert Sokolowski int nlflags, u16 ndm_state) 2954d83b0603SJohn Fastabend { 2955d83b0603SJohn Fastabend struct nlmsghdr *nlh; 2956d83b0603SJohn Fastabend struct ndmsg *ndm; 2957d83b0603SJohn Fastabend 29581c104a6bSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags); 2959d83b0603SJohn Fastabend if (!nlh) 2960d83b0603SJohn Fastabend return -EMSGSIZE; 2961d83b0603SJohn Fastabend 2962d83b0603SJohn Fastabend ndm = nlmsg_data(nlh); 2963d83b0603SJohn Fastabend ndm->ndm_family = AF_BRIDGE; 2964d83b0603SJohn Fastabend ndm->ndm_pad1 = 0; 2965d83b0603SJohn Fastabend ndm->ndm_pad2 = 0; 2966d83b0603SJohn Fastabend ndm->ndm_flags = flags; 2967d83b0603SJohn Fastabend ndm->ndm_type = 0; 2968d83b0603SJohn Fastabend ndm->ndm_ifindex = dev->ifindex; 2969b3379041SHubert Sokolowski ndm->ndm_state = ndm_state; 2970d83b0603SJohn Fastabend 2971d83b0603SJohn Fastabend if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr)) 2972d83b0603SJohn Fastabend goto nla_put_failure; 29731e53d5bbSHubert Sokolowski if (vid) 29741e53d5bbSHubert Sokolowski if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid)) 29751e53d5bbSHubert Sokolowski goto nla_put_failure; 2976d83b0603SJohn Fastabend 2977053c095aSJohannes Berg nlmsg_end(skb, nlh); 2978053c095aSJohannes Berg return 0; 2979d83b0603SJohn Fastabend 2980d83b0603SJohn Fastabend nla_put_failure: 2981d83b0603SJohn Fastabend nlmsg_cancel(skb, nlh); 2982d83b0603SJohn Fastabend return -EMSGSIZE; 2983d83b0603SJohn Fastabend } 2984d83b0603SJohn Fastabend 29853ff661c3SJohn Fastabend static inline size_t rtnl_fdb_nlmsg_size(void) 29863ff661c3SJohn Fastabend { 2987f82ef3e1SSabrina Dubroca return NLMSG_ALIGN(sizeof(struct ndmsg)) + 2988f82ef3e1SSabrina Dubroca nla_total_size(ETH_ALEN) + /* NDA_LLADDR */ 2989f82ef3e1SSabrina Dubroca nla_total_size(sizeof(u16)) + /* NDA_VLAN */ 2990f82ef3e1SSabrina Dubroca 0; 29913ff661c3SJohn Fastabend } 29923ff661c3SJohn Fastabend 2993b3379041SHubert Sokolowski static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type, 2994b3379041SHubert Sokolowski u16 ndm_state) 29953ff661c3SJohn Fastabend { 29963ff661c3SJohn Fastabend struct net *net = dev_net(dev); 29973ff661c3SJohn Fastabend struct sk_buff *skb; 29983ff661c3SJohn Fastabend int err = -ENOBUFS; 29993ff661c3SJohn Fastabend 30003ff661c3SJohn Fastabend skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC); 30013ff661c3SJohn Fastabend if (!skb) 30023ff661c3SJohn Fastabend goto errout; 30033ff661c3SJohn Fastabend 30041e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, addr, vid, 3005b3379041SHubert Sokolowski 0, 0, type, NTF_SELF, 0, ndm_state); 30063ff661c3SJohn Fastabend if (err < 0) { 30073ff661c3SJohn Fastabend kfree_skb(skb); 30083ff661c3SJohn Fastabend goto errout; 30093ff661c3SJohn Fastabend } 30103ff661c3SJohn Fastabend 30113ff661c3SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC); 30123ff661c3SJohn Fastabend return; 30133ff661c3SJohn Fastabend errout: 30143ff661c3SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_NEIGH, err); 30153ff661c3SJohn Fastabend } 30163ff661c3SJohn Fastabend 3017090096bfSVlad Yasevich /** 3018090096bfSVlad Yasevich * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry 3019090096bfSVlad Yasevich */ 3020090096bfSVlad Yasevich int ndo_dflt_fdb_add(struct ndmsg *ndm, 3021090096bfSVlad Yasevich struct nlattr *tb[], 3022090096bfSVlad Yasevich struct net_device *dev, 3023f6f6424bSJiri Pirko const unsigned char *addr, u16 vid, 3024090096bfSVlad Yasevich u16 flags) 3025090096bfSVlad Yasevich { 3026090096bfSVlad Yasevich int err = -EINVAL; 3027090096bfSVlad Yasevich 3028090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3029090096bfSVlad Yasevich * implement its own handler for this. 3030090096bfSVlad Yasevich */ 3031090096bfSVlad Yasevich if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) { 3032090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3033090096bfSVlad Yasevich return err; 3034090096bfSVlad Yasevich } 3035090096bfSVlad Yasevich 303665891feaSOr Gerlitz if (vid) { 303765891feaSOr Gerlitz pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name); 303865891feaSOr Gerlitz return err; 303965891feaSOr Gerlitz } 304065891feaSOr Gerlitz 3041090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3042090096bfSVlad Yasevich err = dev_uc_add_excl(dev, addr); 3043090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3044090096bfSVlad Yasevich err = dev_mc_add_excl(dev, addr); 3045090096bfSVlad Yasevich 3046090096bfSVlad Yasevich /* Only return duplicate errors if NLM_F_EXCL is set */ 3047090096bfSVlad Yasevich if (err == -EEXIST && !(flags & NLM_F_EXCL)) 3048090096bfSVlad Yasevich err = 0; 3049090096bfSVlad Yasevich 3050090096bfSVlad Yasevich return err; 3051090096bfSVlad Yasevich } 3052090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_add); 3053090096bfSVlad Yasevich 3054f6f6424bSJiri Pirko static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid) 3055f6f6424bSJiri Pirko { 3056f6f6424bSJiri Pirko u16 vid = 0; 3057f6f6424bSJiri Pirko 3058f6f6424bSJiri Pirko if (vlan_attr) { 3059f6f6424bSJiri Pirko if (nla_len(vlan_attr) != sizeof(u16)) { 3060f6f6424bSJiri Pirko pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan\n"); 3061f6f6424bSJiri Pirko return -EINVAL; 3062f6f6424bSJiri Pirko } 3063f6f6424bSJiri Pirko 3064f6f6424bSJiri Pirko vid = nla_get_u16(vlan_attr); 3065f6f6424bSJiri Pirko 3066f6f6424bSJiri Pirko if (!vid || vid >= VLAN_VID_MASK) { 3067f6f6424bSJiri Pirko pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan id %d\n", 3068f6f6424bSJiri Pirko vid); 3069f6f6424bSJiri Pirko return -EINVAL; 3070f6f6424bSJiri Pirko } 3071f6f6424bSJiri Pirko } 3072f6f6424bSJiri Pirko *p_vid = vid; 3073f6f6424bSJiri Pirko return 0; 3074f6f6424bSJiri Pirko } 3075f6f6424bSJiri Pirko 3076c21ef3e3SDavid Ahern static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh, 3077c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 307877162022SJohn Fastabend { 307977162022SJohn Fastabend struct net *net = sock_net(skb->sk); 308077162022SJohn Fastabend struct ndmsg *ndm; 308177162022SJohn Fastabend struct nlattr *tb[NDA_MAX+1]; 308277162022SJohn Fastabend struct net_device *dev; 308377162022SJohn Fastabend u8 *addr; 3084f6f6424bSJiri Pirko u16 vid; 308577162022SJohn Fastabend int err; 308677162022SJohn Fastabend 3087c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 308877162022SJohn Fastabend if (err < 0) 308977162022SJohn Fastabend return err; 309077162022SJohn Fastabend 309177162022SJohn Fastabend ndm = nlmsg_data(nlh); 309277162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 309377162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid ifindex\n"); 309477162022SJohn Fastabend return -EINVAL; 309577162022SJohn Fastabend } 309677162022SJohn Fastabend 309777162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 309877162022SJohn Fastabend if (dev == NULL) { 309977162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with unknown ifindex\n"); 310077162022SJohn Fastabend return -ENODEV; 310177162022SJohn Fastabend } 310277162022SJohn Fastabend 310377162022SJohn Fastabend if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 310477162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid address\n"); 310577162022SJohn Fastabend return -EINVAL; 310677162022SJohn Fastabend } 310777162022SJohn Fastabend 310877162022SJohn Fastabend addr = nla_data(tb[NDA_LLADDR]); 310977162022SJohn Fastabend 3110f6f6424bSJiri Pirko err = fdb_vid_parse(tb[NDA_VLAN], &vid); 3111f6f6424bSJiri Pirko if (err) 3112f6f6424bSJiri Pirko return err; 3113f6f6424bSJiri Pirko 311477162022SJohn Fastabend err = -EOPNOTSUPP; 311577162022SJohn Fastabend 311677162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 311777162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 311877162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3119898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3120898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 3121898e5061SJiri Pirko 3122f6f6424bSJiri Pirko err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid, 3123f6f6424bSJiri Pirko nlh->nlmsg_flags); 312477162022SJohn Fastabend if (err) 312577162022SJohn Fastabend goto out; 312677162022SJohn Fastabend else 312777162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 312877162022SJohn Fastabend } 312977162022SJohn Fastabend 313077162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3131090096bfSVlad Yasevich if ((ndm->ndm_flags & NTF_SELF)) { 3132090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_add) 3133090096bfSVlad Yasevich err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr, 3134f6f6424bSJiri Pirko vid, 3135090096bfSVlad Yasevich nlh->nlmsg_flags); 3136090096bfSVlad Yasevich else 3137f6f6424bSJiri Pirko err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, 313877162022SJohn Fastabend nlh->nlmsg_flags); 313977162022SJohn Fastabend 31403ff661c3SJohn Fastabend if (!err) { 3141b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH, 3142b3379041SHubert Sokolowski ndm->ndm_state); 314377162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 314477162022SJohn Fastabend } 31453ff661c3SJohn Fastabend } 314677162022SJohn Fastabend out: 314777162022SJohn Fastabend return err; 314877162022SJohn Fastabend } 314977162022SJohn Fastabend 3150090096bfSVlad Yasevich /** 3151090096bfSVlad Yasevich * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry 3152090096bfSVlad Yasevich */ 3153090096bfSVlad Yasevich int ndo_dflt_fdb_del(struct ndmsg *ndm, 3154090096bfSVlad Yasevich struct nlattr *tb[], 3155090096bfSVlad Yasevich struct net_device *dev, 3156f6f6424bSJiri Pirko const unsigned char *addr, u16 vid) 3157090096bfSVlad Yasevich { 3158c8a89c4aSAlexander Duyck int err = -EINVAL; 3159090096bfSVlad Yasevich 3160090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3161090096bfSVlad Yasevich * implement its own handler for this. 3162090096bfSVlad Yasevich */ 316364535993SSridhar Samudrala if (!(ndm->ndm_state & NUD_PERMANENT)) { 3164090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3165c8a89c4aSAlexander Duyck return err; 3166090096bfSVlad Yasevich } 3167090096bfSVlad Yasevich 3168090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3169090096bfSVlad Yasevich err = dev_uc_del(dev, addr); 3170090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3171090096bfSVlad Yasevich err = dev_mc_del(dev, addr); 3172090096bfSVlad Yasevich 3173090096bfSVlad Yasevich return err; 3174090096bfSVlad Yasevich } 3175090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_del); 3176090096bfSVlad Yasevich 3177c21ef3e3SDavid Ahern static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh, 3178c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 317977162022SJohn Fastabend { 318077162022SJohn Fastabend struct net *net = sock_net(skb->sk); 318177162022SJohn Fastabend struct ndmsg *ndm; 31821690be63SVlad Yasevich struct nlattr *tb[NDA_MAX+1]; 318377162022SJohn Fastabend struct net_device *dev; 318477162022SJohn Fastabend int err = -EINVAL; 318577162022SJohn Fastabend __u8 *addr; 3186f6f6424bSJiri Pirko u16 vid; 318777162022SJohn Fastabend 318890f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_NET_ADMIN)) 31891690be63SVlad Yasevich return -EPERM; 31901690be63SVlad Yasevich 3191c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 31921690be63SVlad Yasevich if (err < 0) 31931690be63SVlad Yasevich return err; 319477162022SJohn Fastabend 319577162022SJohn Fastabend ndm = nlmsg_data(nlh); 319677162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 319777162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_DELNEIGH with invalid ifindex\n"); 319877162022SJohn Fastabend return -EINVAL; 319977162022SJohn Fastabend } 320077162022SJohn Fastabend 320177162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 320277162022SJohn Fastabend if (dev == NULL) { 320377162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_DELNEIGH with unknown ifindex\n"); 320477162022SJohn Fastabend return -ENODEV; 320577162022SJohn Fastabend } 320677162022SJohn Fastabend 32071690be63SVlad Yasevich if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 32081690be63SVlad Yasevich pr_info("PF_BRIDGE: RTM_DELNEIGH with invalid address\n"); 320977162022SJohn Fastabend return -EINVAL; 321077162022SJohn Fastabend } 321177162022SJohn Fastabend 32121690be63SVlad Yasevich addr = nla_data(tb[NDA_LLADDR]); 32131690be63SVlad Yasevich 3214f6f6424bSJiri Pirko err = fdb_vid_parse(tb[NDA_VLAN], &vid); 3215f6f6424bSJiri Pirko if (err) 3216f6f6424bSJiri Pirko return err; 3217f6f6424bSJiri Pirko 321877162022SJohn Fastabend err = -EOPNOTSUPP; 321977162022SJohn Fastabend 322077162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 322177162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 322277162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3223898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3224898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 322577162022SJohn Fastabend 3226898e5061SJiri Pirko if (ops->ndo_fdb_del) 3227f6f6424bSJiri Pirko err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid); 322877162022SJohn Fastabend 322977162022SJohn Fastabend if (err) 323077162022SJohn Fastabend goto out; 323177162022SJohn Fastabend else 323277162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 323377162022SJohn Fastabend } 323477162022SJohn Fastabend 323577162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3236090096bfSVlad Yasevich if (ndm->ndm_flags & NTF_SELF) { 3237090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_del) 3238f6f6424bSJiri Pirko err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr, 3239f6f6424bSJiri Pirko vid); 3240090096bfSVlad Yasevich else 3241f6f6424bSJiri Pirko err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid); 324277162022SJohn Fastabend 32433ff661c3SJohn Fastabend if (!err) { 3244b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH, 3245b3379041SHubert Sokolowski ndm->ndm_state); 324677162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 324777162022SJohn Fastabend } 32483ff661c3SJohn Fastabend } 324977162022SJohn Fastabend out: 325077162022SJohn Fastabend return err; 325177162022SJohn Fastabend } 325277162022SJohn Fastabend 3253d83b0603SJohn Fastabend static int nlmsg_populate_fdb(struct sk_buff *skb, 3254d83b0603SJohn Fastabend struct netlink_callback *cb, 3255d83b0603SJohn Fastabend struct net_device *dev, 3256d83b0603SJohn Fastabend int *idx, 3257d83b0603SJohn Fastabend struct netdev_hw_addr_list *list) 3258d83b0603SJohn Fastabend { 3259d83b0603SJohn Fastabend struct netdev_hw_addr *ha; 3260d83b0603SJohn Fastabend int err; 326115e47304SEric W. Biederman u32 portid, seq; 3262d83b0603SJohn Fastabend 326315e47304SEric W. Biederman portid = NETLINK_CB(cb->skb).portid; 3264d83b0603SJohn Fastabend seq = cb->nlh->nlmsg_seq; 3265d83b0603SJohn Fastabend 3266d83b0603SJohn Fastabend list_for_each_entry(ha, &list->list, list) { 3267d297653dSRoopa Prabhu if (*idx < cb->args[2]) 3268d83b0603SJohn Fastabend goto skip; 3269d83b0603SJohn Fastabend 32701e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0, 3271a7a558feSJohn Fastabend portid, seq, 32721c104a6bSNicolas Dichtel RTM_NEWNEIGH, NTF_SELF, 3273b3379041SHubert Sokolowski NLM_F_MULTI, NUD_PERMANENT); 3274d83b0603SJohn Fastabend if (err < 0) 3275d83b0603SJohn Fastabend return err; 3276d83b0603SJohn Fastabend skip: 3277d83b0603SJohn Fastabend *idx += 1; 3278d83b0603SJohn Fastabend } 3279d83b0603SJohn Fastabend return 0; 3280d83b0603SJohn Fastabend } 3281d83b0603SJohn Fastabend 3282d83b0603SJohn Fastabend /** 32832c53040fSBen Hutchings * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table. 3284d83b0603SJohn Fastabend * @nlh: netlink message header 3285d83b0603SJohn Fastabend * @dev: netdevice 3286d83b0603SJohn Fastabend * 3287d83b0603SJohn Fastabend * Default netdevice operation to dump the existing unicast address list. 328891f3e7b1SJohn Fastabend * Returns number of addresses from list put in skb. 3289d83b0603SJohn Fastabend */ 3290d83b0603SJohn Fastabend int ndo_dflt_fdb_dump(struct sk_buff *skb, 3291d83b0603SJohn Fastabend struct netlink_callback *cb, 3292d83b0603SJohn Fastabend struct net_device *dev, 32935d5eacb3SJamal Hadi Salim struct net_device *filter_dev, 3294d297653dSRoopa Prabhu int *idx) 3295d83b0603SJohn Fastabend { 3296d83b0603SJohn Fastabend int err; 3297d83b0603SJohn Fastabend 3298d83b0603SJohn Fastabend netif_addr_lock_bh(dev); 3299d297653dSRoopa Prabhu err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc); 3300d83b0603SJohn Fastabend if (err) 3301d83b0603SJohn Fastabend goto out; 33022934c9dbSZhang Shengju err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc); 3303d83b0603SJohn Fastabend out: 3304d83b0603SJohn Fastabend netif_addr_unlock_bh(dev); 3305d297653dSRoopa Prabhu return err; 3306d83b0603SJohn Fastabend } 3307d83b0603SJohn Fastabend EXPORT_SYMBOL(ndo_dflt_fdb_dump); 3308d83b0603SJohn Fastabend 330977162022SJohn Fastabend static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb) 331077162022SJohn Fastabend { 331177162022SJohn Fastabend struct net_device *dev; 33125e6d2435SJamal Hadi Salim struct nlattr *tb[IFLA_MAX+1]; 33135e6d2435SJamal Hadi Salim struct net_device *br_dev = NULL; 33145e6d2435SJamal Hadi Salim const struct net_device_ops *ops = NULL; 33155e6d2435SJamal Hadi Salim const struct net_device_ops *cops = NULL; 33165e6d2435SJamal Hadi Salim struct ifinfomsg *ifm = nlmsg_data(cb->nlh); 33175e6d2435SJamal Hadi Salim struct net *net = sock_net(skb->sk); 3318d297653dSRoopa Prabhu struct hlist_head *head; 33195e6d2435SJamal Hadi Salim int brport_idx = 0; 33205e6d2435SJamal Hadi Salim int br_idx = 0; 3321d297653dSRoopa Prabhu int h, s_h; 3322d297653dSRoopa Prabhu int idx = 0, s_idx; 3323d297653dSRoopa Prabhu int err = 0; 3324d297653dSRoopa Prabhu int fidx = 0; 332577162022SJohn Fastabend 33260ff50e83SAlexander Potapenko err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb, 33270ff50e83SAlexander Potapenko IFLA_MAX, ifla_policy, NULL); 33280ff50e83SAlexander Potapenko if (err < 0) { 33290ff50e83SAlexander Potapenko return -EINVAL; 33300ff50e83SAlexander Potapenko } else if (err == 0) { 33315e6d2435SJamal Hadi Salim if (tb[IFLA_MASTER]) 33325e6d2435SJamal Hadi Salim br_idx = nla_get_u32(tb[IFLA_MASTER]); 33335e6d2435SJamal Hadi Salim } 333477162022SJohn Fastabend 33355e6d2435SJamal Hadi Salim brport_idx = ifm->ifi_index; 33365e6d2435SJamal Hadi Salim 33375e6d2435SJamal Hadi Salim if (br_idx) { 33385e6d2435SJamal Hadi Salim br_dev = __dev_get_by_index(net, br_idx); 33395e6d2435SJamal Hadi Salim if (!br_dev) 33405e6d2435SJamal Hadi Salim return -ENODEV; 33415e6d2435SJamal Hadi Salim 3342898e5061SJiri Pirko ops = br_dev->netdev_ops; 33435e6d2435SJamal Hadi Salim } 33445e6d2435SJamal Hadi Salim 3345d297653dSRoopa Prabhu s_h = cb->args[0]; 3346d297653dSRoopa Prabhu s_idx = cb->args[1]; 3347d297653dSRoopa Prabhu 3348d297653dSRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 3349d297653dSRoopa Prabhu idx = 0; 3350d297653dSRoopa Prabhu head = &net->dev_index_head[h]; 3351d297653dSRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 3352d297653dSRoopa Prabhu 33535e6d2435SJamal Hadi Salim if (brport_idx && (dev->ifindex != brport_idx)) 33545e6d2435SJamal Hadi Salim continue; 33555e6d2435SJamal Hadi Salim 33565e6d2435SJamal Hadi Salim if (!br_idx) { /* user did not specify a specific bridge */ 33575e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 33585e6d2435SJamal Hadi Salim br_dev = netdev_master_upper_dev_get(dev); 33595e6d2435SJamal Hadi Salim cops = br_dev->netdev_ops; 33605e6d2435SJamal Hadi Salim } 33615e6d2435SJamal Hadi Salim } else { 33625e6d2435SJamal Hadi Salim if (dev != br_dev && 33635e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_BRIDGE_PORT)) 33645e6d2435SJamal Hadi Salim continue; 33655e6d2435SJamal Hadi Salim 33665e6d2435SJamal Hadi Salim if (br_dev != netdev_master_upper_dev_get(dev) && 33675e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_EBRIDGE)) 33685e6d2435SJamal Hadi Salim continue; 33695e6d2435SJamal Hadi Salim cops = ops; 33705e6d2435SJamal Hadi Salim } 33715e6d2435SJamal Hadi Salim 3372d297653dSRoopa Prabhu if (idx < s_idx) 3373d297653dSRoopa Prabhu goto cont; 3374d297653dSRoopa Prabhu 33755e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 3376d297653dSRoopa Prabhu if (cops && cops->ndo_fdb_dump) { 3377d297653dSRoopa Prabhu err = cops->ndo_fdb_dump(skb, cb, 3378d297653dSRoopa Prabhu br_dev, dev, 3379d297653dSRoopa Prabhu &fidx); 3380d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3381d297653dSRoopa Prabhu goto out; 338277162022SJohn Fastabend } 3383d297653dSRoopa Prabhu } 338477162022SJohn Fastabend 33855e6d2435SJamal Hadi Salim if (dev->netdev_ops->ndo_fdb_dump) 3386d297653dSRoopa Prabhu err = dev->netdev_ops->ndo_fdb_dump(skb, cb, 3387d297653dSRoopa Prabhu dev, NULL, 3388d297653dSRoopa Prabhu &fidx); 33896cb69742SHubert Sokolowski else 3390d297653dSRoopa Prabhu err = ndo_dflt_fdb_dump(skb, cb, dev, NULL, 3391d297653dSRoopa Prabhu &fidx); 3392d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3393d297653dSRoopa Prabhu goto out; 33945e6d2435SJamal Hadi Salim 33955e6d2435SJamal Hadi Salim cops = NULL; 3396d297653dSRoopa Prabhu 3397d297653dSRoopa Prabhu /* reset fdb offset to 0 for rest of the interfaces */ 3398d297653dSRoopa Prabhu cb->args[2] = 0; 3399d297653dSRoopa Prabhu fidx = 0; 3400d297653dSRoopa Prabhu cont: 3401d297653dSRoopa Prabhu idx++; 3402d297653dSRoopa Prabhu } 340377162022SJohn Fastabend } 340477162022SJohn Fastabend 3405d297653dSRoopa Prabhu out: 3406d297653dSRoopa Prabhu cb->args[0] = h; 3407d297653dSRoopa Prabhu cb->args[1] = idx; 3408d297653dSRoopa Prabhu cb->args[2] = fidx; 3409d297653dSRoopa Prabhu 341077162022SJohn Fastabend return skb->len; 341177162022SJohn Fastabend } 341277162022SJohn Fastabend 34132c3c031cSScott Feldman static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask, 34142c3c031cSScott Feldman unsigned int attrnum, unsigned int flag) 34152c3c031cSScott Feldman { 34162c3c031cSScott Feldman if (mask & flag) 34172c3c031cSScott Feldman return nla_put_u8(skb, attrnum, !!(flags & flag)); 34182c3c031cSScott Feldman return 0; 34192c3c031cSScott Feldman } 34202c3c031cSScott Feldman 3421815cccbfSJohn Fastabend int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq, 34222c3c031cSScott Feldman struct net_device *dev, u16 mode, 34237d4f8d87SScott Feldman u32 flags, u32 mask, int nlflags, 34247d4f8d87SScott Feldman u32 filter_mask, 34257d4f8d87SScott Feldman int (*vlan_fill)(struct sk_buff *skb, 34267d4f8d87SScott Feldman struct net_device *dev, 34277d4f8d87SScott Feldman u32 filter_mask)) 3428815cccbfSJohn Fastabend { 3429815cccbfSJohn Fastabend struct nlmsghdr *nlh; 3430815cccbfSJohn Fastabend struct ifinfomsg *ifm; 3431815cccbfSJohn Fastabend struct nlattr *br_afspec; 34322c3c031cSScott Feldman struct nlattr *protinfo; 3433815cccbfSJohn Fastabend u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN; 3434898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 34357d4f8d87SScott Feldman int err = 0; 3436815cccbfSJohn Fastabend 343746c264daSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags); 3438815cccbfSJohn Fastabend if (nlh == NULL) 3439815cccbfSJohn Fastabend return -EMSGSIZE; 3440815cccbfSJohn Fastabend 3441815cccbfSJohn Fastabend ifm = nlmsg_data(nlh); 3442815cccbfSJohn Fastabend ifm->ifi_family = AF_BRIDGE; 3443815cccbfSJohn Fastabend ifm->__ifi_pad = 0; 3444815cccbfSJohn Fastabend ifm->ifi_type = dev->type; 3445815cccbfSJohn Fastabend ifm->ifi_index = dev->ifindex; 3446815cccbfSJohn Fastabend ifm->ifi_flags = dev_get_flags(dev); 3447815cccbfSJohn Fastabend ifm->ifi_change = 0; 3448815cccbfSJohn Fastabend 3449815cccbfSJohn Fastabend 3450815cccbfSJohn Fastabend if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 3451815cccbfSJohn Fastabend nla_put_u32(skb, IFLA_MTU, dev->mtu) || 3452815cccbfSJohn Fastabend nla_put_u8(skb, IFLA_OPERSTATE, operstate) || 3453898e5061SJiri Pirko (br_dev && 3454898e5061SJiri Pirko nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) || 3455815cccbfSJohn Fastabend (dev->addr_len && 3456815cccbfSJohn Fastabend nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) || 3457a54acb3aSNicolas Dichtel (dev->ifindex != dev_get_iflink(dev) && 3458a54acb3aSNicolas Dichtel nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev)))) 3459815cccbfSJohn Fastabend goto nla_put_failure; 3460815cccbfSJohn Fastabend 3461815cccbfSJohn Fastabend br_afspec = nla_nest_start(skb, IFLA_AF_SPEC); 3462815cccbfSJohn Fastabend if (!br_afspec) 3463815cccbfSJohn Fastabend goto nla_put_failure; 3464815cccbfSJohn Fastabend 34651d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) { 3466815cccbfSJohn Fastabend nla_nest_cancel(skb, br_afspec); 3467815cccbfSJohn Fastabend goto nla_put_failure; 3468815cccbfSJohn Fastabend } 34691d460b98SRoopa Prabhu 34701d460b98SRoopa Prabhu if (mode != BRIDGE_MODE_UNDEF) { 34711d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) { 34721d460b98SRoopa Prabhu nla_nest_cancel(skb, br_afspec); 34731d460b98SRoopa Prabhu goto nla_put_failure; 34741d460b98SRoopa Prabhu } 34751d460b98SRoopa Prabhu } 34767d4f8d87SScott Feldman if (vlan_fill) { 34777d4f8d87SScott Feldman err = vlan_fill(skb, dev, filter_mask); 34787d4f8d87SScott Feldman if (err) { 34797d4f8d87SScott Feldman nla_nest_cancel(skb, br_afspec); 34807d4f8d87SScott Feldman goto nla_put_failure; 34817d4f8d87SScott Feldman } 34827d4f8d87SScott Feldman } 3483815cccbfSJohn Fastabend nla_nest_end(skb, br_afspec); 3484815cccbfSJohn Fastabend 34852c3c031cSScott Feldman protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED); 34862c3c031cSScott Feldman if (!protinfo) 34872c3c031cSScott Feldman goto nla_put_failure; 34882c3c031cSScott Feldman 34892c3c031cSScott Feldman if (brport_nla_put_flag(skb, flags, mask, 34902c3c031cSScott Feldman IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) || 34912c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34922c3c031cSScott Feldman IFLA_BRPORT_GUARD, BR_BPDU_GUARD) || 34932c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34942c3c031cSScott Feldman IFLA_BRPORT_FAST_LEAVE, 34952c3c031cSScott Feldman BR_MULTICAST_FAST_LEAVE) || 34962c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34972c3c031cSScott Feldman IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) || 34982c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34992c3c031cSScott Feldman IFLA_BRPORT_LEARNING, BR_LEARNING) || 35002c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 35012c3c031cSScott Feldman IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) || 35022c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 35032c3c031cSScott Feldman IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) || 35042c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 35052c3c031cSScott Feldman IFLA_BRPORT_PROXYARP, BR_PROXYARP)) { 35062c3c031cSScott Feldman nla_nest_cancel(skb, protinfo); 35072c3c031cSScott Feldman goto nla_put_failure; 35082c3c031cSScott Feldman } 35092c3c031cSScott Feldman 35102c3c031cSScott Feldman nla_nest_end(skb, protinfo); 35112c3c031cSScott Feldman 3512053c095aSJohannes Berg nlmsg_end(skb, nlh); 3513053c095aSJohannes Berg return 0; 3514815cccbfSJohn Fastabend nla_put_failure: 3515815cccbfSJohn Fastabend nlmsg_cancel(skb, nlh); 35167d4f8d87SScott Feldman return err ? err : -EMSGSIZE; 3517815cccbfSJohn Fastabend } 35187d4f8d87SScott Feldman EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink); 3519815cccbfSJohn Fastabend 3520e5a55a89SJohn Fastabend static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb) 3521e5a55a89SJohn Fastabend { 3522e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3523e5a55a89SJohn Fastabend struct net_device *dev; 3524e5a55a89SJohn Fastabend int idx = 0; 3525e5a55a89SJohn Fastabend u32 portid = NETLINK_CB(cb->skb).portid; 3526e5a55a89SJohn Fastabend u32 seq = cb->nlh->nlmsg_seq; 35276cbdceebSVlad Yasevich u32 filter_mask = 0; 3528d64f69b0SRoopa Prabhu int err; 35296cbdceebSVlad Yasevich 3530aa68c20fSThomas Graf if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) { 3531aa68c20fSThomas Graf struct nlattr *extfilt; 3532aa68c20fSThomas Graf 35333e805ad2SAsbjoern Sloth Toennesen extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg), 35346cbdceebSVlad Yasevich IFLA_EXT_MASK); 3535aa68c20fSThomas Graf if (extfilt) { 3536aa68c20fSThomas Graf if (nla_len(extfilt) < sizeof(filter_mask)) 3537aa68c20fSThomas Graf return -EINVAL; 3538aa68c20fSThomas Graf 35396cbdceebSVlad Yasevich filter_mask = nla_get_u32(extfilt); 3540aa68c20fSThomas Graf } 3541aa68c20fSThomas Graf } 3542e5a55a89SJohn Fastabend 3543e5a55a89SJohn Fastabend rcu_read_lock(); 3544e5a55a89SJohn Fastabend for_each_netdev_rcu(net, dev) { 3545e5a55a89SJohn Fastabend const struct net_device_ops *ops = dev->netdev_ops; 3546898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3547e5a55a89SJohn Fastabend 3548898e5061SJiri Pirko if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) { 3549d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3550d64f69b0SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_getlink( 3551d64f69b0SRoopa Prabhu skb, portid, seq, dev, 3552d64f69b0SRoopa Prabhu filter_mask, NLM_F_MULTI); 3553f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3554f6c5775fSDavid Ahern if (likely(skb->len)) 3555e5a55a89SJohn Fastabend break; 3556f6c5775fSDavid Ahern 3557f6c5775fSDavid Ahern goto out_err; 3558f6c5775fSDavid Ahern } 3559d64f69b0SRoopa Prabhu } 3560e5a55a89SJohn Fastabend idx++; 3561e5a55a89SJohn Fastabend } 3562e5a55a89SJohn Fastabend 3563e5a55a89SJohn Fastabend if (ops->ndo_bridge_getlink) { 3564d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3565d64f69b0SRoopa Prabhu err = ops->ndo_bridge_getlink(skb, portid, 3566d64f69b0SRoopa Prabhu seq, dev, 356746c264daSNicolas Dichtel filter_mask, 3568d64f69b0SRoopa Prabhu NLM_F_MULTI); 3569f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3570f6c5775fSDavid Ahern if (likely(skb->len)) 3571e5a55a89SJohn Fastabend break; 3572f6c5775fSDavid Ahern 3573f6c5775fSDavid Ahern goto out_err; 3574f6c5775fSDavid Ahern } 3575d64f69b0SRoopa Prabhu } 3576e5a55a89SJohn Fastabend idx++; 3577e5a55a89SJohn Fastabend } 3578e5a55a89SJohn Fastabend } 3579f6c5775fSDavid Ahern err = skb->len; 3580f6c5775fSDavid Ahern out_err: 3581e5a55a89SJohn Fastabend rcu_read_unlock(); 3582e5a55a89SJohn Fastabend cb->args[0] = idx; 3583e5a55a89SJohn Fastabend 3584f6c5775fSDavid Ahern return err; 3585e5a55a89SJohn Fastabend } 3586e5a55a89SJohn Fastabend 35872469ffd7SJohn Fastabend static inline size_t bridge_nlmsg_size(void) 35882469ffd7SJohn Fastabend { 35892469ffd7SJohn Fastabend return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 35902469ffd7SJohn Fastabend + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 35912469ffd7SJohn Fastabend + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 35922469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MASTER */ 35932469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MTU */ 35942469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_LINK */ 35952469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_OPERSTATE */ 35962469ffd7SJohn Fastabend + nla_total_size(sizeof(u8)) /* IFLA_PROTINFO */ 35972469ffd7SJohn Fastabend + nla_total_size(sizeof(struct nlattr)) /* IFLA_AF_SPEC */ 35982469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)) /* IFLA_BRIDGE_FLAGS */ 35992469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_MODE */ 36002469ffd7SJohn Fastabend } 36012469ffd7SJohn Fastabend 360202dba438SRoopa Prabhu static int rtnl_bridge_notify(struct net_device *dev) 36032469ffd7SJohn Fastabend { 36042469ffd7SJohn Fastabend struct net *net = dev_net(dev); 36052469ffd7SJohn Fastabend struct sk_buff *skb; 36062469ffd7SJohn Fastabend int err = -EOPNOTSUPP; 36072469ffd7SJohn Fastabend 360802dba438SRoopa Prabhu if (!dev->netdev_ops->ndo_bridge_getlink) 360902dba438SRoopa Prabhu return 0; 361002dba438SRoopa Prabhu 36112469ffd7SJohn Fastabend skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC); 36122469ffd7SJohn Fastabend if (!skb) { 36132469ffd7SJohn Fastabend err = -ENOMEM; 36142469ffd7SJohn Fastabend goto errout; 36152469ffd7SJohn Fastabend } 36162469ffd7SJohn Fastabend 361746c264daSNicolas Dichtel err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0); 3618c38e01b8SJohn Fastabend if (err < 0) 3619c38e01b8SJohn Fastabend goto errout; 36202469ffd7SJohn Fastabend 362159ccaaaaSRoopa Prabhu if (!skb->len) 362259ccaaaaSRoopa Prabhu goto errout; 362359ccaaaaSRoopa Prabhu 36242469ffd7SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC); 36252469ffd7SJohn Fastabend return 0; 36262469ffd7SJohn Fastabend errout: 36272469ffd7SJohn Fastabend WARN_ON(err == -EMSGSIZE); 36282469ffd7SJohn Fastabend kfree_skb(skb); 362959ccaaaaSRoopa Prabhu if (err) 36302469ffd7SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_LINK, err); 36312469ffd7SJohn Fastabend return err; 36322469ffd7SJohn Fastabend } 36332469ffd7SJohn Fastabend 3634c21ef3e3SDavid Ahern static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3635c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3636e5a55a89SJohn Fastabend { 3637e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3638e5a55a89SJohn Fastabend struct ifinfomsg *ifm; 3639e5a55a89SJohn Fastabend struct net_device *dev; 36402469ffd7SJohn Fastabend struct nlattr *br_spec, *attr = NULL; 36412469ffd7SJohn Fastabend int rem, err = -EOPNOTSUPP; 36424de8b413SRosen, Rami u16 flags = 0; 3643c38e01b8SJohn Fastabend bool have_flags = false; 3644e5a55a89SJohn Fastabend 3645e5a55a89SJohn Fastabend if (nlmsg_len(nlh) < sizeof(*ifm)) 3646e5a55a89SJohn Fastabend return -EINVAL; 3647e5a55a89SJohn Fastabend 3648e5a55a89SJohn Fastabend ifm = nlmsg_data(nlh); 3649e5a55a89SJohn Fastabend if (ifm->ifi_family != AF_BRIDGE) 3650e5a55a89SJohn Fastabend return -EPFNOSUPPORT; 3651e5a55a89SJohn Fastabend 3652e5a55a89SJohn Fastabend dev = __dev_get_by_index(net, ifm->ifi_index); 3653e5a55a89SJohn Fastabend if (!dev) { 3654e5a55a89SJohn Fastabend pr_info("PF_BRIDGE: RTM_SETLINK with unknown ifindex\n"); 3655e5a55a89SJohn Fastabend return -ENODEV; 3656e5a55a89SJohn Fastabend } 3657e5a55a89SJohn Fastabend 36582469ffd7SJohn Fastabend br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 36592469ffd7SJohn Fastabend if (br_spec) { 36602469ffd7SJohn Fastabend nla_for_each_nested(attr, br_spec, rem) { 36612469ffd7SJohn Fastabend if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 36626e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 36636e8d1c55SThomas Graf return -EINVAL; 36646e8d1c55SThomas Graf 3665c38e01b8SJohn Fastabend have_flags = true; 36662469ffd7SJohn Fastabend flags = nla_get_u16(attr); 36672469ffd7SJohn Fastabend break; 36682469ffd7SJohn Fastabend } 36692469ffd7SJohn Fastabend } 36702469ffd7SJohn Fastabend } 36712469ffd7SJohn Fastabend 36722469ffd7SJohn Fastabend if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3673898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3674898e5061SJiri Pirko 3675898e5061SJiri Pirko if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) { 36762469ffd7SJohn Fastabend err = -EOPNOTSUPP; 3677e5a55a89SJohn Fastabend goto out; 3678e5a55a89SJohn Fastabend } 3679e5a55a89SJohn Fastabend 3680add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags); 36812469ffd7SJohn Fastabend if (err) 36822469ffd7SJohn Fastabend goto out; 36832469ffd7SJohn Fastabend 36842469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_MASTER; 36852469ffd7SJohn Fastabend } 36862469ffd7SJohn Fastabend 36872469ffd7SJohn Fastabend if ((flags & BRIDGE_FLAGS_SELF)) { 36882469ffd7SJohn Fastabend if (!dev->netdev_ops->ndo_bridge_setlink) 36892469ffd7SJohn Fastabend err = -EOPNOTSUPP; 36902469ffd7SJohn Fastabend else 3691add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh, 3692add511b3SRoopa Prabhu flags); 369302dba438SRoopa Prabhu if (!err) { 36942469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_SELF; 369502dba438SRoopa Prabhu 369602dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 369702dba438SRoopa Prabhu * change 369802dba438SRoopa Prabhu */ 369902dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 370002dba438SRoopa Prabhu } 37012469ffd7SJohn Fastabend } 37022469ffd7SJohn Fastabend 3703c38e01b8SJohn Fastabend if (have_flags) 37042469ffd7SJohn Fastabend memcpy(nla_data(attr), &flags, sizeof(flags)); 3705e5a55a89SJohn Fastabend out: 3706e5a55a89SJohn Fastabend return err; 3707e5a55a89SJohn Fastabend } 3708e5a55a89SJohn Fastabend 3709c21ef3e3SDavid Ahern static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 3710c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3711407af329SVlad Yasevich { 3712407af329SVlad Yasevich struct net *net = sock_net(skb->sk); 3713407af329SVlad Yasevich struct ifinfomsg *ifm; 3714407af329SVlad Yasevich struct net_device *dev; 3715407af329SVlad Yasevich struct nlattr *br_spec, *attr = NULL; 3716407af329SVlad Yasevich int rem, err = -EOPNOTSUPP; 37174de8b413SRosen, Rami u16 flags = 0; 3718407af329SVlad Yasevich bool have_flags = false; 3719407af329SVlad Yasevich 3720407af329SVlad Yasevich if (nlmsg_len(nlh) < sizeof(*ifm)) 3721407af329SVlad Yasevich return -EINVAL; 3722407af329SVlad Yasevich 3723407af329SVlad Yasevich ifm = nlmsg_data(nlh); 3724407af329SVlad Yasevich if (ifm->ifi_family != AF_BRIDGE) 3725407af329SVlad Yasevich return -EPFNOSUPPORT; 3726407af329SVlad Yasevich 3727407af329SVlad Yasevich dev = __dev_get_by_index(net, ifm->ifi_index); 3728407af329SVlad Yasevich if (!dev) { 3729407af329SVlad Yasevich pr_info("PF_BRIDGE: RTM_SETLINK with unknown ifindex\n"); 3730407af329SVlad Yasevich return -ENODEV; 3731407af329SVlad Yasevich } 3732407af329SVlad Yasevich 3733407af329SVlad Yasevich br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 3734407af329SVlad Yasevich if (br_spec) { 3735407af329SVlad Yasevich nla_for_each_nested(attr, br_spec, rem) { 3736407af329SVlad Yasevich if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 37376e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 37386e8d1c55SThomas Graf return -EINVAL; 37396e8d1c55SThomas Graf 3740407af329SVlad Yasevich have_flags = true; 3741407af329SVlad Yasevich flags = nla_get_u16(attr); 3742407af329SVlad Yasevich break; 3743407af329SVlad Yasevich } 3744407af329SVlad Yasevich } 3745407af329SVlad Yasevich } 3746407af329SVlad Yasevich 3747407af329SVlad Yasevich if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3748407af329SVlad Yasevich struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3749407af329SVlad Yasevich 3750407af329SVlad Yasevich if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) { 3751407af329SVlad Yasevich err = -EOPNOTSUPP; 3752407af329SVlad Yasevich goto out; 3753407af329SVlad Yasevich } 3754407af329SVlad Yasevich 3755add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags); 3756407af329SVlad Yasevich if (err) 3757407af329SVlad Yasevich goto out; 3758407af329SVlad Yasevich 3759407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_MASTER; 3760407af329SVlad Yasevich } 3761407af329SVlad Yasevich 3762407af329SVlad Yasevich if ((flags & BRIDGE_FLAGS_SELF)) { 3763407af329SVlad Yasevich if (!dev->netdev_ops->ndo_bridge_dellink) 3764407af329SVlad Yasevich err = -EOPNOTSUPP; 3765407af329SVlad Yasevich else 3766add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh, 3767add511b3SRoopa Prabhu flags); 3768407af329SVlad Yasevich 376902dba438SRoopa Prabhu if (!err) { 3770407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_SELF; 377102dba438SRoopa Prabhu 377202dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 377302dba438SRoopa Prabhu * change 377402dba438SRoopa Prabhu */ 377502dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 377602dba438SRoopa Prabhu } 3777407af329SVlad Yasevich } 3778407af329SVlad Yasevich 3779407af329SVlad Yasevich if (have_flags) 3780407af329SVlad Yasevich memcpy(nla_data(attr), &flags, sizeof(flags)); 3781407af329SVlad Yasevich out: 3782407af329SVlad Yasevich return err; 3783407af329SVlad Yasevich } 3784407af329SVlad Yasevich 3785e8872a25SNikolay Aleksandrov static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr) 3786e8872a25SNikolay Aleksandrov { 3787e8872a25SNikolay Aleksandrov return (mask & IFLA_STATS_FILTER_BIT(attrid)) && 3788e8872a25SNikolay Aleksandrov (!idxattr || idxattr == attrid); 3789e8872a25SNikolay Aleksandrov } 3790e8872a25SNikolay Aleksandrov 379169ae6ad2SNogah Frankel #define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1) 379269ae6ad2SNogah Frankel static int rtnl_get_offload_stats_attr_size(int attr_id) 379369ae6ad2SNogah Frankel { 379469ae6ad2SNogah Frankel switch (attr_id) { 379569ae6ad2SNogah Frankel case IFLA_OFFLOAD_XSTATS_CPU_HIT: 379669ae6ad2SNogah Frankel return sizeof(struct rtnl_link_stats64); 379769ae6ad2SNogah Frankel } 379869ae6ad2SNogah Frankel 379969ae6ad2SNogah Frankel return 0; 380069ae6ad2SNogah Frankel } 380169ae6ad2SNogah Frankel 380269ae6ad2SNogah Frankel static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev, 380369ae6ad2SNogah Frankel int *prividx) 380469ae6ad2SNogah Frankel { 380569ae6ad2SNogah Frankel struct nlattr *attr = NULL; 380669ae6ad2SNogah Frankel int attr_id, size; 380769ae6ad2SNogah Frankel void *attr_data; 380869ae6ad2SNogah Frankel int err; 380969ae6ad2SNogah Frankel 381069ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 381169ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 381269ae6ad2SNogah Frankel return -ENODATA; 381369ae6ad2SNogah Frankel 381469ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 381569ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 381669ae6ad2SNogah Frankel if (attr_id < *prividx) 381769ae6ad2SNogah Frankel continue; 381869ae6ad2SNogah Frankel 381969ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 382069ae6ad2SNogah Frankel if (!size) 382169ae6ad2SNogah Frankel continue; 382269ae6ad2SNogah Frankel 38233df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 382469ae6ad2SNogah Frankel continue; 382569ae6ad2SNogah Frankel 382669ae6ad2SNogah Frankel attr = nla_reserve_64bit(skb, attr_id, size, 382769ae6ad2SNogah Frankel IFLA_OFFLOAD_XSTATS_UNSPEC); 382869ae6ad2SNogah Frankel if (!attr) 382969ae6ad2SNogah Frankel goto nla_put_failure; 383069ae6ad2SNogah Frankel 383169ae6ad2SNogah Frankel attr_data = nla_data(attr); 383269ae6ad2SNogah Frankel memset(attr_data, 0, size); 383369ae6ad2SNogah Frankel err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev, 383469ae6ad2SNogah Frankel attr_data); 383569ae6ad2SNogah Frankel if (err) 383669ae6ad2SNogah Frankel goto get_offload_stats_failure; 383769ae6ad2SNogah Frankel } 383869ae6ad2SNogah Frankel 383969ae6ad2SNogah Frankel if (!attr) 384069ae6ad2SNogah Frankel return -ENODATA; 384169ae6ad2SNogah Frankel 384269ae6ad2SNogah Frankel *prividx = 0; 384369ae6ad2SNogah Frankel return 0; 384469ae6ad2SNogah Frankel 384569ae6ad2SNogah Frankel nla_put_failure: 384669ae6ad2SNogah Frankel err = -EMSGSIZE; 384769ae6ad2SNogah Frankel get_offload_stats_failure: 384869ae6ad2SNogah Frankel *prividx = attr_id; 384969ae6ad2SNogah Frankel return err; 385069ae6ad2SNogah Frankel } 385169ae6ad2SNogah Frankel 385269ae6ad2SNogah Frankel static int rtnl_get_offload_stats_size(const struct net_device *dev) 385369ae6ad2SNogah Frankel { 385469ae6ad2SNogah Frankel int nla_size = 0; 385569ae6ad2SNogah Frankel int attr_id; 385669ae6ad2SNogah Frankel int size; 385769ae6ad2SNogah Frankel 385869ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 385969ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 386069ae6ad2SNogah Frankel return 0; 386169ae6ad2SNogah Frankel 386269ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 386369ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 38643df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 386569ae6ad2SNogah Frankel continue; 386669ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 386769ae6ad2SNogah Frankel nla_size += nla_total_size_64bit(size); 386869ae6ad2SNogah Frankel } 386969ae6ad2SNogah Frankel 387069ae6ad2SNogah Frankel if (nla_size != 0) 387169ae6ad2SNogah Frankel nla_size += nla_total_size(0); 387269ae6ad2SNogah Frankel 387369ae6ad2SNogah Frankel return nla_size; 387469ae6ad2SNogah Frankel } 387569ae6ad2SNogah Frankel 387610c9ead9SRoopa Prabhu static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev, 387710c9ead9SRoopa Prabhu int type, u32 pid, u32 seq, u32 change, 3878e8872a25SNikolay Aleksandrov unsigned int flags, unsigned int filter_mask, 3879e8872a25SNikolay Aleksandrov int *idxattr, int *prividx) 388010c9ead9SRoopa Prabhu { 388110c9ead9SRoopa Prabhu struct if_stats_msg *ifsm; 388210c9ead9SRoopa Prabhu struct nlmsghdr *nlh; 388310c9ead9SRoopa Prabhu struct nlattr *attr; 3884e8872a25SNikolay Aleksandrov int s_prividx = *prividx; 388569ae6ad2SNogah Frankel int err; 388610c9ead9SRoopa Prabhu 388710c9ead9SRoopa Prabhu ASSERT_RTNL(); 388810c9ead9SRoopa Prabhu 388910c9ead9SRoopa Prabhu nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags); 389010c9ead9SRoopa Prabhu if (!nlh) 389110c9ead9SRoopa Prabhu return -EMSGSIZE; 389210c9ead9SRoopa Prabhu 389310c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 389410c9ead9SRoopa Prabhu ifsm->ifindex = dev->ifindex; 389510c9ead9SRoopa Prabhu ifsm->filter_mask = filter_mask; 389610c9ead9SRoopa Prabhu 3897e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) { 389810c9ead9SRoopa Prabhu struct rtnl_link_stats64 *sp; 389910c9ead9SRoopa Prabhu 390058414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64, 390158414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), 390258414d32SNicolas Dichtel IFLA_STATS_UNSPEC); 390310c9ead9SRoopa Prabhu if (!attr) 390410c9ead9SRoopa Prabhu goto nla_put_failure; 390510c9ead9SRoopa Prabhu 390610c9ead9SRoopa Prabhu sp = nla_data(attr); 390710c9ead9SRoopa Prabhu dev_get_stats(dev, sp); 390810c9ead9SRoopa Prabhu } 390910c9ead9SRoopa Prabhu 391097a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) { 391197a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 391297a47facSNikolay Aleksandrov 391397a47facSNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 391497a47facSNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS; 391597a47facSNikolay Aleksandrov attr = nla_nest_start(skb, 391697a47facSNikolay Aleksandrov IFLA_STATS_LINK_XSTATS); 391797a47facSNikolay Aleksandrov if (!attr) 391897a47facSNikolay Aleksandrov goto nla_put_failure; 391997a47facSNikolay Aleksandrov 392080e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 392180e73cc5SNikolay Aleksandrov nla_nest_end(skb, attr); 392280e73cc5SNikolay Aleksandrov if (err) 392380e73cc5SNikolay Aleksandrov goto nla_put_failure; 392480e73cc5SNikolay Aleksandrov *idxattr = 0; 392580e73cc5SNikolay Aleksandrov } 392680e73cc5SNikolay Aleksandrov } 392780e73cc5SNikolay Aleksandrov 392880e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 392980e73cc5SNikolay Aleksandrov *idxattr)) { 393080e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 393180e73cc5SNikolay Aleksandrov const struct net_device *master; 393280e73cc5SNikolay Aleksandrov 393380e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(dev); 393480e73cc5SNikolay Aleksandrov if (master) 393580e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 393680e73cc5SNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 393780e73cc5SNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS_SLAVE; 393880e73cc5SNikolay Aleksandrov attr = nla_nest_start(skb, 393980e73cc5SNikolay Aleksandrov IFLA_STATS_LINK_XSTATS_SLAVE); 394080e73cc5SNikolay Aleksandrov if (!attr) 394180e73cc5SNikolay Aleksandrov goto nla_put_failure; 394280e73cc5SNikolay Aleksandrov 394380e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 394497a47facSNikolay Aleksandrov nla_nest_end(skb, attr); 394597a47facSNikolay Aleksandrov if (err) 394697a47facSNikolay Aleksandrov goto nla_put_failure; 394797a47facSNikolay Aleksandrov *idxattr = 0; 394897a47facSNikolay Aleksandrov } 394997a47facSNikolay Aleksandrov } 395097a47facSNikolay Aleksandrov 395169ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 395269ae6ad2SNogah Frankel *idxattr)) { 395369ae6ad2SNogah Frankel *idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS; 395469ae6ad2SNogah Frankel attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS); 395569ae6ad2SNogah Frankel if (!attr) 395669ae6ad2SNogah Frankel goto nla_put_failure; 395769ae6ad2SNogah Frankel 395869ae6ad2SNogah Frankel err = rtnl_get_offload_stats(skb, dev, prividx); 395969ae6ad2SNogah Frankel if (err == -ENODATA) 396069ae6ad2SNogah Frankel nla_nest_cancel(skb, attr); 396169ae6ad2SNogah Frankel else 396269ae6ad2SNogah Frankel nla_nest_end(skb, attr); 396369ae6ad2SNogah Frankel 396469ae6ad2SNogah Frankel if (err && err != -ENODATA) 396569ae6ad2SNogah Frankel goto nla_put_failure; 396669ae6ad2SNogah Frankel *idxattr = 0; 396769ae6ad2SNogah Frankel } 396869ae6ad2SNogah Frankel 3969aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) { 3970aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 3971aefb4d4aSRobert Shearman 3972aefb4d4aSRobert Shearman *idxattr = IFLA_STATS_AF_SPEC; 3973aefb4d4aSRobert Shearman attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC); 3974aefb4d4aSRobert Shearman if (!attr) 3975aefb4d4aSRobert Shearman goto nla_put_failure; 3976aefb4d4aSRobert Shearman 3977aefb4d4aSRobert Shearman list_for_each_entry(af_ops, &rtnl_af_ops, list) { 3978aefb4d4aSRobert Shearman if (af_ops->fill_stats_af) { 3979aefb4d4aSRobert Shearman struct nlattr *af; 3980aefb4d4aSRobert Shearman int err; 3981aefb4d4aSRobert Shearman 3982aefb4d4aSRobert Shearman af = nla_nest_start(skb, af_ops->family); 3983aefb4d4aSRobert Shearman if (!af) 3984aefb4d4aSRobert Shearman goto nla_put_failure; 3985aefb4d4aSRobert Shearman 3986aefb4d4aSRobert Shearman err = af_ops->fill_stats_af(skb, dev); 3987aefb4d4aSRobert Shearman 3988aefb4d4aSRobert Shearman if (err == -ENODATA) 3989aefb4d4aSRobert Shearman nla_nest_cancel(skb, af); 3990aefb4d4aSRobert Shearman else if (err < 0) 3991aefb4d4aSRobert Shearman goto nla_put_failure; 3992aefb4d4aSRobert Shearman 3993aefb4d4aSRobert Shearman nla_nest_end(skb, af); 3994aefb4d4aSRobert Shearman } 3995aefb4d4aSRobert Shearman } 3996aefb4d4aSRobert Shearman 3997aefb4d4aSRobert Shearman nla_nest_end(skb, attr); 3998aefb4d4aSRobert Shearman 3999aefb4d4aSRobert Shearman *idxattr = 0; 4000aefb4d4aSRobert Shearman } 4001aefb4d4aSRobert Shearman 400210c9ead9SRoopa Prabhu nlmsg_end(skb, nlh); 400310c9ead9SRoopa Prabhu 400410c9ead9SRoopa Prabhu return 0; 400510c9ead9SRoopa Prabhu 400610c9ead9SRoopa Prabhu nla_put_failure: 4007e8872a25SNikolay Aleksandrov /* not a multi message or no progress mean a real error */ 4008e8872a25SNikolay Aleksandrov if (!(flags & NLM_F_MULTI) || s_prividx == *prividx) 400910c9ead9SRoopa Prabhu nlmsg_cancel(skb, nlh); 4010e8872a25SNikolay Aleksandrov else 4011e8872a25SNikolay Aleksandrov nlmsg_end(skb, nlh); 401210c9ead9SRoopa Prabhu 401310c9ead9SRoopa Prabhu return -EMSGSIZE; 401410c9ead9SRoopa Prabhu } 401510c9ead9SRoopa Prabhu 401610c9ead9SRoopa Prabhu static size_t if_nlmsg_stats_size(const struct net_device *dev, 401710c9ead9SRoopa Prabhu u32 filter_mask) 401810c9ead9SRoopa Prabhu { 401910c9ead9SRoopa Prabhu size_t size = 0; 402010c9ead9SRoopa Prabhu 4021e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0)) 402210c9ead9SRoopa Prabhu size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64)); 402310c9ead9SRoopa Prabhu 402497a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) { 402597a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 402680e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS; 402797a47facSNikolay Aleksandrov 402897a47facSNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 402980e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 403080e73cc5SNikolay Aleksandrov attr)); 403197a47facSNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS */ 403297a47facSNikolay Aleksandrov size += nla_total_size(0); 403397a47facSNikolay Aleksandrov } 403497a47facSNikolay Aleksandrov } 403597a47facSNikolay Aleksandrov 403680e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) { 403780e73cc5SNikolay Aleksandrov struct net_device *_dev = (struct net_device *)dev; 403880e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 403980e73cc5SNikolay Aleksandrov const struct net_device *master; 404080e73cc5SNikolay Aleksandrov 404180e73cc5SNikolay Aleksandrov /* netdev_master_upper_dev_get can't take const */ 404280e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(_dev); 404380e73cc5SNikolay Aleksandrov if (master) 404480e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 404580e73cc5SNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 404680e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS_SLAVE; 404780e73cc5SNikolay Aleksandrov 404880e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 404980e73cc5SNikolay Aleksandrov attr)); 405080e73cc5SNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS_SLAVE */ 405180e73cc5SNikolay Aleksandrov size += nla_total_size(0); 405280e73cc5SNikolay Aleksandrov } 405380e73cc5SNikolay Aleksandrov } 405480e73cc5SNikolay Aleksandrov 405569ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0)) 405669ae6ad2SNogah Frankel size += rtnl_get_offload_stats_size(dev); 405769ae6ad2SNogah Frankel 4058aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) { 4059aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 4060aefb4d4aSRobert Shearman 4061aefb4d4aSRobert Shearman /* for IFLA_STATS_AF_SPEC */ 4062aefb4d4aSRobert Shearman size += nla_total_size(0); 4063aefb4d4aSRobert Shearman 4064aefb4d4aSRobert Shearman list_for_each_entry(af_ops, &rtnl_af_ops, list) { 4065aefb4d4aSRobert Shearman if (af_ops->get_stats_af_size) { 4066aefb4d4aSRobert Shearman size += nla_total_size( 4067aefb4d4aSRobert Shearman af_ops->get_stats_af_size(dev)); 4068aefb4d4aSRobert Shearman 4069aefb4d4aSRobert Shearman /* for AF_* */ 4070aefb4d4aSRobert Shearman size += nla_total_size(0); 4071aefb4d4aSRobert Shearman } 4072aefb4d4aSRobert Shearman } 4073aefb4d4aSRobert Shearman } 4074aefb4d4aSRobert Shearman 407510c9ead9SRoopa Prabhu return size; 407610c9ead9SRoopa Prabhu } 407710c9ead9SRoopa Prabhu 4078c21ef3e3SDavid Ahern static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh, 4079c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 408010c9ead9SRoopa Prabhu { 408110c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 408210c9ead9SRoopa Prabhu struct net_device *dev = NULL; 4083e8872a25SNikolay Aleksandrov int idxattr = 0, prividx = 0; 4084e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 408510c9ead9SRoopa Prabhu struct sk_buff *nskb; 408610c9ead9SRoopa Prabhu u32 filter_mask; 408710c9ead9SRoopa Prabhu int err; 408810c9ead9SRoopa Prabhu 40894775cc1fSMathias Krause if (nlmsg_len(nlh) < sizeof(*ifsm)) 40904775cc1fSMathias Krause return -EINVAL; 40914775cc1fSMathias Krause 409210c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 409310c9ead9SRoopa Prabhu if (ifsm->ifindex > 0) 409410c9ead9SRoopa Prabhu dev = __dev_get_by_index(net, ifsm->ifindex); 409510c9ead9SRoopa Prabhu else 409610c9ead9SRoopa Prabhu return -EINVAL; 409710c9ead9SRoopa Prabhu 409810c9ead9SRoopa Prabhu if (!dev) 409910c9ead9SRoopa Prabhu return -ENODEV; 410010c9ead9SRoopa Prabhu 410110c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 410210c9ead9SRoopa Prabhu if (!filter_mask) 410310c9ead9SRoopa Prabhu return -EINVAL; 410410c9ead9SRoopa Prabhu 410510c9ead9SRoopa Prabhu nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL); 410610c9ead9SRoopa Prabhu if (!nskb) 410710c9ead9SRoopa Prabhu return -ENOBUFS; 410810c9ead9SRoopa Prabhu 410910c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS, 411010c9ead9SRoopa Prabhu NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0, 4111e8872a25SNikolay Aleksandrov 0, filter_mask, &idxattr, &prividx); 411210c9ead9SRoopa Prabhu if (err < 0) { 411310c9ead9SRoopa Prabhu /* -EMSGSIZE implies BUG in if_nlmsg_stats_size */ 411410c9ead9SRoopa Prabhu WARN_ON(err == -EMSGSIZE); 411510c9ead9SRoopa Prabhu kfree_skb(nskb); 411610c9ead9SRoopa Prabhu } else { 411710c9ead9SRoopa Prabhu err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 411810c9ead9SRoopa Prabhu } 411910c9ead9SRoopa Prabhu 412010c9ead9SRoopa Prabhu return err; 412110c9ead9SRoopa Prabhu } 412210c9ead9SRoopa Prabhu 412310c9ead9SRoopa Prabhu static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb) 412410c9ead9SRoopa Prabhu { 4125e8872a25SNikolay Aleksandrov int h, s_h, err, s_idx, s_idxattr, s_prividx; 412610c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 412710c9ead9SRoopa Prabhu unsigned int flags = NLM_F_MULTI; 4128e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 4129e8872a25SNikolay Aleksandrov struct hlist_head *head; 4130e8872a25SNikolay Aleksandrov struct net_device *dev; 413110c9ead9SRoopa Prabhu u32 filter_mask = 0; 4132e8872a25SNikolay Aleksandrov int idx = 0; 413310c9ead9SRoopa Prabhu 413410c9ead9SRoopa Prabhu s_h = cb->args[0]; 413510c9ead9SRoopa Prabhu s_idx = cb->args[1]; 4136e8872a25SNikolay Aleksandrov s_idxattr = cb->args[2]; 4137e8872a25SNikolay Aleksandrov s_prividx = cb->args[3]; 413810c9ead9SRoopa Prabhu 413910c9ead9SRoopa Prabhu cb->seq = net->dev_base_seq; 414010c9ead9SRoopa Prabhu 41414775cc1fSMathias Krause if (nlmsg_len(cb->nlh) < sizeof(*ifsm)) 41424775cc1fSMathias Krause return -EINVAL; 41434775cc1fSMathias Krause 414410c9ead9SRoopa Prabhu ifsm = nlmsg_data(cb->nlh); 414510c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 414610c9ead9SRoopa Prabhu if (!filter_mask) 414710c9ead9SRoopa Prabhu return -EINVAL; 414810c9ead9SRoopa Prabhu 414910c9ead9SRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 415010c9ead9SRoopa Prabhu idx = 0; 415110c9ead9SRoopa Prabhu head = &net->dev_index_head[h]; 415210c9ead9SRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 415310c9ead9SRoopa Prabhu if (idx < s_idx) 415410c9ead9SRoopa Prabhu goto cont; 415510c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS, 415610c9ead9SRoopa Prabhu NETLINK_CB(cb->skb).portid, 415710c9ead9SRoopa Prabhu cb->nlh->nlmsg_seq, 0, 4158e8872a25SNikolay Aleksandrov flags, filter_mask, 4159e8872a25SNikolay Aleksandrov &s_idxattr, &s_prividx); 416010c9ead9SRoopa Prabhu /* If we ran out of room on the first message, 416110c9ead9SRoopa Prabhu * we're in trouble 416210c9ead9SRoopa Prabhu */ 416310c9ead9SRoopa Prabhu WARN_ON((err == -EMSGSIZE) && (skb->len == 0)); 416410c9ead9SRoopa Prabhu 416510c9ead9SRoopa Prabhu if (err < 0) 416610c9ead9SRoopa Prabhu goto out; 4167e8872a25SNikolay Aleksandrov s_prividx = 0; 4168e8872a25SNikolay Aleksandrov s_idxattr = 0; 416910c9ead9SRoopa Prabhu nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 417010c9ead9SRoopa Prabhu cont: 417110c9ead9SRoopa Prabhu idx++; 417210c9ead9SRoopa Prabhu } 417310c9ead9SRoopa Prabhu } 417410c9ead9SRoopa Prabhu out: 4175e8872a25SNikolay Aleksandrov cb->args[3] = s_prividx; 4176e8872a25SNikolay Aleksandrov cb->args[2] = s_idxattr; 417710c9ead9SRoopa Prabhu cb->args[1] = idx; 417810c9ead9SRoopa Prabhu cb->args[0] = h; 417910c9ead9SRoopa Prabhu 418010c9ead9SRoopa Prabhu return skb->len; 418110c9ead9SRoopa Prabhu } 418210c9ead9SRoopa Prabhu 41831da177e4SLinus Torvalds /* Process one rtnetlink message. */ 41841da177e4SLinus Torvalds 41852d4bc933SJohannes Berg static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, 41862d4bc933SJohannes Berg struct netlink_ext_ack *extack) 41871da177e4SLinus Torvalds { 41883b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 41896853dd48SFlorian Westphal struct rtnl_link *handlers; 41906853dd48SFlorian Westphal int err = -EOPNOTSUPP; 4191e2849863SThomas Graf rtnl_doit_func doit; 419262256f98SFlorian Westphal unsigned int flags; 4193617cfc75SAlexander Kuleshov int kind; 41941da177e4SLinus Torvalds int family; 41951da177e4SLinus Torvalds int type; 41961da177e4SLinus Torvalds 41971da177e4SLinus Torvalds type = nlh->nlmsg_type; 41981da177e4SLinus Torvalds if (type > RTM_MAX) 4199038890feSThomas Graf return -EOPNOTSUPP; 42001da177e4SLinus Torvalds 42011da177e4SLinus Torvalds type -= RTM_BASE; 42021da177e4SLinus Torvalds 42031da177e4SLinus Torvalds /* All the messages must have at least 1 byte length */ 4204573ce260SHong zhi guo if (nlmsg_len(nlh) < sizeof(struct rtgenmsg)) 42051da177e4SLinus Torvalds return 0; 42061da177e4SLinus Torvalds 4207573ce260SHong zhi guo family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family; 42081da177e4SLinus Torvalds kind = type&3; 42091da177e4SLinus Torvalds 421090f62cf3SEric W. Biederman if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN)) 42111d00a4ebSThomas Graf return -EPERM; 42121da177e4SLinus Torvalds 42135c2bb9b6SFlorian Westphal if (family >= ARRAY_SIZE(rtnl_msg_handlers)) 42146853dd48SFlorian Westphal family = PF_UNSPEC; 42156853dd48SFlorian Westphal 42166853dd48SFlorian Westphal rcu_read_lock(); 42176853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42186853dd48SFlorian Westphal if (!handlers) { 42196853dd48SFlorian Westphal family = PF_UNSPEC; 42206853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42216853dd48SFlorian Westphal } 42226853dd48SFlorian Westphal 4223b8f3ab42SDavid S. Miller if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { 422497c53cacSDenis V. Lunev struct sock *rtnl; 4225e2849863SThomas Graf rtnl_dumpit_func dumpit; 4226c7ac8679SGreg Rose u16 min_dump_alloc = 0; 42271da177e4SLinus Torvalds 42286853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 42296853dd48SFlorian Westphal if (!dumpit) { 42306853dd48SFlorian Westphal family = PF_UNSPEC; 42316853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[PF_UNSPEC]); 42326853dd48SFlorian Westphal if (!handlers) 42330cc09020SFlorian Westphal goto err_unlock; 4234e1fa6d21SFlorian Westphal 42356853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 42366853dd48SFlorian Westphal if (!dumpit) 42376853dd48SFlorian Westphal goto err_unlock; 42386853dd48SFlorian Westphal } 42396853dd48SFlorian Westphal 4240019a3169SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 4241019a3169SFlorian Westphal 42425c2bb9b6SFlorian Westphal if (type == RTM_GETLINK - RTM_BASE) 4243e1fa6d21SFlorian Westphal min_dump_alloc = rtnl_calcit(skb, nlh); 42441da177e4SLinus Torvalds 42456853dd48SFlorian Westphal rcu_read_unlock(); 42466853dd48SFlorian Westphal 424797c53cacSDenis V. Lunev rtnl = net->rtnl; 424880d326faSPablo Neira Ayuso { 424980d326faSPablo Neira Ayuso struct netlink_dump_control c = { 425080d326faSPablo Neira Ayuso .dump = dumpit, 425180d326faSPablo Neira Ayuso .min_dump_alloc = min_dump_alloc, 425280d326faSPablo Neira Ayuso }; 425380d326faSPablo Neira Ayuso err = netlink_dump_start(rtnl, skb, nlh, &c); 425480d326faSPablo Neira Ayuso } 4255019a3169SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 42562907c35fSEric Dumazet return err; 42571da177e4SLinus Torvalds } 42581da177e4SLinus Torvalds 42598caa38b5SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 42608caa38b5SFlorian Westphal if (!doit) { 42618caa38b5SFlorian Westphal family = PF_UNSPEC; 42628caa38b5SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42638caa38b5SFlorian Westphal } 42648caa38b5SFlorian Westphal 426562256f98SFlorian Westphal flags = READ_ONCE(handlers[type].flags); 426662256f98SFlorian Westphal if (flags & RTNL_FLAG_DOIT_UNLOCKED) { 426762256f98SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 426862256f98SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 426962256f98SFlorian Westphal rcu_read_unlock(); 427062256f98SFlorian Westphal if (doit) 427162256f98SFlorian Westphal err = doit(skb, nlh, extack); 427262256f98SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 427362256f98SFlorian Westphal return err; 427462256f98SFlorian Westphal } 427562256f98SFlorian Westphal 42766853dd48SFlorian Westphal rcu_read_unlock(); 42776853dd48SFlorian Westphal 42780cc09020SFlorian Westphal rtnl_lock(); 42796853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[family]); 42806853dd48SFlorian Westphal if (handlers) { 42816853dd48SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 42826853dd48SFlorian Westphal if (doit) 42830cc09020SFlorian Westphal err = doit(skb, nlh, extack); 42846853dd48SFlorian Westphal } 42850cc09020SFlorian Westphal rtnl_unlock(); 42860cc09020SFlorian Westphal return err; 42870cc09020SFlorian Westphal 42880cc09020SFlorian Westphal err_unlock: 42896853dd48SFlorian Westphal rcu_read_unlock(); 42900cc09020SFlorian Westphal return -EOPNOTSUPP; 42911da177e4SLinus Torvalds } 42921da177e4SLinus Torvalds 4293cd40b7d3SDenis V. Lunev static void rtnetlink_rcv(struct sk_buff *skb) 42941da177e4SLinus Torvalds { 4295cd40b7d3SDenis V. Lunev netlink_rcv_skb(skb, &rtnetlink_rcv_msg); 42961da177e4SLinus Torvalds } 42971da177e4SLinus Torvalds 42985f729eaaSJulien Gomes static int rtnetlink_bind(struct net *net, int group) 42995f729eaaSJulien Gomes { 43005f729eaaSJulien Gomes switch (group) { 43015f729eaaSJulien Gomes case RTNLGRP_IPV4_MROUTE_R: 43025f729eaaSJulien Gomes case RTNLGRP_IPV6_MROUTE_R: 43035f729eaaSJulien Gomes if (!ns_capable(net->user_ns, CAP_NET_ADMIN)) 43045f729eaaSJulien Gomes return -EPERM; 43055f729eaaSJulien Gomes break; 43065f729eaaSJulien Gomes } 43075f729eaaSJulien Gomes return 0; 43085f729eaaSJulien Gomes } 43095f729eaaSJulien Gomes 43101da177e4SLinus Torvalds static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) 43111da177e4SLinus Torvalds { 4312351638e7SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 4313e9dc8653SEric W. Biederman 43141da177e4SLinus Torvalds switch (event) { 43155138e86fSVlad Yasevich case NETDEV_REBOOT: 43163753654eSDavid Ahern case NETDEV_CHANGEADDR: 43175138e86fSVlad Yasevich case NETDEV_CHANGENAME: 43185138e86fSVlad Yasevich case NETDEV_FEAT_CHANGE: 43195138e86fSVlad Yasevich case NETDEV_BONDING_FAILOVER: 43205138e86fSVlad Yasevich case NETDEV_NOTIFY_PEERS: 43215138e86fSVlad Yasevich case NETDEV_RESEND_IGMP: 43225138e86fSVlad Yasevich case NETDEV_CHANGEINFODATA: 43233d3ea5afSVlad Yasevich rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event), 43243d3ea5afSVlad Yasevich GFP_KERNEL); 43251da177e4SLinus Torvalds break; 43261da177e4SLinus Torvalds default: 43271da177e4SLinus Torvalds break; 43281da177e4SLinus Torvalds } 43291da177e4SLinus Torvalds return NOTIFY_DONE; 43301da177e4SLinus Torvalds } 43311da177e4SLinus Torvalds 43321da177e4SLinus Torvalds static struct notifier_block rtnetlink_dev_notifier = { 43331da177e4SLinus Torvalds .notifier_call = rtnetlink_event, 43341da177e4SLinus Torvalds }; 43351da177e4SLinus Torvalds 433697c53cacSDenis V. Lunev 43372c8c1e72SAlexey Dobriyan static int __net_init rtnetlink_net_init(struct net *net) 433897c53cacSDenis V. Lunev { 433997c53cacSDenis V. Lunev struct sock *sk; 4340a31f2d17SPablo Neira Ayuso struct netlink_kernel_cfg cfg = { 4341a31f2d17SPablo Neira Ayuso .groups = RTNLGRP_MAX, 4342a31f2d17SPablo Neira Ayuso .input = rtnetlink_rcv, 4343a31f2d17SPablo Neira Ayuso .cb_mutex = &rtnl_mutex, 43449785e10aSPablo Neira Ayuso .flags = NL_CFG_F_NONROOT_RECV, 43455f729eaaSJulien Gomes .bind = rtnetlink_bind, 4346a31f2d17SPablo Neira Ayuso }; 4347a31f2d17SPablo Neira Ayuso 43489f00d977SPablo Neira Ayuso sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg); 434997c53cacSDenis V. Lunev if (!sk) 435097c53cacSDenis V. Lunev return -ENOMEM; 435197c53cacSDenis V. Lunev net->rtnl = sk; 435297c53cacSDenis V. Lunev return 0; 435397c53cacSDenis V. Lunev } 435497c53cacSDenis V. Lunev 43552c8c1e72SAlexey Dobriyan static void __net_exit rtnetlink_net_exit(struct net *net) 435697c53cacSDenis V. Lunev { 4357b7c6ba6eSDenis V. Lunev netlink_kernel_release(net->rtnl); 435897c53cacSDenis V. Lunev net->rtnl = NULL; 435997c53cacSDenis V. Lunev } 436097c53cacSDenis V. Lunev 436197c53cacSDenis V. Lunev static struct pernet_operations rtnetlink_net_ops = { 436297c53cacSDenis V. Lunev .init = rtnetlink_net_init, 436397c53cacSDenis V. Lunev .exit = rtnetlink_net_exit, 436497c53cacSDenis V. Lunev }; 436597c53cacSDenis V. Lunev 43661da177e4SLinus Torvalds void __init rtnetlink_init(void) 43671da177e4SLinus Torvalds { 4368d38a6512SFlorian Westphal int i; 4369d38a6512SFlorian Westphal 4370d38a6512SFlorian Westphal for (i = 0; i < ARRAY_SIZE(rtnl_msg_handlers_ref); i++) 4371d38a6512SFlorian Westphal refcount_set(&rtnl_msg_handlers_ref[i], 1); 4372d38a6512SFlorian Westphal 437397c53cacSDenis V. Lunev if (register_pernet_subsys(&rtnetlink_net_ops)) 43741da177e4SLinus Torvalds panic("rtnetlink_init: cannot initialize rtnetlink\n"); 437597c53cacSDenis V. Lunev 43761da177e4SLinus Torvalds register_netdevice_notifier(&rtnetlink_dev_notifier); 4377340d17fcSThomas Graf 4378c7ac8679SGreg Rose rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, 4379b97bac64SFlorian Westphal rtnl_dump_ifinfo, 0); 4380b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0); 4381b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0); 4382b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0); 4383687ad8ccSThomas Graf 4384b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0); 4385b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0); 4386b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0); 438777162022SJohn Fastabend 4388b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0); 4389b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0); 4390b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0); 4391e5a55a89SJohn Fastabend 4392b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0); 4393b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0); 4394b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0); 439510c9ead9SRoopa Prabhu 439610c9ead9SRoopa Prabhu rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump, 4397b97bac64SFlorian Westphal 0); 43981da177e4SLinus Torvalds } 4399