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, |
eeda3fd6 | 582 | const struct net_device_stats *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 | ||
14a4b42b | 613 | static void copy_rtnl_link_stats64(void *v, const struct net_device_stats *b) |
10708f37 | 614 | { |
14a4b42b | 615 | struct rtnl_link_stats64 a; |
10708f37 | 616 | |
14a4b42b JE |
617 | a.rx_packets = b->rx_packets; |
618 | a.tx_packets = b->tx_packets; | |
619 | a.rx_bytes = b->rx_bytes; | |
620 | a.tx_bytes = b->tx_bytes; | |
621 | a.rx_errors = b->rx_errors; | |
622 | a.tx_errors = b->tx_errors; | |
623 | a.rx_dropped = b->rx_dropped; | |
624 | a.tx_dropped = b->tx_dropped; | |
10708f37 | 625 | |
14a4b42b JE |
626 | a.multicast = b->multicast; |
627 | a.collisions = b->collisions; | |
10708f37 | 628 | |
14a4b42b JE |
629 | a.rx_length_errors = b->rx_length_errors; |
630 | a.rx_over_errors = b->rx_over_errors; | |
631 | a.rx_crc_errors = b->rx_crc_errors; | |
632 | a.rx_frame_errors = b->rx_frame_errors; | |
633 | a.rx_fifo_errors = b->rx_fifo_errors; | |
634 | a.rx_missed_errors = b->rx_missed_errors; | |
10708f37 | 635 | |
14a4b42b JE |
636 | a.tx_aborted_errors = b->tx_aborted_errors; |
637 | a.tx_carrier_errors = b->tx_carrier_errors; | |
638 | a.tx_fifo_errors = b->tx_fifo_errors; | |
639 | a.tx_heartbeat_errors = b->tx_heartbeat_errors; | |
640 | a.tx_window_errors = b->tx_window_errors; | |
641 | ||
642 | a.rx_compressed = b->rx_compressed; | |
643 | a.tx_compressed = b->tx_compressed; | |
644 | memcpy(v, &a, sizeof(a)); | |
10708f37 | 645 | } |
1da177e4 | 646 | |
c02db8c6 | 647 | /* All VF info */ |
ebc08a6f WM |
648 | static inline int rtnl_vfinfo_size(const struct net_device *dev) |
649 | { | |
c02db8c6 CW |
650 | if (dev->dev.parent && dev_is_pci(dev->dev.parent)) { |
651 | ||
652 | int num_vfs = dev_num_vf(dev->dev.parent); | |
045de01a SF |
653 | size_t size = nla_total_size(sizeof(struct nlattr)); |
654 | size += nla_total_size(num_vfs * sizeof(struct nlattr)); | |
655 | size += num_vfs * | |
656 | (nla_total_size(sizeof(struct ifla_vf_mac)) + | |
657 | nla_total_size(sizeof(struct ifla_vf_vlan)) + | |
658 | nla_total_size(sizeof(struct ifla_vf_tx_rate))); | |
c02db8c6 CW |
659 | return size; |
660 | } else | |
ebc08a6f WM |
661 | return 0; |
662 | } | |
663 | ||
57b61080 SF |
664 | static size_t rtnl_port_size(const struct net_device *dev) |
665 | { | |
666 | size_t port_size = nla_total_size(4) /* PORT_VF */ | |
667 | + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */ | |
668 | + nla_total_size(sizeof(struct ifla_port_vsi)) | |
669 | /* PORT_VSI_TYPE */ | |
670 | + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */ | |
671 | + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */ | |
672 | + nla_total_size(1) /* PROT_VDP_REQUEST */ | |
673 | + nla_total_size(2); /* PORT_VDP_RESPONSE */ | |
674 | size_t vf_ports_size = nla_total_size(sizeof(struct nlattr)); | |
675 | size_t vf_port_size = nla_total_size(sizeof(struct nlattr)) | |
676 | + port_size; | |
677 | size_t port_self_size = nla_total_size(sizeof(struct nlattr)) | |
678 | + port_size; | |
679 | ||
680 | if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent) | |
681 | return 0; | |
682 | if (dev_num_vf(dev->dev.parent)) | |
683 | return port_self_size + vf_ports_size + | |
684 | vf_port_size * dev_num_vf(dev->dev.parent); | |
685 | else | |
686 | return port_self_size; | |
687 | } | |
688 | ||
38f7b870 | 689 | static inline size_t if_nlmsg_size(const struct net_device *dev) |
339bf98f TG |
690 | { |
691 | return NLMSG_ALIGN(sizeof(struct ifinfomsg)) | |
692 | + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */ | |
0b815a1a | 693 | + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */ |
339bf98f TG |
694 | + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */ |
695 | + nla_total_size(sizeof(struct rtnl_link_ifmap)) | |
696 | + nla_total_size(sizeof(struct rtnl_link_stats)) | |
adcfe196 | 697 | + nla_total_size(sizeof(struct rtnl_link_stats64)) |
339bf98f TG |
698 | + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */ |
699 | + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */ | |
700 | + nla_total_size(4) /* IFLA_TXQLEN */ | |
701 | + nla_total_size(4) /* IFLA_WEIGHT */ | |
702 | + nla_total_size(4) /* IFLA_MTU */ | |
703 | + nla_total_size(4) /* IFLA_LINK */ | |
704 | + nla_total_size(4) /* IFLA_MASTER */ | |
705 | + nla_total_size(1) /* IFLA_OPERSTATE */ | |
38f7b870 | 706 | + nla_total_size(1) /* IFLA_LINKMODE */ |
ebc08a6f | 707 | + nla_total_size(4) /* IFLA_NUM_VF */ |
c02db8c6 | 708 | + rtnl_vfinfo_size(dev) /* IFLA_VFINFO_LIST */ |
57b61080 | 709 | + rtnl_port_size(dev) /* IFLA_VF_PORTS + IFLA_PORT_SELF */ |
38f7b870 | 710 | + rtnl_link_get_size(dev); /* IFLA_LINKINFO */ |
339bf98f TG |
711 | } |
712 | ||
57b61080 SF |
713 | static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev) |
714 | { | |
715 | struct nlattr *vf_ports; | |
716 | struct nlattr *vf_port; | |
717 | int vf; | |
718 | int err; | |
719 | ||
720 | vf_ports = nla_nest_start(skb, IFLA_VF_PORTS); | |
721 | if (!vf_ports) | |
722 | return -EMSGSIZE; | |
723 | ||
724 | for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) { | |
725 | vf_port = nla_nest_start(skb, IFLA_VF_PORT); | |
8ca94183 SF |
726 | if (!vf_port) |
727 | goto nla_put_failure; | |
57b61080 SF |
728 | NLA_PUT_U32(skb, IFLA_PORT_VF, vf); |
729 | err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb); | |
8ca94183 SF |
730 | if (err == -EMSGSIZE) |
731 | goto nla_put_failure; | |
57b61080 | 732 | if (err) { |
57b61080 SF |
733 | nla_nest_cancel(skb, vf_port); |
734 | continue; | |
735 | } | |
736 | nla_nest_end(skb, vf_port); | |
737 | } | |
738 | ||
739 | nla_nest_end(skb, vf_ports); | |
740 | ||
741 | return 0; | |
8ca94183 SF |
742 | |
743 | nla_put_failure: | |
744 | nla_nest_cancel(skb, vf_ports); | |
745 | return -EMSGSIZE; | |
57b61080 SF |
746 | } |
747 | ||
748 | static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev) | |
749 | { | |
750 | struct nlattr *port_self; | |
751 | int err; | |
752 | ||
753 | port_self = nla_nest_start(skb, IFLA_PORT_SELF); | |
754 | if (!port_self) | |
755 | return -EMSGSIZE; | |
756 | ||
757 | err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb); | |
758 | if (err) { | |
759 | nla_nest_cancel(skb, port_self); | |
8ca94183 | 760 | return (err == -EMSGSIZE) ? err : 0; |
57b61080 SF |
761 | } |
762 | ||
763 | nla_nest_end(skb, port_self); | |
764 | ||
765 | return 0; | |
766 | } | |
767 | ||
768 | static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev) | |
769 | { | |
770 | int err; | |
771 | ||
772 | if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent) | |
773 | return 0; | |
774 | ||
775 | err = rtnl_port_self_fill(skb, dev); | |
776 | if (err) | |
777 | return err; | |
778 | ||
779 | if (dev_num_vf(dev->dev.parent)) { | |
780 | err = rtnl_vf_ports_fill(skb, dev); | |
781 | if (err) | |
782 | return err; | |
783 | } | |
784 | ||
785 | return 0; | |
786 | } | |
787 | ||
b60c5115 | 788 | static int rtnl_fill_ifinfo(struct sk_buff *skb, struct net_device *dev, |
575c3e2a PM |
789 | int type, u32 pid, u32 seq, u32 change, |
790 | unsigned int flags) | |
b60c5115 TG |
791 | { |
792 | struct ifinfomsg *ifm; | |
793 | struct nlmsghdr *nlh; | |
eeda3fd6 | 794 | const struct net_device_stats *stats; |
96e74088 | 795 | struct nlattr *attr; |
1da177e4 | 796 | |
b60c5115 TG |
797 | nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags); |
798 | if (nlh == NULL) | |
26932566 | 799 | return -EMSGSIZE; |
1da177e4 | 800 | |
b60c5115 TG |
801 | ifm = nlmsg_data(nlh); |
802 | ifm->ifi_family = AF_UNSPEC; | |
803 | ifm->__ifi_pad = 0; | |
804 | ifm->ifi_type = dev->type; | |
805 | ifm->ifi_index = dev->ifindex; | |
806 | ifm->ifi_flags = dev_get_flags(dev); | |
807 | ifm->ifi_change = change; | |
808 | ||
809 | NLA_PUT_STRING(skb, IFLA_IFNAME, dev->name); | |
810 | NLA_PUT_U32(skb, IFLA_TXQLEN, dev->tx_queue_len); | |
b60c5115 TG |
811 | NLA_PUT_U8(skb, IFLA_OPERSTATE, |
812 | netif_running(dev) ? dev->operstate : IF_OPER_DOWN); | |
813 | NLA_PUT_U8(skb, IFLA_LINKMODE, dev->link_mode); | |
814 | NLA_PUT_U32(skb, IFLA_MTU, dev->mtu); | |
815 | ||
816 | if (dev->ifindex != dev->iflink) | |
817 | NLA_PUT_U32(skb, IFLA_LINK, dev->iflink); | |
818 | ||
819 | if (dev->master) | |
820 | NLA_PUT_U32(skb, IFLA_MASTER, dev->master->ifindex); | |
1da177e4 | 821 | |
af356afa PM |
822 | if (dev->qdisc) |
823 | NLA_PUT_STRING(skb, IFLA_QDISC, dev->qdisc->ops->id); | |
b00055aa | 824 | |
0b815a1a SH |
825 | if (dev->ifalias) |
826 | NLA_PUT_STRING(skb, IFLA_IFALIAS, dev->ifalias); | |
827 | ||
1da177e4 LT |
828 | if (1) { |
829 | struct rtnl_link_ifmap map = { | |
830 | .mem_start = dev->mem_start, | |
831 | .mem_end = dev->mem_end, | |
832 | .base_addr = dev->base_addr, | |
833 | .irq = dev->irq, | |
834 | .dma = dev->dma, | |
835 | .port = dev->if_port, | |
836 | }; | |
b60c5115 | 837 | NLA_PUT(skb, IFLA_MAP, sizeof(map), &map); |
1da177e4 LT |
838 | } |
839 | ||
840 | if (dev->addr_len) { | |
b60c5115 TG |
841 | NLA_PUT(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr); |
842 | NLA_PUT(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast); | |
1da177e4 LT |
843 | } |
844 | ||
96e74088 PE |
845 | attr = nla_reserve(skb, IFLA_STATS, |
846 | sizeof(struct rtnl_link_stats)); | |
847 | if (attr == NULL) | |
848 | goto nla_put_failure; | |
b60c5115 | 849 | |
eeda3fd6 | 850 | stats = dev_get_stats(dev); |
96e74088 | 851 | copy_rtnl_link_stats(nla_data(attr), stats); |
1da177e4 | 852 | |
10708f37 JE |
853 | attr = nla_reserve(skb, IFLA_STATS64, |
854 | sizeof(struct rtnl_link_stats64)); | |
855 | if (attr == NULL) | |
856 | goto nla_put_failure; | |
10708f37 JE |
857 | copy_rtnl_link_stats64(nla_data(attr), stats); |
858 | ||
57b61080 SF |
859 | if (dev->dev.parent) |
860 | NLA_PUT_U32(skb, IFLA_NUM_VF, dev_num_vf(dev->dev.parent)); | |
861 | ||
ebc08a6f WM |
862 | if (dev->netdev_ops->ndo_get_vf_config && dev->dev.parent) { |
863 | int i; | |
ebc08a6f | 864 | |
c02db8c6 CW |
865 | struct nlattr *vfinfo, *vf; |
866 | int num_vfs = dev_num_vf(dev->dev.parent); | |
867 | ||
c02db8c6 CW |
868 | vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST); |
869 | if (!vfinfo) | |
870 | goto nla_put_failure; | |
871 | for (i = 0; i < num_vfs; i++) { | |
872 | struct ifla_vf_info ivi; | |
873 | struct ifla_vf_mac vf_mac; | |
874 | struct ifla_vf_vlan vf_vlan; | |
875 | struct ifla_vf_tx_rate vf_tx_rate; | |
ebc08a6f WM |
876 | if (dev->netdev_ops->ndo_get_vf_config(dev, i, &ivi)) |
877 | break; | |
c02db8c6 CW |
878 | vf_mac.vf = vf_vlan.vf = vf_tx_rate.vf = ivi.vf; |
879 | memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac)); | |
880 | vf_vlan.vlan = ivi.vlan; | |
881 | vf_vlan.qos = ivi.qos; | |
882 | vf_tx_rate.rate = ivi.tx_rate; | |
883 | vf = nla_nest_start(skb, IFLA_VF_INFO); | |
884 | if (!vf) { | |
885 | nla_nest_cancel(skb, vfinfo); | |
886 | goto nla_put_failure; | |
887 | } | |
888 | NLA_PUT(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac); | |
889 | NLA_PUT(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan); | |
890 | NLA_PUT(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate), &vf_tx_rate); | |
891 | nla_nest_end(skb, vf); | |
ebc08a6f | 892 | } |
c02db8c6 | 893 | nla_nest_end(skb, vfinfo); |
ebc08a6f | 894 | } |
57b61080 SF |
895 | |
896 | if (rtnl_port_fill(skb, dev)) | |
897 | goto nla_put_failure; | |
898 | ||
38f7b870 PM |
899 | if (dev->rtnl_link_ops) { |
900 | if (rtnl_link_fill(skb, dev) < 0) | |
901 | goto nla_put_failure; | |
902 | } | |
903 | ||
b60c5115 TG |
904 | return nlmsg_end(skb, nlh); |
905 | ||
906 | nla_put_failure: | |
26932566 PM |
907 | nlmsg_cancel(skb, nlh); |
908 | return -EMSGSIZE; | |
1da177e4 LT |
909 | } |
910 | ||
b60c5115 | 911 | static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb) |
1da177e4 | 912 | { |
3b1e0a65 | 913 | struct net *net = sock_net(skb->sk); |
7c28bd0b ED |
914 | int h, s_h; |
915 | int idx = 0, s_idx; | |
1da177e4 | 916 | struct net_device *dev; |
7c28bd0b ED |
917 | struct hlist_head *head; |
918 | struct hlist_node *node; | |
919 | ||
920 | s_h = cb->args[0]; | |
921 | s_idx = cb->args[1]; | |
922 | ||
923 | for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) { | |
924 | idx = 0; | |
925 | head = &net->dev_index_head[h]; | |
926 | hlist_for_each_entry(dev, node, head, index_hlist) { | |
927 | if (idx < s_idx) | |
928 | goto cont; | |
929 | if (rtnl_fill_ifinfo(skb, dev, RTM_NEWLINK, | |
930 | NETLINK_CB(cb->skb).pid, | |
931 | cb->nlh->nlmsg_seq, 0, | |
932 | NLM_F_MULTI) <= 0) | |
933 | goto out; | |
7562f876 | 934 | cont: |
7c28bd0b ED |
935 | idx++; |
936 | } | |
1da177e4 | 937 | } |
7c28bd0b ED |
938 | out: |
939 | cb->args[1] = idx; | |
940 | cb->args[0] = h; | |
1da177e4 LT |
941 | |
942 | return skb->len; | |
943 | } | |
944 | ||
e7199288 | 945 | const struct nla_policy ifla_policy[IFLA_MAX+1] = { |
5176f91e | 946 | [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 }, |
38f7b870 PM |
947 | [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, |
948 | [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, | |
5176f91e | 949 | [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) }, |
da5e0494 | 950 | [IFLA_MTU] = { .type = NLA_U32 }, |
76e87306 | 951 | [IFLA_LINK] = { .type = NLA_U32 }, |
da5e0494 TG |
952 | [IFLA_TXQLEN] = { .type = NLA_U32 }, |
953 | [IFLA_WEIGHT] = { .type = NLA_U32 }, | |
954 | [IFLA_OPERSTATE] = { .type = NLA_U8 }, | |
955 | [IFLA_LINKMODE] = { .type = NLA_U8 }, | |
76e87306 | 956 | [IFLA_LINKINFO] = { .type = NLA_NESTED }, |
d8a5ec67 | 957 | [IFLA_NET_NS_PID] = { .type = NLA_U32 }, |
0b815a1a | 958 | [IFLA_IFALIAS] = { .type = NLA_STRING, .len = IFALIASZ-1 }, |
c02db8c6 | 959 | [IFLA_VFINFO_LIST] = {. type = NLA_NESTED }, |
57b61080 SF |
960 | [IFLA_VF_PORTS] = { .type = NLA_NESTED }, |
961 | [IFLA_PORT_SELF] = { .type = NLA_NESTED }, | |
da5e0494 | 962 | }; |
e0d087af | 963 | EXPORT_SYMBOL(ifla_policy); |
da5e0494 | 964 | |
38f7b870 PM |
965 | static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = { |
966 | [IFLA_INFO_KIND] = { .type = NLA_STRING }, | |
967 | [IFLA_INFO_DATA] = { .type = NLA_NESTED }, | |
968 | }; | |
969 | ||
c02db8c6 CW |
970 | static const struct nla_policy ifla_vfinfo_policy[IFLA_VF_INFO_MAX+1] = { |
971 | [IFLA_VF_INFO] = { .type = NLA_NESTED }, | |
972 | }; | |
973 | ||
974 | static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = { | |
975 | [IFLA_VF_MAC] = { .type = NLA_BINARY, | |
976 | .len = sizeof(struct ifla_vf_mac) }, | |
977 | [IFLA_VF_VLAN] = { .type = NLA_BINARY, | |
978 | .len = sizeof(struct ifla_vf_vlan) }, | |
979 | [IFLA_VF_TX_RATE] = { .type = NLA_BINARY, | |
980 | .len = sizeof(struct ifla_vf_tx_rate) }, | |
981 | }; | |
982 | ||
57b61080 SF |
983 | static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = { |
984 | [IFLA_PORT_VF] = { .type = NLA_U32 }, | |
985 | [IFLA_PORT_PROFILE] = { .type = NLA_STRING, | |
986 | .len = PORT_PROFILE_MAX }, | |
987 | [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY, | |
988 | .len = sizeof(struct ifla_port_vsi)}, | |
989 | [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY, | |
990 | .len = PORT_UUID_MAX }, | |
991 | [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING, | |
992 | .len = PORT_UUID_MAX }, | |
993 | [IFLA_PORT_REQUEST] = { .type = NLA_U8, }, | |
994 | [IFLA_PORT_RESPONSE] = { .type = NLA_U16, }, | |
995 | }; | |
996 | ||
81adee47 EB |
997 | struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[]) |
998 | { | |
999 | struct net *net; | |
1000 | /* Examine the link attributes and figure out which | |
1001 | * network namespace we are talking about. | |
1002 | */ | |
1003 | if (tb[IFLA_NET_NS_PID]) | |
1004 | net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID])); | |
1005 | else | |
1006 | net = get_net(src_net); | |
1007 | return net; | |
1008 | } | |
1009 | EXPORT_SYMBOL(rtnl_link_get_net); | |
1010 | ||
1840bb13 TG |
1011 | static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[]) |
1012 | { | |
1013 | if (dev) { | |
1014 | if (tb[IFLA_ADDRESS] && | |
1015 | nla_len(tb[IFLA_ADDRESS]) < dev->addr_len) | |
1016 | return -EINVAL; | |
1017 | ||
1018 | if (tb[IFLA_BROADCAST] && | |
1019 | nla_len(tb[IFLA_BROADCAST]) < dev->addr_len) | |
1020 | return -EINVAL; | |
1021 | } | |
1022 | ||
1023 | return 0; | |
1024 | } | |
1025 | ||
c02db8c6 CW |
1026 | static int do_setvfinfo(struct net_device *dev, struct nlattr *attr) |
1027 | { | |
1028 | int rem, err = -EINVAL; | |
1029 | struct nlattr *vf; | |
1030 | const struct net_device_ops *ops = dev->netdev_ops; | |
1031 | ||
1032 | nla_for_each_nested(vf, attr, rem) { | |
1033 | switch (nla_type(vf)) { | |
1034 | case IFLA_VF_MAC: { | |
1035 | struct ifla_vf_mac *ivm; | |
1036 | ivm = nla_data(vf); | |
1037 | err = -EOPNOTSUPP; | |
1038 | if (ops->ndo_set_vf_mac) | |
1039 | err = ops->ndo_set_vf_mac(dev, ivm->vf, | |
1040 | ivm->mac); | |
1041 | break; | |
1042 | } | |
1043 | case IFLA_VF_VLAN: { | |
1044 | struct ifla_vf_vlan *ivv; | |
1045 | ivv = nla_data(vf); | |
1046 | err = -EOPNOTSUPP; | |
1047 | if (ops->ndo_set_vf_vlan) | |
1048 | err = ops->ndo_set_vf_vlan(dev, ivv->vf, | |
1049 | ivv->vlan, | |
1050 | ivv->qos); | |
1051 | break; | |
1052 | } | |
1053 | case IFLA_VF_TX_RATE: { | |
1054 | struct ifla_vf_tx_rate *ivt; | |
1055 | ivt = nla_data(vf); | |
1056 | err = -EOPNOTSUPP; | |
1057 | if (ops->ndo_set_vf_tx_rate) | |
1058 | err = ops->ndo_set_vf_tx_rate(dev, ivt->vf, | |
1059 | ivt->rate); | |
1060 | break; | |
1061 | } | |
1062 | default: | |
1063 | err = -EINVAL; | |
1064 | break; | |
1065 | } | |
1066 | if (err) | |
1067 | break; | |
1068 | } | |
1069 | return err; | |
1070 | } | |
1071 | ||
0157f60c | 1072 | static int do_setlink(struct net_device *dev, struct ifinfomsg *ifm, |
38f7b870 | 1073 | struct nlattr **tb, char *ifname, int modified) |
1da177e4 | 1074 | { |
d314774c | 1075 | const struct net_device_ops *ops = dev->netdev_ops; |
38f7b870 | 1076 | int send_addr_notify = 0; |
0157f60c | 1077 | int err; |
1da177e4 | 1078 | |
d8a5ec67 | 1079 | if (tb[IFLA_NET_NS_PID]) { |
81adee47 | 1080 | struct net *net = rtnl_link_get_net(dev_net(dev), tb); |
d8a5ec67 EB |
1081 | if (IS_ERR(net)) { |
1082 | err = PTR_ERR(net); | |
1083 | goto errout; | |
1084 | } | |
1085 | err = dev_change_net_namespace(dev, net, ifname); | |
1086 | put_net(net); | |
1087 | if (err) | |
1088 | goto errout; | |
1089 | modified = 1; | |
1090 | } | |
1091 | ||
da5e0494 | 1092 | if (tb[IFLA_MAP]) { |
1da177e4 LT |
1093 | struct rtnl_link_ifmap *u_map; |
1094 | struct ifmap k_map; | |
1095 | ||
d314774c | 1096 | if (!ops->ndo_set_config) { |
1da177e4 | 1097 | err = -EOPNOTSUPP; |
0157f60c | 1098 | goto errout; |
1da177e4 LT |
1099 | } |
1100 | ||
1101 | if (!netif_device_present(dev)) { | |
1102 | err = -ENODEV; | |
0157f60c | 1103 | goto errout; |
1da177e4 | 1104 | } |
1da177e4 | 1105 | |
da5e0494 | 1106 | u_map = nla_data(tb[IFLA_MAP]); |
1da177e4 LT |
1107 | k_map.mem_start = (unsigned long) u_map->mem_start; |
1108 | k_map.mem_end = (unsigned long) u_map->mem_end; | |
1109 | k_map.base_addr = (unsigned short) u_map->base_addr; | |
1110 | k_map.irq = (unsigned char) u_map->irq; | |
1111 | k_map.dma = (unsigned char) u_map->dma; | |
1112 | k_map.port = (unsigned char) u_map->port; | |
1113 | ||
d314774c | 1114 | err = ops->ndo_set_config(dev, &k_map); |
da5e0494 | 1115 | if (err < 0) |
0157f60c | 1116 | goto errout; |
1da177e4 | 1117 | |
da5e0494 | 1118 | modified = 1; |
1da177e4 LT |
1119 | } |
1120 | ||
da5e0494 | 1121 | if (tb[IFLA_ADDRESS]) { |
70f8e78e DM |
1122 | struct sockaddr *sa; |
1123 | int len; | |
1124 | ||
d314774c | 1125 | if (!ops->ndo_set_mac_address) { |
1da177e4 | 1126 | err = -EOPNOTSUPP; |
0157f60c | 1127 | goto errout; |
1da177e4 | 1128 | } |
da5e0494 | 1129 | |
1da177e4 LT |
1130 | if (!netif_device_present(dev)) { |
1131 | err = -ENODEV; | |
0157f60c | 1132 | goto errout; |
1da177e4 | 1133 | } |
1da177e4 | 1134 | |
70f8e78e DM |
1135 | len = sizeof(sa_family_t) + dev->addr_len; |
1136 | sa = kmalloc(len, GFP_KERNEL); | |
1137 | if (!sa) { | |
1138 | err = -ENOMEM; | |
0157f60c | 1139 | goto errout; |
70f8e78e DM |
1140 | } |
1141 | sa->sa_family = dev->type; | |
da5e0494 | 1142 | memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]), |
70f8e78e | 1143 | dev->addr_len); |
d314774c | 1144 | err = ops->ndo_set_mac_address(dev, sa); |
70f8e78e | 1145 | kfree(sa); |
1da177e4 | 1146 | if (err) |
0157f60c | 1147 | goto errout; |
1da177e4 | 1148 | send_addr_notify = 1; |
da5e0494 | 1149 | modified = 1; |
1da177e4 LT |
1150 | } |
1151 | ||
da5e0494 TG |
1152 | if (tb[IFLA_MTU]) { |
1153 | err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU])); | |
1154 | if (err < 0) | |
0157f60c | 1155 | goto errout; |
da5e0494 | 1156 | modified = 1; |
1da177e4 LT |
1157 | } |
1158 | ||
da5e0494 TG |
1159 | /* |
1160 | * Interface selected by interface index but interface | |
1161 | * name provided implies that a name change has been | |
1162 | * requested. | |
1163 | */ | |
51055be8 | 1164 | if (ifm->ifi_index > 0 && ifname[0]) { |
da5e0494 TG |
1165 | err = dev_change_name(dev, ifname); |
1166 | if (err < 0) | |
0157f60c | 1167 | goto errout; |
da5e0494 | 1168 | modified = 1; |
1da177e4 LT |
1169 | } |
1170 | ||
0b815a1a SH |
1171 | if (tb[IFLA_IFALIAS]) { |
1172 | err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]), | |
1173 | nla_len(tb[IFLA_IFALIAS])); | |
1174 | if (err < 0) | |
1175 | goto errout; | |
1176 | modified = 1; | |
1177 | } | |
1178 | ||
da5e0494 TG |
1179 | if (tb[IFLA_BROADCAST]) { |
1180 | nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len); | |
1181 | send_addr_notify = 1; | |
1da177e4 LT |
1182 | } |
1183 | ||
83b496e9 | 1184 | if (ifm->ifi_flags || ifm->ifi_change) { |
3729d502 | 1185 | err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); |
5f9021cf JB |
1186 | if (err < 0) |
1187 | goto errout; | |
83b496e9 | 1188 | } |
1da177e4 | 1189 | |
93b2d4a2 DM |
1190 | if (tb[IFLA_TXQLEN]) |
1191 | dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); | |
b00055aa | 1192 | |
da5e0494 | 1193 | if (tb[IFLA_OPERSTATE]) |
93b2d4a2 | 1194 | set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); |
b00055aa | 1195 | |
da5e0494 | 1196 | if (tb[IFLA_LINKMODE]) { |
93b2d4a2 DM |
1197 | write_lock_bh(&dev_base_lock); |
1198 | dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); | |
1199 | write_unlock_bh(&dev_base_lock); | |
b00055aa SR |
1200 | } |
1201 | ||
c02db8c6 CW |
1202 | if (tb[IFLA_VFINFO_LIST]) { |
1203 | struct nlattr *attr; | |
1204 | int rem; | |
1205 | nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) { | |
253683bb DH |
1206 | if (nla_type(attr) != IFLA_VF_INFO) { |
1207 | err = -EINVAL; | |
c02db8c6 | 1208 | goto errout; |
253683bb | 1209 | } |
c02db8c6 CW |
1210 | err = do_setvfinfo(dev, attr); |
1211 | if (err < 0) | |
1212 | goto errout; | |
1213 | modified = 1; | |
1214 | } | |
ebc08a6f | 1215 | } |
1da177e4 LT |
1216 | err = 0; |
1217 | ||
57b61080 SF |
1218 | if (tb[IFLA_VF_PORTS]) { |
1219 | struct nlattr *port[IFLA_PORT_MAX+1]; | |
1220 | struct nlattr *attr; | |
1221 | int vf; | |
1222 | int rem; | |
1223 | ||
1224 | err = -EOPNOTSUPP; | |
1225 | if (!ops->ndo_set_vf_port) | |
1226 | goto errout; | |
1227 | ||
1228 | nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) { | |
1229 | if (nla_type(attr) != IFLA_VF_PORT) | |
1230 | continue; | |
1231 | err = nla_parse_nested(port, IFLA_PORT_MAX, | |
1232 | attr, ifla_port_policy); | |
1233 | if (err < 0) | |
1234 | goto errout; | |
1235 | if (!port[IFLA_PORT_VF]) { | |
1236 | err = -EOPNOTSUPP; | |
1237 | goto errout; | |
1238 | } | |
1239 | vf = nla_get_u32(port[IFLA_PORT_VF]); | |
1240 | err = ops->ndo_set_vf_port(dev, vf, port); | |
1241 | if (err < 0) | |
1242 | goto errout; | |
1243 | modified = 1; | |
1244 | } | |
1245 | } | |
1246 | err = 0; | |
1247 | ||
1248 | if (tb[IFLA_PORT_SELF]) { | |
1249 | struct nlattr *port[IFLA_PORT_MAX+1]; | |
1250 | ||
1251 | err = nla_parse_nested(port, IFLA_PORT_MAX, | |
1252 | tb[IFLA_PORT_SELF], ifla_port_policy); | |
1253 | if (err < 0) | |
1254 | goto errout; | |
1255 | ||
1256 | err = -EOPNOTSUPP; | |
1257 | if (ops->ndo_set_vf_port) | |
1258 | err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port); | |
1259 | if (err < 0) | |
1260 | goto errout; | |
1261 | modified = 1; | |
1262 | } | |
1263 | err = 0; | |
1264 | ||
0157f60c | 1265 | errout: |
da5e0494 TG |
1266 | if (err < 0 && modified && net_ratelimit()) |
1267 | printk(KERN_WARNING "A link change request failed with " | |
1268 | "some changes comitted already. Interface %s may " | |
1269 | "have been left with an inconsistent configuration, " | |
1270 | "please check.\n", dev->name); | |
1271 | ||
1da177e4 LT |
1272 | if (send_addr_notify) |
1273 | call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); | |
0157f60c PM |
1274 | return err; |
1275 | } | |
1da177e4 | 1276 | |
0157f60c PM |
1277 | static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1278 | { | |
3b1e0a65 | 1279 | struct net *net = sock_net(skb->sk); |
0157f60c PM |
1280 | struct ifinfomsg *ifm; |
1281 | struct net_device *dev; | |
1282 | int err; | |
1283 | struct nlattr *tb[IFLA_MAX+1]; | |
1284 | char ifname[IFNAMSIZ]; | |
1285 | ||
1286 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); | |
1287 | if (err < 0) | |
1288 | goto errout; | |
1289 | ||
1290 | if (tb[IFLA_IFNAME]) | |
1291 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1292 | else | |
1293 | ifname[0] = '\0'; | |
1294 | ||
1295 | err = -EINVAL; | |
1296 | ifm = nlmsg_data(nlh); | |
1297 | if (ifm->ifi_index > 0) | |
a3d12891 | 1298 | dev = __dev_get_by_index(net, ifm->ifi_index); |
0157f60c | 1299 | else if (tb[IFLA_IFNAME]) |
a3d12891 | 1300 | dev = __dev_get_by_name(net, ifname); |
0157f60c PM |
1301 | else |
1302 | goto errout; | |
1303 | ||
1304 | if (dev == NULL) { | |
1305 | err = -ENODEV; | |
1306 | goto errout; | |
1307 | } | |
1308 | ||
e0d087af ED |
1309 | err = validate_linkmsg(dev, tb); |
1310 | if (err < 0) | |
a3d12891 | 1311 | goto errout; |
0157f60c | 1312 | |
38f7b870 | 1313 | err = do_setlink(dev, ifm, tb, ifname, 0); |
da5e0494 | 1314 | errout: |
1da177e4 LT |
1315 | return err; |
1316 | } | |
1317 | ||
38f7b870 PM |
1318 | static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1319 | { | |
3b1e0a65 | 1320 | struct net *net = sock_net(skb->sk); |
38f7b870 PM |
1321 | const struct rtnl_link_ops *ops; |
1322 | struct net_device *dev; | |
1323 | struct ifinfomsg *ifm; | |
1324 | char ifname[IFNAMSIZ]; | |
1325 | struct nlattr *tb[IFLA_MAX+1]; | |
1326 | int err; | |
1327 | ||
1328 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); | |
1329 | if (err < 0) | |
1330 | return err; | |
1331 | ||
1332 | if (tb[IFLA_IFNAME]) | |
1333 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1334 | ||
1335 | ifm = nlmsg_data(nlh); | |
1336 | if (ifm->ifi_index > 0) | |
881d966b | 1337 | dev = __dev_get_by_index(net, ifm->ifi_index); |
38f7b870 | 1338 | else if (tb[IFLA_IFNAME]) |
881d966b | 1339 | dev = __dev_get_by_name(net, ifname); |
38f7b870 PM |
1340 | else |
1341 | return -EINVAL; | |
1342 | ||
1343 | if (!dev) | |
1344 | return -ENODEV; | |
1345 | ||
1346 | ops = dev->rtnl_link_ops; | |
1347 | if (!ops) | |
1348 | return -EOPNOTSUPP; | |
1349 | ||
23289a37 | 1350 | ops->dellink(dev, NULL); |
38f7b870 PM |
1351 | return 0; |
1352 | } | |
1353 | ||
3729d502 PM |
1354 | int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm) |
1355 | { | |
1356 | unsigned int old_flags; | |
1357 | int err; | |
1358 | ||
1359 | old_flags = dev->flags; | |
1360 | if (ifm && (ifm->ifi_flags || ifm->ifi_change)) { | |
1361 | err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm)); | |
1362 | if (err < 0) | |
1363 | return err; | |
1364 | } | |
1365 | ||
1366 | dev->rtnl_link_state = RTNL_LINK_INITIALIZED; | |
1367 | rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U); | |
1368 | ||
1369 | __dev_notify_flags(dev, old_flags); | |
1370 | return 0; | |
1371 | } | |
1372 | EXPORT_SYMBOL(rtnl_configure_link); | |
1373 | ||
81adee47 EB |
1374 | struct net_device *rtnl_create_link(struct net *src_net, struct net *net, |
1375 | char *ifname, const struct rtnl_link_ops *ops, struct nlattr *tb[]) | |
e7199288 PE |
1376 | { |
1377 | int err; | |
1378 | struct net_device *dev; | |
2e59af3d ED |
1379 | unsigned int num_queues = 1; |
1380 | unsigned int real_num_queues = 1; | |
e7199288 | 1381 | |
2e59af3d | 1382 | if (ops->get_tx_queues) { |
81adee47 | 1383 | err = ops->get_tx_queues(src_net, tb, &num_queues, |
e0d087af | 1384 | &real_num_queues); |
2e59af3d ED |
1385 | if (err) |
1386 | goto err; | |
1387 | } | |
e7199288 | 1388 | err = -ENOMEM; |
2e59af3d | 1389 | dev = alloc_netdev_mq(ops->priv_size, ifname, ops->setup, num_queues); |
e7199288 PE |
1390 | if (!dev) |
1391 | goto err; | |
1392 | ||
81adee47 EB |
1393 | dev_net_set(dev, net); |
1394 | dev->rtnl_link_ops = ops; | |
3729d502 | 1395 | dev->rtnl_link_state = RTNL_LINK_INITIALIZING; |
2e59af3d | 1396 | dev->real_num_tx_queues = real_num_queues; |
81adee47 | 1397 | |
e7199288 PE |
1398 | if (strchr(dev->name, '%')) { |
1399 | err = dev_alloc_name(dev, dev->name); | |
1400 | if (err < 0) | |
1401 | goto err_free; | |
1402 | } | |
1403 | ||
e7199288 PE |
1404 | if (tb[IFLA_MTU]) |
1405 | dev->mtu = nla_get_u32(tb[IFLA_MTU]); | |
1406 | if (tb[IFLA_ADDRESS]) | |
1407 | memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]), | |
1408 | nla_len(tb[IFLA_ADDRESS])); | |
1409 | if (tb[IFLA_BROADCAST]) | |
1410 | memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]), | |
1411 | nla_len(tb[IFLA_BROADCAST])); | |
1412 | if (tb[IFLA_TXQLEN]) | |
1413 | dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]); | |
1414 | if (tb[IFLA_OPERSTATE]) | |
93b2d4a2 | 1415 | set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE])); |
e7199288 PE |
1416 | if (tb[IFLA_LINKMODE]) |
1417 | dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]); | |
1418 | ||
1419 | return dev; | |
1420 | ||
1421 | err_free: | |
1422 | free_netdev(dev); | |
1423 | err: | |
1424 | return ERR_PTR(err); | |
1425 | } | |
e0d087af | 1426 | EXPORT_SYMBOL(rtnl_create_link); |
e7199288 | 1427 | |
38f7b870 PM |
1428 | static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) |
1429 | { | |
3b1e0a65 | 1430 | struct net *net = sock_net(skb->sk); |
38f7b870 PM |
1431 | const struct rtnl_link_ops *ops; |
1432 | struct net_device *dev; | |
1433 | struct ifinfomsg *ifm; | |
1434 | char kind[MODULE_NAME_LEN]; | |
1435 | char ifname[IFNAMSIZ]; | |
1436 | struct nlattr *tb[IFLA_MAX+1]; | |
1437 | struct nlattr *linkinfo[IFLA_INFO_MAX+1]; | |
1438 | int err; | |
1439 | ||
95a5afca | 1440 | #ifdef CONFIG_MODULES |
38f7b870 | 1441 | replay: |
8072f085 | 1442 | #endif |
38f7b870 PM |
1443 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); |
1444 | if (err < 0) | |
1445 | return err; | |
1446 | ||
1447 | if (tb[IFLA_IFNAME]) | |
1448 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1449 | else | |
1450 | ifname[0] = '\0'; | |
1451 | ||
1452 | ifm = nlmsg_data(nlh); | |
1453 | if (ifm->ifi_index > 0) | |
881d966b | 1454 | dev = __dev_get_by_index(net, ifm->ifi_index); |
38f7b870 | 1455 | else if (ifname[0]) |
881d966b | 1456 | dev = __dev_get_by_name(net, ifname); |
38f7b870 PM |
1457 | else |
1458 | dev = NULL; | |
1459 | ||
e0d087af ED |
1460 | err = validate_linkmsg(dev, tb); |
1461 | if (err < 0) | |
1840bb13 TG |
1462 | return err; |
1463 | ||
38f7b870 PM |
1464 | if (tb[IFLA_LINKINFO]) { |
1465 | err = nla_parse_nested(linkinfo, IFLA_INFO_MAX, | |
1466 | tb[IFLA_LINKINFO], ifla_info_policy); | |
1467 | if (err < 0) | |
1468 | return err; | |
1469 | } else | |
1470 | memset(linkinfo, 0, sizeof(linkinfo)); | |
1471 | ||
1472 | if (linkinfo[IFLA_INFO_KIND]) { | |
1473 | nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind)); | |
1474 | ops = rtnl_link_ops_get(kind); | |
1475 | } else { | |
1476 | kind[0] = '\0'; | |
1477 | ops = NULL; | |
1478 | } | |
1479 | ||
1480 | if (1) { | |
1481 | struct nlattr *attr[ops ? ops->maxtype + 1 : 0], **data = NULL; | |
81adee47 | 1482 | struct net *dest_net; |
38f7b870 PM |
1483 | |
1484 | if (ops) { | |
1485 | if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) { | |
1486 | err = nla_parse_nested(attr, ops->maxtype, | |
1487 | linkinfo[IFLA_INFO_DATA], | |
1488 | ops->policy); | |
1489 | if (err < 0) | |
1490 | return err; | |
1491 | data = attr; | |
1492 | } | |
1493 | if (ops->validate) { | |
1494 | err = ops->validate(tb, data); | |
1495 | if (err < 0) | |
1496 | return err; | |
1497 | } | |
1498 | } | |
1499 | ||
1500 | if (dev) { | |
1501 | int modified = 0; | |
1502 | ||
1503 | if (nlh->nlmsg_flags & NLM_F_EXCL) | |
1504 | return -EEXIST; | |
1505 | if (nlh->nlmsg_flags & NLM_F_REPLACE) | |
1506 | return -EOPNOTSUPP; | |
1507 | ||
1508 | if (linkinfo[IFLA_INFO_DATA]) { | |
1509 | if (!ops || ops != dev->rtnl_link_ops || | |
1510 | !ops->changelink) | |
1511 | return -EOPNOTSUPP; | |
1512 | ||
1513 | err = ops->changelink(dev, tb, data); | |
1514 | if (err < 0) | |
1515 | return err; | |
1516 | modified = 1; | |
1517 | } | |
1518 | ||
1519 | return do_setlink(dev, ifm, tb, ifname, modified); | |
1520 | } | |
1521 | ||
1522 | if (!(nlh->nlmsg_flags & NLM_F_CREATE)) | |
1523 | return -ENODEV; | |
1524 | ||
3729d502 | 1525 | if (ifm->ifi_index) |
38f7b870 | 1526 | return -EOPNOTSUPP; |
0e06877c | 1527 | if (tb[IFLA_MAP] || tb[IFLA_MASTER] || tb[IFLA_PROTINFO]) |
38f7b870 PM |
1528 | return -EOPNOTSUPP; |
1529 | ||
1530 | if (!ops) { | |
95a5afca | 1531 | #ifdef CONFIG_MODULES |
38f7b870 PM |
1532 | if (kind[0]) { |
1533 | __rtnl_unlock(); | |
1534 | request_module("rtnl-link-%s", kind); | |
1535 | rtnl_lock(); | |
1536 | ops = rtnl_link_ops_get(kind); | |
1537 | if (ops) | |
1538 | goto replay; | |
1539 | } | |
1540 | #endif | |
1541 | return -EOPNOTSUPP; | |
1542 | } | |
1543 | ||
1544 | if (!ifname[0]) | |
1545 | snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind); | |
e7199288 | 1546 | |
81adee47 EB |
1547 | dest_net = rtnl_link_get_net(net, tb); |
1548 | dev = rtnl_create_link(net, dest_net, ifname, ops, tb); | |
e7199288 PE |
1549 | |
1550 | if (IS_ERR(dev)) | |
1551 | err = PTR_ERR(dev); | |
1552 | else if (ops->newlink) | |
81adee47 | 1553 | err = ops->newlink(net, dev, tb, data); |
2d85cba2 PM |
1554 | else |
1555 | err = register_netdevice(dev); | |
80032cff DC |
1556 | |
1557 | if (err < 0 && !IS_ERR(dev)) | |
38f7b870 | 1558 | free_netdev(dev); |
80032cff | 1559 | if (err < 0) |
3729d502 | 1560 | goto out; |
81adee47 | 1561 | |
3729d502 PM |
1562 | err = rtnl_configure_link(dev, ifm); |
1563 | if (err < 0) | |
1564 | unregister_netdevice(dev); | |
1565 | out: | |
81adee47 | 1566 | put_net(dest_net); |
38f7b870 PM |
1567 | return err; |
1568 | } | |
1569 | } | |
1570 | ||
b60c5115 | 1571 | static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr* nlh, void *arg) |
711e2c33 | 1572 | { |
3b1e0a65 | 1573 | struct net *net = sock_net(skb->sk); |
b60c5115 | 1574 | struct ifinfomsg *ifm; |
a3d12891 | 1575 | char ifname[IFNAMSIZ]; |
b60c5115 TG |
1576 | struct nlattr *tb[IFLA_MAX+1]; |
1577 | struct net_device *dev = NULL; | |
1578 | struct sk_buff *nskb; | |
339bf98f | 1579 | int err; |
711e2c33 | 1580 | |
b60c5115 TG |
1581 | err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy); |
1582 | if (err < 0) | |
9918f230 | 1583 | return err; |
b60c5115 | 1584 | |
a3d12891 ED |
1585 | if (tb[IFLA_IFNAME]) |
1586 | nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ); | |
1587 | ||
b60c5115 | 1588 | ifm = nlmsg_data(nlh); |
a3d12891 ED |
1589 | if (ifm->ifi_index > 0) |
1590 | dev = __dev_get_by_index(net, ifm->ifi_index); | |
1591 | else if (tb[IFLA_IFNAME]) | |
1592 | dev = __dev_get_by_name(net, ifname); | |
1593 | else | |
711e2c33 | 1594 | return -EINVAL; |
711e2c33 | 1595 | |
a3d12891 ED |
1596 | if (dev == NULL) |
1597 | return -ENODEV; | |
1598 | ||
38f7b870 | 1599 | nskb = nlmsg_new(if_nlmsg_size(dev), GFP_KERNEL); |
a3d12891 ED |
1600 | if (nskb == NULL) |
1601 | return -ENOBUFS; | |
b60c5115 | 1602 | |
575c3e2a PM |
1603 | err = rtnl_fill_ifinfo(nskb, dev, RTM_NEWLINK, NETLINK_CB(skb).pid, |
1604 | nlh->nlmsg_seq, 0, 0); | |
26932566 PM |
1605 | if (err < 0) { |
1606 | /* -EMSGSIZE implies BUG in if_nlmsg_size */ | |
1607 | WARN_ON(err == -EMSGSIZE); | |
1608 | kfree_skb(nskb); | |
a3d12891 ED |
1609 | } else |
1610 | err = rtnl_unicast(nskb, net, NETLINK_CB(skb).pid); | |
711e2c33 | 1611 | |
b60c5115 | 1612 | return err; |
711e2c33 | 1613 | } |
711e2c33 | 1614 | |
42bad1da | 1615 | static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb) |
1da177e4 LT |
1616 | { |
1617 | int idx; | |
1618 | int s_idx = cb->family; | |
1619 | ||
1620 | if (s_idx == 0) | |
1621 | s_idx = 1; | |
25239cee | 1622 | for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) { |
1da177e4 LT |
1623 | int type = cb->nlh->nlmsg_type-RTM_BASE; |
1624 | if (idx < s_idx || idx == PF_PACKET) | |
1625 | continue; | |
e2849863 TG |
1626 | if (rtnl_msg_handlers[idx] == NULL || |
1627 | rtnl_msg_handlers[idx][type].dumpit == NULL) | |
1da177e4 LT |
1628 | continue; |
1629 | if (idx > s_idx) | |
1630 | memset(&cb->args[0], 0, sizeof(cb->args)); | |
e2849863 | 1631 | if (rtnl_msg_handlers[idx][type].dumpit(skb, cb)) |
1da177e4 LT |
1632 | break; |
1633 | } | |
1634 | cb->family = idx; | |
1635 | ||
1636 | return skb->len; | |
1637 | } | |
1638 | ||
1639 | void rtmsg_ifinfo(int type, struct net_device *dev, unsigned change) | |
1640 | { | |
c346dca1 | 1641 | struct net *net = dev_net(dev); |
1da177e4 | 1642 | struct sk_buff *skb; |
0ec6d3f4 | 1643 | int err = -ENOBUFS; |
1da177e4 | 1644 | |
38f7b870 | 1645 | skb = nlmsg_new(if_nlmsg_size(dev), GFP_KERNEL); |
0ec6d3f4 TG |
1646 | if (skb == NULL) |
1647 | goto errout; | |
1da177e4 | 1648 | |
575c3e2a | 1649 | err = rtnl_fill_ifinfo(skb, dev, type, 0, 0, change, 0); |
26932566 PM |
1650 | if (err < 0) { |
1651 | /* -EMSGSIZE implies BUG in if_nlmsg_size() */ | |
1652 | WARN_ON(err == -EMSGSIZE); | |
1653 | kfree_skb(skb); | |
1654 | goto errout; | |
1655 | } | |
1ce85fe4 PNA |
1656 | rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_KERNEL); |
1657 | return; | |
0ec6d3f4 TG |
1658 | errout: |
1659 | if (err < 0) | |
4b3da706 | 1660 | rtnl_set_sk_err(net, RTNLGRP_LINK, err); |
1da177e4 LT |
1661 | } |
1662 | ||
1da177e4 LT |
1663 | /* Protected by RTNL sempahore. */ |
1664 | static struct rtattr **rta_buf; | |
1665 | static int rtattr_max; | |
1666 | ||
1667 | /* Process one rtnetlink message. */ | |
1668 | ||
1d00a4eb | 1669 | static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh) |
1da177e4 | 1670 | { |
3b1e0a65 | 1671 | struct net *net = sock_net(skb->sk); |
e2849863 | 1672 | rtnl_doit_func doit; |
1da177e4 LT |
1673 | int sz_idx, kind; |
1674 | int min_len; | |
1675 | int family; | |
1676 | int type; | |
1c2d670f | 1677 | int err; |
1da177e4 | 1678 | |
1da177e4 | 1679 | type = nlh->nlmsg_type; |
1da177e4 | 1680 | if (type > RTM_MAX) |
038890fe | 1681 | return -EOPNOTSUPP; |
1da177e4 LT |
1682 | |
1683 | type -= RTM_BASE; | |
1684 | ||
1685 | /* All the messages must have at least 1 byte length */ | |
1686 | if (nlh->nlmsg_len < NLMSG_LENGTH(sizeof(struct rtgenmsg))) | |
1687 | return 0; | |
1688 | ||
e0d087af | 1689 | family = ((struct rtgenmsg *)NLMSG_DATA(nlh))->rtgen_family; |
1da177e4 LT |
1690 | sz_idx = type>>2; |
1691 | kind = type&3; | |
1692 | ||
1d00a4eb TG |
1693 | if (kind != 2 && security_netlink_recv(skb, CAP_NET_ADMIN)) |
1694 | return -EPERM; | |
1da177e4 LT |
1695 | |
1696 | if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) { | |
97c53cac | 1697 | struct sock *rtnl; |
e2849863 | 1698 | rtnl_dumpit_func dumpit; |
1da177e4 | 1699 | |
e2849863 TG |
1700 | dumpit = rtnl_get_dumpit(family, type); |
1701 | if (dumpit == NULL) | |
038890fe | 1702 | return -EOPNOTSUPP; |
9ac4a169 | 1703 | |
1c2d670f | 1704 | __rtnl_unlock(); |
97c53cac | 1705 | rtnl = net->rtnl; |
1c2d670f PM |
1706 | err = netlink_dump_start(rtnl, skb, nlh, dumpit, NULL); |
1707 | rtnl_lock(); | |
1708 | return err; | |
1da177e4 LT |
1709 | } |
1710 | ||
1711 | memset(rta_buf, 0, (rtattr_max * sizeof(struct rtattr *))); | |
1712 | ||
1713 | min_len = rtm_min[sz_idx]; | |
1714 | if (nlh->nlmsg_len < min_len) | |
1d00a4eb | 1715 | return -EINVAL; |
1da177e4 LT |
1716 | |
1717 | if (nlh->nlmsg_len > min_len) { | |
1718 | int attrlen = nlh->nlmsg_len - NLMSG_ALIGN(min_len); | |
e0d087af | 1719 | struct rtattr *attr = (void *)nlh + NLMSG_ALIGN(min_len); |
1da177e4 LT |
1720 | |
1721 | while (RTA_OK(attr, attrlen)) { | |
1722 | unsigned flavor = attr->rta_type; | |
1723 | if (flavor) { | |
1724 | if (flavor > rta_max[sz_idx]) | |
1d00a4eb | 1725 | return -EINVAL; |
1da177e4 LT |
1726 | rta_buf[flavor-1] = attr; |
1727 | } | |
1728 | attr = RTA_NEXT(attr, attrlen); | |
1729 | } | |
1730 | } | |
1731 | ||
e2849863 TG |
1732 | doit = rtnl_get_doit(family, type); |
1733 | if (doit == NULL) | |
038890fe | 1734 | return -EOPNOTSUPP; |
1da177e4 | 1735 | |
1d00a4eb | 1736 | return doit(skb, nlh, (void *)&rta_buf[0]); |
1da177e4 LT |
1737 | } |
1738 | ||
cd40b7d3 | 1739 | static void rtnetlink_rcv(struct sk_buff *skb) |
1da177e4 | 1740 | { |
cd40b7d3 DL |
1741 | rtnl_lock(); |
1742 | netlink_rcv_skb(skb, &rtnetlink_rcv_msg); | |
1743 | rtnl_unlock(); | |
1da177e4 LT |
1744 | } |
1745 | ||
1da177e4 LT |
1746 | static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr) |
1747 | { | |
1748 | struct net_device *dev = ptr; | |
e9dc8653 | 1749 | |
1da177e4 | 1750 | switch (event) { |
1da177e4 LT |
1751 | case NETDEV_UP: |
1752 | case NETDEV_DOWN: | |
10de05af | 1753 | case NETDEV_PRE_UP: |
d90a909e EB |
1754 | case NETDEV_POST_INIT: |
1755 | case NETDEV_REGISTER: | |
1da177e4 | 1756 | case NETDEV_CHANGE: |
755d0e77 | 1757 | case NETDEV_PRE_TYPE_CHANGE: |
1da177e4 | 1758 | case NETDEV_GOING_DOWN: |
a2835763 | 1759 | case NETDEV_UNREGISTER: |
d90a909e | 1760 | case NETDEV_UNREGISTER_BATCH: |
1da177e4 LT |
1761 | break; |
1762 | default: | |
1763 | rtmsg_ifinfo(RTM_NEWLINK, dev, 0); | |
1764 | break; | |
1765 | } | |
1766 | return NOTIFY_DONE; | |
1767 | } | |
1768 | ||
1769 | static struct notifier_block rtnetlink_dev_notifier = { | |
1770 | .notifier_call = rtnetlink_event, | |
1771 | }; | |
1772 | ||
97c53cac | 1773 | |
2c8c1e72 | 1774 | static int __net_init rtnetlink_net_init(struct net *net) |
97c53cac DL |
1775 | { |
1776 | struct sock *sk; | |
1777 | sk = netlink_kernel_create(net, NETLINK_ROUTE, RTNLGRP_MAX, | |
1778 | rtnetlink_rcv, &rtnl_mutex, THIS_MODULE); | |
1779 | if (!sk) | |
1780 | return -ENOMEM; | |
97c53cac DL |
1781 | net->rtnl = sk; |
1782 | return 0; | |
1783 | } | |
1784 | ||
2c8c1e72 | 1785 | static void __net_exit rtnetlink_net_exit(struct net *net) |
97c53cac | 1786 | { |
775516bf DL |
1787 | netlink_kernel_release(net->rtnl); |
1788 | net->rtnl = NULL; | |
97c53cac DL |
1789 | } |
1790 | ||
1791 | static struct pernet_operations rtnetlink_net_ops = { | |
1792 | .init = rtnetlink_net_init, | |
1793 | .exit = rtnetlink_net_exit, | |
1794 | }; | |
1795 | ||
1da177e4 LT |
1796 | void __init rtnetlink_init(void) |
1797 | { | |
1798 | int i; | |
1799 | ||
1800 | rtattr_max = 0; | |
1801 | for (i = 0; i < ARRAY_SIZE(rta_max); i++) | |
1802 | if (rta_max[i] > rtattr_max) | |
1803 | rtattr_max = rta_max[i]; | |
1804 | rta_buf = kmalloc(rtattr_max * sizeof(struct rtattr *), GFP_KERNEL); | |
1805 | if (!rta_buf) | |
1806 | panic("rtnetlink_init: cannot allocate rta_buf\n"); | |
1807 | ||
97c53cac | 1808 | if (register_pernet_subsys(&rtnetlink_net_ops)) |
1da177e4 | 1809 | panic("rtnetlink_init: cannot initialize rtnetlink\n"); |
97c53cac | 1810 | |
1da177e4 LT |
1811 | netlink_set_nonroot(NETLINK_ROUTE, NL_NONROOT_RECV); |
1812 | register_netdevice_notifier(&rtnetlink_dev_notifier); | |
340d17fc TG |
1813 | |
1814 | rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink, rtnl_dump_ifinfo); | |
1815 | rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL); | |
38f7b870 PM |
1816 | rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL); |
1817 | rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL); | |
687ad8cc TG |
1818 | |
1819 | rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all); | |
1820 | rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all); | |
1da177e4 LT |
1821 | } |
1822 |