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 * The caller must hold the rtnl_mutex. 483f8ff182cSThomas Graf */ 484f8ff182cSThomas Graf void __rtnl_af_unregister(struct rtnl_af_ops *ops) 485f8ff182cSThomas Graf { 486f8ff182cSThomas Graf list_del(&ops->list); 487f8ff182cSThomas Graf } 488f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(__rtnl_af_unregister); 489f8ff182cSThomas Graf 490f8ff182cSThomas Graf /** 491f8ff182cSThomas Graf * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink. 492f8ff182cSThomas Graf * @ops: struct rtnl_af_ops * to unregister 493f8ff182cSThomas Graf */ 494f8ff182cSThomas Graf void rtnl_af_unregister(struct rtnl_af_ops *ops) 495f8ff182cSThomas Graf { 496f8ff182cSThomas Graf rtnl_lock(); 497f8ff182cSThomas Graf __rtnl_af_unregister(ops); 498f8ff182cSThomas Graf rtnl_unlock(); 499f8ff182cSThomas Graf } 500f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_unregister); 501f8ff182cSThomas Graf 502b1974ed0SArad, Ronen static size_t rtnl_link_get_af_size(const struct net_device *dev, 503b1974ed0SArad, Ronen u32 ext_filter_mask) 504f8ff182cSThomas Graf { 505f8ff182cSThomas Graf struct rtnl_af_ops *af_ops; 506f8ff182cSThomas Graf size_t size; 507f8ff182cSThomas Graf 508f8ff182cSThomas Graf /* IFLA_AF_SPEC */ 509f8ff182cSThomas Graf size = nla_total_size(sizeof(struct nlattr)); 510f8ff182cSThomas Graf 511f8ff182cSThomas Graf list_for_each_entry(af_ops, &rtnl_af_ops, list) { 512f8ff182cSThomas Graf if (af_ops->get_link_af_size) { 513f8ff182cSThomas Graf /* AF_* + nested data */ 514f8ff182cSThomas Graf size += nla_total_size(sizeof(struct nlattr)) + 515b1974ed0SArad, Ronen af_ops->get_link_af_size(dev, ext_filter_mask); 516f8ff182cSThomas Graf } 517f8ff182cSThomas Graf } 518f8ff182cSThomas Graf 519f8ff182cSThomas Graf return size; 520f8ff182cSThomas Graf } 521f8ff182cSThomas Graf 522ba7d49b1SJiri Pirko static bool rtnl_have_link_slave_info(const struct net_device *dev) 523ba7d49b1SJiri Pirko { 524ba7d49b1SJiri Pirko struct net_device *master_dev; 525ba7d49b1SJiri Pirko 526ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get((struct net_device *) dev); 527813f020cSJiri Pirko if (master_dev && master_dev->rtnl_link_ops) 528ba7d49b1SJiri Pirko return true; 529ba7d49b1SJiri Pirko return false; 530ba7d49b1SJiri Pirko } 531ba7d49b1SJiri Pirko 532ba7d49b1SJiri Pirko static int rtnl_link_slave_info_fill(struct sk_buff *skb, 533ba7d49b1SJiri Pirko const struct net_device *dev) 534ba7d49b1SJiri Pirko { 535ba7d49b1SJiri Pirko struct net_device *master_dev; 536ba7d49b1SJiri Pirko const struct rtnl_link_ops *ops; 537ba7d49b1SJiri Pirko struct nlattr *slave_data; 538ba7d49b1SJiri Pirko int err; 539ba7d49b1SJiri Pirko 540ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get((struct net_device *) dev); 541ba7d49b1SJiri Pirko if (!master_dev) 542ba7d49b1SJiri Pirko return 0; 543ba7d49b1SJiri Pirko ops = master_dev->rtnl_link_ops; 544ba7d49b1SJiri Pirko if (!ops) 545ba7d49b1SJiri Pirko return 0; 546ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0) 547ba7d49b1SJiri Pirko return -EMSGSIZE; 548ba7d49b1SJiri Pirko if (ops->fill_slave_info) { 549ba7d49b1SJiri Pirko slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA); 550ba7d49b1SJiri Pirko if (!slave_data) 551ba7d49b1SJiri Pirko return -EMSGSIZE; 552ba7d49b1SJiri Pirko err = ops->fill_slave_info(skb, master_dev, dev); 553ba7d49b1SJiri Pirko if (err < 0) 554ba7d49b1SJiri Pirko goto err_cancel_slave_data; 555ba7d49b1SJiri Pirko nla_nest_end(skb, slave_data); 556ba7d49b1SJiri Pirko } 557ba7d49b1SJiri Pirko return 0; 558ba7d49b1SJiri Pirko 559ba7d49b1SJiri Pirko err_cancel_slave_data: 560ba7d49b1SJiri Pirko nla_nest_cancel(skb, slave_data); 561ba7d49b1SJiri Pirko return err; 562ba7d49b1SJiri Pirko } 563ba7d49b1SJiri Pirko 564ba7d49b1SJiri Pirko static int rtnl_link_info_fill(struct sk_buff *skb, 565ba7d49b1SJiri Pirko const struct net_device *dev) 56638f7b870SPatrick McHardy { 56738f7b870SPatrick McHardy const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 568ba7d49b1SJiri Pirko struct nlattr *data; 569ba7d49b1SJiri Pirko int err; 570ba7d49b1SJiri Pirko 571ba7d49b1SJiri Pirko if (!ops) 572ba7d49b1SJiri Pirko return 0; 573ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0) 574ba7d49b1SJiri Pirko return -EMSGSIZE; 575ba7d49b1SJiri Pirko if (ops->fill_xstats) { 576ba7d49b1SJiri Pirko err = ops->fill_xstats(skb, dev); 577ba7d49b1SJiri Pirko if (err < 0) 578ba7d49b1SJiri Pirko return err; 579ba7d49b1SJiri Pirko } 580ba7d49b1SJiri Pirko if (ops->fill_info) { 581ba7d49b1SJiri Pirko data = nla_nest_start(skb, IFLA_INFO_DATA); 582ba7d49b1SJiri Pirko if (data == NULL) 583ba7d49b1SJiri Pirko return -EMSGSIZE; 584ba7d49b1SJiri Pirko err = ops->fill_info(skb, dev); 585ba7d49b1SJiri Pirko if (err < 0) 586ba7d49b1SJiri Pirko goto err_cancel_data; 587ba7d49b1SJiri Pirko nla_nest_end(skb, data); 588ba7d49b1SJiri Pirko } 589ba7d49b1SJiri Pirko return 0; 590ba7d49b1SJiri Pirko 591ba7d49b1SJiri Pirko err_cancel_data: 592ba7d49b1SJiri Pirko nla_nest_cancel(skb, data); 593ba7d49b1SJiri Pirko return err; 594ba7d49b1SJiri Pirko } 595ba7d49b1SJiri Pirko 596ba7d49b1SJiri Pirko static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev) 597ba7d49b1SJiri Pirko { 598ba7d49b1SJiri Pirko struct nlattr *linkinfo; 59938f7b870SPatrick McHardy int err = -EMSGSIZE; 60038f7b870SPatrick McHardy 60138f7b870SPatrick McHardy linkinfo = nla_nest_start(skb, IFLA_LINKINFO); 60238f7b870SPatrick McHardy if (linkinfo == NULL) 60338f7b870SPatrick McHardy goto out; 60438f7b870SPatrick McHardy 605ba7d49b1SJiri Pirko err = rtnl_link_info_fill(skb, dev); 60638f7b870SPatrick McHardy if (err < 0) 60738f7b870SPatrick McHardy goto err_cancel_link; 608ba7d49b1SJiri Pirko 609ba7d49b1SJiri Pirko err = rtnl_link_slave_info_fill(skb, dev); 61038f7b870SPatrick McHardy if (err < 0) 611ba7d49b1SJiri Pirko goto err_cancel_link; 61238f7b870SPatrick McHardy 61338f7b870SPatrick McHardy nla_nest_end(skb, linkinfo); 61438f7b870SPatrick McHardy return 0; 61538f7b870SPatrick McHardy 61638f7b870SPatrick McHardy err_cancel_link: 61738f7b870SPatrick McHardy nla_nest_cancel(skb, linkinfo); 61838f7b870SPatrick McHardy out: 61938f7b870SPatrick McHardy return err; 62038f7b870SPatrick McHardy } 62138f7b870SPatrick McHardy 62295c96174SEric Dumazet int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo) 6231da177e4SLinus Torvalds { 62497c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 6251da177e4SLinus Torvalds int err = 0; 6261da177e4SLinus Torvalds 627ac6d439dSPatrick McHardy NETLINK_CB(skb).dst_group = group; 6281da177e4SLinus Torvalds if (echo) 62963354797SReshetova, Elena refcount_inc(&skb->users); 6301da177e4SLinus Torvalds netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL); 6311da177e4SLinus Torvalds if (echo) 6321da177e4SLinus Torvalds err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT); 6331da177e4SLinus Torvalds return err; 6341da177e4SLinus Torvalds } 6351da177e4SLinus Torvalds 63697c53cacSDenis V. Lunev int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid) 6372942e900SThomas Graf { 63897c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 63997c53cacSDenis V. Lunev 6402942e900SThomas Graf return nlmsg_unicast(rtnl, skb, pid); 6412942e900SThomas Graf } 642e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unicast); 6432942e900SThomas Graf 6441ce85fe4SPablo Neira Ayuso void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group, 64597676b6bSThomas Graf struct nlmsghdr *nlh, gfp_t flags) 64697676b6bSThomas Graf { 64797c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 64897676b6bSThomas Graf int report = 0; 64997676b6bSThomas Graf 65097676b6bSThomas Graf if (nlh) 65197676b6bSThomas Graf report = nlmsg_report(nlh); 65297676b6bSThomas Graf 6531ce85fe4SPablo Neira Ayuso nlmsg_notify(rtnl, skb, pid, group, report, flags); 65497676b6bSThomas Graf } 655e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_notify); 65697676b6bSThomas Graf 65797c53cacSDenis V. Lunev void rtnl_set_sk_err(struct net *net, u32 group, int error) 65897676b6bSThomas Graf { 65997c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 66097c53cacSDenis V. Lunev 66197676b6bSThomas Graf netlink_set_err(rtnl, 0, group, error); 66297676b6bSThomas Graf } 663e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_set_sk_err); 66497676b6bSThomas Graf 6651da177e4SLinus Torvalds int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics) 6661da177e4SLinus Torvalds { 6672d7202bfSThomas Graf struct nlattr *mx; 6682d7202bfSThomas Graf int i, valid = 0; 6691da177e4SLinus Torvalds 6702d7202bfSThomas Graf mx = nla_nest_start(skb, RTA_METRICS); 6712d7202bfSThomas Graf if (mx == NULL) 6722d7202bfSThomas Graf return -ENOBUFS; 6732d7202bfSThomas Graf 6741da177e4SLinus Torvalds for (i = 0; i < RTAX_MAX; i++) { 6752d7202bfSThomas Graf if (metrics[i]) { 676ea697639SDaniel Borkmann if (i == RTAX_CC_ALGO - 1) { 677ea697639SDaniel Borkmann char tmp[TCP_CA_NAME_MAX], *name; 678ea697639SDaniel Borkmann 679ea697639SDaniel Borkmann name = tcp_ca_get_name_by_key(metrics[i], tmp); 680ea697639SDaniel Borkmann if (!name) 681ea697639SDaniel Borkmann continue; 682ea697639SDaniel Borkmann if (nla_put_string(skb, i + 1, name)) 683ea697639SDaniel Borkmann goto nla_put_failure; 684c3a8d947SDaniel Borkmann } else if (i == RTAX_FEATURES - 1) { 685c3a8d947SDaniel Borkmann u32 user_features = metrics[i] & RTAX_FEATURE_MASK; 686c3a8d947SDaniel Borkmann 687f8edcd12SPhil Sutter if (!user_features) 688f8edcd12SPhil Sutter continue; 689c3a8d947SDaniel Borkmann BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK); 690c3a8d947SDaniel Borkmann if (nla_put_u32(skb, i + 1, user_features)) 691c3a8d947SDaniel Borkmann goto nla_put_failure; 692ea697639SDaniel Borkmann } else { 693a6574349SDavid S. Miller if (nla_put_u32(skb, i + 1, metrics[i])) 694a6574349SDavid S. Miller goto nla_put_failure; 6951da177e4SLinus Torvalds } 696ea697639SDaniel Borkmann valid++; 697ea697639SDaniel Borkmann } 6982d7202bfSThomas Graf } 6991da177e4SLinus Torvalds 700a57d27fcSDavid S. Miller if (!valid) { 701a57d27fcSDavid S. Miller nla_nest_cancel(skb, mx); 702a57d27fcSDavid S. Miller return 0; 703a57d27fcSDavid S. Miller } 7042d7202bfSThomas Graf 7052d7202bfSThomas Graf return nla_nest_end(skb, mx); 7062d7202bfSThomas Graf 7072d7202bfSThomas Graf nla_put_failure: 708bc3ed28cSThomas Graf nla_nest_cancel(skb, mx); 709bc3ed28cSThomas Graf return -EMSGSIZE; 7101da177e4SLinus Torvalds } 711e0d087afSEric Dumazet EXPORT_SYMBOL(rtnetlink_put_metrics); 7121da177e4SLinus Torvalds 713e3703b3dSThomas Graf int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id, 71487a50699SDavid S. Miller long expires, u32 error) 715e3703b3dSThomas Graf { 716e3703b3dSThomas Graf struct rta_cacheinfo ci = { 717a399a805SEric Dumazet .rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse), 718e3703b3dSThomas Graf .rta_used = dst->__use, 719e3703b3dSThomas Graf .rta_clntref = atomic_read(&(dst->__refcnt)), 720e3703b3dSThomas Graf .rta_error = error, 721e3703b3dSThomas Graf .rta_id = id, 722e3703b3dSThomas Graf }; 723e3703b3dSThomas Graf 7248253947eSLi Wei if (expires) { 7258253947eSLi Wei unsigned long clock; 726e3703b3dSThomas Graf 7278253947eSLi Wei clock = jiffies_to_clock_t(abs(expires)); 7288253947eSLi Wei clock = min_t(unsigned long, clock, INT_MAX); 7298253947eSLi Wei ci.rta_expires = (expires > 0) ? clock : -clock; 7308253947eSLi Wei } 731e3703b3dSThomas Graf return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci); 732e3703b3dSThomas Graf } 733e3703b3dSThomas Graf EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo); 7341da177e4SLinus Torvalds 73593b2d4a2SDavid S. Miller static void set_operstate(struct net_device *dev, unsigned char transition) 736b00055aaSStefan Rompf { 737b00055aaSStefan Rompf unsigned char operstate = dev->operstate; 738b00055aaSStefan Rompf 739b00055aaSStefan Rompf switch (transition) { 740b00055aaSStefan Rompf case IF_OPER_UP: 741b00055aaSStefan Rompf if ((operstate == IF_OPER_DORMANT || 742b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) && 743b00055aaSStefan Rompf !netif_dormant(dev)) 744b00055aaSStefan Rompf operstate = IF_OPER_UP; 745b00055aaSStefan Rompf break; 746b00055aaSStefan Rompf 747b00055aaSStefan Rompf case IF_OPER_DORMANT: 748b00055aaSStefan Rompf if (operstate == IF_OPER_UP || 749b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) 750b00055aaSStefan Rompf operstate = IF_OPER_DORMANT; 751b00055aaSStefan Rompf break; 7523ff50b79SStephen Hemminger } 753b00055aaSStefan Rompf 754b00055aaSStefan Rompf if (dev->operstate != operstate) { 755b00055aaSStefan Rompf write_lock_bh(&dev_base_lock); 756b00055aaSStefan Rompf dev->operstate = operstate; 757b00055aaSStefan Rompf write_unlock_bh(&dev_base_lock); 758b00055aaSStefan Rompf netdev_state_change(dev); 75993b2d4a2SDavid S. Miller } 760b00055aaSStefan Rompf } 761b00055aaSStefan Rompf 762b1beb681SJiri Benc static unsigned int rtnl_dev_get_flags(const struct net_device *dev) 763b1beb681SJiri Benc { 764b1beb681SJiri Benc return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) | 765b1beb681SJiri Benc (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI)); 766b1beb681SJiri Benc } 767b1beb681SJiri Benc 7683729d502SPatrick McHardy static unsigned int rtnl_dev_combine_flags(const struct net_device *dev, 7693729d502SPatrick McHardy const struct ifinfomsg *ifm) 7703729d502SPatrick McHardy { 7713729d502SPatrick McHardy unsigned int flags = ifm->ifi_flags; 7723729d502SPatrick McHardy 7733729d502SPatrick McHardy /* bugwards compatibility: ifi_change == 0 is treated as ~0 */ 7743729d502SPatrick McHardy if (ifm->ifi_change) 7753729d502SPatrick McHardy flags = (flags & ifm->ifi_change) | 776b1beb681SJiri Benc (rtnl_dev_get_flags(dev) & ~ifm->ifi_change); 7773729d502SPatrick McHardy 7783729d502SPatrick McHardy return flags; 7793729d502SPatrick McHardy } 7803729d502SPatrick McHardy 781b60c5115SThomas Graf static void copy_rtnl_link_stats(struct rtnl_link_stats *a, 782be1f3c2cSBen Hutchings const struct rtnl_link_stats64 *b) 7831da177e4SLinus Torvalds { 784b60c5115SThomas Graf a->rx_packets = b->rx_packets; 785b60c5115SThomas Graf a->tx_packets = b->tx_packets; 786b60c5115SThomas Graf a->rx_bytes = b->rx_bytes; 787b60c5115SThomas Graf a->tx_bytes = b->tx_bytes; 788b60c5115SThomas Graf a->rx_errors = b->rx_errors; 789b60c5115SThomas Graf a->tx_errors = b->tx_errors; 790b60c5115SThomas Graf a->rx_dropped = b->rx_dropped; 791b60c5115SThomas Graf a->tx_dropped = b->tx_dropped; 792b60c5115SThomas Graf 793b60c5115SThomas Graf a->multicast = b->multicast; 794b60c5115SThomas Graf a->collisions = b->collisions; 795b60c5115SThomas Graf 796b60c5115SThomas Graf a->rx_length_errors = b->rx_length_errors; 797b60c5115SThomas Graf a->rx_over_errors = b->rx_over_errors; 798b60c5115SThomas Graf a->rx_crc_errors = b->rx_crc_errors; 799b60c5115SThomas Graf a->rx_frame_errors = b->rx_frame_errors; 800b60c5115SThomas Graf a->rx_fifo_errors = b->rx_fifo_errors; 801b60c5115SThomas Graf a->rx_missed_errors = b->rx_missed_errors; 802b60c5115SThomas Graf 803b60c5115SThomas Graf a->tx_aborted_errors = b->tx_aborted_errors; 804b60c5115SThomas Graf a->tx_carrier_errors = b->tx_carrier_errors; 805b60c5115SThomas Graf a->tx_fifo_errors = b->tx_fifo_errors; 806b60c5115SThomas Graf a->tx_heartbeat_errors = b->tx_heartbeat_errors; 807b60c5115SThomas Graf a->tx_window_errors = b->tx_window_errors; 808b60c5115SThomas Graf 809b60c5115SThomas Graf a->rx_compressed = b->rx_compressed; 810b60c5115SThomas Graf a->tx_compressed = b->tx_compressed; 8116e7333d3SJarod Wilson 8126e7333d3SJarod Wilson a->rx_nohandler = b->rx_nohandler; 81310708f37SJan Engelhardt } 81410708f37SJan Engelhardt 815c02db8c6SChris Wright /* All VF info */ 816115c9b81SGreg Rose static inline int rtnl_vfinfo_size(const struct net_device *dev, 817115c9b81SGreg Rose u32 ext_filter_mask) 818ebc08a6fSWilliams, Mitch A { 8199af15c38SPhil Sutter if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) { 820c02db8c6SChris Wright int num_vfs = dev_num_vf(dev->dev.parent); 8217e75f74aSSabrina Dubroca size_t size = nla_total_size(0); 822045de01aSScott Feldman size += num_vfs * 8237e75f74aSSabrina Dubroca (nla_total_size(0) + 8247e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_mac)) + 8257e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_vlan)) + 8267e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */ 82779aab093SMoshe Shemesh nla_total_size(MAX_VLAN_LIST_LEN * 82879aab093SMoshe Shemesh sizeof(struct ifla_vf_vlan_info)) + 829ed616689SSucheta Chakraborty nla_total_size(sizeof(struct ifla_vf_spoofchk)) + 8307e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_tx_rate)) + 831945a3676SJiri Benc nla_total_size(sizeof(struct ifla_vf_rate)) + 83201a3d796SVlad Zolotarov nla_total_size(sizeof(struct ifla_vf_link_state)) + 8333b766cd8SEran Ben Elisha nla_total_size(sizeof(struct ifla_vf_rss_query_en)) + 8347e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_STATS */ 8353b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_PACKETS */ 836343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8373b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_PACKETS */ 838343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8393b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_BYTES */ 840343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8413b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_BYTES */ 842343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8433b766cd8SEran Ben Elisha /* IFLA_VF_STATS_BROADCAST */ 844343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8453b766cd8SEran Ben Elisha /* IFLA_VF_STATS_MULTICAST */ 846343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 847dd461d6aSHiroshi Shimamoto nla_total_size(sizeof(struct ifla_vf_trust))); 848c02db8c6SChris Wright return size; 849c02db8c6SChris Wright } else 850ebc08a6fSWilliams, Mitch A return 0; 851ebc08a6fSWilliams, Mitch A } 852ebc08a6fSWilliams, Mitch A 853c53864fdSDavid Gibson static size_t rtnl_port_size(const struct net_device *dev, 854c53864fdSDavid Gibson u32 ext_filter_mask) 85557b61080SScott Feldman { 85657b61080SScott Feldman size_t port_size = nla_total_size(4) /* PORT_VF */ 85757b61080SScott Feldman + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ 85857b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ 85957b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ 86057b61080SScott Feldman + nla_total_size(1) /* PROT_VDP_REQUEST */ 86157b61080SScott Feldman + nla_total_size(2); /* PORT_VDP_RESPONSE */ 86257b61080SScott Feldman size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); 86357b61080SScott Feldman size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) 86457b61080SScott Feldman + port_size; 86557b61080SScott Feldman size_t port_self_size = nla_total_size(sizeof(struct nlattr)) 86657b61080SScott Feldman + port_size; 86757b61080SScott Feldman 868c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 869c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 87057b61080SScott Feldman return 0; 87157b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) 87257b61080SScott Feldman return port_self_size + vf_ports_size + 87357b61080SScott Feldman vf_port_size * dev_num_vf(dev->dev.parent); 87457b61080SScott Feldman else 87557b61080SScott Feldman return port_self_size; 87657b61080SScott Feldman } 87757b61080SScott Feldman 878b5cdae32SDavid S. Miller static size_t rtnl_xdp_size(void) 879d1fdd913SBrenden Blanco { 880b3cfaa31SSabrina Dubroca size_t xdp_size = nla_total_size(0) + /* nest IFLA_XDP */ 88158038695SMartin KaFai Lau nla_total_size(1) + /* XDP_ATTACHED */ 88258038695SMartin KaFai Lau nla_total_size(4); /* XDP_PROG_ID */ 883d1fdd913SBrenden Blanco 884d1fdd913SBrenden Blanco return xdp_size; 885d1fdd913SBrenden Blanco } 886d1fdd913SBrenden Blanco 887115c9b81SGreg Rose static noinline size_t if_nlmsg_size(const struct net_device *dev, 888115c9b81SGreg Rose u32 ext_filter_mask) 889339bf98fSThomas Graf { 890339bf98fSThomas Graf return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 891339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 8920b815a1aSStephen Hemminger + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ 893339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ 894270cb4d0SNicolas Dichtel + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap)) 895339bf98fSThomas Graf + nla_total_size(sizeof(struct rtnl_link_stats)) 89635c58459SDavid S. Miller + nla_total_size_64bit(sizeof(struct rtnl_link_stats64)) 897339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 898339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ 899339bf98fSThomas Graf + nla_total_size(4) /* IFLA_TXQLEN */ 900339bf98fSThomas Graf + nla_total_size(4) /* IFLA_WEIGHT */ 901339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MTU */ 902339bf98fSThomas Graf + nla_total_size(4) /* IFLA_LINK */ 903339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MASTER */ 9049a57247fSJiri Pirko + nla_total_size(1) /* IFLA_CARRIER */ 905edbc0bb3SBen Greear + nla_total_size(4) /* IFLA_PROMISCUITY */ 90676ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */ 90776ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */ 9086919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */ 9096919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */ 910339bf98fSThomas Graf + nla_total_size(1) /* IFLA_OPERSTATE */ 91138f7b870SPatrick McHardy + nla_total_size(1) /* IFLA_LINKMODE */ 9122d3b479dSdavid decotigny + nla_total_size(4) /* IFLA_CARRIER_CHANGES */ 913d37512a2SNicolas Dichtel + nla_total_size(4) /* IFLA_LINK_NETNSID */ 914db833d40SSerhey Popovych + nla_total_size(4) /* IFLA_GROUP */ 915115c9b81SGreg Rose + nla_total_size(ext_filter_mask 916115c9b81SGreg Rose & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */ 917115c9b81SGreg Rose + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */ 918c53864fdSDavid Gibson + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ 919f8ff182cSThomas Graf + rtnl_link_get_size(dev) /* IFLA_LINKINFO */ 920b1974ed0SArad, Ronen + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */ 92182f28412SJiri Pirko + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */ 92288d6378bSAnuradha Karuppiah + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */ 923c57c7a95SNicolas Dichtel + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */ 924b5cdae32SDavid S. Miller + rtnl_xdp_size() /* IFLA_XDP */ 9253d3ea5afSVlad Yasevich + nla_total_size(4) /* IFLA_EVENT */ 92688d6378bSAnuradha Karuppiah + nla_total_size(1); /* IFLA_PROTO_DOWN */ 92788d6378bSAnuradha Karuppiah 928339bf98fSThomas Graf } 929339bf98fSThomas Graf 93057b61080SScott Feldman static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) 93157b61080SScott Feldman { 93257b61080SScott Feldman struct nlattr *vf_ports; 93357b61080SScott Feldman struct nlattr *vf_port; 93457b61080SScott Feldman int vf; 93557b61080SScott Feldman int err; 93657b61080SScott Feldman 93757b61080SScott Feldman vf_ports = nla_nest_start(skb, IFLA_VF_PORTS); 93857b61080SScott Feldman if (!vf_ports) 93957b61080SScott Feldman return -EMSGSIZE; 94057b61080SScott Feldman 94157b61080SScott Feldman for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { 94257b61080SScott Feldman vf_port = nla_nest_start(skb, IFLA_VF_PORT); 9438ca94183SScott Feldman if (!vf_port) 9448ca94183SScott Feldman goto nla_put_failure; 945a6574349SDavid S. Miller if (nla_put_u32(skb, IFLA_PORT_VF, vf)) 946a6574349SDavid S. Miller goto nla_put_failure; 94757b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); 9488ca94183SScott Feldman if (err == -EMSGSIZE) 9498ca94183SScott Feldman goto nla_put_failure; 95057b61080SScott Feldman if (err) { 95157b61080SScott Feldman nla_nest_cancel(skb, vf_port); 95257b61080SScott Feldman continue; 95357b61080SScott Feldman } 95457b61080SScott Feldman nla_nest_end(skb, vf_port); 95557b61080SScott Feldman } 95657b61080SScott Feldman 95757b61080SScott Feldman nla_nest_end(skb, vf_ports); 95857b61080SScott Feldman 95957b61080SScott Feldman return 0; 9608ca94183SScott Feldman 9618ca94183SScott Feldman nla_put_failure: 9628ca94183SScott Feldman nla_nest_cancel(skb, vf_ports); 9638ca94183SScott Feldman return -EMSGSIZE; 96457b61080SScott Feldman } 96557b61080SScott Feldman 96657b61080SScott Feldman static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) 96757b61080SScott Feldman { 96857b61080SScott Feldman struct nlattr *port_self; 96957b61080SScott Feldman int err; 97057b61080SScott Feldman 97157b61080SScott Feldman port_self = nla_nest_start(skb, IFLA_PORT_SELF); 97257b61080SScott Feldman if (!port_self) 97357b61080SScott Feldman return -EMSGSIZE; 97457b61080SScott Feldman 97557b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); 97657b61080SScott Feldman if (err) { 97757b61080SScott Feldman nla_nest_cancel(skb, port_self); 9788ca94183SScott Feldman return (err == -EMSGSIZE) ? err : 0; 97957b61080SScott Feldman } 98057b61080SScott Feldman 98157b61080SScott Feldman nla_nest_end(skb, port_self); 98257b61080SScott Feldman 98357b61080SScott Feldman return 0; 98457b61080SScott Feldman } 98557b61080SScott Feldman 986c53864fdSDavid Gibson static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev, 987c53864fdSDavid Gibson u32 ext_filter_mask) 98857b61080SScott Feldman { 98957b61080SScott Feldman int err; 99057b61080SScott Feldman 991c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 992c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 99357b61080SScott Feldman return 0; 99457b61080SScott Feldman 99557b61080SScott Feldman err = rtnl_port_self_fill(skb, dev); 99657b61080SScott Feldman if (err) 99757b61080SScott Feldman return err; 99857b61080SScott Feldman 99957b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) { 100057b61080SScott Feldman err = rtnl_vf_ports_fill(skb, dev); 100157b61080SScott Feldman if (err) 100257b61080SScott Feldman return err; 100357b61080SScott Feldman } 100457b61080SScott Feldman 100557b61080SScott Feldman return 0; 100657b61080SScott Feldman } 100757b61080SScott Feldman 100866cae9edSJiri Pirko static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev) 100966cae9edSJiri Pirko { 101066cae9edSJiri Pirko int err; 101102637fceSJiri Pirko struct netdev_phys_item_id ppid; 101266cae9edSJiri Pirko 101366cae9edSJiri Pirko err = dev_get_phys_port_id(dev, &ppid); 101466cae9edSJiri Pirko if (err) { 101566cae9edSJiri Pirko if (err == -EOPNOTSUPP) 101666cae9edSJiri Pirko return 0; 101766cae9edSJiri Pirko return err; 101866cae9edSJiri Pirko } 101966cae9edSJiri Pirko 102066cae9edSJiri Pirko if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id)) 102166cae9edSJiri Pirko return -EMSGSIZE; 102266cae9edSJiri Pirko 102366cae9edSJiri Pirko return 0; 102466cae9edSJiri Pirko } 102566cae9edSJiri Pirko 1026db24a904SDavid Ahern static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev) 1027db24a904SDavid Ahern { 1028db24a904SDavid Ahern char name[IFNAMSIZ]; 1029db24a904SDavid Ahern int err; 1030db24a904SDavid Ahern 1031db24a904SDavid Ahern err = dev_get_phys_port_name(dev, name, sizeof(name)); 1032db24a904SDavid Ahern if (err) { 1033db24a904SDavid Ahern if (err == -EOPNOTSUPP) 1034db24a904SDavid Ahern return 0; 1035db24a904SDavid Ahern return err; 1036db24a904SDavid Ahern } 1037db24a904SDavid Ahern 103877ef033bSMichal Schmidt if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name)) 1039db24a904SDavid Ahern return -EMSGSIZE; 1040db24a904SDavid Ahern 1041db24a904SDavid Ahern return 0; 1042db24a904SDavid Ahern } 1043db24a904SDavid Ahern 104482f28412SJiri Pirko static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev) 104582f28412SJiri Pirko { 104682f28412SJiri Pirko int err; 1047f8e20a9fSScott Feldman struct switchdev_attr attr = { 10486ff64f6fSIdo Schimmel .orig_dev = dev, 10491f868398SJiri Pirko .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID, 1050f8e20a9fSScott Feldman .flags = SWITCHDEV_F_NO_RECURSE, 1051f8e20a9fSScott Feldman }; 105282f28412SJiri Pirko 1053f8e20a9fSScott Feldman err = switchdev_port_attr_get(dev, &attr); 105482f28412SJiri Pirko if (err) { 105582f28412SJiri Pirko if (err == -EOPNOTSUPP) 105682f28412SJiri Pirko return 0; 105782f28412SJiri Pirko return err; 105882f28412SJiri Pirko } 105982f28412SJiri Pirko 106042275bd8SScott Feldman if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len, 106142275bd8SScott Feldman attr.u.ppid.id)) 106282f28412SJiri Pirko return -EMSGSIZE; 106382f28412SJiri Pirko 106482f28412SJiri Pirko return 0; 106582f28412SJiri Pirko } 106682f28412SJiri Pirko 1067b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb, 1068b22b941bSHannes Frederic Sowa struct net_device *dev) 1069b22b941bSHannes Frederic Sowa { 1070550bce59SRoopa Prabhu struct rtnl_link_stats64 *sp; 1071b22b941bSHannes Frederic Sowa struct nlattr *attr; 1072b22b941bSHannes Frederic Sowa 107358414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS64, 107458414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), IFLA_PAD); 1075b22b941bSHannes Frederic Sowa if (!attr) 1076b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1077b22b941bSHannes Frederic Sowa 1078550bce59SRoopa Prabhu sp = nla_data(attr); 1079550bce59SRoopa Prabhu dev_get_stats(dev, sp); 1080550bce59SRoopa Prabhu 1081550bce59SRoopa Prabhu attr = nla_reserve(skb, IFLA_STATS, 1082550bce59SRoopa Prabhu sizeof(struct rtnl_link_stats)); 1083550bce59SRoopa Prabhu if (!attr) 1084550bce59SRoopa Prabhu return -EMSGSIZE; 1085550bce59SRoopa Prabhu 1086550bce59SRoopa Prabhu copy_rtnl_link_stats(nla_data(attr), sp); 1087b22b941bSHannes Frederic Sowa 1088b22b941bSHannes Frederic Sowa return 0; 1089b22b941bSHannes Frederic Sowa } 1090b22b941bSHannes Frederic Sowa 1091b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb, 1092b22b941bSHannes Frederic Sowa struct net_device *dev, 1093b22b941bSHannes Frederic Sowa int vfs_num, 1094b22b941bSHannes Frederic Sowa struct nlattr *vfinfo) 1095b22b941bSHannes Frederic Sowa { 1096b22b941bSHannes Frederic Sowa struct ifla_vf_rss_query_en vf_rss_query_en; 109779aab093SMoshe Shemesh struct nlattr *vf, *vfstats, *vfvlanlist; 1098b22b941bSHannes Frederic Sowa struct ifla_vf_link_state vf_linkstate; 109979aab093SMoshe Shemesh struct ifla_vf_vlan_info vf_vlan_info; 1100b22b941bSHannes Frederic Sowa struct ifla_vf_spoofchk vf_spoofchk; 1101b22b941bSHannes Frederic Sowa struct ifla_vf_tx_rate vf_tx_rate; 1102b22b941bSHannes Frederic Sowa struct ifla_vf_stats vf_stats; 1103b22b941bSHannes Frederic Sowa struct ifla_vf_trust vf_trust; 1104b22b941bSHannes Frederic Sowa struct ifla_vf_vlan vf_vlan; 1105b22b941bSHannes Frederic Sowa struct ifla_vf_rate vf_rate; 1106b22b941bSHannes Frederic Sowa struct ifla_vf_mac vf_mac; 1107b22b941bSHannes Frederic Sowa struct ifla_vf_info ivi; 1108b22b941bSHannes Frederic Sowa 11090eed9cf5SMintz, Yuval memset(&ivi, 0, sizeof(ivi)); 11100eed9cf5SMintz, Yuval 1111b22b941bSHannes Frederic Sowa /* Not all SR-IOV capable drivers support the 1112b22b941bSHannes Frederic Sowa * spoofcheck and "RSS query enable" query. Preset to 1113b22b941bSHannes Frederic Sowa * -1 so the user space tool can detect that the driver 1114b22b941bSHannes Frederic Sowa * didn't report anything. 1115b22b941bSHannes Frederic Sowa */ 1116b22b941bSHannes Frederic Sowa ivi.spoofchk = -1; 1117b22b941bSHannes Frederic Sowa ivi.rss_query_en = -1; 1118b22b941bSHannes Frederic Sowa ivi.trusted = -1; 1119b22b941bSHannes Frederic Sowa /* The default value for VF link state is "auto" 1120b22b941bSHannes Frederic Sowa * IFLA_VF_LINK_STATE_AUTO which equals zero 1121b22b941bSHannes Frederic Sowa */ 1122b22b941bSHannes Frederic Sowa ivi.linkstate = 0; 112379aab093SMoshe Shemesh /* VLAN Protocol by default is 802.1Q */ 112479aab093SMoshe Shemesh ivi.vlan_proto = htons(ETH_P_8021Q); 1125b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi)) 1126b22b941bSHannes Frederic Sowa return 0; 1127b22b941bSHannes Frederic Sowa 1128775f4f05SDan Carpenter memset(&vf_vlan_info, 0, sizeof(vf_vlan_info)); 1129775f4f05SDan Carpenter 1130b22b941bSHannes Frederic Sowa vf_mac.vf = 1131b22b941bSHannes Frederic Sowa vf_vlan.vf = 113279aab093SMoshe Shemesh vf_vlan_info.vf = 1133b22b941bSHannes Frederic Sowa vf_rate.vf = 1134b22b941bSHannes Frederic Sowa vf_tx_rate.vf = 1135b22b941bSHannes Frederic Sowa vf_spoofchk.vf = 1136b22b941bSHannes Frederic Sowa vf_linkstate.vf = 1137b22b941bSHannes Frederic Sowa vf_rss_query_en.vf = 1138b22b941bSHannes Frederic Sowa vf_trust.vf = ivi.vf; 1139b22b941bSHannes Frederic Sowa 1140b22b941bSHannes Frederic Sowa memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); 1141b22b941bSHannes Frederic Sowa vf_vlan.vlan = ivi.vlan; 1142b22b941bSHannes Frederic Sowa vf_vlan.qos = ivi.qos; 114379aab093SMoshe Shemesh vf_vlan_info.vlan = ivi.vlan; 114479aab093SMoshe Shemesh vf_vlan_info.qos = ivi.qos; 114579aab093SMoshe Shemesh vf_vlan_info.vlan_proto = ivi.vlan_proto; 1146b22b941bSHannes Frederic Sowa vf_tx_rate.rate = ivi.max_tx_rate; 1147b22b941bSHannes Frederic Sowa vf_rate.min_tx_rate = ivi.min_tx_rate; 1148b22b941bSHannes Frederic Sowa vf_rate.max_tx_rate = ivi.max_tx_rate; 1149b22b941bSHannes Frederic Sowa vf_spoofchk.setting = ivi.spoofchk; 1150b22b941bSHannes Frederic Sowa vf_linkstate.link_state = ivi.linkstate; 1151b22b941bSHannes Frederic Sowa vf_rss_query_en.setting = ivi.rss_query_en; 1152b22b941bSHannes Frederic Sowa vf_trust.setting = ivi.trusted; 1153b22b941bSHannes Frederic Sowa vf = nla_nest_start(skb, IFLA_VF_INFO); 115479aab093SMoshe Shemesh if (!vf) 115579aab093SMoshe Shemesh goto nla_put_vfinfo_failure; 1156b22b941bSHannes Frederic Sowa if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) || 1157b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) || 1158b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate), 1159b22b941bSHannes Frederic Sowa &vf_rate) || 1160b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), 1161b22b941bSHannes Frederic Sowa &vf_tx_rate) || 1162b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk), 1163b22b941bSHannes Frederic Sowa &vf_spoofchk) || 1164b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate), 1165b22b941bSHannes Frederic Sowa &vf_linkstate) || 1166b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RSS_QUERY_EN, 1167b22b941bSHannes Frederic Sowa sizeof(vf_rss_query_en), 1168b22b941bSHannes Frederic Sowa &vf_rss_query_en) || 1169b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TRUST, 1170b22b941bSHannes Frederic Sowa sizeof(vf_trust), &vf_trust)) 117179aab093SMoshe Shemesh goto nla_put_vf_failure; 117279aab093SMoshe Shemesh vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST); 117379aab093SMoshe Shemesh if (!vfvlanlist) 117479aab093SMoshe Shemesh goto nla_put_vf_failure; 117579aab093SMoshe Shemesh if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info), 117679aab093SMoshe Shemesh &vf_vlan_info)) { 117779aab093SMoshe Shemesh nla_nest_cancel(skb, vfvlanlist); 117879aab093SMoshe Shemesh goto nla_put_vf_failure; 117979aab093SMoshe Shemesh } 118079aab093SMoshe Shemesh nla_nest_end(skb, vfvlanlist); 1181b22b941bSHannes Frederic Sowa memset(&vf_stats, 0, sizeof(vf_stats)); 1182b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_stats) 1183b22b941bSHannes Frederic Sowa dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num, 1184b22b941bSHannes Frederic Sowa &vf_stats); 1185b22b941bSHannes Frederic Sowa vfstats = nla_nest_start(skb, IFLA_VF_STATS); 118679aab093SMoshe Shemesh if (!vfstats) 118779aab093SMoshe Shemesh goto nla_put_vf_failure; 1188343a6d8eSNicolas Dichtel if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS, 1189343a6d8eSNicolas Dichtel vf_stats.rx_packets, IFLA_VF_STATS_PAD) || 1190343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS, 1191343a6d8eSNicolas Dichtel vf_stats.tx_packets, IFLA_VF_STATS_PAD) || 1192343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES, 1193343a6d8eSNicolas Dichtel vf_stats.rx_bytes, IFLA_VF_STATS_PAD) || 1194343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES, 1195343a6d8eSNicolas Dichtel vf_stats.tx_bytes, IFLA_VF_STATS_PAD) || 1196343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST, 1197343a6d8eSNicolas Dichtel vf_stats.broadcast, IFLA_VF_STATS_PAD) || 1198343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST, 119979aab093SMoshe Shemesh vf_stats.multicast, IFLA_VF_STATS_PAD)) { 120079aab093SMoshe Shemesh nla_nest_cancel(skb, vfstats); 120179aab093SMoshe Shemesh goto nla_put_vf_failure; 120279aab093SMoshe Shemesh } 1203b22b941bSHannes Frederic Sowa nla_nest_end(skb, vfstats); 1204b22b941bSHannes Frederic Sowa nla_nest_end(skb, vf); 1205b22b941bSHannes Frederic Sowa return 0; 120679aab093SMoshe Shemesh 120779aab093SMoshe Shemesh nla_put_vf_failure: 120879aab093SMoshe Shemesh nla_nest_cancel(skb, vf); 120979aab093SMoshe Shemesh nla_put_vfinfo_failure: 121079aab093SMoshe Shemesh nla_nest_cancel(skb, vfinfo); 121179aab093SMoshe Shemesh return -EMSGSIZE; 1212b22b941bSHannes Frederic Sowa } 1213b22b941bSHannes Frederic Sowa 1214b22b941bSHannes Frederic Sowa static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev) 1215b22b941bSHannes Frederic Sowa { 12165f8e4474SKangjie Lu struct rtnl_link_ifmap map; 12175f8e4474SKangjie Lu 12185f8e4474SKangjie Lu memset(&map, 0, sizeof(map)); 12195f8e4474SKangjie Lu map.mem_start = dev->mem_start; 12205f8e4474SKangjie Lu map.mem_end = dev->mem_end; 12215f8e4474SKangjie Lu map.base_addr = dev->base_addr; 12225f8e4474SKangjie Lu map.irq = dev->irq; 12235f8e4474SKangjie Lu map.dma = dev->dma; 12245f8e4474SKangjie Lu map.port = dev->if_port; 12255f8e4474SKangjie Lu 1226270cb4d0SNicolas Dichtel if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD)) 1227b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1228b22b941bSHannes Frederic Sowa 1229b22b941bSHannes Frederic Sowa return 0; 1230b22b941bSHannes Frederic Sowa } 1231b22b941bSHannes Frederic Sowa 123258038695SMartin KaFai Lau static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id) 1233d67b9cd2SDaniel Borkmann { 1234d67b9cd2SDaniel Borkmann const struct net_device_ops *ops = dev->netdev_ops; 123558038695SMartin KaFai Lau const struct bpf_prog *generic_xdp_prog; 1236d67b9cd2SDaniel Borkmann 1237d67b9cd2SDaniel Borkmann ASSERT_RTNL(); 1238d67b9cd2SDaniel Borkmann 123958038695SMartin KaFai Lau *prog_id = 0; 124058038695SMartin KaFai Lau generic_xdp_prog = rtnl_dereference(dev->xdp_prog); 124158038695SMartin KaFai Lau if (generic_xdp_prog) { 124258038695SMartin KaFai Lau *prog_id = generic_xdp_prog->aux->id; 1243d67b9cd2SDaniel Borkmann return XDP_ATTACHED_SKB; 124458038695SMartin KaFai Lau } 1245ce158e58SJakub Kicinski if (!ops->ndo_xdp) 1246d67b9cd2SDaniel Borkmann return XDP_ATTACHED_NONE; 1247ce158e58SJakub Kicinski 1248ce158e58SJakub Kicinski return __dev_xdp_attached(dev, ops->ndo_xdp, prog_id); 1249d67b9cd2SDaniel Borkmann } 1250d67b9cd2SDaniel Borkmann 1251d1fdd913SBrenden Blanco static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev) 1252d1fdd913SBrenden Blanco { 1253d1fdd913SBrenden Blanco struct nlattr *xdp; 125458038695SMartin KaFai Lau u32 prog_id; 1255d1fdd913SBrenden Blanco int err; 1256d1fdd913SBrenden Blanco 1257d1fdd913SBrenden Blanco xdp = nla_nest_start(skb, IFLA_XDP); 1258d1fdd913SBrenden Blanco if (!xdp) 1259d1fdd913SBrenden Blanco return -EMSGSIZE; 1260b5cdae32SDavid S. Miller 1261d67b9cd2SDaniel Borkmann err = nla_put_u8(skb, IFLA_XDP_ATTACHED, 126258038695SMartin KaFai Lau rtnl_xdp_attached_mode(dev, &prog_id)); 1263d1fdd913SBrenden Blanco if (err) 1264d1fdd913SBrenden Blanco goto err_cancel; 1265d1fdd913SBrenden Blanco 126658038695SMartin KaFai Lau if (prog_id) { 126758038695SMartin KaFai Lau err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id); 126858038695SMartin KaFai Lau if (err) 126958038695SMartin KaFai Lau goto err_cancel; 127058038695SMartin KaFai Lau } 127158038695SMartin KaFai Lau 1272d1fdd913SBrenden Blanco nla_nest_end(skb, xdp); 1273d1fdd913SBrenden Blanco return 0; 1274d1fdd913SBrenden Blanco 1275d1fdd913SBrenden Blanco err_cancel: 1276d1fdd913SBrenden Blanco nla_nest_cancel(skb, xdp); 1277d1fdd913SBrenden Blanco return err; 1278d1fdd913SBrenden Blanco } 1279d1fdd913SBrenden Blanco 12803d3ea5afSVlad Yasevich static u32 rtnl_get_event(unsigned long event) 12813d3ea5afSVlad Yasevich { 12823d3ea5afSVlad Yasevich u32 rtnl_event_type = IFLA_EVENT_NONE; 12833d3ea5afSVlad Yasevich 12843d3ea5afSVlad Yasevich switch (event) { 12853d3ea5afSVlad Yasevich case NETDEV_REBOOT: 12863d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_REBOOT; 12873d3ea5afSVlad Yasevich break; 12883d3ea5afSVlad Yasevich case NETDEV_FEAT_CHANGE: 12893d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_FEATURES; 12903d3ea5afSVlad Yasevich break; 12913d3ea5afSVlad Yasevich case NETDEV_BONDING_FAILOVER: 12923d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER; 12933d3ea5afSVlad Yasevich break; 12943d3ea5afSVlad Yasevich case NETDEV_NOTIFY_PEERS: 12953d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS; 12963d3ea5afSVlad Yasevich break; 12973d3ea5afSVlad Yasevich case NETDEV_RESEND_IGMP: 12983d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_IGMP_RESEND; 12993d3ea5afSVlad Yasevich break; 13003d3ea5afSVlad Yasevich case NETDEV_CHANGEINFODATA: 13013d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS; 13023d3ea5afSVlad Yasevich break; 13033d3ea5afSVlad Yasevich default: 13043d3ea5afSVlad Yasevich break; 13053d3ea5afSVlad Yasevich } 13063d3ea5afSVlad Yasevich 13073d3ea5afSVlad Yasevich return rtnl_event_type; 13083d3ea5afSVlad Yasevich } 13093d3ea5afSVlad Yasevich 1310*79110a04SFlorian Westphal static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev) 1311*79110a04SFlorian Westphal { 1312*79110a04SFlorian Westphal const struct net_device *upper_dev; 1313*79110a04SFlorian Westphal int ret = 0; 1314*79110a04SFlorian Westphal 1315*79110a04SFlorian Westphal rcu_read_lock(); 1316*79110a04SFlorian Westphal 1317*79110a04SFlorian Westphal upper_dev = netdev_master_upper_dev_get_rcu(dev); 1318*79110a04SFlorian Westphal if (upper_dev) 1319*79110a04SFlorian Westphal ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex); 1320*79110a04SFlorian Westphal 1321*79110a04SFlorian Westphal rcu_read_unlock(); 1322*79110a04SFlorian Westphal return ret; 1323*79110a04SFlorian Westphal } 1324*79110a04SFlorian Westphal 1325*79110a04SFlorian Westphal static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev) 1326*79110a04SFlorian Westphal { 1327*79110a04SFlorian Westphal int ifindex = dev_get_iflink(dev); 1328*79110a04SFlorian Westphal 1329*79110a04SFlorian Westphal if (dev->ifindex == ifindex) 1330*79110a04SFlorian Westphal return 0; 1331*79110a04SFlorian Westphal 1332*79110a04SFlorian Westphal return nla_put_u32(skb, IFLA_LINK, ifindex); 1333*79110a04SFlorian Westphal } 1334*79110a04SFlorian Westphal 1335b60c5115SThomas Graf static int rtnl_fill_ifinfo(struct sk_buff *skb, struct net_device *dev, 1336575c3e2aSPatrick McHardy int type, u32 pid, u32 seq, u32 change, 13373d3ea5afSVlad Yasevich unsigned int flags, u32 ext_filter_mask, 13383d3ea5afSVlad Yasevich u32 event) 1339b60c5115SThomas Graf { 1340b60c5115SThomas Graf struct ifinfomsg *ifm; 13411da177e4SLinus Torvalds struct nlmsghdr *nlh; 1342b22b941bSHannes Frederic Sowa struct nlattr *af_spec; 1343f8ff182cSThomas Graf struct rtnl_af_ops *af_ops; 13441da177e4SLinus Torvalds 13452907c35fSEric Dumazet ASSERT_RTNL(); 1346b60c5115SThomas Graf nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); 1347b60c5115SThomas Graf if (nlh == NULL) 134826932566SPatrick McHardy return -EMSGSIZE; 13491da177e4SLinus Torvalds 1350b60c5115SThomas Graf ifm = nlmsg_data(nlh); 1351b60c5115SThomas Graf ifm->ifi_family = AF_UNSPEC; 1352b60c5115SThomas Graf ifm->__ifi_pad = 0; 1353b60c5115SThomas Graf ifm->ifi_type = dev->type; 1354b60c5115SThomas Graf ifm->ifi_index = dev->ifindex; 1355b60c5115SThomas Graf ifm->ifi_flags = dev_get_flags(dev); 1356b60c5115SThomas Graf ifm->ifi_change = change; 13571da177e4SLinus Torvalds 1358a6574349SDavid S. Miller if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 1359a6574349SDavid S. Miller nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) || 1360a6574349SDavid S. Miller nla_put_u8(skb, IFLA_OPERSTATE, 1361a6574349SDavid S. Miller netif_running(dev) ? dev->operstate : IF_OPER_DOWN) || 1362a6574349SDavid S. Miller nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) || 1363a6574349SDavid S. Miller nla_put_u32(skb, IFLA_MTU, dev->mtu) || 1364a6574349SDavid S. Miller nla_put_u32(skb, IFLA_GROUP, dev->group) || 1365edbc0bb3SBen Greear nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) || 136676ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) || 1367c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) || 1368c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) || 13691d69c2b3SMark A. Greer #ifdef CONFIG_RPS 137076ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) || 13711d69c2b3SMark A. Greer #endif 1372*79110a04SFlorian Westphal nla_put_iflink(skb, dev) || 1373*79110a04SFlorian Westphal put_master_ifindex(skb, dev) || 13749a57247fSJiri Pirko nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) || 1375a6574349SDavid S. Miller (dev->qdisc && 1376a6574349SDavid S. Miller nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) || 1377a6574349SDavid S. Miller (dev->ifalias && 13782d3b479dSdavid decotigny nla_put_string(skb, IFLA_IFALIAS, dev->ifalias)) || 13792d3b479dSdavid decotigny nla_put_u32(skb, IFLA_CARRIER_CHANGES, 138088d6378bSAnuradha Karuppiah atomic_read(&dev->carrier_changes)) || 138188d6378bSAnuradha Karuppiah nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down)) 1382a6574349SDavid S. Miller goto nla_put_failure; 13830b815a1aSStephen Hemminger 13843d3ea5afSVlad Yasevich if (event != IFLA_EVENT_NONE) { 13853d3ea5afSVlad Yasevich if (nla_put_u32(skb, IFLA_EVENT, event)) 13863d3ea5afSVlad Yasevich goto nla_put_failure; 13873d3ea5afSVlad Yasevich } 13883d3ea5afSVlad Yasevich 1389b22b941bSHannes Frederic Sowa if (rtnl_fill_link_ifmap(skb, dev)) 1390a6574349SDavid S. Miller goto nla_put_failure; 13911da177e4SLinus Torvalds 13921da177e4SLinus Torvalds if (dev->addr_len) { 1393a6574349SDavid S. Miller if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) || 1394a6574349SDavid S. Miller nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast)) 1395a6574349SDavid S. Miller goto nla_put_failure; 13961da177e4SLinus Torvalds } 13971da177e4SLinus Torvalds 139866cae9edSJiri Pirko if (rtnl_phys_port_id_fill(skb, dev)) 139966cae9edSJiri Pirko goto nla_put_failure; 140066cae9edSJiri Pirko 1401db24a904SDavid Ahern if (rtnl_phys_port_name_fill(skb, dev)) 1402db24a904SDavid Ahern goto nla_put_failure; 1403db24a904SDavid Ahern 140482f28412SJiri Pirko if (rtnl_phys_switch_id_fill(skb, dev)) 140582f28412SJiri Pirko goto nla_put_failure; 140682f28412SJiri Pirko 1407b22b941bSHannes Frederic Sowa if (rtnl_fill_stats(skb, dev)) 1408b60c5115SThomas Graf goto nla_put_failure; 1409b60c5115SThomas Graf 1410a6574349SDavid S. Miller if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF) && 1411a6574349SDavid S. Miller nla_put_u32(skb, IFLA_NUM_VF, dev_num_vf(dev->dev.parent))) 1412a6574349SDavid S. Miller goto nla_put_failure; 141357b61080SScott Feldman 1414b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_config && dev->dev.parent && 1415b22b941bSHannes Frederic Sowa ext_filter_mask & RTEXT_FILTER_VF) { 1416ebc08a6fSWilliams, Mitch A int i; 1417b22b941bSHannes Frederic Sowa struct nlattr *vfinfo; 1418c02db8c6SChris Wright int num_vfs = dev_num_vf(dev->dev.parent); 1419c02db8c6SChris Wright 1420c02db8c6SChris Wright vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST); 1421c02db8c6SChris Wright if (!vfinfo) 1422c02db8c6SChris Wright goto nla_put_failure; 1423c02db8c6SChris Wright for (i = 0; i < num_vfs; i++) { 1424b22b941bSHannes Frederic Sowa if (rtnl_fill_vfinfo(skb, dev, i, vfinfo)) 1425b22b941bSHannes Frederic Sowa goto nla_put_failure; 1426b22b941bSHannes Frederic Sowa } 14275f8444a3SGreg Rose 1428c02db8c6SChris Wright nla_nest_end(skb, vfinfo); 1429ebc08a6fSWilliams, Mitch A } 143057b61080SScott Feldman 1431c53864fdSDavid Gibson if (rtnl_port_fill(skb, dev, ext_filter_mask)) 143257b61080SScott Feldman goto nla_put_failure; 143357b61080SScott Feldman 1434d1fdd913SBrenden Blanco if (rtnl_xdp_fill(skb, dev)) 1435d1fdd913SBrenden Blanco goto nla_put_failure; 1436d1fdd913SBrenden Blanco 1437ba7d49b1SJiri Pirko if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) { 143838f7b870SPatrick McHardy if (rtnl_link_fill(skb, dev) < 0) 143938f7b870SPatrick McHardy goto nla_put_failure; 144038f7b870SPatrick McHardy } 144138f7b870SPatrick McHardy 1442d37512a2SNicolas Dichtel if (dev->rtnl_link_ops && 1443d37512a2SNicolas Dichtel dev->rtnl_link_ops->get_link_net) { 1444d37512a2SNicolas Dichtel struct net *link_net = dev->rtnl_link_ops->get_link_net(dev); 1445d37512a2SNicolas Dichtel 1446d37512a2SNicolas Dichtel if (!net_eq(dev_net(dev), link_net)) { 14477a0877d4SNicolas Dichtel int id = peernet2id_alloc(dev_net(dev), link_net); 1448d37512a2SNicolas Dichtel 1449d37512a2SNicolas Dichtel if (nla_put_s32(skb, IFLA_LINK_NETNSID, id)) 1450d37512a2SNicolas Dichtel goto nla_put_failure; 1451d37512a2SNicolas Dichtel } 1452d37512a2SNicolas Dichtel } 1453d37512a2SNicolas Dichtel 1454f8ff182cSThomas Graf if (!(af_spec = nla_nest_start(skb, IFLA_AF_SPEC))) 1455f8ff182cSThomas Graf goto nla_put_failure; 1456f8ff182cSThomas Graf 1457f8ff182cSThomas Graf list_for_each_entry(af_ops, &rtnl_af_ops, list) { 1458f8ff182cSThomas Graf if (af_ops->fill_link_af) { 1459f8ff182cSThomas Graf struct nlattr *af; 1460f8ff182cSThomas Graf int err; 1461f8ff182cSThomas Graf 1462f8ff182cSThomas Graf if (!(af = nla_nest_start(skb, af_ops->family))) 1463f8ff182cSThomas Graf goto nla_put_failure; 1464f8ff182cSThomas Graf 1465d5566fd7SSowmini Varadhan err = af_ops->fill_link_af(skb, dev, ext_filter_mask); 1466f8ff182cSThomas Graf 1467f8ff182cSThomas Graf /* 1468f8ff182cSThomas Graf * Caller may return ENODATA to indicate that there 1469f8ff182cSThomas Graf * was no data to be dumped. This is not an error, it 1470f8ff182cSThomas Graf * means we should trim the attribute header and 1471f8ff182cSThomas Graf * continue. 1472f8ff182cSThomas Graf */ 1473f8ff182cSThomas Graf if (err == -ENODATA) 1474f8ff182cSThomas Graf nla_nest_cancel(skb, af); 1475f8ff182cSThomas Graf else if (err < 0) 1476f8ff182cSThomas Graf goto nla_put_failure; 1477f8ff182cSThomas Graf 1478f8ff182cSThomas Graf nla_nest_end(skb, af); 1479f8ff182cSThomas Graf } 1480f8ff182cSThomas Graf } 1481f8ff182cSThomas Graf 1482f8ff182cSThomas Graf nla_nest_end(skb, af_spec); 1483f8ff182cSThomas Graf 1484053c095aSJohannes Berg nlmsg_end(skb, nlh); 1485053c095aSJohannes Berg return 0; 1486b60c5115SThomas Graf 1487b60c5115SThomas Graf nla_put_failure: 148826932566SPatrick McHardy nlmsg_cancel(skb, nlh); 148926932566SPatrick McHardy return -EMSGSIZE; 14901da177e4SLinus Torvalds } 14911da177e4SLinus Torvalds 1492f7b12606SJiri Pirko static const struct nla_policy ifla_policy[IFLA_MAX+1] = { 1493f7b12606SJiri Pirko [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, 1494f7b12606SJiri Pirko [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1495f7b12606SJiri Pirko [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1496f7b12606SJiri Pirko [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, 1497f7b12606SJiri Pirko [IFLA_MTU] = { .type = NLA_U32 }, 1498f7b12606SJiri Pirko [IFLA_LINK] = { .type = NLA_U32 }, 1499f7b12606SJiri Pirko [IFLA_MASTER] = { .type = NLA_U32 }, 1500f7b12606SJiri Pirko [IFLA_CARRIER] = { .type = NLA_U8 }, 1501f7b12606SJiri Pirko [IFLA_TXQLEN] = { .type = NLA_U32 }, 1502f7b12606SJiri Pirko [IFLA_WEIGHT] = { .type = NLA_U32 }, 1503f7b12606SJiri Pirko [IFLA_OPERSTATE] = { .type = NLA_U8 }, 1504f7b12606SJiri Pirko [IFLA_LINKMODE] = { .type = NLA_U8 }, 1505f7b12606SJiri Pirko [IFLA_LINKINFO] = { .type = NLA_NESTED }, 1506f7b12606SJiri Pirko [IFLA_NET_NS_PID] = { .type = NLA_U32 }, 1507f7b12606SJiri Pirko [IFLA_NET_NS_FD] = { .type = NLA_U32 }, 1508f7b12606SJiri Pirko [IFLA_IFALIAS] = { .type = NLA_STRING, .len = IFALIASZ-1 }, 1509f7b12606SJiri Pirko [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, 1510f7b12606SJiri Pirko [IFLA_VF_PORTS] = { .type = NLA_NESTED }, 1511f7b12606SJiri Pirko [IFLA_PORT_SELF] = { .type = NLA_NESTED }, 1512f7b12606SJiri Pirko [IFLA_AF_SPEC] = { .type = NLA_NESTED }, 1513f7b12606SJiri Pirko [IFLA_EXT_MASK] = { .type = NLA_U32 }, 1514f7b12606SJiri Pirko [IFLA_PROMISCUITY] = { .type = NLA_U32 }, 1515f7b12606SJiri Pirko [IFLA_NUM_TX_QUEUES] = { .type = NLA_U32 }, 1516f7b12606SJiri Pirko [IFLA_NUM_RX_QUEUES] = { .type = NLA_U32 }, 151702637fceSJiri Pirko [IFLA_PHYS_PORT_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 15182d3b479dSdavid decotigny [IFLA_CARRIER_CHANGES] = { .type = NLA_U32 }, /* ignored */ 151982f28412SJiri Pirko [IFLA_PHYS_SWITCH_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 1520317f4810SNicolas Dichtel [IFLA_LINK_NETNSID] = { .type = NLA_S32 }, 152188d6378bSAnuradha Karuppiah [IFLA_PROTO_DOWN] = { .type = NLA_U8 }, 1522d1fdd913SBrenden Blanco [IFLA_XDP] = { .type = NLA_NESTED }, 15233d3ea5afSVlad Yasevich [IFLA_EVENT] = { .type = NLA_U32 }, 1524db833d40SSerhey Popovych [IFLA_GROUP] = { .type = NLA_U32 }, 1525f7b12606SJiri Pirko }; 1526f7b12606SJiri Pirko 1527f7b12606SJiri Pirko static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { 1528f7b12606SJiri Pirko [IFLA_INFO_KIND] = { .type = NLA_STRING }, 1529f7b12606SJiri Pirko [IFLA_INFO_DATA] = { .type = NLA_NESTED }, 1530f7b12606SJiri Pirko [IFLA_INFO_SLAVE_KIND] = { .type = NLA_STRING }, 1531f7b12606SJiri Pirko [IFLA_INFO_SLAVE_DATA] = { .type = NLA_NESTED }, 1532f7b12606SJiri Pirko }; 1533f7b12606SJiri Pirko 1534f7b12606SJiri Pirko static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { 1535364d5716SDaniel Borkmann [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) }, 1536364d5716SDaniel Borkmann [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) }, 153779aab093SMoshe Shemesh [IFLA_VF_VLAN_LIST] = { .type = NLA_NESTED }, 1538364d5716SDaniel Borkmann [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) }, 1539364d5716SDaniel Borkmann [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) }, 1540364d5716SDaniel Borkmann [IFLA_VF_RATE] = { .len = sizeof(struct ifla_vf_rate) }, 1541364d5716SDaniel Borkmann [IFLA_VF_LINK_STATE] = { .len = sizeof(struct ifla_vf_link_state) }, 154201a3d796SVlad Zolotarov [IFLA_VF_RSS_QUERY_EN] = { .len = sizeof(struct ifla_vf_rss_query_en) }, 15433b766cd8SEran Ben Elisha [IFLA_VF_STATS] = { .type = NLA_NESTED }, 1544dd461d6aSHiroshi Shimamoto [IFLA_VF_TRUST] = { .len = sizeof(struct ifla_vf_trust) }, 1545cc8e27ccSEli Cohen [IFLA_VF_IB_NODE_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 1546cc8e27ccSEli Cohen [IFLA_VF_IB_PORT_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 15473b766cd8SEran Ben Elisha }; 15483b766cd8SEran Ben Elisha 1549f7b12606SJiri Pirko static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { 1550f7b12606SJiri Pirko [IFLA_PORT_VF] = { .type = NLA_U32 }, 1551f7b12606SJiri Pirko [IFLA_PORT_PROFILE] = { .type = NLA_STRING, 1552f7b12606SJiri Pirko .len = PORT_PROFILE_MAX }, 1553f7b12606SJiri Pirko [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, 1554f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1555f7b12606SJiri Pirko [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, 1556f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1557f7b12606SJiri Pirko [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, 1558f7b12606SJiri Pirko [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, 1559025331dfSDaniel Borkmann 1560025331dfSDaniel Borkmann /* Unused, but we need to keep it here since user space could 1561025331dfSDaniel Borkmann * fill it. It's also broken with regard to NLA_BINARY use in 1562025331dfSDaniel Borkmann * combination with structs. 1563025331dfSDaniel Borkmann */ 1564025331dfSDaniel Borkmann [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, 1565025331dfSDaniel Borkmann .len = sizeof(struct ifla_port_vsi) }, 1566f7b12606SJiri Pirko }; 1567f7b12606SJiri Pirko 1568d1fdd913SBrenden Blanco static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = { 1569d1fdd913SBrenden Blanco [IFLA_XDP_FD] = { .type = NLA_S32 }, 1570d1fdd913SBrenden Blanco [IFLA_XDP_ATTACHED] = { .type = NLA_U8 }, 157185de8576SDaniel Borkmann [IFLA_XDP_FLAGS] = { .type = NLA_U32 }, 157258038695SMartin KaFai Lau [IFLA_XDP_PROG_ID] = { .type = NLA_U32 }, 1573d1fdd913SBrenden Blanco }; 1574d1fdd913SBrenden Blanco 1575dc599f76SDavid Ahern static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla) 1576dc599f76SDavid Ahern { 1577dc599f76SDavid Ahern const struct rtnl_link_ops *ops = NULL; 1578dc599f76SDavid Ahern struct nlattr *linfo[IFLA_INFO_MAX + 1]; 1579dc599f76SDavid Ahern 1580fceb6435SJohannes Berg if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla, 1581fceb6435SJohannes Berg ifla_info_policy, NULL) < 0) 1582dc599f76SDavid Ahern return NULL; 1583dc599f76SDavid Ahern 1584dc599f76SDavid Ahern if (linfo[IFLA_INFO_KIND]) { 1585dc599f76SDavid Ahern char kind[MODULE_NAME_LEN]; 1586dc599f76SDavid Ahern 1587dc599f76SDavid Ahern nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind)); 1588dc599f76SDavid Ahern ops = rtnl_link_ops_get(kind); 1589dc599f76SDavid Ahern } 1590dc599f76SDavid Ahern 1591dc599f76SDavid Ahern return ops; 1592dc599f76SDavid Ahern } 1593dc599f76SDavid Ahern 1594dc599f76SDavid Ahern static bool link_master_filtered(struct net_device *dev, int master_idx) 1595dc599f76SDavid Ahern { 1596dc599f76SDavid Ahern struct net_device *master; 1597dc599f76SDavid Ahern 1598dc599f76SDavid Ahern if (!master_idx) 1599dc599f76SDavid Ahern return false; 1600dc599f76SDavid Ahern 1601dc599f76SDavid Ahern master = netdev_master_upper_dev_get(dev); 1602dc599f76SDavid Ahern if (!master || master->ifindex != master_idx) 1603dc599f76SDavid Ahern return true; 1604dc599f76SDavid Ahern 1605dc599f76SDavid Ahern return false; 1606dc599f76SDavid Ahern } 1607dc599f76SDavid Ahern 1608dc599f76SDavid Ahern static bool link_kind_filtered(const struct net_device *dev, 1609dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1610dc599f76SDavid Ahern { 1611dc599f76SDavid Ahern if (kind_ops && dev->rtnl_link_ops != kind_ops) 1612dc599f76SDavid Ahern return true; 1613dc599f76SDavid Ahern 1614dc599f76SDavid Ahern return false; 1615dc599f76SDavid Ahern } 1616dc599f76SDavid Ahern 1617dc599f76SDavid Ahern static bool link_dump_filtered(struct net_device *dev, 1618dc599f76SDavid Ahern int master_idx, 1619dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1620dc599f76SDavid Ahern { 1621dc599f76SDavid Ahern if (link_master_filtered(dev, master_idx) || 1622dc599f76SDavid Ahern link_kind_filtered(dev, kind_ops)) 1623dc599f76SDavid Ahern return true; 1624dc599f76SDavid Ahern 1625dc599f76SDavid Ahern return false; 1626dc599f76SDavid Ahern } 1627dc599f76SDavid Ahern 1628b60c5115SThomas Graf static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) 16291da177e4SLinus Torvalds { 16303b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 16317c28bd0bSEric Dumazet int h, s_h; 16327c28bd0bSEric Dumazet int idx = 0, s_idx; 16331da177e4SLinus Torvalds struct net_device *dev; 16347c28bd0bSEric Dumazet struct hlist_head *head; 1635115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 1636115c9b81SGreg Rose u32 ext_filter_mask = 0; 1637dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops = NULL; 1638dc599f76SDavid Ahern unsigned int flags = NLM_F_MULTI; 1639dc599f76SDavid Ahern int master_idx = 0; 1640973462bbSDavid Gibson int err; 1641e5eca6d4SMichal Schmidt int hdrlen; 16421da177e4SLinus Torvalds 16437c28bd0bSEric Dumazet s_h = cb->args[0]; 16447c28bd0bSEric Dumazet s_idx = cb->args[1]; 16457c28bd0bSEric Dumazet 1646e5eca6d4SMichal Schmidt /* A hack to preserve kernel<->userspace interface. 1647e5eca6d4SMichal Schmidt * The correct header is ifinfomsg. It is consistent with rtnl_getlink. 1648e5eca6d4SMichal Schmidt * However, before Linux v3.9 the code here assumed rtgenmsg and that's 1649e5eca6d4SMichal Schmidt * what iproute2 < v3.9.0 used. 1650e5eca6d4SMichal Schmidt * We can detect the old iproute2. Even including the IFLA_EXT_MASK 1651e5eca6d4SMichal Schmidt * attribute, its netlink message is shorter than struct ifinfomsg. 1652e5eca6d4SMichal Schmidt */ 1653e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ? 1654e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 1655e5eca6d4SMichal Schmidt 1656fceb6435SJohannes Berg if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX, 1657fceb6435SJohannes Berg ifla_policy, NULL) >= 0) { 1658115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 1659115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 1660dc599f76SDavid Ahern 1661dc599f76SDavid Ahern if (tb[IFLA_MASTER]) 1662dc599f76SDavid Ahern master_idx = nla_get_u32(tb[IFLA_MASTER]); 1663dc599f76SDavid Ahern 1664dc599f76SDavid Ahern if (tb[IFLA_LINKINFO]) 1665dc599f76SDavid Ahern kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]); 1666dc599f76SDavid Ahern 1667dc599f76SDavid Ahern if (master_idx || kind_ops) 1668dc599f76SDavid Ahern flags |= NLM_F_DUMP_FILTERED; 1669a4b64fbeSEric Dumazet } 1670115c9b81SGreg Rose 16717c28bd0bSEric Dumazet for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 16727562f876SPavel Emelianov idx = 0; 16737c28bd0bSEric Dumazet head = &net->dev_index_head[h]; 1674cac5e65eSEric Dumazet hlist_for_each_entry(dev, head, index_hlist) { 1675dc599f76SDavid Ahern if (link_dump_filtered(dev, master_idx, kind_ops)) 16763f0ae05dSZhang Shengju goto cont; 16771da177e4SLinus Torvalds if (idx < s_idx) 16787562f876SPavel Emelianov goto cont; 1679973462bbSDavid Gibson err = rtnl_fill_ifinfo(skb, dev, RTM_NEWLINK, 168015e47304SEric W. Biederman NETLINK_CB(cb->skb).portid, 16817c28bd0bSEric Dumazet cb->nlh->nlmsg_seq, 0, 1682dc599f76SDavid Ahern flags, 16833d3ea5afSVlad Yasevich ext_filter_mask, 0); 1684973462bbSDavid Gibson 1685f6c5775fSDavid Ahern if (err < 0) { 1686f6c5775fSDavid Ahern if (likely(skb->len)) 16877c28bd0bSEric Dumazet goto out; 16884e985adaSThomas Graf 1689f6c5775fSDavid Ahern goto out_err; 1690f6c5775fSDavid Ahern } 16917562f876SPavel Emelianov cont: 16927562f876SPavel Emelianov idx++; 16931da177e4SLinus Torvalds } 16947c28bd0bSEric Dumazet } 16957c28bd0bSEric Dumazet out: 1696f6c5775fSDavid Ahern err = skb->len; 1697f6c5775fSDavid Ahern out_err: 16987c28bd0bSEric Dumazet cb->args[1] = idx; 16997c28bd0bSEric Dumazet cb->args[0] = h; 1700d0225784SJakub Sitnicki cb->seq = net->dev_base_seq; 1701d0225784SJakub Sitnicki nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 17021da177e4SLinus Torvalds 1703f6c5775fSDavid Ahern return err; 17041da177e4SLinus Torvalds } 17051da177e4SLinus Torvalds 1706fceb6435SJohannes Berg int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len, 1707fceb6435SJohannes Berg struct netlink_ext_ack *exterr) 1708f7b12606SJiri Pirko { 1709fceb6435SJohannes Berg return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr); 1710f7b12606SJiri Pirko } 1711f7b12606SJiri Pirko EXPORT_SYMBOL(rtnl_nla_parse_ifla); 171257b61080SScott Feldman 171381adee47SEric W. Biederman struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) 171481adee47SEric W. Biederman { 171581adee47SEric W. Biederman struct net *net; 171681adee47SEric W. Biederman /* Examine the link attributes and figure out which 171781adee47SEric W. Biederman * network namespace we are talking about. 171881adee47SEric W. Biederman */ 171981adee47SEric W. Biederman if (tb[IFLA_NET_NS_PID]) 172081adee47SEric W. Biederman net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); 1721f0630529SEric W. Biederman else if (tb[IFLA_NET_NS_FD]) 1722f0630529SEric W. Biederman net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD])); 172381adee47SEric W. Biederman else 172481adee47SEric W. Biederman net = get_net(src_net); 172581adee47SEric W. Biederman return net; 172681adee47SEric W. Biederman } 172781adee47SEric W. Biederman EXPORT_SYMBOL(rtnl_link_get_net); 172881adee47SEric W. Biederman 17291840bb13SThomas Graf static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) 17301840bb13SThomas Graf { 17311840bb13SThomas Graf if (dev) { 17321840bb13SThomas Graf if (tb[IFLA_ADDRESS] && 17331840bb13SThomas Graf nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) 17341840bb13SThomas Graf return -EINVAL; 17351840bb13SThomas Graf 17361840bb13SThomas Graf if (tb[IFLA_BROADCAST] && 17371840bb13SThomas Graf nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) 17381840bb13SThomas Graf return -EINVAL; 17391840bb13SThomas Graf } 17401840bb13SThomas Graf 1741cf7afbfeSThomas Graf if (tb[IFLA_AF_SPEC]) { 1742cf7afbfeSThomas Graf struct nlattr *af; 1743cf7afbfeSThomas Graf int rem, err; 1744cf7afbfeSThomas Graf 1745cf7afbfeSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 1746cf7afbfeSThomas Graf const struct rtnl_af_ops *af_ops; 1747cf7afbfeSThomas Graf 1748cf7afbfeSThomas Graf if (!(af_ops = rtnl_af_lookup(nla_type(af)))) 1749cf7afbfeSThomas Graf return -EAFNOSUPPORT; 1750cf7afbfeSThomas Graf 1751cf7afbfeSThomas Graf if (!af_ops->set_link_af) 1752cf7afbfeSThomas Graf return -EOPNOTSUPP; 1753cf7afbfeSThomas Graf 1754cf7afbfeSThomas Graf if (af_ops->validate_link_af) { 17556d3a9a68SKurt Van Dijck err = af_ops->validate_link_af(dev, af); 1756cf7afbfeSThomas Graf if (err < 0) 1757cf7afbfeSThomas Graf return err; 1758cf7afbfeSThomas Graf } 1759cf7afbfeSThomas Graf } 1760cf7afbfeSThomas Graf } 1761cf7afbfeSThomas Graf 17621840bb13SThomas Graf return 0; 17631840bb13SThomas Graf } 17641840bb13SThomas Graf 1765cc8e27ccSEli Cohen static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt, 1766cc8e27ccSEli Cohen int guid_type) 1767cc8e27ccSEli Cohen { 1768cc8e27ccSEli Cohen const struct net_device_ops *ops = dev->netdev_ops; 1769cc8e27ccSEli Cohen 1770cc8e27ccSEli Cohen return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type); 1771cc8e27ccSEli Cohen } 1772cc8e27ccSEli Cohen 1773cc8e27ccSEli Cohen static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type) 1774cc8e27ccSEli Cohen { 1775cc8e27ccSEli Cohen if (dev->type != ARPHRD_INFINIBAND) 1776cc8e27ccSEli Cohen return -EOPNOTSUPP; 1777cc8e27ccSEli Cohen 1778cc8e27ccSEli Cohen return handle_infiniband_guid(dev, ivt, guid_type); 1779cc8e27ccSEli Cohen } 1780cc8e27ccSEli Cohen 17814f7d2cdfSDaniel Borkmann static int do_setvfinfo(struct net_device *dev, struct nlattr **tb) 1782c02db8c6SChris Wright { 1783c02db8c6SChris Wright const struct net_device_ops *ops = dev->netdev_ops; 17844f7d2cdfSDaniel Borkmann int err = -EINVAL; 1785c02db8c6SChris Wright 17864f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_MAC]) { 17874f7d2cdfSDaniel Borkmann struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]); 17884f7d2cdfSDaniel Borkmann 1789c02db8c6SChris Wright err = -EOPNOTSUPP; 1790c02db8c6SChris Wright if (ops->ndo_set_vf_mac) 1791c02db8c6SChris Wright err = ops->ndo_set_vf_mac(dev, ivm->vf, 1792c02db8c6SChris Wright ivm->mac); 17934f7d2cdfSDaniel Borkmann if (err < 0) 17944f7d2cdfSDaniel Borkmann return err; 1795c02db8c6SChris Wright } 17964f7d2cdfSDaniel Borkmann 17974f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_VLAN]) { 17984f7d2cdfSDaniel Borkmann struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]); 17994f7d2cdfSDaniel Borkmann 1800c02db8c6SChris Wright err = -EOPNOTSUPP; 1801c02db8c6SChris Wright if (ops->ndo_set_vf_vlan) 18024f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan, 180379aab093SMoshe Shemesh ivv->qos, 180479aab093SMoshe Shemesh htons(ETH_P_8021Q)); 180579aab093SMoshe Shemesh if (err < 0) 180679aab093SMoshe Shemesh return err; 180779aab093SMoshe Shemesh } 180879aab093SMoshe Shemesh 180979aab093SMoshe Shemesh if (tb[IFLA_VF_VLAN_LIST]) { 181079aab093SMoshe Shemesh struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN]; 181179aab093SMoshe Shemesh struct nlattr *attr; 181279aab093SMoshe Shemesh int rem, len = 0; 181379aab093SMoshe Shemesh 181479aab093SMoshe Shemesh err = -EOPNOTSUPP; 181579aab093SMoshe Shemesh if (!ops->ndo_set_vf_vlan) 181679aab093SMoshe Shemesh return err; 181779aab093SMoshe Shemesh 181879aab093SMoshe Shemesh nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) { 181979aab093SMoshe Shemesh if (nla_type(attr) != IFLA_VF_VLAN_INFO || 182079aab093SMoshe Shemesh nla_len(attr) < NLA_HDRLEN) { 182179aab093SMoshe Shemesh return -EINVAL; 182279aab093SMoshe Shemesh } 182379aab093SMoshe Shemesh if (len >= MAX_VLAN_LIST_LEN) 182479aab093SMoshe Shemesh return -EOPNOTSUPP; 182579aab093SMoshe Shemesh ivvl[len] = nla_data(attr); 182679aab093SMoshe Shemesh 182779aab093SMoshe Shemesh len++; 182879aab093SMoshe Shemesh } 1829fa34cd94SArnd Bergmann if (len == 0) 1830fa34cd94SArnd Bergmann return -EINVAL; 1831fa34cd94SArnd Bergmann 183279aab093SMoshe Shemesh err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan, 183379aab093SMoshe Shemesh ivvl[0]->qos, ivvl[0]->vlan_proto); 18344f7d2cdfSDaniel Borkmann if (err < 0) 18354f7d2cdfSDaniel Borkmann return err; 1836c02db8c6SChris Wright } 18374f7d2cdfSDaniel Borkmann 18384f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_TX_RATE]) { 18394f7d2cdfSDaniel Borkmann struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]); 1840ed616689SSucheta Chakraborty struct ifla_vf_info ivf; 18414f7d2cdfSDaniel Borkmann 1842c02db8c6SChris Wright err = -EOPNOTSUPP; 1843ed616689SSucheta Chakraborty if (ops->ndo_get_vf_config) 18444f7d2cdfSDaniel Borkmann err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf); 18454f7d2cdfSDaniel Borkmann if (err < 0) 18464f7d2cdfSDaniel Borkmann return err; 18474f7d2cdfSDaniel Borkmann 1848ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 1849ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 1850ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 1851ed616689SSucheta Chakraborty ivf.min_tx_rate, 1852c02db8c6SChris Wright ivt->rate); 18534f7d2cdfSDaniel Borkmann if (err < 0) 18544f7d2cdfSDaniel Borkmann return err; 1855c02db8c6SChris Wright } 18564f7d2cdfSDaniel Borkmann 18574f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RATE]) { 18584f7d2cdfSDaniel Borkmann struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]); 18594f7d2cdfSDaniel Borkmann 1860ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 1861ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 1862ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 1863ed616689SSucheta Chakraborty ivt->min_tx_rate, 1864ed616689SSucheta Chakraborty ivt->max_tx_rate); 18654f7d2cdfSDaniel Borkmann if (err < 0) 18664f7d2cdfSDaniel Borkmann return err; 1867ed616689SSucheta Chakraborty } 18684f7d2cdfSDaniel Borkmann 18694f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_SPOOFCHK]) { 18704f7d2cdfSDaniel Borkmann struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]); 18714f7d2cdfSDaniel Borkmann 18725f8444a3SGreg Rose err = -EOPNOTSUPP; 18735f8444a3SGreg Rose if (ops->ndo_set_vf_spoofchk) 18745f8444a3SGreg Rose err = ops->ndo_set_vf_spoofchk(dev, ivs->vf, 18755f8444a3SGreg Rose ivs->setting); 18764f7d2cdfSDaniel Borkmann if (err < 0) 18774f7d2cdfSDaniel Borkmann return err; 18785f8444a3SGreg Rose } 18794f7d2cdfSDaniel Borkmann 18804f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_LINK_STATE]) { 18814f7d2cdfSDaniel Borkmann struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]); 18824f7d2cdfSDaniel Borkmann 18831d8faf48SRony Efraim err = -EOPNOTSUPP; 18841d8faf48SRony Efraim if (ops->ndo_set_vf_link_state) 18851d8faf48SRony Efraim err = ops->ndo_set_vf_link_state(dev, ivl->vf, 18861d8faf48SRony Efraim ivl->link_state); 18874f7d2cdfSDaniel Borkmann if (err < 0) 18884f7d2cdfSDaniel Borkmann return err; 18891d8faf48SRony Efraim } 18904f7d2cdfSDaniel Borkmann 18914f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RSS_QUERY_EN]) { 189201a3d796SVlad Zolotarov struct ifla_vf_rss_query_en *ivrssq_en; 189301a3d796SVlad Zolotarov 189401a3d796SVlad Zolotarov err = -EOPNOTSUPP; 18954f7d2cdfSDaniel Borkmann ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]); 189601a3d796SVlad Zolotarov if (ops->ndo_set_vf_rss_query_en) 18974f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf, 189801a3d796SVlad Zolotarov ivrssq_en->setting); 18994f7d2cdfSDaniel Borkmann if (err < 0) 19004f7d2cdfSDaniel Borkmann return err; 190101a3d796SVlad Zolotarov } 19024f7d2cdfSDaniel Borkmann 1903dd461d6aSHiroshi Shimamoto if (tb[IFLA_VF_TRUST]) { 1904dd461d6aSHiroshi Shimamoto struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]); 1905dd461d6aSHiroshi Shimamoto 1906dd461d6aSHiroshi Shimamoto err = -EOPNOTSUPP; 1907dd461d6aSHiroshi Shimamoto if (ops->ndo_set_vf_trust) 1908dd461d6aSHiroshi Shimamoto err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting); 1909dd461d6aSHiroshi Shimamoto if (err < 0) 1910dd461d6aSHiroshi Shimamoto return err; 1911dd461d6aSHiroshi Shimamoto } 1912dd461d6aSHiroshi Shimamoto 1913cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_NODE_GUID]) { 1914cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]); 1915cc8e27ccSEli Cohen 1916cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 1917cc8e27ccSEli Cohen return -EOPNOTSUPP; 1918cc8e27ccSEli Cohen 1919cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID); 1920cc8e27ccSEli Cohen } 1921cc8e27ccSEli Cohen 1922cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_PORT_GUID]) { 1923cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]); 1924cc8e27ccSEli Cohen 1925cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 1926cc8e27ccSEli Cohen return -EOPNOTSUPP; 1927cc8e27ccSEli Cohen 1928cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID); 1929cc8e27ccSEli Cohen } 1930cc8e27ccSEli Cohen 1931c02db8c6SChris Wright return err; 1932c02db8c6SChris Wright } 1933c02db8c6SChris Wright 1934fbaec0eaSJiri Pirko static int do_set_master(struct net_device *dev, int ifindex) 1935fbaec0eaSJiri Pirko { 1936898e5061SJiri Pirko struct net_device *upper_dev = netdev_master_upper_dev_get(dev); 1937fbaec0eaSJiri Pirko const struct net_device_ops *ops; 1938fbaec0eaSJiri Pirko int err; 1939fbaec0eaSJiri Pirko 1940898e5061SJiri Pirko if (upper_dev) { 1941898e5061SJiri Pirko if (upper_dev->ifindex == ifindex) 1942fbaec0eaSJiri Pirko return 0; 1943898e5061SJiri Pirko ops = upper_dev->netdev_ops; 1944fbaec0eaSJiri Pirko if (ops->ndo_del_slave) { 1945898e5061SJiri Pirko err = ops->ndo_del_slave(upper_dev, dev); 1946fbaec0eaSJiri Pirko if (err) 1947fbaec0eaSJiri Pirko return err; 1948fbaec0eaSJiri Pirko } else { 1949fbaec0eaSJiri Pirko return -EOPNOTSUPP; 1950fbaec0eaSJiri Pirko } 1951fbaec0eaSJiri Pirko } 1952fbaec0eaSJiri Pirko 1953fbaec0eaSJiri Pirko if (ifindex) { 1954898e5061SJiri Pirko upper_dev = __dev_get_by_index(dev_net(dev), ifindex); 1955898e5061SJiri Pirko if (!upper_dev) 1956fbaec0eaSJiri Pirko return -EINVAL; 1957898e5061SJiri Pirko ops = upper_dev->netdev_ops; 1958fbaec0eaSJiri Pirko if (ops->ndo_add_slave) { 1959898e5061SJiri Pirko err = ops->ndo_add_slave(upper_dev, dev); 1960fbaec0eaSJiri Pirko if (err) 1961fbaec0eaSJiri Pirko return err; 1962fbaec0eaSJiri Pirko } else { 1963fbaec0eaSJiri Pirko return -EOPNOTSUPP; 1964fbaec0eaSJiri Pirko } 1965fbaec0eaSJiri Pirko } 1966fbaec0eaSJiri Pirko return 0; 1967fbaec0eaSJiri Pirko } 1968fbaec0eaSJiri Pirko 196990c325e3SNicolas Dichtel #define DO_SETLINK_MODIFIED 0x01 1970ba998906SNicolas Dichtel /* notify flag means notify + modified. */ 1971ba998906SNicolas Dichtel #define DO_SETLINK_NOTIFY 0x03 197290f62cf3SEric W. Biederman static int do_setlink(const struct sk_buff *skb, 197390f62cf3SEric W. Biederman struct net_device *dev, struct ifinfomsg *ifm, 1974ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 197590c325e3SNicolas Dichtel struct nlattr **tb, char *ifname, int status) 19760157f60cSPatrick McHardy { 1977d314774cSStephen Hemminger const struct net_device_ops *ops = dev->netdev_ops; 19780157f60cSPatrick McHardy int err; 19790157f60cSPatrick McHardy 1980f0630529SEric W. Biederman if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) { 198181adee47SEric W. Biederman struct net *net = rtnl_link_get_net(dev_net(dev), tb); 1982d8a5ec67SEric W. Biederman if (IS_ERR(net)) { 1983d8a5ec67SEric W. Biederman err = PTR_ERR(net); 1984d8a5ec67SEric W. Biederman goto errout; 1985d8a5ec67SEric W. Biederman } 198690f62cf3SEric W. Biederman if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) { 1987e0ebde0eSNicolas Dichtel put_net(net); 1988b51642f6SEric W. Biederman err = -EPERM; 1989b51642f6SEric W. Biederman goto errout; 1990b51642f6SEric W. Biederman } 1991d8a5ec67SEric W. Biederman err = dev_change_net_namespace(dev, net, ifname); 1992d8a5ec67SEric W. Biederman put_net(net); 1993d8a5ec67SEric W. Biederman if (err) 1994d8a5ec67SEric W. Biederman goto errout; 199590c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 1996d8a5ec67SEric W. Biederman } 1997d8a5ec67SEric W. Biederman 19980157f60cSPatrick McHardy if (tb[IFLA_MAP]) { 19990157f60cSPatrick McHardy struct rtnl_link_ifmap *u_map; 20000157f60cSPatrick McHardy struct ifmap k_map; 20010157f60cSPatrick McHardy 2002d314774cSStephen Hemminger if (!ops->ndo_set_config) { 20030157f60cSPatrick McHardy err = -EOPNOTSUPP; 20040157f60cSPatrick McHardy goto errout; 20050157f60cSPatrick McHardy } 20060157f60cSPatrick McHardy 20070157f60cSPatrick McHardy if (!netif_device_present(dev)) { 20080157f60cSPatrick McHardy err = -ENODEV; 20090157f60cSPatrick McHardy goto errout; 20100157f60cSPatrick McHardy } 20110157f60cSPatrick McHardy 20120157f60cSPatrick McHardy u_map = nla_data(tb[IFLA_MAP]); 20130157f60cSPatrick McHardy k_map.mem_start = (unsigned long) u_map->mem_start; 20140157f60cSPatrick McHardy k_map.mem_end = (unsigned long) u_map->mem_end; 20150157f60cSPatrick McHardy k_map.base_addr = (unsigned short) u_map->base_addr; 20160157f60cSPatrick McHardy k_map.irq = (unsigned char) u_map->irq; 20170157f60cSPatrick McHardy k_map.dma = (unsigned char) u_map->dma; 20180157f60cSPatrick McHardy k_map.port = (unsigned char) u_map->port; 20190157f60cSPatrick McHardy 2020d314774cSStephen Hemminger err = ops->ndo_set_config(dev, &k_map); 20210157f60cSPatrick McHardy if (err < 0) 20220157f60cSPatrick McHardy goto errout; 20230157f60cSPatrick McHardy 2024ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 20250157f60cSPatrick McHardy } 20260157f60cSPatrick McHardy 20270157f60cSPatrick McHardy if (tb[IFLA_ADDRESS]) { 20280157f60cSPatrick McHardy struct sockaddr *sa; 20290157f60cSPatrick McHardy int len; 20300157f60cSPatrick McHardy 2031153711f9SWANG Cong len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len, 2032153711f9SWANG Cong sizeof(*sa)); 20330157f60cSPatrick McHardy sa = kmalloc(len, GFP_KERNEL); 20340157f60cSPatrick McHardy if (!sa) { 20350157f60cSPatrick McHardy err = -ENOMEM; 20360157f60cSPatrick McHardy goto errout; 20370157f60cSPatrick McHardy } 20380157f60cSPatrick McHardy sa->sa_family = dev->type; 20390157f60cSPatrick McHardy memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), 20400157f60cSPatrick McHardy dev->addr_len); 2041e7c3273eSJiri Pirko err = dev_set_mac_address(dev, sa); 20420157f60cSPatrick McHardy kfree(sa); 20430157f60cSPatrick McHardy if (err) 20440157f60cSPatrick McHardy goto errout; 204590c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20460157f60cSPatrick McHardy } 20470157f60cSPatrick McHardy 20480157f60cSPatrick McHardy if (tb[IFLA_MTU]) { 20490157f60cSPatrick McHardy err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU])); 20500157f60cSPatrick McHardy if (err < 0) 20510157f60cSPatrick McHardy goto errout; 205290c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20530157f60cSPatrick McHardy } 20540157f60cSPatrick McHardy 2055cbda10faSVlad Dogaru if (tb[IFLA_GROUP]) { 2056cbda10faSVlad Dogaru dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2057ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2058cbda10faSVlad Dogaru } 2059cbda10faSVlad Dogaru 20600157f60cSPatrick McHardy /* 20610157f60cSPatrick McHardy * Interface selected by interface index but interface 20620157f60cSPatrick McHardy * name provided implies that a name change has been 20630157f60cSPatrick McHardy * requested. 20640157f60cSPatrick McHardy */ 20650157f60cSPatrick McHardy if (ifm->ifi_index > 0 && ifname[0]) { 20660157f60cSPatrick McHardy err = dev_change_name(dev, ifname); 20670157f60cSPatrick McHardy if (err < 0) 20680157f60cSPatrick McHardy goto errout; 206990c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 20700157f60cSPatrick McHardy } 20710157f60cSPatrick McHardy 20720b815a1aSStephen Hemminger if (tb[IFLA_IFALIAS]) { 20730b815a1aSStephen Hemminger err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), 20740b815a1aSStephen Hemminger nla_len(tb[IFLA_IFALIAS])); 20750b815a1aSStephen Hemminger if (err < 0) 20760b815a1aSStephen Hemminger goto errout; 2077ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 20780b815a1aSStephen Hemminger } 20790b815a1aSStephen Hemminger 20800157f60cSPatrick McHardy if (tb[IFLA_BROADCAST]) { 20810157f60cSPatrick McHardy nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); 2082e7c3273eSJiri Pirko call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); 20830157f60cSPatrick McHardy } 20840157f60cSPatrick McHardy 20850157f60cSPatrick McHardy if (ifm->ifi_flags || ifm->ifi_change) { 20863729d502SPatrick McHardy err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 20875f9021cfSJohannes Berg if (err < 0) 20885f9021cfSJohannes Berg goto errout; 20890157f60cSPatrick McHardy } 20900157f60cSPatrick McHardy 2091fbaec0eaSJiri Pirko if (tb[IFLA_MASTER]) { 2092fbaec0eaSJiri Pirko err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER])); 2093fbaec0eaSJiri Pirko if (err) 2094fbaec0eaSJiri Pirko goto errout; 209590c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 2096fbaec0eaSJiri Pirko } 2097fbaec0eaSJiri Pirko 20989a57247fSJiri Pirko if (tb[IFLA_CARRIER]) { 20999a57247fSJiri Pirko err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER])); 21009a57247fSJiri Pirko if (err) 21019a57247fSJiri Pirko goto errout; 210290c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 21039a57247fSJiri Pirko } 21049a57247fSJiri Pirko 21055d1180fcSNicolas Dichtel if (tb[IFLA_TXQLEN]) { 21060cd29503SAlexey Dobriyan unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]); 21070cd29503SAlexey Dobriyan unsigned int orig_len = dev->tx_queue_len; 21085d1180fcSNicolas Dichtel 210908294a26SJason Wang if (dev->tx_queue_len ^ value) { 21105d1180fcSNicolas Dichtel dev->tx_queue_len = value; 211108294a26SJason Wang err = call_netdevice_notifiers( 211208294a26SJason Wang NETDEV_CHANGE_TX_QUEUE_LEN, dev); 211308294a26SJason Wang err = notifier_to_errno(err); 211408294a26SJason Wang if (err) { 211508294a26SJason Wang dev->tx_queue_len = orig_len; 211608294a26SJason Wang goto errout; 211708294a26SJason Wang } 211808294a26SJason Wang status |= DO_SETLINK_NOTIFY; 211908294a26SJason Wang } 21205d1180fcSNicolas Dichtel } 21210157f60cSPatrick McHardy 21220157f60cSPatrick McHardy if (tb[IFLA_OPERSTATE]) 212393b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 21240157f60cSPatrick McHardy 21250157f60cSPatrick McHardy if (tb[IFLA_LINKMODE]) { 21261889b0e7SNicolas Dichtel unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]); 21271889b0e7SNicolas Dichtel 21280157f60cSPatrick McHardy write_lock_bh(&dev_base_lock); 21291889b0e7SNicolas Dichtel if (dev->link_mode ^ value) 2130ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 21311889b0e7SNicolas Dichtel dev->link_mode = value; 213293b2d4a2SDavid S. Miller write_unlock_bh(&dev_base_lock); 21330157f60cSPatrick McHardy } 21340157f60cSPatrick McHardy 2135c02db8c6SChris Wright if (tb[IFLA_VFINFO_LIST]) { 21364f7d2cdfSDaniel Borkmann struct nlattr *vfinfo[IFLA_VF_MAX + 1]; 2137c02db8c6SChris Wright struct nlattr *attr; 2138c02db8c6SChris Wright int rem; 21394f7d2cdfSDaniel Borkmann 2140c02db8c6SChris Wright nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { 21414f7d2cdfSDaniel Borkmann if (nla_type(attr) != IFLA_VF_INFO || 21424f7d2cdfSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2143253683bbSDavid Howells err = -EINVAL; 2144c02db8c6SChris Wright goto errout; 2145253683bbSDavid Howells } 21464f7d2cdfSDaniel Borkmann err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr, 2147fceb6435SJohannes Berg ifla_vf_policy, NULL); 21484f7d2cdfSDaniel Borkmann if (err < 0) 21494f7d2cdfSDaniel Borkmann goto errout; 21504f7d2cdfSDaniel Borkmann err = do_setvfinfo(dev, vfinfo); 2151ebc08a6fSWilliams, Mitch A if (err < 0) 2152ebc08a6fSWilliams, Mitch A goto errout; 2153ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2154ebc08a6fSWilliams, Mitch A } 2155ebc08a6fSWilliams, Mitch A } 21560157f60cSPatrick McHardy err = 0; 21570157f60cSPatrick McHardy 215857b61080SScott Feldman if (tb[IFLA_VF_PORTS]) { 215957b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 216057b61080SScott Feldman struct nlattr *attr; 216157b61080SScott Feldman int vf; 216257b61080SScott Feldman int rem; 216357b61080SScott Feldman 216457b61080SScott Feldman err = -EOPNOTSUPP; 216557b61080SScott Feldman if (!ops->ndo_set_vf_port) 216657b61080SScott Feldman goto errout; 216757b61080SScott Feldman 216857b61080SScott Feldman nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { 2169035d210fSDaniel Borkmann if (nla_type(attr) != IFLA_VF_PORT || 2170035d210fSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2171035d210fSDaniel Borkmann err = -EINVAL; 2172035d210fSDaniel Borkmann goto errout; 2173035d210fSDaniel Borkmann } 2174035d210fSDaniel Borkmann err = nla_parse_nested(port, IFLA_PORT_MAX, attr, 2175fceb6435SJohannes Berg ifla_port_policy, NULL); 217657b61080SScott Feldman if (err < 0) 217757b61080SScott Feldman goto errout; 217857b61080SScott Feldman if (!port[IFLA_PORT_VF]) { 217957b61080SScott Feldman err = -EOPNOTSUPP; 218057b61080SScott Feldman goto errout; 218157b61080SScott Feldman } 218257b61080SScott Feldman vf = nla_get_u32(port[IFLA_PORT_VF]); 218357b61080SScott Feldman err = ops->ndo_set_vf_port(dev, vf, port); 218457b61080SScott Feldman if (err < 0) 218557b61080SScott Feldman goto errout; 2186ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 218757b61080SScott Feldman } 218857b61080SScott Feldman } 218957b61080SScott Feldman err = 0; 219057b61080SScott Feldman 219157b61080SScott Feldman if (tb[IFLA_PORT_SELF]) { 219257b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 219357b61080SScott Feldman 219457b61080SScott Feldman err = nla_parse_nested(port, IFLA_PORT_MAX, 2195fceb6435SJohannes Berg tb[IFLA_PORT_SELF], ifla_port_policy, 2196fceb6435SJohannes Berg NULL); 219757b61080SScott Feldman if (err < 0) 219857b61080SScott Feldman goto errout; 219957b61080SScott Feldman 220057b61080SScott Feldman err = -EOPNOTSUPP; 220157b61080SScott Feldman if (ops->ndo_set_vf_port) 220257b61080SScott Feldman err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); 220357b61080SScott Feldman if (err < 0) 220457b61080SScott Feldman goto errout; 2205ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 220657b61080SScott Feldman } 2207f8ff182cSThomas Graf 2208f8ff182cSThomas Graf if (tb[IFLA_AF_SPEC]) { 2209f8ff182cSThomas Graf struct nlattr *af; 2210f8ff182cSThomas Graf int rem; 2211f8ff182cSThomas Graf 2212f8ff182cSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 2213f8ff182cSThomas Graf const struct rtnl_af_ops *af_ops; 2214f8ff182cSThomas Graf 2215f8ff182cSThomas Graf if (!(af_ops = rtnl_af_lookup(nla_type(af)))) 2216cf7afbfeSThomas Graf BUG(); 2217f8ff182cSThomas Graf 2218cf7afbfeSThomas Graf err = af_ops->set_link_af(dev, af); 2219f8ff182cSThomas Graf if (err < 0) 2220f8ff182cSThomas Graf goto errout; 2221f8ff182cSThomas Graf 2222ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2223f8ff182cSThomas Graf } 2224f8ff182cSThomas Graf } 222557b61080SScott Feldman err = 0; 222657b61080SScott Feldman 222788d6378bSAnuradha Karuppiah if (tb[IFLA_PROTO_DOWN]) { 222888d6378bSAnuradha Karuppiah err = dev_change_proto_down(dev, 222988d6378bSAnuradha Karuppiah nla_get_u8(tb[IFLA_PROTO_DOWN])); 223088d6378bSAnuradha Karuppiah if (err) 223188d6378bSAnuradha Karuppiah goto errout; 223288d6378bSAnuradha Karuppiah status |= DO_SETLINK_NOTIFY; 223388d6378bSAnuradha Karuppiah } 223488d6378bSAnuradha Karuppiah 2235d1fdd913SBrenden Blanco if (tb[IFLA_XDP]) { 2236d1fdd913SBrenden Blanco struct nlattr *xdp[IFLA_XDP_MAX + 1]; 223785de8576SDaniel Borkmann u32 xdp_flags = 0; 2238d1fdd913SBrenden Blanco 2239d1fdd913SBrenden Blanco err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP], 2240fceb6435SJohannes Berg ifla_xdp_policy, NULL); 2241d1fdd913SBrenden Blanco if (err < 0) 2242d1fdd913SBrenden Blanco goto errout; 2243d1fdd913SBrenden Blanco 224458038695SMartin KaFai Lau if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) { 2245262d8625SBrenden Blanco err = -EINVAL; 2246262d8625SBrenden Blanco goto errout; 2247262d8625SBrenden Blanco } 224885de8576SDaniel Borkmann 224985de8576SDaniel Borkmann if (xdp[IFLA_XDP_FLAGS]) { 225085de8576SDaniel Borkmann xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]); 225185de8576SDaniel Borkmann if (xdp_flags & ~XDP_FLAGS_MASK) { 225285de8576SDaniel Borkmann err = -EINVAL; 225385de8576SDaniel Borkmann goto errout; 225485de8576SDaniel Borkmann } 2255ee5d032fSJakub Kicinski if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) { 22560489df9aSDaniel Borkmann err = -EINVAL; 22570489df9aSDaniel Borkmann goto errout; 22580489df9aSDaniel Borkmann } 225985de8576SDaniel Borkmann } 226085de8576SDaniel Borkmann 2261d1fdd913SBrenden Blanco if (xdp[IFLA_XDP_FD]) { 2262ddf9f970SJakub Kicinski err = dev_change_xdp_fd(dev, extack, 226385de8576SDaniel Borkmann nla_get_s32(xdp[IFLA_XDP_FD]), 226485de8576SDaniel Borkmann xdp_flags); 2265d1fdd913SBrenden Blanco if (err) 2266d1fdd913SBrenden Blanco goto errout; 2267d1fdd913SBrenden Blanco status |= DO_SETLINK_NOTIFY; 2268d1fdd913SBrenden Blanco } 2269d1fdd913SBrenden Blanco } 2270d1fdd913SBrenden Blanco 22710157f60cSPatrick McHardy errout: 2272ba998906SNicolas Dichtel if (status & DO_SETLINK_MODIFIED) { 2273ba998906SNicolas Dichtel if (status & DO_SETLINK_NOTIFY) 2274ba998906SNicolas Dichtel netdev_state_change(dev); 2275ba998906SNicolas Dichtel 2276ba998906SNicolas Dichtel if (err < 0) 2277e87cc472SJoe 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", 2278e87cc472SJoe Perches dev->name); 2279ba998906SNicolas Dichtel } 22800157f60cSPatrick McHardy 22810157f60cSPatrick McHardy return err; 22820157f60cSPatrick McHardy } 22830157f60cSPatrick McHardy 2284c21ef3e3SDavid Ahern static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2285c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2286da5e0494SThomas Graf { 22873b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 2288da5e0494SThomas Graf struct ifinfomsg *ifm; 2289da5e0494SThomas Graf struct net_device *dev; 22900157f60cSPatrick McHardy int err; 2291da5e0494SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 22921da177e4SLinus Torvalds char ifname[IFNAMSIZ]; 22931da177e4SLinus Torvalds 2294c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, 2295c21ef3e3SDavid Ahern extack); 2296da5e0494SThomas Graf if (err < 0) 2297da5e0494SThomas Graf goto errout; 22981da177e4SLinus Torvalds 22995176f91eSThomas Graf if (tb[IFLA_IFNAME]) 23005176f91eSThomas Graf nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 230178e5b891SPatrick McHardy else 230278e5b891SPatrick McHardy ifname[0] = '\0'; 23031da177e4SLinus Torvalds 23041da177e4SLinus Torvalds err = -EINVAL; 2305da5e0494SThomas Graf ifm = nlmsg_data(nlh); 230651055be8SPatrick McHardy if (ifm->ifi_index > 0) 2307a3d12891SEric Dumazet dev = __dev_get_by_index(net, ifm->ifi_index); 2308da5e0494SThomas Graf else if (tb[IFLA_IFNAME]) 2309a3d12891SEric Dumazet dev = __dev_get_by_name(net, ifname); 2310da5e0494SThomas Graf else 2311da5e0494SThomas Graf goto errout; 23121da177e4SLinus Torvalds 2313da5e0494SThomas Graf if (dev == NULL) { 2314da5e0494SThomas Graf err = -ENODEV; 2315da5e0494SThomas Graf goto errout; 2316da5e0494SThomas Graf } 23171da177e4SLinus Torvalds 2318e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2319e0d087afSEric Dumazet if (err < 0) 2320a3d12891SEric Dumazet goto errout; 2321da5e0494SThomas Graf 2322ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0); 2323da5e0494SThomas Graf errout: 23241da177e4SLinus Torvalds return err; 23251da177e4SLinus Torvalds } 23261da177e4SLinus Torvalds 232766400d54SWANG Cong static int rtnl_group_dellink(const struct net *net, int group) 232866400d54SWANG Cong { 232966400d54SWANG Cong struct net_device *dev, *aux; 233066400d54SWANG Cong LIST_HEAD(list_kill); 233166400d54SWANG Cong bool found = false; 233266400d54SWANG Cong 233366400d54SWANG Cong if (!group) 233466400d54SWANG Cong return -EPERM; 233566400d54SWANG Cong 233666400d54SWANG Cong for_each_netdev(net, dev) { 233766400d54SWANG Cong if (dev->group == group) { 233866400d54SWANG Cong const struct rtnl_link_ops *ops; 233966400d54SWANG Cong 234066400d54SWANG Cong found = true; 234166400d54SWANG Cong ops = dev->rtnl_link_ops; 234266400d54SWANG Cong if (!ops || !ops->dellink) 234366400d54SWANG Cong return -EOPNOTSUPP; 234466400d54SWANG Cong } 234566400d54SWANG Cong } 234666400d54SWANG Cong 234766400d54SWANG Cong if (!found) 234866400d54SWANG Cong return -ENODEV; 234966400d54SWANG Cong 235066400d54SWANG Cong for_each_netdev_safe(net, dev, aux) { 235166400d54SWANG Cong if (dev->group == group) { 235266400d54SWANG Cong const struct rtnl_link_ops *ops; 235366400d54SWANG Cong 235466400d54SWANG Cong ops = dev->rtnl_link_ops; 235566400d54SWANG Cong ops->dellink(dev, &list_kill); 235666400d54SWANG Cong } 235766400d54SWANG Cong } 235866400d54SWANG Cong unregister_netdevice_many(&list_kill); 235966400d54SWANG Cong 236066400d54SWANG Cong return 0; 236166400d54SWANG Cong } 236266400d54SWANG Cong 2363614732eaSThomas Graf int rtnl_delete_link(struct net_device *dev) 2364614732eaSThomas Graf { 2365614732eaSThomas Graf const struct rtnl_link_ops *ops; 2366614732eaSThomas Graf LIST_HEAD(list_kill); 2367614732eaSThomas Graf 2368614732eaSThomas Graf ops = dev->rtnl_link_ops; 2369614732eaSThomas Graf if (!ops || !ops->dellink) 2370614732eaSThomas Graf return -EOPNOTSUPP; 2371614732eaSThomas Graf 2372614732eaSThomas Graf ops->dellink(dev, &list_kill); 2373614732eaSThomas Graf unregister_netdevice_many(&list_kill); 2374614732eaSThomas Graf 2375614732eaSThomas Graf return 0; 2376614732eaSThomas Graf } 2377614732eaSThomas Graf EXPORT_SYMBOL_GPL(rtnl_delete_link); 2378614732eaSThomas Graf 2379c21ef3e3SDavid Ahern static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 2380c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 238138f7b870SPatrick McHardy { 23823b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 238338f7b870SPatrick McHardy struct net_device *dev; 238438f7b870SPatrick McHardy struct ifinfomsg *ifm; 238538f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 238638f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 238738f7b870SPatrick McHardy int err; 238838f7b870SPatrick McHardy 2389c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 239038f7b870SPatrick McHardy if (err < 0) 239138f7b870SPatrick McHardy return err; 239238f7b870SPatrick McHardy 239338f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 239438f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 239538f7b870SPatrick McHardy 239638f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 239738f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2398881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 239938f7b870SPatrick McHardy else if (tb[IFLA_IFNAME]) 2400881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 240166400d54SWANG Cong else if (tb[IFLA_GROUP]) 240266400d54SWANG Cong return rtnl_group_dellink(net, nla_get_u32(tb[IFLA_GROUP])); 240338f7b870SPatrick McHardy else 240438f7b870SPatrick McHardy return -EINVAL; 240538f7b870SPatrick McHardy 240638f7b870SPatrick McHardy if (!dev) 240738f7b870SPatrick McHardy return -ENODEV; 240838f7b870SPatrick McHardy 2409614732eaSThomas Graf return rtnl_delete_link(dev); 241038f7b870SPatrick McHardy } 241138f7b870SPatrick McHardy 24123729d502SPatrick McHardy int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) 24133729d502SPatrick McHardy { 24143729d502SPatrick McHardy unsigned int old_flags; 24153729d502SPatrick McHardy int err; 24163729d502SPatrick McHardy 24173729d502SPatrick McHardy old_flags = dev->flags; 24183729d502SPatrick McHardy if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { 24193729d502SPatrick McHardy err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 24203729d502SPatrick McHardy if (err < 0) 24213729d502SPatrick McHardy return err; 24223729d502SPatrick McHardy } 24233729d502SPatrick McHardy 24243729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZED; 24253729d502SPatrick McHardy 2426a528c219SNicolas Dichtel __dev_notify_flags(dev, old_flags, ~0U); 24273729d502SPatrick McHardy return 0; 24283729d502SPatrick McHardy } 24293729d502SPatrick McHardy EXPORT_SYMBOL(rtnl_configure_link); 24303729d502SPatrick McHardy 2431c0713563SRami Rosen struct net_device *rtnl_create_link(struct net *net, 243278ebb0d0SThomas Graf const char *ifname, unsigned char name_assign_type, 24335517750fSTom Gundersen const struct rtnl_link_ops *ops, struct nlattr *tb[]) 2434e7199288SPavel Emelianov { 2435e7199288SPavel Emelianov struct net_device *dev; 2436d40156aaSJiri Pirko unsigned int num_tx_queues = 1; 2437d40156aaSJiri Pirko unsigned int num_rx_queues = 1; 2438e7199288SPavel Emelianov 243976ff5cc9SJiri Pirko if (tb[IFLA_NUM_TX_QUEUES]) 244076ff5cc9SJiri Pirko num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]); 244176ff5cc9SJiri Pirko else if (ops->get_num_tx_queues) 2442d40156aaSJiri Pirko num_tx_queues = ops->get_num_tx_queues(); 244376ff5cc9SJiri Pirko 244476ff5cc9SJiri Pirko if (tb[IFLA_NUM_RX_QUEUES]) 244576ff5cc9SJiri Pirko num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]); 244676ff5cc9SJiri Pirko else if (ops->get_num_rx_queues) 2447d40156aaSJiri Pirko num_rx_queues = ops->get_num_rx_queues(); 2448efacb309Sstephen hemminger 24495517750fSTom Gundersen dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type, 2450c835a677STom Gundersen ops->setup, num_tx_queues, num_rx_queues); 2451e7199288SPavel Emelianov if (!dev) 2452d1892e4eSTobias Klauser return ERR_PTR(-ENOMEM); 2453e7199288SPavel Emelianov 245481adee47SEric W. Biederman dev_net_set(dev, net); 245581adee47SEric W. Biederman dev->rtnl_link_ops = ops; 24563729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZING; 245781adee47SEric W. Biederman 2458e7199288SPavel Emelianov if (tb[IFLA_MTU]) 2459e7199288SPavel Emelianov dev->mtu = nla_get_u32(tb[IFLA_MTU]); 24602afb9b53SJiri Pirko if (tb[IFLA_ADDRESS]) { 2461e7199288SPavel Emelianov memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), 2462e7199288SPavel Emelianov nla_len(tb[IFLA_ADDRESS])); 24632afb9b53SJiri Pirko dev->addr_assign_type = NET_ADDR_SET; 24642afb9b53SJiri Pirko } 2465e7199288SPavel Emelianov if (tb[IFLA_BROADCAST]) 2466e7199288SPavel Emelianov memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), 2467e7199288SPavel Emelianov nla_len(tb[IFLA_BROADCAST])); 2468e7199288SPavel Emelianov if (tb[IFLA_TXQLEN]) 2469e7199288SPavel Emelianov dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); 2470e7199288SPavel Emelianov if (tb[IFLA_OPERSTATE]) 247193b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 2472e7199288SPavel Emelianov if (tb[IFLA_LINKMODE]) 2473e7199288SPavel Emelianov dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); 2474ffa934f1SPatrick McHardy if (tb[IFLA_GROUP]) 2475ffa934f1SPatrick McHardy dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2476e7199288SPavel Emelianov 2477e7199288SPavel Emelianov return dev; 2478e7199288SPavel Emelianov } 2479e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_create_link); 2480e7199288SPavel Emelianov 248190f62cf3SEric W. Biederman static int rtnl_group_changelink(const struct sk_buff *skb, 248290f62cf3SEric W. Biederman struct net *net, int group, 2483e7ed828fSVlad Dogaru struct ifinfomsg *ifm, 2484ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 2485e7ed828fSVlad Dogaru struct nlattr **tb) 2486e7ed828fSVlad Dogaru { 2487d079535dSWANG Cong struct net_device *dev, *aux; 2488e7ed828fSVlad Dogaru int err; 2489e7ed828fSVlad Dogaru 2490d079535dSWANG Cong for_each_netdev_safe(net, dev, aux) { 2491e7ed828fSVlad Dogaru if (dev->group == group) { 2492ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0); 2493e7ed828fSVlad Dogaru if (err < 0) 2494e7ed828fSVlad Dogaru return err; 2495e7ed828fSVlad Dogaru } 2496e7ed828fSVlad Dogaru } 2497e7ed828fSVlad Dogaru 2498e7ed828fSVlad Dogaru return 0; 2499e7ed828fSVlad Dogaru } 2500e7ed828fSVlad Dogaru 2501c21ef3e3SDavid Ahern static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2502c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 250338f7b870SPatrick McHardy { 25043b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 250538f7b870SPatrick McHardy const struct rtnl_link_ops *ops; 2506ba7d49b1SJiri Pirko const struct rtnl_link_ops *m_ops = NULL; 250738f7b870SPatrick McHardy struct net_device *dev; 2508ba7d49b1SJiri Pirko struct net_device *master_dev = NULL; 250938f7b870SPatrick McHardy struct ifinfomsg *ifm; 251038f7b870SPatrick McHardy char kind[MODULE_NAME_LEN]; 251138f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 251238f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 251338f7b870SPatrick McHardy struct nlattr *linkinfo[IFLA_INFO_MAX+1]; 25145517750fSTom Gundersen unsigned char name_assign_type = NET_NAME_USER; 251538f7b870SPatrick McHardy int err; 251638f7b870SPatrick McHardy 251795a5afcaSJohannes Berg #ifdef CONFIG_MODULES 251838f7b870SPatrick McHardy replay: 25198072f085SThomas Graf #endif 2520c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 252138f7b870SPatrick McHardy if (err < 0) 252238f7b870SPatrick McHardy return err; 252338f7b870SPatrick McHardy 252438f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 252538f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 252638f7b870SPatrick McHardy else 252738f7b870SPatrick McHardy ifname[0] = '\0'; 252838f7b870SPatrick McHardy 252938f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 253038f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2531881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 2532e7ed828fSVlad Dogaru else { 2533e7ed828fSVlad Dogaru if (ifname[0]) 2534881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 253538f7b870SPatrick McHardy else 253638f7b870SPatrick McHardy dev = NULL; 2537e7ed828fSVlad Dogaru } 253838f7b870SPatrick McHardy 2539ba7d49b1SJiri Pirko if (dev) { 2540ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get(dev); 2541ba7d49b1SJiri Pirko if (master_dev) 2542ba7d49b1SJiri Pirko m_ops = master_dev->rtnl_link_ops; 2543ba7d49b1SJiri Pirko } 2544ba7d49b1SJiri Pirko 2545e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2546e0d087afSEric Dumazet if (err < 0) 25471840bb13SThomas Graf return err; 25481840bb13SThomas Graf 254938f7b870SPatrick McHardy if (tb[IFLA_LINKINFO]) { 255038f7b870SPatrick McHardy err = nla_parse_nested(linkinfo, IFLA_INFO_MAX, 2551fceb6435SJohannes Berg tb[IFLA_LINKINFO], ifla_info_policy, 2552fceb6435SJohannes Berg NULL); 255338f7b870SPatrick McHardy if (err < 0) 255438f7b870SPatrick McHardy return err; 255538f7b870SPatrick McHardy } else 255638f7b870SPatrick McHardy memset(linkinfo, 0, sizeof(linkinfo)); 255738f7b870SPatrick McHardy 255838f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_KIND]) { 255938f7b870SPatrick McHardy nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); 256038f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 256138f7b870SPatrick McHardy } else { 256238f7b870SPatrick McHardy kind[0] = '\0'; 256338f7b870SPatrick McHardy ops = NULL; 256438f7b870SPatrick McHardy } 256538f7b870SPatrick McHardy 256638f7b870SPatrick McHardy if (1) { 25674e10fd5bSSasha Levin struct nlattr *attr[ops ? ops->maxtype + 1 : 1]; 25684e10fd5bSSasha Levin struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1]; 2569ba7d49b1SJiri Pirko struct nlattr **data = NULL; 2570ba7d49b1SJiri Pirko struct nlattr **slave_data = NULL; 2571317f4810SNicolas Dichtel struct net *dest_net, *link_net = NULL; 257238f7b870SPatrick McHardy 257338f7b870SPatrick McHardy if (ops) { 257438f7b870SPatrick McHardy if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { 257538f7b870SPatrick McHardy err = nla_parse_nested(attr, ops->maxtype, 257638f7b870SPatrick McHardy linkinfo[IFLA_INFO_DATA], 2577fceb6435SJohannes Berg ops->policy, NULL); 257838f7b870SPatrick McHardy if (err < 0) 257938f7b870SPatrick McHardy return err; 258038f7b870SPatrick McHardy data = attr; 258138f7b870SPatrick McHardy } 258238f7b870SPatrick McHardy if (ops->validate) { 2583a8b8a889SMatthias Schiffer err = ops->validate(tb, data, extack); 258438f7b870SPatrick McHardy if (err < 0) 258538f7b870SPatrick McHardy return err; 258638f7b870SPatrick McHardy } 258738f7b870SPatrick McHardy } 258838f7b870SPatrick McHardy 2589ba7d49b1SJiri Pirko if (m_ops) { 2590ba7d49b1SJiri Pirko if (m_ops->slave_maxtype && 2591ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA]) { 2592ba7d49b1SJiri Pirko err = nla_parse_nested(slave_attr, 2593ba7d49b1SJiri Pirko m_ops->slave_maxtype, 2594ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA], 2595fceb6435SJohannes Berg m_ops->slave_policy, 2596fceb6435SJohannes Berg NULL); 2597ba7d49b1SJiri Pirko if (err < 0) 2598ba7d49b1SJiri Pirko return err; 2599ba7d49b1SJiri Pirko slave_data = slave_attr; 2600ba7d49b1SJiri Pirko } 2601ba7d49b1SJiri Pirko if (m_ops->slave_validate) { 2602d116ffc7SMatthias Schiffer err = m_ops->slave_validate(tb, slave_data, 2603d116ffc7SMatthias Schiffer extack); 2604ba7d49b1SJiri Pirko if (err < 0) 2605ba7d49b1SJiri Pirko return err; 2606ba7d49b1SJiri Pirko } 2607ba7d49b1SJiri Pirko } 2608ba7d49b1SJiri Pirko 260938f7b870SPatrick McHardy if (dev) { 261090c325e3SNicolas Dichtel int status = 0; 261138f7b870SPatrick McHardy 261238f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_EXCL) 261338f7b870SPatrick McHardy return -EEXIST; 261438f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_REPLACE) 261538f7b870SPatrick McHardy return -EOPNOTSUPP; 261638f7b870SPatrick McHardy 261738f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_DATA]) { 261838f7b870SPatrick McHardy if (!ops || ops != dev->rtnl_link_ops || 261938f7b870SPatrick McHardy !ops->changelink) 262038f7b870SPatrick McHardy return -EOPNOTSUPP; 262138f7b870SPatrick McHardy 2622ad744b22SMatthias Schiffer err = ops->changelink(dev, tb, data, extack); 262338f7b870SPatrick McHardy if (err < 0) 262438f7b870SPatrick McHardy return err; 2625ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 262638f7b870SPatrick McHardy } 262738f7b870SPatrick McHardy 2628ba7d49b1SJiri Pirko if (linkinfo[IFLA_INFO_SLAVE_DATA]) { 2629ba7d49b1SJiri Pirko if (!m_ops || !m_ops->slave_changelink) 2630ba7d49b1SJiri Pirko return -EOPNOTSUPP; 2631ba7d49b1SJiri Pirko 2632ba7d49b1SJiri Pirko err = m_ops->slave_changelink(master_dev, dev, 263317dd0ec4SMatthias Schiffer tb, slave_data, 263417dd0ec4SMatthias Schiffer extack); 2635ba7d49b1SJiri Pirko if (err < 0) 2636ba7d49b1SJiri Pirko return err; 2637ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2638ba7d49b1SJiri Pirko } 2639ba7d49b1SJiri Pirko 2640ddf9f970SJakub Kicinski return do_setlink(skb, dev, ifm, extack, tb, ifname, 2641ddf9f970SJakub Kicinski status); 264238f7b870SPatrick McHardy } 264338f7b870SPatrick McHardy 2644ffa934f1SPatrick McHardy if (!(nlh->nlmsg_flags & NLM_F_CREATE)) { 2645ffa934f1SPatrick McHardy if (ifm->ifi_index == 0 && tb[IFLA_GROUP]) 264690f62cf3SEric W. Biederman return rtnl_group_changelink(skb, net, 2647ffa934f1SPatrick McHardy nla_get_u32(tb[IFLA_GROUP]), 2648ddf9f970SJakub Kicinski ifm, extack, tb); 264938f7b870SPatrick McHardy return -ENODEV; 2650ffa934f1SPatrick McHardy } 265138f7b870SPatrick McHardy 2652160ca014STheuns Verwoerd if (tb[IFLA_MAP] || tb[IFLA_PROTINFO]) 265338f7b870SPatrick McHardy return -EOPNOTSUPP; 265438f7b870SPatrick McHardy 265538f7b870SPatrick McHardy if (!ops) { 265695a5afcaSJohannes Berg #ifdef CONFIG_MODULES 265738f7b870SPatrick McHardy if (kind[0]) { 265838f7b870SPatrick McHardy __rtnl_unlock(); 265938f7b870SPatrick McHardy request_module("rtnl-link-%s", kind); 266038f7b870SPatrick McHardy rtnl_lock(); 266138f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 266238f7b870SPatrick McHardy if (ops) 266338f7b870SPatrick McHardy goto replay; 266438f7b870SPatrick McHardy } 266538f7b870SPatrick McHardy #endif 266638f7b870SPatrick McHardy return -EOPNOTSUPP; 266738f7b870SPatrick McHardy } 266838f7b870SPatrick McHardy 2669b0ab2fabSJiri Pirko if (!ops->setup) 2670b0ab2fabSJiri Pirko return -EOPNOTSUPP; 2671b0ab2fabSJiri Pirko 26725517750fSTom Gundersen if (!ifname[0]) { 267338f7b870SPatrick McHardy snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); 26745517750fSTom Gundersen name_assign_type = NET_NAME_ENUM; 26755517750fSTom Gundersen } 267638f7b870SPatrick McHardy 267781adee47SEric W. Biederman dest_net = rtnl_link_get_net(net, tb); 267813ad1774SEric W. Biederman if (IS_ERR(dest_net)) 267913ad1774SEric W. Biederman return PTR_ERR(dest_net); 268013ad1774SEric W. Biederman 2681505ce415SEric W. Biederman err = -EPERM; 2682505ce415SEric W. Biederman if (!netlink_ns_capable(skb, dest_net->user_ns, CAP_NET_ADMIN)) 2683505ce415SEric W. Biederman goto out; 2684505ce415SEric W. Biederman 2685317f4810SNicolas Dichtel if (tb[IFLA_LINK_NETNSID]) { 2686317f4810SNicolas Dichtel int id = nla_get_s32(tb[IFLA_LINK_NETNSID]); 2687317f4810SNicolas Dichtel 2688317f4810SNicolas Dichtel link_net = get_net_ns_by_id(dest_net, id); 2689317f4810SNicolas Dichtel if (!link_net) { 2690317f4810SNicolas Dichtel err = -EINVAL; 2691317f4810SNicolas Dichtel goto out; 2692317f4810SNicolas Dichtel } 269306615bedSEric W. Biederman err = -EPERM; 269406615bedSEric W. Biederman if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN)) 269506615bedSEric W. Biederman goto out; 2696317f4810SNicolas Dichtel } 2697317f4810SNicolas Dichtel 2698317f4810SNicolas Dichtel dev = rtnl_create_link(link_net ? : dest_net, ifname, 2699317f4810SNicolas Dichtel name_assign_type, ops, tb); 27009c7dafbfSPavel Emelyanov if (IS_ERR(dev)) { 2701e7199288SPavel Emelianov err = PTR_ERR(dev); 27029c7dafbfSPavel Emelyanov goto out; 27039c7dafbfSPavel Emelyanov } 27049c7dafbfSPavel Emelyanov 27059c7dafbfSPavel Emelyanov dev->ifindex = ifm->ifi_index; 27069c7dafbfSPavel Emelyanov 27070e0eee24SCong Wang if (ops->newlink) { 27087a3f4a18SMatthias Schiffer err = ops->newlink(link_net ? : net, dev, tb, data, 27097a3f4a18SMatthias Schiffer extack); 27100e0eee24SCong Wang /* Drivers should call free_netdev() in ->destructor 2711e51fb152SCong Wang * and unregister it on failure after registration 2712e51fb152SCong Wang * so that device could be finally freed in rtnl_unlock. 27130e0eee24SCong Wang */ 2714e51fb152SCong Wang if (err < 0) { 2715e51fb152SCong Wang /* If device is not registered at all, free it now */ 2716e51fb152SCong Wang if (dev->reg_state == NETREG_UNINITIALIZED) 2717e51fb152SCong Wang free_netdev(dev); 27180e0eee24SCong Wang goto out; 2719e51fb152SCong Wang } 27200e0eee24SCong Wang } else { 27212d85cba2SPatrick McHardy err = register_netdevice(dev); 2722fce9b9beSDan Carpenter if (err < 0) { 272338f7b870SPatrick McHardy free_netdev(dev); 27243729d502SPatrick McHardy goto out; 2725fce9b9beSDan Carpenter } 27260e0eee24SCong Wang } 27273729d502SPatrick McHardy err = rtnl_configure_link(dev, ifm); 272843638900SDavid S. Miller if (err < 0) 272943638900SDavid S. Miller goto out_unregister; 273043638900SDavid S. Miller if (link_net) { 273143638900SDavid S. Miller err = dev_change_net_namespace(dev, dest_net, ifname); 273243638900SDavid S. Miller if (err < 0) 273343638900SDavid S. Miller goto out_unregister; 273443638900SDavid S. Miller } 2735160ca014STheuns Verwoerd if (tb[IFLA_MASTER]) { 2736160ca014STheuns Verwoerd err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER])); 2737160ca014STheuns Verwoerd if (err) 2738160ca014STheuns Verwoerd goto out_unregister; 2739160ca014STheuns Verwoerd } 274043638900SDavid S. Miller out: 274143638900SDavid S. Miller if (link_net) 274243638900SDavid S. Miller put_net(link_net); 274343638900SDavid S. Miller put_net(dest_net); 274443638900SDavid S. Miller return err; 274543638900SDavid S. Miller out_unregister: 27467afb8886SWANG Cong if (ops->newlink) { 27477afb8886SWANG Cong LIST_HEAD(list_kill); 27487afb8886SWANG Cong 27497afb8886SWANG Cong ops->dellink(dev, &list_kill); 27507afb8886SWANG Cong unregister_netdevice_many(&list_kill); 27517afb8886SWANG Cong } else { 27523729d502SPatrick McHardy unregister_netdevice(dev); 27537afb8886SWANG Cong } 2754317f4810SNicolas Dichtel goto out; 2755317f4810SNicolas Dichtel } 275638f7b870SPatrick McHardy } 275738f7b870SPatrick McHardy 2758c21ef3e3SDavid Ahern static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2759c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2760711e2c33SJean Tourrilhes { 27613b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 2762b60c5115SThomas Graf struct ifinfomsg *ifm; 2763a3d12891SEric Dumazet char ifname[IFNAMSIZ]; 2764b60c5115SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 2765b60c5115SThomas Graf struct net_device *dev = NULL; 2766b60c5115SThomas Graf struct sk_buff *nskb; 2767339bf98fSThomas Graf int err; 2768115c9b81SGreg Rose u32 ext_filter_mask = 0; 2769711e2c33SJean Tourrilhes 2770c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 2771b60c5115SThomas Graf if (err < 0) 27729918f230SEric Sesterhenn return err; 2773b60c5115SThomas Graf 2774a3d12891SEric Dumazet if (tb[IFLA_IFNAME]) 2775a3d12891SEric Dumazet nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 2776a3d12891SEric Dumazet 2777115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2778115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2779115c9b81SGreg Rose 2780b60c5115SThomas Graf ifm = nlmsg_data(nlh); 2781a3d12891SEric Dumazet if (ifm->ifi_index > 0) 2782a3d12891SEric Dumazet dev = __dev_get_by_index(net, ifm->ifi_index); 2783a3d12891SEric Dumazet else if (tb[IFLA_IFNAME]) 2784a3d12891SEric Dumazet dev = __dev_get_by_name(net, ifname); 2785a3d12891SEric Dumazet else 2786b60c5115SThomas Graf return -EINVAL; 2787b60c5115SThomas Graf 2788a3d12891SEric Dumazet if (dev == NULL) 2789a3d12891SEric Dumazet return -ENODEV; 2790a3d12891SEric Dumazet 2791115c9b81SGreg Rose nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL); 2792a3d12891SEric Dumazet if (nskb == NULL) 2793a3d12891SEric Dumazet return -ENOBUFS; 2794711e2c33SJean Tourrilhes 279515e47304SEric W. Biederman err = rtnl_fill_ifinfo(nskb, dev, RTM_NEWLINK, NETLINK_CB(skb).portid, 27963d3ea5afSVlad Yasevich nlh->nlmsg_seq, 0, 0, ext_filter_mask, 0); 279726932566SPatrick McHardy if (err < 0) { 279826932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size */ 279926932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 280026932566SPatrick McHardy kfree_skb(nskb); 2801a3d12891SEric Dumazet } else 280215e47304SEric W. Biederman err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 2803b60c5115SThomas Graf 2804711e2c33SJean Tourrilhes return err; 2805711e2c33SJean Tourrilhes } 2806711e2c33SJean Tourrilhes 2807115c9b81SGreg Rose static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh) 2808c7ac8679SGreg Rose { 2809115c9b81SGreg Rose struct net *net = sock_net(skb->sk); 2810115c9b81SGreg Rose struct net_device *dev; 2811115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 2812115c9b81SGreg Rose u32 ext_filter_mask = 0; 2813115c9b81SGreg Rose u16 min_ifinfo_dump_size = 0; 2814e5eca6d4SMichal Schmidt int hdrlen; 2815115c9b81SGreg Rose 2816e5eca6d4SMichal Schmidt /* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */ 2817e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ? 2818e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 2819e5eca6d4SMichal Schmidt 2820fceb6435SJohannes Berg if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) { 2821115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2822115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2823a4b64fbeSEric Dumazet } 2824115c9b81SGreg Rose 2825115c9b81SGreg Rose if (!ext_filter_mask) 2826115c9b81SGreg Rose return NLMSG_GOODSIZE; 2827115c9b81SGreg Rose /* 2828115c9b81SGreg Rose * traverse the list of net devices and compute the minimum 2829115c9b81SGreg Rose * buffer size based upon the filter mask. 2830115c9b81SGreg Rose */ 28316853dd48SFlorian Westphal rcu_read_lock(); 28326853dd48SFlorian Westphal for_each_netdev_rcu(net, dev) { 2833115c9b81SGreg Rose min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size, 2834115c9b81SGreg Rose if_nlmsg_size(dev, 2835115c9b81SGreg Rose ext_filter_mask)); 2836115c9b81SGreg Rose } 28376853dd48SFlorian Westphal rcu_read_unlock(); 2838115c9b81SGreg Rose 283993af2056SZhang Shengju return nlmsg_total_size(min_ifinfo_dump_size); 2840c7ac8679SGreg Rose } 2841c7ac8679SGreg Rose 284242bad1daSAdrian Bunk static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) 28431da177e4SLinus Torvalds { 28441da177e4SLinus Torvalds int idx; 28451da177e4SLinus Torvalds int s_idx = cb->family; 28461da177e4SLinus Torvalds 28471da177e4SLinus Torvalds if (s_idx == 0) 28481da177e4SLinus Torvalds s_idx = 1; 28496853dd48SFlorian Westphal 285025239ceeSPatrick McHardy for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { 28511da177e4SLinus Torvalds int type = cb->nlh->nlmsg_type-RTM_BASE; 28526853dd48SFlorian Westphal struct rtnl_link *handlers; 28536853dd48SFlorian Westphal rtnl_dumpit_func dumpit; 28546853dd48SFlorian Westphal 28551da177e4SLinus Torvalds if (idx < s_idx || idx == PF_PACKET) 28561da177e4SLinus Torvalds continue; 28576853dd48SFlorian Westphal 28586853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[idx]); 28596853dd48SFlorian Westphal if (!handlers) 28601da177e4SLinus Torvalds continue; 28616853dd48SFlorian Westphal 28626853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 28636853dd48SFlorian Westphal if (!dumpit) 28646853dd48SFlorian Westphal continue; 28656853dd48SFlorian Westphal 28660465277fSNicolas Dichtel if (idx > s_idx) { 28671da177e4SLinus Torvalds memset(&cb->args[0], 0, sizeof(cb->args)); 28680465277fSNicolas Dichtel cb->prev_seq = 0; 28690465277fSNicolas Dichtel cb->seq = 0; 28700465277fSNicolas Dichtel } 28716853dd48SFlorian Westphal if (dumpit(skb, cb)) 28721da177e4SLinus Torvalds break; 28731da177e4SLinus Torvalds } 28741da177e4SLinus Torvalds cb->family = idx; 28751da177e4SLinus Torvalds 28761da177e4SLinus Torvalds return skb->len; 28771da177e4SLinus Torvalds } 28781da177e4SLinus Torvalds 2879395eea6cSMahesh Bandewar struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev, 28803d3ea5afSVlad Yasevich unsigned int change, 28813d3ea5afSVlad Yasevich u32 event, gfp_t flags) 28821da177e4SLinus Torvalds { 2883c346dca1SYOSHIFUJI Hideaki struct net *net = dev_net(dev); 28841da177e4SLinus Torvalds struct sk_buff *skb; 28850ec6d3f4SThomas Graf int err = -ENOBUFS; 2886c7ac8679SGreg Rose size_t if_info_size; 28871da177e4SLinus Torvalds 28887f294054SAlexei Starovoitov skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags); 28890ec6d3f4SThomas Graf if (skb == NULL) 28900ec6d3f4SThomas Graf goto errout; 28911da177e4SLinus Torvalds 28923d3ea5afSVlad Yasevich err = rtnl_fill_ifinfo(skb, dev, type, 0, 0, change, 0, 0, event); 289326932566SPatrick McHardy if (err < 0) { 289426932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size() */ 289526932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 289626932566SPatrick McHardy kfree_skb(skb); 289726932566SPatrick McHardy goto errout; 289826932566SPatrick McHardy } 2899395eea6cSMahesh Bandewar return skb; 29000ec6d3f4SThomas Graf errout: 29010ec6d3f4SThomas Graf if (err < 0) 29024b3da706SEric W. Biederman rtnl_set_sk_err(net, RTNLGRP_LINK, err); 2903395eea6cSMahesh Bandewar return NULL; 2904395eea6cSMahesh Bandewar } 2905395eea6cSMahesh Bandewar 2906395eea6cSMahesh Bandewar void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags) 2907395eea6cSMahesh Bandewar { 2908395eea6cSMahesh Bandewar struct net *net = dev_net(dev); 2909395eea6cSMahesh Bandewar 2910395eea6cSMahesh Bandewar rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags); 2911395eea6cSMahesh Bandewar } 2912395eea6cSMahesh Bandewar 29133d3ea5afSVlad Yasevich static void rtmsg_ifinfo_event(int type, struct net_device *dev, 29143d3ea5afSVlad Yasevich unsigned int change, u32 event, 2915395eea6cSMahesh Bandewar gfp_t flags) 2916395eea6cSMahesh Bandewar { 2917395eea6cSMahesh Bandewar struct sk_buff *skb; 2918395eea6cSMahesh Bandewar 2919ed2a80abSNicolas Dichtel if (dev->reg_state != NETREG_REGISTERED) 2920ed2a80abSNicolas Dichtel return; 2921ed2a80abSNicolas Dichtel 29223d3ea5afSVlad Yasevich skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags); 2923395eea6cSMahesh Bandewar if (skb) 2924395eea6cSMahesh Bandewar rtmsg_ifinfo_send(skb, dev, flags); 29251da177e4SLinus Torvalds } 29263d3ea5afSVlad Yasevich 29273d3ea5afSVlad Yasevich void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change, 29283d3ea5afSVlad Yasevich gfp_t flags) 29293d3ea5afSVlad Yasevich { 29308c6c918dSVlad Yasevich rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags); 29313d3ea5afSVlad Yasevich } 2932471cb5a3SJiri Pirko EXPORT_SYMBOL(rtmsg_ifinfo); 29331da177e4SLinus Torvalds 2934d83b0603SJohn Fastabend static int nlmsg_populate_fdb_fill(struct sk_buff *skb, 2935d83b0603SJohn Fastabend struct net_device *dev, 29361e53d5bbSHubert Sokolowski u8 *addr, u16 vid, u32 pid, u32 seq, 29371c104a6bSNicolas Dichtel int type, unsigned int flags, 2938b3379041SHubert Sokolowski int nlflags, u16 ndm_state) 2939d83b0603SJohn Fastabend { 2940d83b0603SJohn Fastabend struct nlmsghdr *nlh; 2941d83b0603SJohn Fastabend struct ndmsg *ndm; 2942d83b0603SJohn Fastabend 29431c104a6bSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags); 2944d83b0603SJohn Fastabend if (!nlh) 2945d83b0603SJohn Fastabend return -EMSGSIZE; 2946d83b0603SJohn Fastabend 2947d83b0603SJohn Fastabend ndm = nlmsg_data(nlh); 2948d83b0603SJohn Fastabend ndm->ndm_family = AF_BRIDGE; 2949d83b0603SJohn Fastabend ndm->ndm_pad1 = 0; 2950d83b0603SJohn Fastabend ndm->ndm_pad2 = 0; 2951d83b0603SJohn Fastabend ndm->ndm_flags = flags; 2952d83b0603SJohn Fastabend ndm->ndm_type = 0; 2953d83b0603SJohn Fastabend ndm->ndm_ifindex = dev->ifindex; 2954b3379041SHubert Sokolowski ndm->ndm_state = ndm_state; 2955d83b0603SJohn Fastabend 2956d83b0603SJohn Fastabend if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr)) 2957d83b0603SJohn Fastabend goto nla_put_failure; 29581e53d5bbSHubert Sokolowski if (vid) 29591e53d5bbSHubert Sokolowski if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid)) 29601e53d5bbSHubert Sokolowski goto nla_put_failure; 2961d83b0603SJohn Fastabend 2962053c095aSJohannes Berg nlmsg_end(skb, nlh); 2963053c095aSJohannes Berg return 0; 2964d83b0603SJohn Fastabend 2965d83b0603SJohn Fastabend nla_put_failure: 2966d83b0603SJohn Fastabend nlmsg_cancel(skb, nlh); 2967d83b0603SJohn Fastabend return -EMSGSIZE; 2968d83b0603SJohn Fastabend } 2969d83b0603SJohn Fastabend 29703ff661c3SJohn Fastabend static inline size_t rtnl_fdb_nlmsg_size(void) 29713ff661c3SJohn Fastabend { 2972f82ef3e1SSabrina Dubroca return NLMSG_ALIGN(sizeof(struct ndmsg)) + 2973f82ef3e1SSabrina Dubroca nla_total_size(ETH_ALEN) + /* NDA_LLADDR */ 2974f82ef3e1SSabrina Dubroca nla_total_size(sizeof(u16)) + /* NDA_VLAN */ 2975f82ef3e1SSabrina Dubroca 0; 29763ff661c3SJohn Fastabend } 29773ff661c3SJohn Fastabend 2978b3379041SHubert Sokolowski static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type, 2979b3379041SHubert Sokolowski u16 ndm_state) 29803ff661c3SJohn Fastabend { 29813ff661c3SJohn Fastabend struct net *net = dev_net(dev); 29823ff661c3SJohn Fastabend struct sk_buff *skb; 29833ff661c3SJohn Fastabend int err = -ENOBUFS; 29843ff661c3SJohn Fastabend 29853ff661c3SJohn Fastabend skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC); 29863ff661c3SJohn Fastabend if (!skb) 29873ff661c3SJohn Fastabend goto errout; 29883ff661c3SJohn Fastabend 29891e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, addr, vid, 2990b3379041SHubert Sokolowski 0, 0, type, NTF_SELF, 0, ndm_state); 29913ff661c3SJohn Fastabend if (err < 0) { 29923ff661c3SJohn Fastabend kfree_skb(skb); 29933ff661c3SJohn Fastabend goto errout; 29943ff661c3SJohn Fastabend } 29953ff661c3SJohn Fastabend 29963ff661c3SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC); 29973ff661c3SJohn Fastabend return; 29983ff661c3SJohn Fastabend errout: 29993ff661c3SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_NEIGH, err); 30003ff661c3SJohn Fastabend } 30013ff661c3SJohn Fastabend 3002090096bfSVlad Yasevich /** 3003090096bfSVlad Yasevich * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry 3004090096bfSVlad Yasevich */ 3005090096bfSVlad Yasevich int ndo_dflt_fdb_add(struct ndmsg *ndm, 3006090096bfSVlad Yasevich struct nlattr *tb[], 3007090096bfSVlad Yasevich struct net_device *dev, 3008f6f6424bSJiri Pirko const unsigned char *addr, u16 vid, 3009090096bfSVlad Yasevich u16 flags) 3010090096bfSVlad Yasevich { 3011090096bfSVlad Yasevich int err = -EINVAL; 3012090096bfSVlad Yasevich 3013090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3014090096bfSVlad Yasevich * implement its own handler for this. 3015090096bfSVlad Yasevich */ 3016090096bfSVlad Yasevich if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) { 3017090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3018090096bfSVlad Yasevich return err; 3019090096bfSVlad Yasevich } 3020090096bfSVlad Yasevich 302165891feaSOr Gerlitz if (vid) { 302265891feaSOr Gerlitz pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name); 302365891feaSOr Gerlitz return err; 302465891feaSOr Gerlitz } 302565891feaSOr Gerlitz 3026090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3027090096bfSVlad Yasevich err = dev_uc_add_excl(dev, addr); 3028090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3029090096bfSVlad Yasevich err = dev_mc_add_excl(dev, addr); 3030090096bfSVlad Yasevich 3031090096bfSVlad Yasevich /* Only return duplicate errors if NLM_F_EXCL is set */ 3032090096bfSVlad Yasevich if (err == -EEXIST && !(flags & NLM_F_EXCL)) 3033090096bfSVlad Yasevich err = 0; 3034090096bfSVlad Yasevich 3035090096bfSVlad Yasevich return err; 3036090096bfSVlad Yasevich } 3037090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_add); 3038090096bfSVlad Yasevich 3039f6f6424bSJiri Pirko static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid) 3040f6f6424bSJiri Pirko { 3041f6f6424bSJiri Pirko u16 vid = 0; 3042f6f6424bSJiri Pirko 3043f6f6424bSJiri Pirko if (vlan_attr) { 3044f6f6424bSJiri Pirko if (nla_len(vlan_attr) != sizeof(u16)) { 3045f6f6424bSJiri Pirko pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan\n"); 3046f6f6424bSJiri Pirko return -EINVAL; 3047f6f6424bSJiri Pirko } 3048f6f6424bSJiri Pirko 3049f6f6424bSJiri Pirko vid = nla_get_u16(vlan_attr); 3050f6f6424bSJiri Pirko 3051f6f6424bSJiri Pirko if (!vid || vid >= VLAN_VID_MASK) { 3052f6f6424bSJiri Pirko pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid vlan id %d\n", 3053f6f6424bSJiri Pirko vid); 3054f6f6424bSJiri Pirko return -EINVAL; 3055f6f6424bSJiri Pirko } 3056f6f6424bSJiri Pirko } 3057f6f6424bSJiri Pirko *p_vid = vid; 3058f6f6424bSJiri Pirko return 0; 3059f6f6424bSJiri Pirko } 3060f6f6424bSJiri Pirko 3061c21ef3e3SDavid Ahern static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh, 3062c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 306377162022SJohn Fastabend { 306477162022SJohn Fastabend struct net *net = sock_net(skb->sk); 306577162022SJohn Fastabend struct ndmsg *ndm; 306677162022SJohn Fastabend struct nlattr *tb[NDA_MAX+1]; 306777162022SJohn Fastabend struct net_device *dev; 306877162022SJohn Fastabend u8 *addr; 3069f6f6424bSJiri Pirko u16 vid; 307077162022SJohn Fastabend int err; 307177162022SJohn Fastabend 3072c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 307377162022SJohn Fastabend if (err < 0) 307477162022SJohn Fastabend return err; 307577162022SJohn Fastabend 307677162022SJohn Fastabend ndm = nlmsg_data(nlh); 307777162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 307877162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid ifindex\n"); 307977162022SJohn Fastabend return -EINVAL; 308077162022SJohn Fastabend } 308177162022SJohn Fastabend 308277162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 308377162022SJohn Fastabend if (dev == NULL) { 308477162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with unknown ifindex\n"); 308577162022SJohn Fastabend return -ENODEV; 308677162022SJohn Fastabend } 308777162022SJohn Fastabend 308877162022SJohn Fastabend if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 308977162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_NEWNEIGH with invalid address\n"); 309077162022SJohn Fastabend return -EINVAL; 309177162022SJohn Fastabend } 309277162022SJohn Fastabend 309377162022SJohn Fastabend addr = nla_data(tb[NDA_LLADDR]); 309477162022SJohn Fastabend 3095f6f6424bSJiri Pirko err = fdb_vid_parse(tb[NDA_VLAN], &vid); 3096f6f6424bSJiri Pirko if (err) 3097f6f6424bSJiri Pirko return err; 3098f6f6424bSJiri Pirko 309977162022SJohn Fastabend err = -EOPNOTSUPP; 310077162022SJohn Fastabend 310177162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 310277162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 310377162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3104898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3105898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 3106898e5061SJiri Pirko 3107f6f6424bSJiri Pirko err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid, 3108f6f6424bSJiri Pirko nlh->nlmsg_flags); 310977162022SJohn Fastabend if (err) 311077162022SJohn Fastabend goto out; 311177162022SJohn Fastabend else 311277162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 311377162022SJohn Fastabend } 311477162022SJohn Fastabend 311577162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3116090096bfSVlad Yasevich if ((ndm->ndm_flags & NTF_SELF)) { 3117090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_add) 3118090096bfSVlad Yasevich err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr, 3119f6f6424bSJiri Pirko vid, 3120090096bfSVlad Yasevich nlh->nlmsg_flags); 3121090096bfSVlad Yasevich else 3122f6f6424bSJiri Pirko err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, 312377162022SJohn Fastabend nlh->nlmsg_flags); 312477162022SJohn Fastabend 31253ff661c3SJohn Fastabend if (!err) { 3126b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH, 3127b3379041SHubert Sokolowski ndm->ndm_state); 312877162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 312977162022SJohn Fastabend } 31303ff661c3SJohn Fastabend } 313177162022SJohn Fastabend out: 313277162022SJohn Fastabend return err; 313377162022SJohn Fastabend } 313477162022SJohn Fastabend 3135090096bfSVlad Yasevich /** 3136090096bfSVlad Yasevich * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry 3137090096bfSVlad Yasevich */ 3138090096bfSVlad Yasevich int ndo_dflt_fdb_del(struct ndmsg *ndm, 3139090096bfSVlad Yasevich struct nlattr *tb[], 3140090096bfSVlad Yasevich struct net_device *dev, 3141f6f6424bSJiri Pirko const unsigned char *addr, u16 vid) 3142090096bfSVlad Yasevich { 3143c8a89c4aSAlexander Duyck int err = -EINVAL; 3144090096bfSVlad Yasevich 3145090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3146090096bfSVlad Yasevich * implement its own handler for this. 3147090096bfSVlad Yasevich */ 314864535993SSridhar Samudrala if (!(ndm->ndm_state & NUD_PERMANENT)) { 3149090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3150c8a89c4aSAlexander Duyck return err; 3151090096bfSVlad Yasevich } 3152090096bfSVlad Yasevich 3153090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3154090096bfSVlad Yasevich err = dev_uc_del(dev, addr); 3155090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3156090096bfSVlad Yasevich err = dev_mc_del(dev, addr); 3157090096bfSVlad Yasevich 3158090096bfSVlad Yasevich return err; 3159090096bfSVlad Yasevich } 3160090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_del); 3161090096bfSVlad Yasevich 3162c21ef3e3SDavid Ahern static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh, 3163c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 316477162022SJohn Fastabend { 316577162022SJohn Fastabend struct net *net = sock_net(skb->sk); 316677162022SJohn Fastabend struct ndmsg *ndm; 31671690be63SVlad Yasevich struct nlattr *tb[NDA_MAX+1]; 316877162022SJohn Fastabend struct net_device *dev; 316977162022SJohn Fastabend int err = -EINVAL; 317077162022SJohn Fastabend __u8 *addr; 3171f6f6424bSJiri Pirko u16 vid; 317277162022SJohn Fastabend 317390f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_NET_ADMIN)) 31741690be63SVlad Yasevich return -EPERM; 31751690be63SVlad Yasevich 3176c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 31771690be63SVlad Yasevich if (err < 0) 31781690be63SVlad Yasevich return err; 317977162022SJohn Fastabend 318077162022SJohn Fastabend ndm = nlmsg_data(nlh); 318177162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 318277162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_DELNEIGH with invalid ifindex\n"); 318377162022SJohn Fastabend return -EINVAL; 318477162022SJohn Fastabend } 318577162022SJohn Fastabend 318677162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 318777162022SJohn Fastabend if (dev == NULL) { 318877162022SJohn Fastabend pr_info("PF_BRIDGE: RTM_DELNEIGH with unknown ifindex\n"); 318977162022SJohn Fastabend return -ENODEV; 319077162022SJohn Fastabend } 319177162022SJohn Fastabend 31921690be63SVlad Yasevich if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 31931690be63SVlad Yasevich pr_info("PF_BRIDGE: RTM_DELNEIGH with invalid address\n"); 319477162022SJohn Fastabend return -EINVAL; 319577162022SJohn Fastabend } 319677162022SJohn Fastabend 31971690be63SVlad Yasevich addr = nla_data(tb[NDA_LLADDR]); 31981690be63SVlad Yasevich 3199f6f6424bSJiri Pirko err = fdb_vid_parse(tb[NDA_VLAN], &vid); 3200f6f6424bSJiri Pirko if (err) 3201f6f6424bSJiri Pirko return err; 3202f6f6424bSJiri Pirko 320377162022SJohn Fastabend err = -EOPNOTSUPP; 320477162022SJohn Fastabend 320577162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 320677162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 320777162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3208898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3209898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 321077162022SJohn Fastabend 3211898e5061SJiri Pirko if (ops->ndo_fdb_del) 3212f6f6424bSJiri Pirko err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid); 321377162022SJohn Fastabend 321477162022SJohn Fastabend if (err) 321577162022SJohn Fastabend goto out; 321677162022SJohn Fastabend else 321777162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 321877162022SJohn Fastabend } 321977162022SJohn Fastabend 322077162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3221090096bfSVlad Yasevich if (ndm->ndm_flags & NTF_SELF) { 3222090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_del) 3223f6f6424bSJiri Pirko err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr, 3224f6f6424bSJiri Pirko vid); 3225090096bfSVlad Yasevich else 3226f6f6424bSJiri Pirko err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid); 322777162022SJohn Fastabend 32283ff661c3SJohn Fastabend if (!err) { 3229b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH, 3230b3379041SHubert Sokolowski ndm->ndm_state); 323177162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 323277162022SJohn Fastabend } 32333ff661c3SJohn Fastabend } 323477162022SJohn Fastabend out: 323577162022SJohn Fastabend return err; 323677162022SJohn Fastabend } 323777162022SJohn Fastabend 3238d83b0603SJohn Fastabend static int nlmsg_populate_fdb(struct sk_buff *skb, 3239d83b0603SJohn Fastabend struct netlink_callback *cb, 3240d83b0603SJohn Fastabend struct net_device *dev, 3241d83b0603SJohn Fastabend int *idx, 3242d83b0603SJohn Fastabend struct netdev_hw_addr_list *list) 3243d83b0603SJohn Fastabend { 3244d83b0603SJohn Fastabend struct netdev_hw_addr *ha; 3245d83b0603SJohn Fastabend int err; 324615e47304SEric W. Biederman u32 portid, seq; 3247d83b0603SJohn Fastabend 324815e47304SEric W. Biederman portid = NETLINK_CB(cb->skb).portid; 3249d83b0603SJohn Fastabend seq = cb->nlh->nlmsg_seq; 3250d83b0603SJohn Fastabend 3251d83b0603SJohn Fastabend list_for_each_entry(ha, &list->list, list) { 3252d297653dSRoopa Prabhu if (*idx < cb->args[2]) 3253d83b0603SJohn Fastabend goto skip; 3254d83b0603SJohn Fastabend 32551e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0, 3256a7a558feSJohn Fastabend portid, seq, 32571c104a6bSNicolas Dichtel RTM_NEWNEIGH, NTF_SELF, 3258b3379041SHubert Sokolowski NLM_F_MULTI, NUD_PERMANENT); 3259d83b0603SJohn Fastabend if (err < 0) 3260d83b0603SJohn Fastabend return err; 3261d83b0603SJohn Fastabend skip: 3262d83b0603SJohn Fastabend *idx += 1; 3263d83b0603SJohn Fastabend } 3264d83b0603SJohn Fastabend return 0; 3265d83b0603SJohn Fastabend } 3266d83b0603SJohn Fastabend 3267d83b0603SJohn Fastabend /** 32682c53040fSBen Hutchings * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table. 3269d83b0603SJohn Fastabend * @nlh: netlink message header 3270d83b0603SJohn Fastabend * @dev: netdevice 3271d83b0603SJohn Fastabend * 3272d83b0603SJohn Fastabend * Default netdevice operation to dump the existing unicast address list. 327391f3e7b1SJohn Fastabend * Returns number of addresses from list put in skb. 3274d83b0603SJohn Fastabend */ 3275d83b0603SJohn Fastabend int ndo_dflt_fdb_dump(struct sk_buff *skb, 3276d83b0603SJohn Fastabend struct netlink_callback *cb, 3277d83b0603SJohn Fastabend struct net_device *dev, 32785d5eacb3SJamal Hadi Salim struct net_device *filter_dev, 3279d297653dSRoopa Prabhu int *idx) 3280d83b0603SJohn Fastabend { 3281d83b0603SJohn Fastabend int err; 3282d83b0603SJohn Fastabend 3283d83b0603SJohn Fastabend netif_addr_lock_bh(dev); 3284d297653dSRoopa Prabhu err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc); 3285d83b0603SJohn Fastabend if (err) 3286d83b0603SJohn Fastabend goto out; 32872934c9dbSZhang Shengju err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc); 3288d83b0603SJohn Fastabend out: 3289d83b0603SJohn Fastabend netif_addr_unlock_bh(dev); 3290d297653dSRoopa Prabhu return err; 3291d83b0603SJohn Fastabend } 3292d83b0603SJohn Fastabend EXPORT_SYMBOL(ndo_dflt_fdb_dump); 3293d83b0603SJohn Fastabend 329477162022SJohn Fastabend static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb) 329577162022SJohn Fastabend { 329677162022SJohn Fastabend struct net_device *dev; 32975e6d2435SJamal Hadi Salim struct nlattr *tb[IFLA_MAX+1]; 32985e6d2435SJamal Hadi Salim struct net_device *br_dev = NULL; 32995e6d2435SJamal Hadi Salim const struct net_device_ops *ops = NULL; 33005e6d2435SJamal Hadi Salim const struct net_device_ops *cops = NULL; 33015e6d2435SJamal Hadi Salim struct ifinfomsg *ifm = nlmsg_data(cb->nlh); 33025e6d2435SJamal Hadi Salim struct net *net = sock_net(skb->sk); 3303d297653dSRoopa Prabhu struct hlist_head *head; 33045e6d2435SJamal Hadi Salim int brport_idx = 0; 33055e6d2435SJamal Hadi Salim int br_idx = 0; 3306d297653dSRoopa Prabhu int h, s_h; 3307d297653dSRoopa Prabhu int idx = 0, s_idx; 3308d297653dSRoopa Prabhu int err = 0; 3309d297653dSRoopa Prabhu int fidx = 0; 331077162022SJohn Fastabend 33110ff50e83SAlexander Potapenko err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb, 33120ff50e83SAlexander Potapenko IFLA_MAX, ifla_policy, NULL); 33130ff50e83SAlexander Potapenko if (err < 0) { 33140ff50e83SAlexander Potapenko return -EINVAL; 33150ff50e83SAlexander Potapenko } else if (err == 0) { 33165e6d2435SJamal Hadi Salim if (tb[IFLA_MASTER]) 33175e6d2435SJamal Hadi Salim br_idx = nla_get_u32(tb[IFLA_MASTER]); 33185e6d2435SJamal Hadi Salim } 331977162022SJohn Fastabend 33205e6d2435SJamal Hadi Salim brport_idx = ifm->ifi_index; 33215e6d2435SJamal Hadi Salim 33225e6d2435SJamal Hadi Salim if (br_idx) { 33235e6d2435SJamal Hadi Salim br_dev = __dev_get_by_index(net, br_idx); 33245e6d2435SJamal Hadi Salim if (!br_dev) 33255e6d2435SJamal Hadi Salim return -ENODEV; 33265e6d2435SJamal Hadi Salim 3327898e5061SJiri Pirko ops = br_dev->netdev_ops; 33285e6d2435SJamal Hadi Salim } 33295e6d2435SJamal Hadi Salim 3330d297653dSRoopa Prabhu s_h = cb->args[0]; 3331d297653dSRoopa Prabhu s_idx = cb->args[1]; 3332d297653dSRoopa Prabhu 3333d297653dSRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 3334d297653dSRoopa Prabhu idx = 0; 3335d297653dSRoopa Prabhu head = &net->dev_index_head[h]; 3336d297653dSRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 3337d297653dSRoopa Prabhu 33385e6d2435SJamal Hadi Salim if (brport_idx && (dev->ifindex != brport_idx)) 33395e6d2435SJamal Hadi Salim continue; 33405e6d2435SJamal Hadi Salim 33415e6d2435SJamal Hadi Salim if (!br_idx) { /* user did not specify a specific bridge */ 33425e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 33435e6d2435SJamal Hadi Salim br_dev = netdev_master_upper_dev_get(dev); 33445e6d2435SJamal Hadi Salim cops = br_dev->netdev_ops; 33455e6d2435SJamal Hadi Salim } 33465e6d2435SJamal Hadi Salim } else { 33475e6d2435SJamal Hadi Salim if (dev != br_dev && 33485e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_BRIDGE_PORT)) 33495e6d2435SJamal Hadi Salim continue; 33505e6d2435SJamal Hadi Salim 33515e6d2435SJamal Hadi Salim if (br_dev != netdev_master_upper_dev_get(dev) && 33525e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_EBRIDGE)) 33535e6d2435SJamal Hadi Salim continue; 33545e6d2435SJamal Hadi Salim cops = ops; 33555e6d2435SJamal Hadi Salim } 33565e6d2435SJamal Hadi Salim 3357d297653dSRoopa Prabhu if (idx < s_idx) 3358d297653dSRoopa Prabhu goto cont; 3359d297653dSRoopa Prabhu 33605e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 3361d297653dSRoopa Prabhu if (cops && cops->ndo_fdb_dump) { 3362d297653dSRoopa Prabhu err = cops->ndo_fdb_dump(skb, cb, 3363d297653dSRoopa Prabhu br_dev, dev, 3364d297653dSRoopa Prabhu &fidx); 3365d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3366d297653dSRoopa Prabhu goto out; 336777162022SJohn Fastabend } 3368d297653dSRoopa Prabhu } 336977162022SJohn Fastabend 33705e6d2435SJamal Hadi Salim if (dev->netdev_ops->ndo_fdb_dump) 3371d297653dSRoopa Prabhu err = dev->netdev_ops->ndo_fdb_dump(skb, cb, 3372d297653dSRoopa Prabhu dev, NULL, 3373d297653dSRoopa Prabhu &fidx); 33746cb69742SHubert Sokolowski else 3375d297653dSRoopa Prabhu err = ndo_dflt_fdb_dump(skb, cb, dev, NULL, 3376d297653dSRoopa Prabhu &fidx); 3377d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3378d297653dSRoopa Prabhu goto out; 33795e6d2435SJamal Hadi Salim 33805e6d2435SJamal Hadi Salim cops = NULL; 3381d297653dSRoopa Prabhu 3382d297653dSRoopa Prabhu /* reset fdb offset to 0 for rest of the interfaces */ 3383d297653dSRoopa Prabhu cb->args[2] = 0; 3384d297653dSRoopa Prabhu fidx = 0; 3385d297653dSRoopa Prabhu cont: 3386d297653dSRoopa Prabhu idx++; 3387d297653dSRoopa Prabhu } 338877162022SJohn Fastabend } 338977162022SJohn Fastabend 3390d297653dSRoopa Prabhu out: 3391d297653dSRoopa Prabhu cb->args[0] = h; 3392d297653dSRoopa Prabhu cb->args[1] = idx; 3393d297653dSRoopa Prabhu cb->args[2] = fidx; 3394d297653dSRoopa Prabhu 339577162022SJohn Fastabend return skb->len; 339677162022SJohn Fastabend } 339777162022SJohn Fastabend 33982c3c031cSScott Feldman static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask, 33992c3c031cSScott Feldman unsigned int attrnum, unsigned int flag) 34002c3c031cSScott Feldman { 34012c3c031cSScott Feldman if (mask & flag) 34022c3c031cSScott Feldman return nla_put_u8(skb, attrnum, !!(flags & flag)); 34032c3c031cSScott Feldman return 0; 34042c3c031cSScott Feldman } 34052c3c031cSScott Feldman 3406815cccbfSJohn Fastabend int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq, 34072c3c031cSScott Feldman struct net_device *dev, u16 mode, 34087d4f8d87SScott Feldman u32 flags, u32 mask, int nlflags, 34097d4f8d87SScott Feldman u32 filter_mask, 34107d4f8d87SScott Feldman int (*vlan_fill)(struct sk_buff *skb, 34117d4f8d87SScott Feldman struct net_device *dev, 34127d4f8d87SScott Feldman u32 filter_mask)) 3413815cccbfSJohn Fastabend { 3414815cccbfSJohn Fastabend struct nlmsghdr *nlh; 3415815cccbfSJohn Fastabend struct ifinfomsg *ifm; 3416815cccbfSJohn Fastabend struct nlattr *br_afspec; 34172c3c031cSScott Feldman struct nlattr *protinfo; 3418815cccbfSJohn Fastabend u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN; 3419898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 34207d4f8d87SScott Feldman int err = 0; 3421815cccbfSJohn Fastabend 342246c264daSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags); 3423815cccbfSJohn Fastabend if (nlh == NULL) 3424815cccbfSJohn Fastabend return -EMSGSIZE; 3425815cccbfSJohn Fastabend 3426815cccbfSJohn Fastabend ifm = nlmsg_data(nlh); 3427815cccbfSJohn Fastabend ifm->ifi_family = AF_BRIDGE; 3428815cccbfSJohn Fastabend ifm->__ifi_pad = 0; 3429815cccbfSJohn Fastabend ifm->ifi_type = dev->type; 3430815cccbfSJohn Fastabend ifm->ifi_index = dev->ifindex; 3431815cccbfSJohn Fastabend ifm->ifi_flags = dev_get_flags(dev); 3432815cccbfSJohn Fastabend ifm->ifi_change = 0; 3433815cccbfSJohn Fastabend 3434815cccbfSJohn Fastabend 3435815cccbfSJohn Fastabend if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 3436815cccbfSJohn Fastabend nla_put_u32(skb, IFLA_MTU, dev->mtu) || 3437815cccbfSJohn Fastabend nla_put_u8(skb, IFLA_OPERSTATE, operstate) || 3438898e5061SJiri Pirko (br_dev && 3439898e5061SJiri Pirko nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) || 3440815cccbfSJohn Fastabend (dev->addr_len && 3441815cccbfSJohn Fastabend nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) || 3442a54acb3aSNicolas Dichtel (dev->ifindex != dev_get_iflink(dev) && 3443a54acb3aSNicolas Dichtel nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev)))) 3444815cccbfSJohn Fastabend goto nla_put_failure; 3445815cccbfSJohn Fastabend 3446815cccbfSJohn Fastabend br_afspec = nla_nest_start(skb, IFLA_AF_SPEC); 3447815cccbfSJohn Fastabend if (!br_afspec) 3448815cccbfSJohn Fastabend goto nla_put_failure; 3449815cccbfSJohn Fastabend 34501d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) { 3451815cccbfSJohn Fastabend nla_nest_cancel(skb, br_afspec); 3452815cccbfSJohn Fastabend goto nla_put_failure; 3453815cccbfSJohn Fastabend } 34541d460b98SRoopa Prabhu 34551d460b98SRoopa Prabhu if (mode != BRIDGE_MODE_UNDEF) { 34561d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) { 34571d460b98SRoopa Prabhu nla_nest_cancel(skb, br_afspec); 34581d460b98SRoopa Prabhu goto nla_put_failure; 34591d460b98SRoopa Prabhu } 34601d460b98SRoopa Prabhu } 34617d4f8d87SScott Feldman if (vlan_fill) { 34627d4f8d87SScott Feldman err = vlan_fill(skb, dev, filter_mask); 34637d4f8d87SScott Feldman if (err) { 34647d4f8d87SScott Feldman nla_nest_cancel(skb, br_afspec); 34657d4f8d87SScott Feldman goto nla_put_failure; 34667d4f8d87SScott Feldman } 34677d4f8d87SScott Feldman } 3468815cccbfSJohn Fastabend nla_nest_end(skb, br_afspec); 3469815cccbfSJohn Fastabend 34702c3c031cSScott Feldman protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED); 34712c3c031cSScott Feldman if (!protinfo) 34722c3c031cSScott Feldman goto nla_put_failure; 34732c3c031cSScott Feldman 34742c3c031cSScott Feldman if (brport_nla_put_flag(skb, flags, mask, 34752c3c031cSScott Feldman IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) || 34762c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34772c3c031cSScott Feldman IFLA_BRPORT_GUARD, BR_BPDU_GUARD) || 34782c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34792c3c031cSScott Feldman IFLA_BRPORT_FAST_LEAVE, 34802c3c031cSScott Feldman BR_MULTICAST_FAST_LEAVE) || 34812c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34822c3c031cSScott Feldman IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) || 34832c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34842c3c031cSScott Feldman IFLA_BRPORT_LEARNING, BR_LEARNING) || 34852c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34862c3c031cSScott Feldman IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) || 34872c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34882c3c031cSScott Feldman IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) || 34892c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 34902c3c031cSScott Feldman IFLA_BRPORT_PROXYARP, BR_PROXYARP)) { 34912c3c031cSScott Feldman nla_nest_cancel(skb, protinfo); 34922c3c031cSScott Feldman goto nla_put_failure; 34932c3c031cSScott Feldman } 34942c3c031cSScott Feldman 34952c3c031cSScott Feldman nla_nest_end(skb, protinfo); 34962c3c031cSScott Feldman 3497053c095aSJohannes Berg nlmsg_end(skb, nlh); 3498053c095aSJohannes Berg return 0; 3499815cccbfSJohn Fastabend nla_put_failure: 3500815cccbfSJohn Fastabend nlmsg_cancel(skb, nlh); 35017d4f8d87SScott Feldman return err ? err : -EMSGSIZE; 3502815cccbfSJohn Fastabend } 35037d4f8d87SScott Feldman EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink); 3504815cccbfSJohn Fastabend 3505e5a55a89SJohn Fastabend static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb) 3506e5a55a89SJohn Fastabend { 3507e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3508e5a55a89SJohn Fastabend struct net_device *dev; 3509e5a55a89SJohn Fastabend int idx = 0; 3510e5a55a89SJohn Fastabend u32 portid = NETLINK_CB(cb->skb).portid; 3511e5a55a89SJohn Fastabend u32 seq = cb->nlh->nlmsg_seq; 35126cbdceebSVlad Yasevich u32 filter_mask = 0; 3513d64f69b0SRoopa Prabhu int err; 35146cbdceebSVlad Yasevich 3515aa68c20fSThomas Graf if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) { 3516aa68c20fSThomas Graf struct nlattr *extfilt; 3517aa68c20fSThomas Graf 35183e805ad2SAsbjoern Sloth Toennesen extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg), 35196cbdceebSVlad Yasevich IFLA_EXT_MASK); 3520aa68c20fSThomas Graf if (extfilt) { 3521aa68c20fSThomas Graf if (nla_len(extfilt) < sizeof(filter_mask)) 3522aa68c20fSThomas Graf return -EINVAL; 3523aa68c20fSThomas Graf 35246cbdceebSVlad Yasevich filter_mask = nla_get_u32(extfilt); 3525aa68c20fSThomas Graf } 3526aa68c20fSThomas Graf } 3527e5a55a89SJohn Fastabend 3528e5a55a89SJohn Fastabend rcu_read_lock(); 3529e5a55a89SJohn Fastabend for_each_netdev_rcu(net, dev) { 3530e5a55a89SJohn Fastabend const struct net_device_ops *ops = dev->netdev_ops; 3531898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3532e5a55a89SJohn Fastabend 3533898e5061SJiri Pirko if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) { 3534d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3535d64f69b0SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_getlink( 3536d64f69b0SRoopa Prabhu skb, portid, seq, dev, 3537d64f69b0SRoopa Prabhu filter_mask, NLM_F_MULTI); 3538f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3539f6c5775fSDavid Ahern if (likely(skb->len)) 3540e5a55a89SJohn Fastabend break; 3541f6c5775fSDavid Ahern 3542f6c5775fSDavid Ahern goto out_err; 3543f6c5775fSDavid Ahern } 3544d64f69b0SRoopa Prabhu } 3545e5a55a89SJohn Fastabend idx++; 3546e5a55a89SJohn Fastabend } 3547e5a55a89SJohn Fastabend 3548e5a55a89SJohn Fastabend if (ops->ndo_bridge_getlink) { 3549d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3550d64f69b0SRoopa Prabhu err = ops->ndo_bridge_getlink(skb, portid, 3551d64f69b0SRoopa Prabhu seq, dev, 355246c264daSNicolas Dichtel filter_mask, 3553d64f69b0SRoopa Prabhu NLM_F_MULTI); 3554f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3555f6c5775fSDavid Ahern if (likely(skb->len)) 3556e5a55a89SJohn Fastabend break; 3557f6c5775fSDavid Ahern 3558f6c5775fSDavid Ahern goto out_err; 3559f6c5775fSDavid Ahern } 3560d64f69b0SRoopa Prabhu } 3561e5a55a89SJohn Fastabend idx++; 3562e5a55a89SJohn Fastabend } 3563e5a55a89SJohn Fastabend } 3564f6c5775fSDavid Ahern err = skb->len; 3565f6c5775fSDavid Ahern out_err: 3566e5a55a89SJohn Fastabend rcu_read_unlock(); 3567e5a55a89SJohn Fastabend cb->args[0] = idx; 3568e5a55a89SJohn Fastabend 3569f6c5775fSDavid Ahern return err; 3570e5a55a89SJohn Fastabend } 3571e5a55a89SJohn Fastabend 35722469ffd7SJohn Fastabend static inline size_t bridge_nlmsg_size(void) 35732469ffd7SJohn Fastabend { 35742469ffd7SJohn Fastabend return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 35752469ffd7SJohn Fastabend + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 35762469ffd7SJohn Fastabend + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 35772469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MASTER */ 35782469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MTU */ 35792469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_LINK */ 35802469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_OPERSTATE */ 35812469ffd7SJohn Fastabend + nla_total_size(sizeof(u8)) /* IFLA_PROTINFO */ 35822469ffd7SJohn Fastabend + nla_total_size(sizeof(struct nlattr)) /* IFLA_AF_SPEC */ 35832469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)) /* IFLA_BRIDGE_FLAGS */ 35842469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_MODE */ 35852469ffd7SJohn Fastabend } 35862469ffd7SJohn Fastabend 358702dba438SRoopa Prabhu static int rtnl_bridge_notify(struct net_device *dev) 35882469ffd7SJohn Fastabend { 35892469ffd7SJohn Fastabend struct net *net = dev_net(dev); 35902469ffd7SJohn Fastabend struct sk_buff *skb; 35912469ffd7SJohn Fastabend int err = -EOPNOTSUPP; 35922469ffd7SJohn Fastabend 359302dba438SRoopa Prabhu if (!dev->netdev_ops->ndo_bridge_getlink) 359402dba438SRoopa Prabhu return 0; 359502dba438SRoopa Prabhu 35962469ffd7SJohn Fastabend skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC); 35972469ffd7SJohn Fastabend if (!skb) { 35982469ffd7SJohn Fastabend err = -ENOMEM; 35992469ffd7SJohn Fastabend goto errout; 36002469ffd7SJohn Fastabend } 36012469ffd7SJohn Fastabend 360246c264daSNicolas Dichtel err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0); 3603c38e01b8SJohn Fastabend if (err < 0) 3604c38e01b8SJohn Fastabend goto errout; 36052469ffd7SJohn Fastabend 360659ccaaaaSRoopa Prabhu if (!skb->len) 360759ccaaaaSRoopa Prabhu goto errout; 360859ccaaaaSRoopa Prabhu 36092469ffd7SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC); 36102469ffd7SJohn Fastabend return 0; 36112469ffd7SJohn Fastabend errout: 36122469ffd7SJohn Fastabend WARN_ON(err == -EMSGSIZE); 36132469ffd7SJohn Fastabend kfree_skb(skb); 361459ccaaaaSRoopa Prabhu if (err) 36152469ffd7SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_LINK, err); 36162469ffd7SJohn Fastabend return err; 36172469ffd7SJohn Fastabend } 36182469ffd7SJohn Fastabend 3619c21ef3e3SDavid Ahern static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3620c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3621e5a55a89SJohn Fastabend { 3622e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3623e5a55a89SJohn Fastabend struct ifinfomsg *ifm; 3624e5a55a89SJohn Fastabend struct net_device *dev; 36252469ffd7SJohn Fastabend struct nlattr *br_spec, *attr = NULL; 36262469ffd7SJohn Fastabend int rem, err = -EOPNOTSUPP; 36274de8b413SRosen, Rami u16 flags = 0; 3628c38e01b8SJohn Fastabend bool have_flags = false; 3629e5a55a89SJohn Fastabend 3630e5a55a89SJohn Fastabend if (nlmsg_len(nlh) < sizeof(*ifm)) 3631e5a55a89SJohn Fastabend return -EINVAL; 3632e5a55a89SJohn Fastabend 3633e5a55a89SJohn Fastabend ifm = nlmsg_data(nlh); 3634e5a55a89SJohn Fastabend if (ifm->ifi_family != AF_BRIDGE) 3635e5a55a89SJohn Fastabend return -EPFNOSUPPORT; 3636e5a55a89SJohn Fastabend 3637e5a55a89SJohn Fastabend dev = __dev_get_by_index(net, ifm->ifi_index); 3638e5a55a89SJohn Fastabend if (!dev) { 3639e5a55a89SJohn Fastabend pr_info("PF_BRIDGE: RTM_SETLINK with unknown ifindex\n"); 3640e5a55a89SJohn Fastabend return -ENODEV; 3641e5a55a89SJohn Fastabend } 3642e5a55a89SJohn Fastabend 36432469ffd7SJohn Fastabend br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 36442469ffd7SJohn Fastabend if (br_spec) { 36452469ffd7SJohn Fastabend nla_for_each_nested(attr, br_spec, rem) { 36462469ffd7SJohn Fastabend if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 36476e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 36486e8d1c55SThomas Graf return -EINVAL; 36496e8d1c55SThomas Graf 3650c38e01b8SJohn Fastabend have_flags = true; 36512469ffd7SJohn Fastabend flags = nla_get_u16(attr); 36522469ffd7SJohn Fastabend break; 36532469ffd7SJohn Fastabend } 36542469ffd7SJohn Fastabend } 36552469ffd7SJohn Fastabend } 36562469ffd7SJohn Fastabend 36572469ffd7SJohn Fastabend if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3658898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3659898e5061SJiri Pirko 3660898e5061SJiri Pirko if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) { 36612469ffd7SJohn Fastabend err = -EOPNOTSUPP; 3662e5a55a89SJohn Fastabend goto out; 3663e5a55a89SJohn Fastabend } 3664e5a55a89SJohn Fastabend 3665add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags); 36662469ffd7SJohn Fastabend if (err) 36672469ffd7SJohn Fastabend goto out; 36682469ffd7SJohn Fastabend 36692469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_MASTER; 36702469ffd7SJohn Fastabend } 36712469ffd7SJohn Fastabend 36722469ffd7SJohn Fastabend if ((flags & BRIDGE_FLAGS_SELF)) { 36732469ffd7SJohn Fastabend if (!dev->netdev_ops->ndo_bridge_setlink) 36742469ffd7SJohn Fastabend err = -EOPNOTSUPP; 36752469ffd7SJohn Fastabend else 3676add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh, 3677add511b3SRoopa Prabhu flags); 367802dba438SRoopa Prabhu if (!err) { 36792469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_SELF; 368002dba438SRoopa Prabhu 368102dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 368202dba438SRoopa Prabhu * change 368302dba438SRoopa Prabhu */ 368402dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 368502dba438SRoopa Prabhu } 36862469ffd7SJohn Fastabend } 36872469ffd7SJohn Fastabend 3688c38e01b8SJohn Fastabend if (have_flags) 36892469ffd7SJohn Fastabend memcpy(nla_data(attr), &flags, sizeof(flags)); 3690e5a55a89SJohn Fastabend out: 3691e5a55a89SJohn Fastabend return err; 3692e5a55a89SJohn Fastabend } 3693e5a55a89SJohn Fastabend 3694c21ef3e3SDavid Ahern static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 3695c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3696407af329SVlad Yasevich { 3697407af329SVlad Yasevich struct net *net = sock_net(skb->sk); 3698407af329SVlad Yasevich struct ifinfomsg *ifm; 3699407af329SVlad Yasevich struct net_device *dev; 3700407af329SVlad Yasevich struct nlattr *br_spec, *attr = NULL; 3701407af329SVlad Yasevich int rem, err = -EOPNOTSUPP; 37024de8b413SRosen, Rami u16 flags = 0; 3703407af329SVlad Yasevich bool have_flags = false; 3704407af329SVlad Yasevich 3705407af329SVlad Yasevich if (nlmsg_len(nlh) < sizeof(*ifm)) 3706407af329SVlad Yasevich return -EINVAL; 3707407af329SVlad Yasevich 3708407af329SVlad Yasevich ifm = nlmsg_data(nlh); 3709407af329SVlad Yasevich if (ifm->ifi_family != AF_BRIDGE) 3710407af329SVlad Yasevich return -EPFNOSUPPORT; 3711407af329SVlad Yasevich 3712407af329SVlad Yasevich dev = __dev_get_by_index(net, ifm->ifi_index); 3713407af329SVlad Yasevich if (!dev) { 3714407af329SVlad Yasevich pr_info("PF_BRIDGE: RTM_SETLINK with unknown ifindex\n"); 3715407af329SVlad Yasevich return -ENODEV; 3716407af329SVlad Yasevich } 3717407af329SVlad Yasevich 3718407af329SVlad Yasevich br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 3719407af329SVlad Yasevich if (br_spec) { 3720407af329SVlad Yasevich nla_for_each_nested(attr, br_spec, rem) { 3721407af329SVlad Yasevich if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 37226e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 37236e8d1c55SThomas Graf return -EINVAL; 37246e8d1c55SThomas Graf 3725407af329SVlad Yasevich have_flags = true; 3726407af329SVlad Yasevich flags = nla_get_u16(attr); 3727407af329SVlad Yasevich break; 3728407af329SVlad Yasevich } 3729407af329SVlad Yasevich } 3730407af329SVlad Yasevich } 3731407af329SVlad Yasevich 3732407af329SVlad Yasevich if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3733407af329SVlad Yasevich struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3734407af329SVlad Yasevich 3735407af329SVlad Yasevich if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) { 3736407af329SVlad Yasevich err = -EOPNOTSUPP; 3737407af329SVlad Yasevich goto out; 3738407af329SVlad Yasevich } 3739407af329SVlad Yasevich 3740add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags); 3741407af329SVlad Yasevich if (err) 3742407af329SVlad Yasevich goto out; 3743407af329SVlad Yasevich 3744407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_MASTER; 3745407af329SVlad Yasevich } 3746407af329SVlad Yasevich 3747407af329SVlad Yasevich if ((flags & BRIDGE_FLAGS_SELF)) { 3748407af329SVlad Yasevich if (!dev->netdev_ops->ndo_bridge_dellink) 3749407af329SVlad Yasevich err = -EOPNOTSUPP; 3750407af329SVlad Yasevich else 3751add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh, 3752add511b3SRoopa Prabhu flags); 3753407af329SVlad Yasevich 375402dba438SRoopa Prabhu if (!err) { 3755407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_SELF; 375602dba438SRoopa Prabhu 375702dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 375802dba438SRoopa Prabhu * change 375902dba438SRoopa Prabhu */ 376002dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 376102dba438SRoopa Prabhu } 3762407af329SVlad Yasevich } 3763407af329SVlad Yasevich 3764407af329SVlad Yasevich if (have_flags) 3765407af329SVlad Yasevich memcpy(nla_data(attr), &flags, sizeof(flags)); 3766407af329SVlad Yasevich out: 3767407af329SVlad Yasevich return err; 3768407af329SVlad Yasevich } 3769407af329SVlad Yasevich 3770e8872a25SNikolay Aleksandrov static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr) 3771e8872a25SNikolay Aleksandrov { 3772e8872a25SNikolay Aleksandrov return (mask & IFLA_STATS_FILTER_BIT(attrid)) && 3773e8872a25SNikolay Aleksandrov (!idxattr || idxattr == attrid); 3774e8872a25SNikolay Aleksandrov } 3775e8872a25SNikolay Aleksandrov 377669ae6ad2SNogah Frankel #define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1) 377769ae6ad2SNogah Frankel static int rtnl_get_offload_stats_attr_size(int attr_id) 377869ae6ad2SNogah Frankel { 377969ae6ad2SNogah Frankel switch (attr_id) { 378069ae6ad2SNogah Frankel case IFLA_OFFLOAD_XSTATS_CPU_HIT: 378169ae6ad2SNogah Frankel return sizeof(struct rtnl_link_stats64); 378269ae6ad2SNogah Frankel } 378369ae6ad2SNogah Frankel 378469ae6ad2SNogah Frankel return 0; 378569ae6ad2SNogah Frankel } 378669ae6ad2SNogah Frankel 378769ae6ad2SNogah Frankel static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev, 378869ae6ad2SNogah Frankel int *prividx) 378969ae6ad2SNogah Frankel { 379069ae6ad2SNogah Frankel struct nlattr *attr = NULL; 379169ae6ad2SNogah Frankel int attr_id, size; 379269ae6ad2SNogah Frankel void *attr_data; 379369ae6ad2SNogah Frankel int err; 379469ae6ad2SNogah Frankel 379569ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 379669ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 379769ae6ad2SNogah Frankel return -ENODATA; 379869ae6ad2SNogah Frankel 379969ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 380069ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 380169ae6ad2SNogah Frankel if (attr_id < *prividx) 380269ae6ad2SNogah Frankel continue; 380369ae6ad2SNogah Frankel 380469ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 380569ae6ad2SNogah Frankel if (!size) 380669ae6ad2SNogah Frankel continue; 380769ae6ad2SNogah Frankel 38083df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 380969ae6ad2SNogah Frankel continue; 381069ae6ad2SNogah Frankel 381169ae6ad2SNogah Frankel attr = nla_reserve_64bit(skb, attr_id, size, 381269ae6ad2SNogah Frankel IFLA_OFFLOAD_XSTATS_UNSPEC); 381369ae6ad2SNogah Frankel if (!attr) 381469ae6ad2SNogah Frankel goto nla_put_failure; 381569ae6ad2SNogah Frankel 381669ae6ad2SNogah Frankel attr_data = nla_data(attr); 381769ae6ad2SNogah Frankel memset(attr_data, 0, size); 381869ae6ad2SNogah Frankel err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev, 381969ae6ad2SNogah Frankel attr_data); 382069ae6ad2SNogah Frankel if (err) 382169ae6ad2SNogah Frankel goto get_offload_stats_failure; 382269ae6ad2SNogah Frankel } 382369ae6ad2SNogah Frankel 382469ae6ad2SNogah Frankel if (!attr) 382569ae6ad2SNogah Frankel return -ENODATA; 382669ae6ad2SNogah Frankel 382769ae6ad2SNogah Frankel *prividx = 0; 382869ae6ad2SNogah Frankel return 0; 382969ae6ad2SNogah Frankel 383069ae6ad2SNogah Frankel nla_put_failure: 383169ae6ad2SNogah Frankel err = -EMSGSIZE; 383269ae6ad2SNogah Frankel get_offload_stats_failure: 383369ae6ad2SNogah Frankel *prividx = attr_id; 383469ae6ad2SNogah Frankel return err; 383569ae6ad2SNogah Frankel } 383669ae6ad2SNogah Frankel 383769ae6ad2SNogah Frankel static int rtnl_get_offload_stats_size(const struct net_device *dev) 383869ae6ad2SNogah Frankel { 383969ae6ad2SNogah Frankel int nla_size = 0; 384069ae6ad2SNogah Frankel int attr_id; 384169ae6ad2SNogah Frankel int size; 384269ae6ad2SNogah Frankel 384369ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 384469ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 384569ae6ad2SNogah Frankel return 0; 384669ae6ad2SNogah Frankel 384769ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 384869ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 38493df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 385069ae6ad2SNogah Frankel continue; 385169ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 385269ae6ad2SNogah Frankel nla_size += nla_total_size_64bit(size); 385369ae6ad2SNogah Frankel } 385469ae6ad2SNogah Frankel 385569ae6ad2SNogah Frankel if (nla_size != 0) 385669ae6ad2SNogah Frankel nla_size += nla_total_size(0); 385769ae6ad2SNogah Frankel 385869ae6ad2SNogah Frankel return nla_size; 385969ae6ad2SNogah Frankel } 386069ae6ad2SNogah Frankel 386110c9ead9SRoopa Prabhu static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev, 386210c9ead9SRoopa Prabhu int type, u32 pid, u32 seq, u32 change, 3863e8872a25SNikolay Aleksandrov unsigned int flags, unsigned int filter_mask, 3864e8872a25SNikolay Aleksandrov int *idxattr, int *prividx) 386510c9ead9SRoopa Prabhu { 386610c9ead9SRoopa Prabhu struct if_stats_msg *ifsm; 386710c9ead9SRoopa Prabhu struct nlmsghdr *nlh; 386810c9ead9SRoopa Prabhu struct nlattr *attr; 3869e8872a25SNikolay Aleksandrov int s_prividx = *prividx; 387069ae6ad2SNogah Frankel int err; 387110c9ead9SRoopa Prabhu 387210c9ead9SRoopa Prabhu ASSERT_RTNL(); 387310c9ead9SRoopa Prabhu 387410c9ead9SRoopa Prabhu nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags); 387510c9ead9SRoopa Prabhu if (!nlh) 387610c9ead9SRoopa Prabhu return -EMSGSIZE; 387710c9ead9SRoopa Prabhu 387810c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 387910c9ead9SRoopa Prabhu ifsm->ifindex = dev->ifindex; 388010c9ead9SRoopa Prabhu ifsm->filter_mask = filter_mask; 388110c9ead9SRoopa Prabhu 3882e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) { 388310c9ead9SRoopa Prabhu struct rtnl_link_stats64 *sp; 388410c9ead9SRoopa Prabhu 388558414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64, 388658414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), 388758414d32SNicolas Dichtel IFLA_STATS_UNSPEC); 388810c9ead9SRoopa Prabhu if (!attr) 388910c9ead9SRoopa Prabhu goto nla_put_failure; 389010c9ead9SRoopa Prabhu 389110c9ead9SRoopa Prabhu sp = nla_data(attr); 389210c9ead9SRoopa Prabhu dev_get_stats(dev, sp); 389310c9ead9SRoopa Prabhu } 389410c9ead9SRoopa Prabhu 389597a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) { 389697a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 389797a47facSNikolay Aleksandrov 389897a47facSNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 389997a47facSNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS; 390097a47facSNikolay Aleksandrov attr = nla_nest_start(skb, 390197a47facSNikolay Aleksandrov IFLA_STATS_LINK_XSTATS); 390297a47facSNikolay Aleksandrov if (!attr) 390397a47facSNikolay Aleksandrov goto nla_put_failure; 390497a47facSNikolay Aleksandrov 390580e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 390680e73cc5SNikolay Aleksandrov nla_nest_end(skb, attr); 390780e73cc5SNikolay Aleksandrov if (err) 390880e73cc5SNikolay Aleksandrov goto nla_put_failure; 390980e73cc5SNikolay Aleksandrov *idxattr = 0; 391080e73cc5SNikolay Aleksandrov } 391180e73cc5SNikolay Aleksandrov } 391280e73cc5SNikolay Aleksandrov 391380e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 391480e73cc5SNikolay Aleksandrov *idxattr)) { 391580e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 391680e73cc5SNikolay Aleksandrov const struct net_device *master; 391780e73cc5SNikolay Aleksandrov 391880e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(dev); 391980e73cc5SNikolay Aleksandrov if (master) 392080e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 392180e73cc5SNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 392280e73cc5SNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS_SLAVE; 392380e73cc5SNikolay Aleksandrov attr = nla_nest_start(skb, 392480e73cc5SNikolay Aleksandrov IFLA_STATS_LINK_XSTATS_SLAVE); 392580e73cc5SNikolay Aleksandrov if (!attr) 392680e73cc5SNikolay Aleksandrov goto nla_put_failure; 392780e73cc5SNikolay Aleksandrov 392880e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 392997a47facSNikolay Aleksandrov nla_nest_end(skb, attr); 393097a47facSNikolay Aleksandrov if (err) 393197a47facSNikolay Aleksandrov goto nla_put_failure; 393297a47facSNikolay Aleksandrov *idxattr = 0; 393397a47facSNikolay Aleksandrov } 393497a47facSNikolay Aleksandrov } 393597a47facSNikolay Aleksandrov 393669ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 393769ae6ad2SNogah Frankel *idxattr)) { 393869ae6ad2SNogah Frankel *idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS; 393969ae6ad2SNogah Frankel attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS); 394069ae6ad2SNogah Frankel if (!attr) 394169ae6ad2SNogah Frankel goto nla_put_failure; 394269ae6ad2SNogah Frankel 394369ae6ad2SNogah Frankel err = rtnl_get_offload_stats(skb, dev, prividx); 394469ae6ad2SNogah Frankel if (err == -ENODATA) 394569ae6ad2SNogah Frankel nla_nest_cancel(skb, attr); 394669ae6ad2SNogah Frankel else 394769ae6ad2SNogah Frankel nla_nest_end(skb, attr); 394869ae6ad2SNogah Frankel 394969ae6ad2SNogah Frankel if (err && err != -ENODATA) 395069ae6ad2SNogah Frankel goto nla_put_failure; 395169ae6ad2SNogah Frankel *idxattr = 0; 395269ae6ad2SNogah Frankel } 395369ae6ad2SNogah Frankel 3954aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) { 3955aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 3956aefb4d4aSRobert Shearman 3957aefb4d4aSRobert Shearman *idxattr = IFLA_STATS_AF_SPEC; 3958aefb4d4aSRobert Shearman attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC); 3959aefb4d4aSRobert Shearman if (!attr) 3960aefb4d4aSRobert Shearman goto nla_put_failure; 3961aefb4d4aSRobert Shearman 3962aefb4d4aSRobert Shearman list_for_each_entry(af_ops, &rtnl_af_ops, list) { 3963aefb4d4aSRobert Shearman if (af_ops->fill_stats_af) { 3964aefb4d4aSRobert Shearman struct nlattr *af; 3965aefb4d4aSRobert Shearman int err; 3966aefb4d4aSRobert Shearman 3967aefb4d4aSRobert Shearman af = nla_nest_start(skb, af_ops->family); 3968aefb4d4aSRobert Shearman if (!af) 3969aefb4d4aSRobert Shearman goto nla_put_failure; 3970aefb4d4aSRobert Shearman 3971aefb4d4aSRobert Shearman err = af_ops->fill_stats_af(skb, dev); 3972aefb4d4aSRobert Shearman 3973aefb4d4aSRobert Shearman if (err == -ENODATA) 3974aefb4d4aSRobert Shearman nla_nest_cancel(skb, af); 3975aefb4d4aSRobert Shearman else if (err < 0) 3976aefb4d4aSRobert Shearman goto nla_put_failure; 3977aefb4d4aSRobert Shearman 3978aefb4d4aSRobert Shearman nla_nest_end(skb, af); 3979aefb4d4aSRobert Shearman } 3980aefb4d4aSRobert Shearman } 3981aefb4d4aSRobert Shearman 3982aefb4d4aSRobert Shearman nla_nest_end(skb, attr); 3983aefb4d4aSRobert Shearman 3984aefb4d4aSRobert Shearman *idxattr = 0; 3985aefb4d4aSRobert Shearman } 3986aefb4d4aSRobert Shearman 398710c9ead9SRoopa Prabhu nlmsg_end(skb, nlh); 398810c9ead9SRoopa Prabhu 398910c9ead9SRoopa Prabhu return 0; 399010c9ead9SRoopa Prabhu 399110c9ead9SRoopa Prabhu nla_put_failure: 3992e8872a25SNikolay Aleksandrov /* not a multi message or no progress mean a real error */ 3993e8872a25SNikolay Aleksandrov if (!(flags & NLM_F_MULTI) || s_prividx == *prividx) 399410c9ead9SRoopa Prabhu nlmsg_cancel(skb, nlh); 3995e8872a25SNikolay Aleksandrov else 3996e8872a25SNikolay Aleksandrov nlmsg_end(skb, nlh); 399710c9ead9SRoopa Prabhu 399810c9ead9SRoopa Prabhu return -EMSGSIZE; 399910c9ead9SRoopa Prabhu } 400010c9ead9SRoopa Prabhu 400110c9ead9SRoopa Prabhu static size_t if_nlmsg_stats_size(const struct net_device *dev, 400210c9ead9SRoopa Prabhu u32 filter_mask) 400310c9ead9SRoopa Prabhu { 400410c9ead9SRoopa Prabhu size_t size = 0; 400510c9ead9SRoopa Prabhu 4006e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0)) 400710c9ead9SRoopa Prabhu size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64)); 400810c9ead9SRoopa Prabhu 400997a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) { 401097a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 401180e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS; 401297a47facSNikolay Aleksandrov 401397a47facSNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 401480e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 401580e73cc5SNikolay Aleksandrov attr)); 401697a47facSNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS */ 401797a47facSNikolay Aleksandrov size += nla_total_size(0); 401897a47facSNikolay Aleksandrov } 401997a47facSNikolay Aleksandrov } 402097a47facSNikolay Aleksandrov 402180e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) { 402280e73cc5SNikolay Aleksandrov struct net_device *_dev = (struct net_device *)dev; 402380e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 402480e73cc5SNikolay Aleksandrov const struct net_device *master; 402580e73cc5SNikolay Aleksandrov 402680e73cc5SNikolay Aleksandrov /* netdev_master_upper_dev_get can't take const */ 402780e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(_dev); 402880e73cc5SNikolay Aleksandrov if (master) 402980e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 403080e73cc5SNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 403180e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS_SLAVE; 403280e73cc5SNikolay Aleksandrov 403380e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 403480e73cc5SNikolay Aleksandrov attr)); 403580e73cc5SNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS_SLAVE */ 403680e73cc5SNikolay Aleksandrov size += nla_total_size(0); 403780e73cc5SNikolay Aleksandrov } 403880e73cc5SNikolay Aleksandrov } 403980e73cc5SNikolay Aleksandrov 404069ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0)) 404169ae6ad2SNogah Frankel size += rtnl_get_offload_stats_size(dev); 404269ae6ad2SNogah Frankel 4043aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) { 4044aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 4045aefb4d4aSRobert Shearman 4046aefb4d4aSRobert Shearman /* for IFLA_STATS_AF_SPEC */ 4047aefb4d4aSRobert Shearman size += nla_total_size(0); 4048aefb4d4aSRobert Shearman 4049aefb4d4aSRobert Shearman list_for_each_entry(af_ops, &rtnl_af_ops, list) { 4050aefb4d4aSRobert Shearman if (af_ops->get_stats_af_size) { 4051aefb4d4aSRobert Shearman size += nla_total_size( 4052aefb4d4aSRobert Shearman af_ops->get_stats_af_size(dev)); 4053aefb4d4aSRobert Shearman 4054aefb4d4aSRobert Shearman /* for AF_* */ 4055aefb4d4aSRobert Shearman size += nla_total_size(0); 4056aefb4d4aSRobert Shearman } 4057aefb4d4aSRobert Shearman } 4058aefb4d4aSRobert Shearman } 4059aefb4d4aSRobert Shearman 406010c9ead9SRoopa Prabhu return size; 406110c9ead9SRoopa Prabhu } 406210c9ead9SRoopa Prabhu 4063c21ef3e3SDavid Ahern static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh, 4064c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 406510c9ead9SRoopa Prabhu { 406610c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 406710c9ead9SRoopa Prabhu struct net_device *dev = NULL; 4068e8872a25SNikolay Aleksandrov int idxattr = 0, prividx = 0; 4069e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 407010c9ead9SRoopa Prabhu struct sk_buff *nskb; 407110c9ead9SRoopa Prabhu u32 filter_mask; 407210c9ead9SRoopa Prabhu int err; 407310c9ead9SRoopa Prabhu 40744775cc1fSMathias Krause if (nlmsg_len(nlh) < sizeof(*ifsm)) 40754775cc1fSMathias Krause return -EINVAL; 40764775cc1fSMathias Krause 407710c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 407810c9ead9SRoopa Prabhu if (ifsm->ifindex > 0) 407910c9ead9SRoopa Prabhu dev = __dev_get_by_index(net, ifsm->ifindex); 408010c9ead9SRoopa Prabhu else 408110c9ead9SRoopa Prabhu return -EINVAL; 408210c9ead9SRoopa Prabhu 408310c9ead9SRoopa Prabhu if (!dev) 408410c9ead9SRoopa Prabhu return -ENODEV; 408510c9ead9SRoopa Prabhu 408610c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 408710c9ead9SRoopa Prabhu if (!filter_mask) 408810c9ead9SRoopa Prabhu return -EINVAL; 408910c9ead9SRoopa Prabhu 409010c9ead9SRoopa Prabhu nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL); 409110c9ead9SRoopa Prabhu if (!nskb) 409210c9ead9SRoopa Prabhu return -ENOBUFS; 409310c9ead9SRoopa Prabhu 409410c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS, 409510c9ead9SRoopa Prabhu NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0, 4096e8872a25SNikolay Aleksandrov 0, filter_mask, &idxattr, &prividx); 409710c9ead9SRoopa Prabhu if (err < 0) { 409810c9ead9SRoopa Prabhu /* -EMSGSIZE implies BUG in if_nlmsg_stats_size */ 409910c9ead9SRoopa Prabhu WARN_ON(err == -EMSGSIZE); 410010c9ead9SRoopa Prabhu kfree_skb(nskb); 410110c9ead9SRoopa Prabhu } else { 410210c9ead9SRoopa Prabhu err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 410310c9ead9SRoopa Prabhu } 410410c9ead9SRoopa Prabhu 410510c9ead9SRoopa Prabhu return err; 410610c9ead9SRoopa Prabhu } 410710c9ead9SRoopa Prabhu 410810c9ead9SRoopa Prabhu static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb) 410910c9ead9SRoopa Prabhu { 4110e8872a25SNikolay Aleksandrov int h, s_h, err, s_idx, s_idxattr, s_prividx; 411110c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 411210c9ead9SRoopa Prabhu unsigned int flags = NLM_F_MULTI; 4113e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 4114e8872a25SNikolay Aleksandrov struct hlist_head *head; 4115e8872a25SNikolay Aleksandrov struct net_device *dev; 411610c9ead9SRoopa Prabhu u32 filter_mask = 0; 4117e8872a25SNikolay Aleksandrov int idx = 0; 411810c9ead9SRoopa Prabhu 411910c9ead9SRoopa Prabhu s_h = cb->args[0]; 412010c9ead9SRoopa Prabhu s_idx = cb->args[1]; 4121e8872a25SNikolay Aleksandrov s_idxattr = cb->args[2]; 4122e8872a25SNikolay Aleksandrov s_prividx = cb->args[3]; 412310c9ead9SRoopa Prabhu 412410c9ead9SRoopa Prabhu cb->seq = net->dev_base_seq; 412510c9ead9SRoopa Prabhu 41264775cc1fSMathias Krause if (nlmsg_len(cb->nlh) < sizeof(*ifsm)) 41274775cc1fSMathias Krause return -EINVAL; 41284775cc1fSMathias Krause 412910c9ead9SRoopa Prabhu ifsm = nlmsg_data(cb->nlh); 413010c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 413110c9ead9SRoopa Prabhu if (!filter_mask) 413210c9ead9SRoopa Prabhu return -EINVAL; 413310c9ead9SRoopa Prabhu 413410c9ead9SRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 413510c9ead9SRoopa Prabhu idx = 0; 413610c9ead9SRoopa Prabhu head = &net->dev_index_head[h]; 413710c9ead9SRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 413810c9ead9SRoopa Prabhu if (idx < s_idx) 413910c9ead9SRoopa Prabhu goto cont; 414010c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS, 414110c9ead9SRoopa Prabhu NETLINK_CB(cb->skb).portid, 414210c9ead9SRoopa Prabhu cb->nlh->nlmsg_seq, 0, 4143e8872a25SNikolay Aleksandrov flags, filter_mask, 4144e8872a25SNikolay Aleksandrov &s_idxattr, &s_prividx); 414510c9ead9SRoopa Prabhu /* If we ran out of room on the first message, 414610c9ead9SRoopa Prabhu * we're in trouble 414710c9ead9SRoopa Prabhu */ 414810c9ead9SRoopa Prabhu WARN_ON((err == -EMSGSIZE) && (skb->len == 0)); 414910c9ead9SRoopa Prabhu 415010c9ead9SRoopa Prabhu if (err < 0) 415110c9ead9SRoopa Prabhu goto out; 4152e8872a25SNikolay Aleksandrov s_prividx = 0; 4153e8872a25SNikolay Aleksandrov s_idxattr = 0; 415410c9ead9SRoopa Prabhu nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 415510c9ead9SRoopa Prabhu cont: 415610c9ead9SRoopa Prabhu idx++; 415710c9ead9SRoopa Prabhu } 415810c9ead9SRoopa Prabhu } 415910c9ead9SRoopa Prabhu out: 4160e8872a25SNikolay Aleksandrov cb->args[3] = s_prividx; 4161e8872a25SNikolay Aleksandrov cb->args[2] = s_idxattr; 416210c9ead9SRoopa Prabhu cb->args[1] = idx; 416310c9ead9SRoopa Prabhu cb->args[0] = h; 416410c9ead9SRoopa Prabhu 416510c9ead9SRoopa Prabhu return skb->len; 416610c9ead9SRoopa Prabhu } 416710c9ead9SRoopa Prabhu 41681da177e4SLinus Torvalds /* Process one rtnetlink message. */ 41691da177e4SLinus Torvalds 41702d4bc933SJohannes Berg static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, 41712d4bc933SJohannes Berg struct netlink_ext_ack *extack) 41721da177e4SLinus Torvalds { 41733b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 41746853dd48SFlorian Westphal struct rtnl_link *handlers; 41756853dd48SFlorian Westphal int err = -EOPNOTSUPP; 4176e2849863SThomas Graf rtnl_doit_func doit; 417762256f98SFlorian Westphal unsigned int flags; 4178617cfc75SAlexander Kuleshov int kind; 41791da177e4SLinus Torvalds int family; 41801da177e4SLinus Torvalds int type; 41811da177e4SLinus Torvalds 41821da177e4SLinus Torvalds type = nlh->nlmsg_type; 41831da177e4SLinus Torvalds if (type > RTM_MAX) 4184038890feSThomas Graf return -EOPNOTSUPP; 41851da177e4SLinus Torvalds 41861da177e4SLinus Torvalds type -= RTM_BASE; 41871da177e4SLinus Torvalds 41881da177e4SLinus Torvalds /* All the messages must have at least 1 byte length */ 4189573ce260SHong zhi guo if (nlmsg_len(nlh) < sizeof(struct rtgenmsg)) 41901da177e4SLinus Torvalds return 0; 41911da177e4SLinus Torvalds 4192573ce260SHong zhi guo family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family; 41931da177e4SLinus Torvalds kind = type&3; 41941da177e4SLinus Torvalds 419590f62cf3SEric W. Biederman if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN)) 41961d00a4ebSThomas Graf return -EPERM; 41971da177e4SLinus Torvalds 41985c2bb9b6SFlorian Westphal if (family >= ARRAY_SIZE(rtnl_msg_handlers)) 41996853dd48SFlorian Westphal family = PF_UNSPEC; 42006853dd48SFlorian Westphal 42016853dd48SFlorian Westphal rcu_read_lock(); 42026853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42036853dd48SFlorian Westphal if (!handlers) { 42046853dd48SFlorian Westphal family = PF_UNSPEC; 42056853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42066853dd48SFlorian Westphal } 42076853dd48SFlorian Westphal 4208b8f3ab42SDavid S. Miller if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { 420997c53cacSDenis V. Lunev struct sock *rtnl; 4210e2849863SThomas Graf rtnl_dumpit_func dumpit; 4211c7ac8679SGreg Rose u16 min_dump_alloc = 0; 42121da177e4SLinus Torvalds 42136853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 42146853dd48SFlorian Westphal if (!dumpit) { 42156853dd48SFlorian Westphal family = PF_UNSPEC; 42166853dd48SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[PF_UNSPEC]); 42176853dd48SFlorian Westphal if (!handlers) 42180cc09020SFlorian Westphal goto err_unlock; 4219e1fa6d21SFlorian Westphal 42206853dd48SFlorian Westphal dumpit = READ_ONCE(handlers[type].dumpit); 42216853dd48SFlorian Westphal if (!dumpit) 42226853dd48SFlorian Westphal goto err_unlock; 42236853dd48SFlorian Westphal } 42246853dd48SFlorian Westphal 4225019a3169SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 4226019a3169SFlorian Westphal 42275c2bb9b6SFlorian Westphal if (type == RTM_GETLINK - RTM_BASE) 4228e1fa6d21SFlorian Westphal min_dump_alloc = rtnl_calcit(skb, nlh); 42291da177e4SLinus Torvalds 42306853dd48SFlorian Westphal rcu_read_unlock(); 42316853dd48SFlorian Westphal 423297c53cacSDenis V. Lunev rtnl = net->rtnl; 423380d326faSPablo Neira Ayuso { 423480d326faSPablo Neira Ayuso struct netlink_dump_control c = { 423580d326faSPablo Neira Ayuso .dump = dumpit, 423680d326faSPablo Neira Ayuso .min_dump_alloc = min_dump_alloc, 423780d326faSPablo Neira Ayuso }; 423880d326faSPablo Neira Ayuso err = netlink_dump_start(rtnl, skb, nlh, &c); 423980d326faSPablo Neira Ayuso } 4240019a3169SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 42412907c35fSEric Dumazet return err; 42421da177e4SLinus Torvalds } 42431da177e4SLinus Torvalds 42448caa38b5SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 42458caa38b5SFlorian Westphal if (!doit) { 42468caa38b5SFlorian Westphal family = PF_UNSPEC; 42478caa38b5SFlorian Westphal handlers = rcu_dereference(rtnl_msg_handlers[family]); 42488caa38b5SFlorian Westphal } 42498caa38b5SFlorian Westphal 425062256f98SFlorian Westphal flags = READ_ONCE(handlers[type].flags); 425162256f98SFlorian Westphal if (flags & RTNL_FLAG_DOIT_UNLOCKED) { 425262256f98SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 425362256f98SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 425462256f98SFlorian Westphal rcu_read_unlock(); 425562256f98SFlorian Westphal if (doit) 425662256f98SFlorian Westphal err = doit(skb, nlh, extack); 425762256f98SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 425862256f98SFlorian Westphal return err; 425962256f98SFlorian Westphal } 426062256f98SFlorian Westphal 42616853dd48SFlorian Westphal rcu_read_unlock(); 42626853dd48SFlorian Westphal 42630cc09020SFlorian Westphal rtnl_lock(); 42646853dd48SFlorian Westphal handlers = rtnl_dereference(rtnl_msg_handlers[family]); 42656853dd48SFlorian Westphal if (handlers) { 42666853dd48SFlorian Westphal doit = READ_ONCE(handlers[type].doit); 42676853dd48SFlorian Westphal if (doit) 42680cc09020SFlorian Westphal err = doit(skb, nlh, extack); 42696853dd48SFlorian Westphal } 42700cc09020SFlorian Westphal rtnl_unlock(); 42710cc09020SFlorian Westphal return err; 42720cc09020SFlorian Westphal 42730cc09020SFlorian Westphal err_unlock: 42746853dd48SFlorian Westphal rcu_read_unlock(); 42750cc09020SFlorian Westphal return -EOPNOTSUPP; 42761da177e4SLinus Torvalds } 42771da177e4SLinus Torvalds 4278cd40b7d3SDenis V. Lunev static void rtnetlink_rcv(struct sk_buff *skb) 42791da177e4SLinus Torvalds { 4280cd40b7d3SDenis V. Lunev netlink_rcv_skb(skb, &rtnetlink_rcv_msg); 42811da177e4SLinus Torvalds } 42821da177e4SLinus Torvalds 42835f729eaaSJulien Gomes static int rtnetlink_bind(struct net *net, int group) 42845f729eaaSJulien Gomes { 42855f729eaaSJulien Gomes switch (group) { 42865f729eaaSJulien Gomes case RTNLGRP_IPV4_MROUTE_R: 42875f729eaaSJulien Gomes case RTNLGRP_IPV6_MROUTE_R: 42885f729eaaSJulien Gomes if (!ns_capable(net->user_ns, CAP_NET_ADMIN)) 42895f729eaaSJulien Gomes return -EPERM; 42905f729eaaSJulien Gomes break; 42915f729eaaSJulien Gomes } 42925f729eaaSJulien Gomes return 0; 42935f729eaaSJulien Gomes } 42945f729eaaSJulien Gomes 42951da177e4SLinus Torvalds static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) 42961da177e4SLinus Torvalds { 4297351638e7SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 4298e9dc8653SEric W. Biederman 42991da177e4SLinus Torvalds switch (event) { 43005138e86fSVlad Yasevich case NETDEV_REBOOT: 43013753654eSDavid Ahern case NETDEV_CHANGEADDR: 43025138e86fSVlad Yasevich case NETDEV_CHANGENAME: 43035138e86fSVlad Yasevich case NETDEV_FEAT_CHANGE: 43045138e86fSVlad Yasevich case NETDEV_BONDING_FAILOVER: 43055138e86fSVlad Yasevich case NETDEV_NOTIFY_PEERS: 43065138e86fSVlad Yasevich case NETDEV_RESEND_IGMP: 43075138e86fSVlad Yasevich case NETDEV_CHANGEINFODATA: 43083d3ea5afSVlad Yasevich rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event), 43093d3ea5afSVlad Yasevich GFP_KERNEL); 43101da177e4SLinus Torvalds break; 43111da177e4SLinus Torvalds default: 43121da177e4SLinus Torvalds break; 43131da177e4SLinus Torvalds } 43141da177e4SLinus Torvalds return NOTIFY_DONE; 43151da177e4SLinus Torvalds } 43161da177e4SLinus Torvalds 43171da177e4SLinus Torvalds static struct notifier_block rtnetlink_dev_notifier = { 43181da177e4SLinus Torvalds .notifier_call = rtnetlink_event, 43191da177e4SLinus Torvalds }; 43201da177e4SLinus Torvalds 432197c53cacSDenis V. Lunev 43222c8c1e72SAlexey Dobriyan static int __net_init rtnetlink_net_init(struct net *net) 432397c53cacSDenis V. Lunev { 432497c53cacSDenis V. Lunev struct sock *sk; 4325a31f2d17SPablo Neira Ayuso struct netlink_kernel_cfg cfg = { 4326a31f2d17SPablo Neira Ayuso .groups = RTNLGRP_MAX, 4327a31f2d17SPablo Neira Ayuso .input = rtnetlink_rcv, 4328a31f2d17SPablo Neira Ayuso .cb_mutex = &rtnl_mutex, 43299785e10aSPablo Neira Ayuso .flags = NL_CFG_F_NONROOT_RECV, 43305f729eaaSJulien Gomes .bind = rtnetlink_bind, 4331a31f2d17SPablo Neira Ayuso }; 4332a31f2d17SPablo Neira Ayuso 43339f00d977SPablo Neira Ayuso sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg); 433497c53cacSDenis V. Lunev if (!sk) 433597c53cacSDenis V. Lunev return -ENOMEM; 433697c53cacSDenis V. Lunev net->rtnl = sk; 433797c53cacSDenis V. Lunev return 0; 433897c53cacSDenis V. Lunev } 433997c53cacSDenis V. Lunev 43402c8c1e72SAlexey Dobriyan static void __net_exit rtnetlink_net_exit(struct net *net) 434197c53cacSDenis V. Lunev { 4342b7c6ba6eSDenis V. Lunev netlink_kernel_release(net->rtnl); 434397c53cacSDenis V. Lunev net->rtnl = NULL; 434497c53cacSDenis V. Lunev } 434597c53cacSDenis V. Lunev 434697c53cacSDenis V. Lunev static struct pernet_operations rtnetlink_net_ops = { 434797c53cacSDenis V. Lunev .init = rtnetlink_net_init, 434897c53cacSDenis V. Lunev .exit = rtnetlink_net_exit, 434997c53cacSDenis V. Lunev }; 435097c53cacSDenis V. Lunev 43511da177e4SLinus Torvalds void __init rtnetlink_init(void) 43521da177e4SLinus Torvalds { 4353d38a6512SFlorian Westphal int i; 4354d38a6512SFlorian Westphal 4355d38a6512SFlorian Westphal for (i = 0; i < ARRAY_SIZE(rtnl_msg_handlers_ref); i++) 4356d38a6512SFlorian Westphal refcount_set(&rtnl_msg_handlers_ref[i], 1); 4357d38a6512SFlorian Westphal 435897c53cacSDenis V. Lunev if (register_pernet_subsys(&rtnetlink_net_ops)) 43591da177e4SLinus Torvalds panic("rtnetlink_init: cannot initialize rtnetlink\n"); 436097c53cacSDenis V. Lunev 43611da177e4SLinus Torvalds register_netdevice_notifier(&rtnetlink_dev_notifier); 4362340d17fcSThomas Graf 4363c7ac8679SGreg Rose rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, 4364b97bac64SFlorian Westphal rtnl_dump_ifinfo, 0); 4365b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0); 4366b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0); 4367b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0); 4368687ad8ccSThomas Graf 4369b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0); 4370b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0); 4371b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0); 437277162022SJohn Fastabend 4373b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0); 4374b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0); 4375b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0); 4376e5a55a89SJohn Fastabend 4377b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0); 4378b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0); 4379b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0); 438010c9ead9SRoopa Prabhu 438110c9ead9SRoopa Prabhu rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump, 4382b97bac64SFlorian Westphal 0); 43831da177e4SLinus Torvalds } 4384