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; 66*addf9b90SFlorian Westphal struct rcu_head rcu; 67e2849863SThomas Graf }; 68e2849863SThomas Graf 696756ae4bSStephen Hemminger static DEFINE_MUTEX(rtnl_mutex); 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds void rtnl_lock(void) 721da177e4SLinus Torvalds { 736756ae4bSStephen Hemminger mutex_lock(&rtnl_mutex); 741da177e4SLinus Torvalds } 75e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_lock); 761da177e4SLinus Torvalds 771b5c5493SEric Dumazet static struct sk_buff *defer_kfree_skb_list; 781b5c5493SEric Dumazet void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail) 791b5c5493SEric Dumazet { 801b5c5493SEric Dumazet if (head && tail) { 811b5c5493SEric Dumazet tail->next = defer_kfree_skb_list; 821b5c5493SEric Dumazet defer_kfree_skb_list = head; 831b5c5493SEric Dumazet } 841b5c5493SEric Dumazet } 851b5c5493SEric Dumazet EXPORT_SYMBOL(rtnl_kfree_skbs); 861b5c5493SEric Dumazet 876756ae4bSStephen Hemminger void __rtnl_unlock(void) 881da177e4SLinus Torvalds { 891b5c5493SEric Dumazet struct sk_buff *head = defer_kfree_skb_list; 901b5c5493SEric Dumazet 911b5c5493SEric Dumazet defer_kfree_skb_list = NULL; 921b5c5493SEric Dumazet 936756ae4bSStephen Hemminger mutex_unlock(&rtnl_mutex); 941b5c5493SEric Dumazet 951b5c5493SEric Dumazet while (head) { 961b5c5493SEric Dumazet struct sk_buff *next = head->next; 971b5c5493SEric Dumazet 981b5c5493SEric Dumazet kfree_skb(head); 991b5c5493SEric Dumazet cond_resched(); 1001b5c5493SEric Dumazet head = next; 1011b5c5493SEric Dumazet } 1021da177e4SLinus Torvalds } 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds void rtnl_unlock(void) 1051da177e4SLinus Torvalds { 10658ec3b4dSHerbert Xu /* This fellow will unlock it for us. */ 1071da177e4SLinus Torvalds netdev_run_todo(); 1081da177e4SLinus Torvalds } 109e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unlock); 1101da177e4SLinus Torvalds 1116756ae4bSStephen Hemminger int rtnl_trylock(void) 1126756ae4bSStephen Hemminger { 1136756ae4bSStephen Hemminger return mutex_trylock(&rtnl_mutex); 1146756ae4bSStephen Hemminger } 115e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_trylock); 1166756ae4bSStephen Hemminger 117c9c1014bSPatrick McHardy int rtnl_is_locked(void) 118c9c1014bSPatrick McHardy { 119c9c1014bSPatrick McHardy return mutex_is_locked(&rtnl_mutex); 120c9c1014bSPatrick McHardy } 121e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_is_locked); 122c9c1014bSPatrick McHardy 123a898def2SPaul E. McKenney #ifdef CONFIG_PROVE_LOCKING 1240cbf3343SYaowei Bai bool lockdep_rtnl_is_held(void) 125a898def2SPaul E. McKenney { 126a898def2SPaul E. McKenney return lockdep_is_held(&rtnl_mutex); 127a898def2SPaul E. McKenney } 128a898def2SPaul E. McKenney EXPORT_SYMBOL(lockdep_rtnl_is_held); 129a898def2SPaul E. McKenney #endif /* #ifdef CONFIG_PROVE_LOCKING */ 130a898def2SPaul E. McKenney 131*addf9b90SFlorian Westphal static struct rtnl_link __rcu **rtnl_msg_handlers[RTNL_FAMILY_MAX + 1]; 132019a3169SFlorian Westphal static refcount_t rtnl_msg_handlers_ref[RTNL_FAMILY_MAX + 1]; 133e2849863SThomas Graf 134e2849863SThomas Graf static inline int rtm_msgindex(int msgtype) 135e2849863SThomas Graf { 136e2849863SThomas Graf int msgindex = msgtype - RTM_BASE; 137e2849863SThomas Graf 138e2849863SThomas Graf /* 139e2849863SThomas Graf * msgindex < 0 implies someone tried to register a netlink 140e2849863SThomas Graf * control code. msgindex >= RTM_NR_MSGTYPES may indicate that 141e2849863SThomas Graf * the message type has not been added to linux/rtnetlink.h 142e2849863SThomas Graf */ 143e2849863SThomas Graf BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES); 144e2849863SThomas Graf 145e2849863SThomas Graf return msgindex; 146e2849863SThomas Graf } 147e2849863SThomas Graf 148*addf9b90SFlorian Westphal static struct rtnl_link *rtnl_get_link(int protocol, int msgtype) 149*addf9b90SFlorian Westphal { 150*addf9b90SFlorian Westphal struct rtnl_link **tab; 151*addf9b90SFlorian Westphal 152*addf9b90SFlorian Westphal if (protocol >= ARRAY_SIZE(rtnl_msg_handlers)) 153*addf9b90SFlorian Westphal protocol = PF_UNSPEC; 154*addf9b90SFlorian Westphal 155*addf9b90SFlorian Westphal tab = rcu_dereference_rtnl(rtnl_msg_handlers[protocol]); 156*addf9b90SFlorian Westphal if (!tab) 157*addf9b90SFlorian Westphal tab = rcu_dereference_rtnl(rtnl_msg_handlers[PF_UNSPEC]); 158*addf9b90SFlorian Westphal 159*addf9b90SFlorian Westphal return tab[msgtype]; 160*addf9b90SFlorian Westphal } 161*addf9b90SFlorian Westphal 162e2849863SThomas Graf /** 163e2849863SThomas Graf * __rtnl_register - Register a rtnetlink message type 164e2849863SThomas Graf * @protocol: Protocol family or PF_UNSPEC 165e2849863SThomas Graf * @msgtype: rtnetlink message type 166e2849863SThomas Graf * @doit: Function pointer called for each request message 167e2849863SThomas Graf * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message 168b97bac64SFlorian Westphal * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions 169e2849863SThomas Graf * 170e2849863SThomas Graf * Registers the specified function pointers (at least one of them has 171e2849863SThomas Graf * to be non-NULL) to be called whenever a request message for the 172e2849863SThomas Graf * specified protocol family and message type is received. 173e2849863SThomas Graf * 174e2849863SThomas Graf * The special protocol family PF_UNSPEC may be used to define fallback 175e2849863SThomas Graf * function pointers for the case when no entry for the specific protocol 176e2849863SThomas Graf * family exists. 177e2849863SThomas Graf * 178e2849863SThomas Graf * Returns 0 on success or a negative error code. 179e2849863SThomas Graf */ 180e2849863SThomas Graf int __rtnl_register(int protocol, int msgtype, 181c7ac8679SGreg Rose rtnl_doit_func doit, rtnl_dumpit_func dumpit, 182b97bac64SFlorian Westphal unsigned int flags) 183e2849863SThomas Graf { 184*addf9b90SFlorian Westphal struct rtnl_link **tab, *link, *old; 185e2849863SThomas Graf int msgindex; 186*addf9b90SFlorian Westphal int ret = -ENOBUFS; 187e2849863SThomas Graf 18825239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 189e2849863SThomas Graf msgindex = rtm_msgindex(msgtype); 190e2849863SThomas Graf 191*addf9b90SFlorian Westphal rtnl_lock(); 192*addf9b90SFlorian Westphal tab = rtnl_msg_handlers[protocol]; 193e2849863SThomas Graf if (tab == NULL) { 194*addf9b90SFlorian Westphal tab = kcalloc(RTM_NR_MSGTYPES, sizeof(void *), GFP_KERNEL); 195*addf9b90SFlorian Westphal if (!tab) 196*addf9b90SFlorian Westphal goto unlock; 197e2849863SThomas Graf 198*addf9b90SFlorian Westphal /* ensures we see the 0 stores */ 1996853dd48SFlorian Westphal rcu_assign_pointer(rtnl_msg_handlers[protocol], tab); 200e2849863SThomas Graf } 201e2849863SThomas Graf 202*addf9b90SFlorian Westphal old = rtnl_dereference(tab[msgindex]); 203*addf9b90SFlorian Westphal if (old) { 204*addf9b90SFlorian Westphal link = kmemdup(old, sizeof(*old), GFP_KERNEL); 205*addf9b90SFlorian Westphal if (!link) 206*addf9b90SFlorian Westphal goto unlock; 207*addf9b90SFlorian Westphal } else { 208*addf9b90SFlorian Westphal link = kzalloc(sizeof(*link), GFP_KERNEL); 209*addf9b90SFlorian Westphal if (!link) 210*addf9b90SFlorian Westphal goto unlock; 211*addf9b90SFlorian Westphal } 212e2849863SThomas Graf 213*addf9b90SFlorian Westphal WARN_ON(doit && link->doit && link->doit != doit); 214*addf9b90SFlorian Westphal if (doit) 215*addf9b90SFlorian Westphal link->doit = doit; 216*addf9b90SFlorian Westphal WARN_ON(dumpit && link->dumpit && link->dumpit != dumpit); 217*addf9b90SFlorian Westphal if (dumpit) 218*addf9b90SFlorian Westphal link->dumpit = dumpit; 219*addf9b90SFlorian Westphal 220*addf9b90SFlorian Westphal link->flags |= flags; 221*addf9b90SFlorian Westphal 222*addf9b90SFlorian Westphal /* publish protocol:msgtype */ 223*addf9b90SFlorian Westphal rcu_assign_pointer(tab[msgindex], link); 224*addf9b90SFlorian Westphal ret = 0; 225*addf9b90SFlorian Westphal if (old) 226*addf9b90SFlorian Westphal kfree_rcu(old, rcu); 227*addf9b90SFlorian Westphal unlock: 228*addf9b90SFlorian Westphal rtnl_unlock(); 229*addf9b90SFlorian Westphal return ret; 230e2849863SThomas Graf } 231e2849863SThomas Graf EXPORT_SYMBOL_GPL(__rtnl_register); 232e2849863SThomas Graf 233e2849863SThomas Graf /** 234e2849863SThomas Graf * rtnl_register - Register a rtnetlink message type 235e2849863SThomas Graf * 236e2849863SThomas Graf * Identical to __rtnl_register() but panics on failure. This is useful 237e2849863SThomas Graf * as failure of this function is very unlikely, it can only happen due 238e2849863SThomas Graf * to lack of memory when allocating the chain to store all message 239e2849863SThomas Graf * handlers for a protocol. Meant for use in init functions where lack 24025985edcSLucas De Marchi * of memory implies no sense in continuing. 241e2849863SThomas Graf */ 242e2849863SThomas Graf void rtnl_register(int protocol, int msgtype, 243c7ac8679SGreg Rose rtnl_doit_func doit, rtnl_dumpit_func dumpit, 244b97bac64SFlorian Westphal unsigned int flags) 245e2849863SThomas Graf { 246b97bac64SFlorian Westphal if (__rtnl_register(protocol, msgtype, doit, dumpit, flags) < 0) 247e2849863SThomas Graf panic("Unable to register rtnetlink message handler, " 248e2849863SThomas Graf "protocol = %d, message type = %d\n", 249e2849863SThomas Graf protocol, msgtype); 250e2849863SThomas Graf } 251e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_register); 252e2849863SThomas Graf 253e2849863SThomas Graf /** 254e2849863SThomas Graf * rtnl_unregister - Unregister a rtnetlink message type 255e2849863SThomas Graf * @protocol: Protocol family or PF_UNSPEC 256e2849863SThomas Graf * @msgtype: rtnetlink message type 257e2849863SThomas Graf * 258e2849863SThomas Graf * Returns 0 on success or a negative error code. 259e2849863SThomas Graf */ 260e2849863SThomas Graf int rtnl_unregister(int protocol, int msgtype) 261e2849863SThomas Graf { 262*addf9b90SFlorian Westphal struct rtnl_link **tab, *link; 263e2849863SThomas Graf int msgindex; 264e2849863SThomas Graf 26525239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 266e2849863SThomas Graf msgindex = rtm_msgindex(msgtype); 267e2849863SThomas Graf 2686853dd48SFlorian Westphal rtnl_lock(); 269*addf9b90SFlorian Westphal tab = rtnl_dereference(rtnl_msg_handlers[protocol]); 270*addf9b90SFlorian Westphal if (!tab) { 2716853dd48SFlorian Westphal rtnl_unlock(); 272e2849863SThomas Graf return -ENOENT; 2736853dd48SFlorian Westphal } 274e2849863SThomas Graf 275*addf9b90SFlorian Westphal link = tab[msgindex]; 276*addf9b90SFlorian Westphal rcu_assign_pointer(tab[msgindex], NULL); 2776853dd48SFlorian Westphal rtnl_unlock(); 278e2849863SThomas Graf 279*addf9b90SFlorian Westphal kfree_rcu(link, rcu); 280*addf9b90SFlorian Westphal 281e2849863SThomas Graf return 0; 282e2849863SThomas Graf } 283e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister); 284e2849863SThomas Graf 285e2849863SThomas Graf /** 286e2849863SThomas Graf * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol 287e2849863SThomas Graf * @protocol : Protocol family or PF_UNSPEC 288e2849863SThomas Graf * 289e2849863SThomas Graf * Identical to calling rtnl_unregster() for all registered message types 290e2849863SThomas Graf * of a certain protocol family. 291e2849863SThomas Graf */ 292e2849863SThomas Graf void rtnl_unregister_all(int protocol) 293e2849863SThomas Graf { 294*addf9b90SFlorian Westphal struct rtnl_link **tab, *link; 295*addf9b90SFlorian Westphal int msgindex; 296019a3169SFlorian Westphal 29725239ceeSPatrick McHardy BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); 298e2849863SThomas Graf 299019a3169SFlorian Westphal rtnl_lock(); 300*addf9b90SFlorian Westphal tab = rtnl_msg_handlers[protocol]; 3016853dd48SFlorian Westphal RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL); 302*addf9b90SFlorian Westphal for (msgindex = 0; msgindex < RTM_NR_MSGTYPES; msgindex++) { 303*addf9b90SFlorian Westphal link = tab[msgindex]; 304*addf9b90SFlorian Westphal if (!link) 305*addf9b90SFlorian Westphal continue; 306*addf9b90SFlorian Westphal 307*addf9b90SFlorian Westphal rcu_assign_pointer(tab[msgindex], NULL); 308*addf9b90SFlorian Westphal kfree_rcu(link, rcu); 309*addf9b90SFlorian Westphal } 310019a3169SFlorian Westphal rtnl_unlock(); 311019a3169SFlorian Westphal 3126853dd48SFlorian Westphal synchronize_net(); 3136853dd48SFlorian Westphal 314d38a6512SFlorian Westphal while (refcount_read(&rtnl_msg_handlers_ref[protocol]) > 1) 315019a3169SFlorian Westphal schedule(); 316*addf9b90SFlorian Westphal kfree(tab); 317e2849863SThomas Graf } 318e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister_all); 3191da177e4SLinus Torvalds 32038f7b870SPatrick McHardy static LIST_HEAD(link_ops); 32138f7b870SPatrick McHardy 322c63044f0SEric Dumazet static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind) 323c63044f0SEric Dumazet { 324c63044f0SEric Dumazet const struct rtnl_link_ops *ops; 325c63044f0SEric Dumazet 326c63044f0SEric Dumazet list_for_each_entry(ops, &link_ops, list) { 327c63044f0SEric Dumazet if (!strcmp(ops->kind, kind)) 328c63044f0SEric Dumazet return ops; 329c63044f0SEric Dumazet } 330c63044f0SEric Dumazet return NULL; 331c63044f0SEric Dumazet } 332c63044f0SEric Dumazet 33338f7b870SPatrick McHardy /** 33438f7b870SPatrick McHardy * __rtnl_link_register - Register rtnl_link_ops with rtnetlink. 33538f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to register 33638f7b870SPatrick McHardy * 33738f7b870SPatrick McHardy * The caller must hold the rtnl_mutex. This function should be used 33838f7b870SPatrick McHardy * by drivers that create devices during module initialization. It 33938f7b870SPatrick McHardy * must be called before registering the devices. 34038f7b870SPatrick McHardy * 34138f7b870SPatrick McHardy * Returns 0 on success or a negative error code. 34238f7b870SPatrick McHardy */ 34338f7b870SPatrick McHardy int __rtnl_link_register(struct rtnl_link_ops *ops) 34438f7b870SPatrick McHardy { 345c63044f0SEric Dumazet if (rtnl_link_ops_get(ops->kind)) 346c63044f0SEric Dumazet return -EEXIST; 347c63044f0SEric Dumazet 348b0ab2fabSJiri Pirko /* The check for setup is here because if ops 349b0ab2fabSJiri Pirko * does not have that filled up, it is not possible 350b0ab2fabSJiri Pirko * to use the ops for creating device. So do not 351b0ab2fabSJiri Pirko * fill up dellink as well. That disables rtnl_dellink. 352b0ab2fabSJiri Pirko */ 353b0ab2fabSJiri Pirko if (ops->setup && !ops->dellink) 35423289a37SEric Dumazet ops->dellink = unregister_netdevice_queue; 3552d85cba2SPatrick McHardy 35638f7b870SPatrick McHardy list_add_tail(&ops->list, &link_ops); 35738f7b870SPatrick McHardy return 0; 35838f7b870SPatrick McHardy } 35938f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_register); 36038f7b870SPatrick McHardy 36138f7b870SPatrick McHardy /** 36238f7b870SPatrick McHardy * rtnl_link_register - Register rtnl_link_ops with rtnetlink. 36338f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to register 36438f7b870SPatrick McHardy * 36538f7b870SPatrick McHardy * Returns 0 on success or a negative error code. 36638f7b870SPatrick McHardy */ 36738f7b870SPatrick McHardy int rtnl_link_register(struct rtnl_link_ops *ops) 36838f7b870SPatrick McHardy { 36938f7b870SPatrick McHardy int err; 37038f7b870SPatrick McHardy 37138f7b870SPatrick McHardy rtnl_lock(); 37238f7b870SPatrick McHardy err = __rtnl_link_register(ops); 37338f7b870SPatrick McHardy rtnl_unlock(); 37438f7b870SPatrick McHardy return err; 37538f7b870SPatrick McHardy } 37638f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_register); 37738f7b870SPatrick McHardy 378669f87baSPavel Emelyanov static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops) 379669f87baSPavel Emelyanov { 380669f87baSPavel Emelyanov struct net_device *dev; 38123289a37SEric Dumazet LIST_HEAD(list_kill); 38223289a37SEric Dumazet 383669f87baSPavel Emelyanov for_each_netdev(net, dev) { 38423289a37SEric Dumazet if (dev->rtnl_link_ops == ops) 38523289a37SEric Dumazet ops->dellink(dev, &list_kill); 386669f87baSPavel Emelyanov } 38723289a37SEric Dumazet unregister_netdevice_many(&list_kill); 388669f87baSPavel Emelyanov } 389669f87baSPavel Emelyanov 39038f7b870SPatrick McHardy /** 39138f7b870SPatrick McHardy * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 39238f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to unregister 39338f7b870SPatrick McHardy * 3942d85cba2SPatrick McHardy * The caller must hold the rtnl_mutex. 39538f7b870SPatrick McHardy */ 39638f7b870SPatrick McHardy void __rtnl_link_unregister(struct rtnl_link_ops *ops) 39738f7b870SPatrick McHardy { 398881d966bSEric W. Biederman struct net *net; 3992d85cba2SPatrick McHardy 400881d966bSEric W. Biederman for_each_net(net) { 401669f87baSPavel Emelyanov __rtnl_kill_links(net, ops); 402881d966bSEric W. Biederman } 40338f7b870SPatrick McHardy list_del(&ops->list); 40438f7b870SPatrick McHardy } 40538f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_unregister); 40638f7b870SPatrick McHardy 407200b916fSCong Wang /* Return with the rtnl_lock held when there are no network 408200b916fSCong Wang * devices unregistering in any network namespace. 409200b916fSCong Wang */ 410200b916fSCong Wang static void rtnl_lock_unregistering_all(void) 411200b916fSCong Wang { 412200b916fSCong Wang struct net *net; 413200b916fSCong Wang bool unregistering; 414ff960a73SPeter Zijlstra DEFINE_WAIT_FUNC(wait, woken_wake_function); 415200b916fSCong Wang 416ff960a73SPeter Zijlstra add_wait_queue(&netdev_unregistering_wq, &wait); 417200b916fSCong Wang for (;;) { 418200b916fSCong Wang unregistering = false; 419200b916fSCong Wang rtnl_lock(); 420200b916fSCong Wang for_each_net(net) { 421200b916fSCong Wang if (net->dev_unreg_count > 0) { 422200b916fSCong Wang unregistering = true; 423200b916fSCong Wang break; 424200b916fSCong Wang } 425200b916fSCong Wang } 426200b916fSCong Wang if (!unregistering) 427200b916fSCong Wang break; 428200b916fSCong Wang __rtnl_unlock(); 429ff960a73SPeter Zijlstra 430ff960a73SPeter Zijlstra wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT); 431200b916fSCong Wang } 432ff960a73SPeter Zijlstra remove_wait_queue(&netdev_unregistering_wq, &wait); 433200b916fSCong Wang } 434200b916fSCong Wang 43538f7b870SPatrick McHardy /** 43638f7b870SPatrick McHardy * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. 43738f7b870SPatrick McHardy * @ops: struct rtnl_link_ops * to unregister 43838f7b870SPatrick McHardy */ 43938f7b870SPatrick McHardy void rtnl_link_unregister(struct rtnl_link_ops *ops) 44038f7b870SPatrick McHardy { 441200b916fSCong Wang /* Close the race with cleanup_net() */ 442200b916fSCong Wang mutex_lock(&net_mutex); 443200b916fSCong Wang rtnl_lock_unregistering_all(); 44438f7b870SPatrick McHardy __rtnl_link_unregister(ops); 44538f7b870SPatrick McHardy rtnl_unlock(); 446200b916fSCong Wang mutex_unlock(&net_mutex); 44738f7b870SPatrick McHardy } 44838f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_unregister); 44938f7b870SPatrick McHardy 450ba7d49b1SJiri Pirko static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev) 451ba7d49b1SJiri Pirko { 452ba7d49b1SJiri Pirko struct net_device *master_dev; 453ba7d49b1SJiri Pirko const struct rtnl_link_ops *ops; 4548515ae38SFlorian Westphal size_t size = 0; 455ba7d49b1SJiri Pirko 4568515ae38SFlorian Westphal rcu_read_lock(); 4578515ae38SFlorian Westphal 4588515ae38SFlorian Westphal master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 459ba7d49b1SJiri Pirko if (!master_dev) 4608515ae38SFlorian Westphal goto out; 4618515ae38SFlorian Westphal 462ba7d49b1SJiri Pirko ops = master_dev->rtnl_link_ops; 4636049f253SFernando Luis Vazquez Cao if (!ops || !ops->get_slave_size) 4648515ae38SFlorian Westphal goto out; 465ba7d49b1SJiri Pirko /* IFLA_INFO_SLAVE_DATA + nested data */ 4668515ae38SFlorian Westphal size = nla_total_size(sizeof(struct nlattr)) + 467ba7d49b1SJiri Pirko ops->get_slave_size(master_dev, dev); 4688515ae38SFlorian Westphal 4698515ae38SFlorian Westphal out: 4708515ae38SFlorian Westphal rcu_read_unlock(); 4718515ae38SFlorian Westphal return size; 472ba7d49b1SJiri Pirko } 473ba7d49b1SJiri Pirko 47438f7b870SPatrick McHardy static size_t rtnl_link_get_size(const struct net_device *dev) 47538f7b870SPatrick McHardy { 47638f7b870SPatrick McHardy const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 47738f7b870SPatrick McHardy size_t size; 47838f7b870SPatrick McHardy 47938f7b870SPatrick McHardy if (!ops) 48038f7b870SPatrick McHardy return 0; 48138f7b870SPatrick McHardy 482369cf77aSThomas Graf size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */ 483369cf77aSThomas Graf nla_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */ 48438f7b870SPatrick McHardy 48538f7b870SPatrick McHardy if (ops->get_size) 48638f7b870SPatrick McHardy /* IFLA_INFO_DATA + nested data */ 487369cf77aSThomas Graf size += nla_total_size(sizeof(struct nlattr)) + 48838f7b870SPatrick McHardy ops->get_size(dev); 48938f7b870SPatrick McHardy 49038f7b870SPatrick McHardy if (ops->get_xstats_size) 491369cf77aSThomas Graf /* IFLA_INFO_XSTATS */ 492369cf77aSThomas Graf size += nla_total_size(ops->get_xstats_size(dev)); 49338f7b870SPatrick McHardy 494ba7d49b1SJiri Pirko size += rtnl_link_get_slave_info_data_size(dev); 495ba7d49b1SJiri Pirko 49638f7b870SPatrick McHardy return size; 49738f7b870SPatrick McHardy } 49838f7b870SPatrick McHardy 499f8ff182cSThomas Graf static LIST_HEAD(rtnl_af_ops); 500f8ff182cSThomas Graf 501f8ff182cSThomas Graf static const struct rtnl_af_ops *rtnl_af_lookup(const int family) 502f8ff182cSThomas Graf { 503f8ff182cSThomas Graf const struct rtnl_af_ops *ops; 504f8ff182cSThomas Graf 5055fa85a09SFlorian Westphal list_for_each_entry_rcu(ops, &rtnl_af_ops, list) { 506f8ff182cSThomas Graf if (ops->family == family) 507f8ff182cSThomas Graf return ops; 508f8ff182cSThomas Graf } 509f8ff182cSThomas Graf 510f8ff182cSThomas Graf return NULL; 511f8ff182cSThomas Graf } 512f8ff182cSThomas Graf 513f8ff182cSThomas Graf /** 514f8ff182cSThomas Graf * rtnl_af_register - Register rtnl_af_ops with rtnetlink. 515f8ff182cSThomas Graf * @ops: struct rtnl_af_ops * to register 516f8ff182cSThomas Graf * 517f8ff182cSThomas Graf * Returns 0 on success or a negative error code. 518f8ff182cSThomas Graf */ 5193678a9d8Sstephen hemminger void rtnl_af_register(struct rtnl_af_ops *ops) 520f8ff182cSThomas Graf { 521f8ff182cSThomas Graf rtnl_lock(); 5225fa85a09SFlorian Westphal list_add_tail_rcu(&ops->list, &rtnl_af_ops); 523f8ff182cSThomas Graf rtnl_unlock(); 524f8ff182cSThomas Graf } 525f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_register); 526f8ff182cSThomas Graf 527f8ff182cSThomas Graf /** 528f8ff182cSThomas Graf * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink. 529f8ff182cSThomas Graf * @ops: struct rtnl_af_ops * to unregister 530f8ff182cSThomas Graf */ 531f8ff182cSThomas Graf void rtnl_af_unregister(struct rtnl_af_ops *ops) 532f8ff182cSThomas Graf { 533f8ff182cSThomas Graf rtnl_lock(); 5345fa85a09SFlorian Westphal list_del_rcu(&ops->list); 535f8ff182cSThomas Graf rtnl_unlock(); 5365fa85a09SFlorian Westphal 5375fa85a09SFlorian Westphal synchronize_rcu(); 538f8ff182cSThomas Graf } 539f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_unregister); 540f8ff182cSThomas Graf 541b1974ed0SArad, Ronen static size_t rtnl_link_get_af_size(const struct net_device *dev, 542b1974ed0SArad, Ronen u32 ext_filter_mask) 543f8ff182cSThomas Graf { 544f8ff182cSThomas Graf struct rtnl_af_ops *af_ops; 545f8ff182cSThomas Graf size_t size; 546f8ff182cSThomas Graf 547f8ff182cSThomas Graf /* IFLA_AF_SPEC */ 548f8ff182cSThomas Graf size = nla_total_size(sizeof(struct nlattr)); 549f8ff182cSThomas Graf 5505fa85a09SFlorian Westphal rcu_read_lock(); 5515fa85a09SFlorian Westphal list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 552f8ff182cSThomas Graf if (af_ops->get_link_af_size) { 553f8ff182cSThomas Graf /* AF_* + nested data */ 554f8ff182cSThomas Graf size += nla_total_size(sizeof(struct nlattr)) + 555b1974ed0SArad, Ronen af_ops->get_link_af_size(dev, ext_filter_mask); 556f8ff182cSThomas Graf } 557f8ff182cSThomas Graf } 5585fa85a09SFlorian Westphal rcu_read_unlock(); 559f8ff182cSThomas Graf 560f8ff182cSThomas Graf return size; 561f8ff182cSThomas Graf } 562f8ff182cSThomas Graf 563ba7d49b1SJiri Pirko static bool rtnl_have_link_slave_info(const struct net_device *dev) 564ba7d49b1SJiri Pirko { 565ba7d49b1SJiri Pirko struct net_device *master_dev; 5664c82a95eSFlorian Westphal bool ret = false; 567ba7d49b1SJiri Pirko 5684c82a95eSFlorian Westphal rcu_read_lock(); 5694c82a95eSFlorian Westphal 5704c82a95eSFlorian Westphal master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev); 571813f020cSJiri Pirko if (master_dev && master_dev->rtnl_link_ops) 5724c82a95eSFlorian Westphal ret = true; 5734c82a95eSFlorian Westphal rcu_read_unlock(); 5744c82a95eSFlorian Westphal return ret; 575ba7d49b1SJiri Pirko } 576ba7d49b1SJiri Pirko 577ba7d49b1SJiri Pirko static int rtnl_link_slave_info_fill(struct sk_buff *skb, 578ba7d49b1SJiri Pirko const struct net_device *dev) 579ba7d49b1SJiri Pirko { 580ba7d49b1SJiri Pirko struct net_device *master_dev; 581ba7d49b1SJiri Pirko const struct rtnl_link_ops *ops; 582ba7d49b1SJiri Pirko struct nlattr *slave_data; 583ba7d49b1SJiri Pirko int err; 584ba7d49b1SJiri Pirko 585ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get((struct net_device *) dev); 586ba7d49b1SJiri Pirko if (!master_dev) 587ba7d49b1SJiri Pirko return 0; 588ba7d49b1SJiri Pirko ops = master_dev->rtnl_link_ops; 589ba7d49b1SJiri Pirko if (!ops) 590ba7d49b1SJiri Pirko return 0; 591ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0) 592ba7d49b1SJiri Pirko return -EMSGSIZE; 593ba7d49b1SJiri Pirko if (ops->fill_slave_info) { 594ba7d49b1SJiri Pirko slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA); 595ba7d49b1SJiri Pirko if (!slave_data) 596ba7d49b1SJiri Pirko return -EMSGSIZE; 597ba7d49b1SJiri Pirko err = ops->fill_slave_info(skb, master_dev, dev); 598ba7d49b1SJiri Pirko if (err < 0) 599ba7d49b1SJiri Pirko goto err_cancel_slave_data; 600ba7d49b1SJiri Pirko nla_nest_end(skb, slave_data); 601ba7d49b1SJiri Pirko } 602ba7d49b1SJiri Pirko return 0; 603ba7d49b1SJiri Pirko 604ba7d49b1SJiri Pirko err_cancel_slave_data: 605ba7d49b1SJiri Pirko nla_nest_cancel(skb, slave_data); 606ba7d49b1SJiri Pirko return err; 607ba7d49b1SJiri Pirko } 608ba7d49b1SJiri Pirko 609ba7d49b1SJiri Pirko static int rtnl_link_info_fill(struct sk_buff *skb, 610ba7d49b1SJiri Pirko const struct net_device *dev) 61138f7b870SPatrick McHardy { 61238f7b870SPatrick McHardy const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 613ba7d49b1SJiri Pirko struct nlattr *data; 614ba7d49b1SJiri Pirko int err; 615ba7d49b1SJiri Pirko 616ba7d49b1SJiri Pirko if (!ops) 617ba7d49b1SJiri Pirko return 0; 618ba7d49b1SJiri Pirko if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0) 619ba7d49b1SJiri Pirko return -EMSGSIZE; 620ba7d49b1SJiri Pirko if (ops->fill_xstats) { 621ba7d49b1SJiri Pirko err = ops->fill_xstats(skb, dev); 622ba7d49b1SJiri Pirko if (err < 0) 623ba7d49b1SJiri Pirko return err; 624ba7d49b1SJiri Pirko } 625ba7d49b1SJiri Pirko if (ops->fill_info) { 626ba7d49b1SJiri Pirko data = nla_nest_start(skb, IFLA_INFO_DATA); 627ba7d49b1SJiri Pirko if (data == NULL) 628ba7d49b1SJiri Pirko return -EMSGSIZE; 629ba7d49b1SJiri Pirko err = ops->fill_info(skb, dev); 630ba7d49b1SJiri Pirko if (err < 0) 631ba7d49b1SJiri Pirko goto err_cancel_data; 632ba7d49b1SJiri Pirko nla_nest_end(skb, data); 633ba7d49b1SJiri Pirko } 634ba7d49b1SJiri Pirko return 0; 635ba7d49b1SJiri Pirko 636ba7d49b1SJiri Pirko err_cancel_data: 637ba7d49b1SJiri Pirko nla_nest_cancel(skb, data); 638ba7d49b1SJiri Pirko return err; 639ba7d49b1SJiri Pirko } 640ba7d49b1SJiri Pirko 641ba7d49b1SJiri Pirko static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev) 642ba7d49b1SJiri Pirko { 643ba7d49b1SJiri Pirko struct nlattr *linkinfo; 64438f7b870SPatrick McHardy int err = -EMSGSIZE; 64538f7b870SPatrick McHardy 64638f7b870SPatrick McHardy linkinfo = nla_nest_start(skb, IFLA_LINKINFO); 64738f7b870SPatrick McHardy if (linkinfo == NULL) 64838f7b870SPatrick McHardy goto out; 64938f7b870SPatrick McHardy 650ba7d49b1SJiri Pirko err = rtnl_link_info_fill(skb, dev); 65138f7b870SPatrick McHardy if (err < 0) 65238f7b870SPatrick McHardy goto err_cancel_link; 653ba7d49b1SJiri Pirko 654ba7d49b1SJiri Pirko err = rtnl_link_slave_info_fill(skb, dev); 65538f7b870SPatrick McHardy if (err < 0) 656ba7d49b1SJiri Pirko goto err_cancel_link; 65738f7b870SPatrick McHardy 65838f7b870SPatrick McHardy nla_nest_end(skb, linkinfo); 65938f7b870SPatrick McHardy return 0; 66038f7b870SPatrick McHardy 66138f7b870SPatrick McHardy err_cancel_link: 66238f7b870SPatrick McHardy nla_nest_cancel(skb, linkinfo); 66338f7b870SPatrick McHardy out: 66438f7b870SPatrick McHardy return err; 66538f7b870SPatrick McHardy } 66638f7b870SPatrick McHardy 66795c96174SEric Dumazet int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo) 6681da177e4SLinus Torvalds { 66997c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 6701da177e4SLinus Torvalds int err = 0; 6711da177e4SLinus Torvalds 672ac6d439dSPatrick McHardy NETLINK_CB(skb).dst_group = group; 6731da177e4SLinus Torvalds if (echo) 67463354797SReshetova, Elena refcount_inc(&skb->users); 6751da177e4SLinus Torvalds netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL); 6761da177e4SLinus Torvalds if (echo) 6771da177e4SLinus Torvalds err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT); 6781da177e4SLinus Torvalds return err; 6791da177e4SLinus Torvalds } 6801da177e4SLinus Torvalds 68197c53cacSDenis V. Lunev int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid) 6822942e900SThomas Graf { 68397c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 68497c53cacSDenis V. Lunev 6852942e900SThomas Graf return nlmsg_unicast(rtnl, skb, pid); 6862942e900SThomas Graf } 687e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unicast); 6882942e900SThomas Graf 6891ce85fe4SPablo Neira Ayuso void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group, 69097676b6bSThomas Graf struct nlmsghdr *nlh, gfp_t flags) 69197676b6bSThomas Graf { 69297c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 69397676b6bSThomas Graf int report = 0; 69497676b6bSThomas Graf 69597676b6bSThomas Graf if (nlh) 69697676b6bSThomas Graf report = nlmsg_report(nlh); 69797676b6bSThomas Graf 6981ce85fe4SPablo Neira Ayuso nlmsg_notify(rtnl, skb, pid, group, report, flags); 69997676b6bSThomas Graf } 700e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_notify); 70197676b6bSThomas Graf 70297c53cacSDenis V. Lunev void rtnl_set_sk_err(struct net *net, u32 group, int error) 70397676b6bSThomas Graf { 70497c53cacSDenis V. Lunev struct sock *rtnl = net->rtnl; 70597c53cacSDenis V. Lunev 70697676b6bSThomas Graf netlink_set_err(rtnl, 0, group, error); 70797676b6bSThomas Graf } 708e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_set_sk_err); 70997676b6bSThomas Graf 7101da177e4SLinus Torvalds int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics) 7111da177e4SLinus Torvalds { 7122d7202bfSThomas Graf struct nlattr *mx; 7132d7202bfSThomas Graf int i, valid = 0; 7141da177e4SLinus Torvalds 7152d7202bfSThomas Graf mx = nla_nest_start(skb, RTA_METRICS); 7162d7202bfSThomas Graf if (mx == NULL) 7172d7202bfSThomas Graf return -ENOBUFS; 7182d7202bfSThomas Graf 7191da177e4SLinus Torvalds for (i = 0; i < RTAX_MAX; i++) { 7202d7202bfSThomas Graf if (metrics[i]) { 721ea697639SDaniel Borkmann if (i == RTAX_CC_ALGO - 1) { 722ea697639SDaniel Borkmann char tmp[TCP_CA_NAME_MAX], *name; 723ea697639SDaniel Borkmann 724ea697639SDaniel Borkmann name = tcp_ca_get_name_by_key(metrics[i], tmp); 725ea697639SDaniel Borkmann if (!name) 726ea697639SDaniel Borkmann continue; 727ea697639SDaniel Borkmann if (nla_put_string(skb, i + 1, name)) 728ea697639SDaniel Borkmann goto nla_put_failure; 729c3a8d947SDaniel Borkmann } else if (i == RTAX_FEATURES - 1) { 730c3a8d947SDaniel Borkmann u32 user_features = metrics[i] & RTAX_FEATURE_MASK; 731c3a8d947SDaniel Borkmann 732f8edcd12SPhil Sutter if (!user_features) 733f8edcd12SPhil Sutter continue; 734c3a8d947SDaniel Borkmann BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK); 735c3a8d947SDaniel Borkmann if (nla_put_u32(skb, i + 1, user_features)) 736c3a8d947SDaniel Borkmann goto nla_put_failure; 737ea697639SDaniel Borkmann } else { 738a6574349SDavid S. Miller if (nla_put_u32(skb, i + 1, metrics[i])) 739a6574349SDavid S. Miller goto nla_put_failure; 7401da177e4SLinus Torvalds } 741ea697639SDaniel Borkmann valid++; 742ea697639SDaniel Borkmann } 7432d7202bfSThomas Graf } 7441da177e4SLinus Torvalds 745a57d27fcSDavid S. Miller if (!valid) { 746a57d27fcSDavid S. Miller nla_nest_cancel(skb, mx); 747a57d27fcSDavid S. Miller return 0; 748a57d27fcSDavid S. Miller } 7492d7202bfSThomas Graf 7502d7202bfSThomas Graf return nla_nest_end(skb, mx); 7512d7202bfSThomas Graf 7522d7202bfSThomas Graf nla_put_failure: 753bc3ed28cSThomas Graf nla_nest_cancel(skb, mx); 754bc3ed28cSThomas Graf return -EMSGSIZE; 7551da177e4SLinus Torvalds } 756e0d087afSEric Dumazet EXPORT_SYMBOL(rtnetlink_put_metrics); 7571da177e4SLinus Torvalds 758e3703b3dSThomas Graf int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id, 75987a50699SDavid S. Miller long expires, u32 error) 760e3703b3dSThomas Graf { 761e3703b3dSThomas Graf struct rta_cacheinfo ci = { 762a399a805SEric Dumazet .rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse), 763e3703b3dSThomas Graf .rta_used = dst->__use, 764e3703b3dSThomas Graf .rta_clntref = atomic_read(&(dst->__refcnt)), 765e3703b3dSThomas Graf .rta_error = error, 766e3703b3dSThomas Graf .rta_id = id, 767e3703b3dSThomas Graf }; 768e3703b3dSThomas Graf 7698253947eSLi Wei if (expires) { 7708253947eSLi Wei unsigned long clock; 771e3703b3dSThomas Graf 7728253947eSLi Wei clock = jiffies_to_clock_t(abs(expires)); 7738253947eSLi Wei clock = min_t(unsigned long, clock, INT_MAX); 7748253947eSLi Wei ci.rta_expires = (expires > 0) ? clock : -clock; 7758253947eSLi Wei } 776e3703b3dSThomas Graf return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci); 777e3703b3dSThomas Graf } 778e3703b3dSThomas Graf EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo); 7791da177e4SLinus Torvalds 78093b2d4a2SDavid S. Miller static void set_operstate(struct net_device *dev, unsigned char transition) 781b00055aaSStefan Rompf { 782b00055aaSStefan Rompf unsigned char operstate = dev->operstate; 783b00055aaSStefan Rompf 784b00055aaSStefan Rompf switch (transition) { 785b00055aaSStefan Rompf case IF_OPER_UP: 786b00055aaSStefan Rompf if ((operstate == IF_OPER_DORMANT || 787b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) && 788b00055aaSStefan Rompf !netif_dormant(dev)) 789b00055aaSStefan Rompf operstate = IF_OPER_UP; 790b00055aaSStefan Rompf break; 791b00055aaSStefan Rompf 792b00055aaSStefan Rompf case IF_OPER_DORMANT: 793b00055aaSStefan Rompf if (operstate == IF_OPER_UP || 794b00055aaSStefan Rompf operstate == IF_OPER_UNKNOWN) 795b00055aaSStefan Rompf operstate = IF_OPER_DORMANT; 796b00055aaSStefan Rompf break; 7973ff50b79SStephen Hemminger } 798b00055aaSStefan Rompf 799b00055aaSStefan Rompf if (dev->operstate != operstate) { 800b00055aaSStefan Rompf write_lock_bh(&dev_base_lock); 801b00055aaSStefan Rompf dev->operstate = operstate; 802b00055aaSStefan Rompf write_unlock_bh(&dev_base_lock); 803b00055aaSStefan Rompf netdev_state_change(dev); 80493b2d4a2SDavid S. Miller } 805b00055aaSStefan Rompf } 806b00055aaSStefan Rompf 807b1beb681SJiri Benc static unsigned int rtnl_dev_get_flags(const struct net_device *dev) 808b1beb681SJiri Benc { 809b1beb681SJiri Benc return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) | 810b1beb681SJiri Benc (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI)); 811b1beb681SJiri Benc } 812b1beb681SJiri Benc 8133729d502SPatrick McHardy static unsigned int rtnl_dev_combine_flags(const struct net_device *dev, 8143729d502SPatrick McHardy const struct ifinfomsg *ifm) 8153729d502SPatrick McHardy { 8163729d502SPatrick McHardy unsigned int flags = ifm->ifi_flags; 8173729d502SPatrick McHardy 8183729d502SPatrick McHardy /* bugwards compatibility: ifi_change == 0 is treated as ~0 */ 8193729d502SPatrick McHardy if (ifm->ifi_change) 8203729d502SPatrick McHardy flags = (flags & ifm->ifi_change) | 821b1beb681SJiri Benc (rtnl_dev_get_flags(dev) & ~ifm->ifi_change); 8223729d502SPatrick McHardy 8233729d502SPatrick McHardy return flags; 8243729d502SPatrick McHardy } 8253729d502SPatrick McHardy 826b60c5115SThomas Graf static void copy_rtnl_link_stats(struct rtnl_link_stats *a, 827be1f3c2cSBen Hutchings const struct rtnl_link_stats64 *b) 8281da177e4SLinus Torvalds { 829b60c5115SThomas Graf a->rx_packets = b->rx_packets; 830b60c5115SThomas Graf a->tx_packets = b->tx_packets; 831b60c5115SThomas Graf a->rx_bytes = b->rx_bytes; 832b60c5115SThomas Graf a->tx_bytes = b->tx_bytes; 833b60c5115SThomas Graf a->rx_errors = b->rx_errors; 834b60c5115SThomas Graf a->tx_errors = b->tx_errors; 835b60c5115SThomas Graf a->rx_dropped = b->rx_dropped; 836b60c5115SThomas Graf a->tx_dropped = b->tx_dropped; 837b60c5115SThomas Graf 838b60c5115SThomas Graf a->multicast = b->multicast; 839b60c5115SThomas Graf a->collisions = b->collisions; 840b60c5115SThomas Graf 841b60c5115SThomas Graf a->rx_length_errors = b->rx_length_errors; 842b60c5115SThomas Graf a->rx_over_errors = b->rx_over_errors; 843b60c5115SThomas Graf a->rx_crc_errors = b->rx_crc_errors; 844b60c5115SThomas Graf a->rx_frame_errors = b->rx_frame_errors; 845b60c5115SThomas Graf a->rx_fifo_errors = b->rx_fifo_errors; 846b60c5115SThomas Graf a->rx_missed_errors = b->rx_missed_errors; 847b60c5115SThomas Graf 848b60c5115SThomas Graf a->tx_aborted_errors = b->tx_aborted_errors; 849b60c5115SThomas Graf a->tx_carrier_errors = b->tx_carrier_errors; 850b60c5115SThomas Graf a->tx_fifo_errors = b->tx_fifo_errors; 851b60c5115SThomas Graf a->tx_heartbeat_errors = b->tx_heartbeat_errors; 852b60c5115SThomas Graf a->tx_window_errors = b->tx_window_errors; 853b60c5115SThomas Graf 854b60c5115SThomas Graf a->rx_compressed = b->rx_compressed; 855b60c5115SThomas Graf a->tx_compressed = b->tx_compressed; 8566e7333d3SJarod Wilson 8576e7333d3SJarod Wilson a->rx_nohandler = b->rx_nohandler; 85810708f37SJan Engelhardt } 85910708f37SJan Engelhardt 860c02db8c6SChris Wright /* All VF info */ 861115c9b81SGreg Rose static inline int rtnl_vfinfo_size(const struct net_device *dev, 862115c9b81SGreg Rose u32 ext_filter_mask) 863ebc08a6fSWilliams, Mitch A { 8649af15c38SPhil Sutter if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) { 865c02db8c6SChris Wright int num_vfs = dev_num_vf(dev->dev.parent); 8667e75f74aSSabrina Dubroca size_t size = nla_total_size(0); 867045de01aSScott Feldman size += num_vfs * 8687e75f74aSSabrina Dubroca (nla_total_size(0) + 8697e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_mac)) + 8707e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_vlan)) + 8717e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */ 87279aab093SMoshe Shemesh nla_total_size(MAX_VLAN_LIST_LEN * 87379aab093SMoshe Shemesh sizeof(struct ifla_vf_vlan_info)) + 874ed616689SSucheta Chakraborty nla_total_size(sizeof(struct ifla_vf_spoofchk)) + 8757e75f74aSSabrina Dubroca nla_total_size(sizeof(struct ifla_vf_tx_rate)) + 876945a3676SJiri Benc nla_total_size(sizeof(struct ifla_vf_rate)) + 87701a3d796SVlad Zolotarov nla_total_size(sizeof(struct ifla_vf_link_state)) + 8783b766cd8SEran Ben Elisha nla_total_size(sizeof(struct ifla_vf_rss_query_en)) + 8797e75f74aSSabrina Dubroca nla_total_size(0) + /* nest IFLA_VF_STATS */ 8803b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_PACKETS */ 881343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8823b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_PACKETS */ 883343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8843b766cd8SEran Ben Elisha /* IFLA_VF_STATS_RX_BYTES */ 885343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8863b766cd8SEran Ben Elisha /* IFLA_VF_STATS_TX_BYTES */ 887343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8883b766cd8SEran Ben Elisha /* IFLA_VF_STATS_BROADCAST */ 889343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 8903b766cd8SEran Ben Elisha /* IFLA_VF_STATS_MULTICAST */ 891343a6d8eSNicolas Dichtel nla_total_size_64bit(sizeof(__u64)) + 892dd461d6aSHiroshi Shimamoto nla_total_size(sizeof(struct ifla_vf_trust))); 893c02db8c6SChris Wright return size; 894c02db8c6SChris Wright } else 895ebc08a6fSWilliams, Mitch A return 0; 896ebc08a6fSWilliams, Mitch A } 897ebc08a6fSWilliams, Mitch A 898c53864fdSDavid Gibson static size_t rtnl_port_size(const struct net_device *dev, 899c53864fdSDavid Gibson u32 ext_filter_mask) 90057b61080SScott Feldman { 90157b61080SScott Feldman size_t port_size = nla_total_size(4) /* PORT_VF */ 90257b61080SScott Feldman + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ 90357b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ 90457b61080SScott Feldman + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ 90557b61080SScott Feldman + nla_total_size(1) /* PROT_VDP_REQUEST */ 90657b61080SScott Feldman + nla_total_size(2); /* PORT_VDP_RESPONSE */ 90757b61080SScott Feldman size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); 90857b61080SScott Feldman size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) 90957b61080SScott Feldman + port_size; 91057b61080SScott Feldman size_t port_self_size = nla_total_size(sizeof(struct nlattr)) 91157b61080SScott Feldman + port_size; 91257b61080SScott Feldman 913c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 914c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 91557b61080SScott Feldman return 0; 91657b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) 91757b61080SScott Feldman return port_self_size + vf_ports_size + 91857b61080SScott Feldman vf_port_size * dev_num_vf(dev->dev.parent); 91957b61080SScott Feldman else 92057b61080SScott Feldman return port_self_size; 92157b61080SScott Feldman } 92257b61080SScott Feldman 923b5cdae32SDavid S. Miller static size_t rtnl_xdp_size(void) 924d1fdd913SBrenden Blanco { 925b3cfaa31SSabrina Dubroca size_t xdp_size = nla_total_size(0) + /* nest IFLA_XDP */ 92658038695SMartin KaFai Lau nla_total_size(1) + /* XDP_ATTACHED */ 92758038695SMartin KaFai Lau nla_total_size(4); /* XDP_PROG_ID */ 928d1fdd913SBrenden Blanco 929d1fdd913SBrenden Blanco return xdp_size; 930d1fdd913SBrenden Blanco } 931d1fdd913SBrenden Blanco 932115c9b81SGreg Rose static noinline size_t if_nlmsg_size(const struct net_device *dev, 933115c9b81SGreg Rose u32 ext_filter_mask) 934339bf98fSThomas Graf { 935339bf98fSThomas Graf return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 936339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 9370b815a1aSStephen Hemminger + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ 938339bf98fSThomas Graf + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ 939270cb4d0SNicolas Dichtel + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap)) 940339bf98fSThomas Graf + nla_total_size(sizeof(struct rtnl_link_stats)) 94135c58459SDavid S. Miller + nla_total_size_64bit(sizeof(struct rtnl_link_stats64)) 942339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 943339bf98fSThomas Graf + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ 944339bf98fSThomas Graf + nla_total_size(4) /* IFLA_TXQLEN */ 945339bf98fSThomas Graf + nla_total_size(4) /* IFLA_WEIGHT */ 946339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MTU */ 947339bf98fSThomas Graf + nla_total_size(4) /* IFLA_LINK */ 948339bf98fSThomas Graf + nla_total_size(4) /* IFLA_MASTER */ 9499a57247fSJiri Pirko + nla_total_size(1) /* IFLA_CARRIER */ 950edbc0bb3SBen Greear + nla_total_size(4) /* IFLA_PROMISCUITY */ 95176ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */ 95276ff5cc9SJiri Pirko + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */ 9536919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */ 9546919756cSTobias Klauser + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */ 955339bf98fSThomas Graf + nla_total_size(1) /* IFLA_OPERSTATE */ 95638f7b870SPatrick McHardy + nla_total_size(1) /* IFLA_LINKMODE */ 9572d3b479dSdavid decotigny + nla_total_size(4) /* IFLA_CARRIER_CHANGES */ 958d37512a2SNicolas Dichtel + nla_total_size(4) /* IFLA_LINK_NETNSID */ 959db833d40SSerhey Popovych + nla_total_size(4) /* IFLA_GROUP */ 960115c9b81SGreg Rose + nla_total_size(ext_filter_mask 961115c9b81SGreg Rose & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */ 962115c9b81SGreg Rose + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */ 963c53864fdSDavid Gibson + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ 964f8ff182cSThomas Graf + rtnl_link_get_size(dev) /* IFLA_LINKINFO */ 965b1974ed0SArad, Ronen + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */ 96682f28412SJiri Pirko + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */ 96788d6378bSAnuradha Karuppiah + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */ 968c57c7a95SNicolas Dichtel + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */ 969b5cdae32SDavid S. Miller + rtnl_xdp_size() /* IFLA_XDP */ 9703d3ea5afSVlad Yasevich + nla_total_size(4) /* IFLA_EVENT */ 9716621dd29SNicolas Dichtel + nla_total_size(4) /* IFLA_NEW_NETNSID */ 97203ac738dSColin Ian King + nla_total_size(1) /* IFLA_PROTO_DOWN */ 97379e1ad14SJiri Benc + nla_total_size(4) /* IFLA_IF_NETNSID */ 97479e1ad14SJiri Benc + 0; 975339bf98fSThomas Graf } 976339bf98fSThomas Graf 97757b61080SScott Feldman static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) 97857b61080SScott Feldman { 97957b61080SScott Feldman struct nlattr *vf_ports; 98057b61080SScott Feldman struct nlattr *vf_port; 98157b61080SScott Feldman int vf; 98257b61080SScott Feldman int err; 98357b61080SScott Feldman 98457b61080SScott Feldman vf_ports = nla_nest_start(skb, IFLA_VF_PORTS); 98557b61080SScott Feldman if (!vf_ports) 98657b61080SScott Feldman return -EMSGSIZE; 98757b61080SScott Feldman 98857b61080SScott Feldman for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { 98957b61080SScott Feldman vf_port = nla_nest_start(skb, IFLA_VF_PORT); 9908ca94183SScott Feldman if (!vf_port) 9918ca94183SScott Feldman goto nla_put_failure; 992a6574349SDavid S. Miller if (nla_put_u32(skb, IFLA_PORT_VF, vf)) 993a6574349SDavid S. Miller goto nla_put_failure; 99457b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); 9958ca94183SScott Feldman if (err == -EMSGSIZE) 9968ca94183SScott Feldman goto nla_put_failure; 99757b61080SScott Feldman if (err) { 99857b61080SScott Feldman nla_nest_cancel(skb, vf_port); 99957b61080SScott Feldman continue; 100057b61080SScott Feldman } 100157b61080SScott Feldman nla_nest_end(skb, vf_port); 100257b61080SScott Feldman } 100357b61080SScott Feldman 100457b61080SScott Feldman nla_nest_end(skb, vf_ports); 100557b61080SScott Feldman 100657b61080SScott Feldman return 0; 10078ca94183SScott Feldman 10088ca94183SScott Feldman nla_put_failure: 10098ca94183SScott Feldman nla_nest_cancel(skb, vf_ports); 10108ca94183SScott Feldman return -EMSGSIZE; 101157b61080SScott Feldman } 101257b61080SScott Feldman 101357b61080SScott Feldman static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) 101457b61080SScott Feldman { 101557b61080SScott Feldman struct nlattr *port_self; 101657b61080SScott Feldman int err; 101757b61080SScott Feldman 101857b61080SScott Feldman port_self = nla_nest_start(skb, IFLA_PORT_SELF); 101957b61080SScott Feldman if (!port_self) 102057b61080SScott Feldman return -EMSGSIZE; 102157b61080SScott Feldman 102257b61080SScott Feldman err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); 102357b61080SScott Feldman if (err) { 102457b61080SScott Feldman nla_nest_cancel(skb, port_self); 10258ca94183SScott Feldman return (err == -EMSGSIZE) ? err : 0; 102657b61080SScott Feldman } 102757b61080SScott Feldman 102857b61080SScott Feldman nla_nest_end(skb, port_self); 102957b61080SScott Feldman 103057b61080SScott Feldman return 0; 103157b61080SScott Feldman } 103257b61080SScott Feldman 1033c53864fdSDavid Gibson static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev, 1034c53864fdSDavid Gibson u32 ext_filter_mask) 103557b61080SScott Feldman { 103657b61080SScott Feldman int err; 103757b61080SScott Feldman 1038c53864fdSDavid Gibson if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent || 1039c53864fdSDavid Gibson !(ext_filter_mask & RTEXT_FILTER_VF)) 104057b61080SScott Feldman return 0; 104157b61080SScott Feldman 104257b61080SScott Feldman err = rtnl_port_self_fill(skb, dev); 104357b61080SScott Feldman if (err) 104457b61080SScott Feldman return err; 104557b61080SScott Feldman 104657b61080SScott Feldman if (dev_num_vf(dev->dev.parent)) { 104757b61080SScott Feldman err = rtnl_vf_ports_fill(skb, dev); 104857b61080SScott Feldman if (err) 104957b61080SScott Feldman return err; 105057b61080SScott Feldman } 105157b61080SScott Feldman 105257b61080SScott Feldman return 0; 105357b61080SScott Feldman } 105457b61080SScott Feldman 105566cae9edSJiri Pirko static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev) 105666cae9edSJiri Pirko { 105766cae9edSJiri Pirko int err; 105802637fceSJiri Pirko struct netdev_phys_item_id ppid; 105966cae9edSJiri Pirko 106066cae9edSJiri Pirko err = dev_get_phys_port_id(dev, &ppid); 106166cae9edSJiri Pirko if (err) { 106266cae9edSJiri Pirko if (err == -EOPNOTSUPP) 106366cae9edSJiri Pirko return 0; 106466cae9edSJiri Pirko return err; 106566cae9edSJiri Pirko } 106666cae9edSJiri Pirko 106766cae9edSJiri Pirko if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id)) 106866cae9edSJiri Pirko return -EMSGSIZE; 106966cae9edSJiri Pirko 107066cae9edSJiri Pirko return 0; 107166cae9edSJiri Pirko } 107266cae9edSJiri Pirko 1073db24a904SDavid Ahern static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev) 1074db24a904SDavid Ahern { 1075db24a904SDavid Ahern char name[IFNAMSIZ]; 1076db24a904SDavid Ahern int err; 1077db24a904SDavid Ahern 1078db24a904SDavid Ahern err = dev_get_phys_port_name(dev, name, sizeof(name)); 1079db24a904SDavid Ahern if (err) { 1080db24a904SDavid Ahern if (err == -EOPNOTSUPP) 1081db24a904SDavid Ahern return 0; 1082db24a904SDavid Ahern return err; 1083db24a904SDavid Ahern } 1084db24a904SDavid Ahern 108577ef033bSMichal Schmidt if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name)) 1086db24a904SDavid Ahern return -EMSGSIZE; 1087db24a904SDavid Ahern 1088db24a904SDavid Ahern return 0; 1089db24a904SDavid Ahern } 1090db24a904SDavid Ahern 109182f28412SJiri Pirko static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev) 109282f28412SJiri Pirko { 109382f28412SJiri Pirko int err; 1094f8e20a9fSScott Feldman struct switchdev_attr attr = { 10956ff64f6fSIdo Schimmel .orig_dev = dev, 10961f868398SJiri Pirko .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID, 1097f8e20a9fSScott Feldman .flags = SWITCHDEV_F_NO_RECURSE, 1098f8e20a9fSScott Feldman }; 109982f28412SJiri Pirko 1100f8e20a9fSScott Feldman err = switchdev_port_attr_get(dev, &attr); 110182f28412SJiri Pirko if (err) { 110282f28412SJiri Pirko if (err == -EOPNOTSUPP) 110382f28412SJiri Pirko return 0; 110482f28412SJiri Pirko return err; 110582f28412SJiri Pirko } 110682f28412SJiri Pirko 110742275bd8SScott Feldman if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len, 110842275bd8SScott Feldman attr.u.ppid.id)) 110982f28412SJiri Pirko return -EMSGSIZE; 111082f28412SJiri Pirko 111182f28412SJiri Pirko return 0; 111282f28412SJiri Pirko } 111382f28412SJiri Pirko 1114b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb, 1115b22b941bSHannes Frederic Sowa struct net_device *dev) 1116b22b941bSHannes Frederic Sowa { 1117550bce59SRoopa Prabhu struct rtnl_link_stats64 *sp; 1118b22b941bSHannes Frederic Sowa struct nlattr *attr; 1119b22b941bSHannes Frederic Sowa 112058414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS64, 112158414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), IFLA_PAD); 1122b22b941bSHannes Frederic Sowa if (!attr) 1123b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1124b22b941bSHannes Frederic Sowa 1125550bce59SRoopa Prabhu sp = nla_data(attr); 1126550bce59SRoopa Prabhu dev_get_stats(dev, sp); 1127550bce59SRoopa Prabhu 1128550bce59SRoopa Prabhu attr = nla_reserve(skb, IFLA_STATS, 1129550bce59SRoopa Prabhu sizeof(struct rtnl_link_stats)); 1130550bce59SRoopa Prabhu if (!attr) 1131550bce59SRoopa Prabhu return -EMSGSIZE; 1132550bce59SRoopa Prabhu 1133550bce59SRoopa Prabhu copy_rtnl_link_stats(nla_data(attr), sp); 1134b22b941bSHannes Frederic Sowa 1135b22b941bSHannes Frederic Sowa return 0; 1136b22b941bSHannes Frederic Sowa } 1137b22b941bSHannes Frederic Sowa 1138b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb, 1139b22b941bSHannes Frederic Sowa struct net_device *dev, 1140b22b941bSHannes Frederic Sowa int vfs_num, 1141b22b941bSHannes Frederic Sowa struct nlattr *vfinfo) 1142b22b941bSHannes Frederic Sowa { 1143b22b941bSHannes Frederic Sowa struct ifla_vf_rss_query_en vf_rss_query_en; 114479aab093SMoshe Shemesh struct nlattr *vf, *vfstats, *vfvlanlist; 1145b22b941bSHannes Frederic Sowa struct ifla_vf_link_state vf_linkstate; 114679aab093SMoshe Shemesh struct ifla_vf_vlan_info vf_vlan_info; 1147b22b941bSHannes Frederic Sowa struct ifla_vf_spoofchk vf_spoofchk; 1148b22b941bSHannes Frederic Sowa struct ifla_vf_tx_rate vf_tx_rate; 1149b22b941bSHannes Frederic Sowa struct ifla_vf_stats vf_stats; 1150b22b941bSHannes Frederic Sowa struct ifla_vf_trust vf_trust; 1151b22b941bSHannes Frederic Sowa struct ifla_vf_vlan vf_vlan; 1152b22b941bSHannes Frederic Sowa struct ifla_vf_rate vf_rate; 1153b22b941bSHannes Frederic Sowa struct ifla_vf_mac vf_mac; 1154b22b941bSHannes Frederic Sowa struct ifla_vf_info ivi; 1155b22b941bSHannes Frederic Sowa 11560eed9cf5SMintz, Yuval memset(&ivi, 0, sizeof(ivi)); 11570eed9cf5SMintz, Yuval 1158b22b941bSHannes Frederic Sowa /* Not all SR-IOV capable drivers support the 1159b22b941bSHannes Frederic Sowa * spoofcheck and "RSS query enable" query. Preset to 1160b22b941bSHannes Frederic Sowa * -1 so the user space tool can detect that the driver 1161b22b941bSHannes Frederic Sowa * didn't report anything. 1162b22b941bSHannes Frederic Sowa */ 1163b22b941bSHannes Frederic Sowa ivi.spoofchk = -1; 1164b22b941bSHannes Frederic Sowa ivi.rss_query_en = -1; 1165b22b941bSHannes Frederic Sowa ivi.trusted = -1; 1166b22b941bSHannes Frederic Sowa /* The default value for VF link state is "auto" 1167b22b941bSHannes Frederic Sowa * IFLA_VF_LINK_STATE_AUTO which equals zero 1168b22b941bSHannes Frederic Sowa */ 1169b22b941bSHannes Frederic Sowa ivi.linkstate = 0; 117079aab093SMoshe Shemesh /* VLAN Protocol by default is 802.1Q */ 117179aab093SMoshe Shemesh ivi.vlan_proto = htons(ETH_P_8021Q); 1172b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi)) 1173b22b941bSHannes Frederic Sowa return 0; 1174b22b941bSHannes Frederic Sowa 1175775f4f05SDan Carpenter memset(&vf_vlan_info, 0, sizeof(vf_vlan_info)); 1176775f4f05SDan Carpenter 1177b22b941bSHannes Frederic Sowa vf_mac.vf = 1178b22b941bSHannes Frederic Sowa vf_vlan.vf = 117979aab093SMoshe Shemesh vf_vlan_info.vf = 1180b22b941bSHannes Frederic Sowa vf_rate.vf = 1181b22b941bSHannes Frederic Sowa vf_tx_rate.vf = 1182b22b941bSHannes Frederic Sowa vf_spoofchk.vf = 1183b22b941bSHannes Frederic Sowa vf_linkstate.vf = 1184b22b941bSHannes Frederic Sowa vf_rss_query_en.vf = 1185b22b941bSHannes Frederic Sowa vf_trust.vf = ivi.vf; 1186b22b941bSHannes Frederic Sowa 1187b22b941bSHannes Frederic Sowa memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); 1188b22b941bSHannes Frederic Sowa vf_vlan.vlan = ivi.vlan; 1189b22b941bSHannes Frederic Sowa vf_vlan.qos = ivi.qos; 119079aab093SMoshe Shemesh vf_vlan_info.vlan = ivi.vlan; 119179aab093SMoshe Shemesh vf_vlan_info.qos = ivi.qos; 119279aab093SMoshe Shemesh vf_vlan_info.vlan_proto = ivi.vlan_proto; 1193b22b941bSHannes Frederic Sowa vf_tx_rate.rate = ivi.max_tx_rate; 1194b22b941bSHannes Frederic Sowa vf_rate.min_tx_rate = ivi.min_tx_rate; 1195b22b941bSHannes Frederic Sowa vf_rate.max_tx_rate = ivi.max_tx_rate; 1196b22b941bSHannes Frederic Sowa vf_spoofchk.setting = ivi.spoofchk; 1197b22b941bSHannes Frederic Sowa vf_linkstate.link_state = ivi.linkstate; 1198b22b941bSHannes Frederic Sowa vf_rss_query_en.setting = ivi.rss_query_en; 1199b22b941bSHannes Frederic Sowa vf_trust.setting = ivi.trusted; 1200b22b941bSHannes Frederic Sowa vf = nla_nest_start(skb, IFLA_VF_INFO); 120179aab093SMoshe Shemesh if (!vf) 120279aab093SMoshe Shemesh goto nla_put_vfinfo_failure; 1203b22b941bSHannes Frederic Sowa if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) || 1204b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) || 1205b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate), 1206b22b941bSHannes Frederic Sowa &vf_rate) || 1207b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), 1208b22b941bSHannes Frederic Sowa &vf_tx_rate) || 1209b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk), 1210b22b941bSHannes Frederic Sowa &vf_spoofchk) || 1211b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate), 1212b22b941bSHannes Frederic Sowa &vf_linkstate) || 1213b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_RSS_QUERY_EN, 1214b22b941bSHannes Frederic Sowa sizeof(vf_rss_query_en), 1215b22b941bSHannes Frederic Sowa &vf_rss_query_en) || 1216b22b941bSHannes Frederic Sowa nla_put(skb, IFLA_VF_TRUST, 1217b22b941bSHannes Frederic Sowa sizeof(vf_trust), &vf_trust)) 121879aab093SMoshe Shemesh goto nla_put_vf_failure; 121979aab093SMoshe Shemesh vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST); 122079aab093SMoshe Shemesh if (!vfvlanlist) 122179aab093SMoshe Shemesh goto nla_put_vf_failure; 122279aab093SMoshe Shemesh if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info), 122379aab093SMoshe Shemesh &vf_vlan_info)) { 122479aab093SMoshe Shemesh nla_nest_cancel(skb, vfvlanlist); 122579aab093SMoshe Shemesh goto nla_put_vf_failure; 122679aab093SMoshe Shemesh } 122779aab093SMoshe Shemesh nla_nest_end(skb, vfvlanlist); 1228b22b941bSHannes Frederic Sowa memset(&vf_stats, 0, sizeof(vf_stats)); 1229b22b941bSHannes Frederic Sowa if (dev->netdev_ops->ndo_get_vf_stats) 1230b22b941bSHannes Frederic Sowa dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num, 1231b22b941bSHannes Frederic Sowa &vf_stats); 1232b22b941bSHannes Frederic Sowa vfstats = nla_nest_start(skb, IFLA_VF_STATS); 123379aab093SMoshe Shemesh if (!vfstats) 123479aab093SMoshe Shemesh goto nla_put_vf_failure; 1235343a6d8eSNicolas Dichtel if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS, 1236343a6d8eSNicolas Dichtel vf_stats.rx_packets, IFLA_VF_STATS_PAD) || 1237343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS, 1238343a6d8eSNicolas Dichtel vf_stats.tx_packets, IFLA_VF_STATS_PAD) || 1239343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES, 1240343a6d8eSNicolas Dichtel vf_stats.rx_bytes, IFLA_VF_STATS_PAD) || 1241343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES, 1242343a6d8eSNicolas Dichtel vf_stats.tx_bytes, IFLA_VF_STATS_PAD) || 1243343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST, 1244343a6d8eSNicolas Dichtel vf_stats.broadcast, IFLA_VF_STATS_PAD) || 1245343a6d8eSNicolas Dichtel nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST, 124679aab093SMoshe Shemesh vf_stats.multicast, IFLA_VF_STATS_PAD)) { 124779aab093SMoshe Shemesh nla_nest_cancel(skb, vfstats); 124879aab093SMoshe Shemesh goto nla_put_vf_failure; 124979aab093SMoshe Shemesh } 1250b22b941bSHannes Frederic Sowa nla_nest_end(skb, vfstats); 1251b22b941bSHannes Frederic Sowa nla_nest_end(skb, vf); 1252b22b941bSHannes Frederic Sowa return 0; 125379aab093SMoshe Shemesh 125479aab093SMoshe Shemesh nla_put_vf_failure: 125579aab093SMoshe Shemesh nla_nest_cancel(skb, vf); 125679aab093SMoshe Shemesh nla_put_vfinfo_failure: 125779aab093SMoshe Shemesh nla_nest_cancel(skb, vfinfo); 125879aab093SMoshe Shemesh return -EMSGSIZE; 1259b22b941bSHannes Frederic Sowa } 1260b22b941bSHannes Frederic Sowa 1261250fc3dfSFlorian Westphal static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb, 1262250fc3dfSFlorian Westphal struct net_device *dev, 1263250fc3dfSFlorian Westphal u32 ext_filter_mask) 1264250fc3dfSFlorian Westphal { 1265250fc3dfSFlorian Westphal struct nlattr *vfinfo; 1266250fc3dfSFlorian Westphal int i, num_vfs; 1267250fc3dfSFlorian Westphal 1268250fc3dfSFlorian Westphal if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0)) 1269250fc3dfSFlorian Westphal return 0; 1270250fc3dfSFlorian Westphal 1271250fc3dfSFlorian Westphal num_vfs = dev_num_vf(dev->dev.parent); 1272250fc3dfSFlorian Westphal if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs)) 1273250fc3dfSFlorian Westphal return -EMSGSIZE; 1274250fc3dfSFlorian Westphal 1275250fc3dfSFlorian Westphal if (!dev->netdev_ops->ndo_get_vf_config) 1276250fc3dfSFlorian Westphal return 0; 1277250fc3dfSFlorian Westphal 1278250fc3dfSFlorian Westphal vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST); 1279250fc3dfSFlorian Westphal if (!vfinfo) 1280250fc3dfSFlorian Westphal return -EMSGSIZE; 1281250fc3dfSFlorian Westphal 1282250fc3dfSFlorian Westphal for (i = 0; i < num_vfs; i++) { 1283250fc3dfSFlorian Westphal if (rtnl_fill_vfinfo(skb, dev, i, vfinfo)) 1284250fc3dfSFlorian Westphal return -EMSGSIZE; 1285250fc3dfSFlorian Westphal } 1286250fc3dfSFlorian Westphal 1287250fc3dfSFlorian Westphal nla_nest_end(skb, vfinfo); 1288250fc3dfSFlorian Westphal return 0; 1289250fc3dfSFlorian Westphal } 1290250fc3dfSFlorian Westphal 1291b22b941bSHannes Frederic Sowa static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev) 1292b22b941bSHannes Frederic Sowa { 12935f8e4474SKangjie Lu struct rtnl_link_ifmap map; 12945f8e4474SKangjie Lu 12955f8e4474SKangjie Lu memset(&map, 0, sizeof(map)); 12965f8e4474SKangjie Lu map.mem_start = dev->mem_start; 12975f8e4474SKangjie Lu map.mem_end = dev->mem_end; 12985f8e4474SKangjie Lu map.base_addr = dev->base_addr; 12995f8e4474SKangjie Lu map.irq = dev->irq; 13005f8e4474SKangjie Lu map.dma = dev->dma; 13015f8e4474SKangjie Lu map.port = dev->if_port; 13025f8e4474SKangjie Lu 1303270cb4d0SNicolas Dichtel if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD)) 1304b22b941bSHannes Frederic Sowa return -EMSGSIZE; 1305b22b941bSHannes Frederic Sowa 1306b22b941bSHannes Frederic Sowa return 0; 1307b22b941bSHannes Frederic Sowa } 1308b22b941bSHannes Frederic Sowa 130958038695SMartin KaFai Lau static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id) 1310d67b9cd2SDaniel Borkmann { 1311d67b9cd2SDaniel Borkmann const struct net_device_ops *ops = dev->netdev_ops; 131258038695SMartin KaFai Lau const struct bpf_prog *generic_xdp_prog; 1313d67b9cd2SDaniel Borkmann 1314d67b9cd2SDaniel Borkmann ASSERT_RTNL(); 1315d67b9cd2SDaniel Borkmann 131658038695SMartin KaFai Lau *prog_id = 0; 131758038695SMartin KaFai Lau generic_xdp_prog = rtnl_dereference(dev->xdp_prog); 131858038695SMartin KaFai Lau if (generic_xdp_prog) { 131958038695SMartin KaFai Lau *prog_id = generic_xdp_prog->aux->id; 1320d67b9cd2SDaniel Borkmann return XDP_ATTACHED_SKB; 132158038695SMartin KaFai Lau } 1322f4e63525SJakub Kicinski if (!ops->ndo_bpf) 1323d67b9cd2SDaniel Borkmann return XDP_ATTACHED_NONE; 1324ce158e58SJakub Kicinski 1325f4e63525SJakub Kicinski return __dev_xdp_attached(dev, ops->ndo_bpf, prog_id); 1326d67b9cd2SDaniel Borkmann } 1327d67b9cd2SDaniel Borkmann 1328d1fdd913SBrenden Blanco static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev) 1329d1fdd913SBrenden Blanco { 1330d1fdd913SBrenden Blanco struct nlattr *xdp; 133158038695SMartin KaFai Lau u32 prog_id; 1332d1fdd913SBrenden Blanco int err; 1333d1fdd913SBrenden Blanco 1334d1fdd913SBrenden Blanco xdp = nla_nest_start(skb, IFLA_XDP); 1335d1fdd913SBrenden Blanco if (!xdp) 1336d1fdd913SBrenden Blanco return -EMSGSIZE; 1337b5cdae32SDavid S. Miller 1338d67b9cd2SDaniel Borkmann err = nla_put_u8(skb, IFLA_XDP_ATTACHED, 133958038695SMartin KaFai Lau rtnl_xdp_attached_mode(dev, &prog_id)); 1340d1fdd913SBrenden Blanco if (err) 1341d1fdd913SBrenden Blanco goto err_cancel; 1342d1fdd913SBrenden Blanco 134358038695SMartin KaFai Lau if (prog_id) { 134458038695SMartin KaFai Lau err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id); 134558038695SMartin KaFai Lau if (err) 134658038695SMartin KaFai Lau goto err_cancel; 134758038695SMartin KaFai Lau } 134858038695SMartin KaFai Lau 1349d1fdd913SBrenden Blanco nla_nest_end(skb, xdp); 1350d1fdd913SBrenden Blanco return 0; 1351d1fdd913SBrenden Blanco 1352d1fdd913SBrenden Blanco err_cancel: 1353d1fdd913SBrenden Blanco nla_nest_cancel(skb, xdp); 1354d1fdd913SBrenden Blanco return err; 1355d1fdd913SBrenden Blanco } 1356d1fdd913SBrenden Blanco 13573d3ea5afSVlad Yasevich static u32 rtnl_get_event(unsigned long event) 13583d3ea5afSVlad Yasevich { 13593d3ea5afSVlad Yasevich u32 rtnl_event_type = IFLA_EVENT_NONE; 13603d3ea5afSVlad Yasevich 13613d3ea5afSVlad Yasevich switch (event) { 13623d3ea5afSVlad Yasevich case NETDEV_REBOOT: 13633d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_REBOOT; 13643d3ea5afSVlad Yasevich break; 13653d3ea5afSVlad Yasevich case NETDEV_FEAT_CHANGE: 13663d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_FEATURES; 13673d3ea5afSVlad Yasevich break; 13683d3ea5afSVlad Yasevich case NETDEV_BONDING_FAILOVER: 13693d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER; 13703d3ea5afSVlad Yasevich break; 13713d3ea5afSVlad Yasevich case NETDEV_NOTIFY_PEERS: 13723d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS; 13733d3ea5afSVlad Yasevich break; 13743d3ea5afSVlad Yasevich case NETDEV_RESEND_IGMP: 13753d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_IGMP_RESEND; 13763d3ea5afSVlad Yasevich break; 13773d3ea5afSVlad Yasevich case NETDEV_CHANGEINFODATA: 13783d3ea5afSVlad Yasevich rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS; 13793d3ea5afSVlad Yasevich break; 13803d3ea5afSVlad Yasevich default: 13813d3ea5afSVlad Yasevich break; 13823d3ea5afSVlad Yasevich } 13833d3ea5afSVlad Yasevich 13843d3ea5afSVlad Yasevich return rtnl_event_type; 13853d3ea5afSVlad Yasevich } 13863d3ea5afSVlad Yasevich 138779110a04SFlorian Westphal static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev) 138879110a04SFlorian Westphal { 138979110a04SFlorian Westphal const struct net_device *upper_dev; 139079110a04SFlorian Westphal int ret = 0; 139179110a04SFlorian Westphal 139279110a04SFlorian Westphal rcu_read_lock(); 139379110a04SFlorian Westphal 139479110a04SFlorian Westphal upper_dev = netdev_master_upper_dev_get_rcu(dev); 139579110a04SFlorian Westphal if (upper_dev) 139679110a04SFlorian Westphal ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex); 139779110a04SFlorian Westphal 139879110a04SFlorian Westphal rcu_read_unlock(); 139979110a04SFlorian Westphal return ret; 140079110a04SFlorian Westphal } 140179110a04SFlorian Westphal 140279110a04SFlorian Westphal static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev) 140379110a04SFlorian Westphal { 140479110a04SFlorian Westphal int ifindex = dev_get_iflink(dev); 140579110a04SFlorian Westphal 140679110a04SFlorian Westphal if (dev->ifindex == ifindex) 140779110a04SFlorian Westphal return 0; 140879110a04SFlorian Westphal 140979110a04SFlorian Westphal return nla_put_u32(skb, IFLA_LINK, ifindex); 141079110a04SFlorian Westphal } 141179110a04SFlorian Westphal 14126c557001SFlorian Westphal static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb, 14136c557001SFlorian Westphal struct net_device *dev) 14146c557001SFlorian Westphal { 14156c557001SFlorian Westphal char buf[IFALIASZ]; 14166c557001SFlorian Westphal int ret; 14176c557001SFlorian Westphal 14186c557001SFlorian Westphal ret = dev_get_alias(dev, buf, sizeof(buf)); 14196c557001SFlorian Westphal return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0; 14206c557001SFlorian Westphal } 14216c557001SFlorian Westphal 1422b1e66b9aSFlorian Westphal static int rtnl_fill_link_netnsid(struct sk_buff *skb, 142379e1ad14SJiri Benc const struct net_device *dev, 142479e1ad14SJiri Benc struct net *src_net) 1425b1e66b9aSFlorian Westphal { 1426b1e66b9aSFlorian Westphal if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) { 1427b1e66b9aSFlorian Westphal struct net *link_net = dev->rtnl_link_ops->get_link_net(dev); 1428b1e66b9aSFlorian Westphal 1429b1e66b9aSFlorian Westphal if (!net_eq(dev_net(dev), link_net)) { 143079e1ad14SJiri Benc int id = peernet2id_alloc(src_net, link_net); 1431b1e66b9aSFlorian Westphal 1432b1e66b9aSFlorian Westphal if (nla_put_s32(skb, IFLA_LINK_NETNSID, id)) 1433b1e66b9aSFlorian Westphal return -EMSGSIZE; 1434b1e66b9aSFlorian Westphal } 1435b1e66b9aSFlorian Westphal } 1436b1e66b9aSFlorian Westphal 1437b1e66b9aSFlorian Westphal return 0; 1438b1e66b9aSFlorian Westphal } 1439b1e66b9aSFlorian Westphal 1440070cbf5bSFlorian Westphal static int rtnl_fill_link_af(struct sk_buff *skb, 1441070cbf5bSFlorian Westphal const struct net_device *dev, 1442070cbf5bSFlorian Westphal u32 ext_filter_mask) 1443070cbf5bSFlorian Westphal { 1444070cbf5bSFlorian Westphal const struct rtnl_af_ops *af_ops; 1445070cbf5bSFlorian Westphal struct nlattr *af_spec; 1446070cbf5bSFlorian Westphal 1447070cbf5bSFlorian Westphal af_spec = nla_nest_start(skb, IFLA_AF_SPEC); 1448070cbf5bSFlorian Westphal if (!af_spec) 1449070cbf5bSFlorian Westphal return -EMSGSIZE; 1450070cbf5bSFlorian Westphal 14515fa85a09SFlorian Westphal list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 1452070cbf5bSFlorian Westphal struct nlattr *af; 1453070cbf5bSFlorian Westphal int err; 1454070cbf5bSFlorian Westphal 1455070cbf5bSFlorian Westphal if (!af_ops->fill_link_af) 1456070cbf5bSFlorian Westphal continue; 1457070cbf5bSFlorian Westphal 1458070cbf5bSFlorian Westphal af = nla_nest_start(skb, af_ops->family); 1459070cbf5bSFlorian Westphal if (!af) 1460070cbf5bSFlorian Westphal return -EMSGSIZE; 1461070cbf5bSFlorian Westphal 1462070cbf5bSFlorian Westphal err = af_ops->fill_link_af(skb, dev, ext_filter_mask); 1463070cbf5bSFlorian Westphal /* 1464070cbf5bSFlorian Westphal * Caller may return ENODATA to indicate that there 1465070cbf5bSFlorian Westphal * was no data to be dumped. This is not an error, it 1466070cbf5bSFlorian Westphal * means we should trim the attribute header and 1467070cbf5bSFlorian Westphal * continue. 1468070cbf5bSFlorian Westphal */ 1469070cbf5bSFlorian Westphal if (err == -ENODATA) 1470070cbf5bSFlorian Westphal nla_nest_cancel(skb, af); 1471070cbf5bSFlorian Westphal else if (err < 0) 1472070cbf5bSFlorian Westphal return -EMSGSIZE; 1473070cbf5bSFlorian Westphal 1474070cbf5bSFlorian Westphal nla_nest_end(skb, af); 1475070cbf5bSFlorian Westphal } 1476070cbf5bSFlorian Westphal 1477070cbf5bSFlorian Westphal nla_nest_end(skb, af_spec); 1478070cbf5bSFlorian Westphal return 0; 1479070cbf5bSFlorian Westphal } 1480070cbf5bSFlorian Westphal 148179e1ad14SJiri Benc static int rtnl_fill_ifinfo(struct sk_buff *skb, 148279e1ad14SJiri Benc struct net_device *dev, struct net *src_net, 1483575c3e2aSPatrick McHardy int type, u32 pid, u32 seq, u32 change, 14843d3ea5afSVlad Yasevich unsigned int flags, u32 ext_filter_mask, 148579e1ad14SJiri Benc u32 event, int *new_nsid, int tgt_netnsid) 1486b60c5115SThomas Graf { 1487b60c5115SThomas Graf struct ifinfomsg *ifm; 14881da177e4SLinus Torvalds struct nlmsghdr *nlh; 14891da177e4SLinus Torvalds 14902907c35fSEric Dumazet ASSERT_RTNL(); 1491b60c5115SThomas Graf nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); 1492b60c5115SThomas Graf if (nlh == NULL) 149326932566SPatrick McHardy return -EMSGSIZE; 14941da177e4SLinus Torvalds 1495b60c5115SThomas Graf ifm = nlmsg_data(nlh); 1496b60c5115SThomas Graf ifm->ifi_family = AF_UNSPEC; 1497b60c5115SThomas Graf ifm->__ifi_pad = 0; 1498b60c5115SThomas Graf ifm->ifi_type = dev->type; 1499b60c5115SThomas Graf ifm->ifi_index = dev->ifindex; 1500b60c5115SThomas Graf ifm->ifi_flags = dev_get_flags(dev); 1501b60c5115SThomas Graf ifm->ifi_change = change; 15021da177e4SLinus Torvalds 150379e1ad14SJiri Benc if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_IF_NETNSID, tgt_netnsid)) 150479e1ad14SJiri Benc goto nla_put_failure; 150579e1ad14SJiri Benc 1506a6574349SDavid S. Miller if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 1507a6574349SDavid S. Miller nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) || 1508a6574349SDavid S. Miller nla_put_u8(skb, IFLA_OPERSTATE, 1509a6574349SDavid S. Miller netif_running(dev) ? dev->operstate : IF_OPER_DOWN) || 1510a6574349SDavid S. Miller nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) || 1511a6574349SDavid S. Miller nla_put_u32(skb, IFLA_MTU, dev->mtu) || 1512a6574349SDavid S. Miller nla_put_u32(skb, IFLA_GROUP, dev->group) || 1513edbc0bb3SBen Greear nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) || 151476ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) || 1515c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) || 1516c70ce028SEric Dumazet nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) || 15171d69c2b3SMark A. Greer #ifdef CONFIG_RPS 151876ff5cc9SJiri Pirko nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) || 15191d69c2b3SMark A. Greer #endif 152079110a04SFlorian Westphal nla_put_iflink(skb, dev) || 152179110a04SFlorian Westphal put_master_ifindex(skb, dev) || 15229a57247fSJiri Pirko nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) || 1523a6574349SDavid S. Miller (dev->qdisc && 1524a6574349SDavid S. Miller nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) || 15256c557001SFlorian Westphal nla_put_ifalias(skb, dev) || 15262d3b479dSdavid decotigny nla_put_u32(skb, IFLA_CARRIER_CHANGES, 152788d6378bSAnuradha Karuppiah atomic_read(&dev->carrier_changes)) || 152888d6378bSAnuradha Karuppiah nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down)) 1529a6574349SDavid S. Miller goto nla_put_failure; 15300b815a1aSStephen Hemminger 15313d3ea5afSVlad Yasevich if (event != IFLA_EVENT_NONE) { 15323d3ea5afSVlad Yasevich if (nla_put_u32(skb, IFLA_EVENT, event)) 15333d3ea5afSVlad Yasevich goto nla_put_failure; 15343d3ea5afSVlad Yasevich } 15353d3ea5afSVlad Yasevich 1536b22b941bSHannes Frederic Sowa if (rtnl_fill_link_ifmap(skb, dev)) 1537a6574349SDavid S. Miller goto nla_put_failure; 15381da177e4SLinus Torvalds 15391da177e4SLinus Torvalds if (dev->addr_len) { 1540a6574349SDavid S. Miller if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) || 1541a6574349SDavid S. Miller nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast)) 1542a6574349SDavid S. Miller goto nla_put_failure; 15431da177e4SLinus Torvalds } 15441da177e4SLinus Torvalds 154566cae9edSJiri Pirko if (rtnl_phys_port_id_fill(skb, dev)) 154666cae9edSJiri Pirko goto nla_put_failure; 154766cae9edSJiri Pirko 1548db24a904SDavid Ahern if (rtnl_phys_port_name_fill(skb, dev)) 1549db24a904SDavid Ahern goto nla_put_failure; 1550db24a904SDavid Ahern 155182f28412SJiri Pirko if (rtnl_phys_switch_id_fill(skb, dev)) 155282f28412SJiri Pirko goto nla_put_failure; 155382f28412SJiri Pirko 1554b22b941bSHannes Frederic Sowa if (rtnl_fill_stats(skb, dev)) 1555b60c5115SThomas Graf goto nla_put_failure; 1556b60c5115SThomas Graf 1557250fc3dfSFlorian Westphal if (rtnl_fill_vf(skb, dev, ext_filter_mask)) 1558a6574349SDavid S. Miller goto nla_put_failure; 155957b61080SScott Feldman 1560c53864fdSDavid Gibson if (rtnl_port_fill(skb, dev, ext_filter_mask)) 156157b61080SScott Feldman goto nla_put_failure; 156257b61080SScott Feldman 1563d1fdd913SBrenden Blanco if (rtnl_xdp_fill(skb, dev)) 1564d1fdd913SBrenden Blanco goto nla_put_failure; 1565d1fdd913SBrenden Blanco 1566ba7d49b1SJiri Pirko if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) { 156738f7b870SPatrick McHardy if (rtnl_link_fill(skb, dev) < 0) 156838f7b870SPatrick McHardy goto nla_put_failure; 156938f7b870SPatrick McHardy } 157038f7b870SPatrick McHardy 157179e1ad14SJiri Benc if (rtnl_fill_link_netnsid(skb, dev, src_net)) 1572d37512a2SNicolas Dichtel goto nla_put_failure; 1573d37512a2SNicolas Dichtel 15746621dd29SNicolas Dichtel if (new_nsid && 15756621dd29SNicolas Dichtel nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0) 15766621dd29SNicolas Dichtel goto nla_put_failure; 15776621dd29SNicolas Dichtel 15785fa85a09SFlorian Westphal rcu_read_lock(); 1579070cbf5bSFlorian Westphal if (rtnl_fill_link_af(skb, dev, ext_filter_mask)) 15805fa85a09SFlorian Westphal goto nla_put_failure_rcu; 15815fa85a09SFlorian Westphal rcu_read_unlock(); 1582f8ff182cSThomas Graf 1583053c095aSJohannes Berg nlmsg_end(skb, nlh); 1584053c095aSJohannes Berg return 0; 1585b60c5115SThomas Graf 15865fa85a09SFlorian Westphal nla_put_failure_rcu: 15875fa85a09SFlorian Westphal rcu_read_unlock(); 1588b60c5115SThomas Graf nla_put_failure: 158926932566SPatrick McHardy nlmsg_cancel(skb, nlh); 159026932566SPatrick McHardy return -EMSGSIZE; 15911da177e4SLinus Torvalds } 15921da177e4SLinus Torvalds 1593f7b12606SJiri Pirko static const struct nla_policy ifla_policy[IFLA_MAX+1] = { 1594f7b12606SJiri Pirko [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, 1595f7b12606SJiri Pirko [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1596f7b12606SJiri Pirko [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 1597f7b12606SJiri Pirko [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, 1598f7b12606SJiri Pirko [IFLA_MTU] = { .type = NLA_U32 }, 1599f7b12606SJiri Pirko [IFLA_LINK] = { .type = NLA_U32 }, 1600f7b12606SJiri Pirko [IFLA_MASTER] = { .type = NLA_U32 }, 1601f7b12606SJiri Pirko [IFLA_CARRIER] = { .type = NLA_U8 }, 1602f7b12606SJiri Pirko [IFLA_TXQLEN] = { .type = NLA_U32 }, 1603f7b12606SJiri Pirko [IFLA_WEIGHT] = { .type = NLA_U32 }, 1604f7b12606SJiri Pirko [IFLA_OPERSTATE] = { .type = NLA_U8 }, 1605f7b12606SJiri Pirko [IFLA_LINKMODE] = { .type = NLA_U8 }, 1606f7b12606SJiri Pirko [IFLA_LINKINFO] = { .type = NLA_NESTED }, 1607f7b12606SJiri Pirko [IFLA_NET_NS_PID] = { .type = NLA_U32 }, 1608f7b12606SJiri Pirko [IFLA_NET_NS_FD] = { .type = NLA_U32 }, 16092459b4c6SNicolas Dichtel /* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to 16102459b4c6SNicolas Dichtel * allow 0-length string (needed to remove an alias). 16112459b4c6SNicolas Dichtel */ 16122459b4c6SNicolas Dichtel [IFLA_IFALIAS] = { .type = NLA_BINARY, .len = IFALIASZ - 1 }, 1613f7b12606SJiri Pirko [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, 1614f7b12606SJiri Pirko [IFLA_VF_PORTS] = { .type = NLA_NESTED }, 1615f7b12606SJiri Pirko [IFLA_PORT_SELF] = { .type = NLA_NESTED }, 1616f7b12606SJiri Pirko [IFLA_AF_SPEC] = { .type = NLA_NESTED }, 1617f7b12606SJiri Pirko [IFLA_EXT_MASK] = { .type = NLA_U32 }, 1618f7b12606SJiri Pirko [IFLA_PROMISCUITY] = { .type = NLA_U32 }, 1619f7b12606SJiri Pirko [IFLA_NUM_TX_QUEUES] = { .type = NLA_U32 }, 1620f7b12606SJiri Pirko [IFLA_NUM_RX_QUEUES] = { .type = NLA_U32 }, 162102637fceSJiri Pirko [IFLA_PHYS_PORT_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 16222d3b479dSdavid decotigny [IFLA_CARRIER_CHANGES] = { .type = NLA_U32 }, /* ignored */ 162382f28412SJiri Pirko [IFLA_PHYS_SWITCH_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN }, 1624317f4810SNicolas Dichtel [IFLA_LINK_NETNSID] = { .type = NLA_S32 }, 162588d6378bSAnuradha Karuppiah [IFLA_PROTO_DOWN] = { .type = NLA_U8 }, 1626d1fdd913SBrenden Blanco [IFLA_XDP] = { .type = NLA_NESTED }, 16273d3ea5afSVlad Yasevich [IFLA_EVENT] = { .type = NLA_U32 }, 1628db833d40SSerhey Popovych [IFLA_GROUP] = { .type = NLA_U32 }, 162979e1ad14SJiri Benc [IFLA_IF_NETNSID] = { .type = NLA_S32 }, 1630f7b12606SJiri Pirko }; 1631f7b12606SJiri Pirko 1632f7b12606SJiri Pirko static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { 1633f7b12606SJiri Pirko [IFLA_INFO_KIND] = { .type = NLA_STRING }, 1634f7b12606SJiri Pirko [IFLA_INFO_DATA] = { .type = NLA_NESTED }, 1635f7b12606SJiri Pirko [IFLA_INFO_SLAVE_KIND] = { .type = NLA_STRING }, 1636f7b12606SJiri Pirko [IFLA_INFO_SLAVE_DATA] = { .type = NLA_NESTED }, 1637f7b12606SJiri Pirko }; 1638f7b12606SJiri Pirko 1639f7b12606SJiri Pirko static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { 1640364d5716SDaniel Borkmann [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) }, 1641364d5716SDaniel Borkmann [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) }, 164279aab093SMoshe Shemesh [IFLA_VF_VLAN_LIST] = { .type = NLA_NESTED }, 1643364d5716SDaniel Borkmann [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) }, 1644364d5716SDaniel Borkmann [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) }, 1645364d5716SDaniel Borkmann [IFLA_VF_RATE] = { .len = sizeof(struct ifla_vf_rate) }, 1646364d5716SDaniel Borkmann [IFLA_VF_LINK_STATE] = { .len = sizeof(struct ifla_vf_link_state) }, 164701a3d796SVlad Zolotarov [IFLA_VF_RSS_QUERY_EN] = { .len = sizeof(struct ifla_vf_rss_query_en) }, 16483b766cd8SEran Ben Elisha [IFLA_VF_STATS] = { .type = NLA_NESTED }, 1649dd461d6aSHiroshi Shimamoto [IFLA_VF_TRUST] = { .len = sizeof(struct ifla_vf_trust) }, 1650cc8e27ccSEli Cohen [IFLA_VF_IB_NODE_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 1651cc8e27ccSEli Cohen [IFLA_VF_IB_PORT_GUID] = { .len = sizeof(struct ifla_vf_guid) }, 16523b766cd8SEran Ben Elisha }; 16533b766cd8SEran Ben Elisha 1654f7b12606SJiri Pirko static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { 1655f7b12606SJiri Pirko [IFLA_PORT_VF] = { .type = NLA_U32 }, 1656f7b12606SJiri Pirko [IFLA_PORT_PROFILE] = { .type = NLA_STRING, 1657f7b12606SJiri Pirko .len = PORT_PROFILE_MAX }, 1658f7b12606SJiri Pirko [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, 1659f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1660f7b12606SJiri Pirko [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, 1661f7b12606SJiri Pirko .len = PORT_UUID_MAX }, 1662f7b12606SJiri Pirko [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, 1663f7b12606SJiri Pirko [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, 1664025331dfSDaniel Borkmann 1665025331dfSDaniel Borkmann /* Unused, but we need to keep it here since user space could 1666025331dfSDaniel Borkmann * fill it. It's also broken with regard to NLA_BINARY use in 1667025331dfSDaniel Borkmann * combination with structs. 1668025331dfSDaniel Borkmann */ 1669025331dfSDaniel Borkmann [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, 1670025331dfSDaniel Borkmann .len = sizeof(struct ifla_port_vsi) }, 1671f7b12606SJiri Pirko }; 1672f7b12606SJiri Pirko 1673d1fdd913SBrenden Blanco static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = { 1674d1fdd913SBrenden Blanco [IFLA_XDP_FD] = { .type = NLA_S32 }, 1675d1fdd913SBrenden Blanco [IFLA_XDP_ATTACHED] = { .type = NLA_U8 }, 167685de8576SDaniel Borkmann [IFLA_XDP_FLAGS] = { .type = NLA_U32 }, 167758038695SMartin KaFai Lau [IFLA_XDP_PROG_ID] = { .type = NLA_U32 }, 1678d1fdd913SBrenden Blanco }; 1679d1fdd913SBrenden Blanco 1680dc599f76SDavid Ahern static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla) 1681dc599f76SDavid Ahern { 1682dc599f76SDavid Ahern const struct rtnl_link_ops *ops = NULL; 1683dc599f76SDavid Ahern struct nlattr *linfo[IFLA_INFO_MAX + 1]; 1684dc599f76SDavid Ahern 1685fceb6435SJohannes Berg if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla, 1686fceb6435SJohannes Berg ifla_info_policy, NULL) < 0) 1687dc599f76SDavid Ahern return NULL; 1688dc599f76SDavid Ahern 1689dc599f76SDavid Ahern if (linfo[IFLA_INFO_KIND]) { 1690dc599f76SDavid Ahern char kind[MODULE_NAME_LEN]; 1691dc599f76SDavid Ahern 1692dc599f76SDavid Ahern nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind)); 1693dc599f76SDavid Ahern ops = rtnl_link_ops_get(kind); 1694dc599f76SDavid Ahern } 1695dc599f76SDavid Ahern 1696dc599f76SDavid Ahern return ops; 1697dc599f76SDavid Ahern } 1698dc599f76SDavid Ahern 1699dc599f76SDavid Ahern static bool link_master_filtered(struct net_device *dev, int master_idx) 1700dc599f76SDavid Ahern { 1701dc599f76SDavid Ahern struct net_device *master; 1702dc599f76SDavid Ahern 1703dc599f76SDavid Ahern if (!master_idx) 1704dc599f76SDavid Ahern return false; 1705dc599f76SDavid Ahern 1706dc599f76SDavid Ahern master = netdev_master_upper_dev_get(dev); 1707dc599f76SDavid Ahern if (!master || master->ifindex != master_idx) 1708dc599f76SDavid Ahern return true; 1709dc599f76SDavid Ahern 1710dc599f76SDavid Ahern return false; 1711dc599f76SDavid Ahern } 1712dc599f76SDavid Ahern 1713dc599f76SDavid Ahern static bool link_kind_filtered(const struct net_device *dev, 1714dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1715dc599f76SDavid Ahern { 1716dc599f76SDavid Ahern if (kind_ops && dev->rtnl_link_ops != kind_ops) 1717dc599f76SDavid Ahern return true; 1718dc599f76SDavid Ahern 1719dc599f76SDavid Ahern return false; 1720dc599f76SDavid Ahern } 1721dc599f76SDavid Ahern 1722dc599f76SDavid Ahern static bool link_dump_filtered(struct net_device *dev, 1723dc599f76SDavid Ahern int master_idx, 1724dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops) 1725dc599f76SDavid Ahern { 1726dc599f76SDavid Ahern if (link_master_filtered(dev, master_idx) || 1727dc599f76SDavid Ahern link_kind_filtered(dev, kind_ops)) 1728dc599f76SDavid Ahern return true; 1729dc599f76SDavid Ahern 1730dc599f76SDavid Ahern return false; 1731dc599f76SDavid Ahern } 1732dc599f76SDavid Ahern 173379e1ad14SJiri Benc static struct net *get_target_net(struct sk_buff *skb, int netnsid) 173479e1ad14SJiri Benc { 173579e1ad14SJiri Benc struct net *net; 173679e1ad14SJiri Benc 173779e1ad14SJiri Benc net = get_net_ns_by_id(sock_net(skb->sk), netnsid); 173879e1ad14SJiri Benc if (!net) 173979e1ad14SJiri Benc return ERR_PTR(-EINVAL); 174079e1ad14SJiri Benc 174179e1ad14SJiri Benc /* For now, the caller is required to have CAP_NET_ADMIN in 174279e1ad14SJiri Benc * the user namespace owning the target net ns. 174379e1ad14SJiri Benc */ 174479e1ad14SJiri Benc if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) { 174579e1ad14SJiri Benc put_net(net); 174679e1ad14SJiri Benc return ERR_PTR(-EACCES); 174779e1ad14SJiri Benc } 174879e1ad14SJiri Benc return net; 174979e1ad14SJiri Benc } 175079e1ad14SJiri Benc 1751b60c5115SThomas Graf static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) 17521da177e4SLinus Torvalds { 17533b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 175479e1ad14SJiri Benc struct net *tgt_net = net; 17557c28bd0bSEric Dumazet int h, s_h; 17567c28bd0bSEric Dumazet int idx = 0, s_idx; 17571da177e4SLinus Torvalds struct net_device *dev; 17587c28bd0bSEric Dumazet struct hlist_head *head; 1759115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 1760115c9b81SGreg Rose u32 ext_filter_mask = 0; 1761dc599f76SDavid Ahern const struct rtnl_link_ops *kind_ops = NULL; 1762dc599f76SDavid Ahern unsigned int flags = NLM_F_MULTI; 1763dc599f76SDavid Ahern int master_idx = 0; 176479e1ad14SJiri Benc int netnsid = -1; 1765973462bbSDavid Gibson int err; 1766e5eca6d4SMichal Schmidt int hdrlen; 17671da177e4SLinus Torvalds 17687c28bd0bSEric Dumazet s_h = cb->args[0]; 17697c28bd0bSEric Dumazet s_idx = cb->args[1]; 17707c28bd0bSEric Dumazet 1771e5eca6d4SMichal Schmidt /* A hack to preserve kernel<->userspace interface. 1772e5eca6d4SMichal Schmidt * The correct header is ifinfomsg. It is consistent with rtnl_getlink. 1773e5eca6d4SMichal Schmidt * However, before Linux v3.9 the code here assumed rtgenmsg and that's 1774e5eca6d4SMichal Schmidt * what iproute2 < v3.9.0 used. 1775e5eca6d4SMichal Schmidt * We can detect the old iproute2. Even including the IFLA_EXT_MASK 1776e5eca6d4SMichal Schmidt * attribute, its netlink message is shorter than struct ifinfomsg. 1777e5eca6d4SMichal Schmidt */ 1778e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ? 1779e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 1780e5eca6d4SMichal Schmidt 1781fceb6435SJohannes Berg if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX, 1782fceb6435SJohannes Berg ifla_policy, NULL) >= 0) { 178379e1ad14SJiri Benc if (tb[IFLA_IF_NETNSID]) { 178479e1ad14SJiri Benc netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]); 178579e1ad14SJiri Benc tgt_net = get_target_net(skb, netnsid); 178679e1ad14SJiri Benc if (IS_ERR(tgt_net)) { 178779e1ad14SJiri Benc tgt_net = net; 178879e1ad14SJiri Benc netnsid = -1; 178979e1ad14SJiri Benc } 179079e1ad14SJiri Benc } 179179e1ad14SJiri Benc 1792115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 1793115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 1794dc599f76SDavid Ahern 1795dc599f76SDavid Ahern if (tb[IFLA_MASTER]) 1796dc599f76SDavid Ahern master_idx = nla_get_u32(tb[IFLA_MASTER]); 1797dc599f76SDavid Ahern 1798dc599f76SDavid Ahern if (tb[IFLA_LINKINFO]) 1799dc599f76SDavid Ahern kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]); 1800dc599f76SDavid Ahern 1801dc599f76SDavid Ahern if (master_idx || kind_ops) 1802dc599f76SDavid Ahern flags |= NLM_F_DUMP_FILTERED; 1803a4b64fbeSEric Dumazet } 1804115c9b81SGreg Rose 18057c28bd0bSEric Dumazet for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 18067562f876SPavel Emelianov idx = 0; 180779e1ad14SJiri Benc head = &tgt_net->dev_index_head[h]; 1808cac5e65eSEric Dumazet hlist_for_each_entry(dev, head, index_hlist) { 1809dc599f76SDavid Ahern if (link_dump_filtered(dev, master_idx, kind_ops)) 18103f0ae05dSZhang Shengju goto cont; 18111da177e4SLinus Torvalds if (idx < s_idx) 18127562f876SPavel Emelianov goto cont; 181379e1ad14SJiri Benc err = rtnl_fill_ifinfo(skb, dev, net, 181479e1ad14SJiri Benc RTM_NEWLINK, 181515e47304SEric W. Biederman NETLINK_CB(cb->skb).portid, 18167c28bd0bSEric Dumazet cb->nlh->nlmsg_seq, 0, 1817dc599f76SDavid Ahern flags, 181879e1ad14SJiri Benc ext_filter_mask, 0, NULL, 181979e1ad14SJiri Benc netnsid); 1820973462bbSDavid Gibson 1821f6c5775fSDavid Ahern if (err < 0) { 1822f6c5775fSDavid Ahern if (likely(skb->len)) 18237c28bd0bSEric Dumazet goto out; 18244e985adaSThomas Graf 1825f6c5775fSDavid Ahern goto out_err; 1826f6c5775fSDavid Ahern } 18277562f876SPavel Emelianov cont: 18287562f876SPavel Emelianov idx++; 18291da177e4SLinus Torvalds } 18307c28bd0bSEric Dumazet } 18317c28bd0bSEric Dumazet out: 1832f6c5775fSDavid Ahern err = skb->len; 1833f6c5775fSDavid Ahern out_err: 18347c28bd0bSEric Dumazet cb->args[1] = idx; 18357c28bd0bSEric Dumazet cb->args[0] = h; 1836d0225784SJakub Sitnicki cb->seq = net->dev_base_seq; 1837d0225784SJakub Sitnicki nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 183879e1ad14SJiri Benc if (netnsid >= 0) 183979e1ad14SJiri Benc put_net(tgt_net); 18401da177e4SLinus Torvalds 1841f6c5775fSDavid Ahern return err; 18421da177e4SLinus Torvalds } 18431da177e4SLinus Torvalds 1844fceb6435SJohannes Berg int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len, 1845fceb6435SJohannes Berg struct netlink_ext_ack *exterr) 1846f7b12606SJiri Pirko { 1847fceb6435SJohannes Berg return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr); 1848f7b12606SJiri Pirko } 1849f7b12606SJiri Pirko EXPORT_SYMBOL(rtnl_nla_parse_ifla); 185057b61080SScott Feldman 185181adee47SEric W. Biederman struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) 185281adee47SEric W. Biederman { 185381adee47SEric W. Biederman struct net *net; 185481adee47SEric W. Biederman /* Examine the link attributes and figure out which 185581adee47SEric W. Biederman * network namespace we are talking about. 185681adee47SEric W. Biederman */ 185781adee47SEric W. Biederman if (tb[IFLA_NET_NS_PID]) 185881adee47SEric W. Biederman net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); 1859f0630529SEric W. Biederman else if (tb[IFLA_NET_NS_FD]) 1860f0630529SEric W. Biederman net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD])); 186181adee47SEric W. Biederman else 186281adee47SEric W. Biederman net = get_net(src_net); 186381adee47SEric W. Biederman return net; 186481adee47SEric W. Biederman } 186581adee47SEric W. Biederman EXPORT_SYMBOL(rtnl_link_get_net); 186681adee47SEric W. Biederman 18671840bb13SThomas Graf static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) 18681840bb13SThomas Graf { 18691840bb13SThomas Graf if (dev) { 18701840bb13SThomas Graf if (tb[IFLA_ADDRESS] && 18711840bb13SThomas Graf nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) 18721840bb13SThomas Graf return -EINVAL; 18731840bb13SThomas Graf 18741840bb13SThomas Graf if (tb[IFLA_BROADCAST] && 18751840bb13SThomas Graf nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) 18761840bb13SThomas Graf return -EINVAL; 18771840bb13SThomas Graf } 18781840bb13SThomas Graf 1879cf7afbfeSThomas Graf if (tb[IFLA_AF_SPEC]) { 1880cf7afbfeSThomas Graf struct nlattr *af; 1881cf7afbfeSThomas Graf int rem, err; 1882cf7afbfeSThomas Graf 1883cf7afbfeSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 1884cf7afbfeSThomas Graf const struct rtnl_af_ops *af_ops; 1885cf7afbfeSThomas Graf 18865fa85a09SFlorian Westphal rcu_read_lock(); 18875fa85a09SFlorian Westphal af_ops = rtnl_af_lookup(nla_type(af)); 18885fa85a09SFlorian Westphal if (!af_ops) { 18895fa85a09SFlorian Westphal rcu_read_unlock(); 1890cf7afbfeSThomas Graf return -EAFNOSUPPORT; 18915fa85a09SFlorian Westphal } 1892cf7afbfeSThomas Graf 18935fa85a09SFlorian Westphal if (!af_ops->set_link_af) { 18945fa85a09SFlorian Westphal rcu_read_unlock(); 1895cf7afbfeSThomas Graf return -EOPNOTSUPP; 18965fa85a09SFlorian Westphal } 1897cf7afbfeSThomas Graf 1898cf7afbfeSThomas Graf if (af_ops->validate_link_af) { 18996d3a9a68SKurt Van Dijck err = af_ops->validate_link_af(dev, af); 19005fa85a09SFlorian Westphal if (err < 0) { 19015fa85a09SFlorian Westphal rcu_read_unlock(); 1902cf7afbfeSThomas Graf return err; 1903cf7afbfeSThomas Graf } 1904cf7afbfeSThomas Graf } 19055fa85a09SFlorian Westphal 19065fa85a09SFlorian Westphal rcu_read_unlock(); 19075fa85a09SFlorian Westphal } 1908cf7afbfeSThomas Graf } 1909cf7afbfeSThomas Graf 19101840bb13SThomas Graf return 0; 19111840bb13SThomas Graf } 19121840bb13SThomas Graf 1913cc8e27ccSEli Cohen static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt, 1914cc8e27ccSEli Cohen int guid_type) 1915cc8e27ccSEli Cohen { 1916cc8e27ccSEli Cohen const struct net_device_ops *ops = dev->netdev_ops; 1917cc8e27ccSEli Cohen 1918cc8e27ccSEli Cohen return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type); 1919cc8e27ccSEli Cohen } 1920cc8e27ccSEli Cohen 1921cc8e27ccSEli Cohen static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type) 1922cc8e27ccSEli Cohen { 1923cc8e27ccSEli Cohen if (dev->type != ARPHRD_INFINIBAND) 1924cc8e27ccSEli Cohen return -EOPNOTSUPP; 1925cc8e27ccSEli Cohen 1926cc8e27ccSEli Cohen return handle_infiniband_guid(dev, ivt, guid_type); 1927cc8e27ccSEli Cohen } 1928cc8e27ccSEli Cohen 19294f7d2cdfSDaniel Borkmann static int do_setvfinfo(struct net_device *dev, struct nlattr **tb) 1930c02db8c6SChris Wright { 1931c02db8c6SChris Wright const struct net_device_ops *ops = dev->netdev_ops; 19324f7d2cdfSDaniel Borkmann int err = -EINVAL; 1933c02db8c6SChris Wright 19344f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_MAC]) { 19354f7d2cdfSDaniel Borkmann struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]); 19364f7d2cdfSDaniel Borkmann 1937c02db8c6SChris Wright err = -EOPNOTSUPP; 1938c02db8c6SChris Wright if (ops->ndo_set_vf_mac) 1939c02db8c6SChris Wright err = ops->ndo_set_vf_mac(dev, ivm->vf, 1940c02db8c6SChris Wright ivm->mac); 19414f7d2cdfSDaniel Borkmann if (err < 0) 19424f7d2cdfSDaniel Borkmann return err; 1943c02db8c6SChris Wright } 19444f7d2cdfSDaniel Borkmann 19454f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_VLAN]) { 19464f7d2cdfSDaniel Borkmann struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]); 19474f7d2cdfSDaniel Borkmann 1948c02db8c6SChris Wright err = -EOPNOTSUPP; 1949c02db8c6SChris Wright if (ops->ndo_set_vf_vlan) 19504f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan, 195179aab093SMoshe Shemesh ivv->qos, 195279aab093SMoshe Shemesh htons(ETH_P_8021Q)); 195379aab093SMoshe Shemesh if (err < 0) 195479aab093SMoshe Shemesh return err; 195579aab093SMoshe Shemesh } 195679aab093SMoshe Shemesh 195779aab093SMoshe Shemesh if (tb[IFLA_VF_VLAN_LIST]) { 195879aab093SMoshe Shemesh struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN]; 195979aab093SMoshe Shemesh struct nlattr *attr; 196079aab093SMoshe Shemesh int rem, len = 0; 196179aab093SMoshe Shemesh 196279aab093SMoshe Shemesh err = -EOPNOTSUPP; 196379aab093SMoshe Shemesh if (!ops->ndo_set_vf_vlan) 196479aab093SMoshe Shemesh return err; 196579aab093SMoshe Shemesh 196679aab093SMoshe Shemesh nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) { 196779aab093SMoshe Shemesh if (nla_type(attr) != IFLA_VF_VLAN_INFO || 196879aab093SMoshe Shemesh nla_len(attr) < NLA_HDRLEN) { 196979aab093SMoshe Shemesh return -EINVAL; 197079aab093SMoshe Shemesh } 197179aab093SMoshe Shemesh if (len >= MAX_VLAN_LIST_LEN) 197279aab093SMoshe Shemesh return -EOPNOTSUPP; 197379aab093SMoshe Shemesh ivvl[len] = nla_data(attr); 197479aab093SMoshe Shemesh 197579aab093SMoshe Shemesh len++; 197679aab093SMoshe Shemesh } 1977fa34cd94SArnd Bergmann if (len == 0) 1978fa34cd94SArnd Bergmann return -EINVAL; 1979fa34cd94SArnd Bergmann 198079aab093SMoshe Shemesh err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan, 198179aab093SMoshe Shemesh ivvl[0]->qos, ivvl[0]->vlan_proto); 19824f7d2cdfSDaniel Borkmann if (err < 0) 19834f7d2cdfSDaniel Borkmann return err; 1984c02db8c6SChris Wright } 19854f7d2cdfSDaniel Borkmann 19864f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_TX_RATE]) { 19874f7d2cdfSDaniel Borkmann struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]); 1988ed616689SSucheta Chakraborty struct ifla_vf_info ivf; 19894f7d2cdfSDaniel Borkmann 1990c02db8c6SChris Wright err = -EOPNOTSUPP; 1991ed616689SSucheta Chakraborty if (ops->ndo_get_vf_config) 19924f7d2cdfSDaniel Borkmann err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf); 19934f7d2cdfSDaniel Borkmann if (err < 0) 19944f7d2cdfSDaniel Borkmann return err; 19954f7d2cdfSDaniel Borkmann 1996ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 1997ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 1998ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 1999ed616689SSucheta Chakraborty ivf.min_tx_rate, 2000c02db8c6SChris Wright ivt->rate); 20014f7d2cdfSDaniel Borkmann if (err < 0) 20024f7d2cdfSDaniel Borkmann return err; 2003c02db8c6SChris Wright } 20044f7d2cdfSDaniel Borkmann 20054f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RATE]) { 20064f7d2cdfSDaniel Borkmann struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]); 20074f7d2cdfSDaniel Borkmann 2008ed616689SSucheta Chakraborty err = -EOPNOTSUPP; 2009ed616689SSucheta Chakraborty if (ops->ndo_set_vf_rate) 2010ed616689SSucheta Chakraborty err = ops->ndo_set_vf_rate(dev, ivt->vf, 2011ed616689SSucheta Chakraborty ivt->min_tx_rate, 2012ed616689SSucheta Chakraborty ivt->max_tx_rate); 20134f7d2cdfSDaniel Borkmann if (err < 0) 20144f7d2cdfSDaniel Borkmann return err; 2015ed616689SSucheta Chakraborty } 20164f7d2cdfSDaniel Borkmann 20174f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_SPOOFCHK]) { 20184f7d2cdfSDaniel Borkmann struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]); 20194f7d2cdfSDaniel Borkmann 20205f8444a3SGreg Rose err = -EOPNOTSUPP; 20215f8444a3SGreg Rose if (ops->ndo_set_vf_spoofchk) 20225f8444a3SGreg Rose err = ops->ndo_set_vf_spoofchk(dev, ivs->vf, 20235f8444a3SGreg Rose ivs->setting); 20244f7d2cdfSDaniel Borkmann if (err < 0) 20254f7d2cdfSDaniel Borkmann return err; 20265f8444a3SGreg Rose } 20274f7d2cdfSDaniel Borkmann 20284f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_LINK_STATE]) { 20294f7d2cdfSDaniel Borkmann struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]); 20304f7d2cdfSDaniel Borkmann 20311d8faf48SRony Efraim err = -EOPNOTSUPP; 20321d8faf48SRony Efraim if (ops->ndo_set_vf_link_state) 20331d8faf48SRony Efraim err = ops->ndo_set_vf_link_state(dev, ivl->vf, 20341d8faf48SRony Efraim ivl->link_state); 20354f7d2cdfSDaniel Borkmann if (err < 0) 20364f7d2cdfSDaniel Borkmann return err; 20371d8faf48SRony Efraim } 20384f7d2cdfSDaniel Borkmann 20394f7d2cdfSDaniel Borkmann if (tb[IFLA_VF_RSS_QUERY_EN]) { 204001a3d796SVlad Zolotarov struct ifla_vf_rss_query_en *ivrssq_en; 204101a3d796SVlad Zolotarov 204201a3d796SVlad Zolotarov err = -EOPNOTSUPP; 20434f7d2cdfSDaniel Borkmann ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]); 204401a3d796SVlad Zolotarov if (ops->ndo_set_vf_rss_query_en) 20454f7d2cdfSDaniel Borkmann err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf, 204601a3d796SVlad Zolotarov ivrssq_en->setting); 20474f7d2cdfSDaniel Borkmann if (err < 0) 20484f7d2cdfSDaniel Borkmann return err; 204901a3d796SVlad Zolotarov } 20504f7d2cdfSDaniel Borkmann 2051dd461d6aSHiroshi Shimamoto if (tb[IFLA_VF_TRUST]) { 2052dd461d6aSHiroshi Shimamoto struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]); 2053dd461d6aSHiroshi Shimamoto 2054dd461d6aSHiroshi Shimamoto err = -EOPNOTSUPP; 2055dd461d6aSHiroshi Shimamoto if (ops->ndo_set_vf_trust) 2056dd461d6aSHiroshi Shimamoto err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting); 2057dd461d6aSHiroshi Shimamoto if (err < 0) 2058dd461d6aSHiroshi Shimamoto return err; 2059dd461d6aSHiroshi Shimamoto } 2060dd461d6aSHiroshi Shimamoto 2061cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_NODE_GUID]) { 2062cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]); 2063cc8e27ccSEli Cohen 2064cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 2065cc8e27ccSEli Cohen return -EOPNOTSUPP; 2066cc8e27ccSEli Cohen 2067cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID); 2068cc8e27ccSEli Cohen } 2069cc8e27ccSEli Cohen 2070cc8e27ccSEli Cohen if (tb[IFLA_VF_IB_PORT_GUID]) { 2071cc8e27ccSEli Cohen struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]); 2072cc8e27ccSEli Cohen 2073cc8e27ccSEli Cohen if (!ops->ndo_set_vf_guid) 2074cc8e27ccSEli Cohen return -EOPNOTSUPP; 2075cc8e27ccSEli Cohen 2076cc8e27ccSEli Cohen return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID); 2077cc8e27ccSEli Cohen } 2078cc8e27ccSEli Cohen 2079c02db8c6SChris Wright return err; 2080c02db8c6SChris Wright } 2081c02db8c6SChris Wright 208233eaf2a6SDavid Ahern static int do_set_master(struct net_device *dev, int ifindex, 208333eaf2a6SDavid Ahern struct netlink_ext_ack *extack) 2084fbaec0eaSJiri Pirko { 2085898e5061SJiri Pirko struct net_device *upper_dev = netdev_master_upper_dev_get(dev); 2086fbaec0eaSJiri Pirko const struct net_device_ops *ops; 2087fbaec0eaSJiri Pirko int err; 2088fbaec0eaSJiri Pirko 2089898e5061SJiri Pirko if (upper_dev) { 2090898e5061SJiri Pirko if (upper_dev->ifindex == ifindex) 2091fbaec0eaSJiri Pirko return 0; 2092898e5061SJiri Pirko ops = upper_dev->netdev_ops; 2093fbaec0eaSJiri Pirko if (ops->ndo_del_slave) { 2094898e5061SJiri Pirko err = ops->ndo_del_slave(upper_dev, dev); 2095fbaec0eaSJiri Pirko if (err) 2096fbaec0eaSJiri Pirko return err; 2097fbaec0eaSJiri Pirko } else { 2098fbaec0eaSJiri Pirko return -EOPNOTSUPP; 2099fbaec0eaSJiri Pirko } 2100fbaec0eaSJiri Pirko } 2101fbaec0eaSJiri Pirko 2102fbaec0eaSJiri Pirko if (ifindex) { 2103898e5061SJiri Pirko upper_dev = __dev_get_by_index(dev_net(dev), ifindex); 2104898e5061SJiri Pirko if (!upper_dev) 2105fbaec0eaSJiri Pirko return -EINVAL; 2106898e5061SJiri Pirko ops = upper_dev->netdev_ops; 2107fbaec0eaSJiri Pirko if (ops->ndo_add_slave) { 210833eaf2a6SDavid Ahern err = ops->ndo_add_slave(upper_dev, dev, extack); 2109fbaec0eaSJiri Pirko if (err) 2110fbaec0eaSJiri Pirko return err; 2111fbaec0eaSJiri Pirko } else { 2112fbaec0eaSJiri Pirko return -EOPNOTSUPP; 2113fbaec0eaSJiri Pirko } 2114fbaec0eaSJiri Pirko } 2115fbaec0eaSJiri Pirko return 0; 2116fbaec0eaSJiri Pirko } 2117fbaec0eaSJiri Pirko 211890c325e3SNicolas Dichtel #define DO_SETLINK_MODIFIED 0x01 2119ba998906SNicolas Dichtel /* notify flag means notify + modified. */ 2120ba998906SNicolas Dichtel #define DO_SETLINK_NOTIFY 0x03 212190f62cf3SEric W. Biederman static int do_setlink(const struct sk_buff *skb, 212290f62cf3SEric W. Biederman struct net_device *dev, struct ifinfomsg *ifm, 2123ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 212490c325e3SNicolas Dichtel struct nlattr **tb, char *ifname, int status) 21250157f60cSPatrick McHardy { 2126d314774cSStephen Hemminger const struct net_device_ops *ops = dev->netdev_ops; 21270157f60cSPatrick McHardy int err; 21280157f60cSPatrick McHardy 2129f0630529SEric W. Biederman if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) { 213081adee47SEric W. Biederman struct net *net = rtnl_link_get_net(dev_net(dev), tb); 2131d8a5ec67SEric W. Biederman if (IS_ERR(net)) { 2132d8a5ec67SEric W. Biederman err = PTR_ERR(net); 2133d8a5ec67SEric W. Biederman goto errout; 2134d8a5ec67SEric W. Biederman } 213590f62cf3SEric W. Biederman if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) { 2136e0ebde0eSNicolas Dichtel put_net(net); 2137b51642f6SEric W. Biederman err = -EPERM; 2138b51642f6SEric W. Biederman goto errout; 2139b51642f6SEric W. Biederman } 2140d8a5ec67SEric W. Biederman err = dev_change_net_namespace(dev, net, ifname); 2141d8a5ec67SEric W. Biederman put_net(net); 2142d8a5ec67SEric W. Biederman if (err) 2143d8a5ec67SEric W. Biederman goto errout; 214490c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 2145d8a5ec67SEric W. Biederman } 2146d8a5ec67SEric W. Biederman 21470157f60cSPatrick McHardy if (tb[IFLA_MAP]) { 21480157f60cSPatrick McHardy struct rtnl_link_ifmap *u_map; 21490157f60cSPatrick McHardy struct ifmap k_map; 21500157f60cSPatrick McHardy 2151d314774cSStephen Hemminger if (!ops->ndo_set_config) { 21520157f60cSPatrick McHardy err = -EOPNOTSUPP; 21530157f60cSPatrick McHardy goto errout; 21540157f60cSPatrick McHardy } 21550157f60cSPatrick McHardy 21560157f60cSPatrick McHardy if (!netif_device_present(dev)) { 21570157f60cSPatrick McHardy err = -ENODEV; 21580157f60cSPatrick McHardy goto errout; 21590157f60cSPatrick McHardy } 21600157f60cSPatrick McHardy 21610157f60cSPatrick McHardy u_map = nla_data(tb[IFLA_MAP]); 21620157f60cSPatrick McHardy k_map.mem_start = (unsigned long) u_map->mem_start; 21630157f60cSPatrick McHardy k_map.mem_end = (unsigned long) u_map->mem_end; 21640157f60cSPatrick McHardy k_map.base_addr = (unsigned short) u_map->base_addr; 21650157f60cSPatrick McHardy k_map.irq = (unsigned char) u_map->irq; 21660157f60cSPatrick McHardy k_map.dma = (unsigned char) u_map->dma; 21670157f60cSPatrick McHardy k_map.port = (unsigned char) u_map->port; 21680157f60cSPatrick McHardy 2169d314774cSStephen Hemminger err = ops->ndo_set_config(dev, &k_map); 21700157f60cSPatrick McHardy if (err < 0) 21710157f60cSPatrick McHardy goto errout; 21720157f60cSPatrick McHardy 2173ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 21740157f60cSPatrick McHardy } 21750157f60cSPatrick McHardy 21760157f60cSPatrick McHardy if (tb[IFLA_ADDRESS]) { 21770157f60cSPatrick McHardy struct sockaddr *sa; 21780157f60cSPatrick McHardy int len; 21790157f60cSPatrick McHardy 2180153711f9SWANG Cong len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len, 2181153711f9SWANG Cong sizeof(*sa)); 21820157f60cSPatrick McHardy sa = kmalloc(len, GFP_KERNEL); 21830157f60cSPatrick McHardy if (!sa) { 21840157f60cSPatrick McHardy err = -ENOMEM; 21850157f60cSPatrick McHardy goto errout; 21860157f60cSPatrick McHardy } 21870157f60cSPatrick McHardy sa->sa_family = dev->type; 21880157f60cSPatrick McHardy memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), 21890157f60cSPatrick McHardy dev->addr_len); 2190e7c3273eSJiri Pirko err = dev_set_mac_address(dev, sa); 21910157f60cSPatrick McHardy kfree(sa); 21920157f60cSPatrick McHardy if (err) 21930157f60cSPatrick McHardy goto errout; 219490c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 21950157f60cSPatrick McHardy } 21960157f60cSPatrick McHardy 21970157f60cSPatrick McHardy if (tb[IFLA_MTU]) { 21980157f60cSPatrick McHardy err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU])); 21990157f60cSPatrick McHardy if (err < 0) 22000157f60cSPatrick McHardy goto errout; 220190c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 22020157f60cSPatrick McHardy } 22030157f60cSPatrick McHardy 2204cbda10faSVlad Dogaru if (tb[IFLA_GROUP]) { 2205cbda10faSVlad Dogaru dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2206ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2207cbda10faSVlad Dogaru } 2208cbda10faSVlad Dogaru 22090157f60cSPatrick McHardy /* 22100157f60cSPatrick McHardy * Interface selected by interface index but interface 22110157f60cSPatrick McHardy * name provided implies that a name change has been 22120157f60cSPatrick McHardy * requested. 22130157f60cSPatrick McHardy */ 22140157f60cSPatrick McHardy if (ifm->ifi_index > 0 && ifname[0]) { 22150157f60cSPatrick McHardy err = dev_change_name(dev, ifname); 22160157f60cSPatrick McHardy if (err < 0) 22170157f60cSPatrick McHardy goto errout; 221890c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 22190157f60cSPatrick McHardy } 22200157f60cSPatrick McHardy 22210b815a1aSStephen Hemminger if (tb[IFLA_IFALIAS]) { 22220b815a1aSStephen Hemminger err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), 22230b815a1aSStephen Hemminger nla_len(tb[IFLA_IFALIAS])); 22240b815a1aSStephen Hemminger if (err < 0) 22250b815a1aSStephen Hemminger goto errout; 2226ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 22270b815a1aSStephen Hemminger } 22280b815a1aSStephen Hemminger 22290157f60cSPatrick McHardy if (tb[IFLA_BROADCAST]) { 22300157f60cSPatrick McHardy nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); 2231e7c3273eSJiri Pirko call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); 22320157f60cSPatrick McHardy } 22330157f60cSPatrick McHardy 22340157f60cSPatrick McHardy if (ifm->ifi_flags || ifm->ifi_change) { 22353729d502SPatrick McHardy err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 22365f9021cfSJohannes Berg if (err < 0) 22375f9021cfSJohannes Berg goto errout; 22380157f60cSPatrick McHardy } 22390157f60cSPatrick McHardy 2240fbaec0eaSJiri Pirko if (tb[IFLA_MASTER]) { 224133eaf2a6SDavid Ahern err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack); 2242fbaec0eaSJiri Pirko if (err) 2243fbaec0eaSJiri Pirko goto errout; 224490c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 2245fbaec0eaSJiri Pirko } 2246fbaec0eaSJiri Pirko 22479a57247fSJiri Pirko if (tb[IFLA_CARRIER]) { 22489a57247fSJiri Pirko err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER])); 22499a57247fSJiri Pirko if (err) 22509a57247fSJiri Pirko goto errout; 225190c325e3SNicolas Dichtel status |= DO_SETLINK_MODIFIED; 22529a57247fSJiri Pirko } 22539a57247fSJiri Pirko 22545d1180fcSNicolas Dichtel if (tb[IFLA_TXQLEN]) { 22550cd29503SAlexey Dobriyan unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]); 22560cd29503SAlexey Dobriyan unsigned int orig_len = dev->tx_queue_len; 22575d1180fcSNicolas Dichtel 225808294a26SJason Wang if (dev->tx_queue_len ^ value) { 22595d1180fcSNicolas Dichtel dev->tx_queue_len = value; 226008294a26SJason Wang err = call_netdevice_notifiers( 226108294a26SJason Wang NETDEV_CHANGE_TX_QUEUE_LEN, dev); 226208294a26SJason Wang err = notifier_to_errno(err); 226308294a26SJason Wang if (err) { 226408294a26SJason Wang dev->tx_queue_len = orig_len; 226508294a26SJason Wang goto errout; 226608294a26SJason Wang } 22672d7f669bSXin Long status |= DO_SETLINK_MODIFIED; 226808294a26SJason Wang } 22695d1180fcSNicolas Dichtel } 22700157f60cSPatrick McHardy 22710157f60cSPatrick McHardy if (tb[IFLA_OPERSTATE]) 227293b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 22730157f60cSPatrick McHardy 22740157f60cSPatrick McHardy if (tb[IFLA_LINKMODE]) { 22751889b0e7SNicolas Dichtel unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]); 22761889b0e7SNicolas Dichtel 22770157f60cSPatrick McHardy write_lock_bh(&dev_base_lock); 22781889b0e7SNicolas Dichtel if (dev->link_mode ^ value) 2279ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 22801889b0e7SNicolas Dichtel dev->link_mode = value; 228193b2d4a2SDavid S. Miller write_unlock_bh(&dev_base_lock); 22820157f60cSPatrick McHardy } 22830157f60cSPatrick McHardy 2284c02db8c6SChris Wright if (tb[IFLA_VFINFO_LIST]) { 22854f7d2cdfSDaniel Borkmann struct nlattr *vfinfo[IFLA_VF_MAX + 1]; 2286c02db8c6SChris Wright struct nlattr *attr; 2287c02db8c6SChris Wright int rem; 22884f7d2cdfSDaniel Borkmann 2289c02db8c6SChris Wright nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { 22904f7d2cdfSDaniel Borkmann if (nla_type(attr) != IFLA_VF_INFO || 22914f7d2cdfSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2292253683bbSDavid Howells err = -EINVAL; 2293c02db8c6SChris Wright goto errout; 2294253683bbSDavid Howells } 22954f7d2cdfSDaniel Borkmann err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr, 2296fceb6435SJohannes Berg ifla_vf_policy, NULL); 22974f7d2cdfSDaniel Borkmann if (err < 0) 22984f7d2cdfSDaniel Borkmann goto errout; 22994f7d2cdfSDaniel Borkmann err = do_setvfinfo(dev, vfinfo); 2300ebc08a6fSWilliams, Mitch A if (err < 0) 2301ebc08a6fSWilliams, Mitch A goto errout; 2302ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2303ebc08a6fSWilliams, Mitch A } 2304ebc08a6fSWilliams, Mitch A } 23050157f60cSPatrick McHardy err = 0; 23060157f60cSPatrick McHardy 230757b61080SScott Feldman if (tb[IFLA_VF_PORTS]) { 230857b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 230957b61080SScott Feldman struct nlattr *attr; 231057b61080SScott Feldman int vf; 231157b61080SScott Feldman int rem; 231257b61080SScott Feldman 231357b61080SScott Feldman err = -EOPNOTSUPP; 231457b61080SScott Feldman if (!ops->ndo_set_vf_port) 231557b61080SScott Feldman goto errout; 231657b61080SScott Feldman 231757b61080SScott Feldman nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { 2318035d210fSDaniel Borkmann if (nla_type(attr) != IFLA_VF_PORT || 2319035d210fSDaniel Borkmann nla_len(attr) < NLA_HDRLEN) { 2320035d210fSDaniel Borkmann err = -EINVAL; 2321035d210fSDaniel Borkmann goto errout; 2322035d210fSDaniel Borkmann } 2323035d210fSDaniel Borkmann err = nla_parse_nested(port, IFLA_PORT_MAX, attr, 2324fceb6435SJohannes Berg ifla_port_policy, NULL); 232557b61080SScott Feldman if (err < 0) 232657b61080SScott Feldman goto errout; 232757b61080SScott Feldman if (!port[IFLA_PORT_VF]) { 232857b61080SScott Feldman err = -EOPNOTSUPP; 232957b61080SScott Feldman goto errout; 233057b61080SScott Feldman } 233157b61080SScott Feldman vf = nla_get_u32(port[IFLA_PORT_VF]); 233257b61080SScott Feldman err = ops->ndo_set_vf_port(dev, vf, port); 233357b61080SScott Feldman if (err < 0) 233457b61080SScott Feldman goto errout; 2335ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 233657b61080SScott Feldman } 233757b61080SScott Feldman } 233857b61080SScott Feldman err = 0; 233957b61080SScott Feldman 234057b61080SScott Feldman if (tb[IFLA_PORT_SELF]) { 234157b61080SScott Feldman struct nlattr *port[IFLA_PORT_MAX+1]; 234257b61080SScott Feldman 234357b61080SScott Feldman err = nla_parse_nested(port, IFLA_PORT_MAX, 2344fceb6435SJohannes Berg tb[IFLA_PORT_SELF], ifla_port_policy, 2345fceb6435SJohannes Berg NULL); 234657b61080SScott Feldman if (err < 0) 234757b61080SScott Feldman goto errout; 234857b61080SScott Feldman 234957b61080SScott Feldman err = -EOPNOTSUPP; 235057b61080SScott Feldman if (ops->ndo_set_vf_port) 235157b61080SScott Feldman err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); 235257b61080SScott Feldman if (err < 0) 235357b61080SScott Feldman goto errout; 2354ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 235557b61080SScott Feldman } 2356f8ff182cSThomas Graf 2357f8ff182cSThomas Graf if (tb[IFLA_AF_SPEC]) { 2358f8ff182cSThomas Graf struct nlattr *af; 2359f8ff182cSThomas Graf int rem; 2360f8ff182cSThomas Graf 2361f8ff182cSThomas Graf nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) { 2362f8ff182cSThomas Graf const struct rtnl_af_ops *af_ops; 2363f8ff182cSThomas Graf 23645fa85a09SFlorian Westphal rcu_read_lock(); 23655fa85a09SFlorian Westphal 2366058c8d59SGustavo A. R. Silva BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af)))); 2367f8ff182cSThomas Graf 2368cf7afbfeSThomas Graf err = af_ops->set_link_af(dev, af); 23695fa85a09SFlorian Westphal if (err < 0) { 23705fa85a09SFlorian Westphal rcu_read_unlock(); 2371f8ff182cSThomas Graf goto errout; 23725fa85a09SFlorian Westphal } 2373f8ff182cSThomas Graf 23745fa85a09SFlorian Westphal rcu_read_unlock(); 2375ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2376f8ff182cSThomas Graf } 2377f8ff182cSThomas Graf } 237857b61080SScott Feldman err = 0; 237957b61080SScott Feldman 238088d6378bSAnuradha Karuppiah if (tb[IFLA_PROTO_DOWN]) { 238188d6378bSAnuradha Karuppiah err = dev_change_proto_down(dev, 238288d6378bSAnuradha Karuppiah nla_get_u8(tb[IFLA_PROTO_DOWN])); 238388d6378bSAnuradha Karuppiah if (err) 238488d6378bSAnuradha Karuppiah goto errout; 238588d6378bSAnuradha Karuppiah status |= DO_SETLINK_NOTIFY; 238688d6378bSAnuradha Karuppiah } 238788d6378bSAnuradha Karuppiah 2388d1fdd913SBrenden Blanco if (tb[IFLA_XDP]) { 2389d1fdd913SBrenden Blanco struct nlattr *xdp[IFLA_XDP_MAX + 1]; 239085de8576SDaniel Borkmann u32 xdp_flags = 0; 2391d1fdd913SBrenden Blanco 2392d1fdd913SBrenden Blanco err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP], 2393fceb6435SJohannes Berg ifla_xdp_policy, NULL); 2394d1fdd913SBrenden Blanco if (err < 0) 2395d1fdd913SBrenden Blanco goto errout; 2396d1fdd913SBrenden Blanco 239758038695SMartin KaFai Lau if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) { 2398262d8625SBrenden Blanco err = -EINVAL; 2399262d8625SBrenden Blanco goto errout; 2400262d8625SBrenden Blanco } 240185de8576SDaniel Borkmann 240285de8576SDaniel Borkmann if (xdp[IFLA_XDP_FLAGS]) { 240385de8576SDaniel Borkmann xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]); 240485de8576SDaniel Borkmann if (xdp_flags & ~XDP_FLAGS_MASK) { 240585de8576SDaniel Borkmann err = -EINVAL; 240685de8576SDaniel Borkmann goto errout; 240785de8576SDaniel Borkmann } 2408ee5d032fSJakub Kicinski if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) { 24090489df9aSDaniel Borkmann err = -EINVAL; 24100489df9aSDaniel Borkmann goto errout; 24110489df9aSDaniel Borkmann } 241285de8576SDaniel Borkmann } 241385de8576SDaniel Borkmann 2414d1fdd913SBrenden Blanco if (xdp[IFLA_XDP_FD]) { 2415ddf9f970SJakub Kicinski err = dev_change_xdp_fd(dev, extack, 241685de8576SDaniel Borkmann nla_get_s32(xdp[IFLA_XDP_FD]), 241785de8576SDaniel Borkmann xdp_flags); 2418d1fdd913SBrenden Blanco if (err) 2419d1fdd913SBrenden Blanco goto errout; 2420d1fdd913SBrenden Blanco status |= DO_SETLINK_NOTIFY; 2421d1fdd913SBrenden Blanco } 2422d1fdd913SBrenden Blanco } 2423d1fdd913SBrenden Blanco 24240157f60cSPatrick McHardy errout: 2425ba998906SNicolas Dichtel if (status & DO_SETLINK_MODIFIED) { 242664ff90ccSXin Long if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY) 2427ba998906SNicolas Dichtel netdev_state_change(dev); 2428ba998906SNicolas Dichtel 2429ba998906SNicolas Dichtel if (err < 0) 2430e87cc472SJoe 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", 2431e87cc472SJoe Perches dev->name); 2432ba998906SNicolas Dichtel } 24330157f60cSPatrick McHardy 24340157f60cSPatrick McHardy return err; 24350157f60cSPatrick McHardy } 24360157f60cSPatrick McHardy 2437c21ef3e3SDavid Ahern static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2438c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2439da5e0494SThomas Graf { 24403b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 2441da5e0494SThomas Graf struct ifinfomsg *ifm; 2442da5e0494SThomas Graf struct net_device *dev; 24430157f60cSPatrick McHardy int err; 2444da5e0494SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 24451da177e4SLinus Torvalds char ifname[IFNAMSIZ]; 24461da177e4SLinus Torvalds 2447c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, 2448c21ef3e3SDavid Ahern extack); 2449da5e0494SThomas Graf if (err < 0) 2450da5e0494SThomas Graf goto errout; 24511da177e4SLinus Torvalds 245279e1ad14SJiri Benc if (tb[IFLA_IF_NETNSID]) 245379e1ad14SJiri Benc return -EOPNOTSUPP; 245479e1ad14SJiri Benc 24555176f91eSThomas Graf if (tb[IFLA_IFNAME]) 24565176f91eSThomas Graf nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 245778e5b891SPatrick McHardy else 245878e5b891SPatrick McHardy ifname[0] = '\0'; 24591da177e4SLinus Torvalds 24601da177e4SLinus Torvalds err = -EINVAL; 2461da5e0494SThomas Graf ifm = nlmsg_data(nlh); 246251055be8SPatrick McHardy if (ifm->ifi_index > 0) 2463a3d12891SEric Dumazet dev = __dev_get_by_index(net, ifm->ifi_index); 2464da5e0494SThomas Graf else if (tb[IFLA_IFNAME]) 2465a3d12891SEric Dumazet dev = __dev_get_by_name(net, ifname); 2466da5e0494SThomas Graf else 2467da5e0494SThomas Graf goto errout; 24681da177e4SLinus Torvalds 2469da5e0494SThomas Graf if (dev == NULL) { 2470da5e0494SThomas Graf err = -ENODEV; 2471da5e0494SThomas Graf goto errout; 2472da5e0494SThomas Graf } 24731da177e4SLinus Torvalds 2474e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2475e0d087afSEric Dumazet if (err < 0) 2476a3d12891SEric Dumazet goto errout; 2477da5e0494SThomas Graf 2478ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0); 2479da5e0494SThomas Graf errout: 24801da177e4SLinus Torvalds return err; 24811da177e4SLinus Torvalds } 24821da177e4SLinus Torvalds 248366400d54SWANG Cong static int rtnl_group_dellink(const struct net *net, int group) 248466400d54SWANG Cong { 248566400d54SWANG Cong struct net_device *dev, *aux; 248666400d54SWANG Cong LIST_HEAD(list_kill); 248766400d54SWANG Cong bool found = false; 248866400d54SWANG Cong 248966400d54SWANG Cong if (!group) 249066400d54SWANG Cong return -EPERM; 249166400d54SWANG Cong 249266400d54SWANG Cong for_each_netdev(net, dev) { 249366400d54SWANG Cong if (dev->group == group) { 249466400d54SWANG Cong const struct rtnl_link_ops *ops; 249566400d54SWANG Cong 249666400d54SWANG Cong found = true; 249766400d54SWANG Cong ops = dev->rtnl_link_ops; 249866400d54SWANG Cong if (!ops || !ops->dellink) 249966400d54SWANG Cong return -EOPNOTSUPP; 250066400d54SWANG Cong } 250166400d54SWANG Cong } 250266400d54SWANG Cong 250366400d54SWANG Cong if (!found) 250466400d54SWANG Cong return -ENODEV; 250566400d54SWANG Cong 250666400d54SWANG Cong for_each_netdev_safe(net, dev, aux) { 250766400d54SWANG Cong if (dev->group == group) { 250866400d54SWANG Cong const struct rtnl_link_ops *ops; 250966400d54SWANG Cong 251066400d54SWANG Cong ops = dev->rtnl_link_ops; 251166400d54SWANG Cong ops->dellink(dev, &list_kill); 251266400d54SWANG Cong } 251366400d54SWANG Cong } 251466400d54SWANG Cong unregister_netdevice_many(&list_kill); 251566400d54SWANG Cong 251666400d54SWANG Cong return 0; 251766400d54SWANG Cong } 251866400d54SWANG Cong 2519614732eaSThomas Graf int rtnl_delete_link(struct net_device *dev) 2520614732eaSThomas Graf { 2521614732eaSThomas Graf const struct rtnl_link_ops *ops; 2522614732eaSThomas Graf LIST_HEAD(list_kill); 2523614732eaSThomas Graf 2524614732eaSThomas Graf ops = dev->rtnl_link_ops; 2525614732eaSThomas Graf if (!ops || !ops->dellink) 2526614732eaSThomas Graf return -EOPNOTSUPP; 2527614732eaSThomas Graf 2528614732eaSThomas Graf ops->dellink(dev, &list_kill); 2529614732eaSThomas Graf unregister_netdevice_many(&list_kill); 2530614732eaSThomas Graf 2531614732eaSThomas Graf return 0; 2532614732eaSThomas Graf } 2533614732eaSThomas Graf EXPORT_SYMBOL_GPL(rtnl_delete_link); 2534614732eaSThomas Graf 2535c21ef3e3SDavid Ahern static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 2536c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 253738f7b870SPatrick McHardy { 25383b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 253938f7b870SPatrick McHardy struct net_device *dev; 254038f7b870SPatrick McHardy struct ifinfomsg *ifm; 254138f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 254238f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 254338f7b870SPatrick McHardy int err; 254438f7b870SPatrick McHardy 2545c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 254638f7b870SPatrick McHardy if (err < 0) 254738f7b870SPatrick McHardy return err; 254838f7b870SPatrick McHardy 254979e1ad14SJiri Benc if (tb[IFLA_IF_NETNSID]) 255079e1ad14SJiri Benc return -EOPNOTSUPP; 255179e1ad14SJiri Benc 255238f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 255338f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 255438f7b870SPatrick McHardy 255538f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 255638f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2557881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 255838f7b870SPatrick McHardy else if (tb[IFLA_IFNAME]) 2559881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 256066400d54SWANG Cong else if (tb[IFLA_GROUP]) 256166400d54SWANG Cong return rtnl_group_dellink(net, nla_get_u32(tb[IFLA_GROUP])); 256238f7b870SPatrick McHardy else 256338f7b870SPatrick McHardy return -EINVAL; 256438f7b870SPatrick McHardy 256538f7b870SPatrick McHardy if (!dev) 256638f7b870SPatrick McHardy return -ENODEV; 256738f7b870SPatrick McHardy 2568614732eaSThomas Graf return rtnl_delete_link(dev); 256938f7b870SPatrick McHardy } 257038f7b870SPatrick McHardy 25713729d502SPatrick McHardy int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) 25723729d502SPatrick McHardy { 25733729d502SPatrick McHardy unsigned int old_flags; 25743729d502SPatrick McHardy int err; 25753729d502SPatrick McHardy 25763729d502SPatrick McHardy old_flags = dev->flags; 25773729d502SPatrick McHardy if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { 25783729d502SPatrick McHardy err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); 25793729d502SPatrick McHardy if (err < 0) 25803729d502SPatrick McHardy return err; 25813729d502SPatrick McHardy } 25823729d502SPatrick McHardy 25833729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZED; 25843729d502SPatrick McHardy 2585a528c219SNicolas Dichtel __dev_notify_flags(dev, old_flags, ~0U); 25863729d502SPatrick McHardy return 0; 25873729d502SPatrick McHardy } 25883729d502SPatrick McHardy EXPORT_SYMBOL(rtnl_configure_link); 25893729d502SPatrick McHardy 2590c0713563SRami Rosen struct net_device *rtnl_create_link(struct net *net, 259178ebb0d0SThomas Graf const char *ifname, unsigned char name_assign_type, 25925517750fSTom Gundersen const struct rtnl_link_ops *ops, struct nlattr *tb[]) 2593e7199288SPavel Emelianov { 2594e7199288SPavel Emelianov struct net_device *dev; 2595d40156aaSJiri Pirko unsigned int num_tx_queues = 1; 2596d40156aaSJiri Pirko unsigned int num_rx_queues = 1; 2597e7199288SPavel Emelianov 259876ff5cc9SJiri Pirko if (tb[IFLA_NUM_TX_QUEUES]) 259976ff5cc9SJiri Pirko num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]); 260076ff5cc9SJiri Pirko else if (ops->get_num_tx_queues) 2601d40156aaSJiri Pirko num_tx_queues = ops->get_num_tx_queues(); 260276ff5cc9SJiri Pirko 260376ff5cc9SJiri Pirko if (tb[IFLA_NUM_RX_QUEUES]) 260476ff5cc9SJiri Pirko num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]); 260576ff5cc9SJiri Pirko else if (ops->get_num_rx_queues) 2606d40156aaSJiri Pirko num_rx_queues = ops->get_num_rx_queues(); 2607efacb309Sstephen hemminger 26085517750fSTom Gundersen dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type, 2609c835a677STom Gundersen ops->setup, num_tx_queues, num_rx_queues); 2610e7199288SPavel Emelianov if (!dev) 2611d1892e4eSTobias Klauser return ERR_PTR(-ENOMEM); 2612e7199288SPavel Emelianov 261381adee47SEric W. Biederman dev_net_set(dev, net); 261481adee47SEric W. Biederman dev->rtnl_link_ops = ops; 26153729d502SPatrick McHardy dev->rtnl_link_state = RTNL_LINK_INITIALIZING; 261681adee47SEric W. Biederman 2617e7199288SPavel Emelianov if (tb[IFLA_MTU]) 2618e7199288SPavel Emelianov dev->mtu = nla_get_u32(tb[IFLA_MTU]); 26192afb9b53SJiri Pirko if (tb[IFLA_ADDRESS]) { 2620e7199288SPavel Emelianov memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), 2621e7199288SPavel Emelianov nla_len(tb[IFLA_ADDRESS])); 26222afb9b53SJiri Pirko dev->addr_assign_type = NET_ADDR_SET; 26232afb9b53SJiri Pirko } 2624e7199288SPavel Emelianov if (tb[IFLA_BROADCAST]) 2625e7199288SPavel Emelianov memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), 2626e7199288SPavel Emelianov nla_len(tb[IFLA_BROADCAST])); 2627e7199288SPavel Emelianov if (tb[IFLA_TXQLEN]) 2628e7199288SPavel Emelianov dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); 2629e7199288SPavel Emelianov if (tb[IFLA_OPERSTATE]) 263093b2d4a2SDavid S. Miller set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); 2631e7199288SPavel Emelianov if (tb[IFLA_LINKMODE]) 2632e7199288SPavel Emelianov dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); 2633ffa934f1SPatrick McHardy if (tb[IFLA_GROUP]) 2634ffa934f1SPatrick McHardy dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP])); 2635e7199288SPavel Emelianov 2636e7199288SPavel Emelianov return dev; 2637e7199288SPavel Emelianov } 2638e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_create_link); 2639e7199288SPavel Emelianov 264090f62cf3SEric W. Biederman static int rtnl_group_changelink(const struct sk_buff *skb, 264190f62cf3SEric W. Biederman struct net *net, int group, 2642e7ed828fSVlad Dogaru struct ifinfomsg *ifm, 2643ddf9f970SJakub Kicinski struct netlink_ext_ack *extack, 2644e7ed828fSVlad Dogaru struct nlattr **tb) 2645e7ed828fSVlad Dogaru { 2646d079535dSWANG Cong struct net_device *dev, *aux; 2647e7ed828fSVlad Dogaru int err; 2648e7ed828fSVlad Dogaru 2649d079535dSWANG Cong for_each_netdev_safe(net, dev, aux) { 2650e7ed828fSVlad Dogaru if (dev->group == group) { 2651ddf9f970SJakub Kicinski err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0); 2652e7ed828fSVlad Dogaru if (err < 0) 2653e7ed828fSVlad Dogaru return err; 2654e7ed828fSVlad Dogaru } 2655e7ed828fSVlad Dogaru } 2656e7ed828fSVlad Dogaru 2657e7ed828fSVlad Dogaru return 0; 2658e7ed828fSVlad Dogaru } 2659e7ed828fSVlad Dogaru 2660c21ef3e3SDavid Ahern static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2661c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 266238f7b870SPatrick McHardy { 26633b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 266438f7b870SPatrick McHardy const struct rtnl_link_ops *ops; 2665ba7d49b1SJiri Pirko const struct rtnl_link_ops *m_ops = NULL; 266638f7b870SPatrick McHardy struct net_device *dev; 2667ba7d49b1SJiri Pirko struct net_device *master_dev = NULL; 266838f7b870SPatrick McHardy struct ifinfomsg *ifm; 266938f7b870SPatrick McHardy char kind[MODULE_NAME_LEN]; 267038f7b870SPatrick McHardy char ifname[IFNAMSIZ]; 267138f7b870SPatrick McHardy struct nlattr *tb[IFLA_MAX+1]; 267238f7b870SPatrick McHardy struct nlattr *linkinfo[IFLA_INFO_MAX+1]; 26735517750fSTom Gundersen unsigned char name_assign_type = NET_NAME_USER; 267438f7b870SPatrick McHardy int err; 267538f7b870SPatrick McHardy 267695a5afcaSJohannes Berg #ifdef CONFIG_MODULES 267738f7b870SPatrick McHardy replay: 26788072f085SThomas Graf #endif 2679c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 268038f7b870SPatrick McHardy if (err < 0) 268138f7b870SPatrick McHardy return err; 268238f7b870SPatrick McHardy 268379e1ad14SJiri Benc if (tb[IFLA_IF_NETNSID]) 268479e1ad14SJiri Benc return -EOPNOTSUPP; 268579e1ad14SJiri Benc 268638f7b870SPatrick McHardy if (tb[IFLA_IFNAME]) 268738f7b870SPatrick McHardy nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 268838f7b870SPatrick McHardy else 268938f7b870SPatrick McHardy ifname[0] = '\0'; 269038f7b870SPatrick McHardy 269138f7b870SPatrick McHardy ifm = nlmsg_data(nlh); 269238f7b870SPatrick McHardy if (ifm->ifi_index > 0) 2693881d966bSEric W. Biederman dev = __dev_get_by_index(net, ifm->ifi_index); 2694e7ed828fSVlad Dogaru else { 2695e7ed828fSVlad Dogaru if (ifname[0]) 2696881d966bSEric W. Biederman dev = __dev_get_by_name(net, ifname); 269738f7b870SPatrick McHardy else 269838f7b870SPatrick McHardy dev = NULL; 2699e7ed828fSVlad Dogaru } 270038f7b870SPatrick McHardy 2701ba7d49b1SJiri Pirko if (dev) { 2702ba7d49b1SJiri Pirko master_dev = netdev_master_upper_dev_get(dev); 2703ba7d49b1SJiri Pirko if (master_dev) 2704ba7d49b1SJiri Pirko m_ops = master_dev->rtnl_link_ops; 2705ba7d49b1SJiri Pirko } 2706ba7d49b1SJiri Pirko 2707e0d087afSEric Dumazet err = validate_linkmsg(dev, tb); 2708e0d087afSEric Dumazet if (err < 0) 27091840bb13SThomas Graf return err; 27101840bb13SThomas Graf 271138f7b870SPatrick McHardy if (tb[IFLA_LINKINFO]) { 271238f7b870SPatrick McHardy err = nla_parse_nested(linkinfo, IFLA_INFO_MAX, 2713fceb6435SJohannes Berg tb[IFLA_LINKINFO], ifla_info_policy, 2714fceb6435SJohannes Berg NULL); 271538f7b870SPatrick McHardy if (err < 0) 271638f7b870SPatrick McHardy return err; 271738f7b870SPatrick McHardy } else 271838f7b870SPatrick McHardy memset(linkinfo, 0, sizeof(linkinfo)); 271938f7b870SPatrick McHardy 272038f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_KIND]) { 272138f7b870SPatrick McHardy nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); 272238f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 272338f7b870SPatrick McHardy } else { 272438f7b870SPatrick McHardy kind[0] = '\0'; 272538f7b870SPatrick McHardy ops = NULL; 272638f7b870SPatrick McHardy } 272738f7b870SPatrick McHardy 272838f7b870SPatrick McHardy if (1) { 27294e10fd5bSSasha Levin struct nlattr *attr[ops ? ops->maxtype + 1 : 1]; 27304e10fd5bSSasha Levin struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1]; 2731ba7d49b1SJiri Pirko struct nlattr **data = NULL; 2732ba7d49b1SJiri Pirko struct nlattr **slave_data = NULL; 2733317f4810SNicolas Dichtel struct net *dest_net, *link_net = NULL; 273438f7b870SPatrick McHardy 273538f7b870SPatrick McHardy if (ops) { 273638f7b870SPatrick McHardy if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { 273738f7b870SPatrick McHardy err = nla_parse_nested(attr, ops->maxtype, 273838f7b870SPatrick McHardy linkinfo[IFLA_INFO_DATA], 2739fceb6435SJohannes Berg ops->policy, NULL); 274038f7b870SPatrick McHardy if (err < 0) 274138f7b870SPatrick McHardy return err; 274238f7b870SPatrick McHardy data = attr; 274338f7b870SPatrick McHardy } 274438f7b870SPatrick McHardy if (ops->validate) { 2745a8b8a889SMatthias Schiffer err = ops->validate(tb, data, extack); 274638f7b870SPatrick McHardy if (err < 0) 274738f7b870SPatrick McHardy return err; 274838f7b870SPatrick McHardy } 274938f7b870SPatrick McHardy } 275038f7b870SPatrick McHardy 2751ba7d49b1SJiri Pirko if (m_ops) { 2752ba7d49b1SJiri Pirko if (m_ops->slave_maxtype && 2753ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA]) { 2754ba7d49b1SJiri Pirko err = nla_parse_nested(slave_attr, 2755ba7d49b1SJiri Pirko m_ops->slave_maxtype, 2756ba7d49b1SJiri Pirko linkinfo[IFLA_INFO_SLAVE_DATA], 2757fceb6435SJohannes Berg m_ops->slave_policy, 2758fceb6435SJohannes Berg NULL); 2759ba7d49b1SJiri Pirko if (err < 0) 2760ba7d49b1SJiri Pirko return err; 2761ba7d49b1SJiri Pirko slave_data = slave_attr; 2762ba7d49b1SJiri Pirko } 2763ba7d49b1SJiri Pirko } 2764ba7d49b1SJiri Pirko 276538f7b870SPatrick McHardy if (dev) { 276690c325e3SNicolas Dichtel int status = 0; 276738f7b870SPatrick McHardy 276838f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_EXCL) 276938f7b870SPatrick McHardy return -EEXIST; 277038f7b870SPatrick McHardy if (nlh->nlmsg_flags & NLM_F_REPLACE) 277138f7b870SPatrick McHardy return -EOPNOTSUPP; 277238f7b870SPatrick McHardy 277338f7b870SPatrick McHardy if (linkinfo[IFLA_INFO_DATA]) { 277438f7b870SPatrick McHardy if (!ops || ops != dev->rtnl_link_ops || 277538f7b870SPatrick McHardy !ops->changelink) 277638f7b870SPatrick McHardy return -EOPNOTSUPP; 277738f7b870SPatrick McHardy 2778ad744b22SMatthias Schiffer err = ops->changelink(dev, tb, data, extack); 277938f7b870SPatrick McHardy if (err < 0) 278038f7b870SPatrick McHardy return err; 2781ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 278238f7b870SPatrick McHardy } 278338f7b870SPatrick McHardy 2784ba7d49b1SJiri Pirko if (linkinfo[IFLA_INFO_SLAVE_DATA]) { 2785ba7d49b1SJiri Pirko if (!m_ops || !m_ops->slave_changelink) 2786ba7d49b1SJiri Pirko return -EOPNOTSUPP; 2787ba7d49b1SJiri Pirko 2788ba7d49b1SJiri Pirko err = m_ops->slave_changelink(master_dev, dev, 278917dd0ec4SMatthias Schiffer tb, slave_data, 279017dd0ec4SMatthias Schiffer extack); 2791ba7d49b1SJiri Pirko if (err < 0) 2792ba7d49b1SJiri Pirko return err; 2793ba998906SNicolas Dichtel status |= DO_SETLINK_NOTIFY; 2794ba7d49b1SJiri Pirko } 2795ba7d49b1SJiri Pirko 2796ddf9f970SJakub Kicinski return do_setlink(skb, dev, ifm, extack, tb, ifname, 2797ddf9f970SJakub Kicinski status); 279838f7b870SPatrick McHardy } 279938f7b870SPatrick McHardy 2800ffa934f1SPatrick McHardy if (!(nlh->nlmsg_flags & NLM_F_CREATE)) { 2801ffa934f1SPatrick McHardy if (ifm->ifi_index == 0 && tb[IFLA_GROUP]) 280290f62cf3SEric W. Biederman return rtnl_group_changelink(skb, net, 2803ffa934f1SPatrick McHardy nla_get_u32(tb[IFLA_GROUP]), 2804ddf9f970SJakub Kicinski ifm, extack, tb); 280538f7b870SPatrick McHardy return -ENODEV; 2806ffa934f1SPatrick McHardy } 280738f7b870SPatrick McHardy 2808160ca014STheuns Verwoerd if (tb[IFLA_MAP] || tb[IFLA_PROTINFO]) 280938f7b870SPatrick McHardy return -EOPNOTSUPP; 281038f7b870SPatrick McHardy 281138f7b870SPatrick McHardy if (!ops) { 281295a5afcaSJohannes Berg #ifdef CONFIG_MODULES 281338f7b870SPatrick McHardy if (kind[0]) { 281438f7b870SPatrick McHardy __rtnl_unlock(); 281538f7b870SPatrick McHardy request_module("rtnl-link-%s", kind); 281638f7b870SPatrick McHardy rtnl_lock(); 281738f7b870SPatrick McHardy ops = rtnl_link_ops_get(kind); 281838f7b870SPatrick McHardy if (ops) 281938f7b870SPatrick McHardy goto replay; 282038f7b870SPatrick McHardy } 282138f7b870SPatrick McHardy #endif 282238f7b870SPatrick McHardy return -EOPNOTSUPP; 282338f7b870SPatrick McHardy } 282438f7b870SPatrick McHardy 2825b0ab2fabSJiri Pirko if (!ops->setup) 2826b0ab2fabSJiri Pirko return -EOPNOTSUPP; 2827b0ab2fabSJiri Pirko 28285517750fSTom Gundersen if (!ifname[0]) { 282938f7b870SPatrick McHardy snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); 28305517750fSTom Gundersen name_assign_type = NET_NAME_ENUM; 28315517750fSTom Gundersen } 283238f7b870SPatrick McHardy 283381adee47SEric W. Biederman dest_net = rtnl_link_get_net(net, tb); 283413ad1774SEric W. Biederman if (IS_ERR(dest_net)) 283513ad1774SEric W. Biederman return PTR_ERR(dest_net); 283613ad1774SEric W. Biederman 2837505ce415SEric W. Biederman err = -EPERM; 2838505ce415SEric W. Biederman if (!netlink_ns_capable(skb, dest_net->user_ns, CAP_NET_ADMIN)) 2839505ce415SEric W. Biederman goto out; 2840505ce415SEric W. Biederman 2841317f4810SNicolas Dichtel if (tb[IFLA_LINK_NETNSID]) { 2842317f4810SNicolas Dichtel int id = nla_get_s32(tb[IFLA_LINK_NETNSID]); 2843317f4810SNicolas Dichtel 2844317f4810SNicolas Dichtel link_net = get_net_ns_by_id(dest_net, id); 2845317f4810SNicolas Dichtel if (!link_net) { 2846317f4810SNicolas Dichtel err = -EINVAL; 2847317f4810SNicolas Dichtel goto out; 2848317f4810SNicolas Dichtel } 284906615bedSEric W. Biederman err = -EPERM; 285006615bedSEric W. Biederman if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN)) 285106615bedSEric W. Biederman goto out; 2852317f4810SNicolas Dichtel } 2853317f4810SNicolas Dichtel 2854317f4810SNicolas Dichtel dev = rtnl_create_link(link_net ? : dest_net, ifname, 2855317f4810SNicolas Dichtel name_assign_type, ops, tb); 28569c7dafbfSPavel Emelyanov if (IS_ERR(dev)) { 2857e7199288SPavel Emelianov err = PTR_ERR(dev); 28589c7dafbfSPavel Emelyanov goto out; 28599c7dafbfSPavel Emelyanov } 28609c7dafbfSPavel Emelyanov 28619c7dafbfSPavel Emelyanov dev->ifindex = ifm->ifi_index; 28629c7dafbfSPavel Emelyanov 28630e0eee24SCong Wang if (ops->newlink) { 28647a3f4a18SMatthias Schiffer err = ops->newlink(link_net ? : net, dev, tb, data, 28657a3f4a18SMatthias Schiffer extack); 28660e0eee24SCong Wang /* Drivers should call free_netdev() in ->destructor 2867e51fb152SCong Wang * and unregister it on failure after registration 2868e51fb152SCong Wang * so that device could be finally freed in rtnl_unlock. 28690e0eee24SCong Wang */ 2870e51fb152SCong Wang if (err < 0) { 2871e51fb152SCong Wang /* If device is not registered at all, free it now */ 2872e51fb152SCong Wang if (dev->reg_state == NETREG_UNINITIALIZED) 2873e51fb152SCong Wang free_netdev(dev); 28740e0eee24SCong Wang goto out; 2875e51fb152SCong Wang } 28760e0eee24SCong Wang } else { 28772d85cba2SPatrick McHardy err = register_netdevice(dev); 2878fce9b9beSDan Carpenter if (err < 0) { 287938f7b870SPatrick McHardy free_netdev(dev); 28803729d502SPatrick McHardy goto out; 2881fce9b9beSDan Carpenter } 28820e0eee24SCong Wang } 28833729d502SPatrick McHardy err = rtnl_configure_link(dev, ifm); 288443638900SDavid S. Miller if (err < 0) 288543638900SDavid S. Miller goto out_unregister; 288643638900SDavid S. Miller if (link_net) { 288743638900SDavid S. Miller err = dev_change_net_namespace(dev, dest_net, ifname); 288843638900SDavid S. Miller if (err < 0) 288943638900SDavid S. Miller goto out_unregister; 289043638900SDavid S. Miller } 2891160ca014STheuns Verwoerd if (tb[IFLA_MASTER]) { 289233eaf2a6SDavid Ahern err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), 289333eaf2a6SDavid Ahern extack); 2894160ca014STheuns Verwoerd if (err) 2895160ca014STheuns Verwoerd goto out_unregister; 2896160ca014STheuns Verwoerd } 289743638900SDavid S. Miller out: 289843638900SDavid S. Miller if (link_net) 289943638900SDavid S. Miller put_net(link_net); 290043638900SDavid S. Miller put_net(dest_net); 290143638900SDavid S. Miller return err; 290243638900SDavid S. Miller out_unregister: 29037afb8886SWANG Cong if (ops->newlink) { 29047afb8886SWANG Cong LIST_HEAD(list_kill); 29057afb8886SWANG Cong 29067afb8886SWANG Cong ops->dellink(dev, &list_kill); 29077afb8886SWANG Cong unregister_netdevice_many(&list_kill); 29087afb8886SWANG Cong } else { 29093729d502SPatrick McHardy unregister_netdevice(dev); 29107afb8886SWANG Cong } 2911317f4810SNicolas Dichtel goto out; 2912317f4810SNicolas Dichtel } 291338f7b870SPatrick McHardy } 291438f7b870SPatrick McHardy 2915c21ef3e3SDavid Ahern static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh, 2916c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 2917711e2c33SJean Tourrilhes { 29183b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 291979e1ad14SJiri Benc struct net *tgt_net = net; 2920b60c5115SThomas Graf struct ifinfomsg *ifm; 2921a3d12891SEric Dumazet char ifname[IFNAMSIZ]; 2922b60c5115SThomas Graf struct nlattr *tb[IFLA_MAX+1]; 2923b60c5115SThomas Graf struct net_device *dev = NULL; 2924b60c5115SThomas Graf struct sk_buff *nskb; 292579e1ad14SJiri Benc int netnsid = -1; 2926339bf98fSThomas Graf int err; 2927115c9b81SGreg Rose u32 ext_filter_mask = 0; 2928711e2c33SJean Tourrilhes 2929c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack); 2930b60c5115SThomas Graf if (err < 0) 29319918f230SEric Sesterhenn return err; 2932b60c5115SThomas Graf 293379e1ad14SJiri Benc if (tb[IFLA_IF_NETNSID]) { 293479e1ad14SJiri Benc netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]); 293579e1ad14SJiri Benc tgt_net = get_target_net(skb, netnsid); 293679e1ad14SJiri Benc if (IS_ERR(tgt_net)) 293779e1ad14SJiri Benc return PTR_ERR(tgt_net); 293879e1ad14SJiri Benc } 293979e1ad14SJiri Benc 2940a3d12891SEric Dumazet if (tb[IFLA_IFNAME]) 2941a3d12891SEric Dumazet nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); 2942a3d12891SEric Dumazet 2943115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2944115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2945115c9b81SGreg Rose 294679e1ad14SJiri Benc err = -EINVAL; 2947b60c5115SThomas Graf ifm = nlmsg_data(nlh); 2948a3d12891SEric Dumazet if (ifm->ifi_index > 0) 294979e1ad14SJiri Benc dev = __dev_get_by_index(tgt_net, ifm->ifi_index); 2950a3d12891SEric Dumazet else if (tb[IFLA_IFNAME]) 295179e1ad14SJiri Benc dev = __dev_get_by_name(tgt_net, ifname); 2952a3d12891SEric Dumazet else 295379e1ad14SJiri Benc goto out; 2954b60c5115SThomas Graf 295579e1ad14SJiri Benc err = -ENODEV; 2956a3d12891SEric Dumazet if (dev == NULL) 295779e1ad14SJiri Benc goto out; 2958a3d12891SEric Dumazet 295979e1ad14SJiri Benc err = -ENOBUFS; 2960115c9b81SGreg Rose nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL); 2961a3d12891SEric Dumazet if (nskb == NULL) 296279e1ad14SJiri Benc goto out; 2963711e2c33SJean Tourrilhes 296479e1ad14SJiri Benc err = rtnl_fill_ifinfo(nskb, dev, net, 296579e1ad14SJiri Benc RTM_NEWLINK, NETLINK_CB(skb).portid, 296679e1ad14SJiri Benc nlh->nlmsg_seq, 0, 0, ext_filter_mask, 296779e1ad14SJiri Benc 0, NULL, netnsid); 296826932566SPatrick McHardy if (err < 0) { 296926932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size */ 297026932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 297126932566SPatrick McHardy kfree_skb(nskb); 2972a3d12891SEric Dumazet } else 297315e47304SEric W. Biederman err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 297479e1ad14SJiri Benc out: 297579e1ad14SJiri Benc if (netnsid >= 0) 297679e1ad14SJiri Benc put_net(tgt_net); 2977b60c5115SThomas Graf 2978711e2c33SJean Tourrilhes return err; 2979711e2c33SJean Tourrilhes } 2980711e2c33SJean Tourrilhes 2981115c9b81SGreg Rose static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh) 2982c7ac8679SGreg Rose { 2983115c9b81SGreg Rose struct net *net = sock_net(skb->sk); 2984115c9b81SGreg Rose struct net_device *dev; 2985115c9b81SGreg Rose struct nlattr *tb[IFLA_MAX+1]; 2986115c9b81SGreg Rose u32 ext_filter_mask = 0; 2987115c9b81SGreg Rose u16 min_ifinfo_dump_size = 0; 2988e5eca6d4SMichal Schmidt int hdrlen; 2989115c9b81SGreg Rose 2990e5eca6d4SMichal Schmidt /* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */ 2991e5eca6d4SMichal Schmidt hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ? 2992e5eca6d4SMichal Schmidt sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg); 2993e5eca6d4SMichal Schmidt 2994fceb6435SJohannes Berg if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) { 2995115c9b81SGreg Rose if (tb[IFLA_EXT_MASK]) 2996115c9b81SGreg Rose ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]); 2997a4b64fbeSEric Dumazet } 2998115c9b81SGreg Rose 2999115c9b81SGreg Rose if (!ext_filter_mask) 3000115c9b81SGreg Rose return NLMSG_GOODSIZE; 3001115c9b81SGreg Rose /* 3002115c9b81SGreg Rose * traverse the list of net devices and compute the minimum 3003115c9b81SGreg Rose * buffer size based upon the filter mask. 3004115c9b81SGreg Rose */ 30056853dd48SFlorian Westphal rcu_read_lock(); 30066853dd48SFlorian Westphal for_each_netdev_rcu(net, dev) { 3007115c9b81SGreg Rose min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size, 3008115c9b81SGreg Rose if_nlmsg_size(dev, 3009115c9b81SGreg Rose ext_filter_mask)); 3010115c9b81SGreg Rose } 30116853dd48SFlorian Westphal rcu_read_unlock(); 3012115c9b81SGreg Rose 301393af2056SZhang Shengju return nlmsg_total_size(min_ifinfo_dump_size); 3014c7ac8679SGreg Rose } 3015c7ac8679SGreg Rose 301642bad1daSAdrian Bunk static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) 30171da177e4SLinus Torvalds { 30181da177e4SLinus Torvalds int idx; 30191da177e4SLinus Torvalds int s_idx = cb->family; 30201da177e4SLinus Torvalds 30211da177e4SLinus Torvalds if (s_idx == 0) 30221da177e4SLinus Torvalds s_idx = 1; 30236853dd48SFlorian Westphal 302425239ceeSPatrick McHardy for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { 3025*addf9b90SFlorian Westphal struct rtnl_link **tab; 30261da177e4SLinus Torvalds int type = cb->nlh->nlmsg_type-RTM_BASE; 3027*addf9b90SFlorian Westphal struct rtnl_link *link; 30286853dd48SFlorian Westphal rtnl_dumpit_func dumpit; 30296853dd48SFlorian Westphal 30301da177e4SLinus Torvalds if (idx < s_idx || idx == PF_PACKET) 30311da177e4SLinus Torvalds continue; 30326853dd48SFlorian Westphal 3033*addf9b90SFlorian Westphal if (type < 0 || type >= RTM_NR_MSGTYPES) 30341da177e4SLinus Torvalds continue; 30356853dd48SFlorian Westphal 3036*addf9b90SFlorian Westphal tab = rcu_dereference_rtnl(rtnl_msg_handlers[idx]); 3037*addf9b90SFlorian Westphal if (!tab) 3038*addf9b90SFlorian Westphal continue; 3039*addf9b90SFlorian Westphal 3040*addf9b90SFlorian Westphal link = tab[type]; 3041*addf9b90SFlorian Westphal if (!link) 3042*addf9b90SFlorian Westphal continue; 3043*addf9b90SFlorian Westphal 3044*addf9b90SFlorian Westphal dumpit = link->dumpit; 30456853dd48SFlorian Westphal if (!dumpit) 30466853dd48SFlorian Westphal continue; 30476853dd48SFlorian Westphal 30480465277fSNicolas Dichtel if (idx > s_idx) { 30491da177e4SLinus Torvalds memset(&cb->args[0], 0, sizeof(cb->args)); 30500465277fSNicolas Dichtel cb->prev_seq = 0; 30510465277fSNicolas Dichtel cb->seq = 0; 30520465277fSNicolas Dichtel } 30536853dd48SFlorian Westphal if (dumpit(skb, cb)) 30541da177e4SLinus Torvalds break; 30551da177e4SLinus Torvalds } 30561da177e4SLinus Torvalds cb->family = idx; 30571da177e4SLinus Torvalds 30581da177e4SLinus Torvalds return skb->len; 30591da177e4SLinus Torvalds } 30601da177e4SLinus Torvalds 3061395eea6cSMahesh Bandewar struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev, 30623d3ea5afSVlad Yasevich unsigned int change, 30636621dd29SNicolas Dichtel u32 event, gfp_t flags, int *new_nsid) 30641da177e4SLinus Torvalds { 3065c346dca1SYOSHIFUJI Hideaki struct net *net = dev_net(dev); 30661da177e4SLinus Torvalds struct sk_buff *skb; 30670ec6d3f4SThomas Graf int err = -ENOBUFS; 3068c7ac8679SGreg Rose size_t if_info_size; 30691da177e4SLinus Torvalds 30707f294054SAlexei Starovoitov skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags); 30710ec6d3f4SThomas Graf if (skb == NULL) 30720ec6d3f4SThomas Graf goto errout; 30731da177e4SLinus Torvalds 307479e1ad14SJiri Benc err = rtnl_fill_ifinfo(skb, dev, dev_net(dev), 307579e1ad14SJiri Benc type, 0, 0, change, 0, 0, event, 307679e1ad14SJiri Benc new_nsid, -1); 307726932566SPatrick McHardy if (err < 0) { 307826932566SPatrick McHardy /* -EMSGSIZE implies BUG in if_nlmsg_size() */ 307926932566SPatrick McHardy WARN_ON(err == -EMSGSIZE); 308026932566SPatrick McHardy kfree_skb(skb); 308126932566SPatrick McHardy goto errout; 308226932566SPatrick McHardy } 3083395eea6cSMahesh Bandewar return skb; 30840ec6d3f4SThomas Graf errout: 30850ec6d3f4SThomas Graf if (err < 0) 30864b3da706SEric W. Biederman rtnl_set_sk_err(net, RTNLGRP_LINK, err); 3087395eea6cSMahesh Bandewar return NULL; 3088395eea6cSMahesh Bandewar } 3089395eea6cSMahesh Bandewar 3090395eea6cSMahesh Bandewar void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags) 3091395eea6cSMahesh Bandewar { 3092395eea6cSMahesh Bandewar struct net *net = dev_net(dev); 3093395eea6cSMahesh Bandewar 3094395eea6cSMahesh Bandewar rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags); 3095395eea6cSMahesh Bandewar } 3096395eea6cSMahesh Bandewar 30973d3ea5afSVlad Yasevich static void rtmsg_ifinfo_event(int type, struct net_device *dev, 30983d3ea5afSVlad Yasevich unsigned int change, u32 event, 30996621dd29SNicolas Dichtel gfp_t flags, int *new_nsid) 3100395eea6cSMahesh Bandewar { 3101395eea6cSMahesh Bandewar struct sk_buff *skb; 3102395eea6cSMahesh Bandewar 3103ed2a80abSNicolas Dichtel if (dev->reg_state != NETREG_REGISTERED) 3104ed2a80abSNicolas Dichtel return; 3105ed2a80abSNicolas Dichtel 31066621dd29SNicolas Dichtel skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid); 3107395eea6cSMahesh Bandewar if (skb) 3108395eea6cSMahesh Bandewar rtmsg_ifinfo_send(skb, dev, flags); 31091da177e4SLinus Torvalds } 31103d3ea5afSVlad Yasevich 31113d3ea5afSVlad Yasevich void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change, 31123d3ea5afSVlad Yasevich gfp_t flags) 31133d3ea5afSVlad Yasevich { 31146621dd29SNicolas Dichtel rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, NULL); 31153d3ea5afSVlad Yasevich } 31161da177e4SLinus Torvalds 31176621dd29SNicolas Dichtel void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change, 31186621dd29SNicolas Dichtel gfp_t flags, int *new_nsid) 31196621dd29SNicolas Dichtel { 31206621dd29SNicolas Dichtel rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, 31216621dd29SNicolas Dichtel new_nsid); 31226621dd29SNicolas Dichtel } 31236621dd29SNicolas Dichtel 3124d83b0603SJohn Fastabend static int nlmsg_populate_fdb_fill(struct sk_buff *skb, 3125d83b0603SJohn Fastabend struct net_device *dev, 31261e53d5bbSHubert Sokolowski u8 *addr, u16 vid, u32 pid, u32 seq, 31271c104a6bSNicolas Dichtel int type, unsigned int flags, 3128b3379041SHubert Sokolowski int nlflags, u16 ndm_state) 3129d83b0603SJohn Fastabend { 3130d83b0603SJohn Fastabend struct nlmsghdr *nlh; 3131d83b0603SJohn Fastabend struct ndmsg *ndm; 3132d83b0603SJohn Fastabend 31331c104a6bSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags); 3134d83b0603SJohn Fastabend if (!nlh) 3135d83b0603SJohn Fastabend return -EMSGSIZE; 3136d83b0603SJohn Fastabend 3137d83b0603SJohn Fastabend ndm = nlmsg_data(nlh); 3138d83b0603SJohn Fastabend ndm->ndm_family = AF_BRIDGE; 3139d83b0603SJohn Fastabend ndm->ndm_pad1 = 0; 3140d83b0603SJohn Fastabend ndm->ndm_pad2 = 0; 3141d83b0603SJohn Fastabend ndm->ndm_flags = flags; 3142d83b0603SJohn Fastabend ndm->ndm_type = 0; 3143d83b0603SJohn Fastabend ndm->ndm_ifindex = dev->ifindex; 3144b3379041SHubert Sokolowski ndm->ndm_state = ndm_state; 3145d83b0603SJohn Fastabend 3146d83b0603SJohn Fastabend if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr)) 3147d83b0603SJohn Fastabend goto nla_put_failure; 31481e53d5bbSHubert Sokolowski if (vid) 31491e53d5bbSHubert Sokolowski if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid)) 31501e53d5bbSHubert Sokolowski goto nla_put_failure; 3151d83b0603SJohn Fastabend 3152053c095aSJohannes Berg nlmsg_end(skb, nlh); 3153053c095aSJohannes Berg return 0; 3154d83b0603SJohn Fastabend 3155d83b0603SJohn Fastabend nla_put_failure: 3156d83b0603SJohn Fastabend nlmsg_cancel(skb, nlh); 3157d83b0603SJohn Fastabend return -EMSGSIZE; 3158d83b0603SJohn Fastabend } 3159d83b0603SJohn Fastabend 31603ff661c3SJohn Fastabend static inline size_t rtnl_fdb_nlmsg_size(void) 31613ff661c3SJohn Fastabend { 3162f82ef3e1SSabrina Dubroca return NLMSG_ALIGN(sizeof(struct ndmsg)) + 3163f82ef3e1SSabrina Dubroca nla_total_size(ETH_ALEN) + /* NDA_LLADDR */ 3164f82ef3e1SSabrina Dubroca nla_total_size(sizeof(u16)) + /* NDA_VLAN */ 3165f82ef3e1SSabrina Dubroca 0; 31663ff661c3SJohn Fastabend } 31673ff661c3SJohn Fastabend 3168b3379041SHubert Sokolowski static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type, 3169b3379041SHubert Sokolowski u16 ndm_state) 31703ff661c3SJohn Fastabend { 31713ff661c3SJohn Fastabend struct net *net = dev_net(dev); 31723ff661c3SJohn Fastabend struct sk_buff *skb; 31733ff661c3SJohn Fastabend int err = -ENOBUFS; 31743ff661c3SJohn Fastabend 31753ff661c3SJohn Fastabend skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC); 31763ff661c3SJohn Fastabend if (!skb) 31773ff661c3SJohn Fastabend goto errout; 31783ff661c3SJohn Fastabend 31791e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, addr, vid, 3180b3379041SHubert Sokolowski 0, 0, type, NTF_SELF, 0, ndm_state); 31813ff661c3SJohn Fastabend if (err < 0) { 31823ff661c3SJohn Fastabend kfree_skb(skb); 31833ff661c3SJohn Fastabend goto errout; 31843ff661c3SJohn Fastabend } 31853ff661c3SJohn Fastabend 31863ff661c3SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC); 31873ff661c3SJohn Fastabend return; 31883ff661c3SJohn Fastabend errout: 31893ff661c3SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_NEIGH, err); 31903ff661c3SJohn Fastabend } 31913ff661c3SJohn Fastabend 3192090096bfSVlad Yasevich /** 3193090096bfSVlad Yasevich * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry 3194090096bfSVlad Yasevich */ 3195090096bfSVlad Yasevich int ndo_dflt_fdb_add(struct ndmsg *ndm, 3196090096bfSVlad Yasevich struct nlattr *tb[], 3197090096bfSVlad Yasevich struct net_device *dev, 3198f6f6424bSJiri Pirko const unsigned char *addr, u16 vid, 3199090096bfSVlad Yasevich u16 flags) 3200090096bfSVlad Yasevich { 3201090096bfSVlad Yasevich int err = -EINVAL; 3202090096bfSVlad Yasevich 3203090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3204090096bfSVlad Yasevich * implement its own handler for this. 3205090096bfSVlad Yasevich */ 3206090096bfSVlad Yasevich if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) { 3207090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3208090096bfSVlad Yasevich return err; 3209090096bfSVlad Yasevich } 3210090096bfSVlad Yasevich 321165891feaSOr Gerlitz if (vid) { 321265891feaSOr Gerlitz pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name); 321365891feaSOr Gerlitz return err; 321465891feaSOr Gerlitz } 321565891feaSOr Gerlitz 3216090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3217090096bfSVlad Yasevich err = dev_uc_add_excl(dev, addr); 3218090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3219090096bfSVlad Yasevich err = dev_mc_add_excl(dev, addr); 3220090096bfSVlad Yasevich 3221090096bfSVlad Yasevich /* Only return duplicate errors if NLM_F_EXCL is set */ 3222090096bfSVlad Yasevich if (err == -EEXIST && !(flags & NLM_F_EXCL)) 3223090096bfSVlad Yasevich err = 0; 3224090096bfSVlad Yasevich 3225090096bfSVlad Yasevich return err; 3226090096bfSVlad Yasevich } 3227090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_add); 3228090096bfSVlad Yasevich 3229b88d12e4SFlorian Westphal static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid, 3230b88d12e4SFlorian Westphal struct netlink_ext_ack *extack) 3231f6f6424bSJiri Pirko { 3232f6f6424bSJiri Pirko u16 vid = 0; 3233f6f6424bSJiri Pirko 3234f6f6424bSJiri Pirko if (vlan_attr) { 3235f6f6424bSJiri Pirko if (nla_len(vlan_attr) != sizeof(u16)) { 3236b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid vlan attribute size"); 3237f6f6424bSJiri Pirko return -EINVAL; 3238f6f6424bSJiri Pirko } 3239f6f6424bSJiri Pirko 3240f6f6424bSJiri Pirko vid = nla_get_u16(vlan_attr); 3241f6f6424bSJiri Pirko 3242f6f6424bSJiri Pirko if (!vid || vid >= VLAN_VID_MASK) { 3243b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid vlan id"); 3244f6f6424bSJiri Pirko return -EINVAL; 3245f6f6424bSJiri Pirko } 3246f6f6424bSJiri Pirko } 3247f6f6424bSJiri Pirko *p_vid = vid; 3248f6f6424bSJiri Pirko return 0; 3249f6f6424bSJiri Pirko } 3250f6f6424bSJiri Pirko 3251c21ef3e3SDavid Ahern static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh, 3252c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 325377162022SJohn Fastabend { 325477162022SJohn Fastabend struct net *net = sock_net(skb->sk); 325577162022SJohn Fastabend struct ndmsg *ndm; 325677162022SJohn Fastabend struct nlattr *tb[NDA_MAX+1]; 325777162022SJohn Fastabend struct net_device *dev; 325877162022SJohn Fastabend u8 *addr; 3259f6f6424bSJiri Pirko u16 vid; 326077162022SJohn Fastabend int err; 326177162022SJohn Fastabend 3262c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 326377162022SJohn Fastabend if (err < 0) 326477162022SJohn Fastabend return err; 326577162022SJohn Fastabend 326677162022SJohn Fastabend ndm = nlmsg_data(nlh); 326777162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 3268b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid ifindex"); 326977162022SJohn Fastabend return -EINVAL; 327077162022SJohn Fastabend } 327177162022SJohn Fastabend 327277162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 327377162022SJohn Fastabend if (dev == NULL) { 3274b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "unknown ifindex"); 327577162022SJohn Fastabend return -ENODEV; 327677162022SJohn Fastabend } 327777162022SJohn Fastabend 327877162022SJohn Fastabend if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 3279b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid address"); 328077162022SJohn Fastabend return -EINVAL; 328177162022SJohn Fastabend } 328277162022SJohn Fastabend 328377162022SJohn Fastabend addr = nla_data(tb[NDA_LLADDR]); 328477162022SJohn Fastabend 3285b88d12e4SFlorian Westphal err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack); 3286f6f6424bSJiri Pirko if (err) 3287f6f6424bSJiri Pirko return err; 3288f6f6424bSJiri Pirko 328977162022SJohn Fastabend err = -EOPNOTSUPP; 329077162022SJohn Fastabend 329177162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 329277162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 329377162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3294898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3295898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 3296898e5061SJiri Pirko 3297f6f6424bSJiri Pirko err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid, 3298f6f6424bSJiri Pirko nlh->nlmsg_flags); 329977162022SJohn Fastabend if (err) 330077162022SJohn Fastabend goto out; 330177162022SJohn Fastabend else 330277162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 330377162022SJohn Fastabend } 330477162022SJohn Fastabend 330577162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3306090096bfSVlad Yasevich if ((ndm->ndm_flags & NTF_SELF)) { 3307090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_add) 3308090096bfSVlad Yasevich err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr, 3309f6f6424bSJiri Pirko vid, 3310090096bfSVlad Yasevich nlh->nlmsg_flags); 3311090096bfSVlad Yasevich else 3312f6f6424bSJiri Pirko err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, 331377162022SJohn Fastabend nlh->nlmsg_flags); 331477162022SJohn Fastabend 33153ff661c3SJohn Fastabend if (!err) { 3316b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH, 3317b3379041SHubert Sokolowski ndm->ndm_state); 331877162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 331977162022SJohn Fastabend } 33203ff661c3SJohn Fastabend } 332177162022SJohn Fastabend out: 332277162022SJohn Fastabend return err; 332377162022SJohn Fastabend } 332477162022SJohn Fastabend 3325090096bfSVlad Yasevich /** 3326090096bfSVlad Yasevich * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry 3327090096bfSVlad Yasevich */ 3328090096bfSVlad Yasevich int ndo_dflt_fdb_del(struct ndmsg *ndm, 3329090096bfSVlad Yasevich struct nlattr *tb[], 3330090096bfSVlad Yasevich struct net_device *dev, 3331f6f6424bSJiri Pirko const unsigned char *addr, u16 vid) 3332090096bfSVlad Yasevich { 3333c8a89c4aSAlexander Duyck int err = -EINVAL; 3334090096bfSVlad Yasevich 3335090096bfSVlad Yasevich /* If aging addresses are supported device will need to 3336090096bfSVlad Yasevich * implement its own handler for this. 3337090096bfSVlad Yasevich */ 333864535993SSridhar Samudrala if (!(ndm->ndm_state & NUD_PERMANENT)) { 3339090096bfSVlad Yasevich pr_info("%s: FDB only supports static addresses\n", dev->name); 3340c8a89c4aSAlexander Duyck return err; 3341090096bfSVlad Yasevich } 3342090096bfSVlad Yasevich 3343090096bfSVlad Yasevich if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 3344090096bfSVlad Yasevich err = dev_uc_del(dev, addr); 3345090096bfSVlad Yasevich else if (is_multicast_ether_addr(addr)) 3346090096bfSVlad Yasevich err = dev_mc_del(dev, addr); 3347090096bfSVlad Yasevich 3348090096bfSVlad Yasevich return err; 3349090096bfSVlad Yasevich } 3350090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_del); 3351090096bfSVlad Yasevich 3352c21ef3e3SDavid Ahern static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh, 3353c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 335477162022SJohn Fastabend { 335577162022SJohn Fastabend struct net *net = sock_net(skb->sk); 335677162022SJohn Fastabend struct ndmsg *ndm; 33571690be63SVlad Yasevich struct nlattr *tb[NDA_MAX+1]; 335877162022SJohn Fastabend struct net_device *dev; 335977162022SJohn Fastabend int err = -EINVAL; 336077162022SJohn Fastabend __u8 *addr; 3361f6f6424bSJiri Pirko u16 vid; 336277162022SJohn Fastabend 336390f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_NET_ADMIN)) 33641690be63SVlad Yasevich return -EPERM; 33651690be63SVlad Yasevich 3366c21ef3e3SDavid Ahern err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack); 33671690be63SVlad Yasevich if (err < 0) 33681690be63SVlad Yasevich return err; 336977162022SJohn Fastabend 337077162022SJohn Fastabend ndm = nlmsg_data(nlh); 337177162022SJohn Fastabend if (ndm->ndm_ifindex == 0) { 3372b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid ifindex"); 337377162022SJohn Fastabend return -EINVAL; 337477162022SJohn Fastabend } 337577162022SJohn Fastabend 337677162022SJohn Fastabend dev = __dev_get_by_index(net, ndm->ndm_ifindex); 337777162022SJohn Fastabend if (dev == NULL) { 3378b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "unknown ifindex"); 337977162022SJohn Fastabend return -ENODEV; 338077162022SJohn Fastabend } 338177162022SJohn Fastabend 33821690be63SVlad Yasevich if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) { 3383b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "invalid address"); 338477162022SJohn Fastabend return -EINVAL; 338577162022SJohn Fastabend } 338677162022SJohn Fastabend 33871690be63SVlad Yasevich addr = nla_data(tb[NDA_LLADDR]); 33881690be63SVlad Yasevich 3389b88d12e4SFlorian Westphal err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack); 3390f6f6424bSJiri Pirko if (err) 3391f6f6424bSJiri Pirko return err; 3392f6f6424bSJiri Pirko 339377162022SJohn Fastabend err = -EOPNOTSUPP; 339477162022SJohn Fastabend 339577162022SJohn Fastabend /* Support fdb on master device the net/bridge default case */ 339677162022SJohn Fastabend if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) && 339777162022SJohn Fastabend (dev->priv_flags & IFF_BRIDGE_PORT)) { 3398898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3399898e5061SJiri Pirko const struct net_device_ops *ops = br_dev->netdev_ops; 340077162022SJohn Fastabend 3401898e5061SJiri Pirko if (ops->ndo_fdb_del) 3402f6f6424bSJiri Pirko err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid); 340377162022SJohn Fastabend 340477162022SJohn Fastabend if (err) 340577162022SJohn Fastabend goto out; 340677162022SJohn Fastabend else 340777162022SJohn Fastabend ndm->ndm_flags &= ~NTF_MASTER; 340877162022SJohn Fastabend } 340977162022SJohn Fastabend 341077162022SJohn Fastabend /* Embedded bridge, macvlan, and any other device support */ 3411090096bfSVlad Yasevich if (ndm->ndm_flags & NTF_SELF) { 3412090096bfSVlad Yasevich if (dev->netdev_ops->ndo_fdb_del) 3413f6f6424bSJiri Pirko err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr, 3414f6f6424bSJiri Pirko vid); 3415090096bfSVlad Yasevich else 3416f6f6424bSJiri Pirko err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid); 341777162022SJohn Fastabend 34183ff661c3SJohn Fastabend if (!err) { 3419b3379041SHubert Sokolowski rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH, 3420b3379041SHubert Sokolowski ndm->ndm_state); 342177162022SJohn Fastabend ndm->ndm_flags &= ~NTF_SELF; 342277162022SJohn Fastabend } 34233ff661c3SJohn Fastabend } 342477162022SJohn Fastabend out: 342577162022SJohn Fastabend return err; 342677162022SJohn Fastabend } 342777162022SJohn Fastabend 3428d83b0603SJohn Fastabend static int nlmsg_populate_fdb(struct sk_buff *skb, 3429d83b0603SJohn Fastabend struct netlink_callback *cb, 3430d83b0603SJohn Fastabend struct net_device *dev, 3431d83b0603SJohn Fastabend int *idx, 3432d83b0603SJohn Fastabend struct netdev_hw_addr_list *list) 3433d83b0603SJohn Fastabend { 3434d83b0603SJohn Fastabend struct netdev_hw_addr *ha; 3435d83b0603SJohn Fastabend int err; 343615e47304SEric W. Biederman u32 portid, seq; 3437d83b0603SJohn Fastabend 343815e47304SEric W. Biederman portid = NETLINK_CB(cb->skb).portid; 3439d83b0603SJohn Fastabend seq = cb->nlh->nlmsg_seq; 3440d83b0603SJohn Fastabend 3441d83b0603SJohn Fastabend list_for_each_entry(ha, &list->list, list) { 3442d297653dSRoopa Prabhu if (*idx < cb->args[2]) 3443d83b0603SJohn Fastabend goto skip; 3444d83b0603SJohn Fastabend 34451e53d5bbSHubert Sokolowski err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0, 3446a7a558feSJohn Fastabend portid, seq, 34471c104a6bSNicolas Dichtel RTM_NEWNEIGH, NTF_SELF, 3448b3379041SHubert Sokolowski NLM_F_MULTI, NUD_PERMANENT); 3449d83b0603SJohn Fastabend if (err < 0) 3450d83b0603SJohn Fastabend return err; 3451d83b0603SJohn Fastabend skip: 3452d83b0603SJohn Fastabend *idx += 1; 3453d83b0603SJohn Fastabend } 3454d83b0603SJohn Fastabend return 0; 3455d83b0603SJohn Fastabend } 3456d83b0603SJohn Fastabend 3457d83b0603SJohn Fastabend /** 34582c53040fSBen Hutchings * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table. 3459d83b0603SJohn Fastabend * @nlh: netlink message header 3460d83b0603SJohn Fastabend * @dev: netdevice 3461d83b0603SJohn Fastabend * 3462d83b0603SJohn Fastabend * Default netdevice operation to dump the existing unicast address list. 346391f3e7b1SJohn Fastabend * Returns number of addresses from list put in skb. 3464d83b0603SJohn Fastabend */ 3465d83b0603SJohn Fastabend int ndo_dflt_fdb_dump(struct sk_buff *skb, 3466d83b0603SJohn Fastabend struct netlink_callback *cb, 3467d83b0603SJohn Fastabend struct net_device *dev, 34685d5eacb3SJamal Hadi Salim struct net_device *filter_dev, 3469d297653dSRoopa Prabhu int *idx) 3470d83b0603SJohn Fastabend { 3471d83b0603SJohn Fastabend int err; 3472d83b0603SJohn Fastabend 3473d83b0603SJohn Fastabend netif_addr_lock_bh(dev); 3474d297653dSRoopa Prabhu err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc); 3475d83b0603SJohn Fastabend if (err) 3476d83b0603SJohn Fastabend goto out; 34772934c9dbSZhang Shengju err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc); 3478d83b0603SJohn Fastabend out: 3479d83b0603SJohn Fastabend netif_addr_unlock_bh(dev); 3480d297653dSRoopa Prabhu return err; 3481d83b0603SJohn Fastabend } 3482d83b0603SJohn Fastabend EXPORT_SYMBOL(ndo_dflt_fdb_dump); 3483d83b0603SJohn Fastabend 348477162022SJohn Fastabend static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb) 348577162022SJohn Fastabend { 348677162022SJohn Fastabend struct net_device *dev; 34875e6d2435SJamal Hadi Salim struct nlattr *tb[IFLA_MAX+1]; 34885e6d2435SJamal Hadi Salim struct net_device *br_dev = NULL; 34895e6d2435SJamal Hadi Salim const struct net_device_ops *ops = NULL; 34905e6d2435SJamal Hadi Salim const struct net_device_ops *cops = NULL; 34915e6d2435SJamal Hadi Salim struct ifinfomsg *ifm = nlmsg_data(cb->nlh); 34925e6d2435SJamal Hadi Salim struct net *net = sock_net(skb->sk); 3493d297653dSRoopa Prabhu struct hlist_head *head; 34945e6d2435SJamal Hadi Salim int brport_idx = 0; 34955e6d2435SJamal Hadi Salim int br_idx = 0; 3496d297653dSRoopa Prabhu int h, s_h; 3497d297653dSRoopa Prabhu int idx = 0, s_idx; 3498d297653dSRoopa Prabhu int err = 0; 3499d297653dSRoopa Prabhu int fidx = 0; 350077162022SJohn Fastabend 35010ff50e83SAlexander Potapenko err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb, 35020ff50e83SAlexander Potapenko IFLA_MAX, ifla_policy, NULL); 35030ff50e83SAlexander Potapenko if (err < 0) { 35040ff50e83SAlexander Potapenko return -EINVAL; 35050ff50e83SAlexander Potapenko } else if (err == 0) { 35065e6d2435SJamal Hadi Salim if (tb[IFLA_MASTER]) 35075e6d2435SJamal Hadi Salim br_idx = nla_get_u32(tb[IFLA_MASTER]); 35085e6d2435SJamal Hadi Salim } 350977162022SJohn Fastabend 35105e6d2435SJamal Hadi Salim brport_idx = ifm->ifi_index; 35115e6d2435SJamal Hadi Salim 35125e6d2435SJamal Hadi Salim if (br_idx) { 35135e6d2435SJamal Hadi Salim br_dev = __dev_get_by_index(net, br_idx); 35145e6d2435SJamal Hadi Salim if (!br_dev) 35155e6d2435SJamal Hadi Salim return -ENODEV; 35165e6d2435SJamal Hadi Salim 3517898e5061SJiri Pirko ops = br_dev->netdev_ops; 35185e6d2435SJamal Hadi Salim } 35195e6d2435SJamal Hadi Salim 3520d297653dSRoopa Prabhu s_h = cb->args[0]; 3521d297653dSRoopa Prabhu s_idx = cb->args[1]; 3522d297653dSRoopa Prabhu 3523d297653dSRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 3524d297653dSRoopa Prabhu idx = 0; 3525d297653dSRoopa Prabhu head = &net->dev_index_head[h]; 3526d297653dSRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 3527d297653dSRoopa Prabhu 35285e6d2435SJamal Hadi Salim if (brport_idx && (dev->ifindex != brport_idx)) 35295e6d2435SJamal Hadi Salim continue; 35305e6d2435SJamal Hadi Salim 35315e6d2435SJamal Hadi Salim if (!br_idx) { /* user did not specify a specific bridge */ 35325e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 35335e6d2435SJamal Hadi Salim br_dev = netdev_master_upper_dev_get(dev); 35345e6d2435SJamal Hadi Salim cops = br_dev->netdev_ops; 35355e6d2435SJamal Hadi Salim } 35365e6d2435SJamal Hadi Salim } else { 35375e6d2435SJamal Hadi Salim if (dev != br_dev && 35385e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_BRIDGE_PORT)) 35395e6d2435SJamal Hadi Salim continue; 35405e6d2435SJamal Hadi Salim 35415e6d2435SJamal Hadi Salim if (br_dev != netdev_master_upper_dev_get(dev) && 35425e6d2435SJamal Hadi Salim !(dev->priv_flags & IFF_EBRIDGE)) 35435e6d2435SJamal Hadi Salim continue; 35445e6d2435SJamal Hadi Salim cops = ops; 35455e6d2435SJamal Hadi Salim } 35465e6d2435SJamal Hadi Salim 3547d297653dSRoopa Prabhu if (idx < s_idx) 3548d297653dSRoopa Prabhu goto cont; 3549d297653dSRoopa Prabhu 35505e6d2435SJamal Hadi Salim if (dev->priv_flags & IFF_BRIDGE_PORT) { 3551d297653dSRoopa Prabhu if (cops && cops->ndo_fdb_dump) { 3552d297653dSRoopa Prabhu err = cops->ndo_fdb_dump(skb, cb, 3553d297653dSRoopa Prabhu br_dev, dev, 3554d297653dSRoopa Prabhu &fidx); 3555d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3556d297653dSRoopa Prabhu goto out; 355777162022SJohn Fastabend } 3558d297653dSRoopa Prabhu } 355977162022SJohn Fastabend 35605e6d2435SJamal Hadi Salim if (dev->netdev_ops->ndo_fdb_dump) 3561d297653dSRoopa Prabhu err = dev->netdev_ops->ndo_fdb_dump(skb, cb, 3562d297653dSRoopa Prabhu dev, NULL, 3563d297653dSRoopa Prabhu &fidx); 35646cb69742SHubert Sokolowski else 3565d297653dSRoopa Prabhu err = ndo_dflt_fdb_dump(skb, cb, dev, NULL, 3566d297653dSRoopa Prabhu &fidx); 3567d297653dSRoopa Prabhu if (err == -EMSGSIZE) 3568d297653dSRoopa Prabhu goto out; 35695e6d2435SJamal Hadi Salim 35705e6d2435SJamal Hadi Salim cops = NULL; 3571d297653dSRoopa Prabhu 3572d297653dSRoopa Prabhu /* reset fdb offset to 0 for rest of the interfaces */ 3573d297653dSRoopa Prabhu cb->args[2] = 0; 3574d297653dSRoopa Prabhu fidx = 0; 3575d297653dSRoopa Prabhu cont: 3576d297653dSRoopa Prabhu idx++; 3577d297653dSRoopa Prabhu } 357877162022SJohn Fastabend } 357977162022SJohn Fastabend 3580d297653dSRoopa Prabhu out: 3581d297653dSRoopa Prabhu cb->args[0] = h; 3582d297653dSRoopa Prabhu cb->args[1] = idx; 3583d297653dSRoopa Prabhu cb->args[2] = fidx; 3584d297653dSRoopa Prabhu 358577162022SJohn Fastabend return skb->len; 358677162022SJohn Fastabend } 358777162022SJohn Fastabend 35882c3c031cSScott Feldman static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask, 35892c3c031cSScott Feldman unsigned int attrnum, unsigned int flag) 35902c3c031cSScott Feldman { 35912c3c031cSScott Feldman if (mask & flag) 35922c3c031cSScott Feldman return nla_put_u8(skb, attrnum, !!(flags & flag)); 35932c3c031cSScott Feldman return 0; 35942c3c031cSScott Feldman } 35952c3c031cSScott Feldman 3596815cccbfSJohn Fastabend int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq, 35972c3c031cSScott Feldman struct net_device *dev, u16 mode, 35987d4f8d87SScott Feldman u32 flags, u32 mask, int nlflags, 35997d4f8d87SScott Feldman u32 filter_mask, 36007d4f8d87SScott Feldman int (*vlan_fill)(struct sk_buff *skb, 36017d4f8d87SScott Feldman struct net_device *dev, 36027d4f8d87SScott Feldman u32 filter_mask)) 3603815cccbfSJohn Fastabend { 3604815cccbfSJohn Fastabend struct nlmsghdr *nlh; 3605815cccbfSJohn Fastabend struct ifinfomsg *ifm; 3606815cccbfSJohn Fastabend struct nlattr *br_afspec; 36072c3c031cSScott Feldman struct nlattr *protinfo; 3608815cccbfSJohn Fastabend u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN; 3609898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 36107d4f8d87SScott Feldman int err = 0; 3611815cccbfSJohn Fastabend 361246c264daSNicolas Dichtel nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags); 3613815cccbfSJohn Fastabend if (nlh == NULL) 3614815cccbfSJohn Fastabend return -EMSGSIZE; 3615815cccbfSJohn Fastabend 3616815cccbfSJohn Fastabend ifm = nlmsg_data(nlh); 3617815cccbfSJohn Fastabend ifm->ifi_family = AF_BRIDGE; 3618815cccbfSJohn Fastabend ifm->__ifi_pad = 0; 3619815cccbfSJohn Fastabend ifm->ifi_type = dev->type; 3620815cccbfSJohn Fastabend ifm->ifi_index = dev->ifindex; 3621815cccbfSJohn Fastabend ifm->ifi_flags = dev_get_flags(dev); 3622815cccbfSJohn Fastabend ifm->ifi_change = 0; 3623815cccbfSJohn Fastabend 3624815cccbfSJohn Fastabend 3625815cccbfSJohn Fastabend if (nla_put_string(skb, IFLA_IFNAME, dev->name) || 3626815cccbfSJohn Fastabend nla_put_u32(skb, IFLA_MTU, dev->mtu) || 3627815cccbfSJohn Fastabend nla_put_u8(skb, IFLA_OPERSTATE, operstate) || 3628898e5061SJiri Pirko (br_dev && 3629898e5061SJiri Pirko nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) || 3630815cccbfSJohn Fastabend (dev->addr_len && 3631815cccbfSJohn Fastabend nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) || 3632a54acb3aSNicolas Dichtel (dev->ifindex != dev_get_iflink(dev) && 3633a54acb3aSNicolas Dichtel nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev)))) 3634815cccbfSJohn Fastabend goto nla_put_failure; 3635815cccbfSJohn Fastabend 3636815cccbfSJohn Fastabend br_afspec = nla_nest_start(skb, IFLA_AF_SPEC); 3637815cccbfSJohn Fastabend if (!br_afspec) 3638815cccbfSJohn Fastabend goto nla_put_failure; 3639815cccbfSJohn Fastabend 36401d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) { 3641815cccbfSJohn Fastabend nla_nest_cancel(skb, br_afspec); 3642815cccbfSJohn Fastabend goto nla_put_failure; 3643815cccbfSJohn Fastabend } 36441d460b98SRoopa Prabhu 36451d460b98SRoopa Prabhu if (mode != BRIDGE_MODE_UNDEF) { 36461d460b98SRoopa Prabhu if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) { 36471d460b98SRoopa Prabhu nla_nest_cancel(skb, br_afspec); 36481d460b98SRoopa Prabhu goto nla_put_failure; 36491d460b98SRoopa Prabhu } 36501d460b98SRoopa Prabhu } 36517d4f8d87SScott Feldman if (vlan_fill) { 36527d4f8d87SScott Feldman err = vlan_fill(skb, dev, filter_mask); 36537d4f8d87SScott Feldman if (err) { 36547d4f8d87SScott Feldman nla_nest_cancel(skb, br_afspec); 36557d4f8d87SScott Feldman goto nla_put_failure; 36567d4f8d87SScott Feldman } 36577d4f8d87SScott Feldman } 3658815cccbfSJohn Fastabend nla_nest_end(skb, br_afspec); 3659815cccbfSJohn Fastabend 36602c3c031cSScott Feldman protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED); 36612c3c031cSScott Feldman if (!protinfo) 36622c3c031cSScott Feldman goto nla_put_failure; 36632c3c031cSScott Feldman 36642c3c031cSScott Feldman if (brport_nla_put_flag(skb, flags, mask, 36652c3c031cSScott Feldman IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) || 36662c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36672c3c031cSScott Feldman IFLA_BRPORT_GUARD, BR_BPDU_GUARD) || 36682c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36692c3c031cSScott Feldman IFLA_BRPORT_FAST_LEAVE, 36702c3c031cSScott Feldman BR_MULTICAST_FAST_LEAVE) || 36712c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36722c3c031cSScott Feldman IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) || 36732c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36742c3c031cSScott Feldman IFLA_BRPORT_LEARNING, BR_LEARNING) || 36752c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36762c3c031cSScott Feldman IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) || 36772c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36782c3c031cSScott Feldman IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) || 36792c3c031cSScott Feldman brport_nla_put_flag(skb, flags, mask, 36802c3c031cSScott Feldman IFLA_BRPORT_PROXYARP, BR_PROXYARP)) { 36812c3c031cSScott Feldman nla_nest_cancel(skb, protinfo); 36822c3c031cSScott Feldman goto nla_put_failure; 36832c3c031cSScott Feldman } 36842c3c031cSScott Feldman 36852c3c031cSScott Feldman nla_nest_end(skb, protinfo); 36862c3c031cSScott Feldman 3687053c095aSJohannes Berg nlmsg_end(skb, nlh); 3688053c095aSJohannes Berg return 0; 3689815cccbfSJohn Fastabend nla_put_failure: 3690815cccbfSJohn Fastabend nlmsg_cancel(skb, nlh); 36917d4f8d87SScott Feldman return err ? err : -EMSGSIZE; 3692815cccbfSJohn Fastabend } 36937d4f8d87SScott Feldman EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink); 3694815cccbfSJohn Fastabend 3695e5a55a89SJohn Fastabend static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb) 3696e5a55a89SJohn Fastabend { 3697e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3698e5a55a89SJohn Fastabend struct net_device *dev; 3699e5a55a89SJohn Fastabend int idx = 0; 3700e5a55a89SJohn Fastabend u32 portid = NETLINK_CB(cb->skb).portid; 3701e5a55a89SJohn Fastabend u32 seq = cb->nlh->nlmsg_seq; 37026cbdceebSVlad Yasevich u32 filter_mask = 0; 3703d64f69b0SRoopa Prabhu int err; 37046cbdceebSVlad Yasevich 3705aa68c20fSThomas Graf if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) { 3706aa68c20fSThomas Graf struct nlattr *extfilt; 3707aa68c20fSThomas Graf 37083e805ad2SAsbjoern Sloth Toennesen extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg), 37096cbdceebSVlad Yasevich IFLA_EXT_MASK); 3710aa68c20fSThomas Graf if (extfilt) { 3711aa68c20fSThomas Graf if (nla_len(extfilt) < sizeof(filter_mask)) 3712aa68c20fSThomas Graf return -EINVAL; 3713aa68c20fSThomas Graf 37146cbdceebSVlad Yasevich filter_mask = nla_get_u32(extfilt); 3715aa68c20fSThomas Graf } 3716aa68c20fSThomas Graf } 3717e5a55a89SJohn Fastabend 3718e5a55a89SJohn Fastabend rcu_read_lock(); 3719e5a55a89SJohn Fastabend for_each_netdev_rcu(net, dev) { 3720e5a55a89SJohn Fastabend const struct net_device_ops *ops = dev->netdev_ops; 3721898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3722e5a55a89SJohn Fastabend 3723898e5061SJiri Pirko if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) { 3724d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3725d64f69b0SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_getlink( 3726d64f69b0SRoopa Prabhu skb, portid, seq, dev, 3727d64f69b0SRoopa Prabhu filter_mask, NLM_F_MULTI); 3728f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3729f6c5775fSDavid Ahern if (likely(skb->len)) 3730e5a55a89SJohn Fastabend break; 3731f6c5775fSDavid Ahern 3732f6c5775fSDavid Ahern goto out_err; 3733f6c5775fSDavid Ahern } 3734d64f69b0SRoopa Prabhu } 3735e5a55a89SJohn Fastabend idx++; 3736e5a55a89SJohn Fastabend } 3737e5a55a89SJohn Fastabend 3738e5a55a89SJohn Fastabend if (ops->ndo_bridge_getlink) { 3739d64f69b0SRoopa Prabhu if (idx >= cb->args[0]) { 3740d64f69b0SRoopa Prabhu err = ops->ndo_bridge_getlink(skb, portid, 3741d64f69b0SRoopa Prabhu seq, dev, 374246c264daSNicolas Dichtel filter_mask, 3743d64f69b0SRoopa Prabhu NLM_F_MULTI); 3744f6c5775fSDavid Ahern if (err < 0 && err != -EOPNOTSUPP) { 3745f6c5775fSDavid Ahern if (likely(skb->len)) 3746e5a55a89SJohn Fastabend break; 3747f6c5775fSDavid Ahern 3748f6c5775fSDavid Ahern goto out_err; 3749f6c5775fSDavid Ahern } 3750d64f69b0SRoopa Prabhu } 3751e5a55a89SJohn Fastabend idx++; 3752e5a55a89SJohn Fastabend } 3753e5a55a89SJohn Fastabend } 3754f6c5775fSDavid Ahern err = skb->len; 3755f6c5775fSDavid Ahern out_err: 3756e5a55a89SJohn Fastabend rcu_read_unlock(); 3757e5a55a89SJohn Fastabend cb->args[0] = idx; 3758e5a55a89SJohn Fastabend 3759f6c5775fSDavid Ahern return err; 3760e5a55a89SJohn Fastabend } 3761e5a55a89SJohn Fastabend 37622469ffd7SJohn Fastabend static inline size_t bridge_nlmsg_size(void) 37632469ffd7SJohn Fastabend { 37642469ffd7SJohn Fastabend return NLMSG_ALIGN(sizeof(struct ifinfomsg)) 37652469ffd7SJohn Fastabend + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ 37662469ffd7SJohn Fastabend + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ 37672469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MASTER */ 37682469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_MTU */ 37692469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_LINK */ 37702469ffd7SJohn Fastabend + nla_total_size(sizeof(u32)) /* IFLA_OPERSTATE */ 37712469ffd7SJohn Fastabend + nla_total_size(sizeof(u8)) /* IFLA_PROTINFO */ 37722469ffd7SJohn Fastabend + nla_total_size(sizeof(struct nlattr)) /* IFLA_AF_SPEC */ 37732469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)) /* IFLA_BRIDGE_FLAGS */ 37742469ffd7SJohn Fastabend + nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_MODE */ 37752469ffd7SJohn Fastabend } 37762469ffd7SJohn Fastabend 377702dba438SRoopa Prabhu static int rtnl_bridge_notify(struct net_device *dev) 37782469ffd7SJohn Fastabend { 37792469ffd7SJohn Fastabend struct net *net = dev_net(dev); 37802469ffd7SJohn Fastabend struct sk_buff *skb; 37812469ffd7SJohn Fastabend int err = -EOPNOTSUPP; 37822469ffd7SJohn Fastabend 378302dba438SRoopa Prabhu if (!dev->netdev_ops->ndo_bridge_getlink) 378402dba438SRoopa Prabhu return 0; 378502dba438SRoopa Prabhu 37862469ffd7SJohn Fastabend skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC); 37872469ffd7SJohn Fastabend if (!skb) { 37882469ffd7SJohn Fastabend err = -ENOMEM; 37892469ffd7SJohn Fastabend goto errout; 37902469ffd7SJohn Fastabend } 37912469ffd7SJohn Fastabend 379246c264daSNicolas Dichtel err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0); 3793c38e01b8SJohn Fastabend if (err < 0) 3794c38e01b8SJohn Fastabend goto errout; 37952469ffd7SJohn Fastabend 379659ccaaaaSRoopa Prabhu if (!skb->len) 379759ccaaaaSRoopa Prabhu goto errout; 379859ccaaaaSRoopa Prabhu 37992469ffd7SJohn Fastabend rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC); 38002469ffd7SJohn Fastabend return 0; 38012469ffd7SJohn Fastabend errout: 38022469ffd7SJohn Fastabend WARN_ON(err == -EMSGSIZE); 38032469ffd7SJohn Fastabend kfree_skb(skb); 380459ccaaaaSRoopa Prabhu if (err) 38052469ffd7SJohn Fastabend rtnl_set_sk_err(net, RTNLGRP_LINK, err); 38062469ffd7SJohn Fastabend return err; 38072469ffd7SJohn Fastabend } 38082469ffd7SJohn Fastabend 3809c21ef3e3SDavid Ahern static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, 3810c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3811e5a55a89SJohn Fastabend { 3812e5a55a89SJohn Fastabend struct net *net = sock_net(skb->sk); 3813e5a55a89SJohn Fastabend struct ifinfomsg *ifm; 3814e5a55a89SJohn Fastabend struct net_device *dev; 38152469ffd7SJohn Fastabend struct nlattr *br_spec, *attr = NULL; 38162469ffd7SJohn Fastabend int rem, err = -EOPNOTSUPP; 38174de8b413SRosen, Rami u16 flags = 0; 3818c38e01b8SJohn Fastabend bool have_flags = false; 3819e5a55a89SJohn Fastabend 3820e5a55a89SJohn Fastabend if (nlmsg_len(nlh) < sizeof(*ifm)) 3821e5a55a89SJohn Fastabend return -EINVAL; 3822e5a55a89SJohn Fastabend 3823e5a55a89SJohn Fastabend ifm = nlmsg_data(nlh); 3824e5a55a89SJohn Fastabend if (ifm->ifi_family != AF_BRIDGE) 3825e5a55a89SJohn Fastabend return -EPFNOSUPPORT; 3826e5a55a89SJohn Fastabend 3827e5a55a89SJohn Fastabend dev = __dev_get_by_index(net, ifm->ifi_index); 3828e5a55a89SJohn Fastabend if (!dev) { 3829b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "unknown ifindex"); 3830e5a55a89SJohn Fastabend return -ENODEV; 3831e5a55a89SJohn Fastabend } 3832e5a55a89SJohn Fastabend 38332469ffd7SJohn Fastabend br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 38342469ffd7SJohn Fastabend if (br_spec) { 38352469ffd7SJohn Fastabend nla_for_each_nested(attr, br_spec, rem) { 38362469ffd7SJohn Fastabend if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 38376e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 38386e8d1c55SThomas Graf return -EINVAL; 38396e8d1c55SThomas Graf 3840c38e01b8SJohn Fastabend have_flags = true; 38412469ffd7SJohn Fastabend flags = nla_get_u16(attr); 38422469ffd7SJohn Fastabend break; 38432469ffd7SJohn Fastabend } 38442469ffd7SJohn Fastabend } 38452469ffd7SJohn Fastabend } 38462469ffd7SJohn Fastabend 38472469ffd7SJohn Fastabend if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3848898e5061SJiri Pirko struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3849898e5061SJiri Pirko 3850898e5061SJiri Pirko if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) { 38512469ffd7SJohn Fastabend err = -EOPNOTSUPP; 3852e5a55a89SJohn Fastabend goto out; 3853e5a55a89SJohn Fastabend } 3854e5a55a89SJohn Fastabend 3855add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags); 38562469ffd7SJohn Fastabend if (err) 38572469ffd7SJohn Fastabend goto out; 38582469ffd7SJohn Fastabend 38592469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_MASTER; 38602469ffd7SJohn Fastabend } 38612469ffd7SJohn Fastabend 38622469ffd7SJohn Fastabend if ((flags & BRIDGE_FLAGS_SELF)) { 38632469ffd7SJohn Fastabend if (!dev->netdev_ops->ndo_bridge_setlink) 38642469ffd7SJohn Fastabend err = -EOPNOTSUPP; 38652469ffd7SJohn Fastabend else 3866add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh, 3867add511b3SRoopa Prabhu flags); 386802dba438SRoopa Prabhu if (!err) { 38692469ffd7SJohn Fastabend flags &= ~BRIDGE_FLAGS_SELF; 387002dba438SRoopa Prabhu 387102dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 387202dba438SRoopa Prabhu * change 387302dba438SRoopa Prabhu */ 387402dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 387502dba438SRoopa Prabhu } 38762469ffd7SJohn Fastabend } 38772469ffd7SJohn Fastabend 3878c38e01b8SJohn Fastabend if (have_flags) 38792469ffd7SJohn Fastabend memcpy(nla_data(attr), &flags, sizeof(flags)); 3880e5a55a89SJohn Fastabend out: 3881e5a55a89SJohn Fastabend return err; 3882e5a55a89SJohn Fastabend } 3883e5a55a89SJohn Fastabend 3884c21ef3e3SDavid Ahern static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, 3885c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 3886407af329SVlad Yasevich { 3887407af329SVlad Yasevich struct net *net = sock_net(skb->sk); 3888407af329SVlad Yasevich struct ifinfomsg *ifm; 3889407af329SVlad Yasevich struct net_device *dev; 3890407af329SVlad Yasevich struct nlattr *br_spec, *attr = NULL; 3891407af329SVlad Yasevich int rem, err = -EOPNOTSUPP; 38924de8b413SRosen, Rami u16 flags = 0; 3893407af329SVlad Yasevich bool have_flags = false; 3894407af329SVlad Yasevich 3895407af329SVlad Yasevich if (nlmsg_len(nlh) < sizeof(*ifm)) 3896407af329SVlad Yasevich return -EINVAL; 3897407af329SVlad Yasevich 3898407af329SVlad Yasevich ifm = nlmsg_data(nlh); 3899407af329SVlad Yasevich if (ifm->ifi_family != AF_BRIDGE) 3900407af329SVlad Yasevich return -EPFNOSUPPORT; 3901407af329SVlad Yasevich 3902407af329SVlad Yasevich dev = __dev_get_by_index(net, ifm->ifi_index); 3903407af329SVlad Yasevich if (!dev) { 3904b88d12e4SFlorian Westphal NL_SET_ERR_MSG(extack, "unknown ifindex"); 3905407af329SVlad Yasevich return -ENODEV; 3906407af329SVlad Yasevich } 3907407af329SVlad Yasevich 3908407af329SVlad Yasevich br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 3909407af329SVlad Yasevich if (br_spec) { 3910407af329SVlad Yasevich nla_for_each_nested(attr, br_spec, rem) { 3911407af329SVlad Yasevich if (nla_type(attr) == IFLA_BRIDGE_FLAGS) { 39126e8d1c55SThomas Graf if (nla_len(attr) < sizeof(flags)) 39136e8d1c55SThomas Graf return -EINVAL; 39146e8d1c55SThomas Graf 3915407af329SVlad Yasevich have_flags = true; 3916407af329SVlad Yasevich flags = nla_get_u16(attr); 3917407af329SVlad Yasevich break; 3918407af329SVlad Yasevich } 3919407af329SVlad Yasevich } 3920407af329SVlad Yasevich } 3921407af329SVlad Yasevich 3922407af329SVlad Yasevich if (!flags || (flags & BRIDGE_FLAGS_MASTER)) { 3923407af329SVlad Yasevich struct net_device *br_dev = netdev_master_upper_dev_get(dev); 3924407af329SVlad Yasevich 3925407af329SVlad Yasevich if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) { 3926407af329SVlad Yasevich err = -EOPNOTSUPP; 3927407af329SVlad Yasevich goto out; 3928407af329SVlad Yasevich } 3929407af329SVlad Yasevich 3930add511b3SRoopa Prabhu err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags); 3931407af329SVlad Yasevich if (err) 3932407af329SVlad Yasevich goto out; 3933407af329SVlad Yasevich 3934407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_MASTER; 3935407af329SVlad Yasevich } 3936407af329SVlad Yasevich 3937407af329SVlad Yasevich if ((flags & BRIDGE_FLAGS_SELF)) { 3938407af329SVlad Yasevich if (!dev->netdev_ops->ndo_bridge_dellink) 3939407af329SVlad Yasevich err = -EOPNOTSUPP; 3940407af329SVlad Yasevich else 3941add511b3SRoopa Prabhu err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh, 3942add511b3SRoopa Prabhu flags); 3943407af329SVlad Yasevich 394402dba438SRoopa Prabhu if (!err) { 3945407af329SVlad Yasevich flags &= ~BRIDGE_FLAGS_SELF; 394602dba438SRoopa Prabhu 394702dba438SRoopa Prabhu /* Generate event to notify upper layer of bridge 394802dba438SRoopa Prabhu * change 394902dba438SRoopa Prabhu */ 395002dba438SRoopa Prabhu err = rtnl_bridge_notify(dev); 395102dba438SRoopa Prabhu } 3952407af329SVlad Yasevich } 3953407af329SVlad Yasevich 3954407af329SVlad Yasevich if (have_flags) 3955407af329SVlad Yasevich memcpy(nla_data(attr), &flags, sizeof(flags)); 3956407af329SVlad Yasevich out: 3957407af329SVlad Yasevich return err; 3958407af329SVlad Yasevich } 3959407af329SVlad Yasevich 3960e8872a25SNikolay Aleksandrov static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr) 3961e8872a25SNikolay Aleksandrov { 3962e8872a25SNikolay Aleksandrov return (mask & IFLA_STATS_FILTER_BIT(attrid)) && 3963e8872a25SNikolay Aleksandrov (!idxattr || idxattr == attrid); 3964e8872a25SNikolay Aleksandrov } 3965e8872a25SNikolay Aleksandrov 396669ae6ad2SNogah Frankel #define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1) 396769ae6ad2SNogah Frankel static int rtnl_get_offload_stats_attr_size(int attr_id) 396869ae6ad2SNogah Frankel { 396969ae6ad2SNogah Frankel switch (attr_id) { 397069ae6ad2SNogah Frankel case IFLA_OFFLOAD_XSTATS_CPU_HIT: 397169ae6ad2SNogah Frankel return sizeof(struct rtnl_link_stats64); 397269ae6ad2SNogah Frankel } 397369ae6ad2SNogah Frankel 397469ae6ad2SNogah Frankel return 0; 397569ae6ad2SNogah Frankel } 397669ae6ad2SNogah Frankel 397769ae6ad2SNogah Frankel static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev, 397869ae6ad2SNogah Frankel int *prividx) 397969ae6ad2SNogah Frankel { 398069ae6ad2SNogah Frankel struct nlattr *attr = NULL; 398169ae6ad2SNogah Frankel int attr_id, size; 398269ae6ad2SNogah Frankel void *attr_data; 398369ae6ad2SNogah Frankel int err; 398469ae6ad2SNogah Frankel 398569ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 398669ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 398769ae6ad2SNogah Frankel return -ENODATA; 398869ae6ad2SNogah Frankel 398969ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 399069ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 399169ae6ad2SNogah Frankel if (attr_id < *prividx) 399269ae6ad2SNogah Frankel continue; 399369ae6ad2SNogah Frankel 399469ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 399569ae6ad2SNogah Frankel if (!size) 399669ae6ad2SNogah Frankel continue; 399769ae6ad2SNogah Frankel 39983df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 399969ae6ad2SNogah Frankel continue; 400069ae6ad2SNogah Frankel 400169ae6ad2SNogah Frankel attr = nla_reserve_64bit(skb, attr_id, size, 400269ae6ad2SNogah Frankel IFLA_OFFLOAD_XSTATS_UNSPEC); 400369ae6ad2SNogah Frankel if (!attr) 400469ae6ad2SNogah Frankel goto nla_put_failure; 400569ae6ad2SNogah Frankel 400669ae6ad2SNogah Frankel attr_data = nla_data(attr); 400769ae6ad2SNogah Frankel memset(attr_data, 0, size); 400869ae6ad2SNogah Frankel err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev, 400969ae6ad2SNogah Frankel attr_data); 401069ae6ad2SNogah Frankel if (err) 401169ae6ad2SNogah Frankel goto get_offload_stats_failure; 401269ae6ad2SNogah Frankel } 401369ae6ad2SNogah Frankel 401469ae6ad2SNogah Frankel if (!attr) 401569ae6ad2SNogah Frankel return -ENODATA; 401669ae6ad2SNogah Frankel 401769ae6ad2SNogah Frankel *prividx = 0; 401869ae6ad2SNogah Frankel return 0; 401969ae6ad2SNogah Frankel 402069ae6ad2SNogah Frankel nla_put_failure: 402169ae6ad2SNogah Frankel err = -EMSGSIZE; 402269ae6ad2SNogah Frankel get_offload_stats_failure: 402369ae6ad2SNogah Frankel *prividx = attr_id; 402469ae6ad2SNogah Frankel return err; 402569ae6ad2SNogah Frankel } 402669ae6ad2SNogah Frankel 402769ae6ad2SNogah Frankel static int rtnl_get_offload_stats_size(const struct net_device *dev) 402869ae6ad2SNogah Frankel { 402969ae6ad2SNogah Frankel int nla_size = 0; 403069ae6ad2SNogah Frankel int attr_id; 403169ae6ad2SNogah Frankel int size; 403269ae6ad2SNogah Frankel 403369ae6ad2SNogah Frankel if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats && 403469ae6ad2SNogah Frankel dev->netdev_ops->ndo_get_offload_stats)) 403569ae6ad2SNogah Frankel return 0; 403669ae6ad2SNogah Frankel 403769ae6ad2SNogah Frankel for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST; 403869ae6ad2SNogah Frankel attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) { 40393df5b3c6SOr Gerlitz if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id)) 404069ae6ad2SNogah Frankel continue; 404169ae6ad2SNogah Frankel size = rtnl_get_offload_stats_attr_size(attr_id); 404269ae6ad2SNogah Frankel nla_size += nla_total_size_64bit(size); 404369ae6ad2SNogah Frankel } 404469ae6ad2SNogah Frankel 404569ae6ad2SNogah Frankel if (nla_size != 0) 404669ae6ad2SNogah Frankel nla_size += nla_total_size(0); 404769ae6ad2SNogah Frankel 404869ae6ad2SNogah Frankel return nla_size; 404969ae6ad2SNogah Frankel } 405069ae6ad2SNogah Frankel 405110c9ead9SRoopa Prabhu static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev, 405210c9ead9SRoopa Prabhu int type, u32 pid, u32 seq, u32 change, 4053e8872a25SNikolay Aleksandrov unsigned int flags, unsigned int filter_mask, 4054e8872a25SNikolay Aleksandrov int *idxattr, int *prividx) 405510c9ead9SRoopa Prabhu { 405610c9ead9SRoopa Prabhu struct if_stats_msg *ifsm; 405710c9ead9SRoopa Prabhu struct nlmsghdr *nlh; 405810c9ead9SRoopa Prabhu struct nlattr *attr; 4059e8872a25SNikolay Aleksandrov int s_prividx = *prividx; 406069ae6ad2SNogah Frankel int err; 406110c9ead9SRoopa Prabhu 406210c9ead9SRoopa Prabhu ASSERT_RTNL(); 406310c9ead9SRoopa Prabhu 406410c9ead9SRoopa Prabhu nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags); 406510c9ead9SRoopa Prabhu if (!nlh) 406610c9ead9SRoopa Prabhu return -EMSGSIZE; 406710c9ead9SRoopa Prabhu 406810c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 4069ce024f42SNikolay Aleksandrov ifsm->family = PF_UNSPEC; 4070ce024f42SNikolay Aleksandrov ifsm->pad1 = 0; 4071ce024f42SNikolay Aleksandrov ifsm->pad2 = 0; 407210c9ead9SRoopa Prabhu ifsm->ifindex = dev->ifindex; 407310c9ead9SRoopa Prabhu ifsm->filter_mask = filter_mask; 407410c9ead9SRoopa Prabhu 4075e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) { 407610c9ead9SRoopa Prabhu struct rtnl_link_stats64 *sp; 407710c9ead9SRoopa Prabhu 407858414d32SNicolas Dichtel attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64, 407958414d32SNicolas Dichtel sizeof(struct rtnl_link_stats64), 408058414d32SNicolas Dichtel IFLA_STATS_UNSPEC); 408110c9ead9SRoopa Prabhu if (!attr) 408210c9ead9SRoopa Prabhu goto nla_put_failure; 408310c9ead9SRoopa Prabhu 408410c9ead9SRoopa Prabhu sp = nla_data(attr); 408510c9ead9SRoopa Prabhu dev_get_stats(dev, sp); 408610c9ead9SRoopa Prabhu } 408710c9ead9SRoopa Prabhu 408897a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) { 408997a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 409097a47facSNikolay Aleksandrov 409197a47facSNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 409297a47facSNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS; 409397a47facSNikolay Aleksandrov attr = nla_nest_start(skb, 409497a47facSNikolay Aleksandrov IFLA_STATS_LINK_XSTATS); 409597a47facSNikolay Aleksandrov if (!attr) 409697a47facSNikolay Aleksandrov goto nla_put_failure; 409797a47facSNikolay Aleksandrov 409880e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 409980e73cc5SNikolay Aleksandrov nla_nest_end(skb, attr); 410080e73cc5SNikolay Aleksandrov if (err) 410180e73cc5SNikolay Aleksandrov goto nla_put_failure; 410280e73cc5SNikolay Aleksandrov *idxattr = 0; 410380e73cc5SNikolay Aleksandrov } 410480e73cc5SNikolay Aleksandrov } 410580e73cc5SNikolay Aleksandrov 410680e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 410780e73cc5SNikolay Aleksandrov *idxattr)) { 410880e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 410980e73cc5SNikolay Aleksandrov const struct net_device *master; 411080e73cc5SNikolay Aleksandrov 411180e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(dev); 411280e73cc5SNikolay Aleksandrov if (master) 411380e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 411480e73cc5SNikolay Aleksandrov if (ops && ops->fill_linkxstats) { 411580e73cc5SNikolay Aleksandrov *idxattr = IFLA_STATS_LINK_XSTATS_SLAVE; 411680e73cc5SNikolay Aleksandrov attr = nla_nest_start(skb, 411780e73cc5SNikolay Aleksandrov IFLA_STATS_LINK_XSTATS_SLAVE); 411880e73cc5SNikolay Aleksandrov if (!attr) 411980e73cc5SNikolay Aleksandrov goto nla_put_failure; 412080e73cc5SNikolay Aleksandrov 412180e73cc5SNikolay Aleksandrov err = ops->fill_linkxstats(skb, dev, prividx, *idxattr); 412297a47facSNikolay Aleksandrov nla_nest_end(skb, attr); 412397a47facSNikolay Aleksandrov if (err) 412497a47facSNikolay Aleksandrov goto nla_put_failure; 412597a47facSNikolay Aleksandrov *idxattr = 0; 412697a47facSNikolay Aleksandrov } 412797a47facSNikolay Aleksandrov } 412897a47facSNikolay Aleksandrov 412969ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 413069ae6ad2SNogah Frankel *idxattr)) { 413169ae6ad2SNogah Frankel *idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS; 413269ae6ad2SNogah Frankel attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS); 413369ae6ad2SNogah Frankel if (!attr) 413469ae6ad2SNogah Frankel goto nla_put_failure; 413569ae6ad2SNogah Frankel 413669ae6ad2SNogah Frankel err = rtnl_get_offload_stats(skb, dev, prividx); 413769ae6ad2SNogah Frankel if (err == -ENODATA) 413869ae6ad2SNogah Frankel nla_nest_cancel(skb, attr); 413969ae6ad2SNogah Frankel else 414069ae6ad2SNogah Frankel nla_nest_end(skb, attr); 414169ae6ad2SNogah Frankel 414269ae6ad2SNogah Frankel if (err && err != -ENODATA) 414369ae6ad2SNogah Frankel goto nla_put_failure; 414469ae6ad2SNogah Frankel *idxattr = 0; 414569ae6ad2SNogah Frankel } 414669ae6ad2SNogah Frankel 4147aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) { 4148aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 4149aefb4d4aSRobert Shearman 4150aefb4d4aSRobert Shearman *idxattr = IFLA_STATS_AF_SPEC; 4151aefb4d4aSRobert Shearman attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC); 4152aefb4d4aSRobert Shearman if (!attr) 4153aefb4d4aSRobert Shearman goto nla_put_failure; 4154aefb4d4aSRobert Shearman 41555fa85a09SFlorian Westphal rcu_read_lock(); 41565fa85a09SFlorian Westphal list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 4157aefb4d4aSRobert Shearman if (af_ops->fill_stats_af) { 4158aefb4d4aSRobert Shearman struct nlattr *af; 4159aefb4d4aSRobert Shearman int err; 4160aefb4d4aSRobert Shearman 4161aefb4d4aSRobert Shearman af = nla_nest_start(skb, af_ops->family); 41625fa85a09SFlorian Westphal if (!af) { 41635fa85a09SFlorian Westphal rcu_read_unlock(); 4164aefb4d4aSRobert Shearman goto nla_put_failure; 41655fa85a09SFlorian Westphal } 4166aefb4d4aSRobert Shearman err = af_ops->fill_stats_af(skb, dev); 4167aefb4d4aSRobert Shearman 41685fa85a09SFlorian Westphal if (err == -ENODATA) { 4169aefb4d4aSRobert Shearman nla_nest_cancel(skb, af); 41705fa85a09SFlorian Westphal } else if (err < 0) { 41715fa85a09SFlorian Westphal rcu_read_unlock(); 4172aefb4d4aSRobert Shearman goto nla_put_failure; 41735fa85a09SFlorian Westphal } 4174aefb4d4aSRobert Shearman 4175aefb4d4aSRobert Shearman nla_nest_end(skb, af); 4176aefb4d4aSRobert Shearman } 4177aefb4d4aSRobert Shearman } 41785fa85a09SFlorian Westphal rcu_read_unlock(); 4179aefb4d4aSRobert Shearman 4180aefb4d4aSRobert Shearman nla_nest_end(skb, attr); 4181aefb4d4aSRobert Shearman 4182aefb4d4aSRobert Shearman *idxattr = 0; 4183aefb4d4aSRobert Shearman } 4184aefb4d4aSRobert Shearman 418510c9ead9SRoopa Prabhu nlmsg_end(skb, nlh); 418610c9ead9SRoopa Prabhu 418710c9ead9SRoopa Prabhu return 0; 418810c9ead9SRoopa Prabhu 418910c9ead9SRoopa Prabhu nla_put_failure: 4190e8872a25SNikolay Aleksandrov /* not a multi message or no progress mean a real error */ 4191e8872a25SNikolay Aleksandrov if (!(flags & NLM_F_MULTI) || s_prividx == *prividx) 419210c9ead9SRoopa Prabhu nlmsg_cancel(skb, nlh); 4193e8872a25SNikolay Aleksandrov else 4194e8872a25SNikolay Aleksandrov nlmsg_end(skb, nlh); 419510c9ead9SRoopa Prabhu 419610c9ead9SRoopa Prabhu return -EMSGSIZE; 419710c9ead9SRoopa Prabhu } 419810c9ead9SRoopa Prabhu 419910c9ead9SRoopa Prabhu static size_t if_nlmsg_stats_size(const struct net_device *dev, 420010c9ead9SRoopa Prabhu u32 filter_mask) 420110c9ead9SRoopa Prabhu { 420210c9ead9SRoopa Prabhu size_t size = 0; 420310c9ead9SRoopa Prabhu 4204e8872a25SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0)) 420510c9ead9SRoopa Prabhu size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64)); 420610c9ead9SRoopa Prabhu 420797a47facSNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) { 420897a47facSNikolay Aleksandrov const struct rtnl_link_ops *ops = dev->rtnl_link_ops; 420980e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS; 421097a47facSNikolay Aleksandrov 421197a47facSNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 421280e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 421380e73cc5SNikolay Aleksandrov attr)); 421497a47facSNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS */ 421597a47facSNikolay Aleksandrov size += nla_total_size(0); 421697a47facSNikolay Aleksandrov } 421797a47facSNikolay Aleksandrov } 421897a47facSNikolay Aleksandrov 421980e73cc5SNikolay Aleksandrov if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) { 422080e73cc5SNikolay Aleksandrov struct net_device *_dev = (struct net_device *)dev; 422180e73cc5SNikolay Aleksandrov const struct rtnl_link_ops *ops = NULL; 422280e73cc5SNikolay Aleksandrov const struct net_device *master; 422380e73cc5SNikolay Aleksandrov 422480e73cc5SNikolay Aleksandrov /* netdev_master_upper_dev_get can't take const */ 422580e73cc5SNikolay Aleksandrov master = netdev_master_upper_dev_get(_dev); 422680e73cc5SNikolay Aleksandrov if (master) 422780e73cc5SNikolay Aleksandrov ops = master->rtnl_link_ops; 422880e73cc5SNikolay Aleksandrov if (ops && ops->get_linkxstats_size) { 422980e73cc5SNikolay Aleksandrov int attr = IFLA_STATS_LINK_XSTATS_SLAVE; 423080e73cc5SNikolay Aleksandrov 423180e73cc5SNikolay Aleksandrov size += nla_total_size(ops->get_linkxstats_size(dev, 423280e73cc5SNikolay Aleksandrov attr)); 423380e73cc5SNikolay Aleksandrov /* for IFLA_STATS_LINK_XSTATS_SLAVE */ 423480e73cc5SNikolay Aleksandrov size += nla_total_size(0); 423580e73cc5SNikolay Aleksandrov } 423680e73cc5SNikolay Aleksandrov } 423780e73cc5SNikolay Aleksandrov 423869ae6ad2SNogah Frankel if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0)) 423969ae6ad2SNogah Frankel size += rtnl_get_offload_stats_size(dev); 424069ae6ad2SNogah Frankel 4241aefb4d4aSRobert Shearman if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) { 4242aefb4d4aSRobert Shearman struct rtnl_af_ops *af_ops; 4243aefb4d4aSRobert Shearman 4244aefb4d4aSRobert Shearman /* for IFLA_STATS_AF_SPEC */ 4245aefb4d4aSRobert Shearman size += nla_total_size(0); 4246aefb4d4aSRobert Shearman 42475fa85a09SFlorian Westphal rcu_read_lock(); 42485fa85a09SFlorian Westphal list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) { 4249aefb4d4aSRobert Shearman if (af_ops->get_stats_af_size) { 4250aefb4d4aSRobert Shearman size += nla_total_size( 4251aefb4d4aSRobert Shearman af_ops->get_stats_af_size(dev)); 4252aefb4d4aSRobert Shearman 4253aefb4d4aSRobert Shearman /* for AF_* */ 4254aefb4d4aSRobert Shearman size += nla_total_size(0); 4255aefb4d4aSRobert Shearman } 4256aefb4d4aSRobert Shearman } 42575fa85a09SFlorian Westphal rcu_read_unlock(); 4258aefb4d4aSRobert Shearman } 4259aefb4d4aSRobert Shearman 426010c9ead9SRoopa Prabhu return size; 426110c9ead9SRoopa Prabhu } 426210c9ead9SRoopa Prabhu 4263c21ef3e3SDavid Ahern static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh, 4264c21ef3e3SDavid Ahern struct netlink_ext_ack *extack) 426510c9ead9SRoopa Prabhu { 426610c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 426710c9ead9SRoopa Prabhu struct net_device *dev = NULL; 4268e8872a25SNikolay Aleksandrov int idxattr = 0, prividx = 0; 4269e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 427010c9ead9SRoopa Prabhu struct sk_buff *nskb; 427110c9ead9SRoopa Prabhu u32 filter_mask; 427210c9ead9SRoopa Prabhu int err; 427310c9ead9SRoopa Prabhu 42744775cc1fSMathias Krause if (nlmsg_len(nlh) < sizeof(*ifsm)) 42754775cc1fSMathias Krause return -EINVAL; 42764775cc1fSMathias Krause 427710c9ead9SRoopa Prabhu ifsm = nlmsg_data(nlh); 427810c9ead9SRoopa Prabhu if (ifsm->ifindex > 0) 427910c9ead9SRoopa Prabhu dev = __dev_get_by_index(net, ifsm->ifindex); 428010c9ead9SRoopa Prabhu else 428110c9ead9SRoopa Prabhu return -EINVAL; 428210c9ead9SRoopa Prabhu 428310c9ead9SRoopa Prabhu if (!dev) 428410c9ead9SRoopa Prabhu return -ENODEV; 428510c9ead9SRoopa Prabhu 428610c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 428710c9ead9SRoopa Prabhu if (!filter_mask) 428810c9ead9SRoopa Prabhu return -EINVAL; 428910c9ead9SRoopa Prabhu 429010c9ead9SRoopa Prabhu nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL); 429110c9ead9SRoopa Prabhu if (!nskb) 429210c9ead9SRoopa Prabhu return -ENOBUFS; 429310c9ead9SRoopa Prabhu 429410c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS, 429510c9ead9SRoopa Prabhu NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0, 4296e8872a25SNikolay Aleksandrov 0, filter_mask, &idxattr, &prividx); 429710c9ead9SRoopa Prabhu if (err < 0) { 429810c9ead9SRoopa Prabhu /* -EMSGSIZE implies BUG in if_nlmsg_stats_size */ 429910c9ead9SRoopa Prabhu WARN_ON(err == -EMSGSIZE); 430010c9ead9SRoopa Prabhu kfree_skb(nskb); 430110c9ead9SRoopa Prabhu } else { 430210c9ead9SRoopa Prabhu err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid); 430310c9ead9SRoopa Prabhu } 430410c9ead9SRoopa Prabhu 430510c9ead9SRoopa Prabhu return err; 430610c9ead9SRoopa Prabhu } 430710c9ead9SRoopa Prabhu 430810c9ead9SRoopa Prabhu static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb) 430910c9ead9SRoopa Prabhu { 4310e8872a25SNikolay Aleksandrov int h, s_h, err, s_idx, s_idxattr, s_prividx; 431110c9ead9SRoopa Prabhu struct net *net = sock_net(skb->sk); 431210c9ead9SRoopa Prabhu unsigned int flags = NLM_F_MULTI; 4313e8872a25SNikolay Aleksandrov struct if_stats_msg *ifsm; 4314e8872a25SNikolay Aleksandrov struct hlist_head *head; 4315e8872a25SNikolay Aleksandrov struct net_device *dev; 431610c9ead9SRoopa Prabhu u32 filter_mask = 0; 4317e8872a25SNikolay Aleksandrov int idx = 0; 431810c9ead9SRoopa Prabhu 431910c9ead9SRoopa Prabhu s_h = cb->args[0]; 432010c9ead9SRoopa Prabhu s_idx = cb->args[1]; 4321e8872a25SNikolay Aleksandrov s_idxattr = cb->args[2]; 4322e8872a25SNikolay Aleksandrov s_prividx = cb->args[3]; 432310c9ead9SRoopa Prabhu 432410c9ead9SRoopa Prabhu cb->seq = net->dev_base_seq; 432510c9ead9SRoopa Prabhu 43264775cc1fSMathias Krause if (nlmsg_len(cb->nlh) < sizeof(*ifsm)) 43274775cc1fSMathias Krause return -EINVAL; 43284775cc1fSMathias Krause 432910c9ead9SRoopa Prabhu ifsm = nlmsg_data(cb->nlh); 433010c9ead9SRoopa Prabhu filter_mask = ifsm->filter_mask; 433110c9ead9SRoopa Prabhu if (!filter_mask) 433210c9ead9SRoopa Prabhu return -EINVAL; 433310c9ead9SRoopa Prabhu 433410c9ead9SRoopa Prabhu for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { 433510c9ead9SRoopa Prabhu idx = 0; 433610c9ead9SRoopa Prabhu head = &net->dev_index_head[h]; 433710c9ead9SRoopa Prabhu hlist_for_each_entry(dev, head, index_hlist) { 433810c9ead9SRoopa Prabhu if (idx < s_idx) 433910c9ead9SRoopa Prabhu goto cont; 434010c9ead9SRoopa Prabhu err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS, 434110c9ead9SRoopa Prabhu NETLINK_CB(cb->skb).portid, 434210c9ead9SRoopa Prabhu cb->nlh->nlmsg_seq, 0, 4343e8872a25SNikolay Aleksandrov flags, filter_mask, 4344e8872a25SNikolay Aleksandrov &s_idxattr, &s_prividx); 434510c9ead9SRoopa Prabhu /* If we ran out of room on the first message, 434610c9ead9SRoopa Prabhu * we're in trouble 434710c9ead9SRoopa Prabhu */ 434810c9ead9SRoopa Prabhu WARN_ON((err == -EMSGSIZE) && (skb->len == 0)); 434910c9ead9SRoopa Prabhu 435010c9ead9SRoopa Prabhu if (err < 0) 435110c9ead9SRoopa Prabhu goto out; 4352e8872a25SNikolay Aleksandrov s_prividx = 0; 4353e8872a25SNikolay Aleksandrov s_idxattr = 0; 435410c9ead9SRoopa Prabhu nl_dump_check_consistent(cb, nlmsg_hdr(skb)); 435510c9ead9SRoopa Prabhu cont: 435610c9ead9SRoopa Prabhu idx++; 435710c9ead9SRoopa Prabhu } 435810c9ead9SRoopa Prabhu } 435910c9ead9SRoopa Prabhu out: 4360e8872a25SNikolay Aleksandrov cb->args[3] = s_prividx; 4361e8872a25SNikolay Aleksandrov cb->args[2] = s_idxattr; 436210c9ead9SRoopa Prabhu cb->args[1] = idx; 436310c9ead9SRoopa Prabhu cb->args[0] = h; 436410c9ead9SRoopa Prabhu 436510c9ead9SRoopa Prabhu return skb->len; 436610c9ead9SRoopa Prabhu } 436710c9ead9SRoopa Prabhu 43681da177e4SLinus Torvalds /* Process one rtnetlink message. */ 43691da177e4SLinus Torvalds 43702d4bc933SJohannes Berg static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, 43712d4bc933SJohannes Berg struct netlink_ext_ack *extack) 43721da177e4SLinus Torvalds { 43733b1e0a65SYOSHIFUJI Hideaki struct net *net = sock_net(skb->sk); 4374*addf9b90SFlorian Westphal struct rtnl_link *link; 43756853dd48SFlorian Westphal int err = -EOPNOTSUPP; 4376e2849863SThomas Graf rtnl_doit_func doit; 437762256f98SFlorian Westphal unsigned int flags; 4378617cfc75SAlexander Kuleshov int kind; 43791da177e4SLinus Torvalds int family; 43801da177e4SLinus Torvalds int type; 43811da177e4SLinus Torvalds 43821da177e4SLinus Torvalds type = nlh->nlmsg_type; 43831da177e4SLinus Torvalds if (type > RTM_MAX) 4384038890feSThomas Graf return -EOPNOTSUPP; 43851da177e4SLinus Torvalds 43861da177e4SLinus Torvalds type -= RTM_BASE; 43871da177e4SLinus Torvalds 43881da177e4SLinus Torvalds /* All the messages must have at least 1 byte length */ 4389573ce260SHong zhi guo if (nlmsg_len(nlh) < sizeof(struct rtgenmsg)) 43901da177e4SLinus Torvalds return 0; 43911da177e4SLinus Torvalds 4392573ce260SHong zhi guo family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family; 43931da177e4SLinus Torvalds kind = type&3; 43941da177e4SLinus Torvalds 439590f62cf3SEric W. Biederman if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN)) 43961d00a4ebSThomas Graf return -EPERM; 43971da177e4SLinus Torvalds 43986853dd48SFlorian Westphal rcu_read_lock(); 4399b8f3ab42SDavid S. Miller if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { 440097c53cacSDenis V. Lunev struct sock *rtnl; 4401e2849863SThomas Graf rtnl_dumpit_func dumpit; 4402c7ac8679SGreg Rose u16 min_dump_alloc = 0; 44031da177e4SLinus Torvalds 4404*addf9b90SFlorian Westphal link = rtnl_get_link(family, type); 4405*addf9b90SFlorian Westphal if (!link || !link->dumpit) { 44066853dd48SFlorian Westphal family = PF_UNSPEC; 4407*addf9b90SFlorian Westphal link = rtnl_get_link(family, type); 4408*addf9b90SFlorian Westphal if (!link || !link->dumpit) 44096853dd48SFlorian Westphal goto err_unlock; 44106853dd48SFlorian Westphal } 4411*addf9b90SFlorian Westphal dumpit = link->dumpit; 44126853dd48SFlorian Westphal 4413019a3169SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 4414019a3169SFlorian Westphal 44155c2bb9b6SFlorian Westphal if (type == RTM_GETLINK - RTM_BASE) 4416e1fa6d21SFlorian Westphal min_dump_alloc = rtnl_calcit(skb, nlh); 44171da177e4SLinus Torvalds 44186853dd48SFlorian Westphal rcu_read_unlock(); 44196853dd48SFlorian Westphal 442097c53cacSDenis V. Lunev rtnl = net->rtnl; 442180d326faSPablo Neira Ayuso { 442280d326faSPablo Neira Ayuso struct netlink_dump_control c = { 442380d326faSPablo Neira Ayuso .dump = dumpit, 442480d326faSPablo Neira Ayuso .min_dump_alloc = min_dump_alloc, 442580d326faSPablo Neira Ayuso }; 442680d326faSPablo Neira Ayuso err = netlink_dump_start(rtnl, skb, nlh, &c); 442780d326faSPablo Neira Ayuso } 4428019a3169SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 44292907c35fSEric Dumazet return err; 44301da177e4SLinus Torvalds } 44311da177e4SLinus Torvalds 4432*addf9b90SFlorian Westphal link = rtnl_get_link(family, type); 4433*addf9b90SFlorian Westphal if (!link || !link->doit) { 44348caa38b5SFlorian Westphal family = PF_UNSPEC; 4435*addf9b90SFlorian Westphal link = rtnl_get_link(PF_UNSPEC, type); 4436*addf9b90SFlorian Westphal if (!link || !link->doit) 4437*addf9b90SFlorian Westphal goto out_unlock; 44388caa38b5SFlorian Westphal } 44398caa38b5SFlorian Westphal 4440*addf9b90SFlorian Westphal flags = link->flags; 444162256f98SFlorian Westphal if (flags & RTNL_FLAG_DOIT_UNLOCKED) { 444262256f98SFlorian Westphal refcount_inc(&rtnl_msg_handlers_ref[family]); 4443*addf9b90SFlorian Westphal doit = link->doit; 444462256f98SFlorian Westphal rcu_read_unlock(); 444562256f98SFlorian Westphal if (doit) 444662256f98SFlorian Westphal err = doit(skb, nlh, extack); 444762256f98SFlorian Westphal refcount_dec(&rtnl_msg_handlers_ref[family]); 444862256f98SFlorian Westphal return err; 444962256f98SFlorian Westphal } 44506853dd48SFlorian Westphal rcu_read_unlock(); 44516853dd48SFlorian Westphal 44520cc09020SFlorian Westphal rtnl_lock(); 4453*addf9b90SFlorian Westphal link = rtnl_get_link(family, type); 4454*addf9b90SFlorian Westphal if (link && link->doit) 4455*addf9b90SFlorian Westphal err = link->doit(skb, nlh, extack); 44560cc09020SFlorian Westphal rtnl_unlock(); 4457*addf9b90SFlorian Westphal 4458*addf9b90SFlorian Westphal return err; 4459*addf9b90SFlorian Westphal 4460*addf9b90SFlorian Westphal out_unlock: 4461*addf9b90SFlorian Westphal rcu_read_unlock(); 44620cc09020SFlorian Westphal return err; 44630cc09020SFlorian Westphal 44640cc09020SFlorian Westphal err_unlock: 44656853dd48SFlorian Westphal rcu_read_unlock(); 44660cc09020SFlorian Westphal return -EOPNOTSUPP; 44671da177e4SLinus Torvalds } 44681da177e4SLinus Torvalds 4469cd40b7d3SDenis V. Lunev static void rtnetlink_rcv(struct sk_buff *skb) 44701da177e4SLinus Torvalds { 4471cd40b7d3SDenis V. Lunev netlink_rcv_skb(skb, &rtnetlink_rcv_msg); 44721da177e4SLinus Torvalds } 44731da177e4SLinus Torvalds 44745f729eaaSJulien Gomes static int rtnetlink_bind(struct net *net, int group) 44755f729eaaSJulien Gomes { 44765f729eaaSJulien Gomes switch (group) { 44775f729eaaSJulien Gomes case RTNLGRP_IPV4_MROUTE_R: 44785f729eaaSJulien Gomes case RTNLGRP_IPV6_MROUTE_R: 44795f729eaaSJulien Gomes if (!ns_capable(net->user_ns, CAP_NET_ADMIN)) 44805f729eaaSJulien Gomes return -EPERM; 44815f729eaaSJulien Gomes break; 44825f729eaaSJulien Gomes } 44835f729eaaSJulien Gomes return 0; 44845f729eaaSJulien Gomes } 44855f729eaaSJulien Gomes 44861da177e4SLinus Torvalds static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) 44871da177e4SLinus Torvalds { 4488351638e7SJiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 4489e9dc8653SEric W. Biederman 44901da177e4SLinus Torvalds switch (event) { 44915138e86fSVlad Yasevich case NETDEV_REBOOT: 44928a212589SXin Long case NETDEV_CHANGEMTU: 44933753654eSDavid Ahern case NETDEV_CHANGEADDR: 44945138e86fSVlad Yasevich case NETDEV_CHANGENAME: 44955138e86fSVlad Yasevich case NETDEV_FEAT_CHANGE: 44965138e86fSVlad Yasevich case NETDEV_BONDING_FAILOVER: 4497e6e66594SXin Long case NETDEV_POST_TYPE_CHANGE: 44985138e86fSVlad Yasevich case NETDEV_NOTIFY_PEERS: 4499dc709f37SXin Long case NETDEV_CHANGEUPPER: 45005138e86fSVlad Yasevich case NETDEV_RESEND_IGMP: 45015138e86fSVlad Yasevich case NETDEV_CHANGEINFODATA: 4502eeda3fb9SXin Long case NETDEV_CHANGELOWERSTATE: 4503ebdcf045SXin Long case NETDEV_CHANGE_TX_QUEUE_LEN: 45043d3ea5afSVlad Yasevich rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event), 45056621dd29SNicolas Dichtel GFP_KERNEL, NULL); 45061da177e4SLinus Torvalds break; 45071da177e4SLinus Torvalds default: 45081da177e4SLinus Torvalds break; 45091da177e4SLinus Torvalds } 45101da177e4SLinus Torvalds return NOTIFY_DONE; 45111da177e4SLinus Torvalds } 45121da177e4SLinus Torvalds 45131da177e4SLinus Torvalds static struct notifier_block rtnetlink_dev_notifier = { 45141da177e4SLinus Torvalds .notifier_call = rtnetlink_event, 45151da177e4SLinus Torvalds }; 45161da177e4SLinus Torvalds 451797c53cacSDenis V. Lunev 45182c8c1e72SAlexey Dobriyan static int __net_init rtnetlink_net_init(struct net *net) 451997c53cacSDenis V. Lunev { 452097c53cacSDenis V. Lunev struct sock *sk; 4521a31f2d17SPablo Neira Ayuso struct netlink_kernel_cfg cfg = { 4522a31f2d17SPablo Neira Ayuso .groups = RTNLGRP_MAX, 4523a31f2d17SPablo Neira Ayuso .input = rtnetlink_rcv, 4524a31f2d17SPablo Neira Ayuso .cb_mutex = &rtnl_mutex, 45259785e10aSPablo Neira Ayuso .flags = NL_CFG_F_NONROOT_RECV, 45265f729eaaSJulien Gomes .bind = rtnetlink_bind, 4527a31f2d17SPablo Neira Ayuso }; 4528a31f2d17SPablo Neira Ayuso 45299f00d977SPablo Neira Ayuso sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg); 453097c53cacSDenis V. Lunev if (!sk) 453197c53cacSDenis V. Lunev return -ENOMEM; 453297c53cacSDenis V. Lunev net->rtnl = sk; 453397c53cacSDenis V. Lunev return 0; 453497c53cacSDenis V. Lunev } 453597c53cacSDenis V. Lunev 45362c8c1e72SAlexey Dobriyan static void __net_exit rtnetlink_net_exit(struct net *net) 453797c53cacSDenis V. Lunev { 4538b7c6ba6eSDenis V. Lunev netlink_kernel_release(net->rtnl); 453997c53cacSDenis V. Lunev net->rtnl = NULL; 454097c53cacSDenis V. Lunev } 454197c53cacSDenis V. Lunev 454297c53cacSDenis V. Lunev static struct pernet_operations rtnetlink_net_ops = { 454397c53cacSDenis V. Lunev .init = rtnetlink_net_init, 454497c53cacSDenis V. Lunev .exit = rtnetlink_net_exit, 454597c53cacSDenis V. Lunev }; 454697c53cacSDenis V. Lunev 45471da177e4SLinus Torvalds void __init rtnetlink_init(void) 45481da177e4SLinus Torvalds { 4549d38a6512SFlorian Westphal int i; 4550d38a6512SFlorian Westphal 4551d38a6512SFlorian Westphal for (i = 0; i < ARRAY_SIZE(rtnl_msg_handlers_ref); i++) 4552d38a6512SFlorian Westphal refcount_set(&rtnl_msg_handlers_ref[i], 1); 4553d38a6512SFlorian Westphal 455497c53cacSDenis V. Lunev if (register_pernet_subsys(&rtnetlink_net_ops)) 45551da177e4SLinus Torvalds panic("rtnetlink_init: cannot initialize rtnetlink\n"); 455697c53cacSDenis V. Lunev 45571da177e4SLinus Torvalds register_netdevice_notifier(&rtnetlink_dev_notifier); 4558340d17fcSThomas Graf 4559c7ac8679SGreg Rose rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, 4560b97bac64SFlorian Westphal rtnl_dump_ifinfo, 0); 4561b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0); 4562b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0); 4563b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0); 4564687ad8ccSThomas Graf 4565b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0); 4566b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0); 4567b97bac64SFlorian Westphal rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0); 456877162022SJohn Fastabend 4569b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0); 4570b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0); 4571b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0); 4572e5a55a89SJohn Fastabend 4573b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0); 4574b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0); 4575b97bac64SFlorian Westphal rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0); 457610c9ead9SRoopa Prabhu 457710c9ead9SRoopa Prabhu rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump, 4578b97bac64SFlorian Westphal 0); 45791da177e4SLinus Torvalds } 4580