Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * INET An implementation of the TCP/IP protocol suite for the LINUX | |
3 | * operating system. INET is implemented using the BSD Socket | |
4 | * interface as the means of communication with the user level. | |
5 | * | |
6 | * Routing netlink socket interface: protocol independent part. | |
7 | * | |
8 | * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or | |
11 | * modify it under the terms of the GNU General Public License | |
12 | * as published by the Free Software Foundation; either version | |
13 | * 2 of the License, or (at your option) any later version. | |
14 | * | |
15 | * Fixes: | |
16 | * Vitaly E. Lavrov RTA_OK arithmetics was wrong. | |
17 | */ | |
18 | ||
1da177e4 LT |
19 | #include <linux/errno.h> |
20 | #include <linux/module.h> | |
21 | #include <linux/types.h> | |
22 | #include <linux/socket.h> | |
23 | #include <linux/kernel.h> | |
1da177e4 LT |
24 | #include <linux/timer.h> |
25 | #include <linux/string.h> | |
26 | #include <linux/sockios.h> | |
27 | #include <linux/net.h> | |
28 | #include <linux/fcntl.h> | |
29 | #include <linux/mm.h> | |
30 | #include <linux/slab.h> | |
31 | #include <linux/interrupt.h> | |
32 | #include <linux/capability.h> | |
33 | #include <linux/skbuff.h> | |
34 | #include <linux/init.h> | |
35 | #include <linux/security.h> | |
6756ae4b | 36 | #include <linux/mutex.h> |
1823730f | 37 | #include <linux/if_addr.h> |
ebc08a6f | 38 | #include <linux/pci.h> |
1da177e4 LT |
39 | |
40 | #include <asm/uaccess.h> | |
41 | #include <asm/system.h> | |
1da177e4 LT |
42 | |
43 | #include <linux/inet.h> | |
44 | #include <linux/netdevice.h> | |
45 | #include <net/ip.h> | |
46 | #include <net/protocol.h> | |
47 | #include <net/arp.h> | |
48 | #include <net/route.h> | |
49 | #include <net/udp.h> | |
50 | #include <net/sock.h> | |
51 | #include <net/pkt_sched.h> | |
14c0b97d | 52 | #include <net/fib_rules.h> |
e2849863 | 53 | #include <net/rtnetlink.h> |
30ffee84 | 54 | #include <net/net_namespace.h> |
1da177e4 | 55 | |
e0d087af | 56 | struct rtnl_link { |
e2849863 TG |
57 | rtnl_doit_func doit; |
58 | rtnl_dumpit_func dumpit; | |
59 | }; | |
60 | ||
6756ae4b | 61 | static DEFINE_MUTEX(rtnl_mutex); |
1da177e4 LT |
62 | |
63 | void rtnl_lock(void) | |
64 | { | |
6756ae4b | 65 | mutex_lock(&rtnl_mutex); |
1da177e4 | 66 | } |
e0d087af | 67 | EXPORT_SYMBOL(rtnl_lock); |
1da177e4 | 68 | |
6756ae4b | 69 | void __rtnl_unlock(void) |
1da177e4 | 70 | { |
6756ae4b | 71 | mutex_unlock(&rtnl_mutex); |
1da177e4 | 72 | } |
6756ae4b | 73 | |
1da177e4 LT |
74 | void rtnl_unlock(void) |
75 | { | |
58ec3b4d | 76 | /* This fellow will unlock it for us. */ |
1da177e4 LT |
77 | netdev_run_todo(); |
78 | } | |
e0d087af | 79 | EXPORT_SYMBOL(rtnl_unlock); |
1da177e4 | 80 | |
6756ae4b SH |
81 | int rtnl_trylock(void) |
82 | { | |
83 | return mutex_trylock(&rtnl_mutex); | |
84 | } | |
e0d087af | 85 | EXPORT_SYMBOL(rtnl_trylock); |
6756ae4b | 86 | |
c9c1014b PM |
87 | int rtnl_is_locked(void) |
88 | { | |
89 | return mutex_is_locked(&rtnl_mutex); | |
90 | } | |
e0d087af | 91 | EXPORT_SYMBOL(rtnl_is_locked); |
c9c1014b | 92 | |
a898def2 PM |
93 | #ifdef CONFIG_PROVE_LOCKING |
94 | int lockdep_rtnl_is_held(void) | |
95 | { | |
96 | return lockdep_is_held(&rtnl_mutex); | |
97 | } | |
98 | EXPORT_SYMBOL(lockdep_rtnl_is_held); | |
99 | #endif /* #ifdef CONFIG_PROVE_LOCKING */ | |
100 | ||
25239cee | 101 | static struct rtnl_link *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1]; |
e2849863 TG |
102 | |
103 | static inline int rtm_msgindex(int msgtype) | |
104 | { | |
105 | int msgindex = msgtype - RTM_BASE; | |
106 | ||
107 | /* | |
108 | * msgindex < 0 implies someone tried to register a netlink | |
109 | * control code. msgindex >= RTM_NR_MSGTYPES may indicate that | |
110 | * the message type has not been added to linux/rtnetlink.h | |
111 | */ | |
112 | BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES); | |
113 | ||
114 | return msgindex; | |
115 | } | |
116 | ||
117 | static rtnl_doit_func rtnl_get_doit(int protocol, int msgindex) | |
118 | { | |
119 | struct rtnl_link *tab; | |
120 | ||
25239cee | 121 | if (protocol <= RTNL_FAMILY_MAX) |
0f87b1dd PM |
122 | tab = rtnl_msg_handlers[protocol]; |
123 | else | |
124 | tab = NULL; | |
125 | ||
51057f2f | 126 | if (tab == NULL || tab[msgindex].doit == NULL) |
e2849863 TG |
127 | tab = rtnl_msg_handlers[PF_UNSPEC]; |
128 | ||
51057f2f | 129 | return tab ? tab[msgindex].doit : NULL; |
e2849863 TG |
130 | } |
131 | ||
132 | static rtnl_dumpit_func rtnl_get_dumpit(int protocol, int msgindex) | |
133 | { | |
134 | struct rtnl_link *tab; | |
135 | ||
25239cee | 136 | if (protocol <= RTNL_FAMILY_MAX) |
0f87b1dd PM |
137 | tab = rtnl_msg_handlers[protocol]; |
138 | else | |
139 | tab = NULL; | |
140 | ||
51057f2f | 141 | if (tab == NULL || tab[msgindex].dumpit == NULL) |
e2849863 TG |
142 | tab = rtnl_msg_handlers[PF_UNSPEC]; |
143 | ||
51057f2f | 144 | return tab ? tab[msgindex].dumpit : NULL; |
e2849863 TG |
145 | } |
146 | ||
147 | /** | |
148 | * __rtnl_register - Register a rtnetlink message type | |
149 | * @protocol: Protocol family or PF_UNSPEC | |
150 | * @msgtype: rtnetlink message type | |
151 | * @doit: Function pointer called for each request message | |
152 | * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message | |
153 | * | |
154 | * Registers the specified function pointers (at least one of them has | |
155 | * to be non-NULL) to be called whenever a request message for the | |
156 | * specified protocol family and message type is received. | |
157 | * | |
158 | * The special protocol family PF_UNSPEC may be used to define fallback | |
159 | * function pointers for the case when no entry for the specific protocol | |
160 | * family exists. | |
161 | * | |
162 | * Returns 0 on success or a negative error code. | |
163 | */ | |
164 | int __rtnl_register(int protocol, int msgtype, | |
165 | rtnl_doit_func doit, rtnl_dumpit_func dumpit) | |
166 | { | |
167 | struct rtnl_link *tab; | |
168 | int msgindex; | |
169 | ||
25239cee | 170 | BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); |
e2849863 TG |
171 | msgindex = rtm_msgindex(msgtype); |
172 | ||
173 | tab = rtnl_msg_handlers[protocol]; | |
174 | if (tab == NULL) { | |
175 | tab = kcalloc(RTM_NR_MSGTYPES, sizeof(*tab), GFP_KERNEL); | |
176 | if (tab == NULL) | |
177 | return -ENOBUFS; | |
178 | ||
179 | rtnl_msg_handlers[protocol] = tab; | |
180 | } | |
181 | ||
182 | if (doit) | |
183 | tab[msgindex].doit = doit; | |
184 | ||
185 | if (dumpit) | |
186 | tab[msgindex].dumpit = dumpit; | |
187 | ||
188 | return 0; | |
189 | } | |
e2849863 TG |
190 | EXPORT_SYMBOL_GPL(__rtnl_register); |
191 | ||
192 | /** | |
193 | * rtnl_register - Register a rtnetlink message type | |
194 | * | |
195 | * Identical to __rtnl_register() but panics on failure. This is useful | |
196 | * as failure of this function is very unlikely, it can only happen due | |
197 | * to lack of memory when allocating the chain to store all message | |
198 | * handlers for a protocol. Meant for use in init functions where lack | |
199 | * of memory implies no sense in continueing. | |
200 | */ | |
201 | void rtnl_register(int protocol, int msgtype, | |
202 | rtnl_doit_func doit, rtnl_dumpit_func dumpit) | |
203 | { | |
204 | if (__rtnl_register(protocol, msgtype, doit, dumpit) < 0) | |
205 | panic("Unable to register rtnetlink message handler, " | |
206 | "protocol = %d, message type = %d\n", | |
207 | protocol, msgtype); | |
208 | } | |
e2849863 TG |
209 | EXPORT_SYMBOL_GPL(rtnl_register); |
210 | ||
211 | /** | |
212 | * rtnl_unregister - Unregister a rtnetlink message type | |
213 | * @protocol: Protocol family or PF_UNSPEC | |
214 | * @msgtype: rtnetlink message type | |
215 | * | |
216 | * Returns 0 on success or a negative error code. | |
217 | */ | |
218 | int rtnl_unregister(int protocol, int msgtype) | |
219 | { | |
220 | int msgindex; | |
221 | ||
25239cee | 222 | BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); |
e2849863 TG |
223 | msgindex = rtm_msgindex(msgtype); |
224 | ||
225 | if (rtnl_msg_handlers[protocol] == NULL) | |
226 | return -ENOENT; | |
227 | ||
228 | rtnl_msg_handlers[protocol][msgindex].doit = NULL; | |
229 | rtnl_msg_handlers[protocol][msgindex].dumpit = NULL; | |
230 | ||
231 | return 0; | |
232 | } | |
e2849863 TG |
233 | EXPORT_SYMBOL_GPL(rtnl_unregister); |
234 | ||
235 | /** | |
236 | * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol | |
237 | * @protocol : Protocol family or PF_UNSPEC | |
238 | * | |
239 | * Identical to calling rtnl_unregster() for all registered message types | |
240 | * of a certain protocol family. | |
241 | */ | |
242 | void rtnl_unregister_all(int protocol) | |
243 | { | |
25239cee | 244 | BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX); |
e2849863 TG |
245 | |
246 | kfree(rtnl_msg_handlers[protocol]); | |
247 | rtnl_msg_handlers[protocol] = NULL; | |
248 | } | |
e2849863 | 249 | EXPORT_SYMBOL_GPL(rtnl_unregister_all); |
1da177e4 | 250 | |
38f7b870 PM |
251 | static LIST_HEAD(link_ops); |
252 | ||
253 | /** | |
254 | * __rtnl_link_register - Register rtnl_link_ops with rtnetlink. | |
255 | * @ops: struct rtnl_link_ops * to register | |
256 | * | |
257 | * The caller must hold the rtnl_mutex. This function should be used | |
258 | * by drivers that create devices during module initialization. It | |
259 | * must be called before registering the devices. | |
260 | * | |
261 | * Returns 0 on success or a negative error code. | |
262 | */ | |
263 | int __rtnl_link_register(struct rtnl_link_ops *ops) | |
264 | { | |
2d85cba2 | 265 | if (!ops->dellink) |
23289a37 | 266 | ops->dellink = unregister_netdevice_queue; |
2d85cba2 | 267 | |
38f7b870 PM |
268 | list_add_tail(&ops->list, &link_ops); |
269 | return 0; | |
270 | } | |
38f7b870 PM |
271 | EXPORT_SYMBOL_GPL(__rtnl_link_register); |
272 | ||
273 | /** | |
274 | * rtnl_link_register - Register rtnl_link_ops with rtnetlink. | |
275 | * @ops: struct rtnl_link_ops * to register | |
276 | * | |
277 | * Returns 0 on success or a negative error code. | |
278 | */ | |
279 | int rtnl_link_register(struct rtnl_link_ops *ops) | |
280 | { | |
281 | int err; | |
282 | ||
283 | rtnl_lock(); | |
284 | err = __rtnl_link_register(ops); | |
285 | rtnl_unlock(); | |
286 | return err; | |
287 | } | |
38f7b870 PM |
288 | EXPORT_SYMBOL_GPL(rtnl_link_register); |
289 | ||
669f87ba PE |
290 | static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops) |
291 | { | |
292 | struct net_device *dev; | |
23289a37 ED |
293 | LIST_HEAD(list_kill); |
294 | ||
669f87ba | 295 | for_each_netdev(net, dev) { |
23289a37 ED |
296 | if (dev->rtnl_link_ops == ops) |
297 | ops->dellink(dev, &list_kill); | |
669f87ba | 298 | } |
23289a37 | 299 | unregister_netdevice_many(&list_kill); |
669f87ba PE |
300 | } |
301 | ||
302 | void rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops) | |
303 | { | |
304 | rtnl_lock(); | |
305 | __rtnl_kill_links(net, ops); | |
306 | rtnl_unlock(); | |
307 | } | |
308 | EXPORT_SYMBOL_GPL(rtnl_kill_links); | |
309 | ||
38f7b870 PM |
310 | /** |
311 | * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. | |
312 | * @ops: struct rtnl_link_ops * to unregister | |
313 | * | |
2d85cba2 | 314 | * The caller must hold the rtnl_mutex. |
38f7b870 PM |
315 | */ |
316 | void __rtnl_link_unregister(struct rtnl_link_ops *ops) | |
317 | { | |
881d966b | 318 | struct net *net; |
2d85cba2 | 319 | |
881d966b | 320 | for_each_net(net) { |
669f87ba | 321 | __rtnl_kill_links(net, ops); |
2d85cba2 | 322 | } |
38f7b870 PM |
323 | list_del(&ops->list); |
324 | } | |
38f7b870 PM |
325 | EXPORT_SYMBOL_GPL(__rtnl_link_unregister); |
326 | ||
327 | /** | |
328 | * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink. | |
329 | * @ops: struct rtnl_link_ops * to unregister | |
330 | */ | |
331 | void rtnl_link_unregister(struct rtnl_link_ops *ops) | |
332 | { | |
333 | rtnl_lock(); | |
334 | __rtnl_link_unregister(ops); | |
335 | rtnl_unlock(); | |
336 | } | |
38f7b870 PM |
337 | EXPORT_SYMBOL_GPL(rtnl_link_unregister); |
338 | ||
339 | static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind) | |
340 | { | |
341 | const struct rtnl_link_ops *ops; | |
342 | ||
343 | list_for_each_entry(ops, &link_ops, list) { | |
344 | if (!strcmp(ops->kind, kind)) | |
345 | return ops; | |
346 | } | |
347 | return NULL; | |
348 | } | |
349 | ||
350 | static size_t rtnl_link_get_size(const struct net_device *dev) | |
351 | { | |
352 | const struct rtnl_link_ops *ops = dev->rtnl_link_ops; | |
353 | size_t size; | |
354 | ||
355 | if (!ops) | |
356 | return 0; | |
357 | ||
358 | size = nlmsg_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */ | |
359 | nlmsg_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */ | |
360 | ||
361 | if (ops->get_size) | |
362 | /* IFLA_INFO_DATA + nested data */ | |
363 | size += nlmsg_total_size(sizeof(struct nlattr)) + | |
364 | ops->get_size(dev); | |
365 | ||
366 | if (ops->get_xstats_size) | |
367 | size += ops->get_xstats_size(dev); /* IFLA_INFO_XSTATS */ | |
368 | ||
369 | return size; | |
370 | } | |
371 | ||
372 | static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev) | |
373 | { | |
374 | const struct rtnl_link_ops *ops = dev->rtnl_link_ops; | |
375 | struct nlattr *linkinfo, *data; | |
376 | int err = -EMSGSIZE; | |
377 | ||
378 | linkinfo = nla_nest_start(skb, IFLA_LINKINFO); | |
379 | if (linkinfo == NULL) | |
380 | goto out; | |
381 | ||
382 | if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0) | |
383 | goto err_cancel_link; | |
384 | if (ops->fill_xstats) { | |
385 | err = ops->fill_xstats(skb, dev); | |
386 | if (err < 0) | |
387 | goto err_cancel_link; | |
388 | } | |
389 | if (ops->fill_info) { | |
390 | data = nla_nest_start(skb, IFLA_INFO_DATA); | |
391 | if (data == NULL) | |
392 | goto err_cancel_link; | |
393 | err = ops->fill_info(skb, dev); | |
394 | if (err < 0) | |
395 | goto err_cancel_data; | |
396 | nla_nest_end(skb, data); | |
397 | } | |
398 | ||
399 | nla_nest_end(skb, linkinfo); | |
400 | return 0; | |
401 | ||
402 | err_cancel_data: | |
403 | nla_nest_cancel(skb, data); | |
404 | err_cancel_link: | |
405 | nla_nest_cancel(skb, linkinfo); | |
406 | out: | |
407 | return err; | |
408 | } | |
409 | ||
db46edc6 | 410 | static const int rtm_min[RTM_NR_FAMILIES] = |
1da177e4 | 411 | { |
f90a0a74 TG |
412 | [RTM_FAM(RTM_NEWLINK)] = NLMSG_LENGTH(sizeof(struct ifinfomsg)), |
413 | [RTM_FAM(RTM_NEWADDR)] = NLMSG_LENGTH(sizeof(struct ifaddrmsg)), | |
414 | [RTM_FAM(RTM_NEWROUTE)] = NLMSG_LENGTH(sizeof(struct rtmsg)), | |
14c0b97d | 415 | [RTM_FAM(RTM_NEWRULE)] = NLMSG_LENGTH(sizeof(struct fib_rule_hdr)), |
f90a0a74 TG |
416 | [RTM_FAM(RTM_NEWQDISC)] = NLMSG_LENGTH(sizeof(struct tcmsg)), |
417 | [RTM_FAM(RTM_NEWTCLASS)] = NLMSG_LENGTH(sizeof(struct tcmsg)), | |
418 | [RTM_FAM(RTM_NEWTFILTER)] = NLMSG_LENGTH(sizeof(struct tcmsg)), | |
419 | [RTM_FAM(RTM_NEWACTION)] = NLMSG_LENGTH(sizeof(struct tcamsg)), | |
f90a0a74 TG |
420 | [RTM_FAM(RTM_GETMULTICAST)] = NLMSG_LENGTH(sizeof(struct rtgenmsg)), |
421 | [RTM_FAM(RTM_GETANYCAST)] = NLMSG_LENGTH(sizeof(struct rtgenmsg)), | |
1da177e4 LT |
422 | }; |
423 | ||
db46edc6 | 424 | static const int rta_max[RTM_NR_FAMILIES] = |
1da177e4 | 425 | { |
f90a0a74 TG |
426 | [RTM_FAM(RTM_NEWLINK)] = IFLA_MAX, |
427 | [RTM_FAM(RTM_NEWADDR)] = IFA_MAX, | |
428 | [RTM_FAM(RTM_NEWROUTE)] = RTA_MAX, | |
14c0b97d | 429 | [RTM_FAM(RTM_NEWRULE)] = FRA_MAX, |
f90a0a74 TG |
430 | [RTM_FAM(RTM_NEWQDISC)] = TCA_MAX, |
431 | [RTM_FAM(RTM_NEWTCLASS)] = TCA_MAX, | |
432 | [RTM_FAM(RTM_NEWTFILTER)] = TCA_MAX, | |
433 | [RTM_FAM(RTM_NEWACTION)] = TCAA_MAX, | |
1da177e4 LT |
434 | }; |
435 | ||
436 | void __rta_fill(struct sk_buff *skb, int attrtype, int attrlen, const void *data) | |
437 | { | |
438 | struct rtattr *rta; | |
439 | int size = RTA_LENGTH(attrlen); | |
440 | ||
e0d087af | 441 | rta = (struct rtattr *)skb_put(skb, RTA_ALIGN(size)); |
1da177e4 LT |
442 | rta->rta_type = attrtype; |
443 | rta->rta_len = size; | |
444 | memcpy(RTA_DATA(rta), data, attrlen); | |
b3563c4f | 445 | memset(RTA_DATA(rta) + attrlen, 0, RTA_ALIGN(size) - size); |
1da177e4 | 446 | } |
e0d087af | 447 | EXPORT_SYMBOL(__rta_fill); |
1da177e4 | 448 | |
97c53cac | 449 | int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned group, int echo) |
1da177e4 | 450 | { |
97c53cac | 451 | struct sock *rtnl = net->rtnl; |
1da177e4 LT |
452 | int err = 0; |
453 | ||
ac6d439d | 454 | NETLINK_CB(skb).dst_group = group; |
1da177e4 LT |
455 | if (echo) |
456 | atomic_inc(&skb->users); | |
457 | netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL); | |
458 | if (echo) | |
459 | err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT); | |
460 | return err; | |
461 | } | |
462 | ||
97c53cac | 463 | int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid) |
2942e900 | 464 | { |
97c53cac DL |
465 | struct sock *rtnl = net->rtnl; |
466 | ||
2942e900 TG |
467 | return nlmsg_unicast(rtnl, skb, pid); |
468 | } | |
e0d087af | 469 | EXPORT_SYMBOL(rtnl_unicast); |
2942e900 | 470 | |
1ce85fe4 PNA |
471 | void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group, |
472 | struct nlmsghdr *nlh, gfp_t flags) | |
97676b6b | 473 | { |
97c53cac | 474 | struct sock *rtnl = net->rtnl; |
97676b6b TG |
475 | int report = 0; |
476 | ||
477 | if (nlh) | |
478 | report = nlmsg_report(nlh); | |
479 | ||
1ce85fe4 | 480 | nlmsg_notify(rtnl, skb, pid, group, report, flags); |
97676b6b | 481 | } |
e0d087af | 482 | EXPORT_SYMBOL(rtnl_notify); |
97676b6b | 483 | |
97c53cac | 484 | void rtnl_set_sk_err(struct net *net, u32 group, int error) |
97676b6b | 485 | { |
97c53cac DL |
486 | struct sock *rtnl = net->rtnl; |
487 | ||
97676b6b TG |
488 | netlink_set_err(rtnl, 0, group, error); |
489 | } | |
e0d087af | 490 | EXPORT_SYMBOL(rtnl_set_sk_err); |
97676b6b | 491 | |
1da177e4 LT |
492 | int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics) |
493 | { | |
2d7202bf TG |
494 | struct nlattr *mx; |
495 | int i, valid = 0; | |
496 | ||
497 | mx = nla_nest_start(skb, RTA_METRICS); | |
498 | if (mx == NULL) | |
499 | return -ENOBUFS; | |
500 | ||
501 | for (i = 0; i < RTAX_MAX; i++) { | |
502 | if (metrics[i]) { | |
503 | valid++; | |
504 | NLA_PUT_U32(skb, i+1, metrics[i]); | |
505 | } | |
1da177e4 | 506 | } |
1da177e4 | 507 | |
a57d27fc DM |
508 | if (!valid) { |
509 | nla_nest_cancel(skb, mx); | |
510 | return 0; | |
511 | } | |
2d7202bf TG |
512 | |
513 | return nla_nest_end(skb, mx); | |
514 | ||
515 | nla_put_failure: | |
bc3ed28c TG |
516 | nla_nest_cancel(skb, mx); |
517 | return -EMSGSIZE; | |
1da177e4 | 518 | } |
e0d087af | 519 | EXPORT_SYMBOL(rtnetlink_put_metrics); |
1da177e4 | 520 | |
e3703b3d TG |
521 | int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id, |
522 | u32 ts, u32 tsage, long expires, u32 error) | |
523 | { | |
524 | struct rta_cacheinfo ci = { | |
525 | .rta_lastuse = jiffies_to_clock_t(jiffies - dst->lastuse), | |
526 | .rta_used = dst->__use, | |
527 | .rta_clntref = atomic_read(&(dst->__refcnt)), | |
528 | .rta_error = error, | |
529 | .rta_id = id, | |
530 | .rta_ts = ts, | |
531 | .rta_tsage = tsage, | |
532 | }; | |
533 | ||
534 | if (expires) | |
535 | ci.rta_expires = jiffies_to_clock_t(expires); | |
536 | ||
537 | return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci); | |
538 | } | |
e3703b3d | 539 | EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo); |
1da177e4 | 540 | |
93b2d4a2 | 541 | static void set_operstate(struct net_device *dev, unsigned char transition) |
b00055aa SR |
542 | { |
543 | unsigned char operstate = dev->operstate; | |
544 | ||
e0d087af | 545 | switch (transition) { |
b00055aa SR |
546 | case IF_OPER_UP: |
547 | if ((operstate == IF_OPER_DORMANT || | |
548 | operstate == IF_OPER_UNKNOWN) && | |
549 | !netif_dormant(dev)) | |
550 | operstate = IF_OPER_UP; | |
551 | break; | |
552 | ||
553 | case IF_OPER_DORMANT: | |
554 | if (operstate == IF_OPER_UP || | |
555 | operstate == IF_OPER_UNKNOWN) | |
556 | operstate = IF_OPER_DORMANT; | |
557 | break; | |
3ff50b79 | 558 | } |
b00055aa SR |
559 | |
560 | if (dev->operstate != operstate) { | |
561 | write_lock_bh(&dev_base_lock); | |
562 | dev->operstate = operstate; | |
563 | write_unlock_bh(&dev_base_lock); | |
93b2d4a2 DM |
564 | netdev_state_change(dev); |
565 | } | |
b00055aa SR |
566 | } |
567 | ||
3729d502 PM |
568 | static unsigned int rtnl_dev_combine_flags(const struct net_device *dev, |
569 | const struct ifinfomsg *ifm) | |
570 | { | |
571 | unsigned int flags = ifm->ifi_flags; | |
572 | ||
573 | /* bugwards compatibility: ifi_change == 0 is treated as ~0 */ | |
574 | if (ifm->ifi_change) | |
575 | flags = (flags & ifm->ifi_change) | | |
576 | (dev->flags & ~ifm->ifi_change); | |
577 | ||
578 | return flags; | |
579 | } | |
580 | ||
b60c5115 | 581 | static void copy_rtnl_link_stats(struct rtnl_link_stats *a, |
be1f3c2c | 582 | const struct rtnl_link_stats64 *b) |
1da177e4 | 583 | { |
b60c5115 TG |
584 | a->rx_packets = b->rx_packets; |
585 | a->tx_packets = b->tx_packets; | |
586 | a->rx_bytes = b->rx_bytes; | |
587 | a->tx_bytes = b->tx_bytes; | |
588 | a->rx_errors = b->rx_errors; | |
589 | a->tx_errors = b->tx_errors; | |
590 | a->rx_dropped = b->rx_dropped; | |
591 | a->tx_dropped = b->tx_dropped; | |
592 | ||
593 | a->multicast = b->multicast; | |
594 | a->collisions = b->collisions; | |
595 | ||
596 | a->rx_length_errors = b->rx_length_errors; | |
597 | a->rx_over_errors = b->rx_over_errors; | |
598 | a->rx_crc_errors = b->rx_crc_errors; | |
599 | a->rx_frame_errors = b->rx_frame_errors; | |
600 | a->rx_fifo_errors = b->rx_fifo_errors; | |
601 | a->rx_missed_errors = b->rx_missed_errors; | |
602 | ||
603 | a->tx_aborted_errors = b->tx_aborted_errors; | |
604 | a->tx_carrier_errors = b->tx_carrier_errors; | |
605 | a->tx_fifo_errors = b->tx_fifo_errors; | |
606 | a->tx_heartbeat_errors = b->tx_heartbeat_errors; | |
607 | a->tx_window_errors = b->tx_window_errors; | |
608 | ||
609 | a->rx_compressed = b->rx_compressed; | |
610 | a->tx_compressed = b->tx_compressed; | |
10708f37 JE |
611 | } |
612 | ||
be1f3c2c | 613 | static void copy_rtnl_link_stats64(void *v, const struct rtnl_link_stats64 *b) |
10708f37 | 614 | { |
afdcba37 | 615 | memcpy(v, b, sizeof(*b)); |
10708f37 | 616 | } |
1da177e4 | 617 | |
c02db8c6 | 618 | /* All VF info */ |
ebc08a6f WM |
619 | static inline int rtnl_vfinfo_size(const struct net_device *dev) |
620 | { | |
c02db8c6 CW |
621 | if (dev->dev.parent && dev_is_pci(dev->dev.parent)) { |
622 | ||
623 | int num_vfs = dev_num_vf(dev->dev.parent); | |
045de01a SF |
624 | size_t size = nla_total_size(sizeof(struct nlattr)); |
625 | size += nla_total_size(num_vfs * sizeof(struct nlattr)); | |
626 | size += num_vfs * | |
627 | (nla_total_size(sizeof(struct ifla_vf_mac)) + | |
628 | nla_total_size(sizeof(struct ifla_vf_vlan)) + | |
629 | nla_total_size(sizeof(struct ifla_vf_tx_rate))); | |
c02db8c6 CW |
630 | return size; |
631 | } else | |
ebc08a6f WM |
632 | return 0; |
633 | } | |
634 | ||
57b61080 SF |
635 | static size_t rtnl_port_size(const struct net_device *dev) |
636 | { | |
637 | size_t port_size = nla_total_size(4) /* PORT_VF */ | |
638 | + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ | |
639 | + nla_total_size(sizeof(struct ifla_port_vsi)) | |
640 | /* PORT_VSI_TYPE */ | |
641 | + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ | |
642 | + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ | |
643 | + nla_total_size(1) /* PROT_VDP_REQUEST */ | |
644 | + nla_total_size(2); /* PORT_VDP_RESPONSE */ | |
645 | size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); | |
646 | size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) | |
647 | + port_size; | |
648 | size_t port_self_size = nla_total_size(sizeof(struct nlattr)) | |
649 | + port_size; | |
650 | ||
651 | if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent) | |
652 | return 0; | |
653 | if (dev_num_vf(dev->dev.parent)) | |
654 | return port_self_size + vf_ports_size + | |
655 | vf_port_size * dev_num_vf(dev->dev.parent); | |
656 | else | |
657 | return port_self_size; | |
658 | } | |
659 | ||
9e34a5b5 | 660 | static noinline size_t if_nlmsg_size(const struct net_device *dev) |
339bf98f TG |
661 | { |
662 | return NLMSG_ALIGN(sizeof(struct ifinfomsg)) | |
663 | + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ | |
0b815a1a | 664 | + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ |
339bf98f TG |
665 | + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ |
666 | + nla_total_size(sizeof(struct rtnl_link_ifmap)) | |
667 | + nla_total_size(sizeof(struct rtnl_link_stats)) | |
adcfe196 | 668 | + nla_total_size(sizeof(struct rtnl_link_stats64)) |
339bf98f TG |
669 | + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ |
670 | + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ | |
671 | + nla_total_size(4) /* IFLA_TXQLEN */ | |
672 | + nla_total_size(4) /* IFLA_WEIGHT */ | |
673 | + nla_total_size(4) /* IFLA_MTU */ | |
674 | + nla_total_size(4) /* IFLA_LINK */ | |
675 | + nla_total_size(4) /* IFLA_MASTER */ | |
676 | + nla_total_size(1) /* IFLA_OPERSTATE */ | |
38f7b870 | 677 | + nla_total_size(1) /* IFLA_LINKMODE */ |
ebc08a6f | 678 | + nla_total_size(4) /* IFLA_NUM_VF */ |
c02db8c6 | 679 | + rtnl_vfinfo_size(dev) /* IFLA_VFINFO_LIST */ |
57b61080 | 680 | + rtnl_port_size(dev) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ |
38f7b870 | 681 | + rtnl_link_get_size(dev); /* IFLA_LINKINFO */ |
339bf98f TG |
682 | } |
683 | ||
57b61080 SF |
684 | static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) |
685 | { | |
686 | struct nlattr *vf_ports; | |
687 | struct nlattr *vf_port; | |
688 | int vf; | |
689 | int err; | |
690 | ||
691 | vf_ports = nla_nest_start(skb, IFLA_VF_PORTS); | |
692 | if (!vf_ports) | |
693 | return -EMSGSIZE; | |
694 | ||
695 | for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { | |
696 | vf_port = nla_nest_start(skb, IFLA_VF_PORT); | |
8ca94183 SF |
697 | if (!vf_port) |
698 | goto nla_put_failure; | |
57b61080 SF |
699 | NLA_PUT_U32(skb, IFLA_PORT_VF, vf); |
700 | err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); | |
8ca94183 SF |
701 | if (err == -EMSGSIZE) |
702 | goto nla_put_failure; | |
57b61080 | 703 | if (err) { |
57b61080 SF |
704 | nla_nest_cancel(skb, vf_port); |
705 | continue; | |
706 | } | |
707 | nla_nest_end(skb, vf_port); | |
708 | } | |
709 | ||
710 | nla_nest_end(skb, vf_ports); | |
711 | ||
712 | return 0; | |
8ca94183 SF |
713 | |
714 | nla_put_failure: | |
715 | nla_nest_cancel(skb, vf_ports); | |
716 | return -EMSGSIZE; | |
57b61080 SF |
717 | } |
718 | ||
719 | static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) | |
720 | { | |
721 | struct nlattr *port_self; | |
722 | int err; | |
723 | ||
724 | port_self = nla_nest_start(skb, IFLA_PORT_SELF); | |
725 | if (!port_self) | |
726 | return -EMSGSIZE; | |
727 | ||
728 | err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); | |
729 | if (err) { | |
730 | nla_nest_cancel(skb, port_self); | |
8ca94183 | 731 | return (err == -EMSGSIZE) ? err : 0; |
57b61080 SF |
732 | } |
733 | ||
734 | nla_nest_end(skb, port_self); | |
735 | ||
736 | return 0; | |
737 | } | |
738 | ||
739 | static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev) | |
740 | { | |
741 | int err; | |
742 | ||
743 | if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent) | |
744 | return 0; | |
745 | ||
746 | err = rtnl_port_self_fill(skb, dev); | |
747 | if (err) | |
748 | return err; | |
749 | ||
750 | if (dev_num_vf(dev->dev.parent)) { | |
751 | err = rtnl_vf_ports_fill(skb, dev); | |
752 | if (err) | |
753 | return err; | |
754 | } | |
755 | ||
756 | return 0; | |
757 | } | |
758 | ||
b60c5115 | 759 | static int rtnl_fill_ifinfo(struct sk_buff *skb, struct net_device *dev, |
575c3e2a PM |
760 | int type, u32 pid, u32 seq, u32 change, |
761 | unsigned int flags) | |
b60c5115 TG |
762 | { |
763 | struct ifinfomsg *ifm; | |
764 | struct nlmsghdr *nlh; | |
28172739 | 765 | struct rtnl_link_stats64 temp; |
be1f3c2c | 766 | const struct rtnl_link_stats64 *stats; |
96e74088 | 767 | struct nlattr *attr; |
1da177e4 | 768 | |
b60c5115 TG |
769 | nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); |
770 | if (nlh == NULL) | |
26932566 | 771 | return -EMSGSIZE; |
1da177e4 | 772 | |
b60c5115 TG |
773 | ifm = nlmsg_data(nlh); |
774 | ifm->ifi_family = AF_UNSPEC; | |
775 | ifm->__ifi_pad = 0; | |
776 | ifm->ifi_type = dev->type; | |
777 | ifm->ifi_index = dev->ifindex; | |
778 | ifm->ifi_flags = dev_get_flags(dev); | |
779 | ifm->ifi_change = change; | |
780 | ||
781 | NLA_PUT_STRING(skb, IFLA_IFNAME, dev->name); | |
782 | NLA_PUT_U32(skb, IFLA_TXQLEN, dev->tx_queue_len); | |
b60c5115 TG |
783 | NLA_PUT_U8(skb, IFLA_OPERSTATE, |
784 | netif_running(dev) ? dev->operstate : IF_OPER_DOWN); | |
785 | NLA_PUT_U8(skb, IFLA_LINKMODE, dev->link_mode); | |
786 | NLA_PUT_U32(skb, IFLA_MTU, dev->mtu); | |
787 | ||
788 | if (dev->ifindex != dev->iflink) | |
789 | NLA_PUT_U32(skb, IFLA_LINK, dev->iflink); | |
790 | ||
791 | if (dev->master) | |
792 | NLA_PUT_U32(skb, IFLA_MASTER, dev->master->ifindex); | |
1da177e4 | 793 | |
af356afa PM |
794 | if (dev->qdisc) |
795 | NLA_PUT_STRING(skb, IFLA_QDISC, dev->qdisc->ops->id); | |
b00055aa | 796 | |
0b815a1a SH |
797 | if (dev->ifalias) |
798 | NLA_PUT_STRING(skb, IFLA_IFALIAS, dev->ifalias); | |
799 | ||
1da177e4 LT |
800 | if (1) { |
801 | struct rtnl_link_ifmap map = { | |
802 | .mem_start = dev->mem_start, | |
803 | .mem_end = dev->mem_end, | |
804 | .base_addr = dev->base_addr, | |
805 | .irq = dev->irq, | |
806 | .dma = dev->dma, | |
807 | .port = dev->if_port, | |
808 | }; | |
b60c5115 | 809 | NLA_PUT(skb, IFLA_MAP, sizeof(map), &map); |
1da177e4 LT |
810 | } |
811 | ||
812 | if (dev->addr_len) { | |
b60c5115 TG |
813 | NLA_PUT(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr); |
814 | NLA_PUT(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast); | |
1da177e4 LT |
815 | } |
816 | ||
96e74088 PE |
817 | attr = nla_reserve(skb, IFLA_STATS, |
818 | sizeof(struct rtnl_link_stats)); | |
819 | if (attr == NULL) | |
820 | goto nla_put_failure; | |
b60c5115 | 821 | |
28172739 | 822 | stats = dev_get_stats(dev, &temp); |
96e74088 | 823 | copy_rtnl_link_stats(nla_data(attr), stats); |
1da177e4 | 824 | |
10708f37 JE |
825 | attr = nla_reserve(skb, IFLA_STATS64, |
826 | sizeof(struct rtnl_link_stats64)); | |
827 | if (attr == NULL) | |
828 | goto nla_put_failure; | |
10708f37 JE |
829 | copy_rtnl_link_stats64(nla_data(attr), stats); |
830 | ||
57b61080 SF |
831 | if (dev->dev.parent) |
832 | NLA_PUT_U32(skb, IFLA_NUM_VF, dev_num_vf(dev->dev.parent)); | |
833 | ||
ebc08a6f WM |
834 | if (dev->netdev_ops->ndo_get_vf_config && dev->dev.parent) { |
835 | int i; | |
ebc08a6f | 836 | |
c02db8c6 CW |
837 | struct nlattr *vfinfo, *vf; |
838 | int num_vfs = dev_num_vf(dev->dev.parent); | |
839 | ||
c02db8c6 CW |
840 | vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST); |
841 | if (!vfinfo) | |
842 | goto nla_put_failure; | |
843 | for (i = 0; i < num_vfs; i++) { | |
844 | struct ifla_vf_info ivi; | |
845 | struct ifla_vf_mac vf_mac; | |
846 | struct ifla_vf_vlan vf_vlan; | |
847 | struct ifla_vf_tx_rate vf_tx_rate; | |
ebc08a6f WM |
848 | if (dev->netdev_ops->ndo_get_vf_config(dev, i, &ivi)) |
849 | break; | |
c02db8c6 CW |
850 | vf_mac.vf = vf_vlan.vf = vf_tx_rate.vf = ivi.vf; |
851 | memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); | |
852 | vf_vlan.vlan = ivi.vlan; | |
853 | vf_vlan.qos = ivi.qos; | |
854 | vf_tx_rate.rate = ivi.tx_rate; | |
855 | vf = nla_nest_start(skb, IFLA_VF_INFO); | |
856 | if (!vf) { | |
857 | nla_nest_cancel(skb, vfinfo); | |
858 | goto nla_put_failure; | |
859 | } | |
860 | NLA_PUT(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac); | |
861 | NLA_PUT(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan); | |
862 | NLA_PUT(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), &vf_tx_rate); | |
863 | nla_nest_end(skb, vf); | |
ebc08a6f | 864 | } |
c02db8c6 | 865 | nla_nest_end(skb, vfinfo); |
ebc08a6f | 866 | } |
57b61080 SF |
867 | |
868 | if (rtnl_port_fill(skb, dev)) | |
869 | goto nla_put_failure; | |
870 | ||
38f7b870 PM |
871 | if (dev->rtnl_link_ops) { |
872 | if (rtnl_link_fill(skb, dev) < 0) | |
873 | goto nla_put_failure; | |
874 | } | |
875 | ||
b60c5115 TG |
876 | return nlmsg_end(skb, nlh); |
877 | ||
878 | nla_put_failure: | |
26932566 PM |
879 | nlmsg_cancel(skb, nlh); |
880 | return -EMSGSIZE; | |
1da177e4 LT |
881 | } |
882 | ||
b60c5115 | 883 | static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) |
1da177e4 | 884 | { |
3b1e0a65 | 885 | struct net *net = sock_net(skb->sk); |
7c28bd0b ED |
886 | int h, s_h; |
887 | int idx = 0, s_idx; | |
1da177e4 | 888 | struct net_device *dev; |
7c28bd0b ED |
889 | struct hlist_head *head; |
890 | struct hlist_node *node; | |
891 | ||
892 | s_h = cb->args[0]; | |
893 | s_idx = cb->args[1]; | |
894 | ||
895 | for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { | |
896 | idx = 0; | |
897 | head = &net->dev_index_head[h]; | |
898 | hlist_for_each_entry(dev, node, head, index_hlist) { | |
899 | if (idx < s_idx) | |
900 | goto cont; | |
901 | if (rtnl_fill_ifinfo(skb, dev, RTM_NEWLINK, | |
902 | NETLINK_CB(cb->skb).pid, | |
903 | cb->nlh->nlmsg_seq, 0, | |
904 | NLM_F_MULTI) <= 0) | |
905 | goto out; | |
7562f876 | 906 | cont: |
7c28bd0b ED |
907 | idx++; |
908 | } | |
1da177e4 | 909 | } |
7c28bd0b ED |
910 | out: |
911 | cb->args[1] = idx; | |
912 | cb->args[0] = h; | |
1da177e4 LT |
913 | |
914 | return skb->len; | |
915 | } | |
916 | ||
e7199288 | 917 | const struct nla_policy ifla_policy[IFLA_MAX+1] = { |
5176f91e | 918 | [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, |
38f7b870 PM |
919 | [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, |
920 | [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, | |
5176f91e | 921 | [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, |
da5e0494 | 922 | [IFLA_MTU] = { .type = NLA_U32 }, |
76e87306 | 923 | [IFLA_LINK] = { .type = NLA_U32 }, |
da5e0494 TG |
924 | [IFLA_TXQLEN] = { .type = NLA_U32 }, |
925 | [IFLA_WEIGHT] = { .type = NLA_U32 }, | |
926 | [IFLA_OPERSTATE] = { .type = NLA_U8 }, | |
927 | [IFLA_LINKMODE] = { .type = NLA_U8 }, | |
76e87306 | 928 | [IFLA_LINKINFO] = { .type = NLA_NESTED }, |
d8a5ec67 | 929 | [IFLA_NET_NS_PID] = { .type = NLA_U32 }, |
0b815a1a | 930 | [IFLA_IFALIAS] = { .type = NLA_STRING, .len = IFALIASZ-1 }, |
c02db8c6 | 931 | [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, |
57b61080 SF |
932 | [IFLA_VF_PORTS] = { .type = NLA_NESTED }, |
933 | [IFLA_PORT_SELF] = { .type = NLA_NESTED }, | |
da5e0494 | 934 | }; |
e0d087af | 935 | EXPORT_SYMBOL(ifla_policy); |
da5e0494 | 936 | |
38f7b870 PM |
937 | static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { |
938 | [IFLA_INFO_KIND] = { .type = NLA_STRING }, | |
939 | [IFLA_INFO_DATA] = { .type = NLA_NESTED }, | |
940 | }; | |
941 | ||
c02db8c6 CW |
942 | static const struct nla_policy ifla_vfinfo_policy[IFLA_VF_INFO_MAX+1] = { |
943 | [IFLA_VF_INFO] = { .type = NLA_NESTED }, | |
944 | }; | |
945 | ||
946 | static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { | |
947 | [IFLA_VF_MAC] = { .type = NLA_BINARY, | |
948 | .len = sizeof(struct ifla_vf_mac) }, | |
949 | [IFLA_VF_VLAN] = { .type = NLA_BINARY, | |
950 | .len = sizeof(struct ifla_vf_vlan) }, | |
951 | [IFLA_VF_TX_RATE] = { .type = NLA_BINARY, | |
952 | .len = sizeof(struct ifla_vf_tx_rate) }, | |
953 | }; | |
954 | ||
57b61080 SF |
955 | static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { |
956 | [IFLA_PORT_VF] = { .type = NLA_U32 }, | |
957 | [IFLA_PORT_PROFILE] = { .type = NLA_STRING, | |
958 | .len = PORT_PROFILE_MAX }, | |
959 | [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, | |
960 | .len = sizeof(struct ifla_port_vsi)}, | |
961 | [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, | |
962 | .len = PORT_UUID_MAX }, | |
963 | [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, | |
964 | .len = PORT_UUID_MAX }, | |
965 | [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, | |
966 | [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, | |
967 | }; | |
968 | ||
81adee47 EB |
969 | struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) |
970 | { | |
971 | struct net *net; | |
972 | /* Examine the link attributes and figure out which | |
973 | * network namespace we are talking about. | |
974 | */ | |
975 | if (tb[IFLA_NET_NS_PID]) | |
976 | net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); | |
977 | else | |
978 | net = get_net(src_net); | |
979 | return net; | |
980 | } | |
981 | EXPORT_SYMBOL(rtnl_link_get_net); | |
982 | ||
1840bb13 TG |
983 | static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) |
984 | { | |
985 | if (dev) { | |
986 | if (tb[IFLA_ADDRESS] && | |
987 | nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) | |
988 | return -EINVAL; | |
989 | ||
990 | if (tb[IFLA_BROADCAST] && | |
991 | nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) | |
992 | return -EINVAL; | |
993 | } | |
994 | ||
995 | return 0; | |
996 | } | |
997 | ||
c02db8c6 CW |
998 | static int do_setvfinfo(struct net_device *dev, struct nlattr *attr) |
999 | { | |
1000 | int rem, err = -EINVAL; | |
1001 | struct nlattr *vf; | |
1002 | const struct net_device_ops *ops = dev->netdev_ops; | |
1003 | ||
1004 | nla_for_each_nested(vf, attr, rem) { | |
1005 | switch (nla_type(vf)) { | |
1006 | case IFLA_VF_MAC: { | |
1007 | struct ifla_vf_mac *ivm; | |
1008 | ivm = nla_data(vf); | |
1009 | err = -EOPNOTSUPP; | |
1010 | if (ops->ndo_set_vf_mac) | |
1011 | err = ops->ndo_set_vf_mac(dev, ivm->vf, | |
1012 | ivm->mac); | |
1013 | break; | |
1014 | } | |
1015 | case IFLA_VF_VLAN: { | |
1016 | struct ifla_vf_vlan *ivv; | |
1017 | ivv = nla_data(vf); | |
1018 | err = -EOPNOTSUPP; | |
1019 | if (ops->ndo_set_vf_vlan) | |
1020 | err = ops->ndo_set_vf_vlan(dev, ivv->vf, | |
1021 | ivv->vlan, | |
1022 | ivv->qos); | |
1023 | break; | |
1024 | } | |
1025 | case IFLA_VF_TX_RATE: { | |
1026 | struct ifla_vf_tx_rate *ivt; | |
1027 | ivt = nla_data(vf); | |
1028 | err = -EOPNOTSUPP; | |
1029 | if (ops->ndo_set_vf_tx_rate) | |
1030 | err = ops->ndo_set_vf_tx_rate(dev, ivt->vf, | |
1031 | ivt->rate); | |
1032 | break; | |
1033 | } | |
1034 | default: | |
1035 | err = -EINVAL; | |
1036 | break; | |
1037 | } | |
1038 | if (err) | |
1039 | break; | |
1040 | } | |
1041 | return err; | |
1042 | } | |
1043 | ||
0157f60c | 1044 | static int do_setlink(struct net_device *dev, struct ifinfomsg *ifm, |
38f7b870 | 1045 | struct nlattr **tb, char *ifname, int modified) |
1da177e4 | 1046 | { |
d314774c | 1047 | const struct net_device_ops *ops = dev->netdev_ops; |
38f7b870 | 1048 | int send_addr_notify = 0; |
0157f60c | 1049 | int err; |
1da177e4 | 1050 | |
d8a5ec67 | 1051 | if (tb[IFLA_NET_NS_PID]) { |
81adee47 | 1052 | struct net *net = rtnl_link_get_net(dev_net(dev), tb); |
d8a5ec67 EB |
1053 | if (IS_ERR(net)) { |
1054 | err = PTR_ERR(net); | |
1055 | goto errout; | |
1056 | } | |
1057 | err = dev_change_net_namespace(dev, net, ifname); | |
1058 | put_net(net); | |
1059 | if (err) | |
1060 | goto errout; | |
1061 | modified = 1; | |
1062 | } | |
1063 | ||
da5e0494 | 1064 | if (tb[IFLA_MAP]) { |
1da177e4 LT |
1065 | struct rtnl_link_ifmap *u_map; |
1066 | struct ifmap k_map; | |
1067 | ||
d314774c | 1068 | if (!ops->ndo_set_config) { |
1da177e4 | 1069 | err = -EOPNOTSUPP; |
0157f60c | 1070 | goto errout; |
1da177e4 LT |
1071 | } |
1072 | ||
1073 | if (!netif_device_present(dev)) { | |
1074 | err = -ENODEV; | |
0157f60c | 1075 | goto errout; |
1da177e4 | 1076 | } |
1da177e4 | 1077 | |
da5e0494 | 1078 | u_map = nla_data(tb[IFLA_MAP]); |
1da177e4 LT |
1079 | k_map.mem_start = (unsigned long) u_map->mem_start; |
1080 | k_map.mem_end = (unsigned long) u_map->mem_end; | |
1081 | k_map.base_addr = (unsigned short) u_map->base_addr; | |
1082 | k_map.irq = (unsigned char) u_map->irq; | |
1083 | k_map.dma = (unsigned char) u_map->dma; | |
1084 | k_map.port = (unsigned char) u_map->port; | |
1085 | ||
d314774c | 1086 | err = ops->ndo_set_config(dev, &k_map); |
da5e0494 | 1087 | if (err < 0) |
0157f60c | 1088 | goto errout; |
1da177e4 | 1089 | |
da5e0494 | 1090 | modified = 1; |
1da177e4 LT |
1091 | } |
1092 | ||
da5e0494 | 1093 | if (tb[IFLA_ADDRESS]) { |
70f8e78e DM |
1094 | struct sockaddr *sa; |
1095 | int len; | |
1096 | ||
d314774c | 1097 | if (!ops->ndo_set_mac_address) { |
1da177e4 | 1098 | err = -EOPNOTSUPP; |
0157f60c | 1099 | goto errout; |
1da177e4 | 1100 | } |
da5e0494 | 1101 | |
1da177e4 LT |
1102 | if (!netif_device_present(dev)) { |
1103 | err = -ENODEV; | |
0157f60c | 1104 | goto errout; |
1da177e4 | 1105 | } |
1da177e4 | 1106 | |
70f8e78e DM |
1107 | len = sizeof(sa_family_t) + dev->addr_len; |
1108 | sa = kmalloc(len, GFP_KERNEL); | |
1109 | if (!sa) { | |
1110 | err = -ENOMEM; | |
0157f60c | 1111 | goto errout; |
70f8e78e DM |
1112 | } |
1113 | sa->sa_family = dev->type; | |
da5e0494 | 1114 | memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), |
70f8e78e | 1115 | dev->addr_len); |
d314774c | 1116 | err = ops->ndo_set_mac_address(dev, sa); |
70f8e78e | 1117 | kfree(sa); |
1da177e4 | 1118 | if (err) |
0157f60c | 1119 | goto errout; |
1da177e4 | 1120 | send_addr_notify = 1; |
da5e0494 | 1121 | modified = 1; |
1da177e4 LT |
1122 | } |
1123 | ||
da5e0494 TG |
1124 | if (tb[IFLA_MTU]) { |
1125 | err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU])); | |
1126 | if (err < 0) | |
0157f60c | 1127 | goto errout; |
da5e0494 | 1128 | modified = 1; |
1da177e4 LT |
1129 | } |
1130 | ||
da5e0494 TG |
1131 | /* |
1132 | * Interface selected by interface index but interface | |
1133 | * name provided implies that a name change has been | |
1134 | * requested. | |
1135 | */ | |
51055be8 | 1136 | if (ifm->ifi_index > 0 && ifname[0]) { |
da5e0494 TG |
1137 | err = dev_change_name(dev, ifname); |
1138 | if (err < 0) | |
0157f60c | 1139 | goto errout; |
da5e0494 | 1140 | modified = 1; |
1da177e4 LT |
1141 | } |
1142 | ||
0b815a1a SH |
1143 | if (tb[IFLA_IFALIAS]) { |
1144 | err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), | |
1145 | nla_len(tb[IFLA_IFALIAS])); | |
1146 | if (err < 0) | |
1147 | goto errout; | |
1148 | modified = 1; | |
1149 | } | |
1150 | ||
da5e0494 TG |
1151 | if (tb[IFLA_BROADCAST]) { |
1152 | nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); | |
1153 | send_addr_notify = 1; | |
1da177e4 LT |
1154 | } |
1155 | ||
83b496e9 | 1156 | if (ifm->ifi_flags || ifm->ifi_change) { |
3729d502 | 1157 | err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); |
5f9021cf JB |
1158 | if (err < 0) |
1159 | goto errout; | |
83b496e9 | 1160 | } |
1da177e4 | 1161 | |
93b2d4a2 DM |
1162 | if (tb[IFLA_TXQLEN]) |
1163 | dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); | |
b00055aa | 1164 | |
da5e0494 | 1165 | if (tb[IFLA_OPERSTATE]) |
93b2d4a2 | 1166 | set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); |
b00055aa | 1167 | |
da5e0494 | 1168 | if (tb[IFLA_LINKMODE]) { |
93b2d4a2 DM |
1169 | write_lock_bh(&dev_base_lock); |
1170 | dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); | |
1171 | write_unlock_bh(&dev_base_lock); | |
b00055aa SR |
1172 | } |
1173 | ||
c02db8c6 CW |
1174 | if (tb[IFLA_VFINFO_LIST]) { |
1175 | struct nlattr *attr; | |
1176 | int rem; | |
1177 | nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { | |
253683bb DH |
1178 | if (nla_type(attr) != IFLA_VF_INFO) { |
1179 | err = -EINVAL; | |
c02db8c6 | 1180 | goto errout; |
253683bb | 1181 | } |
c02db8c6 CW |
1182 | err = do_setvfinfo(dev, attr); |
1183 | if (err < 0) | |
1184 | goto errout; | |
1185 | modified = 1; | |
1186 | } | |
ebc08a6f | 1187 | } |
1da177e4 LT |
1188 | err = 0; |
1189 | ||
57b61080 SF |
1190 | if (tb[IFLA_VF_PORTS]) { |
1191 | struct nlattr *port[IFLA_PORT_MAX+1]; | |
1192 | struct nlattr *attr; | |
1193 | int vf; | |
1194 | int rem; | |
1195 | ||
1196 | err = -EOPNOTSUPP; | |
1197 | if (!ops->ndo_set_vf_port) | |
1198 | goto errout; | |
1199 | ||
1200 | nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { | |
1201 | if (nla_type(attr) != IFLA_VF_PORT) | |
1202 | continue; | |
1203 | err = nla_parse_nested(port, IFLA_PORT_MAX, | |
1204 | attr, ifla_port_policy); | |
1205 | if (err < 0) | |
1206 | goto errout; | |
1207 | if (!port[IFLA_PORT_VF]) { | |
1208 | err = -EOPNOTSUPP; | |
1209 | goto errout; | |
1210 | } | |
1211 | vf = nla_get_u32(port[IFLA_PORT_VF]); | |
1212 | err = ops->ndo_set_vf_port(dev, vf, port); | |
1213 | if (err < 0) | |
1214 | goto errout; | |
1215 | modified = 1; | |
1216 | } | |
1217 | } | |
1218 | err = 0; | |
1219 | ||
1220 | if (tb[IFLA_PORT_SELF]) { | |
1221 | struct nlattr *port[IFLA_PORT_MAX+1]; | |
1222 | ||
1223 | err = nla_parse_nested(port, IFLA_PORT_MAX, | |
1224 | tb[IFLA_PORT_SELF], ifla_port_policy); | |
1225 | if (err < 0) | |
1226 | goto errout; | |
1227 | ||
1228 | err = -EOPNOTSUPP; | |
1229 | if (ops->ndo_set_vf_port) | |
1230 | err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); | |
1231 | if (err < 0) | |
1232 | goto errout; | |
1233 | modified = 1; | |
1234 | } | |
1235 | err = 0; | |
1236 | ||
0157f60c | 1237 | errout: |
da5e0494 TG |
1238 | if (err < 0 && modified && net_ratelimit()) |
1239 | printk(KERN_WARNING "A link change request failed with " | |
1240 | "some changes comitted already. Interface %s may " | |
1241 | "have been left with an inconsistent configuration, " | |
1242 | "please check.\n", dev->name); | |
1243 | ||
1da177e4 LT |
1244 | if (send_addr_notify) |
1245 | call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); | |
0157f60c PM |
1246 | return err; |
1247 | } | |
1da177e4 | 1248 | |
0157f60c PM |
1249 | static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1250 | { | |
3b1e0a65 | 1251 | struct net *net = sock_net(skb->sk); |
0157f60c PM |
1252 | struct ifinfomsg *ifm; |
1253 | struct net_device *dev; | |
1254 | int err; | |
1255 | struct nlattr *tb[IFLA_MAX+1]; | |
1256 | char ifname[IFNAMSIZ]; | |
1257 | ||
1258 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); | |
1259 | if (err < 0) | |
1260 | goto errout; | |
1261 | ||
1262 | if (tb[IFLA_IFNAME]) | |
1263 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1264 | else | |
1265 | ifname[0] = '\0'; | |
1266 | ||
1267 | err = -EINVAL; | |
1268 | ifm = nlmsg_data(nlh); | |
1269 | if (ifm->ifi_index > 0) | |
a3d12891 | 1270 | dev = __dev_get_by_index(net, ifm->ifi_index); |
0157f60c | 1271 | else if (tb[IFLA_IFNAME]) |
a3d12891 | 1272 | dev = __dev_get_by_name(net, ifname); |
0157f60c PM |
1273 | else |
1274 | goto errout; | |
1275 | ||
1276 | if (dev == NULL) { | |
1277 | err = -ENODEV; | |
1278 | goto errout; | |
1279 | } | |
1280 | ||
e0d087af ED |
1281 | err = validate_linkmsg(dev, tb); |
1282 | if (err < 0) | |
a3d12891 | 1283 | goto errout; |
0157f60c | 1284 | |
38f7b870 | 1285 | err = do_setlink(dev, ifm, tb, ifname, 0); |
da5e0494 | 1286 | errout: |
1da177e4 LT |
1287 | return err; |
1288 | } | |
1289 | ||
38f7b870 PM |
1290 | static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1291 | { | |
3b1e0a65 | 1292 | struct net *net = sock_net(skb->sk); |
38f7b870 PM |
1293 | const struct rtnl_link_ops *ops; |
1294 | struct net_device *dev; | |
1295 | struct ifinfomsg *ifm; | |
1296 | char ifname[IFNAMSIZ]; | |
1297 | struct nlattr *tb[IFLA_MAX+1]; | |
1298 | int err; | |
1299 | ||
1300 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); | |
1301 | if (err < 0) | |
1302 | return err; | |
1303 | ||
1304 | if (tb[IFLA_IFNAME]) | |
1305 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1306 | ||
1307 | ifm = nlmsg_data(nlh); | |
1308 | if (ifm->ifi_index > 0) | |
881d966b | 1309 | dev = __dev_get_by_index(net, ifm->ifi_index); |
38f7b870 | 1310 | else if (tb[IFLA_IFNAME]) |
881d966b | 1311 | dev = __dev_get_by_name(net, ifname); |
38f7b870 PM |
1312 | else |
1313 | return -EINVAL; | |
1314 | ||
1315 | if (!dev) | |
1316 | return -ENODEV; | |
1317 | ||
1318 | ops = dev->rtnl_link_ops; | |
1319 | if (!ops) | |
1320 | return -EOPNOTSUPP; | |
1321 | ||
23289a37 | 1322 | ops->dellink(dev, NULL); |
38f7b870 PM |
1323 | return 0; |
1324 | } | |
1325 | ||
3729d502 PM |
1326 | int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) |
1327 | { | |
1328 | unsigned int old_flags; | |
1329 | int err; | |
1330 | ||
1331 | old_flags = dev->flags; | |
1332 | if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { | |
1333 | err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); | |
1334 | if (err < 0) | |
1335 | return err; | |
1336 | } | |
1337 | ||
1338 | dev->rtnl_link_state = RTNL_LINK_INITIALIZED; | |
1339 | rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U); | |
1340 | ||
1341 | __dev_notify_flags(dev, old_flags); | |
1342 | return 0; | |
1343 | } | |
1344 | EXPORT_SYMBOL(rtnl_configure_link); | |
1345 | ||
81adee47 EB |
1346 | struct net_device *rtnl_create_link(struct net *src_net, struct net *net, |
1347 | char *ifname, const struct rtnl_link_ops *ops, struct nlattr *tb[]) | |
e7199288 PE |
1348 | { |
1349 | int err; | |
1350 | struct net_device *dev; | |
2e59af3d ED |
1351 | unsigned int num_queues = 1; |
1352 | unsigned int real_num_queues = 1; | |
e7199288 | 1353 | |
2e59af3d | 1354 | if (ops->get_tx_queues) { |
81adee47 | 1355 | err = ops->get_tx_queues(src_net, tb, &num_queues, |
e0d087af | 1356 | &real_num_queues); |
2e59af3d ED |
1357 | if (err) |
1358 | goto err; | |
1359 | } | |
e7199288 | 1360 | err = -ENOMEM; |
2e59af3d | 1361 | dev = alloc_netdev_mq(ops->priv_size, ifname, ops->setup, num_queues); |
e7199288 PE |
1362 | if (!dev) |
1363 | goto err; | |
1364 | ||
81adee47 EB |
1365 | dev_net_set(dev, net); |
1366 | dev->rtnl_link_ops = ops; | |
3729d502 | 1367 | dev->rtnl_link_state = RTNL_LINK_INITIALIZING; |
2e59af3d | 1368 | dev->real_num_tx_queues = real_num_queues; |
81adee47 | 1369 | |
e7199288 PE |
1370 | if (strchr(dev->name, '%')) { |
1371 | err = dev_alloc_name(dev, dev->name); | |
1372 | if (err < 0) | |
1373 | goto err_free; | |
1374 | } | |
1375 | ||
e7199288 PE |
1376 | if (tb[IFLA_MTU]) |
1377 | dev->mtu = nla_get_u32(tb[IFLA_MTU]); | |
1378 | if (tb[IFLA_ADDRESS]) | |
1379 | memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), | |
1380 | nla_len(tb[IFLA_ADDRESS])); | |
1381 | if (tb[IFLA_BROADCAST]) | |
1382 | memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), | |
1383 | nla_len(tb[IFLA_BROADCAST])); | |
1384 | if (tb[IFLA_TXQLEN]) | |
1385 | dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); | |
1386 | if (tb[IFLA_OPERSTATE]) | |
93b2d4a2 | 1387 | set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); |
e7199288 PE |
1388 | if (tb[IFLA_LINKMODE]) |
1389 | dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); | |
1390 | ||
1391 | return dev; | |
1392 | ||
1393 | err_free: | |
1394 | free_netdev(dev); | |
1395 | err: | |
1396 | return ERR_PTR(err); | |
1397 | } | |
e0d087af | 1398 | EXPORT_SYMBOL(rtnl_create_link); |
e7199288 | 1399 | |
38f7b870 PM |
1400 | static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1401 | { | |
3b1e0a65 | 1402 | struct net *net = sock_net(skb->sk); |
38f7b870 PM |
1403 | const struct rtnl_link_ops *ops; |
1404 | struct net_device *dev; | |
1405 | struct ifinfomsg *ifm; | |
1406 | char kind[MODULE_NAME_LEN]; | |
1407 | char ifname[IFNAMSIZ]; | |
1408 | struct nlattr *tb[IFLA_MAX+1]; | |
1409 | struct nlattr *linkinfo[IFLA_INFO_MAX+1]; | |
1410 | int err; | |
1411 | ||
95a5afca | 1412 | #ifdef CONFIG_MODULES |
38f7b870 | 1413 | replay: |
8072f085 | 1414 | #endif |
38f7b870 PM |
1415 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); |
1416 | if (err < 0) | |
1417 | return err; | |
1418 | ||
1419 | if (tb[IFLA_IFNAME]) | |
1420 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1421 | else | |
1422 | ifname[0] = '\0'; | |
1423 | ||
1424 | ifm = nlmsg_data(nlh); | |
1425 | if (ifm->ifi_index > 0) | |
881d966b | 1426 | dev = __dev_get_by_index(net, ifm->ifi_index); |
38f7b870 | 1427 | else if (ifname[0]) |
881d966b | 1428 | dev = __dev_get_by_name(net, ifname); |
38f7b870 PM |
1429 | else |
1430 | dev = NULL; | |
1431 | ||
e0d087af ED |
1432 | err = validate_linkmsg(dev, tb); |
1433 | if (err < 0) | |
1840bb13 TG |
1434 | return err; |
1435 | ||
38f7b870 PM |
1436 | if (tb[IFLA_LINKINFO]) { |
1437 | err = nla_parse_nested(linkinfo, IFLA_INFO_MAX, | |
1438 | tb[IFLA_LINKINFO], ifla_info_policy); | |
1439 | if (err < 0) | |
1440 | return err; | |
1441 | } else | |
1442 | memset(linkinfo, 0, sizeof(linkinfo)); | |
1443 | ||
1444 | if (linkinfo[IFLA_INFO_KIND]) { | |
1445 | nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); | |
1446 | ops = rtnl_link_ops_get(kind); | |
1447 | } else { | |
1448 | kind[0] = '\0'; | |
1449 | ops = NULL; | |
1450 | } | |
1451 | ||
1452 | if (1) { | |
1453 | struct nlattr *attr[ops ? ops->maxtype + 1 : 0], **data = NULL; | |
81adee47 | 1454 | struct net *dest_net; |
38f7b870 PM |
1455 | |
1456 | if (ops) { | |
1457 | if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { | |
1458 | err = nla_parse_nested(attr, ops->maxtype, | |
1459 | linkinfo[IFLA_INFO_DATA], | |
1460 | ops->policy); | |
1461 | if (err < 0) | |
1462 | return err; | |
1463 | data = attr; | |
1464 | } | |
1465 | if (ops->validate) { | |
1466 | err = ops->validate(tb, data); | |
1467 | if (err < 0) | |
1468 | return err; | |
1469 | } | |
1470 | } | |
1471 | ||
1472 | if (dev) { | |
1473 | int modified = 0; | |
1474 | ||
1475 | if (nlh->nlmsg_flags & NLM_F_EXCL) | |
1476 | return -EEXIST; | |
1477 | if (nlh->nlmsg_flags & NLM_F_REPLACE) | |
1478 | return -EOPNOTSUPP; | |
1479 | ||
1480 | if (linkinfo[IFLA_INFO_DATA]) { | |
1481 | if (!ops || ops != dev->rtnl_link_ops || | |
1482 | !ops->changelink) | |
1483 | return -EOPNOTSUPP; | |
1484 | ||
1485 | err = ops->changelink(dev, tb, data); | |
1486 | if (err < 0) | |
1487 | return err; | |
1488 | modified = 1; | |
1489 | } | |
1490 | ||
1491 | return do_setlink(dev, ifm, tb, ifname, modified); | |
1492 | } | |
1493 | ||
1494 | if (!(nlh->nlmsg_flags & NLM_F_CREATE)) | |
1495 | return -ENODEV; | |
1496 | ||
3729d502 | 1497 | if (ifm->ifi_index) |
38f7b870 | 1498 | return -EOPNOTSUPP; |
0e06877c | 1499 | if (tb[IFLA_MAP] || tb[IFLA_MASTER] || tb[IFLA_PROTINFO]) |
38f7b870 PM |
1500 | return -EOPNOTSUPP; |
1501 | ||
1502 | if (!ops) { | |
95a5afca | 1503 | #ifdef CONFIG_MODULES |
38f7b870 PM |
1504 | if (kind[0]) { |
1505 | __rtnl_unlock(); | |
1506 | request_module("rtnl-link-%s", kind); | |
1507 | rtnl_lock(); | |
1508 | ops = rtnl_link_ops_get(kind); | |
1509 | if (ops) | |
1510 | goto replay; | |
1511 | } | |
1512 | #endif | |
1513 | return -EOPNOTSUPP; | |
1514 | } | |
1515 | ||
1516 | if (!ifname[0]) | |
1517 | snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); | |
e7199288 | 1518 | |
81adee47 EB |
1519 | dest_net = rtnl_link_get_net(net, tb); |
1520 | dev = rtnl_create_link(net, dest_net, ifname, ops, tb); | |
e7199288 PE |
1521 | |
1522 | if (IS_ERR(dev)) | |
1523 | err = PTR_ERR(dev); | |
1524 | else if (ops->newlink) | |
81adee47 | 1525 | err = ops->newlink(net, dev, tb, data); |
2d85cba2 PM |
1526 | else |
1527 | err = register_netdevice(dev); | |
80032cff DC |
1528 | |
1529 | if (err < 0 && !IS_ERR(dev)) | |
38f7b870 | 1530 | free_netdev(dev); |
80032cff | 1531 | if (err < 0) |
3729d502 | 1532 | goto out; |
81adee47 | 1533 | |
3729d502 PM |
1534 | err = rtnl_configure_link(dev, ifm); |
1535 | if (err < 0) | |
1536 | unregister_netdevice(dev); | |
1537 | out: | |
81adee47 | 1538 | put_net(dest_net); |
38f7b870 PM |
1539 | return err; |
1540 | } | |
1541 | } | |
1542 | ||
b60c5115 | 1543 | static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr* nlh, void *arg) |
711e2c33 | 1544 | { |
3b1e0a65 | 1545 | struct net *net = sock_net(skb->sk); |
b60c5115 | 1546 | struct ifinfomsg *ifm; |
a3d12891 | 1547 | char ifname[IFNAMSIZ]; |
b60c5115 TG |
1548 | struct nlattr *tb[IFLA_MAX+1]; |
1549 | struct net_device *dev = NULL; | |
1550 | struct sk_buff *nskb; | |
339bf98f | 1551 | int err; |
711e2c33 | 1552 | |
b60c5115 TG |
1553 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); |
1554 | if (err < 0) | |
9918f230 | 1555 | return err; |
b60c5115 | 1556 | |
a3d12891 ED |
1557 | if (tb[IFLA_IFNAME]) |
1558 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1559 | ||
b60c5115 | 1560 | ifm = nlmsg_data(nlh); |
a3d12891 ED |
1561 | if (ifm->ifi_index > 0) |
1562 | dev = __dev_get_by_index(net, ifm->ifi_index); | |
1563 | else if (tb[IFLA_IFNAME]) | |
1564 | dev = __dev_get_by_name(net, ifname); | |
1565 | else | |
711e2c33 | 1566 | return -EINVAL; |
711e2c33 | 1567 | |
a3d12891 ED |
1568 | if (dev == NULL) |
1569 | return -ENODEV; | |
1570 | ||
38f7b870 | 1571 | nskb = nlmsg_new(if_nlmsg_size(dev), GFP_KERNEL); |
a3d12891 ED |
1572 | if (nskb == NULL) |
1573 | return -ENOBUFS; | |
b60c5115 | 1574 | |
575c3e2a PM |
1575 | err = rtnl_fill_ifinfo(nskb, dev, RTM_NEWLINK, NETLINK_CB(skb).pid, |
1576 | nlh->nlmsg_seq, 0, 0); | |
26932566 PM |
1577 | if (err < 0) { |
1578 | /* -EMSGSIZE implies BUG in if_nlmsg_size */ | |
1579 | WARN_ON(err == -EMSGSIZE); | |
1580 | kfree_skb(nskb); | |
a3d12891 ED |
1581 | } else |
1582 | err = rtnl_unicast(nskb, net, NETLINK_CB(skb).pid); | |
711e2c33 | 1583 | |
b60c5115 | 1584 | return err; |
711e2c33 | 1585 | } |
711e2c33 | 1586 | |
42bad1da | 1587 | static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) |
1da177e4 LT |
1588 | { |
1589 | int idx; | |
1590 | int s_idx = cb->family; | |
1591 | ||
1592 | if (s_idx == 0) | |
1593 | s_idx = 1; | |
25239cee | 1594 | for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { |
1da177e4 LT |
1595 | int type = cb->nlh->nlmsg_type-RTM_BASE; |
1596 | if (idx < s_idx || idx == PF_PACKET) | |
1597 | continue; | |
e2849863 TG |
1598 | if (rtnl_msg_handlers[idx] == NULL || |
1599 | rtnl_msg_handlers[idx][type].dumpit == NULL) | |
1da177e4 LT |
1600 | continue; |
1601 | if (idx > s_idx) | |
1602 | memset(&cb->args[0], 0, sizeof(cb->args)); | |
e2849863 | 1603 | if (rtnl_msg_handlers[idx][type].dumpit(skb, cb)) |
1da177e4 LT |
1604 | break; |
1605 | } | |
1606 | cb->family = idx; | |
1607 | ||
1608 | return skb->len; | |
1609 | } | |
1610 | ||
1611 | void rtmsg_ifinfo(int type, struct net_device *dev, unsigned change) | |
1612 | { | |
c346dca1 | 1613 | struct net *net = dev_net(dev); |
1da177e4 | 1614 | struct sk_buff *skb; |
0ec6d3f4 | 1615 | int err = -ENOBUFS; |
1da177e4 | 1616 | |
38f7b870 | 1617 | skb = nlmsg_new(if_nlmsg_size(dev), GFP_KERNEL); |
0ec6d3f4 TG |
1618 | if (skb == NULL) |
1619 | goto errout; | |
1da177e4 | 1620 | |
575c3e2a | 1621 | err = rtnl_fill_ifinfo(skb, dev, type, 0, 0, change, 0); |
26932566 PM |
1622 | if (err < 0) { |
1623 | /* -EMSGSIZE implies BUG in if_nlmsg_size() */ | |
1624 | WARN_ON(err == -EMSGSIZE); | |
1625 | kfree_skb(skb); | |
1626 | goto errout; | |
1627 | } | |
1ce85fe4 PNA |
1628 | rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_KERNEL); |
1629 | return; | |
0ec6d3f4 TG |
1630 | errout: |
1631 | if (err < 0) | |
4b3da706 | 1632 | rtnl_set_sk_err(net, RTNLGRP_LINK, err); |
1da177e4 LT |
1633 | } |
1634 | ||
1da177e4 LT |
1635 | /* Protected by RTNL sempahore. */ |
1636 | static struct rtattr **rta_buf; | |
1637 | static int rtattr_max; | |
1638 | ||
1639 | /* Process one rtnetlink message. */ | |
1640 | ||
1d00a4eb | 1641 | static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh) |
1da177e4 | 1642 | { |
3b1e0a65 | 1643 | struct net *net = sock_net(skb->sk); |
e2849863 | 1644 | rtnl_doit_func doit; |
1da177e4 LT |
1645 | int sz_idx, kind; |
1646 | int min_len; | |
1647 | int family; | |
1648 | int type; | |
1c2d670f | 1649 | int err; |
1da177e4 | 1650 | |
1da177e4 | 1651 | type = nlh->nlmsg_type; |
1da177e4 | 1652 | if (type > RTM_MAX) |
038890fe | 1653 | return -EOPNOTSUPP; |
1da177e4 LT |
1654 | |
1655 | type -= RTM_BASE; | |
1656 | ||
1657 | /* All the messages must have at least 1 byte length */ | |
1658 | if (nlh->nlmsg_len < NLMSG_LENGTH(sizeof(struct rtgenmsg))) | |
1659 | return 0; | |
1660 | ||
e0d087af | 1661 | family = ((struct rtgenmsg *)NLMSG_DATA(nlh))->rtgen_family; |
1da177e4 LT |
1662 | sz_idx = type>>2; |
1663 | kind = type&3; | |
1664 | ||
1d00a4eb TG |
1665 | if (kind != 2 && security_netlink_recv(skb, CAP_NET_ADMIN)) |
1666 | return -EPERM; | |
1da177e4 LT |
1667 | |
1668 | if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { | |
97c53cac | 1669 | struct sock *rtnl; |
e2849863 | 1670 | rtnl_dumpit_func dumpit; |
1da177e4 | 1671 | |
e2849863 TG |
1672 | dumpit = rtnl_get_dumpit(family, type); |
1673 | if (dumpit == NULL) | |
038890fe | 1674 | return -EOPNOTSUPP; |
9ac4a169 | 1675 | |
1c2d670f | 1676 | __rtnl_unlock(); |
97c53cac | 1677 | rtnl = net->rtnl; |
1c2d670f PM |
1678 | err = netlink_dump_start(rtnl, skb, nlh, dumpit, NULL); |
1679 | rtnl_lock(); | |
1680 | return err; | |
1da177e4 LT |
1681 | } |
1682 | ||
1683 | memset(rta_buf, 0, (rtattr_max * sizeof(struct rtattr *))); | |
1684 | ||
1685 | min_len = rtm_min[sz_idx]; | |
1686 | if (nlh->nlmsg_len < min_len) | |
1d00a4eb | 1687 | return -EINVAL; |
1da177e4 LT |
1688 | |
1689 | if (nlh->nlmsg_len > min_len) { | |
1690 | int attrlen = nlh->nlmsg_len - NLMSG_ALIGN(min_len); | |
e0d087af | 1691 | struct rtattr *attr = (void *)nlh + NLMSG_ALIGN(min_len); |
1da177e4 LT |
1692 | |
1693 | while (RTA_OK(attr, attrlen)) { | |
1694 | unsigned flavor = attr->rta_type; | |
1695 | if (flavor) { | |
1696 | if (flavor > rta_max[sz_idx]) | |
1d00a4eb | 1697 | return -EINVAL; |
1da177e4 LT |
1698 | rta_buf[flavor-1] = attr; |
1699 | } | |
1700 | attr = RTA_NEXT(attr, attrlen); | |
1701 | } | |
1702 | } | |
1703 | ||
e2849863 TG |
1704 | doit = rtnl_get_doit(family, type); |
1705 | if (doit == NULL) | |
038890fe | 1706 | return -EOPNOTSUPP; |
1da177e4 | 1707 | |
1d00a4eb | 1708 | return doit(skb, nlh, (void *)&rta_buf[0]); |
1da177e4 LT |
1709 | } |
1710 | ||
cd40b7d3 | 1711 | static void rtnetlink_rcv(struct sk_buff *skb) |
1da177e4 | 1712 | { |
cd40b7d3 DL |
1713 | rtnl_lock(); |
1714 | netlink_rcv_skb(skb, &rtnetlink_rcv_msg); | |
1715 | rtnl_unlock(); | |
1da177e4 LT |
1716 | } |
1717 | ||
1da177e4 LT |
1718 | static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) |
1719 | { | |
1720 | struct net_device *dev = ptr; | |
e9dc8653 | 1721 | |
1da177e4 | 1722 | switch (event) { |
1da177e4 LT |
1723 | case NETDEV_UP: |
1724 | case NETDEV_DOWN: | |
10de05af | 1725 | case NETDEV_PRE_UP: |
d90a909e EB |
1726 | case NETDEV_POST_INIT: |
1727 | case NETDEV_REGISTER: | |
1da177e4 | 1728 | case NETDEV_CHANGE: |
755d0e77 | 1729 | case NETDEV_PRE_TYPE_CHANGE: |
1da177e4 | 1730 | case NETDEV_GOING_DOWN: |
a2835763 | 1731 | case NETDEV_UNREGISTER: |
d90a909e | 1732 | case NETDEV_UNREGISTER_BATCH: |
1da177e4 LT |
1733 | break; |
1734 | default: | |
1735 | rtmsg_ifinfo(RTM_NEWLINK, dev, 0); | |
1736 | break; | |
1737 | } | |
1738 | return NOTIFY_DONE; | |
1739 | } | |
1740 | ||
1741 | static struct notifier_block rtnetlink_dev_notifier = { | |
1742 | .notifier_call = rtnetlink_event, | |
1743 | }; | |
1744 | ||
97c53cac | 1745 | |
2c8c1e72 | 1746 | static int __net_init rtnetlink_net_init(struct net *net) |
97c53cac DL |
1747 | { |
1748 | struct sock *sk; | |
1749 | sk = netlink_kernel_create(net, NETLINK_ROUTE, RTNLGRP_MAX, | |
1750 | rtnetlink_rcv, &rtnl_mutex, THIS_MODULE); | |
1751 | if (!sk) | |
1752 | return -ENOMEM; | |
97c53cac DL |
1753 | net->rtnl = sk; |
1754 | return 0; | |
1755 | } | |
1756 | ||
2c8c1e72 | 1757 | static void __net_exit rtnetlink_net_exit(struct net *net) |
97c53cac | 1758 | { |
775516bf DL |
1759 | netlink_kernel_release(net->rtnl); |
1760 | net->rtnl = NULL; | |
97c53cac DL |
1761 | } |
1762 | ||
1763 | static struct pernet_operations rtnetlink_net_ops = { | |
1764 | .init = rtnetlink_net_init, | |
1765 | .exit = rtnetlink_net_exit, | |
1766 | }; | |
1767 | ||
1da177e4 LT |
1768 | void __init rtnetlink_init(void) |
1769 | { | |
1770 | int i; | |
1771 | ||
1772 | rtattr_max = 0; | |
1773 | for (i = 0; i < ARRAY_SIZE(rta_max); i++) | |
1774 | if (rta_max[i] > rtattr_max) | |
1775 | rtattr_max = rta_max[i]; | |
1776 | rta_buf = kmalloc(rtattr_max * sizeof(struct rtattr *), GFP_KERNEL); | |
1777 | if (!rta_buf) | |
1778 | panic("rtnetlink_init: cannot allocate rta_buf\n"); | |
1779 | ||
97c53cac | 1780 | if (register_pernet_subsys(&rtnetlink_net_ops)) |
1da177e4 | 1781 | panic("rtnetlink_init: cannot initialize rtnetlink\n"); |
97c53cac | 1782 | |
1da177e4 LT |
1783 | netlink_set_nonroot(NETLINK_ROUTE, NL_NONROOT_RECV); |
1784 | register_netdevice_notifier(&rtnetlink_dev_notifier); | |
340d17fc TG |
1785 | |
1786 | rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, rtnl_dump_ifinfo); | |
1787 | rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL); | |
38f7b870 PM |
1788 | rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL); |
1789 | rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL); | |
687ad8cc TG |
1790 | |
1791 | rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all); | |
1792 | rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all); | |
1da177e4 LT |
1793 | } |
1794 |