1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * drivers/net/bond/bond_netlink.c - Netlink interface for bonding
4  * Copyright (c) 2013 Jiri Pirko <jiri@resnulli.us>
5  * Copyright (c) 2013 Scott Feldman <sfeldma@cumulusnetworks.com>
6  */
7 
8 #include <linux/module.h>
9 #include <linux/errno.h>
10 #include <linux/netdevice.h>
11 #include <linux/etherdevice.h>
12 #include <linux/if_link.h>
13 #include <linux/if_ether.h>
14 #include <net/netlink.h>
15 #include <net/rtnetlink.h>
16 #include <net/bonding.h>
17 #include <net/ipv6.h>
18 
bond_get_slave_size(const struct net_device * bond_dev,const struct net_device * slave_dev)19 static size_t bond_get_slave_size(const struct net_device *bond_dev,
20 				  const struct net_device *slave_dev)
21 {
22 	return nla_total_size(sizeof(u8)) +	/* IFLA_BOND_SLAVE_STATE */
23 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_SLAVE_MII_STATUS */
24 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_SLAVE_LINK_FAILURE_COUNT */
25 		nla_total_size(MAX_ADDR_LEN) +	/* IFLA_BOND_SLAVE_PERM_HWADDR */
26 		nla_total_size(sizeof(u16)) +	/* IFLA_BOND_SLAVE_QUEUE_ID */
27 		nla_total_size(sizeof(u16)) +	/* IFLA_BOND_SLAVE_AD_AGGREGATOR_ID */
28 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_SLAVE_AD_ACTOR_OPER_PORT_STATE */
29 		nla_total_size(sizeof(u16)) +	/* IFLA_BOND_SLAVE_AD_PARTNER_OPER_PORT_STATE */
30 		nla_total_size(sizeof(s32)) +	/* IFLA_BOND_SLAVE_PRIO */
31 		0;
32 }
33 
bond_fill_slave_info(struct sk_buff * skb,const struct net_device * bond_dev,const struct net_device * slave_dev)34 static int bond_fill_slave_info(struct sk_buff *skb,
35 				const struct net_device *bond_dev,
36 				const struct net_device *slave_dev)
37 {
38 	struct slave *slave = bond_slave_get_rtnl(slave_dev);
39 
40 	if (nla_put_u8(skb, IFLA_BOND_SLAVE_STATE, bond_slave_state(slave)))
41 		goto nla_put_failure;
42 
43 	if (nla_put_u8(skb, IFLA_BOND_SLAVE_MII_STATUS, slave->link))
44 		goto nla_put_failure;
45 
46 	if (nla_put_u32(skb, IFLA_BOND_SLAVE_LINK_FAILURE_COUNT,
47 			slave->link_failure_count))
48 		goto nla_put_failure;
49 
50 	if (nla_put(skb, IFLA_BOND_SLAVE_PERM_HWADDR,
51 		    slave_dev->addr_len, slave->perm_hwaddr))
52 		goto nla_put_failure;
53 
54 	if (nla_put_u16(skb, IFLA_BOND_SLAVE_QUEUE_ID, slave->queue_id))
55 		goto nla_put_failure;
56 
57 	if (nla_put_s32(skb, IFLA_BOND_SLAVE_PRIO, slave->prio))
58 		goto nla_put_failure;
59 
60 	if (BOND_MODE(slave->bond) == BOND_MODE_8023AD) {
61 		const struct aggregator *agg;
62 		const struct port *ad_port;
63 
64 		ad_port = &SLAVE_AD_INFO(slave)->port;
65 		agg = SLAVE_AD_INFO(slave)->port.aggregator;
66 		if (agg) {
67 			if (nla_put_u16(skb, IFLA_BOND_SLAVE_AD_AGGREGATOR_ID,
68 					agg->aggregator_identifier))
69 				goto nla_put_failure;
70 			if (nla_put_u8(skb,
71 				       IFLA_BOND_SLAVE_AD_ACTOR_OPER_PORT_STATE,
72 				       ad_port->actor_oper_port_state))
73 				goto nla_put_failure;
74 			if (nla_put_u16(skb,
75 					IFLA_BOND_SLAVE_AD_PARTNER_OPER_PORT_STATE,
76 					ad_port->partner_oper.port_state))
77 				goto nla_put_failure;
78 		}
79 	}
80 
81 	return 0;
82 
83 nla_put_failure:
84 	return -EMSGSIZE;
85 }
86 
87 /* Limit the max delay range to 300s */
88 static struct netlink_range_validation delay_range = {
89 	.max = 300000,
90 };
91 
92 static const struct nla_policy bond_policy[IFLA_BOND_MAX + 1] = {
93 	[IFLA_BOND_MODE]		= { .type = NLA_U8 },
94 	[IFLA_BOND_ACTIVE_SLAVE]	= { .type = NLA_U32 },
95 	[IFLA_BOND_MIIMON]		= { .type = NLA_U32 },
96 	[IFLA_BOND_UPDELAY]		= { .type = NLA_U32 },
97 	[IFLA_BOND_DOWNDELAY]		= { .type = NLA_U32 },
98 	[IFLA_BOND_USE_CARRIER]		= { .type = NLA_U8 },
99 	[IFLA_BOND_ARP_INTERVAL]	= { .type = NLA_U32 },
100 	[IFLA_BOND_ARP_IP_TARGET]	= { .type = NLA_NESTED },
101 	[IFLA_BOND_ARP_VALIDATE]	= { .type = NLA_U32 },
102 	[IFLA_BOND_ARP_ALL_TARGETS]	= { .type = NLA_U32 },
103 	[IFLA_BOND_PRIMARY]		= { .type = NLA_U32 },
104 	[IFLA_BOND_PRIMARY_RESELECT]	= { .type = NLA_U8 },
105 	[IFLA_BOND_FAIL_OVER_MAC]	= { .type = NLA_U8 },
106 	[IFLA_BOND_XMIT_HASH_POLICY]	= { .type = NLA_U8 },
107 	[IFLA_BOND_RESEND_IGMP]		= { .type = NLA_U32 },
108 	[IFLA_BOND_NUM_PEER_NOTIF]	= { .type = NLA_U8 },
109 	[IFLA_BOND_ALL_SLAVES_ACTIVE]	= { .type = NLA_U8 },
110 	[IFLA_BOND_MIN_LINKS]		= { .type = NLA_U32 },
111 	[IFLA_BOND_LP_INTERVAL]		= { .type = NLA_U32 },
112 	[IFLA_BOND_PACKETS_PER_SLAVE]	= { .type = NLA_U32 },
113 	[IFLA_BOND_AD_LACP_ACTIVE]	= { .type = NLA_U8 },
114 	[IFLA_BOND_AD_LACP_RATE]	= { .type = NLA_U8 },
115 	[IFLA_BOND_AD_SELECT]		= { .type = NLA_U8 },
116 	[IFLA_BOND_AD_INFO]		= { .type = NLA_NESTED },
117 	[IFLA_BOND_AD_ACTOR_SYS_PRIO]	= { .type = NLA_U16 },
118 	[IFLA_BOND_AD_USER_PORT_KEY]	= { .type = NLA_U16 },
119 	[IFLA_BOND_AD_ACTOR_SYSTEM]	= { .type = NLA_BINARY,
120 					    .len  = ETH_ALEN },
121 	[IFLA_BOND_TLB_DYNAMIC_LB]	= { .type = NLA_U8 },
122 	[IFLA_BOND_PEER_NOTIF_DELAY]    = NLA_POLICY_FULL_RANGE(NLA_U32, &delay_range),
123 	[IFLA_BOND_MISSED_MAX]		= { .type = NLA_U8 },
124 	[IFLA_BOND_NS_IP6_TARGET]	= { .type = NLA_NESTED },
125 };
126 
127 static const struct nla_policy bond_slave_policy[IFLA_BOND_SLAVE_MAX + 1] = {
128 	[IFLA_BOND_SLAVE_QUEUE_ID]	= { .type = NLA_U16 },
129 	[IFLA_BOND_SLAVE_PRIO]		= { .type = NLA_S32 },
130 };
131 
bond_validate(struct nlattr * tb[],struct nlattr * data[],struct netlink_ext_ack * extack)132 static int bond_validate(struct nlattr *tb[], struct nlattr *data[],
133 			 struct netlink_ext_ack *extack)
134 {
135 	if (tb[IFLA_ADDRESS]) {
136 		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
137 			return -EINVAL;
138 		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
139 			return -EADDRNOTAVAIL;
140 	}
141 	return 0;
142 }
143 
bond_slave_changelink(struct net_device * bond_dev,struct net_device * slave_dev,struct nlattr * tb[],struct nlattr * data[],struct netlink_ext_ack * extack)144 static int bond_slave_changelink(struct net_device *bond_dev,
145 				 struct net_device *slave_dev,
146 				 struct nlattr *tb[], struct nlattr *data[],
147 				 struct netlink_ext_ack *extack)
148 {
149 	struct bonding *bond = netdev_priv(bond_dev);
150 	struct bond_opt_value newval;
151 	int err;
152 
153 	if (!data)
154 		return 0;
155 
156 	if (data[IFLA_BOND_SLAVE_QUEUE_ID]) {
157 		u16 queue_id = nla_get_u16(data[IFLA_BOND_SLAVE_QUEUE_ID]);
158 		char queue_id_str[IFNAMSIZ + 7];
159 
160 		/* queue_id option setting expects slave_name:queue_id */
161 		snprintf(queue_id_str, sizeof(queue_id_str), "%s:%u\n",
162 			 slave_dev->name, queue_id);
163 		bond_opt_initstr(&newval, queue_id_str);
164 		err = __bond_opt_set(bond, BOND_OPT_QUEUE_ID, &newval,
165 				     data[IFLA_BOND_SLAVE_QUEUE_ID], extack);
166 		if (err)
167 			return err;
168 	}
169 
170 	if (data[IFLA_BOND_SLAVE_PRIO]) {
171 		int prio = nla_get_s32(data[IFLA_BOND_SLAVE_PRIO]);
172 
173 		bond_opt_slave_initval(&newval, &slave_dev, prio);
174 		err = __bond_opt_set(bond, BOND_OPT_PRIO, &newval,
175 				     data[IFLA_BOND_SLAVE_PRIO], extack);
176 		if (err)
177 			return err;
178 	}
179 
180 	return 0;
181 }
182 
bond_changelink(struct net_device * bond_dev,struct nlattr * tb[],struct nlattr * data[],struct netlink_ext_ack * extack)183 static int bond_changelink(struct net_device *bond_dev, struct nlattr *tb[],
184 			   struct nlattr *data[],
185 			   struct netlink_ext_ack *extack)
186 {
187 	struct bonding *bond = netdev_priv(bond_dev);
188 	struct bond_opt_value newval;
189 	int miimon = 0;
190 	int err;
191 
192 	if (!data)
193 		return 0;
194 
195 	if (data[IFLA_BOND_MODE]) {
196 		int mode = nla_get_u8(data[IFLA_BOND_MODE]);
197 
198 		bond_opt_initval(&newval, mode);
199 		err = __bond_opt_set(bond, BOND_OPT_MODE, &newval,
200 				     data[IFLA_BOND_MODE], extack);
201 		if (err)
202 			return err;
203 	}
204 	if (data[IFLA_BOND_ACTIVE_SLAVE]) {
205 		int ifindex = nla_get_u32(data[IFLA_BOND_ACTIVE_SLAVE]);
206 		struct net_device *slave_dev;
207 		char *active_slave = "";
208 
209 		if (ifindex != 0) {
210 			slave_dev = __dev_get_by_index(dev_net(bond_dev),
211 						       ifindex);
212 			if (!slave_dev)
213 				return -ENODEV;
214 			active_slave = slave_dev->name;
215 		}
216 		bond_opt_initstr(&newval, active_slave);
217 		err = __bond_opt_set(bond, BOND_OPT_ACTIVE_SLAVE, &newval,
218 				     data[IFLA_BOND_ACTIVE_SLAVE], extack);
219 		if (err)
220 			return err;
221 	}
222 	if (data[IFLA_BOND_MIIMON]) {
223 		miimon = nla_get_u32(data[IFLA_BOND_MIIMON]);
224 
225 		bond_opt_initval(&newval, miimon);
226 		err = __bond_opt_set(bond, BOND_OPT_MIIMON, &newval,
227 				     data[IFLA_BOND_MIIMON], extack);
228 		if (err)
229 			return err;
230 	}
231 	if (data[IFLA_BOND_UPDELAY]) {
232 		int updelay = nla_get_u32(data[IFLA_BOND_UPDELAY]);
233 
234 		bond_opt_initval(&newval, updelay);
235 		err = __bond_opt_set(bond, BOND_OPT_UPDELAY, &newval,
236 				     data[IFLA_BOND_UPDELAY], extack);
237 		if (err)
238 			return err;
239 	}
240 	if (data[IFLA_BOND_DOWNDELAY]) {
241 		int downdelay = nla_get_u32(data[IFLA_BOND_DOWNDELAY]);
242 
243 		bond_opt_initval(&newval, downdelay);
244 		err = __bond_opt_set(bond, BOND_OPT_DOWNDELAY, &newval,
245 				     data[IFLA_BOND_DOWNDELAY], extack);
246 		if (err)
247 			return err;
248 	}
249 	if (data[IFLA_BOND_PEER_NOTIF_DELAY]) {
250 		int delay = nla_get_u32(data[IFLA_BOND_PEER_NOTIF_DELAY]);
251 
252 		bond_opt_initval(&newval, delay);
253 		err = __bond_opt_set(bond, BOND_OPT_PEER_NOTIF_DELAY, &newval,
254 				     data[IFLA_BOND_PEER_NOTIF_DELAY], extack);
255 		if (err)
256 			return err;
257 	}
258 	if (data[IFLA_BOND_USE_CARRIER]) {
259 		int use_carrier = nla_get_u8(data[IFLA_BOND_USE_CARRIER]);
260 
261 		bond_opt_initval(&newval, use_carrier);
262 		err = __bond_opt_set(bond, BOND_OPT_USE_CARRIER, &newval,
263 				     data[IFLA_BOND_USE_CARRIER], extack);
264 		if (err)
265 			return err;
266 	}
267 	if (data[IFLA_BOND_ARP_INTERVAL]) {
268 		int arp_interval = nla_get_u32(data[IFLA_BOND_ARP_INTERVAL]);
269 
270 		if (arp_interval && miimon) {
271 			NL_SET_ERR_MSG_ATTR(extack, data[IFLA_BOND_ARP_INTERVAL],
272 					    "ARP monitoring cannot be used with MII monitoring");
273 			return -EINVAL;
274 		}
275 
276 		bond_opt_initval(&newval, arp_interval);
277 		err = __bond_opt_set(bond, BOND_OPT_ARP_INTERVAL, &newval,
278 				     data[IFLA_BOND_ARP_INTERVAL], extack);
279 		if (err)
280 			return err;
281 	}
282 	if (data[IFLA_BOND_ARP_IP_TARGET]) {
283 		struct nlattr *attr;
284 		int i = 0, rem;
285 
286 		bond_option_arp_ip_targets_clear(bond);
287 		nla_for_each_nested(attr, data[IFLA_BOND_ARP_IP_TARGET], rem) {
288 			__be32 target;
289 
290 			if (nla_len(attr) < sizeof(target))
291 				return -EINVAL;
292 
293 			target = nla_get_be32(attr);
294 
295 			bond_opt_initval(&newval, (__force u64)target);
296 			err = __bond_opt_set(bond, BOND_OPT_ARP_TARGETS,
297 					     &newval,
298 					     data[IFLA_BOND_ARP_IP_TARGET],
299 					     extack);
300 			if (err)
301 				break;
302 			i++;
303 		}
304 		if (i == 0 && bond->params.arp_interval)
305 			netdev_warn(bond->dev, "Removing last arp target with arp_interval on\n");
306 		if (err)
307 			return err;
308 	}
309 #if IS_ENABLED(CONFIG_IPV6)
310 	if (data[IFLA_BOND_NS_IP6_TARGET]) {
311 		struct nlattr *attr;
312 		int i = 0, rem;
313 
314 		bond_option_ns_ip6_targets_clear(bond);
315 		nla_for_each_nested(attr, data[IFLA_BOND_NS_IP6_TARGET], rem) {
316 			struct in6_addr addr6;
317 
318 			if (nla_len(attr) < sizeof(addr6)) {
319 				NL_SET_ERR_MSG(extack, "Invalid IPv6 address");
320 				return -EINVAL;
321 			}
322 
323 			addr6 = nla_get_in6_addr(attr);
324 
325 			bond_opt_initextra(&newval, &addr6, sizeof(addr6));
326 			err = __bond_opt_set(bond, BOND_OPT_NS_TARGETS,
327 					     &newval,
328 					     data[IFLA_BOND_NS_IP6_TARGET],
329 					     extack);
330 			if (err)
331 				break;
332 			i++;
333 		}
334 		if (i == 0 && bond->params.arp_interval)
335 			netdev_warn(bond->dev, "Removing last ns target with arp_interval on\n");
336 		if (err)
337 			return err;
338 	}
339 #endif
340 	if (data[IFLA_BOND_ARP_VALIDATE]) {
341 		int arp_validate = nla_get_u32(data[IFLA_BOND_ARP_VALIDATE]);
342 
343 		if (arp_validate && miimon) {
344 			NL_SET_ERR_MSG_ATTR(extack, data[IFLA_BOND_ARP_INTERVAL],
345 					    "ARP validating cannot be used with MII monitoring");
346 			return -EINVAL;
347 		}
348 
349 		bond_opt_initval(&newval, arp_validate);
350 		err = __bond_opt_set(bond, BOND_OPT_ARP_VALIDATE, &newval,
351 				     data[IFLA_BOND_ARP_VALIDATE], extack);
352 		if (err)
353 			return err;
354 	}
355 	if (data[IFLA_BOND_ARP_ALL_TARGETS]) {
356 		int arp_all_targets =
357 			nla_get_u32(data[IFLA_BOND_ARP_ALL_TARGETS]);
358 
359 		bond_opt_initval(&newval, arp_all_targets);
360 		err = __bond_opt_set(bond, BOND_OPT_ARP_ALL_TARGETS, &newval,
361 				     data[IFLA_BOND_ARP_ALL_TARGETS], extack);
362 		if (err)
363 			return err;
364 	}
365 	if (data[IFLA_BOND_PRIMARY]) {
366 		int ifindex = nla_get_u32(data[IFLA_BOND_PRIMARY]);
367 		struct net_device *dev;
368 		char *primary = "";
369 
370 		dev = __dev_get_by_index(dev_net(bond_dev), ifindex);
371 		if (dev)
372 			primary = dev->name;
373 
374 		bond_opt_initstr(&newval, primary);
375 		err = __bond_opt_set(bond, BOND_OPT_PRIMARY, &newval,
376 				     data[IFLA_BOND_PRIMARY], extack);
377 		if (err)
378 			return err;
379 	}
380 	if (data[IFLA_BOND_PRIMARY_RESELECT]) {
381 		int primary_reselect =
382 			nla_get_u8(data[IFLA_BOND_PRIMARY_RESELECT]);
383 
384 		bond_opt_initval(&newval, primary_reselect);
385 		err = __bond_opt_set(bond, BOND_OPT_PRIMARY_RESELECT, &newval,
386 				     data[IFLA_BOND_PRIMARY_RESELECT], extack);
387 		if (err)
388 			return err;
389 	}
390 	if (data[IFLA_BOND_FAIL_OVER_MAC]) {
391 		int fail_over_mac =
392 			nla_get_u8(data[IFLA_BOND_FAIL_OVER_MAC]);
393 
394 		bond_opt_initval(&newval, fail_over_mac);
395 		err = __bond_opt_set(bond, BOND_OPT_FAIL_OVER_MAC, &newval,
396 				     data[IFLA_BOND_FAIL_OVER_MAC], extack);
397 		if (err)
398 			return err;
399 	}
400 	if (data[IFLA_BOND_XMIT_HASH_POLICY]) {
401 		int xmit_hash_policy =
402 			nla_get_u8(data[IFLA_BOND_XMIT_HASH_POLICY]);
403 
404 		bond_opt_initval(&newval, xmit_hash_policy);
405 		err = __bond_opt_set(bond, BOND_OPT_XMIT_HASH, &newval,
406 				     data[IFLA_BOND_XMIT_HASH_POLICY], extack);
407 		if (err)
408 			return err;
409 	}
410 	if (data[IFLA_BOND_RESEND_IGMP]) {
411 		int resend_igmp =
412 			nla_get_u32(data[IFLA_BOND_RESEND_IGMP]);
413 
414 		bond_opt_initval(&newval, resend_igmp);
415 		err = __bond_opt_set(bond, BOND_OPT_RESEND_IGMP, &newval,
416 				     data[IFLA_BOND_RESEND_IGMP], extack);
417 		if (err)
418 			return err;
419 	}
420 	if (data[IFLA_BOND_NUM_PEER_NOTIF]) {
421 		int num_peer_notif =
422 			nla_get_u8(data[IFLA_BOND_NUM_PEER_NOTIF]);
423 
424 		bond_opt_initval(&newval, num_peer_notif);
425 		err = __bond_opt_set(bond, BOND_OPT_NUM_PEER_NOTIF, &newval,
426 				     data[IFLA_BOND_NUM_PEER_NOTIF], extack);
427 		if (err)
428 			return err;
429 	}
430 	if (data[IFLA_BOND_ALL_SLAVES_ACTIVE]) {
431 		int all_slaves_active =
432 			nla_get_u8(data[IFLA_BOND_ALL_SLAVES_ACTIVE]);
433 
434 		bond_opt_initval(&newval, all_slaves_active);
435 		err = __bond_opt_set(bond, BOND_OPT_ALL_SLAVES_ACTIVE, &newval,
436 				     data[IFLA_BOND_ALL_SLAVES_ACTIVE], extack);
437 		if (err)
438 			return err;
439 	}
440 	if (data[IFLA_BOND_MIN_LINKS]) {
441 		int min_links =
442 			nla_get_u32(data[IFLA_BOND_MIN_LINKS]);
443 
444 		bond_opt_initval(&newval, min_links);
445 		err = __bond_opt_set(bond, BOND_OPT_MINLINKS, &newval,
446 				     data[IFLA_BOND_MIN_LINKS], extack);
447 		if (err)
448 			return err;
449 	}
450 	if (data[IFLA_BOND_LP_INTERVAL]) {
451 		int lp_interval =
452 			nla_get_u32(data[IFLA_BOND_LP_INTERVAL]);
453 
454 		bond_opt_initval(&newval, lp_interval);
455 		err = __bond_opt_set(bond, BOND_OPT_LP_INTERVAL, &newval,
456 				     data[IFLA_BOND_LP_INTERVAL], extack);
457 		if (err)
458 			return err;
459 	}
460 	if (data[IFLA_BOND_PACKETS_PER_SLAVE]) {
461 		int packets_per_slave =
462 			nla_get_u32(data[IFLA_BOND_PACKETS_PER_SLAVE]);
463 
464 		bond_opt_initval(&newval, packets_per_slave);
465 		err = __bond_opt_set(bond, BOND_OPT_PACKETS_PER_SLAVE, &newval,
466 				     data[IFLA_BOND_PACKETS_PER_SLAVE], extack);
467 		if (err)
468 			return err;
469 	}
470 
471 	if (data[IFLA_BOND_AD_LACP_ACTIVE]) {
472 		int lacp_active = nla_get_u8(data[IFLA_BOND_AD_LACP_ACTIVE]);
473 
474 		bond_opt_initval(&newval, lacp_active);
475 		err = __bond_opt_set(bond, BOND_OPT_LACP_ACTIVE, &newval,
476 				     data[IFLA_BOND_AD_LACP_ACTIVE], extack);
477 		if (err)
478 			return err;
479 	}
480 
481 	if (data[IFLA_BOND_AD_LACP_RATE]) {
482 		int lacp_rate =
483 			nla_get_u8(data[IFLA_BOND_AD_LACP_RATE]);
484 
485 		bond_opt_initval(&newval, lacp_rate);
486 		err = __bond_opt_set(bond, BOND_OPT_LACP_RATE, &newval,
487 				     data[IFLA_BOND_AD_LACP_RATE], extack);
488 		if (err)
489 			return err;
490 	}
491 	if (data[IFLA_BOND_AD_SELECT]) {
492 		int ad_select =
493 			nla_get_u8(data[IFLA_BOND_AD_SELECT]);
494 
495 		bond_opt_initval(&newval, ad_select);
496 		err = __bond_opt_set(bond, BOND_OPT_AD_SELECT, &newval,
497 				     data[IFLA_BOND_AD_SELECT], extack);
498 		if (err)
499 			return err;
500 	}
501 	if (data[IFLA_BOND_AD_ACTOR_SYS_PRIO]) {
502 		int actor_sys_prio =
503 			nla_get_u16(data[IFLA_BOND_AD_ACTOR_SYS_PRIO]);
504 
505 		bond_opt_initval(&newval, actor_sys_prio);
506 		err = __bond_opt_set(bond, BOND_OPT_AD_ACTOR_SYS_PRIO, &newval,
507 				     data[IFLA_BOND_AD_ACTOR_SYS_PRIO], extack);
508 		if (err)
509 			return err;
510 	}
511 	if (data[IFLA_BOND_AD_USER_PORT_KEY]) {
512 		int port_key =
513 			nla_get_u16(data[IFLA_BOND_AD_USER_PORT_KEY]);
514 
515 		bond_opt_initval(&newval, port_key);
516 		err = __bond_opt_set(bond, BOND_OPT_AD_USER_PORT_KEY, &newval,
517 				     data[IFLA_BOND_AD_USER_PORT_KEY], extack);
518 		if (err)
519 			return err;
520 	}
521 	if (data[IFLA_BOND_AD_ACTOR_SYSTEM]) {
522 		if (nla_len(data[IFLA_BOND_AD_ACTOR_SYSTEM]) != ETH_ALEN)
523 			return -EINVAL;
524 
525 		bond_opt_initval(&newval,
526 				 nla_get_u64(data[IFLA_BOND_AD_ACTOR_SYSTEM]));
527 		err = __bond_opt_set(bond, BOND_OPT_AD_ACTOR_SYSTEM, &newval,
528 				     data[IFLA_BOND_AD_ACTOR_SYSTEM], extack);
529 		if (err)
530 			return err;
531 	}
532 	if (data[IFLA_BOND_TLB_DYNAMIC_LB]) {
533 		int dynamic_lb = nla_get_u8(data[IFLA_BOND_TLB_DYNAMIC_LB]);
534 
535 		bond_opt_initval(&newval, dynamic_lb);
536 		err = __bond_opt_set(bond, BOND_OPT_TLB_DYNAMIC_LB, &newval,
537 				     data[IFLA_BOND_TLB_DYNAMIC_LB], extack);
538 		if (err)
539 			return err;
540 	}
541 
542 	if (data[IFLA_BOND_MISSED_MAX]) {
543 		int missed_max = nla_get_u8(data[IFLA_BOND_MISSED_MAX]);
544 
545 		bond_opt_initval(&newval, missed_max);
546 		err = __bond_opt_set(bond, BOND_OPT_MISSED_MAX, &newval,
547 				     data[IFLA_BOND_MISSED_MAX], extack);
548 		if (err)
549 			return err;
550 	}
551 
552 	return 0;
553 }
554 
bond_newlink(struct net * src_net,struct net_device * bond_dev,struct nlattr * tb[],struct nlattr * data[],struct netlink_ext_ack * extack)555 static int bond_newlink(struct net *src_net, struct net_device *bond_dev,
556 			struct nlattr *tb[], struct nlattr *data[],
557 			struct netlink_ext_ack *extack)
558 {
559 	int err;
560 
561 	err = bond_changelink(bond_dev, tb, data, extack);
562 	if (err < 0)
563 		return err;
564 
565 	err = register_netdevice(bond_dev);
566 	if (!err) {
567 		struct bonding *bond = netdev_priv(bond_dev);
568 
569 		netif_carrier_off(bond_dev);
570 		bond_work_init_all(bond);
571 	}
572 
573 	return err;
574 }
575 
bond_get_size(const struct net_device * bond_dev)576 static size_t bond_get_size(const struct net_device *bond_dev)
577 {
578 	return nla_total_size(sizeof(u8)) +	/* IFLA_BOND_MODE */
579 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_ACTIVE_SLAVE */
580 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_MIIMON */
581 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_UPDELAY */
582 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_DOWNDELAY */
583 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_USE_CARRIER */
584 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_ARP_INTERVAL */
585 						/* IFLA_BOND_ARP_IP_TARGET */
586 		nla_total_size(sizeof(struct nlattr)) +
587 		nla_total_size(sizeof(u32)) * BOND_MAX_ARP_TARGETS +
588 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_ARP_VALIDATE */
589 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_ARP_ALL_TARGETS */
590 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_PRIMARY */
591 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_PRIMARY_RESELECT */
592 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_FAIL_OVER_MAC */
593 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_XMIT_HASH_POLICY */
594 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_RESEND_IGMP */
595 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_NUM_PEER_NOTIF */
596 		nla_total_size(sizeof(u8)) +   /* IFLA_BOND_ALL_SLAVES_ACTIVE */
597 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_MIN_LINKS */
598 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_LP_INTERVAL */
599 		nla_total_size(sizeof(u32)) +  /* IFLA_BOND_PACKETS_PER_SLAVE */
600 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_AD_LACP_ACTIVE */
601 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_AD_LACP_RATE */
602 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_AD_SELECT */
603 		nla_total_size(sizeof(struct nlattr)) + /* IFLA_BOND_AD_INFO */
604 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_INFO_AGGREGATOR */
605 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_INFO_NUM_PORTS */
606 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_INFO_ACTOR_KEY */
607 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_INFO_PARTNER_KEY*/
608 		nla_total_size(ETH_ALEN) +    /* IFLA_BOND_AD_INFO_PARTNER_MAC*/
609 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_ACTOR_SYS_PRIO */
610 		nla_total_size(sizeof(u16)) + /* IFLA_BOND_AD_USER_PORT_KEY */
611 		nla_total_size(ETH_ALEN) + /* IFLA_BOND_AD_ACTOR_SYSTEM */
612 		nla_total_size(sizeof(u8)) + /* IFLA_BOND_TLB_DYNAMIC_LB */
613 		nla_total_size(sizeof(u32)) +	/* IFLA_BOND_PEER_NOTIF_DELAY */
614 		nla_total_size(sizeof(u8)) +	/* IFLA_BOND_MISSED_MAX */
615 						/* IFLA_BOND_NS_IP6_TARGET */
616 		nla_total_size(sizeof(struct nlattr)) +
617 		nla_total_size(sizeof(struct in6_addr)) * BOND_MAX_NS_TARGETS +
618 		0;
619 }
620 
bond_option_active_slave_get_ifindex(struct bonding * bond)621 static int bond_option_active_slave_get_ifindex(struct bonding *bond)
622 {
623 	const struct net_device *slave;
624 	int ifindex;
625 
626 	rcu_read_lock();
627 	slave = bond_option_active_slave_get_rcu(bond);
628 	ifindex = slave ? slave->ifindex : 0;
629 	rcu_read_unlock();
630 	return ifindex;
631 }
632 
bond_fill_info(struct sk_buff * skb,const struct net_device * bond_dev)633 static int bond_fill_info(struct sk_buff *skb,
634 			  const struct net_device *bond_dev)
635 {
636 	struct bonding *bond = netdev_priv(bond_dev);
637 	unsigned int packets_per_slave;
638 	int ifindex, i, targets_added;
639 	struct nlattr *targets;
640 	struct slave *primary;
641 
642 	if (nla_put_u8(skb, IFLA_BOND_MODE, BOND_MODE(bond)))
643 		goto nla_put_failure;
644 
645 	ifindex = bond_option_active_slave_get_ifindex(bond);
646 	if (ifindex && nla_put_u32(skb, IFLA_BOND_ACTIVE_SLAVE, ifindex))
647 		goto nla_put_failure;
648 
649 	if (nla_put_u32(skb, IFLA_BOND_MIIMON, bond->params.miimon))
650 		goto nla_put_failure;
651 
652 	if (nla_put_u32(skb, IFLA_BOND_UPDELAY,
653 			bond->params.updelay * bond->params.miimon))
654 		goto nla_put_failure;
655 
656 	if (nla_put_u32(skb, IFLA_BOND_DOWNDELAY,
657 			bond->params.downdelay * bond->params.miimon))
658 		goto nla_put_failure;
659 
660 	if (nla_put_u32(skb, IFLA_BOND_PEER_NOTIF_DELAY,
661 			bond->params.peer_notif_delay * bond->params.miimon))
662 		goto nla_put_failure;
663 
664 	if (nla_put_u8(skb, IFLA_BOND_USE_CARRIER, bond->params.use_carrier))
665 		goto nla_put_failure;
666 
667 	if (nla_put_u32(skb, IFLA_BOND_ARP_INTERVAL, bond->params.arp_interval))
668 		goto nla_put_failure;
669 
670 	targets = nla_nest_start_noflag(skb, IFLA_BOND_ARP_IP_TARGET);
671 	if (!targets)
672 		goto nla_put_failure;
673 
674 	targets_added = 0;
675 	for (i = 0; i < BOND_MAX_ARP_TARGETS; i++) {
676 		if (bond->params.arp_targets[i]) {
677 			if (nla_put_be32(skb, i, bond->params.arp_targets[i]))
678 				goto nla_put_failure;
679 			targets_added = 1;
680 		}
681 	}
682 
683 	if (targets_added)
684 		nla_nest_end(skb, targets);
685 	else
686 		nla_nest_cancel(skb, targets);
687 
688 	if (nla_put_u32(skb, IFLA_BOND_ARP_VALIDATE, bond->params.arp_validate))
689 		goto nla_put_failure;
690 
691 	if (nla_put_u32(skb, IFLA_BOND_ARP_ALL_TARGETS,
692 			bond->params.arp_all_targets))
693 		goto nla_put_failure;
694 
695 #if IS_ENABLED(CONFIG_IPV6)
696 	targets = nla_nest_start(skb, IFLA_BOND_NS_IP6_TARGET);
697 	if (!targets)
698 		goto nla_put_failure;
699 
700 	targets_added = 0;
701 	for (i = 0; i < BOND_MAX_NS_TARGETS; i++) {
702 		if (!ipv6_addr_any(&bond->params.ns_targets[i])) {
703 			if (nla_put_in6_addr(skb, i, &bond->params.ns_targets[i]))
704 				goto nla_put_failure;
705 			targets_added = 1;
706 		}
707 	}
708 
709 	if (targets_added)
710 		nla_nest_end(skb, targets);
711 	else
712 		nla_nest_cancel(skb, targets);
713 #endif
714 
715 	primary = rtnl_dereference(bond->primary_slave);
716 	if (primary &&
717 	    nla_put_u32(skb, IFLA_BOND_PRIMARY, primary->dev->ifindex))
718 		goto nla_put_failure;
719 
720 	if (nla_put_u8(skb, IFLA_BOND_PRIMARY_RESELECT,
721 		       bond->params.primary_reselect))
722 		goto nla_put_failure;
723 
724 	if (nla_put_u8(skb, IFLA_BOND_FAIL_OVER_MAC,
725 		       bond->params.fail_over_mac))
726 		goto nla_put_failure;
727 
728 	if (nla_put_u8(skb, IFLA_BOND_XMIT_HASH_POLICY,
729 		       bond->params.xmit_policy))
730 		goto nla_put_failure;
731 
732 	if (nla_put_u32(skb, IFLA_BOND_RESEND_IGMP,
733 			bond->params.resend_igmp))
734 		goto nla_put_failure;
735 
736 	if (nla_put_u8(skb, IFLA_BOND_NUM_PEER_NOTIF,
737 		       bond->params.num_peer_notif))
738 		goto nla_put_failure;
739 
740 	if (nla_put_u8(skb, IFLA_BOND_ALL_SLAVES_ACTIVE,
741 		       bond->params.all_slaves_active))
742 		goto nla_put_failure;
743 
744 	if (nla_put_u32(skb, IFLA_BOND_MIN_LINKS,
745 			bond->params.min_links))
746 		goto nla_put_failure;
747 
748 	if (nla_put_u32(skb, IFLA_BOND_LP_INTERVAL,
749 			bond->params.lp_interval))
750 		goto nla_put_failure;
751 
752 	packets_per_slave = bond->params.packets_per_slave;
753 	if (nla_put_u32(skb, IFLA_BOND_PACKETS_PER_SLAVE,
754 			packets_per_slave))
755 		goto nla_put_failure;
756 
757 	if (nla_put_u8(skb, IFLA_BOND_AD_LACP_ACTIVE,
758 		       bond->params.lacp_active))
759 		goto nla_put_failure;
760 
761 	if (nla_put_u8(skb, IFLA_BOND_AD_LACP_RATE,
762 		       bond->params.lacp_fast))
763 		goto nla_put_failure;
764 
765 	if (nla_put_u8(skb, IFLA_BOND_AD_SELECT,
766 		       bond->params.ad_select))
767 		goto nla_put_failure;
768 
769 	if (nla_put_u8(skb, IFLA_BOND_TLB_DYNAMIC_LB,
770 		       bond->params.tlb_dynamic_lb))
771 		goto nla_put_failure;
772 
773 	if (nla_put_u8(skb, IFLA_BOND_MISSED_MAX,
774 		       bond->params.missed_max))
775 		goto nla_put_failure;
776 
777 	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
778 		struct ad_info info;
779 
780 		if (capable(CAP_NET_ADMIN)) {
781 			if (nla_put_u16(skb, IFLA_BOND_AD_ACTOR_SYS_PRIO,
782 					bond->params.ad_actor_sys_prio))
783 				goto nla_put_failure;
784 
785 			if (nla_put_u16(skb, IFLA_BOND_AD_USER_PORT_KEY,
786 					bond->params.ad_user_port_key))
787 				goto nla_put_failure;
788 
789 			if (nla_put(skb, IFLA_BOND_AD_ACTOR_SYSTEM,
790 				    ETH_ALEN, &bond->params.ad_actor_system))
791 				goto nla_put_failure;
792 		}
793 		if (!bond_3ad_get_active_agg_info(bond, &info)) {
794 			struct nlattr *nest;
795 
796 			nest = nla_nest_start_noflag(skb, IFLA_BOND_AD_INFO);
797 			if (!nest)
798 				goto nla_put_failure;
799 
800 			if (nla_put_u16(skb, IFLA_BOND_AD_INFO_AGGREGATOR,
801 					info.aggregator_id))
802 				goto nla_put_failure;
803 			if (nla_put_u16(skb, IFLA_BOND_AD_INFO_NUM_PORTS,
804 					info.ports))
805 				goto nla_put_failure;
806 			if (nla_put_u16(skb, IFLA_BOND_AD_INFO_ACTOR_KEY,
807 					info.actor_key))
808 				goto nla_put_failure;
809 			if (nla_put_u16(skb, IFLA_BOND_AD_INFO_PARTNER_KEY,
810 					info.partner_key))
811 				goto nla_put_failure;
812 			if (nla_put(skb, IFLA_BOND_AD_INFO_PARTNER_MAC,
813 				    sizeof(info.partner_system),
814 				    &info.partner_system))
815 				goto nla_put_failure;
816 
817 			nla_nest_end(skb, nest);
818 		}
819 	}
820 
821 	return 0;
822 
823 nla_put_failure:
824 	return -EMSGSIZE;
825 }
826 
bond_get_linkxstats_size(const struct net_device * dev,int attr)827 static size_t bond_get_linkxstats_size(const struct net_device *dev, int attr)
828 {
829 	switch (attr) {
830 	case IFLA_STATS_LINK_XSTATS:
831 	case IFLA_STATS_LINK_XSTATS_SLAVE:
832 		break;
833 	default:
834 		return 0;
835 	}
836 
837 	return bond_3ad_stats_size() + nla_total_size(0);
838 }
839 
bond_fill_linkxstats(struct sk_buff * skb,const struct net_device * dev,int * prividx,int attr)840 static int bond_fill_linkxstats(struct sk_buff *skb,
841 				const struct net_device *dev,
842 				int *prividx, int attr)
843 {
844 	struct nlattr *nla __maybe_unused;
845 	struct slave *slave = NULL;
846 	struct nlattr *nest, *nest2;
847 	struct bonding *bond;
848 
849 	switch (attr) {
850 	case IFLA_STATS_LINK_XSTATS:
851 		bond = netdev_priv(dev);
852 		break;
853 	case IFLA_STATS_LINK_XSTATS_SLAVE:
854 		slave = bond_slave_get_rtnl(dev);
855 		if (!slave)
856 			return 0;
857 		bond = slave->bond;
858 		break;
859 	default:
860 		return -EINVAL;
861 	}
862 
863 	nest = nla_nest_start_noflag(skb, LINK_XSTATS_TYPE_BOND);
864 	if (!nest)
865 		return -EMSGSIZE;
866 	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
867 		struct bond_3ad_stats *stats;
868 
869 		if (slave)
870 			stats = &SLAVE_AD_INFO(slave)->stats;
871 		else
872 			stats = &BOND_AD_INFO(bond).stats;
873 
874 		nest2 = nla_nest_start_noflag(skb, BOND_XSTATS_3AD);
875 		if (!nest2) {
876 			nla_nest_end(skb, nest);
877 			return -EMSGSIZE;
878 		}
879 
880 		if (bond_3ad_stats_fill(skb, stats)) {
881 			nla_nest_cancel(skb, nest2);
882 			nla_nest_end(skb, nest);
883 			return -EMSGSIZE;
884 		}
885 		nla_nest_end(skb, nest2);
886 	}
887 	nla_nest_end(skb, nest);
888 
889 	return 0;
890 }
891 
892 struct rtnl_link_ops bond_link_ops __read_mostly = {
893 	.kind			= "bond",
894 	.priv_size		= sizeof(struct bonding),
895 	.setup			= bond_setup,
896 	.maxtype		= IFLA_BOND_MAX,
897 	.policy			= bond_policy,
898 	.validate		= bond_validate,
899 	.newlink		= bond_newlink,
900 	.changelink		= bond_changelink,
901 	.get_size		= bond_get_size,
902 	.fill_info		= bond_fill_info,
903 	.get_num_tx_queues	= bond_get_num_tx_queues,
904 	.get_num_rx_queues	= bond_get_num_tx_queues, /* Use the same number
905 							     as for TX queues */
906 	.fill_linkxstats        = bond_fill_linkxstats,
907 	.get_linkxstats_size    = bond_get_linkxstats_size,
908 	.slave_maxtype		= IFLA_BOND_SLAVE_MAX,
909 	.slave_policy		= bond_slave_policy,
910 	.slave_changelink	= bond_slave_changelink,
911 	.get_slave_size		= bond_get_slave_size,
912 	.fill_slave_info	= bond_fill_slave_info,
913 };
914 
bond_netlink_init(void)915 int __init bond_netlink_init(void)
916 {
917 	return rtnl_link_register(&bond_link_ops);
918 }
919 
bond_netlink_fini(void)920 void bond_netlink_fini(void)
921 {
922 	rtnl_link_unregister(&bond_link_ops);
923 }
924 
925 MODULE_ALIAS_RTNL_LINK("bond");
926