Loading...
1/*
2 * originally based on the dummy device.
3 *
4 * Copyright 1999, Thomas Davis, tadavis@lbl.gov.
5 * Licensed under the GPL. Based on dummy.c, and eql.c devices.
6 *
7 * bonding.c: an Ethernet Bonding driver
8 *
9 * This is useful to talk to a Cisco EtherChannel compatible equipment:
10 * Cisco 5500
11 * Sun Trunking (Solaris)
12 * Alteon AceDirector Trunks
13 * Linux Bonding
14 * and probably many L2 switches ...
15 *
16 * How it works:
17 * ifconfig bond0 ipaddress netmask up
18 * will setup a network device, with an ip address. No mac address
19 * will be assigned at this time. The hw mac address will come from
20 * the first slave bonded to the channel. All slaves will then use
21 * this hw mac address.
22 *
23 * ifconfig bond0 down
24 * will release all slaves, marking them as down.
25 *
26 * ifenslave bond0 eth0
27 * will attach eth0 to bond0 as a slave. eth0 hw mac address will either
28 * a: be used as initial mac address
29 * b: if a hw mac address already is there, eth0's hw mac address
30 * will then be set from bond0.
31 *
32 */
33
34#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
35
36#include <linux/kernel.h>
37#include <linux/module.h>
38#include <linux/types.h>
39#include <linux/fcntl.h>
40#include <linux/interrupt.h>
41#include <linux/ptrace.h>
42#include <linux/ioport.h>
43#include <linux/in.h>
44#include <net/ip.h>
45#include <linux/ip.h>
46#include <linux/tcp.h>
47#include <linux/udp.h>
48#include <linux/slab.h>
49#include <linux/string.h>
50#include <linux/init.h>
51#include <linux/timer.h>
52#include <linux/socket.h>
53#include <linux/ctype.h>
54#include <linux/inet.h>
55#include <linux/bitops.h>
56#include <linux/io.h>
57#include <asm/system.h>
58#include <asm/dma.h>
59#include <linux/uaccess.h>
60#include <linux/errno.h>
61#include <linux/netdevice.h>
62#include <linux/inetdevice.h>
63#include <linux/igmp.h>
64#include <linux/etherdevice.h>
65#include <linux/skbuff.h>
66#include <net/sock.h>
67#include <linux/rtnetlink.h>
68#include <linux/smp.h>
69#include <linux/if_ether.h>
70#include <net/arp.h>
71#include <linux/mii.h>
72#include <linux/ethtool.h>
73#include <linux/if_vlan.h>
74#include <linux/if_bonding.h>
75#include <linux/jiffies.h>
76#include <linux/preempt.h>
77#include <net/route.h>
78#include <net/net_namespace.h>
79#include <net/netns/generic.h>
80#include "bonding.h"
81#include "bond_3ad.h"
82#include "bond_alb.h"
83
84/*---------------------------- Module parameters ----------------------------*/
85
86/* monitor all links that often (in milliseconds). <=0 disables monitoring */
87#define BOND_LINK_MON_INTERV 0
88#define BOND_LINK_ARP_INTERV 0
89
90static int max_bonds = BOND_DEFAULT_MAX_BONDS;
91static int tx_queues = BOND_DEFAULT_TX_QUEUES;
92static int num_peer_notif = 1;
93static int miimon = BOND_LINK_MON_INTERV;
94static int updelay;
95static int downdelay;
96static int use_carrier = 1;
97static char *mode;
98static char *primary;
99static char *primary_reselect;
100static char *lacp_rate;
101static int min_links;
102static char *ad_select;
103static char *xmit_hash_policy;
104static int arp_interval = BOND_LINK_ARP_INTERV;
105static char *arp_ip_target[BOND_MAX_ARP_TARGETS];
106static char *arp_validate;
107static char *fail_over_mac;
108static int all_slaves_active = 0;
109static struct bond_params bonding_defaults;
110static int resend_igmp = BOND_DEFAULT_RESEND_IGMP;
111
112module_param(max_bonds, int, 0);
113MODULE_PARM_DESC(max_bonds, "Max number of bonded devices");
114module_param(tx_queues, int, 0);
115MODULE_PARM_DESC(tx_queues, "Max number of transmit queues (default = 16)");
116module_param_named(num_grat_arp, num_peer_notif, int, 0644);
117MODULE_PARM_DESC(num_grat_arp, "Number of peer notifications to send on "
118 "failover event (alias of num_unsol_na)");
119module_param_named(num_unsol_na, num_peer_notif, int, 0644);
120MODULE_PARM_DESC(num_unsol_na, "Number of peer notifications to send on "
121 "failover event (alias of num_grat_arp)");
122module_param(miimon, int, 0);
123MODULE_PARM_DESC(miimon, "Link check interval in milliseconds");
124module_param(updelay, int, 0);
125MODULE_PARM_DESC(updelay, "Delay before considering link up, in milliseconds");
126module_param(downdelay, int, 0);
127MODULE_PARM_DESC(downdelay, "Delay before considering link down, "
128 "in milliseconds");
129module_param(use_carrier, int, 0);
130MODULE_PARM_DESC(use_carrier, "Use netif_carrier_ok (vs MII ioctls) in miimon; "
131 "0 for off, 1 for on (default)");
132module_param(mode, charp, 0);
133MODULE_PARM_DESC(mode, "Mode of operation; 0 for balance-rr, "
134 "1 for active-backup, 2 for balance-xor, "
135 "3 for broadcast, 4 for 802.3ad, 5 for balance-tlb, "
136 "6 for balance-alb");
137module_param(primary, charp, 0);
138MODULE_PARM_DESC(primary, "Primary network device to use");
139module_param(primary_reselect, charp, 0);
140MODULE_PARM_DESC(primary_reselect, "Reselect primary slave "
141 "once it comes up; "
142 "0 for always (default), "
143 "1 for only if speed of primary is "
144 "better, "
145 "2 for only on active slave "
146 "failure");
147module_param(lacp_rate, charp, 0);
148MODULE_PARM_DESC(lacp_rate, "LACPDU tx rate to request from 802.3ad partner; "
149 "0 for slow, 1 for fast");
150module_param(ad_select, charp, 0);
151MODULE_PARM_DESC(ad_select, "803.ad aggregation selection logic; "
152 "0 for stable (default), 1 for bandwidth, "
153 "2 for count");
154module_param(min_links, int, 0);
155MODULE_PARM_DESC(min_links, "Minimum number of available links before turning on carrier");
156
157module_param(xmit_hash_policy, charp, 0);
158MODULE_PARM_DESC(xmit_hash_policy, "balance-xor and 802.3ad hashing method; "
159 "0 for layer 2 (default), 1 for layer 3+4, "
160 "2 for layer 2+3");
161module_param(arp_interval, int, 0);
162MODULE_PARM_DESC(arp_interval, "arp interval in milliseconds");
163module_param_array(arp_ip_target, charp, NULL, 0);
164MODULE_PARM_DESC(arp_ip_target, "arp targets in n.n.n.n form");
165module_param(arp_validate, charp, 0);
166MODULE_PARM_DESC(arp_validate, "validate src/dst of ARP probes; "
167 "0 for none (default), 1 for active, "
168 "2 for backup, 3 for all");
169module_param(fail_over_mac, charp, 0);
170MODULE_PARM_DESC(fail_over_mac, "For active-backup, do not set all slaves to "
171 "the same MAC; 0 for none (default), "
172 "1 for active, 2 for follow");
173module_param(all_slaves_active, int, 0);
174MODULE_PARM_DESC(all_slaves_active, "Keep all frames received on an interface"
175 "by setting active flag for all slaves; "
176 "0 for never (default), 1 for always.");
177module_param(resend_igmp, int, 0);
178MODULE_PARM_DESC(resend_igmp, "Number of IGMP membership reports to send on "
179 "link failure");
180
181/*----------------------------- Global variables ----------------------------*/
182
183#ifdef CONFIG_NET_POLL_CONTROLLER
184atomic_t netpoll_block_tx = ATOMIC_INIT(0);
185#endif
186
187int bond_net_id __read_mostly;
188
189static __be32 arp_target[BOND_MAX_ARP_TARGETS];
190static int arp_ip_count;
191static int bond_mode = BOND_MODE_ROUNDROBIN;
192static int xmit_hashtype = BOND_XMIT_POLICY_LAYER2;
193static int lacp_fast;
194
195const struct bond_parm_tbl bond_lacp_tbl[] = {
196{ "slow", AD_LACP_SLOW},
197{ "fast", AD_LACP_FAST},
198{ NULL, -1},
199};
200
201const struct bond_parm_tbl bond_mode_tbl[] = {
202{ "balance-rr", BOND_MODE_ROUNDROBIN},
203{ "active-backup", BOND_MODE_ACTIVEBACKUP},
204{ "balance-xor", BOND_MODE_XOR},
205{ "broadcast", BOND_MODE_BROADCAST},
206{ "802.3ad", BOND_MODE_8023AD},
207{ "balance-tlb", BOND_MODE_TLB},
208{ "balance-alb", BOND_MODE_ALB},
209{ NULL, -1},
210};
211
212const struct bond_parm_tbl xmit_hashtype_tbl[] = {
213{ "layer2", BOND_XMIT_POLICY_LAYER2},
214{ "layer3+4", BOND_XMIT_POLICY_LAYER34},
215{ "layer2+3", BOND_XMIT_POLICY_LAYER23},
216{ NULL, -1},
217};
218
219const struct bond_parm_tbl arp_validate_tbl[] = {
220{ "none", BOND_ARP_VALIDATE_NONE},
221{ "active", BOND_ARP_VALIDATE_ACTIVE},
222{ "backup", BOND_ARP_VALIDATE_BACKUP},
223{ "all", BOND_ARP_VALIDATE_ALL},
224{ NULL, -1},
225};
226
227const struct bond_parm_tbl fail_over_mac_tbl[] = {
228{ "none", BOND_FOM_NONE},
229{ "active", BOND_FOM_ACTIVE},
230{ "follow", BOND_FOM_FOLLOW},
231{ NULL, -1},
232};
233
234const struct bond_parm_tbl pri_reselect_tbl[] = {
235{ "always", BOND_PRI_RESELECT_ALWAYS},
236{ "better", BOND_PRI_RESELECT_BETTER},
237{ "failure", BOND_PRI_RESELECT_FAILURE},
238{ NULL, -1},
239};
240
241struct bond_parm_tbl ad_select_tbl[] = {
242{ "stable", BOND_AD_STABLE},
243{ "bandwidth", BOND_AD_BANDWIDTH},
244{ "count", BOND_AD_COUNT},
245{ NULL, -1},
246};
247
248/*-------------------------- Forward declarations ---------------------------*/
249
250static int bond_init(struct net_device *bond_dev);
251static void bond_uninit(struct net_device *bond_dev);
252
253/*---------------------------- General routines -----------------------------*/
254
255const char *bond_mode_name(int mode)
256{
257 static const char *names[] = {
258 [BOND_MODE_ROUNDROBIN] = "load balancing (round-robin)",
259 [BOND_MODE_ACTIVEBACKUP] = "fault-tolerance (active-backup)",
260 [BOND_MODE_XOR] = "load balancing (xor)",
261 [BOND_MODE_BROADCAST] = "fault-tolerance (broadcast)",
262 [BOND_MODE_8023AD] = "IEEE 802.3ad Dynamic link aggregation",
263 [BOND_MODE_TLB] = "transmit load balancing",
264 [BOND_MODE_ALB] = "adaptive load balancing",
265 };
266
267 if (mode < 0 || mode > BOND_MODE_ALB)
268 return "unknown";
269
270 return names[mode];
271}
272
273/*---------------------------------- VLAN -----------------------------------*/
274
275/**
276 * bond_add_vlan - add a new vlan id on bond
277 * @bond: bond that got the notification
278 * @vlan_id: the vlan id to add
279 *
280 * Returns -ENOMEM if allocation failed.
281 */
282static int bond_add_vlan(struct bonding *bond, unsigned short vlan_id)
283{
284 struct vlan_entry *vlan;
285
286 pr_debug("bond: %s, vlan id %d\n",
287 (bond ? bond->dev->name : "None"), vlan_id);
288
289 vlan = kzalloc(sizeof(struct vlan_entry), GFP_KERNEL);
290 if (!vlan)
291 return -ENOMEM;
292
293 INIT_LIST_HEAD(&vlan->vlan_list);
294 vlan->vlan_id = vlan_id;
295
296 write_lock_bh(&bond->lock);
297
298 list_add_tail(&vlan->vlan_list, &bond->vlan_list);
299
300 write_unlock_bh(&bond->lock);
301
302 pr_debug("added VLAN ID %d on bond %s\n", vlan_id, bond->dev->name);
303
304 return 0;
305}
306
307/**
308 * bond_del_vlan - delete a vlan id from bond
309 * @bond: bond that got the notification
310 * @vlan_id: the vlan id to delete
311 *
312 * returns -ENODEV if @vlan_id was not found in @bond.
313 */
314static int bond_del_vlan(struct bonding *bond, unsigned short vlan_id)
315{
316 struct vlan_entry *vlan;
317 int res = -ENODEV;
318
319 pr_debug("bond: %s, vlan id %d\n", bond->dev->name, vlan_id);
320
321 block_netpoll_tx();
322 write_lock_bh(&bond->lock);
323
324 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
325 if (vlan->vlan_id == vlan_id) {
326 list_del(&vlan->vlan_list);
327
328 if (bond_is_lb(bond))
329 bond_alb_clear_vlan(bond, vlan_id);
330
331 pr_debug("removed VLAN ID %d from bond %s\n",
332 vlan_id, bond->dev->name);
333
334 kfree(vlan);
335
336 res = 0;
337 goto out;
338 }
339 }
340
341 pr_debug("couldn't find VLAN ID %d in bond %s\n",
342 vlan_id, bond->dev->name);
343
344out:
345 write_unlock_bh(&bond->lock);
346 unblock_netpoll_tx();
347 return res;
348}
349
350/**
351 * bond_next_vlan - safely skip to the next item in the vlans list.
352 * @bond: the bond we're working on
353 * @curr: item we're advancing from
354 *
355 * Returns %NULL if list is empty, bond->next_vlan if @curr is %NULL,
356 * or @curr->next otherwise (even if it is @curr itself again).
357 *
358 * Caller must hold bond->lock
359 */
360struct vlan_entry *bond_next_vlan(struct bonding *bond, struct vlan_entry *curr)
361{
362 struct vlan_entry *next, *last;
363
364 if (list_empty(&bond->vlan_list))
365 return NULL;
366
367 if (!curr) {
368 next = list_entry(bond->vlan_list.next,
369 struct vlan_entry, vlan_list);
370 } else {
371 last = list_entry(bond->vlan_list.prev,
372 struct vlan_entry, vlan_list);
373 if (last == curr) {
374 next = list_entry(bond->vlan_list.next,
375 struct vlan_entry, vlan_list);
376 } else {
377 next = list_entry(curr->vlan_list.next,
378 struct vlan_entry, vlan_list);
379 }
380 }
381
382 return next;
383}
384
385#define bond_queue_mapping(skb) (*(u16 *)((skb)->cb))
386
387/**
388 * bond_dev_queue_xmit - Prepare skb for xmit.
389 *
390 * @bond: bond device that got this skb for tx.
391 * @skb: hw accel VLAN tagged skb to transmit
392 * @slave_dev: slave that is supposed to xmit this skbuff
393 */
394int bond_dev_queue_xmit(struct bonding *bond, struct sk_buff *skb,
395 struct net_device *slave_dev)
396{
397 skb->dev = slave_dev;
398 skb->priority = 1;
399
400 skb->queue_mapping = bond_queue_mapping(skb);
401
402 if (unlikely(netpoll_tx_running(slave_dev)))
403 bond_netpoll_send_skb(bond_get_slave_by_dev(bond, slave_dev), skb);
404 else
405 dev_queue_xmit(skb);
406
407 return 0;
408}
409
410/*
411 * In the following 2 functions, bond_vlan_rx_add_vid and bond_vlan_rx_kill_vid,
412 * We don't protect the slave list iteration with a lock because:
413 * a. This operation is performed in IOCTL context,
414 * b. The operation is protected by the RTNL semaphore in the 8021q code,
415 * c. Holding a lock with BH disabled while directly calling a base driver
416 * entry point is generally a BAD idea.
417 *
418 * The design of synchronization/protection for this operation in the 8021q
419 * module is good for one or more VLAN devices over a single physical device
420 * and cannot be extended for a teaming solution like bonding, so there is a
421 * potential race condition here where a net device from the vlan group might
422 * be referenced (either by a base driver or the 8021q code) while it is being
423 * removed from the system. However, it turns out we're not making matters
424 * worse, and if it works for regular VLAN usage it will work here too.
425*/
426
427/**
428 * bond_vlan_rx_add_vid - Propagates adding an id to slaves
429 * @bond_dev: bonding net device that got called
430 * @vid: vlan id being added
431 */
432static void bond_vlan_rx_add_vid(struct net_device *bond_dev, uint16_t vid)
433{
434 struct bonding *bond = netdev_priv(bond_dev);
435 struct slave *slave;
436 int i, res;
437
438 bond_for_each_slave(bond, slave, i) {
439 struct net_device *slave_dev = slave->dev;
440 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
441
442 if ((slave_dev->features & NETIF_F_HW_VLAN_FILTER) &&
443 slave_ops->ndo_vlan_rx_add_vid) {
444 slave_ops->ndo_vlan_rx_add_vid(slave_dev, vid);
445 }
446 }
447
448 res = bond_add_vlan(bond, vid);
449 if (res) {
450 pr_err("%s: Error: Failed to add vlan id %d\n",
451 bond_dev->name, vid);
452 }
453}
454
455/**
456 * bond_vlan_rx_kill_vid - Propagates deleting an id to slaves
457 * @bond_dev: bonding net device that got called
458 * @vid: vlan id being removed
459 */
460static void bond_vlan_rx_kill_vid(struct net_device *bond_dev, uint16_t vid)
461{
462 struct bonding *bond = netdev_priv(bond_dev);
463 struct slave *slave;
464 int i, res;
465
466 bond_for_each_slave(bond, slave, i) {
467 struct net_device *slave_dev = slave->dev;
468 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
469
470 if ((slave_dev->features & NETIF_F_HW_VLAN_FILTER) &&
471 slave_ops->ndo_vlan_rx_kill_vid) {
472 slave_ops->ndo_vlan_rx_kill_vid(slave_dev, vid);
473 }
474 }
475
476 res = bond_del_vlan(bond, vid);
477 if (res) {
478 pr_err("%s: Error: Failed to remove vlan id %d\n",
479 bond_dev->name, vid);
480 }
481}
482
483static void bond_add_vlans_on_slave(struct bonding *bond, struct net_device *slave_dev)
484{
485 struct vlan_entry *vlan;
486 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
487
488 if (!(slave_dev->features & NETIF_F_HW_VLAN_FILTER) ||
489 !(slave_ops->ndo_vlan_rx_add_vid))
490 return;
491
492 list_for_each_entry(vlan, &bond->vlan_list, vlan_list)
493 slave_ops->ndo_vlan_rx_add_vid(slave_dev, vlan->vlan_id);
494}
495
496static void bond_del_vlans_from_slave(struct bonding *bond,
497 struct net_device *slave_dev)
498{
499 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
500 struct vlan_entry *vlan;
501
502 if (!(slave_dev->features & NETIF_F_HW_VLAN_FILTER) ||
503 !(slave_ops->ndo_vlan_rx_kill_vid))
504 return;
505
506 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
507 if (!vlan->vlan_id)
508 continue;
509 slave_ops->ndo_vlan_rx_kill_vid(slave_dev, vlan->vlan_id);
510 }
511}
512
513/*------------------------------- Link status -------------------------------*/
514
515/*
516 * Set the carrier state for the master according to the state of its
517 * slaves. If any slaves are up, the master is up. In 802.3ad mode,
518 * do special 802.3ad magic.
519 *
520 * Returns zero if carrier state does not change, nonzero if it does.
521 */
522static int bond_set_carrier(struct bonding *bond)
523{
524 struct slave *slave;
525 int i;
526
527 if (bond->slave_cnt == 0)
528 goto down;
529
530 if (bond->params.mode == BOND_MODE_8023AD)
531 return bond_3ad_set_carrier(bond);
532
533 bond_for_each_slave(bond, slave, i) {
534 if (slave->link == BOND_LINK_UP) {
535 if (!netif_carrier_ok(bond->dev)) {
536 netif_carrier_on(bond->dev);
537 return 1;
538 }
539 return 0;
540 }
541 }
542
543down:
544 if (netif_carrier_ok(bond->dev)) {
545 netif_carrier_off(bond->dev);
546 return 1;
547 }
548 return 0;
549}
550
551/*
552 * Get link speed and duplex from the slave's base driver
553 * using ethtool. If for some reason the call fails or the
554 * values are invalid, fake speed and duplex to 100/Full
555 * and return error.
556 */
557static int bond_update_speed_duplex(struct slave *slave)
558{
559 struct net_device *slave_dev = slave->dev;
560 struct ethtool_cmd etool = { .cmd = ETHTOOL_GSET };
561 u32 slave_speed;
562 int res;
563
564 /* Fake speed and duplex */
565 slave->speed = SPEED_100;
566 slave->duplex = DUPLEX_FULL;
567
568 if (!slave_dev->ethtool_ops || !slave_dev->ethtool_ops->get_settings)
569 return -1;
570
571 res = slave_dev->ethtool_ops->get_settings(slave_dev, &etool);
572 if (res < 0)
573 return -1;
574
575 slave_speed = ethtool_cmd_speed(&etool);
576 if (slave_speed == 0 || slave_speed == ((__u32) -1))
577 return -1;
578
579 switch (etool.duplex) {
580 case DUPLEX_FULL:
581 case DUPLEX_HALF:
582 break;
583 default:
584 return -1;
585 }
586
587 slave->speed = slave_speed;
588 slave->duplex = etool.duplex;
589
590 return 0;
591}
592
593/*
594 * if <dev> supports MII link status reporting, check its link status.
595 *
596 * We either do MII/ETHTOOL ioctls, or check netif_carrier_ok(),
597 * depending upon the setting of the use_carrier parameter.
598 *
599 * Return either BMSR_LSTATUS, meaning that the link is up (or we
600 * can't tell and just pretend it is), or 0, meaning that the link is
601 * down.
602 *
603 * If reporting is non-zero, instead of faking link up, return -1 if
604 * both ETHTOOL and MII ioctls fail (meaning the device does not
605 * support them). If use_carrier is set, return whatever it says.
606 * It'd be nice if there was a good way to tell if a driver supports
607 * netif_carrier, but there really isn't.
608 */
609static int bond_check_dev_link(struct bonding *bond,
610 struct net_device *slave_dev, int reporting)
611{
612 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
613 int (*ioctl)(struct net_device *, struct ifreq *, int);
614 struct ifreq ifr;
615 struct mii_ioctl_data *mii;
616
617 if (!reporting && !netif_running(slave_dev))
618 return 0;
619
620 if (bond->params.use_carrier)
621 return netif_carrier_ok(slave_dev) ? BMSR_LSTATUS : 0;
622
623 /* Try to get link status using Ethtool first. */
624 if (slave_dev->ethtool_ops) {
625 if (slave_dev->ethtool_ops->get_link) {
626 u32 link;
627
628 link = slave_dev->ethtool_ops->get_link(slave_dev);
629
630 return link ? BMSR_LSTATUS : 0;
631 }
632 }
633
634 /* Ethtool can't be used, fallback to MII ioctls. */
635 ioctl = slave_ops->ndo_do_ioctl;
636 if (ioctl) {
637 /* TODO: set pointer to correct ioctl on a per team member */
638 /* bases to make this more efficient. that is, once */
639 /* we determine the correct ioctl, we will always */
640 /* call it and not the others for that team */
641 /* member. */
642
643 /*
644 * We cannot assume that SIOCGMIIPHY will also read a
645 * register; not all network drivers (e.g., e100)
646 * support that.
647 */
648
649 /* Yes, the mii is overlaid on the ifreq.ifr_ifru */
650 strncpy(ifr.ifr_name, slave_dev->name, IFNAMSIZ);
651 mii = if_mii(&ifr);
652 if (IOCTL(slave_dev, &ifr, SIOCGMIIPHY) == 0) {
653 mii->reg_num = MII_BMSR;
654 if (IOCTL(slave_dev, &ifr, SIOCGMIIREG) == 0)
655 return mii->val_out & BMSR_LSTATUS;
656 }
657 }
658
659 /*
660 * If reporting, report that either there's no dev->do_ioctl,
661 * or both SIOCGMIIREG and get_link failed (meaning that we
662 * cannot report link status). If not reporting, pretend
663 * we're ok.
664 */
665 return reporting ? -1 : BMSR_LSTATUS;
666}
667
668/*----------------------------- Multicast list ------------------------------*/
669
670/*
671 * Push the promiscuity flag down to appropriate slaves
672 */
673static int bond_set_promiscuity(struct bonding *bond, int inc)
674{
675 int err = 0;
676 if (USES_PRIMARY(bond->params.mode)) {
677 /* write lock already acquired */
678 if (bond->curr_active_slave) {
679 err = dev_set_promiscuity(bond->curr_active_slave->dev,
680 inc);
681 }
682 } else {
683 struct slave *slave;
684 int i;
685 bond_for_each_slave(bond, slave, i) {
686 err = dev_set_promiscuity(slave->dev, inc);
687 if (err)
688 return err;
689 }
690 }
691 return err;
692}
693
694/*
695 * Push the allmulti flag down to all slaves
696 */
697static int bond_set_allmulti(struct bonding *bond, int inc)
698{
699 int err = 0;
700 if (USES_PRIMARY(bond->params.mode)) {
701 /* write lock already acquired */
702 if (bond->curr_active_slave) {
703 err = dev_set_allmulti(bond->curr_active_slave->dev,
704 inc);
705 }
706 } else {
707 struct slave *slave;
708 int i;
709 bond_for_each_slave(bond, slave, i) {
710 err = dev_set_allmulti(slave->dev, inc);
711 if (err)
712 return err;
713 }
714 }
715 return err;
716}
717
718/*
719 * Add a Multicast address to slaves
720 * according to mode
721 */
722static void bond_mc_add(struct bonding *bond, void *addr)
723{
724 if (USES_PRIMARY(bond->params.mode)) {
725 /* write lock already acquired */
726 if (bond->curr_active_slave)
727 dev_mc_add(bond->curr_active_slave->dev, addr);
728 } else {
729 struct slave *slave;
730 int i;
731
732 bond_for_each_slave(bond, slave, i)
733 dev_mc_add(slave->dev, addr);
734 }
735}
736
737/*
738 * Remove a multicast address from slave
739 * according to mode
740 */
741static void bond_mc_del(struct bonding *bond, void *addr)
742{
743 if (USES_PRIMARY(bond->params.mode)) {
744 /* write lock already acquired */
745 if (bond->curr_active_slave)
746 dev_mc_del(bond->curr_active_slave->dev, addr);
747 } else {
748 struct slave *slave;
749 int i;
750 bond_for_each_slave(bond, slave, i) {
751 dev_mc_del(slave->dev, addr);
752 }
753 }
754}
755
756
757static void __bond_resend_igmp_join_requests(struct net_device *dev)
758{
759 struct in_device *in_dev;
760
761 rcu_read_lock();
762 in_dev = __in_dev_get_rcu(dev);
763 if (in_dev)
764 ip_mc_rejoin_groups(in_dev);
765 rcu_read_unlock();
766}
767
768/*
769 * Retrieve the list of registered multicast addresses for the bonding
770 * device and retransmit an IGMP JOIN request to the current active
771 * slave.
772 */
773static void bond_resend_igmp_join_requests(struct bonding *bond)
774{
775 struct net_device *vlan_dev;
776 struct vlan_entry *vlan;
777
778 read_lock(&bond->lock);
779
780 if (bond->kill_timers)
781 goto out;
782
783 /* rejoin all groups on bond device */
784 __bond_resend_igmp_join_requests(bond->dev);
785
786 /* rejoin all groups on vlan devices */
787 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
788 rcu_read_lock();
789 vlan_dev = __vlan_find_dev_deep(bond->dev,
790 vlan->vlan_id);
791 rcu_read_unlock();
792 if (vlan_dev)
793 __bond_resend_igmp_join_requests(vlan_dev);
794 }
795
796 if ((--bond->igmp_retrans > 0) && !bond->kill_timers)
797 queue_delayed_work(bond->wq, &bond->mcast_work, HZ/5);
798out:
799 read_unlock(&bond->lock);
800}
801
802static void bond_resend_igmp_join_requests_delayed(struct work_struct *work)
803{
804 struct bonding *bond = container_of(work, struct bonding,
805 mcast_work.work);
806 bond_resend_igmp_join_requests(bond);
807}
808
809/*
810 * flush all members of flush->mc_list from device dev->mc_list
811 */
812static void bond_mc_list_flush(struct net_device *bond_dev,
813 struct net_device *slave_dev)
814{
815 struct bonding *bond = netdev_priv(bond_dev);
816 struct netdev_hw_addr *ha;
817
818 netdev_for_each_mc_addr(ha, bond_dev)
819 dev_mc_del(slave_dev, ha->addr);
820
821 if (bond->params.mode == BOND_MODE_8023AD) {
822 /* del lacpdu mc addr from mc list */
823 u8 lacpdu_multicast[ETH_ALEN] = MULTICAST_LACPDU_ADDR;
824
825 dev_mc_del(slave_dev, lacpdu_multicast);
826 }
827}
828
829/*--------------------------- Active slave change ---------------------------*/
830
831/*
832 * Update the mc list and multicast-related flags for the new and
833 * old active slaves (if any) according to the multicast mode, and
834 * promiscuous flags unconditionally.
835 */
836static void bond_mc_swap(struct bonding *bond, struct slave *new_active,
837 struct slave *old_active)
838{
839 struct netdev_hw_addr *ha;
840
841 if (!USES_PRIMARY(bond->params.mode))
842 /* nothing to do - mc list is already up-to-date on
843 * all slaves
844 */
845 return;
846
847 if (old_active) {
848 if (bond->dev->flags & IFF_PROMISC)
849 dev_set_promiscuity(old_active->dev, -1);
850
851 if (bond->dev->flags & IFF_ALLMULTI)
852 dev_set_allmulti(old_active->dev, -1);
853
854 netdev_for_each_mc_addr(ha, bond->dev)
855 dev_mc_del(old_active->dev, ha->addr);
856 }
857
858 if (new_active) {
859 /* FIXME: Signal errors upstream. */
860 if (bond->dev->flags & IFF_PROMISC)
861 dev_set_promiscuity(new_active->dev, 1);
862
863 if (bond->dev->flags & IFF_ALLMULTI)
864 dev_set_allmulti(new_active->dev, 1);
865
866 netdev_for_each_mc_addr(ha, bond->dev)
867 dev_mc_add(new_active->dev, ha->addr);
868 }
869}
870
871/*
872 * bond_do_fail_over_mac
873 *
874 * Perform special MAC address swapping for fail_over_mac settings
875 *
876 * Called with RTNL, bond->lock for read, curr_slave_lock for write_bh.
877 */
878static void bond_do_fail_over_mac(struct bonding *bond,
879 struct slave *new_active,
880 struct slave *old_active)
881 __releases(&bond->curr_slave_lock)
882 __releases(&bond->lock)
883 __acquires(&bond->lock)
884 __acquires(&bond->curr_slave_lock)
885{
886 u8 tmp_mac[ETH_ALEN];
887 struct sockaddr saddr;
888 int rv;
889
890 switch (bond->params.fail_over_mac) {
891 case BOND_FOM_ACTIVE:
892 if (new_active)
893 memcpy(bond->dev->dev_addr, new_active->dev->dev_addr,
894 new_active->dev->addr_len);
895 break;
896 case BOND_FOM_FOLLOW:
897 /*
898 * if new_active && old_active, swap them
899 * if just old_active, do nothing (going to no active slave)
900 * if just new_active, set new_active to bond's MAC
901 */
902 if (!new_active)
903 return;
904
905 write_unlock_bh(&bond->curr_slave_lock);
906 read_unlock(&bond->lock);
907
908 if (old_active) {
909 memcpy(tmp_mac, new_active->dev->dev_addr, ETH_ALEN);
910 memcpy(saddr.sa_data, old_active->dev->dev_addr,
911 ETH_ALEN);
912 saddr.sa_family = new_active->dev->type;
913 } else {
914 memcpy(saddr.sa_data, bond->dev->dev_addr, ETH_ALEN);
915 saddr.sa_family = bond->dev->type;
916 }
917
918 rv = dev_set_mac_address(new_active->dev, &saddr);
919 if (rv) {
920 pr_err("%s: Error %d setting MAC of slave %s\n",
921 bond->dev->name, -rv, new_active->dev->name);
922 goto out;
923 }
924
925 if (!old_active)
926 goto out;
927
928 memcpy(saddr.sa_data, tmp_mac, ETH_ALEN);
929 saddr.sa_family = old_active->dev->type;
930
931 rv = dev_set_mac_address(old_active->dev, &saddr);
932 if (rv)
933 pr_err("%s: Error %d setting MAC of slave %s\n",
934 bond->dev->name, -rv, new_active->dev->name);
935out:
936 read_lock(&bond->lock);
937 write_lock_bh(&bond->curr_slave_lock);
938 break;
939 default:
940 pr_err("%s: bond_do_fail_over_mac impossible: bad policy %d\n",
941 bond->dev->name, bond->params.fail_over_mac);
942 break;
943 }
944
945}
946
947static bool bond_should_change_active(struct bonding *bond)
948{
949 struct slave *prim = bond->primary_slave;
950 struct slave *curr = bond->curr_active_slave;
951
952 if (!prim || !curr || curr->link != BOND_LINK_UP)
953 return true;
954 if (bond->force_primary) {
955 bond->force_primary = false;
956 return true;
957 }
958 if (bond->params.primary_reselect == BOND_PRI_RESELECT_BETTER &&
959 (prim->speed < curr->speed ||
960 (prim->speed == curr->speed && prim->duplex <= curr->duplex)))
961 return false;
962 if (bond->params.primary_reselect == BOND_PRI_RESELECT_FAILURE)
963 return false;
964 return true;
965}
966
967/**
968 * find_best_interface - select the best available slave to be the active one
969 * @bond: our bonding struct
970 *
971 * Warning: Caller must hold curr_slave_lock for writing.
972 */
973static struct slave *bond_find_best_slave(struct bonding *bond)
974{
975 struct slave *new_active, *old_active;
976 struct slave *bestslave = NULL;
977 int mintime = bond->params.updelay;
978 int i;
979
980 new_active = bond->curr_active_slave;
981
982 if (!new_active) { /* there were no active slaves left */
983 if (bond->slave_cnt > 0) /* found one slave */
984 new_active = bond->first_slave;
985 else
986 return NULL; /* still no slave, return NULL */
987 }
988
989 if ((bond->primary_slave) &&
990 bond->primary_slave->link == BOND_LINK_UP &&
991 bond_should_change_active(bond)) {
992 new_active = bond->primary_slave;
993 }
994
995 /* remember where to stop iterating over the slaves */
996 old_active = new_active;
997
998 bond_for_each_slave_from(bond, new_active, i, old_active) {
999 if (new_active->link == BOND_LINK_UP) {
1000 return new_active;
1001 } else if (new_active->link == BOND_LINK_BACK &&
1002 IS_UP(new_active->dev)) {
1003 /* link up, but waiting for stabilization */
1004 if (new_active->delay < mintime) {
1005 mintime = new_active->delay;
1006 bestslave = new_active;
1007 }
1008 }
1009 }
1010
1011 return bestslave;
1012}
1013
1014static bool bond_should_notify_peers(struct bonding *bond)
1015{
1016 struct slave *slave = bond->curr_active_slave;
1017
1018 pr_debug("bond_should_notify_peers: bond %s slave %s\n",
1019 bond->dev->name, slave ? slave->dev->name : "NULL");
1020
1021 if (!slave || !bond->send_peer_notif ||
1022 test_bit(__LINK_STATE_LINKWATCH_PENDING, &slave->dev->state))
1023 return false;
1024
1025 bond->send_peer_notif--;
1026 return true;
1027}
1028
1029/**
1030 * change_active_interface - change the active slave into the specified one
1031 * @bond: our bonding struct
1032 * @new: the new slave to make the active one
1033 *
1034 * Set the new slave to the bond's settings and unset them on the old
1035 * curr_active_slave.
1036 * Setting include flags, mc-list, promiscuity, allmulti, etc.
1037 *
1038 * If @new's link state is %BOND_LINK_BACK we'll set it to %BOND_LINK_UP,
1039 * because it is apparently the best available slave we have, even though its
1040 * updelay hasn't timed out yet.
1041 *
1042 * If new_active is not NULL, caller must hold bond->lock for read and
1043 * curr_slave_lock for write_bh.
1044 */
1045void bond_change_active_slave(struct bonding *bond, struct slave *new_active)
1046{
1047 struct slave *old_active = bond->curr_active_slave;
1048
1049 if (old_active == new_active)
1050 return;
1051
1052 if (new_active) {
1053 new_active->jiffies = jiffies;
1054
1055 if (new_active->link == BOND_LINK_BACK) {
1056 if (USES_PRIMARY(bond->params.mode)) {
1057 pr_info("%s: making interface %s the new active one %d ms earlier.\n",
1058 bond->dev->name, new_active->dev->name,
1059 (bond->params.updelay - new_active->delay) * bond->params.miimon);
1060 }
1061
1062 new_active->delay = 0;
1063 new_active->link = BOND_LINK_UP;
1064
1065 if (bond->params.mode == BOND_MODE_8023AD)
1066 bond_3ad_handle_link_change(new_active, BOND_LINK_UP);
1067
1068 if (bond_is_lb(bond))
1069 bond_alb_handle_link_change(bond, new_active, BOND_LINK_UP);
1070 } else {
1071 if (USES_PRIMARY(bond->params.mode)) {
1072 pr_info("%s: making interface %s the new active one.\n",
1073 bond->dev->name, new_active->dev->name);
1074 }
1075 }
1076 }
1077
1078 if (USES_PRIMARY(bond->params.mode))
1079 bond_mc_swap(bond, new_active, old_active);
1080
1081 if (bond_is_lb(bond)) {
1082 bond_alb_handle_active_change(bond, new_active);
1083 if (old_active)
1084 bond_set_slave_inactive_flags(old_active);
1085 if (new_active)
1086 bond_set_slave_active_flags(new_active);
1087 } else {
1088 bond->curr_active_slave = new_active;
1089 }
1090
1091 if (bond->params.mode == BOND_MODE_ACTIVEBACKUP) {
1092 if (old_active)
1093 bond_set_slave_inactive_flags(old_active);
1094
1095 if (new_active) {
1096 bool should_notify_peers = false;
1097
1098 bond_set_slave_active_flags(new_active);
1099
1100 if (bond->params.fail_over_mac)
1101 bond_do_fail_over_mac(bond, new_active,
1102 old_active);
1103
1104 if (netif_running(bond->dev)) {
1105 bond->send_peer_notif =
1106 bond->params.num_peer_notif;
1107 should_notify_peers =
1108 bond_should_notify_peers(bond);
1109 }
1110
1111 write_unlock_bh(&bond->curr_slave_lock);
1112 read_unlock(&bond->lock);
1113
1114 netdev_bonding_change(bond->dev, NETDEV_BONDING_FAILOVER);
1115 if (should_notify_peers)
1116 netdev_bonding_change(bond->dev,
1117 NETDEV_NOTIFY_PEERS);
1118
1119 read_lock(&bond->lock);
1120 write_lock_bh(&bond->curr_slave_lock);
1121 }
1122 }
1123
1124 /* resend IGMP joins since active slave has changed or
1125 * all were sent on curr_active_slave.
1126 * resend only if bond is brought up with the affected
1127 * bonding modes and the retransmission is enabled */
1128 if (netif_running(bond->dev) && (bond->params.resend_igmp > 0) &&
1129 ((USES_PRIMARY(bond->params.mode) && new_active) ||
1130 bond->params.mode == BOND_MODE_ROUNDROBIN)) {
1131 bond->igmp_retrans = bond->params.resend_igmp;
1132 queue_delayed_work(bond->wq, &bond->mcast_work, 0);
1133 }
1134}
1135
1136/**
1137 * bond_select_active_slave - select a new active slave, if needed
1138 * @bond: our bonding struct
1139 *
1140 * This functions should be called when one of the following occurs:
1141 * - The old curr_active_slave has been released or lost its link.
1142 * - The primary_slave has got its link back.
1143 * - A slave has got its link back and there's no old curr_active_slave.
1144 *
1145 * Caller must hold bond->lock for read and curr_slave_lock for write_bh.
1146 */
1147void bond_select_active_slave(struct bonding *bond)
1148{
1149 struct slave *best_slave;
1150 int rv;
1151
1152 best_slave = bond_find_best_slave(bond);
1153 if (best_slave != bond->curr_active_slave) {
1154 bond_change_active_slave(bond, best_slave);
1155 rv = bond_set_carrier(bond);
1156 if (!rv)
1157 return;
1158
1159 if (netif_carrier_ok(bond->dev)) {
1160 pr_info("%s: first active interface up!\n",
1161 bond->dev->name);
1162 } else {
1163 pr_info("%s: now running without any active interface !\n",
1164 bond->dev->name);
1165 }
1166 }
1167}
1168
1169/*--------------------------- slave list handling ---------------------------*/
1170
1171/*
1172 * This function attaches the slave to the end of list.
1173 *
1174 * bond->lock held for writing by caller.
1175 */
1176static void bond_attach_slave(struct bonding *bond, struct slave *new_slave)
1177{
1178 if (bond->first_slave == NULL) { /* attaching the first slave */
1179 new_slave->next = new_slave;
1180 new_slave->prev = new_slave;
1181 bond->first_slave = new_slave;
1182 } else {
1183 new_slave->next = bond->first_slave;
1184 new_slave->prev = bond->first_slave->prev;
1185 new_slave->next->prev = new_slave;
1186 new_slave->prev->next = new_slave;
1187 }
1188
1189 bond->slave_cnt++;
1190}
1191
1192/*
1193 * This function detaches the slave from the list.
1194 * WARNING: no check is made to verify if the slave effectively
1195 * belongs to <bond>.
1196 * Nothing is freed on return, structures are just unchained.
1197 * If any slave pointer in bond was pointing to <slave>,
1198 * it should be changed by the calling function.
1199 *
1200 * bond->lock held for writing by caller.
1201 */
1202static void bond_detach_slave(struct bonding *bond, struct slave *slave)
1203{
1204 if (slave->next)
1205 slave->next->prev = slave->prev;
1206
1207 if (slave->prev)
1208 slave->prev->next = slave->next;
1209
1210 if (bond->first_slave == slave) { /* slave is the first slave */
1211 if (bond->slave_cnt > 1) { /* there are more slave */
1212 bond->first_slave = slave->next;
1213 } else {
1214 bond->first_slave = NULL; /* slave was the last one */
1215 }
1216 }
1217
1218 slave->next = NULL;
1219 slave->prev = NULL;
1220 bond->slave_cnt--;
1221}
1222
1223#ifdef CONFIG_NET_POLL_CONTROLLER
1224static inline int slave_enable_netpoll(struct slave *slave)
1225{
1226 struct netpoll *np;
1227 int err = 0;
1228
1229 np = kzalloc(sizeof(*np), GFP_KERNEL);
1230 err = -ENOMEM;
1231 if (!np)
1232 goto out;
1233
1234 np->dev = slave->dev;
1235 strlcpy(np->dev_name, slave->dev->name, IFNAMSIZ);
1236 err = __netpoll_setup(np);
1237 if (err) {
1238 kfree(np);
1239 goto out;
1240 }
1241 slave->np = np;
1242out:
1243 return err;
1244}
1245static inline void slave_disable_netpoll(struct slave *slave)
1246{
1247 struct netpoll *np = slave->np;
1248
1249 if (!np)
1250 return;
1251
1252 slave->np = NULL;
1253 synchronize_rcu_bh();
1254 __netpoll_cleanup(np);
1255 kfree(np);
1256}
1257static inline bool slave_dev_support_netpoll(struct net_device *slave_dev)
1258{
1259 if (slave_dev->priv_flags & IFF_DISABLE_NETPOLL)
1260 return false;
1261 if (!slave_dev->netdev_ops->ndo_poll_controller)
1262 return false;
1263 return true;
1264}
1265
1266static void bond_poll_controller(struct net_device *bond_dev)
1267{
1268}
1269
1270static void __bond_netpoll_cleanup(struct bonding *bond)
1271{
1272 struct slave *slave;
1273 int i;
1274
1275 bond_for_each_slave(bond, slave, i)
1276 if (IS_UP(slave->dev))
1277 slave_disable_netpoll(slave);
1278}
1279static void bond_netpoll_cleanup(struct net_device *bond_dev)
1280{
1281 struct bonding *bond = netdev_priv(bond_dev);
1282
1283 read_lock(&bond->lock);
1284 __bond_netpoll_cleanup(bond);
1285 read_unlock(&bond->lock);
1286}
1287
1288static int bond_netpoll_setup(struct net_device *dev, struct netpoll_info *ni)
1289{
1290 struct bonding *bond = netdev_priv(dev);
1291 struct slave *slave;
1292 int i, err = 0;
1293
1294 read_lock(&bond->lock);
1295 bond_for_each_slave(bond, slave, i) {
1296 err = slave_enable_netpoll(slave);
1297 if (err) {
1298 __bond_netpoll_cleanup(bond);
1299 break;
1300 }
1301 }
1302 read_unlock(&bond->lock);
1303 return err;
1304}
1305
1306static struct netpoll_info *bond_netpoll_info(struct bonding *bond)
1307{
1308 return bond->dev->npinfo;
1309}
1310
1311#else
1312static inline int slave_enable_netpoll(struct slave *slave)
1313{
1314 return 0;
1315}
1316static inline void slave_disable_netpoll(struct slave *slave)
1317{
1318}
1319static void bond_netpoll_cleanup(struct net_device *bond_dev)
1320{
1321}
1322#endif
1323
1324/*---------------------------------- IOCTL ----------------------------------*/
1325
1326static int bond_sethwaddr(struct net_device *bond_dev,
1327 struct net_device *slave_dev)
1328{
1329 pr_debug("bond_dev=%p\n", bond_dev);
1330 pr_debug("slave_dev=%p\n", slave_dev);
1331 pr_debug("slave_dev->addr_len=%d\n", slave_dev->addr_len);
1332 memcpy(bond_dev->dev_addr, slave_dev->dev_addr, slave_dev->addr_len);
1333 return 0;
1334}
1335
1336static u32 bond_fix_features(struct net_device *dev, u32 features)
1337{
1338 struct slave *slave;
1339 struct bonding *bond = netdev_priv(dev);
1340 u32 mask;
1341 int i;
1342
1343 read_lock(&bond->lock);
1344
1345 if (!bond->first_slave) {
1346 /* Disable adding VLANs to empty bond. But why? --mq */
1347 features |= NETIF_F_VLAN_CHALLENGED;
1348 goto out;
1349 }
1350
1351 mask = features;
1352 features &= ~NETIF_F_ONE_FOR_ALL;
1353 features |= NETIF_F_ALL_FOR_ALL;
1354
1355 bond_for_each_slave(bond, slave, i) {
1356 features = netdev_increment_features(features,
1357 slave->dev->features,
1358 mask);
1359 }
1360
1361out:
1362 read_unlock(&bond->lock);
1363 return features;
1364}
1365
1366#define BOND_VLAN_FEATURES (NETIF_F_ALL_CSUM | NETIF_F_SG | \
1367 NETIF_F_FRAGLIST | NETIF_F_ALL_TSO | \
1368 NETIF_F_HIGHDMA | NETIF_F_LRO)
1369
1370static void bond_compute_features(struct bonding *bond)
1371{
1372 struct slave *slave;
1373 struct net_device *bond_dev = bond->dev;
1374 u32 vlan_features = BOND_VLAN_FEATURES;
1375 unsigned short max_hard_header_len = ETH_HLEN;
1376 int i;
1377
1378 read_lock(&bond->lock);
1379
1380 if (!bond->first_slave)
1381 goto done;
1382
1383 bond_for_each_slave(bond, slave, i) {
1384 vlan_features = netdev_increment_features(vlan_features,
1385 slave->dev->vlan_features, BOND_VLAN_FEATURES);
1386
1387 if (slave->dev->hard_header_len > max_hard_header_len)
1388 max_hard_header_len = slave->dev->hard_header_len;
1389 }
1390
1391done:
1392 bond_dev->vlan_features = vlan_features;
1393 bond_dev->hard_header_len = max_hard_header_len;
1394
1395 read_unlock(&bond->lock);
1396
1397 netdev_change_features(bond_dev);
1398}
1399
1400static void bond_setup_by_slave(struct net_device *bond_dev,
1401 struct net_device *slave_dev)
1402{
1403 struct bonding *bond = netdev_priv(bond_dev);
1404
1405 bond_dev->header_ops = slave_dev->header_ops;
1406
1407 bond_dev->type = slave_dev->type;
1408 bond_dev->hard_header_len = slave_dev->hard_header_len;
1409 bond_dev->addr_len = slave_dev->addr_len;
1410
1411 memcpy(bond_dev->broadcast, slave_dev->broadcast,
1412 slave_dev->addr_len);
1413 bond->setup_by_slave = 1;
1414}
1415
1416/* On bonding slaves other than the currently active slave, suppress
1417 * duplicates except for alb non-mcast/bcast.
1418 */
1419static bool bond_should_deliver_exact_match(struct sk_buff *skb,
1420 struct slave *slave,
1421 struct bonding *bond)
1422{
1423 if (bond_is_slave_inactive(slave)) {
1424 if (bond->params.mode == BOND_MODE_ALB &&
1425 skb->pkt_type != PACKET_BROADCAST &&
1426 skb->pkt_type != PACKET_MULTICAST)
1427 return false;
1428 return true;
1429 }
1430 return false;
1431}
1432
1433static rx_handler_result_t bond_handle_frame(struct sk_buff **pskb)
1434{
1435 struct sk_buff *skb = *pskb;
1436 struct slave *slave;
1437 struct bonding *bond;
1438 void (*recv_probe)(struct sk_buff *, struct bonding *,
1439 struct slave *);
1440
1441 skb = skb_share_check(skb, GFP_ATOMIC);
1442 if (unlikely(!skb))
1443 return RX_HANDLER_CONSUMED;
1444
1445 *pskb = skb;
1446
1447 slave = bond_slave_get_rcu(skb->dev);
1448 bond = slave->bond;
1449
1450 if (bond->params.arp_interval)
1451 slave->dev->last_rx = jiffies;
1452
1453 recv_probe = ACCESS_ONCE(bond->recv_probe);
1454 if (recv_probe) {
1455 struct sk_buff *nskb = skb_clone(skb, GFP_ATOMIC);
1456
1457 if (likely(nskb)) {
1458 recv_probe(nskb, bond, slave);
1459 dev_kfree_skb(nskb);
1460 }
1461 }
1462
1463 if (bond_should_deliver_exact_match(skb, slave, bond)) {
1464 return RX_HANDLER_EXACT;
1465 }
1466
1467 skb->dev = bond->dev;
1468
1469 if (bond->params.mode == BOND_MODE_ALB &&
1470 bond->dev->priv_flags & IFF_BRIDGE_PORT &&
1471 skb->pkt_type == PACKET_HOST) {
1472
1473 if (unlikely(skb_cow_head(skb,
1474 skb->data - skb_mac_header(skb)))) {
1475 kfree_skb(skb);
1476 return RX_HANDLER_CONSUMED;
1477 }
1478 memcpy(eth_hdr(skb)->h_dest, bond->dev->dev_addr, ETH_ALEN);
1479 }
1480
1481 return RX_HANDLER_ANOTHER;
1482}
1483
1484/* enslave device <slave> to bond device <master> */
1485int bond_enslave(struct net_device *bond_dev, struct net_device *slave_dev)
1486{
1487 struct bonding *bond = netdev_priv(bond_dev);
1488 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
1489 struct slave *new_slave = NULL;
1490 struct netdev_hw_addr *ha;
1491 struct sockaddr addr;
1492 int link_reporting;
1493 int res = 0;
1494
1495 if (!bond->params.use_carrier && slave_dev->ethtool_ops == NULL &&
1496 slave_ops->ndo_do_ioctl == NULL) {
1497 pr_warning("%s: Warning: no link monitoring support for %s\n",
1498 bond_dev->name, slave_dev->name);
1499 }
1500
1501 /* already enslaved */
1502 if (slave_dev->flags & IFF_SLAVE) {
1503 pr_debug("Error, Device was already enslaved\n");
1504 return -EBUSY;
1505 }
1506
1507 /* vlan challenged mutual exclusion */
1508 /* no need to lock since we're protected by rtnl_lock */
1509 if (slave_dev->features & NETIF_F_VLAN_CHALLENGED) {
1510 pr_debug("%s: NETIF_F_VLAN_CHALLENGED\n", slave_dev->name);
1511 if (bond_vlan_used(bond)) {
1512 pr_err("%s: Error: cannot enslave VLAN challenged slave %s on VLAN enabled bond %s\n",
1513 bond_dev->name, slave_dev->name, bond_dev->name);
1514 return -EPERM;
1515 } else {
1516 pr_warning("%s: Warning: enslaved VLAN challenged slave %s. Adding VLANs will be blocked as long as %s is part of bond %s\n",
1517 bond_dev->name, slave_dev->name,
1518 slave_dev->name, bond_dev->name);
1519 }
1520 } else {
1521 pr_debug("%s: ! NETIF_F_VLAN_CHALLENGED\n", slave_dev->name);
1522 }
1523
1524 /*
1525 * Old ifenslave binaries are no longer supported. These can
1526 * be identified with moderate accuracy by the state of the slave:
1527 * the current ifenslave will set the interface down prior to
1528 * enslaving it; the old ifenslave will not.
1529 */
1530 if ((slave_dev->flags & IFF_UP)) {
1531 pr_err("%s is up. This may be due to an out of date ifenslave.\n",
1532 slave_dev->name);
1533 res = -EPERM;
1534 goto err_undo_flags;
1535 }
1536
1537 /* set bonding device ether type by slave - bonding netdevices are
1538 * created with ether_setup, so when the slave type is not ARPHRD_ETHER
1539 * there is a need to override some of the type dependent attribs/funcs.
1540 *
1541 * bond ether type mutual exclusion - don't allow slaves of dissimilar
1542 * ether type (eg ARPHRD_ETHER and ARPHRD_INFINIBAND) share the same bond
1543 */
1544 if (bond->slave_cnt == 0) {
1545 if (bond_dev->type != slave_dev->type) {
1546 pr_debug("%s: change device type from %d to %d\n",
1547 bond_dev->name,
1548 bond_dev->type, slave_dev->type);
1549
1550 res = netdev_bonding_change(bond_dev,
1551 NETDEV_PRE_TYPE_CHANGE);
1552 res = notifier_to_errno(res);
1553 if (res) {
1554 pr_err("%s: refused to change device type\n",
1555 bond_dev->name);
1556 res = -EBUSY;
1557 goto err_undo_flags;
1558 }
1559
1560 /* Flush unicast and multicast addresses */
1561 dev_uc_flush(bond_dev);
1562 dev_mc_flush(bond_dev);
1563
1564 if (slave_dev->type != ARPHRD_ETHER)
1565 bond_setup_by_slave(bond_dev, slave_dev);
1566 else {
1567 ether_setup(bond_dev);
1568 bond_dev->priv_flags &= ~IFF_TX_SKB_SHARING;
1569 }
1570
1571 netdev_bonding_change(bond_dev,
1572 NETDEV_POST_TYPE_CHANGE);
1573 }
1574 } else if (bond_dev->type != slave_dev->type) {
1575 pr_err("%s ether type (%d) is different from other slaves (%d), can not enslave it.\n",
1576 slave_dev->name,
1577 slave_dev->type, bond_dev->type);
1578 res = -EINVAL;
1579 goto err_undo_flags;
1580 }
1581
1582 if (slave_ops->ndo_set_mac_address == NULL) {
1583 if (bond->slave_cnt == 0) {
1584 pr_warning("%s: Warning: The first slave device specified does not support setting the MAC address. Setting fail_over_mac to active.",
1585 bond_dev->name);
1586 bond->params.fail_over_mac = BOND_FOM_ACTIVE;
1587 } else if (bond->params.fail_over_mac != BOND_FOM_ACTIVE) {
1588 pr_err("%s: Error: The slave device specified does not support setting the MAC address, but fail_over_mac is not set to active.\n",
1589 bond_dev->name);
1590 res = -EOPNOTSUPP;
1591 goto err_undo_flags;
1592 }
1593 }
1594
1595 call_netdevice_notifiers(NETDEV_JOIN, slave_dev);
1596
1597 /* If this is the first slave, then we need to set the master's hardware
1598 * address to be the same as the slave's. */
1599 if (is_zero_ether_addr(bond->dev->dev_addr))
1600 memcpy(bond->dev->dev_addr, slave_dev->dev_addr,
1601 slave_dev->addr_len);
1602
1603
1604 new_slave = kzalloc(sizeof(struct slave), GFP_KERNEL);
1605 if (!new_slave) {
1606 res = -ENOMEM;
1607 goto err_undo_flags;
1608 }
1609
1610 /*
1611 * Set the new_slave's queue_id to be zero. Queue ID mapping
1612 * is set via sysfs or module option if desired.
1613 */
1614 new_slave->queue_id = 0;
1615
1616 /* Save slave's original mtu and then set it to match the bond */
1617 new_slave->original_mtu = slave_dev->mtu;
1618 res = dev_set_mtu(slave_dev, bond->dev->mtu);
1619 if (res) {
1620 pr_debug("Error %d calling dev_set_mtu\n", res);
1621 goto err_free;
1622 }
1623
1624 /*
1625 * Save slave's original ("permanent") mac address for modes
1626 * that need it, and for restoring it upon release, and then
1627 * set it to the master's address
1628 */
1629 memcpy(new_slave->perm_hwaddr, slave_dev->dev_addr, ETH_ALEN);
1630
1631 if (!bond->params.fail_over_mac) {
1632 /*
1633 * Set slave to master's mac address. The application already
1634 * set the master's mac address to that of the first slave
1635 */
1636 memcpy(addr.sa_data, bond_dev->dev_addr, bond_dev->addr_len);
1637 addr.sa_family = slave_dev->type;
1638 res = dev_set_mac_address(slave_dev, &addr);
1639 if (res) {
1640 pr_debug("Error %d calling set_mac_address\n", res);
1641 goto err_restore_mtu;
1642 }
1643 }
1644
1645 res = netdev_set_bond_master(slave_dev, bond_dev);
1646 if (res) {
1647 pr_debug("Error %d calling netdev_set_bond_master\n", res);
1648 goto err_restore_mac;
1649 }
1650
1651 /* open the slave since the application closed it */
1652 res = dev_open(slave_dev);
1653 if (res) {
1654 pr_debug("Opening slave %s failed\n", slave_dev->name);
1655 goto err_unset_master;
1656 }
1657
1658 new_slave->bond = bond;
1659 new_slave->dev = slave_dev;
1660 slave_dev->priv_flags |= IFF_BONDING;
1661
1662 if (bond_is_lb(bond)) {
1663 /* bond_alb_init_slave() must be called before all other stages since
1664 * it might fail and we do not want to have to undo everything
1665 */
1666 res = bond_alb_init_slave(bond, new_slave);
1667 if (res)
1668 goto err_close;
1669 }
1670
1671 /* If the mode USES_PRIMARY, then the new slave gets the
1672 * master's promisc (and mc) settings only if it becomes the
1673 * curr_active_slave, and that is taken care of later when calling
1674 * bond_change_active()
1675 */
1676 if (!USES_PRIMARY(bond->params.mode)) {
1677 /* set promiscuity level to new slave */
1678 if (bond_dev->flags & IFF_PROMISC) {
1679 res = dev_set_promiscuity(slave_dev, 1);
1680 if (res)
1681 goto err_close;
1682 }
1683
1684 /* set allmulti level to new slave */
1685 if (bond_dev->flags & IFF_ALLMULTI) {
1686 res = dev_set_allmulti(slave_dev, 1);
1687 if (res)
1688 goto err_close;
1689 }
1690
1691 netif_addr_lock_bh(bond_dev);
1692 /* upload master's mc_list to new slave */
1693 netdev_for_each_mc_addr(ha, bond_dev)
1694 dev_mc_add(slave_dev, ha->addr);
1695 netif_addr_unlock_bh(bond_dev);
1696 }
1697
1698 if (bond->params.mode == BOND_MODE_8023AD) {
1699 /* add lacpdu mc addr to mc list */
1700 u8 lacpdu_multicast[ETH_ALEN] = MULTICAST_LACPDU_ADDR;
1701
1702 dev_mc_add(slave_dev, lacpdu_multicast);
1703 }
1704
1705 bond_add_vlans_on_slave(bond, slave_dev);
1706
1707 write_lock_bh(&bond->lock);
1708
1709 bond_attach_slave(bond, new_slave);
1710
1711 new_slave->delay = 0;
1712 new_slave->link_failure_count = 0;
1713
1714 write_unlock_bh(&bond->lock);
1715
1716 bond_compute_features(bond);
1717
1718 read_lock(&bond->lock);
1719
1720 new_slave->last_arp_rx = jiffies;
1721
1722 if (bond->params.miimon && !bond->params.use_carrier) {
1723 link_reporting = bond_check_dev_link(bond, slave_dev, 1);
1724
1725 if ((link_reporting == -1) && !bond->params.arp_interval) {
1726 /*
1727 * miimon is set but a bonded network driver
1728 * does not support ETHTOOL/MII and
1729 * arp_interval is not set. Note: if
1730 * use_carrier is enabled, we will never go
1731 * here (because netif_carrier is always
1732 * supported); thus, we don't need to change
1733 * the messages for netif_carrier.
1734 */
1735 pr_warning("%s: Warning: MII and ETHTOOL support not available for interface %s, and arp_interval/arp_ip_target module parameters not specified, thus bonding will not detect link failures! see bonding.txt for details.\n",
1736 bond_dev->name, slave_dev->name);
1737 } else if (link_reporting == -1) {
1738 /* unable get link status using mii/ethtool */
1739 pr_warning("%s: Warning: can't get link status from interface %s; the network driver associated with this interface does not support MII or ETHTOOL link status reporting, thus miimon has no effect on this interface.\n",
1740 bond_dev->name, slave_dev->name);
1741 }
1742 }
1743
1744 /* check for initial state */
1745 if (!bond->params.miimon ||
1746 (bond_check_dev_link(bond, slave_dev, 0) == BMSR_LSTATUS)) {
1747 if (bond->params.updelay) {
1748 pr_debug("Initial state of slave_dev is BOND_LINK_BACK\n");
1749 new_slave->link = BOND_LINK_BACK;
1750 new_slave->delay = bond->params.updelay;
1751 } else {
1752 pr_debug("Initial state of slave_dev is BOND_LINK_UP\n");
1753 new_slave->link = BOND_LINK_UP;
1754 }
1755 new_slave->jiffies = jiffies;
1756 } else {
1757 pr_debug("Initial state of slave_dev is BOND_LINK_DOWN\n");
1758 new_slave->link = BOND_LINK_DOWN;
1759 }
1760
1761 if (bond_update_speed_duplex(new_slave) &&
1762 (new_slave->link != BOND_LINK_DOWN)) {
1763 pr_warning("%s: Warning: failed to get speed and duplex from %s, assumed to be 100Mb/sec and Full.\n",
1764 bond_dev->name, new_slave->dev->name);
1765
1766 if (bond->params.mode == BOND_MODE_8023AD) {
1767 pr_warning("%s: Warning: Operation of 802.3ad mode requires ETHTOOL support in base driver for proper aggregator selection.\n",
1768 bond_dev->name);
1769 }
1770 }
1771
1772 if (USES_PRIMARY(bond->params.mode) && bond->params.primary[0]) {
1773 /* if there is a primary slave, remember it */
1774 if (strcmp(bond->params.primary, new_slave->dev->name) == 0) {
1775 bond->primary_slave = new_slave;
1776 bond->force_primary = true;
1777 }
1778 }
1779
1780 write_lock_bh(&bond->curr_slave_lock);
1781
1782 switch (bond->params.mode) {
1783 case BOND_MODE_ACTIVEBACKUP:
1784 bond_set_slave_inactive_flags(new_slave);
1785 bond_select_active_slave(bond);
1786 break;
1787 case BOND_MODE_8023AD:
1788 /* in 802.3ad mode, the internal mechanism
1789 * will activate the slaves in the selected
1790 * aggregator
1791 */
1792 bond_set_slave_inactive_flags(new_slave);
1793 /* if this is the first slave */
1794 if (bond->slave_cnt == 1) {
1795 SLAVE_AD_INFO(new_slave).id = 1;
1796 /* Initialize AD with the number of times that the AD timer is called in 1 second
1797 * can be called only after the mac address of the bond is set
1798 */
1799 bond_3ad_initialize(bond, 1000/AD_TIMER_INTERVAL);
1800 } else {
1801 SLAVE_AD_INFO(new_slave).id =
1802 SLAVE_AD_INFO(new_slave->prev).id + 1;
1803 }
1804
1805 bond_3ad_bind_slave(new_slave);
1806 break;
1807 case BOND_MODE_TLB:
1808 case BOND_MODE_ALB:
1809 bond_set_active_slave(new_slave);
1810 bond_set_slave_inactive_flags(new_slave);
1811 bond_select_active_slave(bond);
1812 break;
1813 default:
1814 pr_debug("This slave is always active in trunk mode\n");
1815
1816 /* always active in trunk mode */
1817 bond_set_active_slave(new_slave);
1818
1819 /* In trunking mode there is little meaning to curr_active_slave
1820 * anyway (it holds no special properties of the bond device),
1821 * so we can change it without calling change_active_interface()
1822 */
1823 if (!bond->curr_active_slave)
1824 bond->curr_active_slave = new_slave;
1825
1826 break;
1827 } /* switch(bond_mode) */
1828
1829 write_unlock_bh(&bond->curr_slave_lock);
1830
1831 bond_set_carrier(bond);
1832
1833#ifdef CONFIG_NET_POLL_CONTROLLER
1834 slave_dev->npinfo = bond_netpoll_info(bond);
1835 if (slave_dev->npinfo) {
1836 if (slave_enable_netpoll(new_slave)) {
1837 read_unlock(&bond->lock);
1838 pr_info("Error, %s: master_dev is using netpoll, "
1839 "but new slave device does not support netpoll.\n",
1840 bond_dev->name);
1841 res = -EBUSY;
1842 goto err_close;
1843 }
1844 }
1845#endif
1846
1847 read_unlock(&bond->lock);
1848
1849 res = bond_create_slave_symlinks(bond_dev, slave_dev);
1850 if (res)
1851 goto err_close;
1852
1853 res = netdev_rx_handler_register(slave_dev, bond_handle_frame,
1854 new_slave);
1855 if (res) {
1856 pr_debug("Error %d calling netdev_rx_handler_register\n", res);
1857 goto err_dest_symlinks;
1858 }
1859
1860 pr_info("%s: enslaving %s as a%s interface with a%s link.\n",
1861 bond_dev->name, slave_dev->name,
1862 bond_is_active_slave(new_slave) ? "n active" : " backup",
1863 new_slave->link != BOND_LINK_DOWN ? "n up" : " down");
1864
1865 /* enslave is successful */
1866 return 0;
1867
1868/* Undo stages on error */
1869err_dest_symlinks:
1870 bond_destroy_slave_symlinks(bond_dev, slave_dev);
1871
1872err_close:
1873 dev_close(slave_dev);
1874
1875err_unset_master:
1876 netdev_set_bond_master(slave_dev, NULL);
1877
1878err_restore_mac:
1879 if (!bond->params.fail_over_mac) {
1880 /* XXX TODO - fom follow mode needs to change master's
1881 * MAC if this slave's MAC is in use by the bond, or at
1882 * least print a warning.
1883 */
1884 memcpy(addr.sa_data, new_slave->perm_hwaddr, ETH_ALEN);
1885 addr.sa_family = slave_dev->type;
1886 dev_set_mac_address(slave_dev, &addr);
1887 }
1888
1889err_restore_mtu:
1890 dev_set_mtu(slave_dev, new_slave->original_mtu);
1891
1892err_free:
1893 kfree(new_slave);
1894
1895err_undo_flags:
1896 bond_compute_features(bond);
1897
1898 return res;
1899}
1900
1901/*
1902 * Try to release the slave device <slave> from the bond device <master>
1903 * It is legal to access curr_active_slave without a lock because all the function
1904 * is write-locked.
1905 *
1906 * The rules for slave state should be:
1907 * for Active/Backup:
1908 * Active stays on all backups go down
1909 * for Bonded connections:
1910 * The first up interface should be left on and all others downed.
1911 */
1912int bond_release(struct net_device *bond_dev, struct net_device *slave_dev)
1913{
1914 struct bonding *bond = netdev_priv(bond_dev);
1915 struct slave *slave, *oldcurrent;
1916 struct sockaddr addr;
1917 u32 old_features = bond_dev->features;
1918
1919 /* slave is not a slave or master is not master of this slave */
1920 if (!(slave_dev->flags & IFF_SLAVE) ||
1921 (slave_dev->master != bond_dev)) {
1922 pr_err("%s: Error: cannot release %s.\n",
1923 bond_dev->name, slave_dev->name);
1924 return -EINVAL;
1925 }
1926
1927 block_netpoll_tx();
1928 netdev_bonding_change(bond_dev, NETDEV_RELEASE);
1929 write_lock_bh(&bond->lock);
1930
1931 slave = bond_get_slave_by_dev(bond, slave_dev);
1932 if (!slave) {
1933 /* not a slave of this bond */
1934 pr_info("%s: %s not enslaved\n",
1935 bond_dev->name, slave_dev->name);
1936 write_unlock_bh(&bond->lock);
1937 unblock_netpoll_tx();
1938 return -EINVAL;
1939 }
1940
1941 /* unregister rx_handler early so bond_handle_frame wouldn't be called
1942 * for this slave anymore.
1943 */
1944 netdev_rx_handler_unregister(slave_dev);
1945 write_unlock_bh(&bond->lock);
1946 synchronize_net();
1947 write_lock_bh(&bond->lock);
1948
1949 if (!bond->params.fail_over_mac) {
1950 if (!compare_ether_addr(bond_dev->dev_addr, slave->perm_hwaddr) &&
1951 bond->slave_cnt > 1)
1952 pr_warning("%s: Warning: the permanent HWaddr of %s - %pM - is still in use by %s. Set the HWaddr of %s to a different address to avoid conflicts.\n",
1953 bond_dev->name, slave_dev->name,
1954 slave->perm_hwaddr,
1955 bond_dev->name, slave_dev->name);
1956 }
1957
1958 /* Inform AD package of unbinding of slave. */
1959 if (bond->params.mode == BOND_MODE_8023AD) {
1960 /* must be called before the slave is
1961 * detached from the list
1962 */
1963 bond_3ad_unbind_slave(slave);
1964 }
1965
1966 pr_info("%s: releasing %s interface %s\n",
1967 bond_dev->name,
1968 bond_is_active_slave(slave) ? "active" : "backup",
1969 slave_dev->name);
1970
1971 oldcurrent = bond->curr_active_slave;
1972
1973 bond->current_arp_slave = NULL;
1974
1975 /* release the slave from its bond */
1976 bond_detach_slave(bond, slave);
1977
1978 if (bond->primary_slave == slave)
1979 bond->primary_slave = NULL;
1980
1981 if (oldcurrent == slave)
1982 bond_change_active_slave(bond, NULL);
1983
1984 if (bond_is_lb(bond)) {
1985 /* Must be called only after the slave has been
1986 * detached from the list and the curr_active_slave
1987 * has been cleared (if our_slave == old_current),
1988 * but before a new active slave is selected.
1989 */
1990 write_unlock_bh(&bond->lock);
1991 bond_alb_deinit_slave(bond, slave);
1992 write_lock_bh(&bond->lock);
1993 }
1994
1995 if (oldcurrent == slave) {
1996 /*
1997 * Note that we hold RTNL over this sequence, so there
1998 * is no concern that another slave add/remove event
1999 * will interfere.
2000 */
2001 write_unlock_bh(&bond->lock);
2002 read_lock(&bond->lock);
2003 write_lock_bh(&bond->curr_slave_lock);
2004
2005 bond_select_active_slave(bond);
2006
2007 write_unlock_bh(&bond->curr_slave_lock);
2008 read_unlock(&bond->lock);
2009 write_lock_bh(&bond->lock);
2010 }
2011
2012 if (bond->slave_cnt == 0) {
2013 bond_set_carrier(bond);
2014
2015 /* if the last slave was removed, zero the mac address
2016 * of the master so it will be set by the application
2017 * to the mac address of the first slave
2018 */
2019 memset(bond_dev->dev_addr, 0, bond_dev->addr_len);
2020
2021 if (bond_vlan_used(bond)) {
2022 pr_warning("%s: Warning: clearing HW address of %s while it still has VLANs.\n",
2023 bond_dev->name, bond_dev->name);
2024 pr_warning("%s: When re-adding slaves, make sure the bond's HW address matches its VLANs'.\n",
2025 bond_dev->name);
2026 }
2027 }
2028
2029 write_unlock_bh(&bond->lock);
2030 unblock_netpoll_tx();
2031
2032 bond_compute_features(bond);
2033 if (!(bond_dev->features & NETIF_F_VLAN_CHALLENGED) &&
2034 (old_features & NETIF_F_VLAN_CHALLENGED))
2035 pr_info("%s: last VLAN challenged slave %s left bond %s. VLAN blocking is removed\n",
2036 bond_dev->name, slave_dev->name, bond_dev->name);
2037
2038 /* must do this from outside any spinlocks */
2039 bond_destroy_slave_symlinks(bond_dev, slave_dev);
2040
2041 bond_del_vlans_from_slave(bond, slave_dev);
2042
2043 /* If the mode USES_PRIMARY, then we should only remove its
2044 * promisc and mc settings if it was the curr_active_slave, but that was
2045 * already taken care of above when we detached the slave
2046 */
2047 if (!USES_PRIMARY(bond->params.mode)) {
2048 /* unset promiscuity level from slave */
2049 if (bond_dev->flags & IFF_PROMISC)
2050 dev_set_promiscuity(slave_dev, -1);
2051
2052 /* unset allmulti level from slave */
2053 if (bond_dev->flags & IFF_ALLMULTI)
2054 dev_set_allmulti(slave_dev, -1);
2055
2056 /* flush master's mc_list from slave */
2057 netif_addr_lock_bh(bond_dev);
2058 bond_mc_list_flush(bond_dev, slave_dev);
2059 netif_addr_unlock_bh(bond_dev);
2060 }
2061
2062 netdev_set_bond_master(slave_dev, NULL);
2063
2064 slave_disable_netpoll(slave);
2065
2066 /* close slave before restoring its mac address */
2067 dev_close(slave_dev);
2068
2069 if (bond->params.fail_over_mac != BOND_FOM_ACTIVE) {
2070 /* restore original ("permanent") mac address */
2071 memcpy(addr.sa_data, slave->perm_hwaddr, ETH_ALEN);
2072 addr.sa_family = slave_dev->type;
2073 dev_set_mac_address(slave_dev, &addr);
2074 }
2075
2076 dev_set_mtu(slave_dev, slave->original_mtu);
2077
2078 slave_dev->priv_flags &= ~IFF_BONDING;
2079
2080 kfree(slave);
2081
2082 return 0; /* deletion OK */
2083}
2084
2085/*
2086* First release a slave and then destroy the bond if no more slaves are left.
2087* Must be under rtnl_lock when this function is called.
2088*/
2089static int bond_release_and_destroy(struct net_device *bond_dev,
2090 struct net_device *slave_dev)
2091{
2092 struct bonding *bond = netdev_priv(bond_dev);
2093 int ret;
2094
2095 ret = bond_release(bond_dev, slave_dev);
2096 if ((ret == 0) && (bond->slave_cnt == 0)) {
2097 bond_dev->priv_flags |= IFF_DISABLE_NETPOLL;
2098 pr_info("%s: destroying bond %s.\n",
2099 bond_dev->name, bond_dev->name);
2100 unregister_netdevice(bond_dev);
2101 }
2102 return ret;
2103}
2104
2105/*
2106 * This function releases all slaves.
2107 */
2108static int bond_release_all(struct net_device *bond_dev)
2109{
2110 struct bonding *bond = netdev_priv(bond_dev);
2111 struct slave *slave;
2112 struct net_device *slave_dev;
2113 struct sockaddr addr;
2114
2115 write_lock_bh(&bond->lock);
2116
2117 netif_carrier_off(bond_dev);
2118
2119 if (bond->slave_cnt == 0)
2120 goto out;
2121
2122 bond->current_arp_slave = NULL;
2123 bond->primary_slave = NULL;
2124 bond_change_active_slave(bond, NULL);
2125
2126 while ((slave = bond->first_slave) != NULL) {
2127 /* Inform AD package of unbinding of slave
2128 * before slave is detached from the list.
2129 */
2130 if (bond->params.mode == BOND_MODE_8023AD)
2131 bond_3ad_unbind_slave(slave);
2132
2133 slave_dev = slave->dev;
2134 bond_detach_slave(bond, slave);
2135
2136 /* now that the slave is detached, unlock and perform
2137 * all the undo steps that should not be called from
2138 * within a lock.
2139 */
2140 write_unlock_bh(&bond->lock);
2141
2142 /* unregister rx_handler early so bond_handle_frame wouldn't
2143 * be called for this slave anymore.
2144 */
2145 netdev_rx_handler_unregister(slave_dev);
2146 synchronize_net();
2147
2148 if (bond_is_lb(bond)) {
2149 /* must be called only after the slave
2150 * has been detached from the list
2151 */
2152 bond_alb_deinit_slave(bond, slave);
2153 }
2154
2155 bond_destroy_slave_symlinks(bond_dev, slave_dev);
2156 bond_del_vlans_from_slave(bond, slave_dev);
2157
2158 /* If the mode USES_PRIMARY, then we should only remove its
2159 * promisc and mc settings if it was the curr_active_slave, but that was
2160 * already taken care of above when we detached the slave
2161 */
2162 if (!USES_PRIMARY(bond->params.mode)) {
2163 /* unset promiscuity level from slave */
2164 if (bond_dev->flags & IFF_PROMISC)
2165 dev_set_promiscuity(slave_dev, -1);
2166
2167 /* unset allmulti level from slave */
2168 if (bond_dev->flags & IFF_ALLMULTI)
2169 dev_set_allmulti(slave_dev, -1);
2170
2171 /* flush master's mc_list from slave */
2172 netif_addr_lock_bh(bond_dev);
2173 bond_mc_list_flush(bond_dev, slave_dev);
2174 netif_addr_unlock_bh(bond_dev);
2175 }
2176
2177 netdev_set_bond_master(slave_dev, NULL);
2178
2179 slave_disable_netpoll(slave);
2180
2181 /* close slave before restoring its mac address */
2182 dev_close(slave_dev);
2183
2184 if (!bond->params.fail_over_mac) {
2185 /* restore original ("permanent") mac address*/
2186 memcpy(addr.sa_data, slave->perm_hwaddr, ETH_ALEN);
2187 addr.sa_family = slave_dev->type;
2188 dev_set_mac_address(slave_dev, &addr);
2189 }
2190
2191 kfree(slave);
2192
2193 /* re-acquire the lock before getting the next slave */
2194 write_lock_bh(&bond->lock);
2195 }
2196
2197 /* zero the mac address of the master so it will be
2198 * set by the application to the mac address of the
2199 * first slave
2200 */
2201 memset(bond_dev->dev_addr, 0, bond_dev->addr_len);
2202
2203 if (bond_vlan_used(bond)) {
2204 pr_warning("%s: Warning: clearing HW address of %s while it still has VLANs.\n",
2205 bond_dev->name, bond_dev->name);
2206 pr_warning("%s: When re-adding slaves, make sure the bond's HW address matches its VLANs'.\n",
2207 bond_dev->name);
2208 }
2209
2210 pr_info("%s: released all slaves\n", bond_dev->name);
2211
2212out:
2213 write_unlock_bh(&bond->lock);
2214
2215 bond_compute_features(bond);
2216
2217 return 0;
2218}
2219
2220/*
2221 * This function changes the active slave to slave <slave_dev>.
2222 * It returns -EINVAL in the following cases.
2223 * - <slave_dev> is not found in the list.
2224 * - There is not active slave now.
2225 * - <slave_dev> is already active.
2226 * - The link state of <slave_dev> is not BOND_LINK_UP.
2227 * - <slave_dev> is not running.
2228 * In these cases, this function does nothing.
2229 * In the other cases, current_slave pointer is changed and 0 is returned.
2230 */
2231static int bond_ioctl_change_active(struct net_device *bond_dev, struct net_device *slave_dev)
2232{
2233 struct bonding *bond = netdev_priv(bond_dev);
2234 struct slave *old_active = NULL;
2235 struct slave *new_active = NULL;
2236 int res = 0;
2237
2238 if (!USES_PRIMARY(bond->params.mode))
2239 return -EINVAL;
2240
2241 /* Verify that master_dev is indeed the master of slave_dev */
2242 if (!(slave_dev->flags & IFF_SLAVE) || (slave_dev->master != bond_dev))
2243 return -EINVAL;
2244
2245 read_lock(&bond->lock);
2246
2247 read_lock(&bond->curr_slave_lock);
2248 old_active = bond->curr_active_slave;
2249 read_unlock(&bond->curr_slave_lock);
2250
2251 new_active = bond_get_slave_by_dev(bond, slave_dev);
2252
2253 /*
2254 * Changing to the current active: do nothing; return success.
2255 */
2256 if (new_active && (new_active == old_active)) {
2257 read_unlock(&bond->lock);
2258 return 0;
2259 }
2260
2261 if ((new_active) &&
2262 (old_active) &&
2263 (new_active->link == BOND_LINK_UP) &&
2264 IS_UP(new_active->dev)) {
2265 block_netpoll_tx();
2266 write_lock_bh(&bond->curr_slave_lock);
2267 bond_change_active_slave(bond, new_active);
2268 write_unlock_bh(&bond->curr_slave_lock);
2269 unblock_netpoll_tx();
2270 } else
2271 res = -EINVAL;
2272
2273 read_unlock(&bond->lock);
2274
2275 return res;
2276}
2277
2278static int bond_info_query(struct net_device *bond_dev, struct ifbond *info)
2279{
2280 struct bonding *bond = netdev_priv(bond_dev);
2281
2282 info->bond_mode = bond->params.mode;
2283 info->miimon = bond->params.miimon;
2284
2285 read_lock(&bond->lock);
2286 info->num_slaves = bond->slave_cnt;
2287 read_unlock(&bond->lock);
2288
2289 return 0;
2290}
2291
2292static int bond_slave_info_query(struct net_device *bond_dev, struct ifslave *info)
2293{
2294 struct bonding *bond = netdev_priv(bond_dev);
2295 struct slave *slave;
2296 int i, res = -ENODEV;
2297
2298 read_lock(&bond->lock);
2299
2300 bond_for_each_slave(bond, slave, i) {
2301 if (i == (int)info->slave_id) {
2302 res = 0;
2303 strcpy(info->slave_name, slave->dev->name);
2304 info->link = slave->link;
2305 info->state = bond_slave_state(slave);
2306 info->link_failure_count = slave->link_failure_count;
2307 break;
2308 }
2309 }
2310
2311 read_unlock(&bond->lock);
2312
2313 return res;
2314}
2315
2316/*-------------------------------- Monitoring -------------------------------*/
2317
2318
2319static int bond_miimon_inspect(struct bonding *bond)
2320{
2321 struct slave *slave;
2322 int i, link_state, commit = 0;
2323 bool ignore_updelay;
2324
2325 ignore_updelay = !bond->curr_active_slave ? true : false;
2326
2327 bond_for_each_slave(bond, slave, i) {
2328 slave->new_link = BOND_LINK_NOCHANGE;
2329
2330 link_state = bond_check_dev_link(bond, slave->dev, 0);
2331
2332 switch (slave->link) {
2333 case BOND_LINK_UP:
2334 if (link_state)
2335 continue;
2336
2337 slave->link = BOND_LINK_FAIL;
2338 slave->delay = bond->params.downdelay;
2339 if (slave->delay) {
2340 pr_info("%s: link status down for %sinterface %s, disabling it in %d ms.\n",
2341 bond->dev->name,
2342 (bond->params.mode ==
2343 BOND_MODE_ACTIVEBACKUP) ?
2344 (bond_is_active_slave(slave) ?
2345 "active " : "backup ") : "",
2346 slave->dev->name,
2347 bond->params.downdelay * bond->params.miimon);
2348 }
2349 /*FALLTHRU*/
2350 case BOND_LINK_FAIL:
2351 if (link_state) {
2352 /*
2353 * recovered before downdelay expired
2354 */
2355 slave->link = BOND_LINK_UP;
2356 slave->jiffies = jiffies;
2357 pr_info("%s: link status up again after %d ms for interface %s.\n",
2358 bond->dev->name,
2359 (bond->params.downdelay - slave->delay) *
2360 bond->params.miimon,
2361 slave->dev->name);
2362 continue;
2363 }
2364
2365 if (slave->delay <= 0) {
2366 slave->new_link = BOND_LINK_DOWN;
2367 commit++;
2368 continue;
2369 }
2370
2371 slave->delay--;
2372 break;
2373
2374 case BOND_LINK_DOWN:
2375 if (!link_state)
2376 continue;
2377
2378 slave->link = BOND_LINK_BACK;
2379 slave->delay = bond->params.updelay;
2380
2381 if (slave->delay) {
2382 pr_info("%s: link status up for interface %s, enabling it in %d ms.\n",
2383 bond->dev->name, slave->dev->name,
2384 ignore_updelay ? 0 :
2385 bond->params.updelay *
2386 bond->params.miimon);
2387 }
2388 /*FALLTHRU*/
2389 case BOND_LINK_BACK:
2390 if (!link_state) {
2391 slave->link = BOND_LINK_DOWN;
2392 pr_info("%s: link status down again after %d ms for interface %s.\n",
2393 bond->dev->name,
2394 (bond->params.updelay - slave->delay) *
2395 bond->params.miimon,
2396 slave->dev->name);
2397
2398 continue;
2399 }
2400
2401 if (ignore_updelay)
2402 slave->delay = 0;
2403
2404 if (slave->delay <= 0) {
2405 slave->new_link = BOND_LINK_UP;
2406 commit++;
2407 ignore_updelay = false;
2408 continue;
2409 }
2410
2411 slave->delay--;
2412 break;
2413 }
2414 }
2415
2416 return commit;
2417}
2418
2419static void bond_miimon_commit(struct bonding *bond)
2420{
2421 struct slave *slave;
2422 int i;
2423
2424 bond_for_each_slave(bond, slave, i) {
2425 switch (slave->new_link) {
2426 case BOND_LINK_NOCHANGE:
2427 continue;
2428
2429 case BOND_LINK_UP:
2430 slave->link = BOND_LINK_UP;
2431 slave->jiffies = jiffies;
2432
2433 if (bond->params.mode == BOND_MODE_8023AD) {
2434 /* prevent it from being the active one */
2435 bond_set_backup_slave(slave);
2436 } else if (bond->params.mode != BOND_MODE_ACTIVEBACKUP) {
2437 /* make it immediately active */
2438 bond_set_active_slave(slave);
2439 } else if (slave != bond->primary_slave) {
2440 /* prevent it from being the active one */
2441 bond_set_backup_slave(slave);
2442 }
2443
2444 bond_update_speed_duplex(slave);
2445
2446 pr_info("%s: link status definitely up for interface %s, %u Mbps %s duplex.\n",
2447 bond->dev->name, slave->dev->name,
2448 slave->speed, slave->duplex ? "full" : "half");
2449
2450 /* notify ad that the link status has changed */
2451 if (bond->params.mode == BOND_MODE_8023AD)
2452 bond_3ad_handle_link_change(slave, BOND_LINK_UP);
2453
2454 if (bond_is_lb(bond))
2455 bond_alb_handle_link_change(bond, slave,
2456 BOND_LINK_UP);
2457
2458 if (!bond->curr_active_slave ||
2459 (slave == bond->primary_slave))
2460 goto do_failover;
2461
2462 continue;
2463
2464 case BOND_LINK_DOWN:
2465 if (slave->link_failure_count < UINT_MAX)
2466 slave->link_failure_count++;
2467
2468 slave->link = BOND_LINK_DOWN;
2469
2470 if (bond->params.mode == BOND_MODE_ACTIVEBACKUP ||
2471 bond->params.mode == BOND_MODE_8023AD)
2472 bond_set_slave_inactive_flags(slave);
2473
2474 pr_info("%s: link status definitely down for interface %s, disabling it\n",
2475 bond->dev->name, slave->dev->name);
2476
2477 if (bond->params.mode == BOND_MODE_8023AD)
2478 bond_3ad_handle_link_change(slave,
2479 BOND_LINK_DOWN);
2480
2481 if (bond_is_lb(bond))
2482 bond_alb_handle_link_change(bond, slave,
2483 BOND_LINK_DOWN);
2484
2485 if (slave == bond->curr_active_slave)
2486 goto do_failover;
2487
2488 continue;
2489
2490 default:
2491 pr_err("%s: invalid new link %d on slave %s\n",
2492 bond->dev->name, slave->new_link,
2493 slave->dev->name);
2494 slave->new_link = BOND_LINK_NOCHANGE;
2495
2496 continue;
2497 }
2498
2499do_failover:
2500 ASSERT_RTNL();
2501 block_netpoll_tx();
2502 write_lock_bh(&bond->curr_slave_lock);
2503 bond_select_active_slave(bond);
2504 write_unlock_bh(&bond->curr_slave_lock);
2505 unblock_netpoll_tx();
2506 }
2507
2508 bond_set_carrier(bond);
2509}
2510
2511/*
2512 * bond_mii_monitor
2513 *
2514 * Really a wrapper that splits the mii monitor into two phases: an
2515 * inspection, then (if inspection indicates something needs to be done)
2516 * an acquisition of appropriate locks followed by a commit phase to
2517 * implement whatever link state changes are indicated.
2518 */
2519void bond_mii_monitor(struct work_struct *work)
2520{
2521 struct bonding *bond = container_of(work, struct bonding,
2522 mii_work.work);
2523 bool should_notify_peers = false;
2524
2525 read_lock(&bond->lock);
2526 if (bond->kill_timers)
2527 goto out;
2528
2529 if (bond->slave_cnt == 0)
2530 goto re_arm;
2531
2532 should_notify_peers = bond_should_notify_peers(bond);
2533
2534 if (bond_miimon_inspect(bond)) {
2535 read_unlock(&bond->lock);
2536 rtnl_lock();
2537 read_lock(&bond->lock);
2538
2539 bond_miimon_commit(bond);
2540
2541 read_unlock(&bond->lock);
2542 rtnl_unlock(); /* might sleep, hold no other locks */
2543 read_lock(&bond->lock);
2544 }
2545
2546re_arm:
2547 if (bond->params.miimon && !bond->kill_timers)
2548 queue_delayed_work(bond->wq, &bond->mii_work,
2549 msecs_to_jiffies(bond->params.miimon));
2550out:
2551 read_unlock(&bond->lock);
2552
2553 if (should_notify_peers) {
2554 rtnl_lock();
2555 netdev_bonding_change(bond->dev, NETDEV_NOTIFY_PEERS);
2556 rtnl_unlock();
2557 }
2558}
2559
2560static __be32 bond_glean_dev_ip(struct net_device *dev)
2561{
2562 struct in_device *idev;
2563 struct in_ifaddr *ifa;
2564 __be32 addr = 0;
2565
2566 if (!dev)
2567 return 0;
2568
2569 rcu_read_lock();
2570 idev = __in_dev_get_rcu(dev);
2571 if (!idev)
2572 goto out;
2573
2574 ifa = idev->ifa_list;
2575 if (!ifa)
2576 goto out;
2577
2578 addr = ifa->ifa_local;
2579out:
2580 rcu_read_unlock();
2581 return addr;
2582}
2583
2584static int bond_has_this_ip(struct bonding *bond, __be32 ip)
2585{
2586 struct vlan_entry *vlan;
2587
2588 if (ip == bond->master_ip)
2589 return 1;
2590
2591 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
2592 if (ip == vlan->vlan_ip)
2593 return 1;
2594 }
2595
2596 return 0;
2597}
2598
2599/*
2600 * We go to the (large) trouble of VLAN tagging ARP frames because
2601 * switches in VLAN mode (especially if ports are configured as
2602 * "native" to a VLAN) might not pass non-tagged frames.
2603 */
2604static void bond_arp_send(struct net_device *slave_dev, int arp_op, __be32 dest_ip, __be32 src_ip, unsigned short vlan_id)
2605{
2606 struct sk_buff *skb;
2607
2608 pr_debug("arp %d on slave %s: dst %x src %x vid %d\n", arp_op,
2609 slave_dev->name, dest_ip, src_ip, vlan_id);
2610
2611 skb = arp_create(arp_op, ETH_P_ARP, dest_ip, slave_dev, src_ip,
2612 NULL, slave_dev->dev_addr, NULL);
2613
2614 if (!skb) {
2615 pr_err("ARP packet allocation failed\n");
2616 return;
2617 }
2618 if (vlan_id) {
2619 skb = vlan_put_tag(skb, vlan_id);
2620 if (!skb) {
2621 pr_err("failed to insert VLAN tag\n");
2622 return;
2623 }
2624 }
2625 arp_xmit(skb);
2626}
2627
2628
2629static void bond_arp_send_all(struct bonding *bond, struct slave *slave)
2630{
2631 int i, vlan_id;
2632 __be32 *targets = bond->params.arp_targets;
2633 struct vlan_entry *vlan;
2634 struct net_device *vlan_dev;
2635 struct rtable *rt;
2636
2637 for (i = 0; (i < BOND_MAX_ARP_TARGETS); i++) {
2638 if (!targets[i])
2639 break;
2640 pr_debug("basa: target %x\n", targets[i]);
2641 if (!bond_vlan_used(bond)) {
2642 pr_debug("basa: empty vlan: arp_send\n");
2643 bond_arp_send(slave->dev, ARPOP_REQUEST, targets[i],
2644 bond->master_ip, 0);
2645 continue;
2646 }
2647
2648 /*
2649 * If VLANs are configured, we do a route lookup to
2650 * determine which VLAN interface would be used, so we
2651 * can tag the ARP with the proper VLAN tag.
2652 */
2653 rt = ip_route_output(dev_net(bond->dev), targets[i], 0,
2654 RTO_ONLINK, 0);
2655 if (IS_ERR(rt)) {
2656 if (net_ratelimit()) {
2657 pr_warning("%s: no route to arp_ip_target %pI4\n",
2658 bond->dev->name, &targets[i]);
2659 }
2660 continue;
2661 }
2662
2663 /*
2664 * This target is not on a VLAN
2665 */
2666 if (rt->dst.dev == bond->dev) {
2667 ip_rt_put(rt);
2668 pr_debug("basa: rtdev == bond->dev: arp_send\n");
2669 bond_arp_send(slave->dev, ARPOP_REQUEST, targets[i],
2670 bond->master_ip, 0);
2671 continue;
2672 }
2673
2674 vlan_id = 0;
2675 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
2676 rcu_read_lock();
2677 vlan_dev = __vlan_find_dev_deep(bond->dev,
2678 vlan->vlan_id);
2679 rcu_read_unlock();
2680 if (vlan_dev == rt->dst.dev) {
2681 vlan_id = vlan->vlan_id;
2682 pr_debug("basa: vlan match on %s %d\n",
2683 vlan_dev->name, vlan_id);
2684 break;
2685 }
2686 }
2687
2688 if (vlan_id) {
2689 ip_rt_put(rt);
2690 bond_arp_send(slave->dev, ARPOP_REQUEST, targets[i],
2691 vlan->vlan_ip, vlan_id);
2692 continue;
2693 }
2694
2695 if (net_ratelimit()) {
2696 pr_warning("%s: no path to arp_ip_target %pI4 via rt.dev %s\n",
2697 bond->dev->name, &targets[i],
2698 rt->dst.dev ? rt->dst.dev->name : "NULL");
2699 }
2700 ip_rt_put(rt);
2701 }
2702}
2703
2704static void bond_validate_arp(struct bonding *bond, struct slave *slave, __be32 sip, __be32 tip)
2705{
2706 int i;
2707 __be32 *targets = bond->params.arp_targets;
2708
2709 for (i = 0; (i < BOND_MAX_ARP_TARGETS) && targets[i]; i++) {
2710 pr_debug("bva: sip %pI4 tip %pI4 t[%d] %pI4 bhti(tip) %d\n",
2711 &sip, &tip, i, &targets[i],
2712 bond_has_this_ip(bond, tip));
2713 if (sip == targets[i]) {
2714 if (bond_has_this_ip(bond, tip))
2715 slave->last_arp_rx = jiffies;
2716 return;
2717 }
2718 }
2719}
2720
2721static void bond_arp_rcv(struct sk_buff *skb, struct bonding *bond,
2722 struct slave *slave)
2723{
2724 struct arphdr *arp;
2725 unsigned char *arp_ptr;
2726 __be32 sip, tip;
2727
2728 if (skb->protocol != __cpu_to_be16(ETH_P_ARP))
2729 return;
2730
2731 read_lock(&bond->lock);
2732
2733 pr_debug("bond_arp_rcv: bond %s skb->dev %s\n",
2734 bond->dev->name, skb->dev->name);
2735
2736 if (!pskb_may_pull(skb, arp_hdr_len(bond->dev)))
2737 goto out_unlock;
2738
2739 arp = arp_hdr(skb);
2740 if (arp->ar_hln != bond->dev->addr_len ||
2741 skb->pkt_type == PACKET_OTHERHOST ||
2742 skb->pkt_type == PACKET_LOOPBACK ||
2743 arp->ar_hrd != htons(ARPHRD_ETHER) ||
2744 arp->ar_pro != htons(ETH_P_IP) ||
2745 arp->ar_pln != 4)
2746 goto out_unlock;
2747
2748 arp_ptr = (unsigned char *)(arp + 1);
2749 arp_ptr += bond->dev->addr_len;
2750 memcpy(&sip, arp_ptr, 4);
2751 arp_ptr += 4 + bond->dev->addr_len;
2752 memcpy(&tip, arp_ptr, 4);
2753
2754 pr_debug("bond_arp_rcv: %s %s/%d av %d sv %d sip %pI4 tip %pI4\n",
2755 bond->dev->name, slave->dev->name, bond_slave_state(slave),
2756 bond->params.arp_validate, slave_do_arp_validate(bond, slave),
2757 &sip, &tip);
2758
2759 /*
2760 * Backup slaves won't see the ARP reply, but do come through
2761 * here for each ARP probe (so we swap the sip/tip to validate
2762 * the probe). In a "redundant switch, common router" type of
2763 * configuration, the ARP probe will (hopefully) travel from
2764 * the active, through one switch, the router, then the other
2765 * switch before reaching the backup.
2766 */
2767 if (bond_is_active_slave(slave))
2768 bond_validate_arp(bond, slave, sip, tip);
2769 else
2770 bond_validate_arp(bond, slave, tip, sip);
2771
2772out_unlock:
2773 read_unlock(&bond->lock);
2774}
2775
2776/*
2777 * this function is called regularly to monitor each slave's link
2778 * ensuring that traffic is being sent and received when arp monitoring
2779 * is used in load-balancing mode. if the adapter has been dormant, then an
2780 * arp is transmitted to generate traffic. see activebackup_arp_monitor for
2781 * arp monitoring in active backup mode.
2782 */
2783void bond_loadbalance_arp_mon(struct work_struct *work)
2784{
2785 struct bonding *bond = container_of(work, struct bonding,
2786 arp_work.work);
2787 struct slave *slave, *oldcurrent;
2788 int do_failover = 0;
2789 int delta_in_ticks;
2790 int i;
2791
2792 read_lock(&bond->lock);
2793
2794 delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
2795
2796 if (bond->kill_timers)
2797 goto out;
2798
2799 if (bond->slave_cnt == 0)
2800 goto re_arm;
2801
2802 read_lock(&bond->curr_slave_lock);
2803 oldcurrent = bond->curr_active_slave;
2804 read_unlock(&bond->curr_slave_lock);
2805
2806 /* see if any of the previous devices are up now (i.e. they have
2807 * xmt and rcv traffic). the curr_active_slave does not come into
2808 * the picture unless it is null. also, slave->jiffies is not needed
2809 * here because we send an arp on each slave and give a slave as
2810 * long as it needs to get the tx/rx within the delta.
2811 * TODO: what about up/down delay in arp mode? it wasn't here before
2812 * so it can wait
2813 */
2814 bond_for_each_slave(bond, slave, i) {
2815 unsigned long trans_start = dev_trans_start(slave->dev);
2816
2817 if (slave->link != BOND_LINK_UP) {
2818 if (time_in_range(jiffies,
2819 trans_start - delta_in_ticks,
2820 trans_start + delta_in_ticks) &&
2821 time_in_range(jiffies,
2822 slave->dev->last_rx - delta_in_ticks,
2823 slave->dev->last_rx + delta_in_ticks)) {
2824
2825 slave->link = BOND_LINK_UP;
2826 bond_set_active_slave(slave);
2827
2828 /* primary_slave has no meaning in round-robin
2829 * mode. the window of a slave being up and
2830 * curr_active_slave being null after enslaving
2831 * is closed.
2832 */
2833 if (!oldcurrent) {
2834 pr_info("%s: link status definitely up for interface %s, ",
2835 bond->dev->name,
2836 slave->dev->name);
2837 do_failover = 1;
2838 } else {
2839 pr_info("%s: interface %s is now up\n",
2840 bond->dev->name,
2841 slave->dev->name);
2842 }
2843 }
2844 } else {
2845 /* slave->link == BOND_LINK_UP */
2846
2847 /* not all switches will respond to an arp request
2848 * when the source ip is 0, so don't take the link down
2849 * if we don't know our ip yet
2850 */
2851 if (!time_in_range(jiffies,
2852 trans_start - delta_in_ticks,
2853 trans_start + 2 * delta_in_ticks) ||
2854 !time_in_range(jiffies,
2855 slave->dev->last_rx - delta_in_ticks,
2856 slave->dev->last_rx + 2 * delta_in_ticks)) {
2857
2858 slave->link = BOND_LINK_DOWN;
2859 bond_set_backup_slave(slave);
2860
2861 if (slave->link_failure_count < UINT_MAX)
2862 slave->link_failure_count++;
2863
2864 pr_info("%s: interface %s is now down.\n",
2865 bond->dev->name,
2866 slave->dev->name);
2867
2868 if (slave == oldcurrent)
2869 do_failover = 1;
2870 }
2871 }
2872
2873 /* note: if switch is in round-robin mode, all links
2874 * must tx arp to ensure all links rx an arp - otherwise
2875 * links may oscillate or not come up at all; if switch is
2876 * in something like xor mode, there is nothing we can
2877 * do - all replies will be rx'ed on same link causing slaves
2878 * to be unstable during low/no traffic periods
2879 */
2880 if (IS_UP(slave->dev))
2881 bond_arp_send_all(bond, slave);
2882 }
2883
2884 if (do_failover) {
2885 block_netpoll_tx();
2886 write_lock_bh(&bond->curr_slave_lock);
2887
2888 bond_select_active_slave(bond);
2889
2890 write_unlock_bh(&bond->curr_slave_lock);
2891 unblock_netpoll_tx();
2892 }
2893
2894re_arm:
2895 if (bond->params.arp_interval && !bond->kill_timers)
2896 queue_delayed_work(bond->wq, &bond->arp_work, delta_in_ticks);
2897out:
2898 read_unlock(&bond->lock);
2899}
2900
2901/*
2902 * Called to inspect slaves for active-backup mode ARP monitor link state
2903 * changes. Sets new_link in slaves to specify what action should take
2904 * place for the slave. Returns 0 if no changes are found, >0 if changes
2905 * to link states must be committed.
2906 *
2907 * Called with bond->lock held for read.
2908 */
2909static int bond_ab_arp_inspect(struct bonding *bond, int delta_in_ticks)
2910{
2911 struct slave *slave;
2912 int i, commit = 0;
2913 unsigned long trans_start;
2914
2915 bond_for_each_slave(bond, slave, i) {
2916 slave->new_link = BOND_LINK_NOCHANGE;
2917
2918 if (slave->link != BOND_LINK_UP) {
2919 if (time_in_range(jiffies,
2920 slave_last_rx(bond, slave) - delta_in_ticks,
2921 slave_last_rx(bond, slave) + delta_in_ticks)) {
2922
2923 slave->new_link = BOND_LINK_UP;
2924 commit++;
2925 }
2926
2927 continue;
2928 }
2929
2930 /*
2931 * Give slaves 2*delta after being enslaved or made
2932 * active. This avoids bouncing, as the last receive
2933 * times need a full ARP monitor cycle to be updated.
2934 */
2935 if (time_in_range(jiffies,
2936 slave->jiffies - delta_in_ticks,
2937 slave->jiffies + 2 * delta_in_ticks))
2938 continue;
2939
2940 /*
2941 * Backup slave is down if:
2942 * - No current_arp_slave AND
2943 * - more than 3*delta since last receive AND
2944 * - the bond has an IP address
2945 *
2946 * Note: a non-null current_arp_slave indicates
2947 * the curr_active_slave went down and we are
2948 * searching for a new one; under this condition
2949 * we only take the curr_active_slave down - this
2950 * gives each slave a chance to tx/rx traffic
2951 * before being taken out
2952 */
2953 if (!bond_is_active_slave(slave) &&
2954 !bond->current_arp_slave &&
2955 !time_in_range(jiffies,
2956 slave_last_rx(bond, slave) - delta_in_ticks,
2957 slave_last_rx(bond, slave) + 3 * delta_in_ticks)) {
2958
2959 slave->new_link = BOND_LINK_DOWN;
2960 commit++;
2961 }
2962
2963 /*
2964 * Active slave is down if:
2965 * - more than 2*delta since transmitting OR
2966 * - (more than 2*delta since receive AND
2967 * the bond has an IP address)
2968 */
2969 trans_start = dev_trans_start(slave->dev);
2970 if (bond_is_active_slave(slave) &&
2971 (!time_in_range(jiffies,
2972 trans_start - delta_in_ticks,
2973 trans_start + 2 * delta_in_ticks) ||
2974 !time_in_range(jiffies,
2975 slave_last_rx(bond, slave) - delta_in_ticks,
2976 slave_last_rx(bond, slave) + 2 * delta_in_ticks))) {
2977
2978 slave->new_link = BOND_LINK_DOWN;
2979 commit++;
2980 }
2981 }
2982
2983 return commit;
2984}
2985
2986/*
2987 * Called to commit link state changes noted by inspection step of
2988 * active-backup mode ARP monitor.
2989 *
2990 * Called with RTNL and bond->lock for read.
2991 */
2992static void bond_ab_arp_commit(struct bonding *bond, int delta_in_ticks)
2993{
2994 struct slave *slave;
2995 int i;
2996 unsigned long trans_start;
2997
2998 bond_for_each_slave(bond, slave, i) {
2999 switch (slave->new_link) {
3000 case BOND_LINK_NOCHANGE:
3001 continue;
3002
3003 case BOND_LINK_UP:
3004 trans_start = dev_trans_start(slave->dev);
3005 if ((!bond->curr_active_slave &&
3006 time_in_range(jiffies,
3007 trans_start - delta_in_ticks,
3008 trans_start + delta_in_ticks)) ||
3009 bond->curr_active_slave != slave) {
3010 slave->link = BOND_LINK_UP;
3011 bond->current_arp_slave = NULL;
3012
3013 pr_info("%s: link status definitely up for interface %s.\n",
3014 bond->dev->name, slave->dev->name);
3015
3016 if (!bond->curr_active_slave ||
3017 (slave == bond->primary_slave))
3018 goto do_failover;
3019
3020 }
3021
3022 continue;
3023
3024 case BOND_LINK_DOWN:
3025 if (slave->link_failure_count < UINT_MAX)
3026 slave->link_failure_count++;
3027
3028 slave->link = BOND_LINK_DOWN;
3029 bond_set_slave_inactive_flags(slave);
3030
3031 pr_info("%s: link status definitely down for interface %s, disabling it\n",
3032 bond->dev->name, slave->dev->name);
3033
3034 if (slave == bond->curr_active_slave) {
3035 bond->current_arp_slave = NULL;
3036 goto do_failover;
3037 }
3038
3039 continue;
3040
3041 default:
3042 pr_err("%s: impossible: new_link %d on slave %s\n",
3043 bond->dev->name, slave->new_link,
3044 slave->dev->name);
3045 continue;
3046 }
3047
3048do_failover:
3049 ASSERT_RTNL();
3050 block_netpoll_tx();
3051 write_lock_bh(&bond->curr_slave_lock);
3052 bond_select_active_slave(bond);
3053 write_unlock_bh(&bond->curr_slave_lock);
3054 unblock_netpoll_tx();
3055 }
3056
3057 bond_set_carrier(bond);
3058}
3059
3060/*
3061 * Send ARP probes for active-backup mode ARP monitor.
3062 *
3063 * Called with bond->lock held for read.
3064 */
3065static void bond_ab_arp_probe(struct bonding *bond)
3066{
3067 struct slave *slave;
3068 int i;
3069
3070 read_lock(&bond->curr_slave_lock);
3071
3072 if (bond->current_arp_slave && bond->curr_active_slave)
3073 pr_info("PROBE: c_arp %s && cas %s BAD\n",
3074 bond->current_arp_slave->dev->name,
3075 bond->curr_active_slave->dev->name);
3076
3077 if (bond->curr_active_slave) {
3078 bond_arp_send_all(bond, bond->curr_active_slave);
3079 read_unlock(&bond->curr_slave_lock);
3080 return;
3081 }
3082
3083 read_unlock(&bond->curr_slave_lock);
3084
3085 /* if we don't have a curr_active_slave, search for the next available
3086 * backup slave from the current_arp_slave and make it the candidate
3087 * for becoming the curr_active_slave
3088 */
3089
3090 if (!bond->current_arp_slave) {
3091 bond->current_arp_slave = bond->first_slave;
3092 if (!bond->current_arp_slave)
3093 return;
3094 }
3095
3096 bond_set_slave_inactive_flags(bond->current_arp_slave);
3097
3098 /* search for next candidate */
3099 bond_for_each_slave_from(bond, slave, i, bond->current_arp_slave->next) {
3100 if (IS_UP(slave->dev)) {
3101 slave->link = BOND_LINK_BACK;
3102 bond_set_slave_active_flags(slave);
3103 bond_arp_send_all(bond, slave);
3104 slave->jiffies = jiffies;
3105 bond->current_arp_slave = slave;
3106 break;
3107 }
3108
3109 /* if the link state is up at this point, we
3110 * mark it down - this can happen if we have
3111 * simultaneous link failures and
3112 * reselect_active_interface doesn't make this
3113 * one the current slave so it is still marked
3114 * up when it is actually down
3115 */
3116 if (slave->link == BOND_LINK_UP) {
3117 slave->link = BOND_LINK_DOWN;
3118 if (slave->link_failure_count < UINT_MAX)
3119 slave->link_failure_count++;
3120
3121 bond_set_slave_inactive_flags(slave);
3122
3123 pr_info("%s: backup interface %s is now down.\n",
3124 bond->dev->name, slave->dev->name);
3125 }
3126 }
3127}
3128
3129void bond_activebackup_arp_mon(struct work_struct *work)
3130{
3131 struct bonding *bond = container_of(work, struct bonding,
3132 arp_work.work);
3133 bool should_notify_peers = false;
3134 int delta_in_ticks;
3135
3136 read_lock(&bond->lock);
3137
3138 if (bond->kill_timers)
3139 goto out;
3140
3141 delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
3142
3143 if (bond->slave_cnt == 0)
3144 goto re_arm;
3145
3146 should_notify_peers = bond_should_notify_peers(bond);
3147
3148 if (bond_ab_arp_inspect(bond, delta_in_ticks)) {
3149 read_unlock(&bond->lock);
3150 rtnl_lock();
3151 read_lock(&bond->lock);
3152
3153 bond_ab_arp_commit(bond, delta_in_ticks);
3154
3155 read_unlock(&bond->lock);
3156 rtnl_unlock();
3157 read_lock(&bond->lock);
3158 }
3159
3160 bond_ab_arp_probe(bond);
3161
3162re_arm:
3163 if (bond->params.arp_interval && !bond->kill_timers)
3164 queue_delayed_work(bond->wq, &bond->arp_work, delta_in_ticks);
3165out:
3166 read_unlock(&bond->lock);
3167
3168 if (should_notify_peers) {
3169 rtnl_lock();
3170 netdev_bonding_change(bond->dev, NETDEV_NOTIFY_PEERS);
3171 rtnl_unlock();
3172 }
3173}
3174
3175/*-------------------------- netdev event handling --------------------------*/
3176
3177/*
3178 * Change device name
3179 */
3180static int bond_event_changename(struct bonding *bond)
3181{
3182 bond_remove_proc_entry(bond);
3183 bond_create_proc_entry(bond);
3184
3185 bond_debug_reregister(bond);
3186
3187 return NOTIFY_DONE;
3188}
3189
3190static int bond_master_netdev_event(unsigned long event,
3191 struct net_device *bond_dev)
3192{
3193 struct bonding *event_bond = netdev_priv(bond_dev);
3194
3195 switch (event) {
3196 case NETDEV_CHANGENAME:
3197 return bond_event_changename(event_bond);
3198 default:
3199 break;
3200 }
3201
3202 return NOTIFY_DONE;
3203}
3204
3205static int bond_slave_netdev_event(unsigned long event,
3206 struct net_device *slave_dev)
3207{
3208 struct net_device *bond_dev = slave_dev->master;
3209 struct bonding *bond = netdev_priv(bond_dev);
3210
3211 switch (event) {
3212 case NETDEV_UNREGISTER:
3213 if (bond_dev) {
3214 if (bond->setup_by_slave)
3215 bond_release_and_destroy(bond_dev, slave_dev);
3216 else
3217 bond_release(bond_dev, slave_dev);
3218 }
3219 break;
3220 case NETDEV_CHANGE:
3221 if (bond->params.mode == BOND_MODE_8023AD || bond_is_lb(bond)) {
3222 struct slave *slave;
3223
3224 slave = bond_get_slave_by_dev(bond, slave_dev);
3225 if (slave) {
3226 u32 old_speed = slave->speed;
3227 u8 old_duplex = slave->duplex;
3228
3229 bond_update_speed_duplex(slave);
3230
3231 if (bond_is_lb(bond))
3232 break;
3233
3234 if (old_speed != slave->speed)
3235 bond_3ad_adapter_speed_changed(slave);
3236 if (old_duplex != slave->duplex)
3237 bond_3ad_adapter_duplex_changed(slave);
3238 }
3239 }
3240
3241 break;
3242 case NETDEV_DOWN:
3243 /*
3244 * ... Or is it this?
3245 */
3246 break;
3247 case NETDEV_CHANGEMTU:
3248 /*
3249 * TODO: Should slaves be allowed to
3250 * independently alter their MTU? For
3251 * an active-backup bond, slaves need
3252 * not be the same type of device, so
3253 * MTUs may vary. For other modes,
3254 * slaves arguably should have the
3255 * same MTUs. To do this, we'd need to
3256 * take over the slave's change_mtu
3257 * function for the duration of their
3258 * servitude.
3259 */
3260 break;
3261 case NETDEV_CHANGENAME:
3262 /*
3263 * TODO: handle changing the primary's name
3264 */
3265 break;
3266 case NETDEV_FEAT_CHANGE:
3267 bond_compute_features(bond);
3268 break;
3269 default:
3270 break;
3271 }
3272
3273 return NOTIFY_DONE;
3274}
3275
3276/*
3277 * bond_netdev_event: handle netdev notifier chain events.
3278 *
3279 * This function receives events for the netdev chain. The caller (an
3280 * ioctl handler calling blocking_notifier_call_chain) holds the necessary
3281 * locks for us to safely manipulate the slave devices (RTNL lock,
3282 * dev_probe_lock).
3283 */
3284static int bond_netdev_event(struct notifier_block *this,
3285 unsigned long event, void *ptr)
3286{
3287 struct net_device *event_dev = (struct net_device *)ptr;
3288
3289 pr_debug("event_dev: %s, event: %lx\n",
3290 event_dev ? event_dev->name : "None",
3291 event);
3292
3293 if (!(event_dev->priv_flags & IFF_BONDING))
3294 return NOTIFY_DONE;
3295
3296 if (event_dev->flags & IFF_MASTER) {
3297 pr_debug("IFF_MASTER\n");
3298 return bond_master_netdev_event(event, event_dev);
3299 }
3300
3301 if (event_dev->flags & IFF_SLAVE) {
3302 pr_debug("IFF_SLAVE\n");
3303 return bond_slave_netdev_event(event, event_dev);
3304 }
3305
3306 return NOTIFY_DONE;
3307}
3308
3309/*
3310 * bond_inetaddr_event: handle inetaddr notifier chain events.
3311 *
3312 * We keep track of device IPs primarily to use as source addresses in
3313 * ARP monitor probes (rather than spewing out broadcasts all the time).
3314 *
3315 * We track one IP for the main device (if it has one), plus one per VLAN.
3316 */
3317static int bond_inetaddr_event(struct notifier_block *this, unsigned long event, void *ptr)
3318{
3319 struct in_ifaddr *ifa = ptr;
3320 struct net_device *vlan_dev, *event_dev = ifa->ifa_dev->dev;
3321 struct bond_net *bn = net_generic(dev_net(event_dev), bond_net_id);
3322 struct bonding *bond;
3323 struct vlan_entry *vlan;
3324
3325 list_for_each_entry(bond, &bn->dev_list, bond_list) {
3326 if (bond->dev == event_dev) {
3327 switch (event) {
3328 case NETDEV_UP:
3329 bond->master_ip = ifa->ifa_local;
3330 return NOTIFY_OK;
3331 case NETDEV_DOWN:
3332 bond->master_ip = bond_glean_dev_ip(bond->dev);
3333 return NOTIFY_OK;
3334 default:
3335 return NOTIFY_DONE;
3336 }
3337 }
3338
3339 list_for_each_entry(vlan, &bond->vlan_list, vlan_list) {
3340 vlan_dev = __vlan_find_dev_deep(bond->dev,
3341 vlan->vlan_id);
3342 if (vlan_dev == event_dev) {
3343 switch (event) {
3344 case NETDEV_UP:
3345 vlan->vlan_ip = ifa->ifa_local;
3346 return NOTIFY_OK;
3347 case NETDEV_DOWN:
3348 vlan->vlan_ip =
3349 bond_glean_dev_ip(vlan_dev);
3350 return NOTIFY_OK;
3351 default:
3352 return NOTIFY_DONE;
3353 }
3354 }
3355 }
3356 }
3357 return NOTIFY_DONE;
3358}
3359
3360static struct notifier_block bond_netdev_notifier = {
3361 .notifier_call = bond_netdev_event,
3362};
3363
3364static struct notifier_block bond_inetaddr_notifier = {
3365 .notifier_call = bond_inetaddr_event,
3366};
3367
3368/*---------------------------- Hashing Policies -----------------------------*/
3369
3370/*
3371 * Hash for the output device based upon layer 2 and layer 3 data. If
3372 * the packet is not IP mimic bond_xmit_hash_policy_l2()
3373 */
3374static int bond_xmit_hash_policy_l23(struct sk_buff *skb, int count)
3375{
3376 struct ethhdr *data = (struct ethhdr *)skb->data;
3377 struct iphdr *iph = ip_hdr(skb);
3378
3379 if (skb->protocol == htons(ETH_P_IP)) {
3380 return ((ntohl(iph->saddr ^ iph->daddr) & 0xffff) ^
3381 (data->h_dest[5] ^ data->h_source[5])) % count;
3382 }
3383
3384 return (data->h_dest[5] ^ data->h_source[5]) % count;
3385}
3386
3387/*
3388 * Hash for the output device based upon layer 3 and layer 4 data. If
3389 * the packet is a frag or not TCP or UDP, just use layer 3 data. If it is
3390 * altogether not IP, mimic bond_xmit_hash_policy_l2()
3391 */
3392static int bond_xmit_hash_policy_l34(struct sk_buff *skb, int count)
3393{
3394 struct ethhdr *data = (struct ethhdr *)skb->data;
3395 struct iphdr *iph = ip_hdr(skb);
3396 __be16 *layer4hdr = (__be16 *)((u32 *)iph + iph->ihl);
3397 int layer4_xor = 0;
3398
3399 if (skb->protocol == htons(ETH_P_IP)) {
3400 if (!ip_is_fragment(iph) &&
3401 (iph->protocol == IPPROTO_TCP ||
3402 iph->protocol == IPPROTO_UDP)) {
3403 layer4_xor = ntohs((*layer4hdr ^ *(layer4hdr + 1)));
3404 }
3405 return (layer4_xor ^
3406 ((ntohl(iph->saddr ^ iph->daddr)) & 0xffff)) % count;
3407
3408 }
3409
3410 return (data->h_dest[5] ^ data->h_source[5]) % count;
3411}
3412
3413/*
3414 * Hash for the output device based upon layer 2 data
3415 */
3416static int bond_xmit_hash_policy_l2(struct sk_buff *skb, int count)
3417{
3418 struct ethhdr *data = (struct ethhdr *)skb->data;
3419
3420 return (data->h_dest[5] ^ data->h_source[5]) % count;
3421}
3422
3423/*-------------------------- Device entry points ----------------------------*/
3424
3425static int bond_open(struct net_device *bond_dev)
3426{
3427 struct bonding *bond = netdev_priv(bond_dev);
3428 struct slave *slave;
3429 int i;
3430
3431 bond->kill_timers = 0;
3432
3433 /* reset slave->backup and slave->inactive */
3434 read_lock(&bond->lock);
3435 if (bond->slave_cnt > 0) {
3436 read_lock(&bond->curr_slave_lock);
3437 bond_for_each_slave(bond, slave, i) {
3438 if ((bond->params.mode == BOND_MODE_ACTIVEBACKUP)
3439 && (slave != bond->curr_active_slave)) {
3440 bond_set_slave_inactive_flags(slave);
3441 } else {
3442 bond_set_slave_active_flags(slave);
3443 }
3444 }
3445 read_unlock(&bond->curr_slave_lock);
3446 }
3447 read_unlock(&bond->lock);
3448
3449 INIT_DELAYED_WORK(&bond->mcast_work, bond_resend_igmp_join_requests_delayed);
3450
3451 if (bond_is_lb(bond)) {
3452 /* bond_alb_initialize must be called before the timer
3453 * is started.
3454 */
3455 if (bond_alb_initialize(bond, (bond->params.mode == BOND_MODE_ALB))) {
3456 /* something went wrong - fail the open operation */
3457 return -ENOMEM;
3458 }
3459
3460 INIT_DELAYED_WORK(&bond->alb_work, bond_alb_monitor);
3461 queue_delayed_work(bond->wq, &bond->alb_work, 0);
3462 }
3463
3464 if (bond->params.miimon) { /* link check interval, in milliseconds. */
3465 INIT_DELAYED_WORK(&bond->mii_work, bond_mii_monitor);
3466 queue_delayed_work(bond->wq, &bond->mii_work, 0);
3467 }
3468
3469 if (bond->params.arp_interval) { /* arp interval, in milliseconds. */
3470 if (bond->params.mode == BOND_MODE_ACTIVEBACKUP)
3471 INIT_DELAYED_WORK(&bond->arp_work,
3472 bond_activebackup_arp_mon);
3473 else
3474 INIT_DELAYED_WORK(&bond->arp_work,
3475 bond_loadbalance_arp_mon);
3476
3477 queue_delayed_work(bond->wq, &bond->arp_work, 0);
3478 if (bond->params.arp_validate)
3479 bond->recv_probe = bond_arp_rcv;
3480 }
3481
3482 if (bond->params.mode == BOND_MODE_8023AD) {
3483 INIT_DELAYED_WORK(&bond->ad_work, bond_3ad_state_machine_handler);
3484 queue_delayed_work(bond->wq, &bond->ad_work, 0);
3485 /* register to receive LACPDUs */
3486 bond->recv_probe = bond_3ad_lacpdu_recv;
3487 bond_3ad_initiate_agg_selection(bond, 1);
3488 }
3489
3490 return 0;
3491}
3492
3493static int bond_close(struct net_device *bond_dev)
3494{
3495 struct bonding *bond = netdev_priv(bond_dev);
3496
3497 write_lock_bh(&bond->lock);
3498
3499 bond->send_peer_notif = 0;
3500
3501 /* signal timers not to re-arm */
3502 bond->kill_timers = 1;
3503
3504 write_unlock_bh(&bond->lock);
3505
3506 if (bond->params.miimon) { /* link check interval, in milliseconds. */
3507 cancel_delayed_work(&bond->mii_work);
3508 }
3509
3510 if (bond->params.arp_interval) { /* arp interval, in milliseconds. */
3511 cancel_delayed_work(&bond->arp_work);
3512 }
3513
3514 switch (bond->params.mode) {
3515 case BOND_MODE_8023AD:
3516 cancel_delayed_work(&bond->ad_work);
3517 break;
3518 case BOND_MODE_TLB:
3519 case BOND_MODE_ALB:
3520 cancel_delayed_work(&bond->alb_work);
3521 break;
3522 default:
3523 break;
3524 }
3525
3526 if (delayed_work_pending(&bond->mcast_work))
3527 cancel_delayed_work(&bond->mcast_work);
3528
3529 if (bond_is_lb(bond)) {
3530 /* Must be called only after all
3531 * slaves have been released
3532 */
3533 bond_alb_deinitialize(bond);
3534 }
3535 bond->recv_probe = NULL;
3536
3537 return 0;
3538}
3539
3540static struct rtnl_link_stats64 *bond_get_stats(struct net_device *bond_dev,
3541 struct rtnl_link_stats64 *stats)
3542{
3543 struct bonding *bond = netdev_priv(bond_dev);
3544 struct rtnl_link_stats64 temp;
3545 struct slave *slave;
3546 int i;
3547
3548 memset(stats, 0, sizeof(*stats));
3549
3550 read_lock_bh(&bond->lock);
3551
3552 bond_for_each_slave(bond, slave, i) {
3553 const struct rtnl_link_stats64 *sstats =
3554 dev_get_stats(slave->dev, &temp);
3555
3556 stats->rx_packets += sstats->rx_packets;
3557 stats->rx_bytes += sstats->rx_bytes;
3558 stats->rx_errors += sstats->rx_errors;
3559 stats->rx_dropped += sstats->rx_dropped;
3560
3561 stats->tx_packets += sstats->tx_packets;
3562 stats->tx_bytes += sstats->tx_bytes;
3563 stats->tx_errors += sstats->tx_errors;
3564 stats->tx_dropped += sstats->tx_dropped;
3565
3566 stats->multicast += sstats->multicast;
3567 stats->collisions += sstats->collisions;
3568
3569 stats->rx_length_errors += sstats->rx_length_errors;
3570 stats->rx_over_errors += sstats->rx_over_errors;
3571 stats->rx_crc_errors += sstats->rx_crc_errors;
3572 stats->rx_frame_errors += sstats->rx_frame_errors;
3573 stats->rx_fifo_errors += sstats->rx_fifo_errors;
3574 stats->rx_missed_errors += sstats->rx_missed_errors;
3575
3576 stats->tx_aborted_errors += sstats->tx_aborted_errors;
3577 stats->tx_carrier_errors += sstats->tx_carrier_errors;
3578 stats->tx_fifo_errors += sstats->tx_fifo_errors;
3579 stats->tx_heartbeat_errors += sstats->tx_heartbeat_errors;
3580 stats->tx_window_errors += sstats->tx_window_errors;
3581 }
3582
3583 read_unlock_bh(&bond->lock);
3584
3585 return stats;
3586}
3587
3588static int bond_do_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
3589{
3590 struct net_device *slave_dev = NULL;
3591 struct ifbond k_binfo;
3592 struct ifbond __user *u_binfo = NULL;
3593 struct ifslave k_sinfo;
3594 struct ifslave __user *u_sinfo = NULL;
3595 struct mii_ioctl_data *mii = NULL;
3596 int res = 0;
3597
3598 pr_debug("bond_ioctl: master=%s, cmd=%d\n", bond_dev->name, cmd);
3599
3600 switch (cmd) {
3601 case SIOCGMIIPHY:
3602 mii = if_mii(ifr);
3603 if (!mii)
3604 return -EINVAL;
3605
3606 mii->phy_id = 0;
3607 /* Fall Through */
3608 case SIOCGMIIREG:
3609 /*
3610 * We do this again just in case we were called by SIOCGMIIREG
3611 * instead of SIOCGMIIPHY.
3612 */
3613 mii = if_mii(ifr);
3614 if (!mii)
3615 return -EINVAL;
3616
3617
3618 if (mii->reg_num == 1) {
3619 struct bonding *bond = netdev_priv(bond_dev);
3620 mii->val_out = 0;
3621 read_lock(&bond->lock);
3622 read_lock(&bond->curr_slave_lock);
3623 if (netif_carrier_ok(bond->dev))
3624 mii->val_out = BMSR_LSTATUS;
3625
3626 read_unlock(&bond->curr_slave_lock);
3627 read_unlock(&bond->lock);
3628 }
3629
3630 return 0;
3631 case BOND_INFO_QUERY_OLD:
3632 case SIOCBONDINFOQUERY:
3633 u_binfo = (struct ifbond __user *)ifr->ifr_data;
3634
3635 if (copy_from_user(&k_binfo, u_binfo, sizeof(ifbond)))
3636 return -EFAULT;
3637
3638 res = bond_info_query(bond_dev, &k_binfo);
3639 if (res == 0 &&
3640 copy_to_user(u_binfo, &k_binfo, sizeof(ifbond)))
3641 return -EFAULT;
3642
3643 return res;
3644 case BOND_SLAVE_INFO_QUERY_OLD:
3645 case SIOCBONDSLAVEINFOQUERY:
3646 u_sinfo = (struct ifslave __user *)ifr->ifr_data;
3647
3648 if (copy_from_user(&k_sinfo, u_sinfo, sizeof(ifslave)))
3649 return -EFAULT;
3650
3651 res = bond_slave_info_query(bond_dev, &k_sinfo);
3652 if (res == 0 &&
3653 copy_to_user(u_sinfo, &k_sinfo, sizeof(ifslave)))
3654 return -EFAULT;
3655
3656 return res;
3657 default:
3658 /* Go on */
3659 break;
3660 }
3661
3662 if (!capable(CAP_NET_ADMIN))
3663 return -EPERM;
3664
3665 slave_dev = dev_get_by_name(dev_net(bond_dev), ifr->ifr_slave);
3666
3667 pr_debug("slave_dev=%p:\n", slave_dev);
3668
3669 if (!slave_dev)
3670 res = -ENODEV;
3671 else {
3672 pr_debug("slave_dev->name=%s:\n", slave_dev->name);
3673 switch (cmd) {
3674 case BOND_ENSLAVE_OLD:
3675 case SIOCBONDENSLAVE:
3676 res = bond_enslave(bond_dev, slave_dev);
3677 break;
3678 case BOND_RELEASE_OLD:
3679 case SIOCBONDRELEASE:
3680 res = bond_release(bond_dev, slave_dev);
3681 break;
3682 case BOND_SETHWADDR_OLD:
3683 case SIOCBONDSETHWADDR:
3684 res = bond_sethwaddr(bond_dev, slave_dev);
3685 break;
3686 case BOND_CHANGE_ACTIVE_OLD:
3687 case SIOCBONDCHANGEACTIVE:
3688 res = bond_ioctl_change_active(bond_dev, slave_dev);
3689 break;
3690 default:
3691 res = -EOPNOTSUPP;
3692 }
3693
3694 dev_put(slave_dev);
3695 }
3696
3697 return res;
3698}
3699
3700static bool bond_addr_in_mc_list(unsigned char *addr,
3701 struct netdev_hw_addr_list *list,
3702 int addrlen)
3703{
3704 struct netdev_hw_addr *ha;
3705
3706 netdev_hw_addr_list_for_each(ha, list)
3707 if (!memcmp(ha->addr, addr, addrlen))
3708 return true;
3709
3710 return false;
3711}
3712
3713static void bond_set_multicast_list(struct net_device *bond_dev)
3714{
3715 struct bonding *bond = netdev_priv(bond_dev);
3716 struct netdev_hw_addr *ha;
3717 bool found;
3718
3719 /*
3720 * Do promisc before checking multicast_mode
3721 */
3722 if ((bond_dev->flags & IFF_PROMISC) && !(bond->flags & IFF_PROMISC))
3723 /*
3724 * FIXME: Need to handle the error when one of the multi-slaves
3725 * encounters error.
3726 */
3727 bond_set_promiscuity(bond, 1);
3728
3729
3730 if (!(bond_dev->flags & IFF_PROMISC) && (bond->flags & IFF_PROMISC))
3731 bond_set_promiscuity(bond, -1);
3732
3733
3734 /* set allmulti flag to slaves */
3735 if ((bond_dev->flags & IFF_ALLMULTI) && !(bond->flags & IFF_ALLMULTI))
3736 /*
3737 * FIXME: Need to handle the error when one of the multi-slaves
3738 * encounters error.
3739 */
3740 bond_set_allmulti(bond, 1);
3741
3742
3743 if (!(bond_dev->flags & IFF_ALLMULTI) && (bond->flags & IFF_ALLMULTI))
3744 bond_set_allmulti(bond, -1);
3745
3746
3747 read_lock(&bond->lock);
3748
3749 bond->flags = bond_dev->flags;
3750
3751 /* looking for addresses to add to slaves' mc list */
3752 netdev_for_each_mc_addr(ha, bond_dev) {
3753 found = bond_addr_in_mc_list(ha->addr, &bond->mc_list,
3754 bond_dev->addr_len);
3755 if (!found)
3756 bond_mc_add(bond, ha->addr);
3757 }
3758
3759 /* looking for addresses to delete from slaves' list */
3760 netdev_hw_addr_list_for_each(ha, &bond->mc_list) {
3761 found = bond_addr_in_mc_list(ha->addr, &bond_dev->mc,
3762 bond_dev->addr_len);
3763 if (!found)
3764 bond_mc_del(bond, ha->addr);
3765 }
3766
3767 /* save master's multicast list */
3768 __hw_addr_flush(&bond->mc_list);
3769 __hw_addr_add_multiple(&bond->mc_list, &bond_dev->mc,
3770 bond_dev->addr_len, NETDEV_HW_ADDR_T_MULTICAST);
3771
3772 read_unlock(&bond->lock);
3773}
3774
3775static int bond_neigh_setup(struct net_device *dev, struct neigh_parms *parms)
3776{
3777 struct bonding *bond = netdev_priv(dev);
3778 struct slave *slave = bond->first_slave;
3779
3780 if (slave) {
3781 const struct net_device_ops *slave_ops
3782 = slave->dev->netdev_ops;
3783 if (slave_ops->ndo_neigh_setup)
3784 return slave_ops->ndo_neigh_setup(slave->dev, parms);
3785 }
3786 return 0;
3787}
3788
3789/*
3790 * Change the MTU of all of a master's slaves to match the master
3791 */
3792static int bond_change_mtu(struct net_device *bond_dev, int new_mtu)
3793{
3794 struct bonding *bond = netdev_priv(bond_dev);
3795 struct slave *slave, *stop_at;
3796 int res = 0;
3797 int i;
3798
3799 pr_debug("bond=%p, name=%s, new_mtu=%d\n", bond,
3800 (bond_dev ? bond_dev->name : "None"), new_mtu);
3801
3802 /* Can't hold bond->lock with bh disabled here since
3803 * some base drivers panic. On the other hand we can't
3804 * hold bond->lock without bh disabled because we'll
3805 * deadlock. The only solution is to rely on the fact
3806 * that we're under rtnl_lock here, and the slaves
3807 * list won't change. This doesn't solve the problem
3808 * of setting the slave's MTU while it is
3809 * transmitting, but the assumption is that the base
3810 * driver can handle that.
3811 *
3812 * TODO: figure out a way to safely iterate the slaves
3813 * list, but without holding a lock around the actual
3814 * call to the base driver.
3815 */
3816
3817 bond_for_each_slave(bond, slave, i) {
3818 pr_debug("s %p s->p %p c_m %p\n",
3819 slave,
3820 slave->prev,
3821 slave->dev->netdev_ops->ndo_change_mtu);
3822
3823 res = dev_set_mtu(slave->dev, new_mtu);
3824
3825 if (res) {
3826 /* If we failed to set the slave's mtu to the new value
3827 * we must abort the operation even in ACTIVE_BACKUP
3828 * mode, because if we allow the backup slaves to have
3829 * different mtu values than the active slave we'll
3830 * need to change their mtu when doing a failover. That
3831 * means changing their mtu from timer context, which
3832 * is probably not a good idea.
3833 */
3834 pr_debug("err %d %s\n", res, slave->dev->name);
3835 goto unwind;
3836 }
3837 }
3838
3839 bond_dev->mtu = new_mtu;
3840
3841 return 0;
3842
3843unwind:
3844 /* unwind from head to the slave that failed */
3845 stop_at = slave;
3846 bond_for_each_slave_from_to(bond, slave, i, bond->first_slave, stop_at) {
3847 int tmp_res;
3848
3849 tmp_res = dev_set_mtu(slave->dev, bond_dev->mtu);
3850 if (tmp_res) {
3851 pr_debug("unwind err %d dev %s\n",
3852 tmp_res, slave->dev->name);
3853 }
3854 }
3855
3856 return res;
3857}
3858
3859/*
3860 * Change HW address
3861 *
3862 * Note that many devices must be down to change the HW address, and
3863 * downing the master releases all slaves. We can make bonds full of
3864 * bonding devices to test this, however.
3865 */
3866static int bond_set_mac_address(struct net_device *bond_dev, void *addr)
3867{
3868 struct bonding *bond = netdev_priv(bond_dev);
3869 struct sockaddr *sa = addr, tmp_sa;
3870 struct slave *slave, *stop_at;
3871 int res = 0;
3872 int i;
3873
3874 if (bond->params.mode == BOND_MODE_ALB)
3875 return bond_alb_set_mac_address(bond_dev, addr);
3876
3877
3878 pr_debug("bond=%p, name=%s\n",
3879 bond, bond_dev ? bond_dev->name : "None");
3880
3881 /*
3882 * If fail_over_mac is set to active, do nothing and return
3883 * success. Returning an error causes ifenslave to fail.
3884 */
3885 if (bond->params.fail_over_mac == BOND_FOM_ACTIVE)
3886 return 0;
3887
3888 if (!is_valid_ether_addr(sa->sa_data))
3889 return -EADDRNOTAVAIL;
3890
3891 /* Can't hold bond->lock with bh disabled here since
3892 * some base drivers panic. On the other hand we can't
3893 * hold bond->lock without bh disabled because we'll
3894 * deadlock. The only solution is to rely on the fact
3895 * that we're under rtnl_lock here, and the slaves
3896 * list won't change. This doesn't solve the problem
3897 * of setting the slave's hw address while it is
3898 * transmitting, but the assumption is that the base
3899 * driver can handle that.
3900 *
3901 * TODO: figure out a way to safely iterate the slaves
3902 * list, but without holding a lock around the actual
3903 * call to the base driver.
3904 */
3905
3906 bond_for_each_slave(bond, slave, i) {
3907 const struct net_device_ops *slave_ops = slave->dev->netdev_ops;
3908 pr_debug("slave %p %s\n", slave, slave->dev->name);
3909
3910 if (slave_ops->ndo_set_mac_address == NULL) {
3911 res = -EOPNOTSUPP;
3912 pr_debug("EOPNOTSUPP %s\n", slave->dev->name);
3913 goto unwind;
3914 }
3915
3916 res = dev_set_mac_address(slave->dev, addr);
3917 if (res) {
3918 /* TODO: consider downing the slave
3919 * and retry ?
3920 * User should expect communications
3921 * breakage anyway until ARP finish
3922 * updating, so...
3923 */
3924 pr_debug("err %d %s\n", res, slave->dev->name);
3925 goto unwind;
3926 }
3927 }
3928
3929 /* success */
3930 memcpy(bond_dev->dev_addr, sa->sa_data, bond_dev->addr_len);
3931 return 0;
3932
3933unwind:
3934 memcpy(tmp_sa.sa_data, bond_dev->dev_addr, bond_dev->addr_len);
3935 tmp_sa.sa_family = bond_dev->type;
3936
3937 /* unwind from head to the slave that failed */
3938 stop_at = slave;
3939 bond_for_each_slave_from_to(bond, slave, i, bond->first_slave, stop_at) {
3940 int tmp_res;
3941
3942 tmp_res = dev_set_mac_address(slave->dev, &tmp_sa);
3943 if (tmp_res) {
3944 pr_debug("unwind err %d dev %s\n",
3945 tmp_res, slave->dev->name);
3946 }
3947 }
3948
3949 return res;
3950}
3951
3952static int bond_xmit_roundrobin(struct sk_buff *skb, struct net_device *bond_dev)
3953{
3954 struct bonding *bond = netdev_priv(bond_dev);
3955 struct slave *slave, *start_at;
3956 int i, slave_no, res = 1;
3957 struct iphdr *iph = ip_hdr(skb);
3958
3959 /*
3960 * Start with the curr_active_slave that joined the bond as the
3961 * default for sending IGMP traffic. For failover purposes one
3962 * needs to maintain some consistency for the interface that will
3963 * send the join/membership reports. The curr_active_slave found
3964 * will send all of this type of traffic.
3965 */
3966 if ((iph->protocol == IPPROTO_IGMP) &&
3967 (skb->protocol == htons(ETH_P_IP))) {
3968
3969 read_lock(&bond->curr_slave_lock);
3970 slave = bond->curr_active_slave;
3971 read_unlock(&bond->curr_slave_lock);
3972
3973 if (!slave)
3974 goto out;
3975 } else {
3976 /*
3977 * Concurrent TX may collide on rr_tx_counter; we accept
3978 * that as being rare enough not to justify using an
3979 * atomic op here.
3980 */
3981 slave_no = bond->rr_tx_counter++ % bond->slave_cnt;
3982
3983 bond_for_each_slave(bond, slave, i) {
3984 slave_no--;
3985 if (slave_no < 0)
3986 break;
3987 }
3988 }
3989
3990 start_at = slave;
3991 bond_for_each_slave_from(bond, slave, i, start_at) {
3992 if (IS_UP(slave->dev) &&
3993 (slave->link == BOND_LINK_UP) &&
3994 bond_is_active_slave(slave)) {
3995 res = bond_dev_queue_xmit(bond, skb, slave->dev);
3996 break;
3997 }
3998 }
3999
4000out:
4001 if (res) {
4002 /* no suitable interface, frame not sent */
4003 dev_kfree_skb(skb);
4004 }
4005
4006 return NETDEV_TX_OK;
4007}
4008
4009
4010/*
4011 * in active-backup mode, we know that bond->curr_active_slave is always valid if
4012 * the bond has a usable interface.
4013 */
4014static int bond_xmit_activebackup(struct sk_buff *skb, struct net_device *bond_dev)
4015{
4016 struct bonding *bond = netdev_priv(bond_dev);
4017 int res = 1;
4018
4019 read_lock(&bond->curr_slave_lock);
4020
4021 if (bond->curr_active_slave)
4022 res = bond_dev_queue_xmit(bond, skb,
4023 bond->curr_active_slave->dev);
4024
4025 if (res)
4026 /* no suitable interface, frame not sent */
4027 dev_kfree_skb(skb);
4028
4029 read_unlock(&bond->curr_slave_lock);
4030
4031 return NETDEV_TX_OK;
4032}
4033
4034/*
4035 * In bond_xmit_xor() , we determine the output device by using a pre-
4036 * determined xmit_hash_policy(), If the selected device is not enabled,
4037 * find the next active slave.
4038 */
4039static int bond_xmit_xor(struct sk_buff *skb, struct net_device *bond_dev)
4040{
4041 struct bonding *bond = netdev_priv(bond_dev);
4042 struct slave *slave, *start_at;
4043 int slave_no;
4044 int i;
4045 int res = 1;
4046
4047 slave_no = bond->xmit_hash_policy(skb, bond->slave_cnt);
4048
4049 bond_for_each_slave(bond, slave, i) {
4050 slave_no--;
4051 if (slave_no < 0)
4052 break;
4053 }
4054
4055 start_at = slave;
4056
4057 bond_for_each_slave_from(bond, slave, i, start_at) {
4058 if (IS_UP(slave->dev) &&
4059 (slave->link == BOND_LINK_UP) &&
4060 bond_is_active_slave(slave)) {
4061 res = bond_dev_queue_xmit(bond, skb, slave->dev);
4062 break;
4063 }
4064 }
4065
4066 if (res) {
4067 /* no suitable interface, frame not sent */
4068 dev_kfree_skb(skb);
4069 }
4070
4071 return NETDEV_TX_OK;
4072}
4073
4074/*
4075 * in broadcast mode, we send everything to all usable interfaces.
4076 */
4077static int bond_xmit_broadcast(struct sk_buff *skb, struct net_device *bond_dev)
4078{
4079 struct bonding *bond = netdev_priv(bond_dev);
4080 struct slave *slave, *start_at;
4081 struct net_device *tx_dev = NULL;
4082 int i;
4083 int res = 1;
4084
4085 read_lock(&bond->curr_slave_lock);
4086 start_at = bond->curr_active_slave;
4087 read_unlock(&bond->curr_slave_lock);
4088
4089 if (!start_at)
4090 goto out;
4091
4092 bond_for_each_slave_from(bond, slave, i, start_at) {
4093 if (IS_UP(slave->dev) &&
4094 (slave->link == BOND_LINK_UP) &&
4095 bond_is_active_slave(slave)) {
4096 if (tx_dev) {
4097 struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
4098 if (!skb2) {
4099 pr_err("%s: Error: bond_xmit_broadcast(): skb_clone() failed\n",
4100 bond_dev->name);
4101 continue;
4102 }
4103
4104 res = bond_dev_queue_xmit(bond, skb2, tx_dev);
4105 if (res) {
4106 dev_kfree_skb(skb2);
4107 continue;
4108 }
4109 }
4110 tx_dev = slave->dev;
4111 }
4112 }
4113
4114 if (tx_dev)
4115 res = bond_dev_queue_xmit(bond, skb, tx_dev);
4116
4117out:
4118 if (res)
4119 /* no suitable interface, frame not sent */
4120 dev_kfree_skb(skb);
4121
4122 /* frame sent to all suitable interfaces */
4123 return NETDEV_TX_OK;
4124}
4125
4126/*------------------------- Device initialization ---------------------------*/
4127
4128static void bond_set_xmit_hash_policy(struct bonding *bond)
4129{
4130 switch (bond->params.xmit_policy) {
4131 case BOND_XMIT_POLICY_LAYER23:
4132 bond->xmit_hash_policy = bond_xmit_hash_policy_l23;
4133 break;
4134 case BOND_XMIT_POLICY_LAYER34:
4135 bond->xmit_hash_policy = bond_xmit_hash_policy_l34;
4136 break;
4137 case BOND_XMIT_POLICY_LAYER2:
4138 default:
4139 bond->xmit_hash_policy = bond_xmit_hash_policy_l2;
4140 break;
4141 }
4142}
4143
4144/*
4145 * Lookup the slave that corresponds to a qid
4146 */
4147static inline int bond_slave_override(struct bonding *bond,
4148 struct sk_buff *skb)
4149{
4150 int i, res = 1;
4151 struct slave *slave = NULL;
4152 struct slave *check_slave;
4153
4154 if (!skb->queue_mapping)
4155 return 1;
4156
4157 /* Find out if any slaves have the same mapping as this skb. */
4158 bond_for_each_slave(bond, check_slave, i) {
4159 if (check_slave->queue_id == skb->queue_mapping) {
4160 slave = check_slave;
4161 break;
4162 }
4163 }
4164
4165 /* If the slave isn't UP, use default transmit policy. */
4166 if (slave && slave->queue_id && IS_UP(slave->dev) &&
4167 (slave->link == BOND_LINK_UP)) {
4168 res = bond_dev_queue_xmit(bond, skb, slave->dev);
4169 }
4170
4171 return res;
4172}
4173
4174
4175static u16 bond_select_queue(struct net_device *dev, struct sk_buff *skb)
4176{
4177 /*
4178 * This helper function exists to help dev_pick_tx get the correct
4179 * destination queue. Using a helper function skips a call to
4180 * skb_tx_hash and will put the skbs in the queue we expect on their
4181 * way down to the bonding driver.
4182 */
4183 u16 txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;
4184
4185 /*
4186 * Save the original txq to restore before passing to the driver
4187 */
4188 bond_queue_mapping(skb) = skb->queue_mapping;
4189
4190 if (unlikely(txq >= dev->real_num_tx_queues)) {
4191 do {
4192 txq -= dev->real_num_tx_queues;
4193 } while (txq >= dev->real_num_tx_queues);
4194 }
4195 return txq;
4196}
4197
4198static netdev_tx_t __bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
4199{
4200 struct bonding *bond = netdev_priv(dev);
4201
4202 if (TX_QUEUE_OVERRIDE(bond->params.mode)) {
4203 if (!bond_slave_override(bond, skb))
4204 return NETDEV_TX_OK;
4205 }
4206
4207 switch (bond->params.mode) {
4208 case BOND_MODE_ROUNDROBIN:
4209 return bond_xmit_roundrobin(skb, dev);
4210 case BOND_MODE_ACTIVEBACKUP:
4211 return bond_xmit_activebackup(skb, dev);
4212 case BOND_MODE_XOR:
4213 return bond_xmit_xor(skb, dev);
4214 case BOND_MODE_BROADCAST:
4215 return bond_xmit_broadcast(skb, dev);
4216 case BOND_MODE_8023AD:
4217 return bond_3ad_xmit_xor(skb, dev);
4218 case BOND_MODE_ALB:
4219 case BOND_MODE_TLB:
4220 return bond_alb_xmit(skb, dev);
4221 default:
4222 /* Should never happen, mode already checked */
4223 pr_err("%s: Error: Unknown bonding mode %d\n",
4224 dev->name, bond->params.mode);
4225 WARN_ON_ONCE(1);
4226 dev_kfree_skb(skb);
4227 return NETDEV_TX_OK;
4228 }
4229}
4230
4231static netdev_tx_t bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
4232{
4233 struct bonding *bond = netdev_priv(dev);
4234 netdev_tx_t ret = NETDEV_TX_OK;
4235
4236 /*
4237 * If we risk deadlock from transmitting this in the
4238 * netpoll path, tell netpoll to queue the frame for later tx
4239 */
4240 if (is_netpoll_tx_blocked(dev))
4241 return NETDEV_TX_BUSY;
4242
4243 read_lock(&bond->lock);
4244
4245 if (bond->slave_cnt)
4246 ret = __bond_start_xmit(skb, dev);
4247 else
4248 dev_kfree_skb(skb);
4249
4250 read_unlock(&bond->lock);
4251
4252 return ret;
4253}
4254
4255/*
4256 * set bond mode specific net device operations
4257 */
4258void bond_set_mode_ops(struct bonding *bond, int mode)
4259{
4260 struct net_device *bond_dev = bond->dev;
4261
4262 switch (mode) {
4263 case BOND_MODE_ROUNDROBIN:
4264 break;
4265 case BOND_MODE_ACTIVEBACKUP:
4266 break;
4267 case BOND_MODE_XOR:
4268 bond_set_xmit_hash_policy(bond);
4269 break;
4270 case BOND_MODE_BROADCAST:
4271 break;
4272 case BOND_MODE_8023AD:
4273 bond_set_xmit_hash_policy(bond);
4274 break;
4275 case BOND_MODE_ALB:
4276 /* FALLTHRU */
4277 case BOND_MODE_TLB:
4278 break;
4279 default:
4280 /* Should never happen, mode already checked */
4281 pr_err("%s: Error: Unknown bonding mode %d\n",
4282 bond_dev->name, mode);
4283 break;
4284 }
4285}
4286
4287static void bond_ethtool_get_drvinfo(struct net_device *bond_dev,
4288 struct ethtool_drvinfo *drvinfo)
4289{
4290 strncpy(drvinfo->driver, DRV_NAME, 32);
4291 strncpy(drvinfo->version, DRV_VERSION, 32);
4292 snprintf(drvinfo->fw_version, 32, "%d", BOND_ABI_VERSION);
4293}
4294
4295static const struct ethtool_ops bond_ethtool_ops = {
4296 .get_drvinfo = bond_ethtool_get_drvinfo,
4297 .get_link = ethtool_op_get_link,
4298};
4299
4300static const struct net_device_ops bond_netdev_ops = {
4301 .ndo_init = bond_init,
4302 .ndo_uninit = bond_uninit,
4303 .ndo_open = bond_open,
4304 .ndo_stop = bond_close,
4305 .ndo_start_xmit = bond_start_xmit,
4306 .ndo_select_queue = bond_select_queue,
4307 .ndo_get_stats64 = bond_get_stats,
4308 .ndo_do_ioctl = bond_do_ioctl,
4309 .ndo_set_multicast_list = bond_set_multicast_list,
4310 .ndo_change_mtu = bond_change_mtu,
4311 .ndo_set_mac_address = bond_set_mac_address,
4312 .ndo_neigh_setup = bond_neigh_setup,
4313 .ndo_vlan_rx_add_vid = bond_vlan_rx_add_vid,
4314 .ndo_vlan_rx_kill_vid = bond_vlan_rx_kill_vid,
4315#ifdef CONFIG_NET_POLL_CONTROLLER
4316 .ndo_netpoll_setup = bond_netpoll_setup,
4317 .ndo_netpoll_cleanup = bond_netpoll_cleanup,
4318 .ndo_poll_controller = bond_poll_controller,
4319#endif
4320 .ndo_add_slave = bond_enslave,
4321 .ndo_del_slave = bond_release,
4322 .ndo_fix_features = bond_fix_features,
4323};
4324
4325static void bond_destructor(struct net_device *bond_dev)
4326{
4327 struct bonding *bond = netdev_priv(bond_dev);
4328 if (bond->wq)
4329 destroy_workqueue(bond->wq);
4330 free_netdev(bond_dev);
4331}
4332
4333static void bond_setup(struct net_device *bond_dev)
4334{
4335 struct bonding *bond = netdev_priv(bond_dev);
4336
4337 /* initialize rwlocks */
4338 rwlock_init(&bond->lock);
4339 rwlock_init(&bond->curr_slave_lock);
4340
4341 bond->params = bonding_defaults;
4342
4343 /* Initialize pointers */
4344 bond->dev = bond_dev;
4345 INIT_LIST_HEAD(&bond->vlan_list);
4346
4347 /* Initialize the device entry points */
4348 ether_setup(bond_dev);
4349 bond_dev->netdev_ops = &bond_netdev_ops;
4350 bond_dev->ethtool_ops = &bond_ethtool_ops;
4351 bond_set_mode_ops(bond, bond->params.mode);
4352
4353 bond_dev->destructor = bond_destructor;
4354
4355 /* Initialize the device options */
4356 bond_dev->tx_queue_len = 0;
4357 bond_dev->flags |= IFF_MASTER|IFF_MULTICAST;
4358 bond_dev->priv_flags |= IFF_BONDING;
4359 bond_dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
4360
4361 /* At first, we block adding VLANs. That's the only way to
4362 * prevent problems that occur when adding VLANs over an
4363 * empty bond. The block will be removed once non-challenged
4364 * slaves are enslaved.
4365 */
4366 bond_dev->features |= NETIF_F_VLAN_CHALLENGED;
4367
4368 /* don't acquire bond device's netif_tx_lock when
4369 * transmitting */
4370 bond_dev->features |= NETIF_F_LLTX;
4371
4372 /* By default, we declare the bond to be fully
4373 * VLAN hardware accelerated capable. Special
4374 * care is taken in the various xmit functions
4375 * when there are slaves that are not hw accel
4376 * capable
4377 */
4378
4379 bond_dev->hw_features = BOND_VLAN_FEATURES |
4380 NETIF_F_HW_VLAN_TX |
4381 NETIF_F_HW_VLAN_RX |
4382 NETIF_F_HW_VLAN_FILTER;
4383
4384 bond_dev->hw_features &= ~(NETIF_F_ALL_CSUM & ~NETIF_F_NO_CSUM);
4385 bond_dev->features |= bond_dev->hw_features;
4386}
4387
4388static void bond_work_cancel_all(struct bonding *bond)
4389{
4390 write_lock_bh(&bond->lock);
4391 bond->kill_timers = 1;
4392 write_unlock_bh(&bond->lock);
4393
4394 if (bond->params.miimon && delayed_work_pending(&bond->mii_work))
4395 cancel_delayed_work(&bond->mii_work);
4396
4397 if (bond->params.arp_interval && delayed_work_pending(&bond->arp_work))
4398 cancel_delayed_work(&bond->arp_work);
4399
4400 if (bond->params.mode == BOND_MODE_ALB &&
4401 delayed_work_pending(&bond->alb_work))
4402 cancel_delayed_work(&bond->alb_work);
4403
4404 if (bond->params.mode == BOND_MODE_8023AD &&
4405 delayed_work_pending(&bond->ad_work))
4406 cancel_delayed_work(&bond->ad_work);
4407
4408 if (delayed_work_pending(&bond->mcast_work))
4409 cancel_delayed_work(&bond->mcast_work);
4410}
4411
4412/*
4413* Destroy a bonding device.
4414* Must be under rtnl_lock when this function is called.
4415*/
4416static void bond_uninit(struct net_device *bond_dev)
4417{
4418 struct bonding *bond = netdev_priv(bond_dev);
4419 struct vlan_entry *vlan, *tmp;
4420
4421 bond_netpoll_cleanup(bond_dev);
4422
4423 /* Release the bonded slaves */
4424 bond_release_all(bond_dev);
4425
4426 list_del(&bond->bond_list);
4427
4428 bond_work_cancel_all(bond);
4429
4430 bond_remove_proc_entry(bond);
4431
4432 bond_debug_unregister(bond);
4433
4434 __hw_addr_flush(&bond->mc_list);
4435
4436 list_for_each_entry_safe(vlan, tmp, &bond->vlan_list, vlan_list) {
4437 list_del(&vlan->vlan_list);
4438 kfree(vlan);
4439 }
4440}
4441
4442/*------------------------- Module initialization ---------------------------*/
4443
4444/*
4445 * Convert string input module parms. Accept either the
4446 * number of the mode or its string name. A bit complicated because
4447 * some mode names are substrings of other names, and calls from sysfs
4448 * may have whitespace in the name (trailing newlines, for example).
4449 */
4450int bond_parse_parm(const char *buf, const struct bond_parm_tbl *tbl)
4451{
4452 int modeint = -1, i, rv;
4453 char *p, modestr[BOND_MAX_MODENAME_LEN + 1] = { 0, };
4454
4455 for (p = (char *)buf; *p; p++)
4456 if (!(isdigit(*p) || isspace(*p)))
4457 break;
4458
4459 if (*p)
4460 rv = sscanf(buf, "%20s", modestr);
4461 else
4462 rv = sscanf(buf, "%d", &modeint);
4463
4464 if (!rv)
4465 return -1;
4466
4467 for (i = 0; tbl[i].modename; i++) {
4468 if (modeint == tbl[i].mode)
4469 return tbl[i].mode;
4470 if (strcmp(modestr, tbl[i].modename) == 0)
4471 return tbl[i].mode;
4472 }
4473
4474 return -1;
4475}
4476
4477static int bond_check_params(struct bond_params *params)
4478{
4479 int arp_validate_value, fail_over_mac_value, primary_reselect_value;
4480
4481 /*
4482 * Convert string parameters.
4483 */
4484 if (mode) {
4485 bond_mode = bond_parse_parm(mode, bond_mode_tbl);
4486 if (bond_mode == -1) {
4487 pr_err("Error: Invalid bonding mode \"%s\"\n",
4488 mode == NULL ? "NULL" : mode);
4489 return -EINVAL;
4490 }
4491 }
4492
4493 if (xmit_hash_policy) {
4494 if ((bond_mode != BOND_MODE_XOR) &&
4495 (bond_mode != BOND_MODE_8023AD)) {
4496 pr_info("xmit_hash_policy param is irrelevant in mode %s\n",
4497 bond_mode_name(bond_mode));
4498 } else {
4499 xmit_hashtype = bond_parse_parm(xmit_hash_policy,
4500 xmit_hashtype_tbl);
4501 if (xmit_hashtype == -1) {
4502 pr_err("Error: Invalid xmit_hash_policy \"%s\"\n",
4503 xmit_hash_policy == NULL ? "NULL" :
4504 xmit_hash_policy);
4505 return -EINVAL;
4506 }
4507 }
4508 }
4509
4510 if (lacp_rate) {
4511 if (bond_mode != BOND_MODE_8023AD) {
4512 pr_info("lacp_rate param is irrelevant in mode %s\n",
4513 bond_mode_name(bond_mode));
4514 } else {
4515 lacp_fast = bond_parse_parm(lacp_rate, bond_lacp_tbl);
4516 if (lacp_fast == -1) {
4517 pr_err("Error: Invalid lacp rate \"%s\"\n",
4518 lacp_rate == NULL ? "NULL" : lacp_rate);
4519 return -EINVAL;
4520 }
4521 }
4522 }
4523
4524 if (ad_select) {
4525 params->ad_select = bond_parse_parm(ad_select, ad_select_tbl);
4526 if (params->ad_select == -1) {
4527 pr_err("Error: Invalid ad_select \"%s\"\n",
4528 ad_select == NULL ? "NULL" : ad_select);
4529 return -EINVAL;
4530 }
4531
4532 if (bond_mode != BOND_MODE_8023AD) {
4533 pr_warning("ad_select param only affects 802.3ad mode\n");
4534 }
4535 } else {
4536 params->ad_select = BOND_AD_STABLE;
4537 }
4538
4539 if (max_bonds < 0) {
4540 pr_warning("Warning: max_bonds (%d) not in range %d-%d, so it was reset to BOND_DEFAULT_MAX_BONDS (%d)\n",
4541 max_bonds, 0, INT_MAX, BOND_DEFAULT_MAX_BONDS);
4542 max_bonds = BOND_DEFAULT_MAX_BONDS;
4543 }
4544
4545 if (miimon < 0) {
4546 pr_warning("Warning: miimon module parameter (%d), not in range 0-%d, so it was reset to %d\n",
4547 miimon, INT_MAX, BOND_LINK_MON_INTERV);
4548 miimon = BOND_LINK_MON_INTERV;
4549 }
4550
4551 if (updelay < 0) {
4552 pr_warning("Warning: updelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
4553 updelay, INT_MAX);
4554 updelay = 0;
4555 }
4556
4557 if (downdelay < 0) {
4558 pr_warning("Warning: downdelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
4559 downdelay, INT_MAX);
4560 downdelay = 0;
4561 }
4562
4563 if ((use_carrier != 0) && (use_carrier != 1)) {
4564 pr_warning("Warning: use_carrier module parameter (%d), not of valid value (0/1), so it was set to 1\n",
4565 use_carrier);
4566 use_carrier = 1;
4567 }
4568
4569 if (num_peer_notif < 0 || num_peer_notif > 255) {
4570 pr_warning("Warning: num_grat_arp/num_unsol_na (%d) not in range 0-255 so it was reset to 1\n",
4571 num_peer_notif);
4572 num_peer_notif = 1;
4573 }
4574
4575 /* reset values for 802.3ad */
4576 if (bond_mode == BOND_MODE_8023AD) {
4577 if (!miimon) {
4578 pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure, speed and duplex which are essential for 802.3ad operation\n");
4579 pr_warning("Forcing miimon to 100msec\n");
4580 miimon = 100;
4581 }
4582 }
4583
4584 if (tx_queues < 1 || tx_queues > 255) {
4585 pr_warning("Warning: tx_queues (%d) should be between "
4586 "1 and 255, resetting to %d\n",
4587 tx_queues, BOND_DEFAULT_TX_QUEUES);
4588 tx_queues = BOND_DEFAULT_TX_QUEUES;
4589 }
4590
4591 if ((all_slaves_active != 0) && (all_slaves_active != 1)) {
4592 pr_warning("Warning: all_slaves_active module parameter (%d), "
4593 "not of valid value (0/1), so it was set to "
4594 "0\n", all_slaves_active);
4595 all_slaves_active = 0;
4596 }
4597
4598 if (resend_igmp < 0 || resend_igmp > 255) {
4599 pr_warning("Warning: resend_igmp (%d) should be between "
4600 "0 and 255, resetting to %d\n",
4601 resend_igmp, BOND_DEFAULT_RESEND_IGMP);
4602 resend_igmp = BOND_DEFAULT_RESEND_IGMP;
4603 }
4604
4605 /* reset values for TLB/ALB */
4606 if ((bond_mode == BOND_MODE_TLB) ||
4607 (bond_mode == BOND_MODE_ALB)) {
4608 if (!miimon) {
4609 pr_warning("Warning: miimon must be specified, otherwise bonding will not detect link failure and link speed which are essential for TLB/ALB load balancing\n");
4610 pr_warning("Forcing miimon to 100msec\n");
4611 miimon = 100;
4612 }
4613 }
4614
4615 if (bond_mode == BOND_MODE_ALB) {
4616 pr_notice("In ALB mode you might experience client disconnections upon reconnection of a link if the bonding module updelay parameter (%d msec) is incompatible with the forwarding delay time of the switch\n",
4617 updelay);
4618 }
4619
4620 if (!miimon) {
4621 if (updelay || downdelay) {
4622 /* just warn the user the up/down delay will have
4623 * no effect since miimon is zero...
4624 */
4625 pr_warning("Warning: miimon module parameter not set and updelay (%d) or downdelay (%d) module parameter is set; updelay and downdelay have no effect unless miimon is set\n",
4626 updelay, downdelay);
4627 }
4628 } else {
4629 /* don't allow arp monitoring */
4630 if (arp_interval) {
4631 pr_warning("Warning: miimon (%d) and arp_interval (%d) can't be used simultaneously, disabling ARP monitoring\n",
4632 miimon, arp_interval);
4633 arp_interval = 0;
4634 }
4635
4636 if ((updelay % miimon) != 0) {
4637 pr_warning("Warning: updelay (%d) is not a multiple of miimon (%d), updelay rounded to %d ms\n",
4638 updelay, miimon,
4639 (updelay / miimon) * miimon);
4640 }
4641
4642 updelay /= miimon;
4643
4644 if ((downdelay % miimon) != 0) {
4645 pr_warning("Warning: downdelay (%d) is not a multiple of miimon (%d), downdelay rounded to %d ms\n",
4646 downdelay, miimon,
4647 (downdelay / miimon) * miimon);
4648 }
4649
4650 downdelay /= miimon;
4651 }
4652
4653 if (arp_interval < 0) {
4654 pr_warning("Warning: arp_interval module parameter (%d) , not in range 0-%d, so it was reset to %d\n",
4655 arp_interval, INT_MAX, BOND_LINK_ARP_INTERV);
4656 arp_interval = BOND_LINK_ARP_INTERV;
4657 }
4658
4659 for (arp_ip_count = 0;
4660 (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[arp_ip_count];
4661 arp_ip_count++) {
4662 /* not complete check, but should be good enough to
4663 catch mistakes */
4664 if (!isdigit(arp_ip_target[arp_ip_count][0])) {
4665 pr_warning("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n",
4666 arp_ip_target[arp_ip_count]);
4667 arp_interval = 0;
4668 } else {
4669 __be32 ip = in_aton(arp_ip_target[arp_ip_count]);
4670 arp_target[arp_ip_count] = ip;
4671 }
4672 }
4673
4674 if (arp_interval && !arp_ip_count) {
4675 /* don't allow arping if no arp_ip_target given... */
4676 pr_warning("Warning: arp_interval module parameter (%d) specified without providing an arp_ip_target parameter, arp_interval was reset to 0\n",
4677 arp_interval);
4678 arp_interval = 0;
4679 }
4680
4681 if (arp_validate) {
4682 if (bond_mode != BOND_MODE_ACTIVEBACKUP) {
4683 pr_err("arp_validate only supported in active-backup mode\n");
4684 return -EINVAL;
4685 }
4686 if (!arp_interval) {
4687 pr_err("arp_validate requires arp_interval\n");
4688 return -EINVAL;
4689 }
4690
4691 arp_validate_value = bond_parse_parm(arp_validate,
4692 arp_validate_tbl);
4693 if (arp_validate_value == -1) {
4694 pr_err("Error: invalid arp_validate \"%s\"\n",
4695 arp_validate == NULL ? "NULL" : arp_validate);
4696 return -EINVAL;
4697 }
4698 } else
4699 arp_validate_value = 0;
4700
4701 if (miimon) {
4702 pr_info("MII link monitoring set to %d ms\n", miimon);
4703 } else if (arp_interval) {
4704 int i;
4705
4706 pr_info("ARP monitoring set to %d ms, validate %s, with %d target(s):",
4707 arp_interval,
4708 arp_validate_tbl[arp_validate_value].modename,
4709 arp_ip_count);
4710
4711 for (i = 0; i < arp_ip_count; i++)
4712 pr_info(" %s", arp_ip_target[i]);
4713
4714 pr_info("\n");
4715
4716 } else if (max_bonds) {
4717 /* miimon and arp_interval not set, we need one so things
4718 * work as expected, see bonding.txt for details
4719 */
4720 pr_debug("Warning: either miimon or arp_interval and arp_ip_target module parameters must be specified, otherwise bonding will not detect link failures! see bonding.txt for details.\n");
4721 }
4722
4723 if (primary && !USES_PRIMARY(bond_mode)) {
4724 /* currently, using a primary only makes sense
4725 * in active backup, TLB or ALB modes
4726 */
4727 pr_warning("Warning: %s primary device specified but has no effect in %s mode\n",
4728 primary, bond_mode_name(bond_mode));
4729 primary = NULL;
4730 }
4731
4732 if (primary && primary_reselect) {
4733 primary_reselect_value = bond_parse_parm(primary_reselect,
4734 pri_reselect_tbl);
4735 if (primary_reselect_value == -1) {
4736 pr_err("Error: Invalid primary_reselect \"%s\"\n",
4737 primary_reselect ==
4738 NULL ? "NULL" : primary_reselect);
4739 return -EINVAL;
4740 }
4741 } else {
4742 primary_reselect_value = BOND_PRI_RESELECT_ALWAYS;
4743 }
4744
4745 if (fail_over_mac) {
4746 fail_over_mac_value = bond_parse_parm(fail_over_mac,
4747 fail_over_mac_tbl);
4748 if (fail_over_mac_value == -1) {
4749 pr_err("Error: invalid fail_over_mac \"%s\"\n",
4750 arp_validate == NULL ? "NULL" : arp_validate);
4751 return -EINVAL;
4752 }
4753
4754 if (bond_mode != BOND_MODE_ACTIVEBACKUP)
4755 pr_warning("Warning: fail_over_mac only affects active-backup mode.\n");
4756 } else {
4757 fail_over_mac_value = BOND_FOM_NONE;
4758 }
4759
4760 /* fill params struct with the proper values */
4761 params->mode = bond_mode;
4762 params->xmit_policy = xmit_hashtype;
4763 params->miimon = miimon;
4764 params->num_peer_notif = num_peer_notif;
4765 params->arp_interval = arp_interval;
4766 params->arp_validate = arp_validate_value;
4767 params->updelay = updelay;
4768 params->downdelay = downdelay;
4769 params->use_carrier = use_carrier;
4770 params->lacp_fast = lacp_fast;
4771 params->primary[0] = 0;
4772 params->primary_reselect = primary_reselect_value;
4773 params->fail_over_mac = fail_over_mac_value;
4774 params->tx_queues = tx_queues;
4775 params->all_slaves_active = all_slaves_active;
4776 params->resend_igmp = resend_igmp;
4777 params->min_links = min_links;
4778
4779 if (primary) {
4780 strncpy(params->primary, primary, IFNAMSIZ);
4781 params->primary[IFNAMSIZ - 1] = 0;
4782 }
4783
4784 memcpy(params->arp_targets, arp_target, sizeof(arp_target));
4785
4786 return 0;
4787}
4788
4789static struct lock_class_key bonding_netdev_xmit_lock_key;
4790static struct lock_class_key bonding_netdev_addr_lock_key;
4791
4792static void bond_set_lockdep_class_one(struct net_device *dev,
4793 struct netdev_queue *txq,
4794 void *_unused)
4795{
4796 lockdep_set_class(&txq->_xmit_lock,
4797 &bonding_netdev_xmit_lock_key);
4798}
4799
4800static void bond_set_lockdep_class(struct net_device *dev)
4801{
4802 lockdep_set_class(&dev->addr_list_lock,
4803 &bonding_netdev_addr_lock_key);
4804 netdev_for_each_tx_queue(dev, bond_set_lockdep_class_one, NULL);
4805}
4806
4807/*
4808 * Called from registration process
4809 */
4810static int bond_init(struct net_device *bond_dev)
4811{
4812 struct bonding *bond = netdev_priv(bond_dev);
4813 struct bond_net *bn = net_generic(dev_net(bond_dev), bond_net_id);
4814 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
4815
4816 pr_debug("Begin bond_init for %s\n", bond_dev->name);
4817
4818 /*
4819 * Initialize locks that may be required during
4820 * en/deslave operations. All of the bond_open work
4821 * (of which this is part) should really be moved to
4822 * a phase prior to dev_open
4823 */
4824 spin_lock_init(&(bond_info->tx_hashtbl_lock));
4825 spin_lock_init(&(bond_info->rx_hashtbl_lock));
4826
4827 bond->wq = create_singlethread_workqueue(bond_dev->name);
4828 if (!bond->wq)
4829 return -ENOMEM;
4830
4831 bond_set_lockdep_class(bond_dev);
4832
4833 bond_create_proc_entry(bond);
4834 list_add_tail(&bond->bond_list, &bn->dev_list);
4835
4836 bond_prepare_sysfs_group(bond);
4837
4838 bond_debug_register(bond);
4839
4840 __hw_addr_init(&bond->mc_list);
4841 return 0;
4842}
4843
4844static int bond_validate(struct nlattr *tb[], struct nlattr *data[])
4845{
4846 if (tb[IFLA_ADDRESS]) {
4847 if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
4848 return -EINVAL;
4849 if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
4850 return -EADDRNOTAVAIL;
4851 }
4852 return 0;
4853}
4854
4855static struct rtnl_link_ops bond_link_ops __read_mostly = {
4856 .kind = "bond",
4857 .priv_size = sizeof(struct bonding),
4858 .setup = bond_setup,
4859 .validate = bond_validate,
4860};
4861
4862/* Create a new bond based on the specified name and bonding parameters.
4863 * If name is NULL, obtain a suitable "bond%d" name for us.
4864 * Caller must NOT hold rtnl_lock; we need to release it here before we
4865 * set up our sysfs entries.
4866 */
4867int bond_create(struct net *net, const char *name)
4868{
4869 struct net_device *bond_dev;
4870 int res;
4871
4872 rtnl_lock();
4873
4874 bond_dev = alloc_netdev_mq(sizeof(struct bonding),
4875 name ? name : "bond%d",
4876 bond_setup, tx_queues);
4877 if (!bond_dev) {
4878 pr_err("%s: eek! can't alloc netdev!\n", name);
4879 rtnl_unlock();
4880 return -ENOMEM;
4881 }
4882
4883 dev_net_set(bond_dev, net);
4884 bond_dev->rtnl_link_ops = &bond_link_ops;
4885
4886 res = register_netdevice(bond_dev);
4887
4888 netif_carrier_off(bond_dev);
4889
4890 rtnl_unlock();
4891 if (res < 0)
4892 bond_destructor(bond_dev);
4893 return res;
4894}
4895
4896static int __net_init bond_net_init(struct net *net)
4897{
4898 struct bond_net *bn = net_generic(net, bond_net_id);
4899
4900 bn->net = net;
4901 INIT_LIST_HEAD(&bn->dev_list);
4902
4903 bond_create_proc_dir(bn);
4904
4905 return 0;
4906}
4907
4908static void __net_exit bond_net_exit(struct net *net)
4909{
4910 struct bond_net *bn = net_generic(net, bond_net_id);
4911
4912 bond_destroy_proc_dir(bn);
4913}
4914
4915static struct pernet_operations bond_net_ops = {
4916 .init = bond_net_init,
4917 .exit = bond_net_exit,
4918 .id = &bond_net_id,
4919 .size = sizeof(struct bond_net),
4920};
4921
4922static int __init bonding_init(void)
4923{
4924 int i;
4925 int res;
4926
4927 pr_info("%s", bond_version);
4928
4929 res = bond_check_params(&bonding_defaults);
4930 if (res)
4931 goto out;
4932
4933 res = register_pernet_subsys(&bond_net_ops);
4934 if (res)
4935 goto out;
4936
4937 res = rtnl_link_register(&bond_link_ops);
4938 if (res)
4939 goto err_link;
4940
4941 bond_create_debugfs();
4942
4943 for (i = 0; i < max_bonds; i++) {
4944 res = bond_create(&init_net, NULL);
4945 if (res)
4946 goto err;
4947 }
4948
4949 res = bond_create_sysfs();
4950 if (res)
4951 goto err;
4952
4953 register_netdevice_notifier(&bond_netdev_notifier);
4954 register_inetaddr_notifier(&bond_inetaddr_notifier);
4955out:
4956 return res;
4957err:
4958 rtnl_link_unregister(&bond_link_ops);
4959err_link:
4960 unregister_pernet_subsys(&bond_net_ops);
4961 goto out;
4962
4963}
4964
4965static void __exit bonding_exit(void)
4966{
4967 unregister_netdevice_notifier(&bond_netdev_notifier);
4968 unregister_inetaddr_notifier(&bond_inetaddr_notifier);
4969
4970 bond_destroy_sysfs();
4971 bond_destroy_debugfs();
4972
4973 rtnl_link_unregister(&bond_link_ops);
4974 unregister_pernet_subsys(&bond_net_ops);
4975
4976#ifdef CONFIG_NET_POLL_CONTROLLER
4977 /*
4978 * Make sure we don't have an imbalance on our netpoll blocking
4979 */
4980 WARN_ON(atomic_read(&netpoll_block_tx));
4981#endif
4982}
4983
4984module_init(bonding_init);
4985module_exit(bonding_exit);
4986MODULE_LICENSE("GPL");
4987MODULE_VERSION(DRV_VERSION);
4988MODULE_DESCRIPTION(DRV_DESCRIPTION ", v" DRV_VERSION);
4989MODULE_AUTHOR("Thomas Davis, tadavis@lbl.gov and many others");
4990MODULE_ALIAS_RTNL_LINK("bond");
1// SPDX-License-Identifier: GPL-1.0+
2/*
3 * originally based on the dummy device.
4 *
5 * Copyright 1999, Thomas Davis, tadavis@lbl.gov.
6 * Based on dummy.c, and eql.c devices.
7 *
8 * bonding.c: an Ethernet Bonding driver
9 *
10 * This is useful to talk to a Cisco EtherChannel compatible equipment:
11 * Cisco 5500
12 * Sun Trunking (Solaris)
13 * Alteon AceDirector Trunks
14 * Linux Bonding
15 * and probably many L2 switches ...
16 *
17 * How it works:
18 * ifconfig bond0 ipaddress netmask up
19 * will setup a network device, with an ip address. No mac address
20 * will be assigned at this time. The hw mac address will come from
21 * the first slave bonded to the channel. All slaves will then use
22 * this hw mac address.
23 *
24 * ifconfig bond0 down
25 * will release all slaves, marking them as down.
26 *
27 * ifenslave bond0 eth0
28 * will attach eth0 to bond0 as a slave. eth0 hw mac address will either
29 * a: be used as initial mac address
30 * b: if a hw mac address already is there, eth0's hw mac address
31 * will then be set from bond0.
32 *
33 */
34
35#include <linux/kernel.h>
36#include <linux/module.h>
37#include <linux/types.h>
38#include <linux/fcntl.h>
39#include <linux/filter.h>
40#include <linux/interrupt.h>
41#include <linux/ptrace.h>
42#include <linux/ioport.h>
43#include <linux/in.h>
44#include <net/ip.h>
45#include <linux/ip.h>
46#include <linux/icmp.h>
47#include <linux/icmpv6.h>
48#include <linux/tcp.h>
49#include <linux/udp.h>
50#include <linux/slab.h>
51#include <linux/string.h>
52#include <linux/init.h>
53#include <linux/timer.h>
54#include <linux/socket.h>
55#include <linux/ctype.h>
56#include <linux/inet.h>
57#include <linux/bitops.h>
58#include <linux/io.h>
59#include <asm/dma.h>
60#include <linux/uaccess.h>
61#include <linux/errno.h>
62#include <linux/netdevice.h>
63#include <linux/inetdevice.h>
64#include <linux/igmp.h>
65#include <linux/etherdevice.h>
66#include <linux/skbuff.h>
67#include <net/sock.h>
68#include <linux/rtnetlink.h>
69#include <linux/smp.h>
70#include <linux/if_ether.h>
71#include <net/arp.h>
72#include <linux/mii.h>
73#include <linux/ethtool.h>
74#include <linux/if_vlan.h>
75#include <linux/if_bonding.h>
76#include <linux/phy.h>
77#include <linux/jiffies.h>
78#include <linux/preempt.h>
79#include <net/route.h>
80#include <net/net_namespace.h>
81#include <net/netns/generic.h>
82#include <net/pkt_sched.h>
83#include <linux/rculist.h>
84#include <net/flow_dissector.h>
85#include <net/xfrm.h>
86#include <net/bonding.h>
87#include <net/bond_3ad.h>
88#include <net/bond_alb.h>
89#if IS_ENABLED(CONFIG_TLS_DEVICE)
90#include <net/tls.h>
91#endif
92#include <net/ip6_route.h>
93#include <net/xdp.h>
94
95#include "bonding_priv.h"
96
97/*---------------------------- Module parameters ----------------------------*/
98
99/* monitor all links that often (in milliseconds). <=0 disables monitoring */
100
101static int max_bonds = BOND_DEFAULT_MAX_BONDS;
102static int tx_queues = BOND_DEFAULT_TX_QUEUES;
103static int num_peer_notif = 1;
104static int miimon;
105static int updelay;
106static int downdelay;
107static int use_carrier = 1;
108static char *mode;
109static char *primary;
110static char *primary_reselect;
111static char *lacp_rate;
112static int min_links;
113static char *ad_select;
114static char *xmit_hash_policy;
115static int arp_interval;
116static char *arp_ip_target[BOND_MAX_ARP_TARGETS];
117static char *arp_validate;
118static char *arp_all_targets;
119static char *fail_over_mac;
120static int all_slaves_active;
121static struct bond_params bonding_defaults;
122static int resend_igmp = BOND_DEFAULT_RESEND_IGMP;
123static int packets_per_slave = 1;
124static int lp_interval = BOND_ALB_DEFAULT_LP_INTERVAL;
125
126module_param(max_bonds, int, 0);
127MODULE_PARM_DESC(max_bonds, "Max number of bonded devices");
128module_param(tx_queues, int, 0);
129MODULE_PARM_DESC(tx_queues, "Max number of transmit queues (default = 16)");
130module_param_named(num_grat_arp, num_peer_notif, int, 0644);
131MODULE_PARM_DESC(num_grat_arp, "Number of peer notifications to send on "
132 "failover event (alias of num_unsol_na)");
133module_param_named(num_unsol_na, num_peer_notif, int, 0644);
134MODULE_PARM_DESC(num_unsol_na, "Number of peer notifications to send on "
135 "failover event (alias of num_grat_arp)");
136module_param(miimon, int, 0);
137MODULE_PARM_DESC(miimon, "Link check interval in milliseconds");
138module_param(updelay, int, 0);
139MODULE_PARM_DESC(updelay, "Delay before considering link up, in milliseconds");
140module_param(downdelay, int, 0);
141MODULE_PARM_DESC(downdelay, "Delay before considering link down, "
142 "in milliseconds");
143module_param(use_carrier, int, 0);
144MODULE_PARM_DESC(use_carrier, "Use netif_carrier_ok (vs MII ioctls) in miimon; "
145 "0 for off, 1 for on (default)");
146module_param(mode, charp, 0);
147MODULE_PARM_DESC(mode, "Mode of operation; 0 for balance-rr, "
148 "1 for active-backup, 2 for balance-xor, "
149 "3 for broadcast, 4 for 802.3ad, 5 for balance-tlb, "
150 "6 for balance-alb");
151module_param(primary, charp, 0);
152MODULE_PARM_DESC(primary, "Primary network device to use");
153module_param(primary_reselect, charp, 0);
154MODULE_PARM_DESC(primary_reselect, "Reselect primary slave "
155 "once it comes up; "
156 "0 for always (default), "
157 "1 for only if speed of primary is "
158 "better, "
159 "2 for only on active slave "
160 "failure");
161module_param(lacp_rate, charp, 0);
162MODULE_PARM_DESC(lacp_rate, "LACPDU tx rate to request from 802.3ad partner; "
163 "0 for slow, 1 for fast");
164module_param(ad_select, charp, 0);
165MODULE_PARM_DESC(ad_select, "802.3ad aggregation selection logic; "
166 "0 for stable (default), 1 for bandwidth, "
167 "2 for count");
168module_param(min_links, int, 0);
169MODULE_PARM_DESC(min_links, "Minimum number of available links before turning on carrier");
170
171module_param(xmit_hash_policy, charp, 0);
172MODULE_PARM_DESC(xmit_hash_policy, "balance-alb, balance-tlb, balance-xor, 802.3ad hashing method; "
173 "0 for layer 2 (default), 1 for layer 3+4, "
174 "2 for layer 2+3, 3 for encap layer 2+3, "
175 "4 for encap layer 3+4, 5 for vlan+srcmac");
176module_param(arp_interval, int, 0);
177MODULE_PARM_DESC(arp_interval, "arp interval in milliseconds");
178module_param_array(arp_ip_target, charp, NULL, 0);
179MODULE_PARM_DESC(arp_ip_target, "arp targets in n.n.n.n form");
180module_param(arp_validate, charp, 0);
181MODULE_PARM_DESC(arp_validate, "validate src/dst of ARP probes; "
182 "0 for none (default), 1 for active, "
183 "2 for backup, 3 for all");
184module_param(arp_all_targets, charp, 0);
185MODULE_PARM_DESC(arp_all_targets, "fail on any/all arp targets timeout; 0 for any (default), 1 for all");
186module_param(fail_over_mac, charp, 0);
187MODULE_PARM_DESC(fail_over_mac, "For active-backup, do not set all slaves to "
188 "the same MAC; 0 for none (default), "
189 "1 for active, 2 for follow");
190module_param(all_slaves_active, int, 0);
191MODULE_PARM_DESC(all_slaves_active, "Keep all frames received on an interface "
192 "by setting active flag for all slaves; "
193 "0 for never (default), 1 for always.");
194module_param(resend_igmp, int, 0);
195MODULE_PARM_DESC(resend_igmp, "Number of IGMP membership reports to send on "
196 "link failure");
197module_param(packets_per_slave, int, 0);
198MODULE_PARM_DESC(packets_per_slave, "Packets to send per slave in balance-rr "
199 "mode; 0 for a random slave, 1 packet per "
200 "slave (default), >1 packets per slave.");
201module_param(lp_interval, uint, 0);
202MODULE_PARM_DESC(lp_interval, "The number of seconds between instances where "
203 "the bonding driver sends learning packets to "
204 "each slaves peer switch. The default is 1.");
205
206/*----------------------------- Global variables ----------------------------*/
207
208#ifdef CONFIG_NET_POLL_CONTROLLER
209atomic_t netpoll_block_tx = ATOMIC_INIT(0);
210#endif
211
212unsigned int bond_net_id __read_mostly;
213
214static const struct flow_dissector_key flow_keys_bonding_keys[] = {
215 {
216 .key_id = FLOW_DISSECTOR_KEY_CONTROL,
217 .offset = offsetof(struct flow_keys, control),
218 },
219 {
220 .key_id = FLOW_DISSECTOR_KEY_BASIC,
221 .offset = offsetof(struct flow_keys, basic),
222 },
223 {
224 .key_id = FLOW_DISSECTOR_KEY_IPV4_ADDRS,
225 .offset = offsetof(struct flow_keys, addrs.v4addrs),
226 },
227 {
228 .key_id = FLOW_DISSECTOR_KEY_IPV6_ADDRS,
229 .offset = offsetof(struct flow_keys, addrs.v6addrs),
230 },
231 {
232 .key_id = FLOW_DISSECTOR_KEY_TIPC,
233 .offset = offsetof(struct flow_keys, addrs.tipckey),
234 },
235 {
236 .key_id = FLOW_DISSECTOR_KEY_PORTS,
237 .offset = offsetof(struct flow_keys, ports),
238 },
239 {
240 .key_id = FLOW_DISSECTOR_KEY_ICMP,
241 .offset = offsetof(struct flow_keys, icmp),
242 },
243 {
244 .key_id = FLOW_DISSECTOR_KEY_VLAN,
245 .offset = offsetof(struct flow_keys, vlan),
246 },
247 {
248 .key_id = FLOW_DISSECTOR_KEY_FLOW_LABEL,
249 .offset = offsetof(struct flow_keys, tags),
250 },
251 {
252 .key_id = FLOW_DISSECTOR_KEY_GRE_KEYID,
253 .offset = offsetof(struct flow_keys, keyid),
254 },
255};
256
257static struct flow_dissector flow_keys_bonding __read_mostly;
258
259/*-------------------------- Forward declarations ---------------------------*/
260
261static int bond_init(struct net_device *bond_dev);
262static void bond_uninit(struct net_device *bond_dev);
263static void bond_get_stats(struct net_device *bond_dev,
264 struct rtnl_link_stats64 *stats);
265static void bond_slave_arr_handler(struct work_struct *work);
266static bool bond_time_in_interval(struct bonding *bond, unsigned long last_act,
267 int mod);
268static void bond_netdev_notify_work(struct work_struct *work);
269
270/*---------------------------- General routines -----------------------------*/
271
272const char *bond_mode_name(int mode)
273{
274 static const char *names[] = {
275 [BOND_MODE_ROUNDROBIN] = "load balancing (round-robin)",
276 [BOND_MODE_ACTIVEBACKUP] = "fault-tolerance (active-backup)",
277 [BOND_MODE_XOR] = "load balancing (xor)",
278 [BOND_MODE_BROADCAST] = "fault-tolerance (broadcast)",
279 [BOND_MODE_8023AD] = "IEEE 802.3ad Dynamic link aggregation",
280 [BOND_MODE_TLB] = "transmit load balancing",
281 [BOND_MODE_ALB] = "adaptive load balancing",
282 };
283
284 if (mode < BOND_MODE_ROUNDROBIN || mode > BOND_MODE_ALB)
285 return "unknown";
286
287 return names[mode];
288}
289
290/**
291 * bond_dev_queue_xmit - Prepare skb for xmit.
292 *
293 * @bond: bond device that got this skb for tx.
294 * @skb: hw accel VLAN tagged skb to transmit
295 * @slave_dev: slave that is supposed to xmit this skbuff
296 */
297netdev_tx_t bond_dev_queue_xmit(struct bonding *bond, struct sk_buff *skb,
298 struct net_device *slave_dev)
299{
300 skb->dev = slave_dev;
301
302 BUILD_BUG_ON(sizeof(skb->queue_mapping) !=
303 sizeof(qdisc_skb_cb(skb)->slave_dev_queue_mapping));
304 skb_set_queue_mapping(skb, qdisc_skb_cb(skb)->slave_dev_queue_mapping);
305
306 if (unlikely(netpoll_tx_running(bond->dev)))
307 return bond_netpoll_send_skb(bond_get_slave_by_dev(bond, slave_dev), skb);
308
309 return dev_queue_xmit(skb);
310}
311
312static bool bond_sk_check(struct bonding *bond)
313{
314 switch (BOND_MODE(bond)) {
315 case BOND_MODE_8023AD:
316 case BOND_MODE_XOR:
317 if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER34)
318 return true;
319 fallthrough;
320 default:
321 return false;
322 }
323}
324
325static bool bond_xdp_check(struct bonding *bond)
326{
327 switch (BOND_MODE(bond)) {
328 case BOND_MODE_ROUNDROBIN:
329 case BOND_MODE_ACTIVEBACKUP:
330 return true;
331 case BOND_MODE_8023AD:
332 case BOND_MODE_XOR:
333 /* vlan+srcmac is not supported with XDP as in most cases the 802.1q
334 * payload is not in the packet due to hardware offload.
335 */
336 if (bond->params.xmit_policy != BOND_XMIT_POLICY_VLAN_SRCMAC)
337 return true;
338 fallthrough;
339 default:
340 return false;
341 }
342}
343
344/*---------------------------------- VLAN -----------------------------------*/
345
346/* In the following 2 functions, bond_vlan_rx_add_vid and bond_vlan_rx_kill_vid,
347 * We don't protect the slave list iteration with a lock because:
348 * a. This operation is performed in IOCTL context,
349 * b. The operation is protected by the RTNL semaphore in the 8021q code,
350 * c. Holding a lock with BH disabled while directly calling a base driver
351 * entry point is generally a BAD idea.
352 *
353 * The design of synchronization/protection for this operation in the 8021q
354 * module is good for one or more VLAN devices over a single physical device
355 * and cannot be extended for a teaming solution like bonding, so there is a
356 * potential race condition here where a net device from the vlan group might
357 * be referenced (either by a base driver or the 8021q code) while it is being
358 * removed from the system. However, it turns out we're not making matters
359 * worse, and if it works for regular VLAN usage it will work here too.
360*/
361
362/**
363 * bond_vlan_rx_add_vid - Propagates adding an id to slaves
364 * @bond_dev: bonding net device that got called
365 * @proto: network protocol ID
366 * @vid: vlan id being added
367 */
368static int bond_vlan_rx_add_vid(struct net_device *bond_dev,
369 __be16 proto, u16 vid)
370{
371 struct bonding *bond = netdev_priv(bond_dev);
372 struct slave *slave, *rollback_slave;
373 struct list_head *iter;
374 int res;
375
376 bond_for_each_slave(bond, slave, iter) {
377 res = vlan_vid_add(slave->dev, proto, vid);
378 if (res)
379 goto unwind;
380 }
381
382 return 0;
383
384unwind:
385 /* unwind to the slave that failed */
386 bond_for_each_slave(bond, rollback_slave, iter) {
387 if (rollback_slave == slave)
388 break;
389
390 vlan_vid_del(rollback_slave->dev, proto, vid);
391 }
392
393 return res;
394}
395
396/**
397 * bond_vlan_rx_kill_vid - Propagates deleting an id to slaves
398 * @bond_dev: bonding net device that got called
399 * @proto: network protocol ID
400 * @vid: vlan id being removed
401 */
402static int bond_vlan_rx_kill_vid(struct net_device *bond_dev,
403 __be16 proto, u16 vid)
404{
405 struct bonding *bond = netdev_priv(bond_dev);
406 struct list_head *iter;
407 struct slave *slave;
408
409 bond_for_each_slave(bond, slave, iter)
410 vlan_vid_del(slave->dev, proto, vid);
411
412 if (bond_is_lb(bond))
413 bond_alb_clear_vlan(bond, vid);
414
415 return 0;
416}
417
418/*---------------------------------- XFRM -----------------------------------*/
419
420#ifdef CONFIG_XFRM_OFFLOAD
421/**
422 * bond_ipsec_add_sa - program device with a security association
423 * @xs: pointer to transformer state struct
424 * @extack: extack point to fill failure reason
425 **/
426static int bond_ipsec_add_sa(struct xfrm_state *xs,
427 struct netlink_ext_ack *extack)
428{
429 struct net_device *bond_dev = xs->xso.dev;
430 struct bond_ipsec *ipsec;
431 struct bonding *bond;
432 struct slave *slave;
433 int err;
434
435 if (!bond_dev)
436 return -EINVAL;
437
438 rcu_read_lock();
439 bond = netdev_priv(bond_dev);
440 slave = rcu_dereference(bond->curr_active_slave);
441 if (!slave) {
442 rcu_read_unlock();
443 return -ENODEV;
444 }
445
446 if (!slave->dev->xfrmdev_ops ||
447 !slave->dev->xfrmdev_ops->xdo_dev_state_add ||
448 netif_is_bond_master(slave->dev)) {
449 NL_SET_ERR_MSG_MOD(extack, "Slave does not support ipsec offload");
450 rcu_read_unlock();
451 return -EINVAL;
452 }
453
454 ipsec = kmalloc(sizeof(*ipsec), GFP_ATOMIC);
455 if (!ipsec) {
456 rcu_read_unlock();
457 return -ENOMEM;
458 }
459 xs->xso.real_dev = slave->dev;
460
461 err = slave->dev->xfrmdev_ops->xdo_dev_state_add(xs, extack);
462 if (!err) {
463 ipsec->xs = xs;
464 INIT_LIST_HEAD(&ipsec->list);
465 spin_lock_bh(&bond->ipsec_lock);
466 list_add(&ipsec->list, &bond->ipsec_list);
467 spin_unlock_bh(&bond->ipsec_lock);
468 } else {
469 kfree(ipsec);
470 }
471 rcu_read_unlock();
472 return err;
473}
474
475static void bond_ipsec_add_sa_all(struct bonding *bond)
476{
477 struct net_device *bond_dev = bond->dev;
478 struct bond_ipsec *ipsec;
479 struct slave *slave;
480
481 rcu_read_lock();
482 slave = rcu_dereference(bond->curr_active_slave);
483 if (!slave)
484 goto out;
485
486 if (!slave->dev->xfrmdev_ops ||
487 !slave->dev->xfrmdev_ops->xdo_dev_state_add ||
488 netif_is_bond_master(slave->dev)) {
489 spin_lock_bh(&bond->ipsec_lock);
490 if (!list_empty(&bond->ipsec_list))
491 slave_warn(bond_dev, slave->dev,
492 "%s: no slave xdo_dev_state_add\n",
493 __func__);
494 spin_unlock_bh(&bond->ipsec_lock);
495 goto out;
496 }
497
498 spin_lock_bh(&bond->ipsec_lock);
499 list_for_each_entry(ipsec, &bond->ipsec_list, list) {
500 ipsec->xs->xso.real_dev = slave->dev;
501 if (slave->dev->xfrmdev_ops->xdo_dev_state_add(ipsec->xs, NULL)) {
502 slave_warn(bond_dev, slave->dev, "%s: failed to add SA\n", __func__);
503 ipsec->xs->xso.real_dev = NULL;
504 }
505 }
506 spin_unlock_bh(&bond->ipsec_lock);
507out:
508 rcu_read_unlock();
509}
510
511/**
512 * bond_ipsec_del_sa - clear out this specific SA
513 * @xs: pointer to transformer state struct
514 **/
515static void bond_ipsec_del_sa(struct xfrm_state *xs)
516{
517 struct net_device *bond_dev = xs->xso.dev;
518 struct bond_ipsec *ipsec;
519 struct bonding *bond;
520 struct slave *slave;
521
522 if (!bond_dev)
523 return;
524
525 rcu_read_lock();
526 bond = netdev_priv(bond_dev);
527 slave = rcu_dereference(bond->curr_active_slave);
528
529 if (!slave)
530 goto out;
531
532 if (!xs->xso.real_dev)
533 goto out;
534
535 WARN_ON(xs->xso.real_dev != slave->dev);
536
537 if (!slave->dev->xfrmdev_ops ||
538 !slave->dev->xfrmdev_ops->xdo_dev_state_delete ||
539 netif_is_bond_master(slave->dev)) {
540 slave_warn(bond_dev, slave->dev, "%s: no slave xdo_dev_state_delete\n", __func__);
541 goto out;
542 }
543
544 slave->dev->xfrmdev_ops->xdo_dev_state_delete(xs);
545out:
546 spin_lock_bh(&bond->ipsec_lock);
547 list_for_each_entry(ipsec, &bond->ipsec_list, list) {
548 if (ipsec->xs == xs) {
549 list_del(&ipsec->list);
550 kfree(ipsec);
551 break;
552 }
553 }
554 spin_unlock_bh(&bond->ipsec_lock);
555 rcu_read_unlock();
556}
557
558static void bond_ipsec_del_sa_all(struct bonding *bond)
559{
560 struct net_device *bond_dev = bond->dev;
561 struct bond_ipsec *ipsec;
562 struct slave *slave;
563
564 rcu_read_lock();
565 slave = rcu_dereference(bond->curr_active_slave);
566 if (!slave) {
567 rcu_read_unlock();
568 return;
569 }
570
571 spin_lock_bh(&bond->ipsec_lock);
572 list_for_each_entry(ipsec, &bond->ipsec_list, list) {
573 if (!ipsec->xs->xso.real_dev)
574 continue;
575
576 if (!slave->dev->xfrmdev_ops ||
577 !slave->dev->xfrmdev_ops->xdo_dev_state_delete ||
578 netif_is_bond_master(slave->dev)) {
579 slave_warn(bond_dev, slave->dev,
580 "%s: no slave xdo_dev_state_delete\n",
581 __func__);
582 } else {
583 slave->dev->xfrmdev_ops->xdo_dev_state_delete(ipsec->xs);
584 }
585 ipsec->xs->xso.real_dev = NULL;
586 }
587 spin_unlock_bh(&bond->ipsec_lock);
588 rcu_read_unlock();
589}
590
591/**
592 * bond_ipsec_offload_ok - can this packet use the xfrm hw offload
593 * @skb: current data packet
594 * @xs: pointer to transformer state struct
595 **/
596static bool bond_ipsec_offload_ok(struct sk_buff *skb, struct xfrm_state *xs)
597{
598 struct net_device *bond_dev = xs->xso.dev;
599 struct net_device *real_dev;
600 struct slave *curr_active;
601 struct bonding *bond;
602 int err;
603
604 bond = netdev_priv(bond_dev);
605 rcu_read_lock();
606 curr_active = rcu_dereference(bond->curr_active_slave);
607 real_dev = curr_active->dev;
608
609 if (BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
610 err = false;
611 goto out;
612 }
613
614 if (!xs->xso.real_dev) {
615 err = false;
616 goto out;
617 }
618
619 if (!real_dev->xfrmdev_ops ||
620 !real_dev->xfrmdev_ops->xdo_dev_offload_ok ||
621 netif_is_bond_master(real_dev)) {
622 err = false;
623 goto out;
624 }
625
626 err = real_dev->xfrmdev_ops->xdo_dev_offload_ok(skb, xs);
627out:
628 rcu_read_unlock();
629 return err;
630}
631
632static const struct xfrmdev_ops bond_xfrmdev_ops = {
633 .xdo_dev_state_add = bond_ipsec_add_sa,
634 .xdo_dev_state_delete = bond_ipsec_del_sa,
635 .xdo_dev_offload_ok = bond_ipsec_offload_ok,
636};
637#endif /* CONFIG_XFRM_OFFLOAD */
638
639/*------------------------------- Link status -------------------------------*/
640
641/* Set the carrier state for the master according to the state of its
642 * slaves. If any slaves are up, the master is up. In 802.3ad mode,
643 * do special 802.3ad magic.
644 *
645 * Returns zero if carrier state does not change, nonzero if it does.
646 */
647int bond_set_carrier(struct bonding *bond)
648{
649 struct list_head *iter;
650 struct slave *slave;
651
652 if (!bond_has_slaves(bond))
653 goto down;
654
655 if (BOND_MODE(bond) == BOND_MODE_8023AD)
656 return bond_3ad_set_carrier(bond);
657
658 bond_for_each_slave(bond, slave, iter) {
659 if (slave->link == BOND_LINK_UP) {
660 if (!netif_carrier_ok(bond->dev)) {
661 netif_carrier_on(bond->dev);
662 return 1;
663 }
664 return 0;
665 }
666 }
667
668down:
669 if (netif_carrier_ok(bond->dev)) {
670 netif_carrier_off(bond->dev);
671 return 1;
672 }
673 return 0;
674}
675
676/* Get link speed and duplex from the slave's base driver
677 * using ethtool. If for some reason the call fails or the
678 * values are invalid, set speed and duplex to -1,
679 * and return. Return 1 if speed or duplex settings are
680 * UNKNOWN; 0 otherwise.
681 */
682static int bond_update_speed_duplex(struct slave *slave)
683{
684 struct net_device *slave_dev = slave->dev;
685 struct ethtool_link_ksettings ecmd;
686 int res;
687
688 slave->speed = SPEED_UNKNOWN;
689 slave->duplex = DUPLEX_UNKNOWN;
690
691 res = __ethtool_get_link_ksettings(slave_dev, &ecmd);
692 if (res < 0)
693 return 1;
694 if (ecmd.base.speed == 0 || ecmd.base.speed == ((__u32)-1))
695 return 1;
696 switch (ecmd.base.duplex) {
697 case DUPLEX_FULL:
698 case DUPLEX_HALF:
699 break;
700 default:
701 return 1;
702 }
703
704 slave->speed = ecmd.base.speed;
705 slave->duplex = ecmd.base.duplex;
706
707 return 0;
708}
709
710const char *bond_slave_link_status(s8 link)
711{
712 switch (link) {
713 case BOND_LINK_UP:
714 return "up";
715 case BOND_LINK_FAIL:
716 return "going down";
717 case BOND_LINK_DOWN:
718 return "down";
719 case BOND_LINK_BACK:
720 return "going back";
721 default:
722 return "unknown";
723 }
724}
725
726/* if <dev> supports MII link status reporting, check its link status.
727 *
728 * We either do MII/ETHTOOL ioctls, or check netif_carrier_ok(),
729 * depending upon the setting of the use_carrier parameter.
730 *
731 * Return either BMSR_LSTATUS, meaning that the link is up (or we
732 * can't tell and just pretend it is), or 0, meaning that the link is
733 * down.
734 *
735 * If reporting is non-zero, instead of faking link up, return -1 if
736 * both ETHTOOL and MII ioctls fail (meaning the device does not
737 * support them). If use_carrier is set, return whatever it says.
738 * It'd be nice if there was a good way to tell if a driver supports
739 * netif_carrier, but there really isn't.
740 */
741static int bond_check_dev_link(struct bonding *bond,
742 struct net_device *slave_dev, int reporting)
743{
744 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
745 int (*ioctl)(struct net_device *, struct ifreq *, int);
746 struct ifreq ifr;
747 struct mii_ioctl_data *mii;
748
749 if (!reporting && !netif_running(slave_dev))
750 return 0;
751
752 if (bond->params.use_carrier)
753 return netif_carrier_ok(slave_dev) ? BMSR_LSTATUS : 0;
754
755 /* Try to get link status using Ethtool first. */
756 if (slave_dev->ethtool_ops->get_link)
757 return slave_dev->ethtool_ops->get_link(slave_dev) ?
758 BMSR_LSTATUS : 0;
759
760 /* Ethtool can't be used, fallback to MII ioctls. */
761 ioctl = slave_ops->ndo_eth_ioctl;
762 if (ioctl) {
763 /* TODO: set pointer to correct ioctl on a per team member
764 * bases to make this more efficient. that is, once
765 * we determine the correct ioctl, we will always
766 * call it and not the others for that team
767 * member.
768 */
769
770 /* We cannot assume that SIOCGMIIPHY will also read a
771 * register; not all network drivers (e.g., e100)
772 * support that.
773 */
774
775 /* Yes, the mii is overlaid on the ifreq.ifr_ifru */
776 strscpy_pad(ifr.ifr_name, slave_dev->name, IFNAMSIZ);
777 mii = if_mii(&ifr);
778 if (ioctl(slave_dev, &ifr, SIOCGMIIPHY) == 0) {
779 mii->reg_num = MII_BMSR;
780 if (ioctl(slave_dev, &ifr, SIOCGMIIREG) == 0)
781 return mii->val_out & BMSR_LSTATUS;
782 }
783 }
784
785 /* If reporting, report that either there's no ndo_eth_ioctl,
786 * or both SIOCGMIIREG and get_link failed (meaning that we
787 * cannot report link status). If not reporting, pretend
788 * we're ok.
789 */
790 return reporting ? -1 : BMSR_LSTATUS;
791}
792
793/*----------------------------- Multicast list ------------------------------*/
794
795/* Push the promiscuity flag down to appropriate slaves */
796static int bond_set_promiscuity(struct bonding *bond, int inc)
797{
798 struct list_head *iter;
799 int err = 0;
800
801 if (bond_uses_primary(bond)) {
802 struct slave *curr_active = rtnl_dereference(bond->curr_active_slave);
803
804 if (curr_active)
805 err = dev_set_promiscuity(curr_active->dev, inc);
806 } else {
807 struct slave *slave;
808
809 bond_for_each_slave(bond, slave, iter) {
810 err = dev_set_promiscuity(slave->dev, inc);
811 if (err)
812 return err;
813 }
814 }
815 return err;
816}
817
818/* Push the allmulti flag down to all slaves */
819static int bond_set_allmulti(struct bonding *bond, int inc)
820{
821 struct list_head *iter;
822 int err = 0;
823
824 if (bond_uses_primary(bond)) {
825 struct slave *curr_active = rtnl_dereference(bond->curr_active_slave);
826
827 if (curr_active)
828 err = dev_set_allmulti(curr_active->dev, inc);
829 } else {
830 struct slave *slave;
831
832 bond_for_each_slave(bond, slave, iter) {
833 err = dev_set_allmulti(slave->dev, inc);
834 if (err)
835 return err;
836 }
837 }
838 return err;
839}
840
841/* Retrieve the list of registered multicast addresses for the bonding
842 * device and retransmit an IGMP JOIN request to the current active
843 * slave.
844 */
845static void bond_resend_igmp_join_requests_delayed(struct work_struct *work)
846{
847 struct bonding *bond = container_of(work, struct bonding,
848 mcast_work.work);
849
850 if (!rtnl_trylock()) {
851 queue_delayed_work(bond->wq, &bond->mcast_work, 1);
852 return;
853 }
854 call_netdevice_notifiers(NETDEV_RESEND_IGMP, bond->dev);
855
856 if (bond->igmp_retrans > 1) {
857 bond->igmp_retrans--;
858 queue_delayed_work(bond->wq, &bond->mcast_work, HZ/5);
859 }
860 rtnl_unlock();
861}
862
863/* Flush bond's hardware addresses from slave */
864static void bond_hw_addr_flush(struct net_device *bond_dev,
865 struct net_device *slave_dev)
866{
867 struct bonding *bond = netdev_priv(bond_dev);
868
869 dev_uc_unsync(slave_dev, bond_dev);
870 dev_mc_unsync(slave_dev, bond_dev);
871
872 if (BOND_MODE(bond) == BOND_MODE_8023AD)
873 dev_mc_del(slave_dev, lacpdu_mcast_addr);
874}
875
876/*--------------------------- Active slave change ---------------------------*/
877
878/* Update the hardware address list and promisc/allmulti for the new and
879 * old active slaves (if any). Modes that are not using primary keep all
880 * slaves up date at all times; only the modes that use primary need to call
881 * this function to swap these settings during a failover.
882 */
883static void bond_hw_addr_swap(struct bonding *bond, struct slave *new_active,
884 struct slave *old_active)
885{
886 if (old_active) {
887 if (bond->dev->flags & IFF_PROMISC)
888 dev_set_promiscuity(old_active->dev, -1);
889
890 if (bond->dev->flags & IFF_ALLMULTI)
891 dev_set_allmulti(old_active->dev, -1);
892
893 if (bond->dev->flags & IFF_UP)
894 bond_hw_addr_flush(bond->dev, old_active->dev);
895 }
896
897 if (new_active) {
898 /* FIXME: Signal errors upstream. */
899 if (bond->dev->flags & IFF_PROMISC)
900 dev_set_promiscuity(new_active->dev, 1);
901
902 if (bond->dev->flags & IFF_ALLMULTI)
903 dev_set_allmulti(new_active->dev, 1);
904
905 if (bond->dev->flags & IFF_UP) {
906 netif_addr_lock_bh(bond->dev);
907 dev_uc_sync(new_active->dev, bond->dev);
908 dev_mc_sync(new_active->dev, bond->dev);
909 netif_addr_unlock_bh(bond->dev);
910 }
911 }
912}
913
914/**
915 * bond_set_dev_addr - clone slave's address to bond
916 * @bond_dev: bond net device
917 * @slave_dev: slave net device
918 *
919 * Should be called with RTNL held.
920 */
921static int bond_set_dev_addr(struct net_device *bond_dev,
922 struct net_device *slave_dev)
923{
924 int err;
925
926 slave_dbg(bond_dev, slave_dev, "bond_dev=%p slave_dev=%p slave_dev->addr_len=%d\n",
927 bond_dev, slave_dev, slave_dev->addr_len);
928 err = dev_pre_changeaddr_notify(bond_dev, slave_dev->dev_addr, NULL);
929 if (err)
930 return err;
931
932 __dev_addr_set(bond_dev, slave_dev->dev_addr, slave_dev->addr_len);
933 bond_dev->addr_assign_type = NET_ADDR_STOLEN;
934 call_netdevice_notifiers(NETDEV_CHANGEADDR, bond_dev);
935 return 0;
936}
937
938static struct slave *bond_get_old_active(struct bonding *bond,
939 struct slave *new_active)
940{
941 struct slave *slave;
942 struct list_head *iter;
943
944 bond_for_each_slave(bond, slave, iter) {
945 if (slave == new_active)
946 continue;
947
948 if (ether_addr_equal(bond->dev->dev_addr, slave->dev->dev_addr))
949 return slave;
950 }
951
952 return NULL;
953}
954
955/* bond_do_fail_over_mac
956 *
957 * Perform special MAC address swapping for fail_over_mac settings
958 *
959 * Called with RTNL
960 */
961static void bond_do_fail_over_mac(struct bonding *bond,
962 struct slave *new_active,
963 struct slave *old_active)
964{
965 u8 tmp_mac[MAX_ADDR_LEN];
966 struct sockaddr_storage ss;
967 int rv;
968
969 switch (bond->params.fail_over_mac) {
970 case BOND_FOM_ACTIVE:
971 if (new_active) {
972 rv = bond_set_dev_addr(bond->dev, new_active->dev);
973 if (rv)
974 slave_err(bond->dev, new_active->dev, "Error %d setting bond MAC from slave\n",
975 -rv);
976 }
977 break;
978 case BOND_FOM_FOLLOW:
979 /* if new_active && old_active, swap them
980 * if just old_active, do nothing (going to no active slave)
981 * if just new_active, set new_active to bond's MAC
982 */
983 if (!new_active)
984 return;
985
986 if (!old_active)
987 old_active = bond_get_old_active(bond, new_active);
988
989 if (old_active) {
990 bond_hw_addr_copy(tmp_mac, new_active->dev->dev_addr,
991 new_active->dev->addr_len);
992 bond_hw_addr_copy(ss.__data,
993 old_active->dev->dev_addr,
994 old_active->dev->addr_len);
995 ss.ss_family = new_active->dev->type;
996 } else {
997 bond_hw_addr_copy(ss.__data, bond->dev->dev_addr,
998 bond->dev->addr_len);
999 ss.ss_family = bond->dev->type;
1000 }
1001
1002 rv = dev_set_mac_address(new_active->dev,
1003 (struct sockaddr *)&ss, NULL);
1004 if (rv) {
1005 slave_err(bond->dev, new_active->dev, "Error %d setting MAC of new active slave\n",
1006 -rv);
1007 goto out;
1008 }
1009
1010 if (!old_active)
1011 goto out;
1012
1013 bond_hw_addr_copy(ss.__data, tmp_mac,
1014 new_active->dev->addr_len);
1015 ss.ss_family = old_active->dev->type;
1016
1017 rv = dev_set_mac_address(old_active->dev,
1018 (struct sockaddr *)&ss, NULL);
1019 if (rv)
1020 slave_err(bond->dev, old_active->dev, "Error %d setting MAC of old active slave\n",
1021 -rv);
1022out:
1023 break;
1024 default:
1025 netdev_err(bond->dev, "bond_do_fail_over_mac impossible: bad policy %d\n",
1026 bond->params.fail_over_mac);
1027 break;
1028 }
1029
1030}
1031
1032/**
1033 * bond_choose_primary_or_current - select the primary or high priority slave
1034 * @bond: our bonding struct
1035 *
1036 * - Check if there is a primary link. If the primary link was set and is up,
1037 * go on and do link reselection.
1038 *
1039 * - If primary link is not set or down, find the highest priority link.
1040 * If the highest priority link is not current slave, set it as primary
1041 * link and do link reselection.
1042 */
1043static struct slave *bond_choose_primary_or_current(struct bonding *bond)
1044{
1045 struct slave *prim = rtnl_dereference(bond->primary_slave);
1046 struct slave *curr = rtnl_dereference(bond->curr_active_slave);
1047 struct slave *slave, *hprio = NULL;
1048 struct list_head *iter;
1049
1050 if (!prim || prim->link != BOND_LINK_UP) {
1051 bond_for_each_slave(bond, slave, iter) {
1052 if (slave->link == BOND_LINK_UP) {
1053 hprio = hprio ?: slave;
1054 if (slave->prio > hprio->prio)
1055 hprio = slave;
1056 }
1057 }
1058
1059 if (hprio && hprio != curr) {
1060 prim = hprio;
1061 goto link_reselect;
1062 }
1063
1064 if (!curr || curr->link != BOND_LINK_UP)
1065 return NULL;
1066 return curr;
1067 }
1068
1069 if (bond->force_primary) {
1070 bond->force_primary = false;
1071 return prim;
1072 }
1073
1074link_reselect:
1075 if (!curr || curr->link != BOND_LINK_UP)
1076 return prim;
1077
1078 /* At this point, prim and curr are both up */
1079 switch (bond->params.primary_reselect) {
1080 case BOND_PRI_RESELECT_ALWAYS:
1081 return prim;
1082 case BOND_PRI_RESELECT_BETTER:
1083 if (prim->speed < curr->speed)
1084 return curr;
1085 if (prim->speed == curr->speed && prim->duplex <= curr->duplex)
1086 return curr;
1087 return prim;
1088 case BOND_PRI_RESELECT_FAILURE:
1089 return curr;
1090 default:
1091 netdev_err(bond->dev, "impossible primary_reselect %d\n",
1092 bond->params.primary_reselect);
1093 return curr;
1094 }
1095}
1096
1097/**
1098 * bond_find_best_slave - select the best available slave to be the active one
1099 * @bond: our bonding struct
1100 */
1101static struct slave *bond_find_best_slave(struct bonding *bond)
1102{
1103 struct slave *slave, *bestslave = NULL;
1104 struct list_head *iter;
1105 int mintime = bond->params.updelay;
1106
1107 slave = bond_choose_primary_or_current(bond);
1108 if (slave)
1109 return slave;
1110
1111 bond_for_each_slave(bond, slave, iter) {
1112 if (slave->link == BOND_LINK_UP)
1113 return slave;
1114 if (slave->link == BOND_LINK_BACK && bond_slave_is_up(slave) &&
1115 slave->delay < mintime) {
1116 mintime = slave->delay;
1117 bestslave = slave;
1118 }
1119 }
1120
1121 return bestslave;
1122}
1123
1124static bool bond_should_notify_peers(struct bonding *bond)
1125{
1126 struct slave *slave;
1127
1128 rcu_read_lock();
1129 slave = rcu_dereference(bond->curr_active_slave);
1130 rcu_read_unlock();
1131
1132 if (!slave || !bond->send_peer_notif ||
1133 bond->send_peer_notif %
1134 max(1, bond->params.peer_notif_delay) != 0 ||
1135 !netif_carrier_ok(bond->dev) ||
1136 test_bit(__LINK_STATE_LINKWATCH_PENDING, &slave->dev->state))
1137 return false;
1138
1139 netdev_dbg(bond->dev, "bond_should_notify_peers: slave %s\n",
1140 slave ? slave->dev->name : "NULL");
1141
1142 return true;
1143}
1144
1145/**
1146 * bond_change_active_slave - change the active slave into the specified one
1147 * @bond: our bonding struct
1148 * @new_active: the new slave to make the active one
1149 *
1150 * Set the new slave to the bond's settings and unset them on the old
1151 * curr_active_slave.
1152 * Setting include flags, mc-list, promiscuity, allmulti, etc.
1153 *
1154 * If @new's link state is %BOND_LINK_BACK we'll set it to %BOND_LINK_UP,
1155 * because it is apparently the best available slave we have, even though its
1156 * updelay hasn't timed out yet.
1157 *
1158 * Caller must hold RTNL.
1159 */
1160void bond_change_active_slave(struct bonding *bond, struct slave *new_active)
1161{
1162 struct slave *old_active;
1163
1164 ASSERT_RTNL();
1165
1166 old_active = rtnl_dereference(bond->curr_active_slave);
1167
1168 if (old_active == new_active)
1169 return;
1170
1171#ifdef CONFIG_XFRM_OFFLOAD
1172 bond_ipsec_del_sa_all(bond);
1173#endif /* CONFIG_XFRM_OFFLOAD */
1174
1175 if (new_active) {
1176 new_active->last_link_up = jiffies;
1177
1178 if (new_active->link == BOND_LINK_BACK) {
1179 if (bond_uses_primary(bond)) {
1180 slave_info(bond->dev, new_active->dev, "making interface the new active one %d ms earlier\n",
1181 (bond->params.updelay - new_active->delay) * bond->params.miimon);
1182 }
1183
1184 new_active->delay = 0;
1185 bond_set_slave_link_state(new_active, BOND_LINK_UP,
1186 BOND_SLAVE_NOTIFY_NOW);
1187
1188 if (BOND_MODE(bond) == BOND_MODE_8023AD)
1189 bond_3ad_handle_link_change(new_active, BOND_LINK_UP);
1190
1191 if (bond_is_lb(bond))
1192 bond_alb_handle_link_change(bond, new_active, BOND_LINK_UP);
1193 } else {
1194 if (bond_uses_primary(bond))
1195 slave_info(bond->dev, new_active->dev, "making interface the new active one\n");
1196 }
1197 }
1198
1199 if (bond_uses_primary(bond))
1200 bond_hw_addr_swap(bond, new_active, old_active);
1201
1202 if (bond_is_lb(bond)) {
1203 bond_alb_handle_active_change(bond, new_active);
1204 if (old_active)
1205 bond_set_slave_inactive_flags(old_active,
1206 BOND_SLAVE_NOTIFY_NOW);
1207 if (new_active)
1208 bond_set_slave_active_flags(new_active,
1209 BOND_SLAVE_NOTIFY_NOW);
1210 } else {
1211 rcu_assign_pointer(bond->curr_active_slave, new_active);
1212 }
1213
1214 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP) {
1215 if (old_active)
1216 bond_set_slave_inactive_flags(old_active,
1217 BOND_SLAVE_NOTIFY_NOW);
1218
1219 if (new_active) {
1220 bool should_notify_peers = false;
1221
1222 bond_set_slave_active_flags(new_active,
1223 BOND_SLAVE_NOTIFY_NOW);
1224
1225 if (bond->params.fail_over_mac)
1226 bond_do_fail_over_mac(bond, new_active,
1227 old_active);
1228
1229 if (netif_running(bond->dev)) {
1230 bond->send_peer_notif =
1231 bond->params.num_peer_notif *
1232 max(1, bond->params.peer_notif_delay);
1233 should_notify_peers =
1234 bond_should_notify_peers(bond);
1235 }
1236
1237 call_netdevice_notifiers(NETDEV_BONDING_FAILOVER, bond->dev);
1238 if (should_notify_peers) {
1239 bond->send_peer_notif--;
1240 call_netdevice_notifiers(NETDEV_NOTIFY_PEERS,
1241 bond->dev);
1242 }
1243 }
1244 }
1245
1246#ifdef CONFIG_XFRM_OFFLOAD
1247 bond_ipsec_add_sa_all(bond);
1248#endif /* CONFIG_XFRM_OFFLOAD */
1249
1250 /* resend IGMP joins since active slave has changed or
1251 * all were sent on curr_active_slave.
1252 * resend only if bond is brought up with the affected
1253 * bonding modes and the retransmission is enabled
1254 */
1255 if (netif_running(bond->dev) && (bond->params.resend_igmp > 0) &&
1256 ((bond_uses_primary(bond) && new_active) ||
1257 BOND_MODE(bond) == BOND_MODE_ROUNDROBIN)) {
1258 bond->igmp_retrans = bond->params.resend_igmp;
1259 queue_delayed_work(bond->wq, &bond->mcast_work, 1);
1260 }
1261}
1262
1263/**
1264 * bond_select_active_slave - select a new active slave, if needed
1265 * @bond: our bonding struct
1266 *
1267 * This functions should be called when one of the following occurs:
1268 * - The old curr_active_slave has been released or lost its link.
1269 * - The primary_slave has got its link back.
1270 * - A slave has got its link back and there's no old curr_active_slave.
1271 *
1272 * Caller must hold RTNL.
1273 */
1274void bond_select_active_slave(struct bonding *bond)
1275{
1276 struct slave *best_slave;
1277 int rv;
1278
1279 ASSERT_RTNL();
1280
1281 best_slave = bond_find_best_slave(bond);
1282 if (best_slave != rtnl_dereference(bond->curr_active_slave)) {
1283 bond_change_active_slave(bond, best_slave);
1284 rv = bond_set_carrier(bond);
1285 if (!rv)
1286 return;
1287
1288 if (netif_carrier_ok(bond->dev))
1289 netdev_info(bond->dev, "active interface up!\n");
1290 else
1291 netdev_info(bond->dev, "now running without any active interface!\n");
1292 }
1293}
1294
1295#ifdef CONFIG_NET_POLL_CONTROLLER
1296static inline int slave_enable_netpoll(struct slave *slave)
1297{
1298 struct netpoll *np;
1299 int err = 0;
1300
1301 np = kzalloc(sizeof(*np), GFP_KERNEL);
1302 err = -ENOMEM;
1303 if (!np)
1304 goto out;
1305
1306 err = __netpoll_setup(np, slave->dev);
1307 if (err) {
1308 kfree(np);
1309 goto out;
1310 }
1311 slave->np = np;
1312out:
1313 return err;
1314}
1315static inline void slave_disable_netpoll(struct slave *slave)
1316{
1317 struct netpoll *np = slave->np;
1318
1319 if (!np)
1320 return;
1321
1322 slave->np = NULL;
1323
1324 __netpoll_free(np);
1325}
1326
1327static void bond_poll_controller(struct net_device *bond_dev)
1328{
1329 struct bonding *bond = netdev_priv(bond_dev);
1330 struct slave *slave = NULL;
1331 struct list_head *iter;
1332 struct ad_info ad_info;
1333
1334 if (BOND_MODE(bond) == BOND_MODE_8023AD)
1335 if (bond_3ad_get_active_agg_info(bond, &ad_info))
1336 return;
1337
1338 bond_for_each_slave_rcu(bond, slave, iter) {
1339 if (!bond_slave_is_up(slave))
1340 continue;
1341
1342 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
1343 struct aggregator *agg =
1344 SLAVE_AD_INFO(slave)->port.aggregator;
1345
1346 if (agg &&
1347 agg->aggregator_identifier != ad_info.aggregator_id)
1348 continue;
1349 }
1350
1351 netpoll_poll_dev(slave->dev);
1352 }
1353}
1354
1355static void bond_netpoll_cleanup(struct net_device *bond_dev)
1356{
1357 struct bonding *bond = netdev_priv(bond_dev);
1358 struct list_head *iter;
1359 struct slave *slave;
1360
1361 bond_for_each_slave(bond, slave, iter)
1362 if (bond_slave_is_up(slave))
1363 slave_disable_netpoll(slave);
1364}
1365
1366static int bond_netpoll_setup(struct net_device *dev, struct netpoll_info *ni)
1367{
1368 struct bonding *bond = netdev_priv(dev);
1369 struct list_head *iter;
1370 struct slave *slave;
1371 int err = 0;
1372
1373 bond_for_each_slave(bond, slave, iter) {
1374 err = slave_enable_netpoll(slave);
1375 if (err) {
1376 bond_netpoll_cleanup(dev);
1377 break;
1378 }
1379 }
1380 return err;
1381}
1382#else
1383static inline int slave_enable_netpoll(struct slave *slave)
1384{
1385 return 0;
1386}
1387static inline void slave_disable_netpoll(struct slave *slave)
1388{
1389}
1390static void bond_netpoll_cleanup(struct net_device *bond_dev)
1391{
1392}
1393#endif
1394
1395/*---------------------------------- IOCTL ----------------------------------*/
1396
1397static netdev_features_t bond_fix_features(struct net_device *dev,
1398 netdev_features_t features)
1399{
1400 struct bonding *bond = netdev_priv(dev);
1401 struct list_head *iter;
1402 netdev_features_t mask;
1403 struct slave *slave;
1404
1405 mask = features;
1406
1407 features &= ~NETIF_F_ONE_FOR_ALL;
1408 features |= NETIF_F_ALL_FOR_ALL;
1409
1410 bond_for_each_slave(bond, slave, iter) {
1411 features = netdev_increment_features(features,
1412 slave->dev->features,
1413 mask);
1414 }
1415 features = netdev_add_tso_features(features, mask);
1416
1417 return features;
1418}
1419
1420#define BOND_VLAN_FEATURES (NETIF_F_HW_CSUM | NETIF_F_SG | \
1421 NETIF_F_FRAGLIST | NETIF_F_GSO_SOFTWARE | \
1422 NETIF_F_HIGHDMA | NETIF_F_LRO)
1423
1424#define BOND_ENC_FEATURES (NETIF_F_HW_CSUM | NETIF_F_SG | \
1425 NETIF_F_RXCSUM | NETIF_F_GSO_SOFTWARE)
1426
1427#define BOND_MPLS_FEATURES (NETIF_F_HW_CSUM | NETIF_F_SG | \
1428 NETIF_F_GSO_SOFTWARE)
1429
1430
1431static void bond_compute_features(struct bonding *bond)
1432{
1433 unsigned int dst_release_flag = IFF_XMIT_DST_RELEASE |
1434 IFF_XMIT_DST_RELEASE_PERM;
1435 netdev_features_t vlan_features = BOND_VLAN_FEATURES;
1436 netdev_features_t enc_features = BOND_ENC_FEATURES;
1437#ifdef CONFIG_XFRM_OFFLOAD
1438 netdev_features_t xfrm_features = BOND_XFRM_FEATURES;
1439#endif /* CONFIG_XFRM_OFFLOAD */
1440 netdev_features_t mpls_features = BOND_MPLS_FEATURES;
1441 struct net_device *bond_dev = bond->dev;
1442 struct list_head *iter;
1443 struct slave *slave;
1444 unsigned short max_hard_header_len = ETH_HLEN;
1445 unsigned int tso_max_size = TSO_MAX_SIZE;
1446 u16 tso_max_segs = TSO_MAX_SEGS;
1447
1448 if (!bond_has_slaves(bond))
1449 goto done;
1450 vlan_features &= NETIF_F_ALL_FOR_ALL;
1451 mpls_features &= NETIF_F_ALL_FOR_ALL;
1452
1453 bond_for_each_slave(bond, slave, iter) {
1454 vlan_features = netdev_increment_features(vlan_features,
1455 slave->dev->vlan_features, BOND_VLAN_FEATURES);
1456
1457 enc_features = netdev_increment_features(enc_features,
1458 slave->dev->hw_enc_features,
1459 BOND_ENC_FEATURES);
1460
1461#ifdef CONFIG_XFRM_OFFLOAD
1462 xfrm_features = netdev_increment_features(xfrm_features,
1463 slave->dev->hw_enc_features,
1464 BOND_XFRM_FEATURES);
1465#endif /* CONFIG_XFRM_OFFLOAD */
1466
1467 mpls_features = netdev_increment_features(mpls_features,
1468 slave->dev->mpls_features,
1469 BOND_MPLS_FEATURES);
1470
1471 dst_release_flag &= slave->dev->priv_flags;
1472 if (slave->dev->hard_header_len > max_hard_header_len)
1473 max_hard_header_len = slave->dev->hard_header_len;
1474
1475 tso_max_size = min(tso_max_size, slave->dev->tso_max_size);
1476 tso_max_segs = min(tso_max_segs, slave->dev->tso_max_segs);
1477 }
1478 bond_dev->hard_header_len = max_hard_header_len;
1479
1480done:
1481 bond_dev->vlan_features = vlan_features;
1482 bond_dev->hw_enc_features = enc_features | NETIF_F_GSO_ENCAP_ALL |
1483 NETIF_F_HW_VLAN_CTAG_TX |
1484 NETIF_F_HW_VLAN_STAG_TX;
1485#ifdef CONFIG_XFRM_OFFLOAD
1486 bond_dev->hw_enc_features |= xfrm_features;
1487#endif /* CONFIG_XFRM_OFFLOAD */
1488 bond_dev->mpls_features = mpls_features;
1489 netif_set_tso_max_segs(bond_dev, tso_max_segs);
1490 netif_set_tso_max_size(bond_dev, tso_max_size);
1491
1492 bond_dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
1493 if ((bond_dev->priv_flags & IFF_XMIT_DST_RELEASE_PERM) &&
1494 dst_release_flag == (IFF_XMIT_DST_RELEASE | IFF_XMIT_DST_RELEASE_PERM))
1495 bond_dev->priv_flags |= IFF_XMIT_DST_RELEASE;
1496
1497 netdev_change_features(bond_dev);
1498}
1499
1500static void bond_setup_by_slave(struct net_device *bond_dev,
1501 struct net_device *slave_dev)
1502{
1503 bool was_up = !!(bond_dev->flags & IFF_UP);
1504
1505 dev_close(bond_dev);
1506
1507 bond_dev->header_ops = slave_dev->header_ops;
1508
1509 bond_dev->type = slave_dev->type;
1510 bond_dev->hard_header_len = slave_dev->hard_header_len;
1511 bond_dev->needed_headroom = slave_dev->needed_headroom;
1512 bond_dev->addr_len = slave_dev->addr_len;
1513
1514 memcpy(bond_dev->broadcast, slave_dev->broadcast,
1515 slave_dev->addr_len);
1516
1517 if (slave_dev->flags & IFF_POINTOPOINT) {
1518 bond_dev->flags &= ~(IFF_BROADCAST | IFF_MULTICAST);
1519 bond_dev->flags |= (IFF_POINTOPOINT | IFF_NOARP);
1520 }
1521 if (was_up)
1522 dev_open(bond_dev, NULL);
1523}
1524
1525/* On bonding slaves other than the currently active slave, suppress
1526 * duplicates except for alb non-mcast/bcast.
1527 */
1528static bool bond_should_deliver_exact_match(struct sk_buff *skb,
1529 struct slave *slave,
1530 struct bonding *bond)
1531{
1532 if (bond_is_slave_inactive(slave)) {
1533 if (BOND_MODE(bond) == BOND_MODE_ALB &&
1534 skb->pkt_type != PACKET_BROADCAST &&
1535 skb->pkt_type != PACKET_MULTICAST)
1536 return false;
1537 return true;
1538 }
1539 return false;
1540}
1541
1542static rx_handler_result_t bond_handle_frame(struct sk_buff **pskb)
1543{
1544 struct sk_buff *skb = *pskb;
1545 struct slave *slave;
1546 struct bonding *bond;
1547 int (*recv_probe)(const struct sk_buff *, struct bonding *,
1548 struct slave *);
1549 int ret = RX_HANDLER_ANOTHER;
1550
1551 skb = skb_share_check(skb, GFP_ATOMIC);
1552 if (unlikely(!skb))
1553 return RX_HANDLER_CONSUMED;
1554
1555 *pskb = skb;
1556
1557 slave = bond_slave_get_rcu(skb->dev);
1558 bond = slave->bond;
1559
1560 recv_probe = READ_ONCE(bond->recv_probe);
1561 if (recv_probe) {
1562 ret = recv_probe(skb, bond, slave);
1563 if (ret == RX_HANDLER_CONSUMED) {
1564 consume_skb(skb);
1565 return ret;
1566 }
1567 }
1568
1569 /*
1570 * For packets determined by bond_should_deliver_exact_match() call to
1571 * be suppressed we want to make an exception for link-local packets.
1572 * This is necessary for e.g. LLDP daemons to be able to monitor
1573 * inactive slave links without being forced to bind to them
1574 * explicitly.
1575 *
1576 * At the same time, packets that are passed to the bonding master
1577 * (including link-local ones) can have their originating interface
1578 * determined via PACKET_ORIGDEV socket option.
1579 */
1580 if (bond_should_deliver_exact_match(skb, slave, bond)) {
1581 if (is_link_local_ether_addr(eth_hdr(skb)->h_dest))
1582 return RX_HANDLER_PASS;
1583 return RX_HANDLER_EXACT;
1584 }
1585
1586 skb->dev = bond->dev;
1587
1588 if (BOND_MODE(bond) == BOND_MODE_ALB &&
1589 netif_is_bridge_port(bond->dev) &&
1590 skb->pkt_type == PACKET_HOST) {
1591
1592 if (unlikely(skb_cow_head(skb,
1593 skb->data - skb_mac_header(skb)))) {
1594 kfree_skb(skb);
1595 return RX_HANDLER_CONSUMED;
1596 }
1597 bond_hw_addr_copy(eth_hdr(skb)->h_dest, bond->dev->dev_addr,
1598 bond->dev->addr_len);
1599 }
1600
1601 return ret;
1602}
1603
1604static enum netdev_lag_tx_type bond_lag_tx_type(struct bonding *bond)
1605{
1606 switch (BOND_MODE(bond)) {
1607 case BOND_MODE_ROUNDROBIN:
1608 return NETDEV_LAG_TX_TYPE_ROUNDROBIN;
1609 case BOND_MODE_ACTIVEBACKUP:
1610 return NETDEV_LAG_TX_TYPE_ACTIVEBACKUP;
1611 case BOND_MODE_BROADCAST:
1612 return NETDEV_LAG_TX_TYPE_BROADCAST;
1613 case BOND_MODE_XOR:
1614 case BOND_MODE_8023AD:
1615 return NETDEV_LAG_TX_TYPE_HASH;
1616 default:
1617 return NETDEV_LAG_TX_TYPE_UNKNOWN;
1618 }
1619}
1620
1621static enum netdev_lag_hash bond_lag_hash_type(struct bonding *bond,
1622 enum netdev_lag_tx_type type)
1623{
1624 if (type != NETDEV_LAG_TX_TYPE_HASH)
1625 return NETDEV_LAG_HASH_NONE;
1626
1627 switch (bond->params.xmit_policy) {
1628 case BOND_XMIT_POLICY_LAYER2:
1629 return NETDEV_LAG_HASH_L2;
1630 case BOND_XMIT_POLICY_LAYER34:
1631 return NETDEV_LAG_HASH_L34;
1632 case BOND_XMIT_POLICY_LAYER23:
1633 return NETDEV_LAG_HASH_L23;
1634 case BOND_XMIT_POLICY_ENCAP23:
1635 return NETDEV_LAG_HASH_E23;
1636 case BOND_XMIT_POLICY_ENCAP34:
1637 return NETDEV_LAG_HASH_E34;
1638 case BOND_XMIT_POLICY_VLAN_SRCMAC:
1639 return NETDEV_LAG_HASH_VLAN_SRCMAC;
1640 default:
1641 return NETDEV_LAG_HASH_UNKNOWN;
1642 }
1643}
1644
1645static int bond_master_upper_dev_link(struct bonding *bond, struct slave *slave,
1646 struct netlink_ext_ack *extack)
1647{
1648 struct netdev_lag_upper_info lag_upper_info;
1649 enum netdev_lag_tx_type type;
1650 int err;
1651
1652 type = bond_lag_tx_type(bond);
1653 lag_upper_info.tx_type = type;
1654 lag_upper_info.hash_type = bond_lag_hash_type(bond, type);
1655
1656 err = netdev_master_upper_dev_link(slave->dev, bond->dev, slave,
1657 &lag_upper_info, extack);
1658 if (err)
1659 return err;
1660
1661 slave->dev->flags |= IFF_SLAVE;
1662 return 0;
1663}
1664
1665static void bond_upper_dev_unlink(struct bonding *bond, struct slave *slave)
1666{
1667 netdev_upper_dev_unlink(slave->dev, bond->dev);
1668 slave->dev->flags &= ~IFF_SLAVE;
1669}
1670
1671static void slave_kobj_release(struct kobject *kobj)
1672{
1673 struct slave *slave = to_slave(kobj);
1674 struct bonding *bond = bond_get_bond_by_slave(slave);
1675
1676 cancel_delayed_work_sync(&slave->notify_work);
1677 if (BOND_MODE(bond) == BOND_MODE_8023AD)
1678 kfree(SLAVE_AD_INFO(slave));
1679
1680 kfree(slave);
1681}
1682
1683static struct kobj_type slave_ktype = {
1684 .release = slave_kobj_release,
1685#ifdef CONFIG_SYSFS
1686 .sysfs_ops = &slave_sysfs_ops,
1687#endif
1688};
1689
1690static int bond_kobj_init(struct slave *slave)
1691{
1692 int err;
1693
1694 err = kobject_init_and_add(&slave->kobj, &slave_ktype,
1695 &(slave->dev->dev.kobj), "bonding_slave");
1696 if (err)
1697 kobject_put(&slave->kobj);
1698
1699 return err;
1700}
1701
1702static struct slave *bond_alloc_slave(struct bonding *bond,
1703 struct net_device *slave_dev)
1704{
1705 struct slave *slave = NULL;
1706
1707 slave = kzalloc(sizeof(*slave), GFP_KERNEL);
1708 if (!slave)
1709 return NULL;
1710
1711 slave->bond = bond;
1712 slave->dev = slave_dev;
1713 INIT_DELAYED_WORK(&slave->notify_work, bond_netdev_notify_work);
1714
1715 if (bond_kobj_init(slave))
1716 return NULL;
1717
1718 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
1719 SLAVE_AD_INFO(slave) = kzalloc(sizeof(struct ad_slave_info),
1720 GFP_KERNEL);
1721 if (!SLAVE_AD_INFO(slave)) {
1722 kobject_put(&slave->kobj);
1723 return NULL;
1724 }
1725 }
1726
1727 return slave;
1728}
1729
1730static void bond_fill_ifbond(struct bonding *bond, struct ifbond *info)
1731{
1732 info->bond_mode = BOND_MODE(bond);
1733 info->miimon = bond->params.miimon;
1734 info->num_slaves = bond->slave_cnt;
1735}
1736
1737static void bond_fill_ifslave(struct slave *slave, struct ifslave *info)
1738{
1739 strcpy(info->slave_name, slave->dev->name);
1740 info->link = slave->link;
1741 info->state = bond_slave_state(slave);
1742 info->link_failure_count = slave->link_failure_count;
1743}
1744
1745static void bond_netdev_notify_work(struct work_struct *_work)
1746{
1747 struct slave *slave = container_of(_work, struct slave,
1748 notify_work.work);
1749
1750 if (rtnl_trylock()) {
1751 struct netdev_bonding_info binfo;
1752
1753 bond_fill_ifslave(slave, &binfo.slave);
1754 bond_fill_ifbond(slave->bond, &binfo.master);
1755 netdev_bonding_info_change(slave->dev, &binfo);
1756 rtnl_unlock();
1757 } else {
1758 queue_delayed_work(slave->bond->wq, &slave->notify_work, 1);
1759 }
1760}
1761
1762void bond_queue_slave_event(struct slave *slave)
1763{
1764 queue_delayed_work(slave->bond->wq, &slave->notify_work, 0);
1765}
1766
1767void bond_lower_state_changed(struct slave *slave)
1768{
1769 struct netdev_lag_lower_state_info info;
1770
1771 info.link_up = slave->link == BOND_LINK_UP ||
1772 slave->link == BOND_LINK_FAIL;
1773 info.tx_enabled = bond_is_active_slave(slave);
1774 netdev_lower_state_changed(slave->dev, &info);
1775}
1776
1777#define BOND_NL_ERR(bond_dev, extack, errmsg) do { \
1778 if (extack) \
1779 NL_SET_ERR_MSG(extack, errmsg); \
1780 else \
1781 netdev_err(bond_dev, "Error: %s\n", errmsg); \
1782} while (0)
1783
1784#define SLAVE_NL_ERR(bond_dev, slave_dev, extack, errmsg) do { \
1785 if (extack) \
1786 NL_SET_ERR_MSG(extack, errmsg); \
1787 else \
1788 slave_err(bond_dev, slave_dev, "Error: %s\n", errmsg); \
1789} while (0)
1790
1791/* The bonding driver uses ether_setup() to convert a master bond device
1792 * to ARPHRD_ETHER, that resets the target netdevice's flags so we always
1793 * have to restore the IFF_MASTER flag, and only restore IFF_SLAVE and IFF_UP
1794 * if they were set
1795 */
1796static void bond_ether_setup(struct net_device *bond_dev)
1797{
1798 unsigned int flags = bond_dev->flags & (IFF_SLAVE | IFF_UP);
1799
1800 ether_setup(bond_dev);
1801 bond_dev->flags |= IFF_MASTER | flags;
1802 bond_dev->priv_flags &= ~IFF_TX_SKB_SHARING;
1803}
1804
1805void bond_xdp_set_features(struct net_device *bond_dev)
1806{
1807 struct bonding *bond = netdev_priv(bond_dev);
1808 xdp_features_t val = NETDEV_XDP_ACT_MASK;
1809 struct list_head *iter;
1810 struct slave *slave;
1811
1812 ASSERT_RTNL();
1813
1814 if (!bond_xdp_check(bond) || !bond_has_slaves(bond)) {
1815 xdp_clear_features_flag(bond_dev);
1816 return;
1817 }
1818
1819 bond_for_each_slave(bond, slave, iter)
1820 val &= slave->dev->xdp_features;
1821
1822 val &= ~NETDEV_XDP_ACT_XSK_ZEROCOPY;
1823
1824 xdp_set_features_flag(bond_dev, val);
1825}
1826
1827/* enslave device <slave> to bond device <master> */
1828int bond_enslave(struct net_device *bond_dev, struct net_device *slave_dev,
1829 struct netlink_ext_ack *extack)
1830{
1831 struct bonding *bond = netdev_priv(bond_dev);
1832 const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
1833 struct slave *new_slave = NULL, *prev_slave;
1834 struct sockaddr_storage ss;
1835 int link_reporting;
1836 int res = 0, i;
1837
1838 if (slave_dev->flags & IFF_MASTER &&
1839 !netif_is_bond_master(slave_dev)) {
1840 BOND_NL_ERR(bond_dev, extack,
1841 "Device type (master device) cannot be enslaved");
1842 return -EPERM;
1843 }
1844
1845 if (!bond->params.use_carrier &&
1846 slave_dev->ethtool_ops->get_link == NULL &&
1847 slave_ops->ndo_eth_ioctl == NULL) {
1848 slave_warn(bond_dev, slave_dev, "no link monitoring support\n");
1849 }
1850
1851 /* already in-use? */
1852 if (netdev_is_rx_handler_busy(slave_dev)) {
1853 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1854 "Device is in use and cannot be enslaved");
1855 return -EBUSY;
1856 }
1857
1858 if (bond_dev == slave_dev) {
1859 BOND_NL_ERR(bond_dev, extack, "Cannot enslave bond to itself.");
1860 return -EPERM;
1861 }
1862
1863 /* vlan challenged mutual exclusion */
1864 /* no need to lock since we're protected by rtnl_lock */
1865 if (slave_dev->features & NETIF_F_VLAN_CHALLENGED) {
1866 slave_dbg(bond_dev, slave_dev, "is NETIF_F_VLAN_CHALLENGED\n");
1867 if (vlan_uses_dev(bond_dev)) {
1868 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1869 "Can not enslave VLAN challenged device to VLAN enabled bond");
1870 return -EPERM;
1871 } else {
1872 slave_warn(bond_dev, slave_dev, "enslaved VLAN challenged slave. Adding VLANs will be blocked as long as it is part of bond.\n");
1873 }
1874 } else {
1875 slave_dbg(bond_dev, slave_dev, "is !NETIF_F_VLAN_CHALLENGED\n");
1876 }
1877
1878 if (slave_dev->features & NETIF_F_HW_ESP)
1879 slave_dbg(bond_dev, slave_dev, "is esp-hw-offload capable\n");
1880
1881 /* Old ifenslave binaries are no longer supported. These can
1882 * be identified with moderate accuracy by the state of the slave:
1883 * the current ifenslave will set the interface down prior to
1884 * enslaving it; the old ifenslave will not.
1885 */
1886 if (slave_dev->flags & IFF_UP) {
1887 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1888 "Device can not be enslaved while up");
1889 return -EPERM;
1890 }
1891
1892 /* set bonding device ether type by slave - bonding netdevices are
1893 * created with ether_setup, so when the slave type is not ARPHRD_ETHER
1894 * there is a need to override some of the type dependent attribs/funcs.
1895 *
1896 * bond ether type mutual exclusion - don't allow slaves of dissimilar
1897 * ether type (eg ARPHRD_ETHER and ARPHRD_INFINIBAND) share the same bond
1898 */
1899 if (!bond_has_slaves(bond)) {
1900 if (bond_dev->type != slave_dev->type) {
1901 slave_dbg(bond_dev, slave_dev, "change device type from %d to %d\n",
1902 bond_dev->type, slave_dev->type);
1903
1904 res = call_netdevice_notifiers(NETDEV_PRE_TYPE_CHANGE,
1905 bond_dev);
1906 res = notifier_to_errno(res);
1907 if (res) {
1908 slave_err(bond_dev, slave_dev, "refused to change device type\n");
1909 return -EBUSY;
1910 }
1911
1912 /* Flush unicast and multicast addresses */
1913 dev_uc_flush(bond_dev);
1914 dev_mc_flush(bond_dev);
1915
1916 if (slave_dev->type != ARPHRD_ETHER)
1917 bond_setup_by_slave(bond_dev, slave_dev);
1918 else
1919 bond_ether_setup(bond_dev);
1920
1921 call_netdevice_notifiers(NETDEV_POST_TYPE_CHANGE,
1922 bond_dev);
1923 }
1924 } else if (bond_dev->type != slave_dev->type) {
1925 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1926 "Device type is different from other slaves");
1927 return -EINVAL;
1928 }
1929
1930 if (slave_dev->type == ARPHRD_INFINIBAND &&
1931 BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1932 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1933 "Only active-backup mode is supported for infiniband slaves");
1934 res = -EOPNOTSUPP;
1935 goto err_undo_flags;
1936 }
1937
1938 if (!slave_ops->ndo_set_mac_address ||
1939 slave_dev->type == ARPHRD_INFINIBAND) {
1940 slave_warn(bond_dev, slave_dev, "The slave device specified does not support setting the MAC address\n");
1941 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP &&
1942 bond->params.fail_over_mac != BOND_FOM_ACTIVE) {
1943 if (!bond_has_slaves(bond)) {
1944 bond->params.fail_over_mac = BOND_FOM_ACTIVE;
1945 slave_warn(bond_dev, slave_dev, "Setting fail_over_mac to active for active-backup mode\n");
1946 } else {
1947 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
1948 "Slave device does not support setting the MAC address, but fail_over_mac is not set to active");
1949 res = -EOPNOTSUPP;
1950 goto err_undo_flags;
1951 }
1952 }
1953 }
1954
1955 call_netdevice_notifiers(NETDEV_JOIN, slave_dev);
1956
1957 /* If this is the first slave, then we need to set the master's hardware
1958 * address to be the same as the slave's.
1959 */
1960 if (!bond_has_slaves(bond) &&
1961 bond->dev->addr_assign_type == NET_ADDR_RANDOM) {
1962 res = bond_set_dev_addr(bond->dev, slave_dev);
1963 if (res)
1964 goto err_undo_flags;
1965 }
1966
1967 new_slave = bond_alloc_slave(bond, slave_dev);
1968 if (!new_slave) {
1969 res = -ENOMEM;
1970 goto err_undo_flags;
1971 }
1972
1973 /* Set the new_slave's queue_id to be zero. Queue ID mapping
1974 * is set via sysfs or module option if desired.
1975 */
1976 new_slave->queue_id = 0;
1977
1978 /* Save slave's original mtu and then set it to match the bond */
1979 new_slave->original_mtu = slave_dev->mtu;
1980 res = dev_set_mtu(slave_dev, bond->dev->mtu);
1981 if (res) {
1982 slave_err(bond_dev, slave_dev, "Error %d calling dev_set_mtu\n", res);
1983 goto err_free;
1984 }
1985
1986 /* Save slave's original ("permanent") mac address for modes
1987 * that need it, and for restoring it upon release, and then
1988 * set it to the master's address
1989 */
1990 bond_hw_addr_copy(new_slave->perm_hwaddr, slave_dev->dev_addr,
1991 slave_dev->addr_len);
1992
1993 if (!bond->params.fail_over_mac ||
1994 BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1995 /* Set slave to master's mac address. The application already
1996 * set the master's mac address to that of the first slave
1997 */
1998 memcpy(ss.__data, bond_dev->dev_addr, bond_dev->addr_len);
1999 ss.ss_family = slave_dev->type;
2000 res = dev_set_mac_address(slave_dev, (struct sockaddr *)&ss,
2001 extack);
2002 if (res) {
2003 slave_err(bond_dev, slave_dev, "Error %d calling set_mac_address\n", res);
2004 goto err_restore_mtu;
2005 }
2006 }
2007
2008 /* set no_addrconf flag before open to prevent IPv6 addrconf */
2009 slave_dev->priv_flags |= IFF_NO_ADDRCONF;
2010
2011 /* open the slave since the application closed it */
2012 res = dev_open(slave_dev, extack);
2013 if (res) {
2014 slave_err(bond_dev, slave_dev, "Opening slave failed\n");
2015 goto err_restore_mac;
2016 }
2017
2018 slave_dev->priv_flags |= IFF_BONDING;
2019 /* initialize slave stats */
2020 dev_get_stats(new_slave->dev, &new_slave->slave_stats);
2021
2022 if (bond_is_lb(bond)) {
2023 /* bond_alb_init_slave() must be called before all other stages since
2024 * it might fail and we do not want to have to undo everything
2025 */
2026 res = bond_alb_init_slave(bond, new_slave);
2027 if (res)
2028 goto err_close;
2029 }
2030
2031 res = vlan_vids_add_by_dev(slave_dev, bond_dev);
2032 if (res) {
2033 slave_err(bond_dev, slave_dev, "Couldn't add bond vlan ids\n");
2034 goto err_close;
2035 }
2036
2037 prev_slave = bond_last_slave(bond);
2038
2039 new_slave->delay = 0;
2040 new_slave->link_failure_count = 0;
2041
2042 if (bond_update_speed_duplex(new_slave) &&
2043 bond_needs_speed_duplex(bond))
2044 new_slave->link = BOND_LINK_DOWN;
2045
2046 new_slave->last_rx = jiffies -
2047 (msecs_to_jiffies(bond->params.arp_interval) + 1);
2048 for (i = 0; i < BOND_MAX_ARP_TARGETS; i++)
2049 new_slave->target_last_arp_rx[i] = new_slave->last_rx;
2050
2051 new_slave->last_tx = new_slave->last_rx;
2052
2053 if (bond->params.miimon && !bond->params.use_carrier) {
2054 link_reporting = bond_check_dev_link(bond, slave_dev, 1);
2055
2056 if ((link_reporting == -1) && !bond->params.arp_interval) {
2057 /* miimon is set but a bonded network driver
2058 * does not support ETHTOOL/MII and
2059 * arp_interval is not set. Note: if
2060 * use_carrier is enabled, we will never go
2061 * here (because netif_carrier is always
2062 * supported); thus, we don't need to change
2063 * the messages for netif_carrier.
2064 */
2065 slave_warn(bond_dev, slave_dev, "MII and ETHTOOL support not available for slave, and arp_interval/arp_ip_target module parameters not specified, thus bonding will not detect link failures! see bonding.txt for details\n");
2066 } else if (link_reporting == -1) {
2067 /* unable get link status using mii/ethtool */
2068 slave_warn(bond_dev, slave_dev, "can't get link status from slave; the network driver associated with this interface does not support MII or ETHTOOL link status reporting, thus miimon has no effect on this interface\n");
2069 }
2070 }
2071
2072 /* check for initial state */
2073 new_slave->link = BOND_LINK_NOCHANGE;
2074 if (bond->params.miimon) {
2075 if (bond_check_dev_link(bond, slave_dev, 0) == BMSR_LSTATUS) {
2076 if (bond->params.updelay) {
2077 bond_set_slave_link_state(new_slave,
2078 BOND_LINK_BACK,
2079 BOND_SLAVE_NOTIFY_NOW);
2080 new_slave->delay = bond->params.updelay;
2081 } else {
2082 bond_set_slave_link_state(new_slave,
2083 BOND_LINK_UP,
2084 BOND_SLAVE_NOTIFY_NOW);
2085 }
2086 } else {
2087 bond_set_slave_link_state(new_slave, BOND_LINK_DOWN,
2088 BOND_SLAVE_NOTIFY_NOW);
2089 }
2090 } else if (bond->params.arp_interval) {
2091 bond_set_slave_link_state(new_slave,
2092 (netif_carrier_ok(slave_dev) ?
2093 BOND_LINK_UP : BOND_LINK_DOWN),
2094 BOND_SLAVE_NOTIFY_NOW);
2095 } else {
2096 bond_set_slave_link_state(new_slave, BOND_LINK_UP,
2097 BOND_SLAVE_NOTIFY_NOW);
2098 }
2099
2100 if (new_slave->link != BOND_LINK_DOWN)
2101 new_slave->last_link_up = jiffies;
2102 slave_dbg(bond_dev, slave_dev, "Initial state of slave is BOND_LINK_%s\n",
2103 new_slave->link == BOND_LINK_DOWN ? "DOWN" :
2104 (new_slave->link == BOND_LINK_UP ? "UP" : "BACK"));
2105
2106 if (bond_uses_primary(bond) && bond->params.primary[0]) {
2107 /* if there is a primary slave, remember it */
2108 if (strcmp(bond->params.primary, new_slave->dev->name) == 0) {
2109 rcu_assign_pointer(bond->primary_slave, new_slave);
2110 bond->force_primary = true;
2111 }
2112 }
2113
2114 switch (BOND_MODE(bond)) {
2115 case BOND_MODE_ACTIVEBACKUP:
2116 bond_set_slave_inactive_flags(new_slave,
2117 BOND_SLAVE_NOTIFY_NOW);
2118 break;
2119 case BOND_MODE_8023AD:
2120 /* in 802.3ad mode, the internal mechanism
2121 * will activate the slaves in the selected
2122 * aggregator
2123 */
2124 bond_set_slave_inactive_flags(new_slave, BOND_SLAVE_NOTIFY_NOW);
2125 /* if this is the first slave */
2126 if (!prev_slave) {
2127 SLAVE_AD_INFO(new_slave)->id = 1;
2128 /* Initialize AD with the number of times that the AD timer is called in 1 second
2129 * can be called only after the mac address of the bond is set
2130 */
2131 bond_3ad_initialize(bond);
2132 } else {
2133 SLAVE_AD_INFO(new_slave)->id =
2134 SLAVE_AD_INFO(prev_slave)->id + 1;
2135 }
2136
2137 bond_3ad_bind_slave(new_slave);
2138 break;
2139 case BOND_MODE_TLB:
2140 case BOND_MODE_ALB:
2141 bond_set_active_slave(new_slave);
2142 bond_set_slave_inactive_flags(new_slave, BOND_SLAVE_NOTIFY_NOW);
2143 break;
2144 default:
2145 slave_dbg(bond_dev, slave_dev, "This slave is always active in trunk mode\n");
2146
2147 /* always active in trunk mode */
2148 bond_set_active_slave(new_slave);
2149
2150 /* In trunking mode there is little meaning to curr_active_slave
2151 * anyway (it holds no special properties of the bond device),
2152 * so we can change it without calling change_active_interface()
2153 */
2154 if (!rcu_access_pointer(bond->curr_active_slave) &&
2155 new_slave->link == BOND_LINK_UP)
2156 rcu_assign_pointer(bond->curr_active_slave, new_slave);
2157
2158 break;
2159 } /* switch(bond_mode) */
2160
2161#ifdef CONFIG_NET_POLL_CONTROLLER
2162 if (bond->dev->npinfo) {
2163 if (slave_enable_netpoll(new_slave)) {
2164 slave_info(bond_dev, slave_dev, "master_dev is using netpoll, but new slave device does not support netpoll\n");
2165 res = -EBUSY;
2166 goto err_detach;
2167 }
2168 }
2169#endif
2170
2171 if (!(bond_dev->features & NETIF_F_LRO))
2172 dev_disable_lro(slave_dev);
2173
2174 res = netdev_rx_handler_register(slave_dev, bond_handle_frame,
2175 new_slave);
2176 if (res) {
2177 slave_dbg(bond_dev, slave_dev, "Error %d calling netdev_rx_handler_register\n", res);
2178 goto err_detach;
2179 }
2180
2181 res = bond_master_upper_dev_link(bond, new_slave, extack);
2182 if (res) {
2183 slave_dbg(bond_dev, slave_dev, "Error %d calling bond_master_upper_dev_link\n", res);
2184 goto err_unregister;
2185 }
2186
2187 bond_lower_state_changed(new_slave);
2188
2189 res = bond_sysfs_slave_add(new_slave);
2190 if (res) {
2191 slave_dbg(bond_dev, slave_dev, "Error %d calling bond_sysfs_slave_add\n", res);
2192 goto err_upper_unlink;
2193 }
2194
2195 /* If the mode uses primary, then the following is handled by
2196 * bond_change_active_slave().
2197 */
2198 if (!bond_uses_primary(bond)) {
2199 /* set promiscuity level to new slave */
2200 if (bond_dev->flags & IFF_PROMISC) {
2201 res = dev_set_promiscuity(slave_dev, 1);
2202 if (res)
2203 goto err_sysfs_del;
2204 }
2205
2206 /* set allmulti level to new slave */
2207 if (bond_dev->flags & IFF_ALLMULTI) {
2208 res = dev_set_allmulti(slave_dev, 1);
2209 if (res) {
2210 if (bond_dev->flags & IFF_PROMISC)
2211 dev_set_promiscuity(slave_dev, -1);
2212 goto err_sysfs_del;
2213 }
2214 }
2215
2216 if (bond_dev->flags & IFF_UP) {
2217 netif_addr_lock_bh(bond_dev);
2218 dev_mc_sync_multiple(slave_dev, bond_dev);
2219 dev_uc_sync_multiple(slave_dev, bond_dev);
2220 netif_addr_unlock_bh(bond_dev);
2221
2222 if (BOND_MODE(bond) == BOND_MODE_8023AD)
2223 dev_mc_add(slave_dev, lacpdu_mcast_addr);
2224 }
2225 }
2226
2227 bond->slave_cnt++;
2228 bond_compute_features(bond);
2229 bond_set_carrier(bond);
2230
2231 if (bond_uses_primary(bond)) {
2232 block_netpoll_tx();
2233 bond_select_active_slave(bond);
2234 unblock_netpoll_tx();
2235 }
2236
2237 if (bond_mode_can_use_xmit_hash(bond))
2238 bond_update_slave_arr(bond, NULL);
2239
2240
2241 if (!slave_dev->netdev_ops->ndo_bpf ||
2242 !slave_dev->netdev_ops->ndo_xdp_xmit) {
2243 if (bond->xdp_prog) {
2244 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
2245 "Slave does not support XDP");
2246 res = -EOPNOTSUPP;
2247 goto err_sysfs_del;
2248 }
2249 } else if (bond->xdp_prog) {
2250 struct netdev_bpf xdp = {
2251 .command = XDP_SETUP_PROG,
2252 .flags = 0,
2253 .prog = bond->xdp_prog,
2254 .extack = extack,
2255 };
2256
2257 if (dev_xdp_prog_count(slave_dev) > 0) {
2258 SLAVE_NL_ERR(bond_dev, slave_dev, extack,
2259 "Slave has XDP program loaded, please unload before enslaving");
2260 res = -EOPNOTSUPP;
2261 goto err_sysfs_del;
2262 }
2263
2264 res = slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp);
2265 if (res < 0) {
2266 /* ndo_bpf() sets extack error message */
2267 slave_dbg(bond_dev, slave_dev, "Error %d calling ndo_bpf\n", res);
2268 goto err_sysfs_del;
2269 }
2270 if (bond->xdp_prog)
2271 bpf_prog_inc(bond->xdp_prog);
2272 }
2273
2274 bond_xdp_set_features(bond_dev);
2275
2276 slave_info(bond_dev, slave_dev, "Enslaving as %s interface with %s link\n",
2277 bond_is_active_slave(new_slave) ? "an active" : "a backup",
2278 new_slave->link != BOND_LINK_DOWN ? "an up" : "a down");
2279
2280 /* enslave is successful */
2281 bond_queue_slave_event(new_slave);
2282 return 0;
2283
2284/* Undo stages on error */
2285err_sysfs_del:
2286 bond_sysfs_slave_del(new_slave);
2287
2288err_upper_unlink:
2289 bond_upper_dev_unlink(bond, new_slave);
2290
2291err_unregister:
2292 netdev_rx_handler_unregister(slave_dev);
2293
2294err_detach:
2295 vlan_vids_del_by_dev(slave_dev, bond_dev);
2296 if (rcu_access_pointer(bond->primary_slave) == new_slave)
2297 RCU_INIT_POINTER(bond->primary_slave, NULL);
2298 if (rcu_access_pointer(bond->curr_active_slave) == new_slave) {
2299 block_netpoll_tx();
2300 bond_change_active_slave(bond, NULL);
2301 bond_select_active_slave(bond);
2302 unblock_netpoll_tx();
2303 }
2304 /* either primary_slave or curr_active_slave might've changed */
2305 synchronize_rcu();
2306 slave_disable_netpoll(new_slave);
2307
2308err_close:
2309 if (!netif_is_bond_master(slave_dev))
2310 slave_dev->priv_flags &= ~IFF_BONDING;
2311 dev_close(slave_dev);
2312
2313err_restore_mac:
2314 slave_dev->priv_flags &= ~IFF_NO_ADDRCONF;
2315 if (!bond->params.fail_over_mac ||
2316 BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
2317 /* XXX TODO - fom follow mode needs to change master's
2318 * MAC if this slave's MAC is in use by the bond, or at
2319 * least print a warning.
2320 */
2321 bond_hw_addr_copy(ss.__data, new_slave->perm_hwaddr,
2322 new_slave->dev->addr_len);
2323 ss.ss_family = slave_dev->type;
2324 dev_set_mac_address(slave_dev, (struct sockaddr *)&ss, NULL);
2325 }
2326
2327err_restore_mtu:
2328 dev_set_mtu(slave_dev, new_slave->original_mtu);
2329
2330err_free:
2331 kobject_put(&new_slave->kobj);
2332
2333err_undo_flags:
2334 /* Enslave of first slave has failed and we need to fix master's mac */
2335 if (!bond_has_slaves(bond)) {
2336 if (ether_addr_equal_64bits(bond_dev->dev_addr,
2337 slave_dev->dev_addr))
2338 eth_hw_addr_random(bond_dev);
2339 if (bond_dev->type != ARPHRD_ETHER) {
2340 dev_close(bond_dev);
2341 bond_ether_setup(bond_dev);
2342 }
2343 }
2344
2345 return res;
2346}
2347
2348/* Try to release the slave device <slave> from the bond device <master>
2349 * It is legal to access curr_active_slave without a lock because all the function
2350 * is RTNL-locked. If "all" is true it means that the function is being called
2351 * while destroying a bond interface and all slaves are being released.
2352 *
2353 * The rules for slave state should be:
2354 * for Active/Backup:
2355 * Active stays on all backups go down
2356 * for Bonded connections:
2357 * The first up interface should be left on and all others downed.
2358 */
2359static int __bond_release_one(struct net_device *bond_dev,
2360 struct net_device *slave_dev,
2361 bool all, bool unregister)
2362{
2363 struct bonding *bond = netdev_priv(bond_dev);
2364 struct slave *slave, *oldcurrent;
2365 struct sockaddr_storage ss;
2366 int old_flags = bond_dev->flags;
2367 netdev_features_t old_features = bond_dev->features;
2368
2369 /* slave is not a slave or master is not master of this slave */
2370 if (!(slave_dev->flags & IFF_SLAVE) ||
2371 !netdev_has_upper_dev(slave_dev, bond_dev)) {
2372 slave_dbg(bond_dev, slave_dev, "cannot release slave\n");
2373 return -EINVAL;
2374 }
2375
2376 block_netpoll_tx();
2377
2378 slave = bond_get_slave_by_dev(bond, slave_dev);
2379 if (!slave) {
2380 /* not a slave of this bond */
2381 slave_info(bond_dev, slave_dev, "interface not enslaved\n");
2382 unblock_netpoll_tx();
2383 return -EINVAL;
2384 }
2385
2386 bond_set_slave_inactive_flags(slave, BOND_SLAVE_NOTIFY_NOW);
2387
2388 bond_sysfs_slave_del(slave);
2389
2390 /* recompute stats just before removing the slave */
2391 bond_get_stats(bond->dev, &bond->bond_stats);
2392
2393 if (bond->xdp_prog) {
2394 struct netdev_bpf xdp = {
2395 .command = XDP_SETUP_PROG,
2396 .flags = 0,
2397 .prog = NULL,
2398 .extack = NULL,
2399 };
2400 if (slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp))
2401 slave_warn(bond_dev, slave_dev, "failed to unload XDP program\n");
2402 }
2403
2404 /* unregister rx_handler early so bond_handle_frame wouldn't be called
2405 * for this slave anymore.
2406 */
2407 netdev_rx_handler_unregister(slave_dev);
2408
2409 if (BOND_MODE(bond) == BOND_MODE_8023AD)
2410 bond_3ad_unbind_slave(slave);
2411
2412 bond_upper_dev_unlink(bond, slave);
2413
2414 if (bond_mode_can_use_xmit_hash(bond))
2415 bond_update_slave_arr(bond, slave);
2416
2417 slave_info(bond_dev, slave_dev, "Releasing %s interface\n",
2418 bond_is_active_slave(slave) ? "active" : "backup");
2419
2420 oldcurrent = rcu_access_pointer(bond->curr_active_slave);
2421
2422 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
2423
2424 if (!all && (!bond->params.fail_over_mac ||
2425 BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP)) {
2426 if (ether_addr_equal_64bits(bond_dev->dev_addr, slave->perm_hwaddr) &&
2427 bond_has_slaves(bond))
2428 slave_warn(bond_dev, slave_dev, "the permanent HWaddr of slave - %pM - is still in use by bond - set the HWaddr of slave to a different address to avoid conflicts\n",
2429 slave->perm_hwaddr);
2430 }
2431
2432 if (rtnl_dereference(bond->primary_slave) == slave)
2433 RCU_INIT_POINTER(bond->primary_slave, NULL);
2434
2435 if (oldcurrent == slave)
2436 bond_change_active_slave(bond, NULL);
2437
2438 if (bond_is_lb(bond)) {
2439 /* Must be called only after the slave has been
2440 * detached from the list and the curr_active_slave
2441 * has been cleared (if our_slave == old_current),
2442 * but before a new active slave is selected.
2443 */
2444 bond_alb_deinit_slave(bond, slave);
2445 }
2446
2447 if (all) {
2448 RCU_INIT_POINTER(bond->curr_active_slave, NULL);
2449 } else if (oldcurrent == slave) {
2450 /* Note that we hold RTNL over this sequence, so there
2451 * is no concern that another slave add/remove event
2452 * will interfere.
2453 */
2454 bond_select_active_slave(bond);
2455 }
2456
2457 bond_set_carrier(bond);
2458 if (!bond_has_slaves(bond))
2459 eth_hw_addr_random(bond_dev);
2460
2461 unblock_netpoll_tx();
2462 synchronize_rcu();
2463 bond->slave_cnt--;
2464
2465 if (!bond_has_slaves(bond)) {
2466 call_netdevice_notifiers(NETDEV_CHANGEADDR, bond->dev);
2467 call_netdevice_notifiers(NETDEV_RELEASE, bond->dev);
2468 }
2469
2470 bond_compute_features(bond);
2471 if (!(bond_dev->features & NETIF_F_VLAN_CHALLENGED) &&
2472 (old_features & NETIF_F_VLAN_CHALLENGED))
2473 slave_info(bond_dev, slave_dev, "last VLAN challenged slave left bond - VLAN blocking is removed\n");
2474
2475 vlan_vids_del_by_dev(slave_dev, bond_dev);
2476
2477 /* If the mode uses primary, then this case was handled above by
2478 * bond_change_active_slave(..., NULL)
2479 */
2480 if (!bond_uses_primary(bond)) {
2481 /* unset promiscuity level from slave
2482 * NOTE: The NETDEV_CHANGEADDR call above may change the value
2483 * of the IFF_PROMISC flag in the bond_dev, but we need the
2484 * value of that flag before that change, as that was the value
2485 * when this slave was attached, so we cache at the start of the
2486 * function and use it here. Same goes for ALLMULTI below
2487 */
2488 if (old_flags & IFF_PROMISC)
2489 dev_set_promiscuity(slave_dev, -1);
2490
2491 /* unset allmulti level from slave */
2492 if (old_flags & IFF_ALLMULTI)
2493 dev_set_allmulti(slave_dev, -1);
2494
2495 if (old_flags & IFF_UP)
2496 bond_hw_addr_flush(bond_dev, slave_dev);
2497 }
2498
2499 slave_disable_netpoll(slave);
2500
2501 /* close slave before restoring its mac address */
2502 dev_close(slave_dev);
2503
2504 slave_dev->priv_flags &= ~IFF_NO_ADDRCONF;
2505
2506 if (bond->params.fail_over_mac != BOND_FOM_ACTIVE ||
2507 BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
2508 /* restore original ("permanent") mac address */
2509 bond_hw_addr_copy(ss.__data, slave->perm_hwaddr,
2510 slave->dev->addr_len);
2511 ss.ss_family = slave_dev->type;
2512 dev_set_mac_address(slave_dev, (struct sockaddr *)&ss, NULL);
2513 }
2514
2515 if (unregister)
2516 __dev_set_mtu(slave_dev, slave->original_mtu);
2517 else
2518 dev_set_mtu(slave_dev, slave->original_mtu);
2519
2520 if (!netif_is_bond_master(slave_dev))
2521 slave_dev->priv_flags &= ~IFF_BONDING;
2522
2523 bond_xdp_set_features(bond_dev);
2524 kobject_put(&slave->kobj);
2525
2526 return 0;
2527}
2528
2529/* A wrapper used because of ndo_del_link */
2530int bond_release(struct net_device *bond_dev, struct net_device *slave_dev)
2531{
2532 return __bond_release_one(bond_dev, slave_dev, false, false);
2533}
2534
2535/* First release a slave and then destroy the bond if no more slaves are left.
2536 * Must be under rtnl_lock when this function is called.
2537 */
2538static int bond_release_and_destroy(struct net_device *bond_dev,
2539 struct net_device *slave_dev)
2540{
2541 struct bonding *bond = netdev_priv(bond_dev);
2542 int ret;
2543
2544 ret = __bond_release_one(bond_dev, slave_dev, false, true);
2545 if (ret == 0 && !bond_has_slaves(bond) &&
2546 bond_dev->reg_state != NETREG_UNREGISTERING) {
2547 bond_dev->priv_flags |= IFF_DISABLE_NETPOLL;
2548 netdev_info(bond_dev, "Destroying bond\n");
2549 bond_remove_proc_entry(bond);
2550 unregister_netdevice(bond_dev);
2551 }
2552 return ret;
2553}
2554
2555static void bond_info_query(struct net_device *bond_dev, struct ifbond *info)
2556{
2557 struct bonding *bond = netdev_priv(bond_dev);
2558
2559 bond_fill_ifbond(bond, info);
2560}
2561
2562static int bond_slave_info_query(struct net_device *bond_dev, struct ifslave *info)
2563{
2564 struct bonding *bond = netdev_priv(bond_dev);
2565 struct list_head *iter;
2566 int i = 0, res = -ENODEV;
2567 struct slave *slave;
2568
2569 bond_for_each_slave(bond, slave, iter) {
2570 if (i++ == (int)info->slave_id) {
2571 res = 0;
2572 bond_fill_ifslave(slave, info);
2573 break;
2574 }
2575 }
2576
2577 return res;
2578}
2579
2580/*-------------------------------- Monitoring -------------------------------*/
2581
2582/* called with rcu_read_lock() */
2583static int bond_miimon_inspect(struct bonding *bond)
2584{
2585 bool ignore_updelay = false;
2586 int link_state, commit = 0;
2587 struct list_head *iter;
2588 struct slave *slave;
2589
2590 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP) {
2591 ignore_updelay = !rcu_dereference(bond->curr_active_slave);
2592 } else {
2593 struct bond_up_slave *usable_slaves;
2594
2595 usable_slaves = rcu_dereference(bond->usable_slaves);
2596
2597 if (usable_slaves && usable_slaves->count == 0)
2598 ignore_updelay = true;
2599 }
2600
2601 bond_for_each_slave_rcu(bond, slave, iter) {
2602 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
2603
2604 link_state = bond_check_dev_link(bond, slave->dev, 0);
2605
2606 switch (slave->link) {
2607 case BOND_LINK_UP:
2608 if (link_state)
2609 continue;
2610
2611 bond_propose_link_state(slave, BOND_LINK_FAIL);
2612 commit++;
2613 slave->delay = bond->params.downdelay;
2614 if (slave->delay && net_ratelimit()) {
2615 slave_info(bond->dev, slave->dev, "link status down for %sinterface, disabling it in %d ms\n",
2616 (BOND_MODE(bond) ==
2617 BOND_MODE_ACTIVEBACKUP) ?
2618 (bond_is_active_slave(slave) ?
2619 "active " : "backup ") : "",
2620 bond->params.downdelay * bond->params.miimon);
2621 }
2622 fallthrough;
2623 case BOND_LINK_FAIL:
2624 if (link_state) {
2625 /* recovered before downdelay expired */
2626 bond_propose_link_state(slave, BOND_LINK_UP);
2627 slave->last_link_up = jiffies;
2628 if (net_ratelimit())
2629 slave_info(bond->dev, slave->dev, "link status up again after %d ms\n",
2630 (bond->params.downdelay - slave->delay) *
2631 bond->params.miimon);
2632 commit++;
2633 continue;
2634 }
2635
2636 if (slave->delay <= 0) {
2637 bond_propose_link_state(slave, BOND_LINK_DOWN);
2638 commit++;
2639 continue;
2640 }
2641
2642 slave->delay--;
2643 break;
2644
2645 case BOND_LINK_DOWN:
2646 if (!link_state)
2647 continue;
2648
2649 bond_propose_link_state(slave, BOND_LINK_BACK);
2650 commit++;
2651 slave->delay = bond->params.updelay;
2652
2653 if (slave->delay && net_ratelimit()) {
2654 slave_info(bond->dev, slave->dev, "link status up, enabling it in %d ms\n",
2655 ignore_updelay ? 0 :
2656 bond->params.updelay *
2657 bond->params.miimon);
2658 }
2659 fallthrough;
2660 case BOND_LINK_BACK:
2661 if (!link_state) {
2662 bond_propose_link_state(slave, BOND_LINK_DOWN);
2663 if (net_ratelimit())
2664 slave_info(bond->dev, slave->dev, "link status down again after %d ms\n",
2665 (bond->params.updelay - slave->delay) *
2666 bond->params.miimon);
2667 commit++;
2668 continue;
2669 }
2670
2671 if (ignore_updelay)
2672 slave->delay = 0;
2673
2674 if (slave->delay <= 0) {
2675 bond_propose_link_state(slave, BOND_LINK_UP);
2676 commit++;
2677 ignore_updelay = false;
2678 continue;
2679 }
2680
2681 slave->delay--;
2682 break;
2683 }
2684 }
2685
2686 return commit;
2687}
2688
2689static void bond_miimon_link_change(struct bonding *bond,
2690 struct slave *slave,
2691 char link)
2692{
2693 switch (BOND_MODE(bond)) {
2694 case BOND_MODE_8023AD:
2695 bond_3ad_handle_link_change(slave, link);
2696 break;
2697 case BOND_MODE_TLB:
2698 case BOND_MODE_ALB:
2699 bond_alb_handle_link_change(bond, slave, link);
2700 break;
2701 case BOND_MODE_XOR:
2702 bond_update_slave_arr(bond, NULL);
2703 break;
2704 }
2705}
2706
2707static void bond_miimon_commit(struct bonding *bond)
2708{
2709 struct slave *slave, *primary, *active;
2710 bool do_failover = false;
2711 struct list_head *iter;
2712
2713 ASSERT_RTNL();
2714
2715 bond_for_each_slave(bond, slave, iter) {
2716 switch (slave->link_new_state) {
2717 case BOND_LINK_NOCHANGE:
2718 /* For 802.3ad mode, check current slave speed and
2719 * duplex again in case its port was disabled after
2720 * invalid speed/duplex reporting but recovered before
2721 * link monitoring could make a decision on the actual
2722 * link status
2723 */
2724 if (BOND_MODE(bond) == BOND_MODE_8023AD &&
2725 slave->link == BOND_LINK_UP)
2726 bond_3ad_adapter_speed_duplex_changed(slave);
2727 continue;
2728
2729 case BOND_LINK_UP:
2730 if (bond_update_speed_duplex(slave) &&
2731 bond_needs_speed_duplex(bond)) {
2732 slave->link = BOND_LINK_DOWN;
2733 if (net_ratelimit())
2734 slave_warn(bond->dev, slave->dev,
2735 "failed to get link speed/duplex\n");
2736 continue;
2737 }
2738 bond_set_slave_link_state(slave, BOND_LINK_UP,
2739 BOND_SLAVE_NOTIFY_NOW);
2740 slave->last_link_up = jiffies;
2741
2742 primary = rtnl_dereference(bond->primary_slave);
2743 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
2744 /* prevent it from being the active one */
2745 bond_set_backup_slave(slave);
2746 } else if (BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
2747 /* make it immediately active */
2748 bond_set_active_slave(slave);
2749 }
2750
2751 slave_info(bond->dev, slave->dev, "link status definitely up, %u Mbps %s duplex\n",
2752 slave->speed == SPEED_UNKNOWN ? 0 : slave->speed,
2753 slave->duplex ? "full" : "half");
2754
2755 bond_miimon_link_change(bond, slave, BOND_LINK_UP);
2756
2757 active = rtnl_dereference(bond->curr_active_slave);
2758 if (!active || slave == primary || slave->prio > active->prio)
2759 do_failover = true;
2760
2761 continue;
2762
2763 case BOND_LINK_DOWN:
2764 if (slave->link_failure_count < UINT_MAX)
2765 slave->link_failure_count++;
2766
2767 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
2768 BOND_SLAVE_NOTIFY_NOW);
2769
2770 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP ||
2771 BOND_MODE(bond) == BOND_MODE_8023AD)
2772 bond_set_slave_inactive_flags(slave,
2773 BOND_SLAVE_NOTIFY_NOW);
2774
2775 slave_info(bond->dev, slave->dev, "link status definitely down, disabling slave\n");
2776
2777 bond_miimon_link_change(bond, slave, BOND_LINK_DOWN);
2778
2779 if (slave == rcu_access_pointer(bond->curr_active_slave))
2780 do_failover = true;
2781
2782 continue;
2783
2784 default:
2785 slave_err(bond->dev, slave->dev, "invalid new link %d on slave\n",
2786 slave->link_new_state);
2787 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
2788
2789 continue;
2790 }
2791 }
2792
2793 if (do_failover) {
2794 block_netpoll_tx();
2795 bond_select_active_slave(bond);
2796 unblock_netpoll_tx();
2797 }
2798
2799 bond_set_carrier(bond);
2800}
2801
2802/* bond_mii_monitor
2803 *
2804 * Really a wrapper that splits the mii monitor into two phases: an
2805 * inspection, then (if inspection indicates something needs to be done)
2806 * an acquisition of appropriate locks followed by a commit phase to
2807 * implement whatever link state changes are indicated.
2808 */
2809static void bond_mii_monitor(struct work_struct *work)
2810{
2811 struct bonding *bond = container_of(work, struct bonding,
2812 mii_work.work);
2813 bool should_notify_peers = false;
2814 bool commit;
2815 unsigned long delay;
2816 struct slave *slave;
2817 struct list_head *iter;
2818
2819 delay = msecs_to_jiffies(bond->params.miimon);
2820
2821 if (!bond_has_slaves(bond))
2822 goto re_arm;
2823
2824 rcu_read_lock();
2825 should_notify_peers = bond_should_notify_peers(bond);
2826 commit = !!bond_miimon_inspect(bond);
2827 if (bond->send_peer_notif) {
2828 rcu_read_unlock();
2829 if (rtnl_trylock()) {
2830 bond->send_peer_notif--;
2831 rtnl_unlock();
2832 }
2833 } else {
2834 rcu_read_unlock();
2835 }
2836
2837 if (commit) {
2838 /* Race avoidance with bond_close cancel of workqueue */
2839 if (!rtnl_trylock()) {
2840 delay = 1;
2841 should_notify_peers = false;
2842 goto re_arm;
2843 }
2844
2845 bond_for_each_slave(bond, slave, iter) {
2846 bond_commit_link_state(slave, BOND_SLAVE_NOTIFY_LATER);
2847 }
2848 bond_miimon_commit(bond);
2849
2850 rtnl_unlock(); /* might sleep, hold no other locks */
2851 }
2852
2853re_arm:
2854 if (bond->params.miimon)
2855 queue_delayed_work(bond->wq, &bond->mii_work, delay);
2856
2857 if (should_notify_peers) {
2858 if (!rtnl_trylock())
2859 return;
2860 call_netdevice_notifiers(NETDEV_NOTIFY_PEERS, bond->dev);
2861 rtnl_unlock();
2862 }
2863}
2864
2865static int bond_upper_dev_walk(struct net_device *upper,
2866 struct netdev_nested_priv *priv)
2867{
2868 __be32 ip = *(__be32 *)priv->data;
2869
2870 return ip == bond_confirm_addr(upper, 0, ip);
2871}
2872
2873static bool bond_has_this_ip(struct bonding *bond, __be32 ip)
2874{
2875 struct netdev_nested_priv priv = {
2876 .data = (void *)&ip,
2877 };
2878 bool ret = false;
2879
2880 if (ip == bond_confirm_addr(bond->dev, 0, ip))
2881 return true;
2882
2883 rcu_read_lock();
2884 if (netdev_walk_all_upper_dev_rcu(bond->dev, bond_upper_dev_walk, &priv))
2885 ret = true;
2886 rcu_read_unlock();
2887
2888 return ret;
2889}
2890
2891#define BOND_VLAN_PROTO_NONE cpu_to_be16(0xffff)
2892
2893static bool bond_handle_vlan(struct slave *slave, struct bond_vlan_tag *tags,
2894 struct sk_buff *skb)
2895{
2896 struct net_device *bond_dev = slave->bond->dev;
2897 struct net_device *slave_dev = slave->dev;
2898 struct bond_vlan_tag *outer_tag = tags;
2899
2900 if (!tags || tags->vlan_proto == BOND_VLAN_PROTO_NONE)
2901 return true;
2902
2903 tags++;
2904
2905 /* Go through all the tags backwards and add them to the packet */
2906 while (tags->vlan_proto != BOND_VLAN_PROTO_NONE) {
2907 if (!tags->vlan_id) {
2908 tags++;
2909 continue;
2910 }
2911
2912 slave_dbg(bond_dev, slave_dev, "inner tag: proto %X vid %X\n",
2913 ntohs(outer_tag->vlan_proto), tags->vlan_id);
2914 skb = vlan_insert_tag_set_proto(skb, tags->vlan_proto,
2915 tags->vlan_id);
2916 if (!skb) {
2917 net_err_ratelimited("failed to insert inner VLAN tag\n");
2918 return false;
2919 }
2920
2921 tags++;
2922 }
2923 /* Set the outer tag */
2924 if (outer_tag->vlan_id) {
2925 slave_dbg(bond_dev, slave_dev, "outer tag: proto %X vid %X\n",
2926 ntohs(outer_tag->vlan_proto), outer_tag->vlan_id);
2927 __vlan_hwaccel_put_tag(skb, outer_tag->vlan_proto,
2928 outer_tag->vlan_id);
2929 }
2930
2931 return true;
2932}
2933
2934/* We go to the (large) trouble of VLAN tagging ARP frames because
2935 * switches in VLAN mode (especially if ports are configured as
2936 * "native" to a VLAN) might not pass non-tagged frames.
2937 */
2938static void bond_arp_send(struct slave *slave, int arp_op, __be32 dest_ip,
2939 __be32 src_ip, struct bond_vlan_tag *tags)
2940{
2941 struct net_device *bond_dev = slave->bond->dev;
2942 struct net_device *slave_dev = slave->dev;
2943 struct sk_buff *skb;
2944
2945 slave_dbg(bond_dev, slave_dev, "arp %d on slave: dst %pI4 src %pI4\n",
2946 arp_op, &dest_ip, &src_ip);
2947
2948 skb = arp_create(arp_op, ETH_P_ARP, dest_ip, slave_dev, src_ip,
2949 NULL, slave_dev->dev_addr, NULL);
2950
2951 if (!skb) {
2952 net_err_ratelimited("ARP packet allocation failed\n");
2953 return;
2954 }
2955
2956 if (bond_handle_vlan(slave, tags, skb)) {
2957 slave_update_last_tx(slave);
2958 arp_xmit(skb);
2959 }
2960
2961 return;
2962}
2963
2964/* Validate the device path between the @start_dev and the @end_dev.
2965 * The path is valid if the @end_dev is reachable through device
2966 * stacking.
2967 * When the path is validated, collect any vlan information in the
2968 * path.
2969 */
2970struct bond_vlan_tag *bond_verify_device_path(struct net_device *start_dev,
2971 struct net_device *end_dev,
2972 int level)
2973{
2974 struct bond_vlan_tag *tags;
2975 struct net_device *upper;
2976 struct list_head *iter;
2977
2978 if (start_dev == end_dev) {
2979 tags = kcalloc(level + 1, sizeof(*tags), GFP_ATOMIC);
2980 if (!tags)
2981 return ERR_PTR(-ENOMEM);
2982 tags[level].vlan_proto = BOND_VLAN_PROTO_NONE;
2983 return tags;
2984 }
2985
2986 netdev_for_each_upper_dev_rcu(start_dev, upper, iter) {
2987 tags = bond_verify_device_path(upper, end_dev, level + 1);
2988 if (IS_ERR_OR_NULL(tags)) {
2989 if (IS_ERR(tags))
2990 return tags;
2991 continue;
2992 }
2993 if (is_vlan_dev(upper)) {
2994 tags[level].vlan_proto = vlan_dev_vlan_proto(upper);
2995 tags[level].vlan_id = vlan_dev_vlan_id(upper);
2996 }
2997
2998 return tags;
2999 }
3000
3001 return NULL;
3002}
3003
3004static void bond_arp_send_all(struct bonding *bond, struct slave *slave)
3005{
3006 struct rtable *rt;
3007 struct bond_vlan_tag *tags;
3008 __be32 *targets = bond->params.arp_targets, addr;
3009 int i;
3010
3011 for (i = 0; i < BOND_MAX_ARP_TARGETS && targets[i]; i++) {
3012 slave_dbg(bond->dev, slave->dev, "%s: target %pI4\n",
3013 __func__, &targets[i]);
3014 tags = NULL;
3015
3016 /* Find out through which dev should the packet go */
3017 rt = ip_route_output(dev_net(bond->dev), targets[i], 0,
3018 RTO_ONLINK, 0);
3019 if (IS_ERR(rt)) {
3020 /* there's no route to target - try to send arp
3021 * probe to generate any traffic (arp_validate=0)
3022 */
3023 if (bond->params.arp_validate)
3024 pr_warn_once("%s: no route to arp_ip_target %pI4 and arp_validate is set\n",
3025 bond->dev->name,
3026 &targets[i]);
3027 bond_arp_send(slave, ARPOP_REQUEST, targets[i],
3028 0, tags);
3029 continue;
3030 }
3031
3032 /* bond device itself */
3033 if (rt->dst.dev == bond->dev)
3034 goto found;
3035
3036 rcu_read_lock();
3037 tags = bond_verify_device_path(bond->dev, rt->dst.dev, 0);
3038 rcu_read_unlock();
3039
3040 if (!IS_ERR_OR_NULL(tags))
3041 goto found;
3042
3043 /* Not our device - skip */
3044 slave_dbg(bond->dev, slave->dev, "no path to arp_ip_target %pI4 via rt.dev %s\n",
3045 &targets[i], rt->dst.dev ? rt->dst.dev->name : "NULL");
3046
3047 ip_rt_put(rt);
3048 continue;
3049
3050found:
3051 addr = bond_confirm_addr(rt->dst.dev, targets[i], 0);
3052 ip_rt_put(rt);
3053 bond_arp_send(slave, ARPOP_REQUEST, targets[i], addr, tags);
3054 kfree(tags);
3055 }
3056}
3057
3058static void bond_validate_arp(struct bonding *bond, struct slave *slave, __be32 sip, __be32 tip)
3059{
3060 int i;
3061
3062 if (!sip || !bond_has_this_ip(bond, tip)) {
3063 slave_dbg(bond->dev, slave->dev, "%s: sip %pI4 tip %pI4 not found\n",
3064 __func__, &sip, &tip);
3065 return;
3066 }
3067
3068 i = bond_get_targets_ip(bond->params.arp_targets, sip);
3069 if (i == -1) {
3070 slave_dbg(bond->dev, slave->dev, "%s: sip %pI4 not found in targets\n",
3071 __func__, &sip);
3072 return;
3073 }
3074 slave->last_rx = jiffies;
3075 slave->target_last_arp_rx[i] = jiffies;
3076}
3077
3078static int bond_arp_rcv(const struct sk_buff *skb, struct bonding *bond,
3079 struct slave *slave)
3080{
3081 struct arphdr *arp = (struct arphdr *)skb->data;
3082 struct slave *curr_active_slave, *curr_arp_slave;
3083 unsigned char *arp_ptr;
3084 __be32 sip, tip;
3085 unsigned int alen;
3086
3087 alen = arp_hdr_len(bond->dev);
3088
3089 if (alen > skb_headlen(skb)) {
3090 arp = kmalloc(alen, GFP_ATOMIC);
3091 if (!arp)
3092 goto out_unlock;
3093 if (skb_copy_bits(skb, 0, arp, alen) < 0)
3094 goto out_unlock;
3095 }
3096
3097 if (arp->ar_hln != bond->dev->addr_len ||
3098 skb->pkt_type == PACKET_OTHERHOST ||
3099 skb->pkt_type == PACKET_LOOPBACK ||
3100 arp->ar_hrd != htons(ARPHRD_ETHER) ||
3101 arp->ar_pro != htons(ETH_P_IP) ||
3102 arp->ar_pln != 4)
3103 goto out_unlock;
3104
3105 arp_ptr = (unsigned char *)(arp + 1);
3106 arp_ptr += bond->dev->addr_len;
3107 memcpy(&sip, arp_ptr, 4);
3108 arp_ptr += 4 + bond->dev->addr_len;
3109 memcpy(&tip, arp_ptr, 4);
3110
3111 slave_dbg(bond->dev, slave->dev, "%s: %s/%d av %d sv %d sip %pI4 tip %pI4\n",
3112 __func__, slave->dev->name, bond_slave_state(slave),
3113 bond->params.arp_validate, slave_do_arp_validate(bond, slave),
3114 &sip, &tip);
3115
3116 curr_active_slave = rcu_dereference(bond->curr_active_slave);
3117 curr_arp_slave = rcu_dereference(bond->current_arp_slave);
3118
3119 /* We 'trust' the received ARP enough to validate it if:
3120 *
3121 * (a) the slave receiving the ARP is active (which includes the
3122 * current ARP slave, if any), or
3123 *
3124 * (b) the receiving slave isn't active, but there is a currently
3125 * active slave and it received valid arp reply(s) after it became
3126 * the currently active slave, or
3127 *
3128 * (c) there is an ARP slave that sent an ARP during the prior ARP
3129 * interval, and we receive an ARP reply on any slave. We accept
3130 * these because switch FDB update delays may deliver the ARP
3131 * reply to a slave other than the sender of the ARP request.
3132 *
3133 * Note: for (b), backup slaves are receiving the broadcast ARP
3134 * request, not a reply. This request passes from the sending
3135 * slave through the L2 switch(es) to the receiving slave. Since
3136 * this is checking the request, sip/tip are swapped for
3137 * validation.
3138 *
3139 * This is done to avoid endless looping when we can't reach the
3140 * arp_ip_target and fool ourselves with our own arp requests.
3141 */
3142 if (bond_is_active_slave(slave))
3143 bond_validate_arp(bond, slave, sip, tip);
3144 else if (curr_active_slave &&
3145 time_after(slave_last_rx(bond, curr_active_slave),
3146 curr_active_slave->last_link_up))
3147 bond_validate_arp(bond, slave, tip, sip);
3148 else if (curr_arp_slave && (arp->ar_op == htons(ARPOP_REPLY)) &&
3149 bond_time_in_interval(bond, slave_last_tx(curr_arp_slave), 1))
3150 bond_validate_arp(bond, slave, sip, tip);
3151
3152out_unlock:
3153 if (arp != (struct arphdr *)skb->data)
3154 kfree(arp);
3155 return RX_HANDLER_ANOTHER;
3156}
3157
3158#if IS_ENABLED(CONFIG_IPV6)
3159static void bond_ns_send(struct slave *slave, const struct in6_addr *daddr,
3160 const struct in6_addr *saddr, struct bond_vlan_tag *tags)
3161{
3162 struct net_device *bond_dev = slave->bond->dev;
3163 struct net_device *slave_dev = slave->dev;
3164 struct in6_addr mcaddr;
3165 struct sk_buff *skb;
3166
3167 slave_dbg(bond_dev, slave_dev, "NS on slave: dst %pI6c src %pI6c\n",
3168 daddr, saddr);
3169
3170 skb = ndisc_ns_create(slave_dev, daddr, saddr, 0);
3171 if (!skb) {
3172 net_err_ratelimited("NS packet allocation failed\n");
3173 return;
3174 }
3175
3176 addrconf_addr_solict_mult(daddr, &mcaddr);
3177 if (bond_handle_vlan(slave, tags, skb)) {
3178 slave_update_last_tx(slave);
3179 ndisc_send_skb(skb, &mcaddr, saddr);
3180 }
3181}
3182
3183static void bond_ns_send_all(struct bonding *bond, struct slave *slave)
3184{
3185 struct in6_addr *targets = bond->params.ns_targets;
3186 struct bond_vlan_tag *tags;
3187 struct dst_entry *dst;
3188 struct in6_addr saddr;
3189 struct flowi6 fl6;
3190 int i;
3191
3192 for (i = 0; i < BOND_MAX_NS_TARGETS && !ipv6_addr_any(&targets[i]); i++) {
3193 slave_dbg(bond->dev, slave->dev, "%s: target %pI6c\n",
3194 __func__, &targets[i]);
3195 tags = NULL;
3196
3197 /* Find out through which dev should the packet go */
3198 memset(&fl6, 0, sizeof(struct flowi6));
3199 fl6.daddr = targets[i];
3200 fl6.flowi6_oif = bond->dev->ifindex;
3201
3202 dst = ip6_route_output(dev_net(bond->dev), NULL, &fl6);
3203 if (dst->error) {
3204 dst_release(dst);
3205 /* there's no route to target - try to send arp
3206 * probe to generate any traffic (arp_validate=0)
3207 */
3208 if (bond->params.arp_validate)
3209 pr_warn_once("%s: no route to ns_ip6_target %pI6c and arp_validate is set\n",
3210 bond->dev->name,
3211 &targets[i]);
3212 bond_ns_send(slave, &targets[i], &in6addr_any, tags);
3213 continue;
3214 }
3215
3216 /* bond device itself */
3217 if (dst->dev == bond->dev)
3218 goto found;
3219
3220 rcu_read_lock();
3221 tags = bond_verify_device_path(bond->dev, dst->dev, 0);
3222 rcu_read_unlock();
3223
3224 if (!IS_ERR_OR_NULL(tags))
3225 goto found;
3226
3227 /* Not our device - skip */
3228 slave_dbg(bond->dev, slave->dev, "no path to ns_ip6_target %pI6c via dst->dev %s\n",
3229 &targets[i], dst->dev ? dst->dev->name : "NULL");
3230
3231 dst_release(dst);
3232 continue;
3233
3234found:
3235 if (!ipv6_dev_get_saddr(dev_net(dst->dev), dst->dev, &targets[i], 0, &saddr))
3236 bond_ns_send(slave, &targets[i], &saddr, tags);
3237 else
3238 bond_ns_send(slave, &targets[i], &in6addr_any, tags);
3239
3240 dst_release(dst);
3241 kfree(tags);
3242 }
3243}
3244
3245static int bond_confirm_addr6(struct net_device *dev,
3246 struct netdev_nested_priv *priv)
3247{
3248 struct in6_addr *addr = (struct in6_addr *)priv->data;
3249
3250 return ipv6_chk_addr(dev_net(dev), addr, dev, 0);
3251}
3252
3253static bool bond_has_this_ip6(struct bonding *bond, struct in6_addr *addr)
3254{
3255 struct netdev_nested_priv priv = {
3256 .data = addr,
3257 };
3258 int ret = false;
3259
3260 if (bond_confirm_addr6(bond->dev, &priv))
3261 return true;
3262
3263 rcu_read_lock();
3264 if (netdev_walk_all_upper_dev_rcu(bond->dev, bond_confirm_addr6, &priv))
3265 ret = true;
3266 rcu_read_unlock();
3267
3268 return ret;
3269}
3270
3271static void bond_validate_na(struct bonding *bond, struct slave *slave,
3272 struct in6_addr *saddr, struct in6_addr *daddr)
3273{
3274 int i;
3275
3276 /* Ignore NAs that:
3277 * 1. Source address is unspecified address.
3278 * 2. Dest address is neither all-nodes multicast address nor
3279 * exist on bond interface.
3280 */
3281 if (ipv6_addr_any(saddr) ||
3282 (!ipv6_addr_equal(daddr, &in6addr_linklocal_allnodes) &&
3283 !bond_has_this_ip6(bond, daddr))) {
3284 slave_dbg(bond->dev, slave->dev, "%s: sip %pI6c tip %pI6c not found\n",
3285 __func__, saddr, daddr);
3286 return;
3287 }
3288
3289 i = bond_get_targets_ip6(bond->params.ns_targets, saddr);
3290 if (i == -1) {
3291 slave_dbg(bond->dev, slave->dev, "%s: sip %pI6c not found in targets\n",
3292 __func__, saddr);
3293 return;
3294 }
3295 slave->last_rx = jiffies;
3296 slave->target_last_arp_rx[i] = jiffies;
3297}
3298
3299static int bond_na_rcv(const struct sk_buff *skb, struct bonding *bond,
3300 struct slave *slave)
3301{
3302 struct slave *curr_active_slave, *curr_arp_slave;
3303 struct in6_addr *saddr, *daddr;
3304 struct {
3305 struct ipv6hdr ip6;
3306 struct icmp6hdr icmp6;
3307 } *combined, _combined;
3308
3309 if (skb->pkt_type == PACKET_OTHERHOST ||
3310 skb->pkt_type == PACKET_LOOPBACK)
3311 goto out;
3312
3313 combined = skb_header_pointer(skb, 0, sizeof(_combined), &_combined);
3314 if (!combined || combined->ip6.nexthdr != NEXTHDR_ICMP ||
3315 (combined->icmp6.icmp6_type != NDISC_NEIGHBOUR_SOLICITATION &&
3316 combined->icmp6.icmp6_type != NDISC_NEIGHBOUR_ADVERTISEMENT))
3317 goto out;
3318
3319 saddr = &combined->ip6.saddr;
3320 daddr = &combined->ip6.daddr;
3321
3322 slave_dbg(bond->dev, slave->dev, "%s: %s/%d av %d sv %d sip %pI6c tip %pI6c\n",
3323 __func__, slave->dev->name, bond_slave_state(slave),
3324 bond->params.arp_validate, slave_do_arp_validate(bond, slave),
3325 saddr, daddr);
3326
3327 curr_active_slave = rcu_dereference(bond->curr_active_slave);
3328 curr_arp_slave = rcu_dereference(bond->current_arp_slave);
3329
3330 /* We 'trust' the received ARP enough to validate it if:
3331 * see bond_arp_rcv().
3332 */
3333 if (bond_is_active_slave(slave))
3334 bond_validate_na(bond, slave, saddr, daddr);
3335 else if (curr_active_slave &&
3336 time_after(slave_last_rx(bond, curr_active_slave),
3337 curr_active_slave->last_link_up))
3338 bond_validate_na(bond, slave, daddr, saddr);
3339 else if (curr_arp_slave &&
3340 bond_time_in_interval(bond, slave_last_tx(curr_arp_slave), 1))
3341 bond_validate_na(bond, slave, saddr, daddr);
3342
3343out:
3344 return RX_HANDLER_ANOTHER;
3345}
3346#endif
3347
3348int bond_rcv_validate(const struct sk_buff *skb, struct bonding *bond,
3349 struct slave *slave)
3350{
3351#if IS_ENABLED(CONFIG_IPV6)
3352 bool is_ipv6 = skb->protocol == __cpu_to_be16(ETH_P_IPV6);
3353#endif
3354 bool is_arp = skb->protocol == __cpu_to_be16(ETH_P_ARP);
3355
3356 slave_dbg(bond->dev, slave->dev, "%s: skb->dev %s\n",
3357 __func__, skb->dev->name);
3358
3359 /* Use arp validate logic for both ARP and NS */
3360 if (!slave_do_arp_validate(bond, slave)) {
3361 if ((slave_do_arp_validate_only(bond) && is_arp) ||
3362#if IS_ENABLED(CONFIG_IPV6)
3363 (slave_do_arp_validate_only(bond) && is_ipv6) ||
3364#endif
3365 !slave_do_arp_validate_only(bond))
3366 slave->last_rx = jiffies;
3367 return RX_HANDLER_ANOTHER;
3368 } else if (is_arp) {
3369 return bond_arp_rcv(skb, bond, slave);
3370#if IS_ENABLED(CONFIG_IPV6)
3371 } else if (is_ipv6) {
3372 return bond_na_rcv(skb, bond, slave);
3373#endif
3374 } else {
3375 return RX_HANDLER_ANOTHER;
3376 }
3377}
3378
3379static void bond_send_validate(struct bonding *bond, struct slave *slave)
3380{
3381 bond_arp_send_all(bond, slave);
3382#if IS_ENABLED(CONFIG_IPV6)
3383 bond_ns_send_all(bond, slave);
3384#endif
3385}
3386
3387/* function to verify if we're in the arp_interval timeslice, returns true if
3388 * (last_act - arp_interval) <= jiffies <= (last_act + mod * arp_interval +
3389 * arp_interval/2) . the arp_interval/2 is needed for really fast networks.
3390 */
3391static bool bond_time_in_interval(struct bonding *bond, unsigned long last_act,
3392 int mod)
3393{
3394 int delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
3395
3396 return time_in_range(jiffies,
3397 last_act - delta_in_ticks,
3398 last_act + mod * delta_in_ticks + delta_in_ticks/2);
3399}
3400
3401/* This function is called regularly to monitor each slave's link
3402 * ensuring that traffic is being sent and received when arp monitoring
3403 * is used in load-balancing mode. if the adapter has been dormant, then an
3404 * arp is transmitted to generate traffic. see activebackup_arp_monitor for
3405 * arp monitoring in active backup mode.
3406 */
3407static void bond_loadbalance_arp_mon(struct bonding *bond)
3408{
3409 struct slave *slave, *oldcurrent;
3410 struct list_head *iter;
3411 int do_failover = 0, slave_state_changed = 0;
3412
3413 if (!bond_has_slaves(bond))
3414 goto re_arm;
3415
3416 rcu_read_lock();
3417
3418 oldcurrent = rcu_dereference(bond->curr_active_slave);
3419 /* see if any of the previous devices are up now (i.e. they have
3420 * xmt and rcv traffic). the curr_active_slave does not come into
3421 * the picture unless it is null. also, slave->last_link_up is not
3422 * needed here because we send an arp on each slave and give a slave
3423 * as long as it needs to get the tx/rx within the delta.
3424 * TODO: what about up/down delay in arp mode? it wasn't here before
3425 * so it can wait
3426 */
3427 bond_for_each_slave_rcu(bond, slave, iter) {
3428 unsigned long last_tx = slave_last_tx(slave);
3429
3430 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
3431
3432 if (slave->link != BOND_LINK_UP) {
3433 if (bond_time_in_interval(bond, last_tx, 1) &&
3434 bond_time_in_interval(bond, slave->last_rx, 1)) {
3435
3436 bond_propose_link_state(slave, BOND_LINK_UP);
3437 slave_state_changed = 1;
3438
3439 /* primary_slave has no meaning in round-robin
3440 * mode. the window of a slave being up and
3441 * curr_active_slave being null after enslaving
3442 * is closed.
3443 */
3444 if (!oldcurrent) {
3445 slave_info(bond->dev, slave->dev, "link status definitely up\n");
3446 do_failover = 1;
3447 } else {
3448 slave_info(bond->dev, slave->dev, "interface is now up\n");
3449 }
3450 }
3451 } else {
3452 /* slave->link == BOND_LINK_UP */
3453
3454 /* not all switches will respond to an arp request
3455 * when the source ip is 0, so don't take the link down
3456 * if we don't know our ip yet
3457 */
3458 if (!bond_time_in_interval(bond, last_tx, bond->params.missed_max) ||
3459 !bond_time_in_interval(bond, slave->last_rx, bond->params.missed_max)) {
3460
3461 bond_propose_link_state(slave, BOND_LINK_DOWN);
3462 slave_state_changed = 1;
3463
3464 if (slave->link_failure_count < UINT_MAX)
3465 slave->link_failure_count++;
3466
3467 slave_info(bond->dev, slave->dev, "interface is now down\n");
3468
3469 if (slave == oldcurrent)
3470 do_failover = 1;
3471 }
3472 }
3473
3474 /* note: if switch is in round-robin mode, all links
3475 * must tx arp to ensure all links rx an arp - otherwise
3476 * links may oscillate or not come up at all; if switch is
3477 * in something like xor mode, there is nothing we can
3478 * do - all replies will be rx'ed on same link causing slaves
3479 * to be unstable during low/no traffic periods
3480 */
3481 if (bond_slave_is_up(slave))
3482 bond_send_validate(bond, slave);
3483 }
3484
3485 rcu_read_unlock();
3486
3487 if (do_failover || slave_state_changed) {
3488 if (!rtnl_trylock())
3489 goto re_arm;
3490
3491 bond_for_each_slave(bond, slave, iter) {
3492 if (slave->link_new_state != BOND_LINK_NOCHANGE)
3493 slave->link = slave->link_new_state;
3494 }
3495
3496 if (slave_state_changed) {
3497 bond_slave_state_change(bond);
3498 if (BOND_MODE(bond) == BOND_MODE_XOR)
3499 bond_update_slave_arr(bond, NULL);
3500 }
3501 if (do_failover) {
3502 block_netpoll_tx();
3503 bond_select_active_slave(bond);
3504 unblock_netpoll_tx();
3505 }
3506 rtnl_unlock();
3507 }
3508
3509re_arm:
3510 if (bond->params.arp_interval)
3511 queue_delayed_work(bond->wq, &bond->arp_work,
3512 msecs_to_jiffies(bond->params.arp_interval));
3513}
3514
3515/* Called to inspect slaves for active-backup mode ARP monitor link state
3516 * changes. Sets proposed link state in slaves to specify what action
3517 * should take place for the slave. Returns 0 if no changes are found, >0
3518 * if changes to link states must be committed.
3519 *
3520 * Called with rcu_read_lock held.
3521 */
3522static int bond_ab_arp_inspect(struct bonding *bond)
3523{
3524 unsigned long last_tx, last_rx;
3525 struct list_head *iter;
3526 struct slave *slave;
3527 int commit = 0;
3528
3529 bond_for_each_slave_rcu(bond, slave, iter) {
3530 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
3531 last_rx = slave_last_rx(bond, slave);
3532
3533 if (slave->link != BOND_LINK_UP) {
3534 if (bond_time_in_interval(bond, last_rx, 1)) {
3535 bond_propose_link_state(slave, BOND_LINK_UP);
3536 commit++;
3537 } else if (slave->link == BOND_LINK_BACK) {
3538 bond_propose_link_state(slave, BOND_LINK_FAIL);
3539 commit++;
3540 }
3541 continue;
3542 }
3543
3544 /* Give slaves 2*delta after being enslaved or made
3545 * active. This avoids bouncing, as the last receive
3546 * times need a full ARP monitor cycle to be updated.
3547 */
3548 if (bond_time_in_interval(bond, slave->last_link_up, 2))
3549 continue;
3550
3551 /* Backup slave is down if:
3552 * - No current_arp_slave AND
3553 * - more than (missed_max+1)*delta since last receive AND
3554 * - the bond has an IP address
3555 *
3556 * Note: a non-null current_arp_slave indicates
3557 * the curr_active_slave went down and we are
3558 * searching for a new one; under this condition
3559 * we only take the curr_active_slave down - this
3560 * gives each slave a chance to tx/rx traffic
3561 * before being taken out
3562 */
3563 if (!bond_is_active_slave(slave) &&
3564 !rcu_access_pointer(bond->current_arp_slave) &&
3565 !bond_time_in_interval(bond, last_rx, bond->params.missed_max + 1)) {
3566 bond_propose_link_state(slave, BOND_LINK_DOWN);
3567 commit++;
3568 }
3569
3570 /* Active slave is down if:
3571 * - more than missed_max*delta since transmitting OR
3572 * - (more than missed_max*delta since receive AND
3573 * the bond has an IP address)
3574 */
3575 last_tx = slave_last_tx(slave);
3576 if (bond_is_active_slave(slave) &&
3577 (!bond_time_in_interval(bond, last_tx, bond->params.missed_max) ||
3578 !bond_time_in_interval(bond, last_rx, bond->params.missed_max))) {
3579 bond_propose_link_state(slave, BOND_LINK_DOWN);
3580 commit++;
3581 }
3582 }
3583
3584 return commit;
3585}
3586
3587/* Called to commit link state changes noted by inspection step of
3588 * active-backup mode ARP monitor.
3589 *
3590 * Called with RTNL hold.
3591 */
3592static void bond_ab_arp_commit(struct bonding *bond)
3593{
3594 bool do_failover = false;
3595 struct list_head *iter;
3596 unsigned long last_tx;
3597 struct slave *slave;
3598
3599 bond_for_each_slave(bond, slave, iter) {
3600 switch (slave->link_new_state) {
3601 case BOND_LINK_NOCHANGE:
3602 continue;
3603
3604 case BOND_LINK_UP:
3605 last_tx = slave_last_tx(slave);
3606 if (rtnl_dereference(bond->curr_active_slave) != slave ||
3607 (!rtnl_dereference(bond->curr_active_slave) &&
3608 bond_time_in_interval(bond, last_tx, 1))) {
3609 struct slave *current_arp_slave;
3610
3611 current_arp_slave = rtnl_dereference(bond->current_arp_slave);
3612 bond_set_slave_link_state(slave, BOND_LINK_UP,
3613 BOND_SLAVE_NOTIFY_NOW);
3614 if (current_arp_slave) {
3615 bond_set_slave_inactive_flags(
3616 current_arp_slave,
3617 BOND_SLAVE_NOTIFY_NOW);
3618 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3619 }
3620
3621 slave_info(bond->dev, slave->dev, "link status definitely up\n");
3622
3623 if (!rtnl_dereference(bond->curr_active_slave) ||
3624 slave == rtnl_dereference(bond->primary_slave) ||
3625 slave->prio > rtnl_dereference(bond->curr_active_slave)->prio)
3626 do_failover = true;
3627
3628 }
3629
3630 continue;
3631
3632 case BOND_LINK_DOWN:
3633 if (slave->link_failure_count < UINT_MAX)
3634 slave->link_failure_count++;
3635
3636 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
3637 BOND_SLAVE_NOTIFY_NOW);
3638 bond_set_slave_inactive_flags(slave,
3639 BOND_SLAVE_NOTIFY_NOW);
3640
3641 slave_info(bond->dev, slave->dev, "link status definitely down, disabling slave\n");
3642
3643 if (slave == rtnl_dereference(bond->curr_active_slave)) {
3644 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3645 do_failover = true;
3646 }
3647
3648 continue;
3649
3650 case BOND_LINK_FAIL:
3651 bond_set_slave_link_state(slave, BOND_LINK_FAIL,
3652 BOND_SLAVE_NOTIFY_NOW);
3653 bond_set_slave_inactive_flags(slave,
3654 BOND_SLAVE_NOTIFY_NOW);
3655
3656 /* A slave has just been enslaved and has become
3657 * the current active slave.
3658 */
3659 if (rtnl_dereference(bond->curr_active_slave))
3660 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3661 continue;
3662
3663 default:
3664 slave_err(bond->dev, slave->dev,
3665 "impossible: link_new_state %d on slave\n",
3666 slave->link_new_state);
3667 continue;
3668 }
3669 }
3670
3671 if (do_failover) {
3672 block_netpoll_tx();
3673 bond_select_active_slave(bond);
3674 unblock_netpoll_tx();
3675 }
3676
3677 bond_set_carrier(bond);
3678}
3679
3680/* Send ARP probes for active-backup mode ARP monitor.
3681 *
3682 * Called with rcu_read_lock held.
3683 */
3684static bool bond_ab_arp_probe(struct bonding *bond)
3685{
3686 struct slave *slave, *before = NULL, *new_slave = NULL,
3687 *curr_arp_slave = rcu_dereference(bond->current_arp_slave),
3688 *curr_active_slave = rcu_dereference(bond->curr_active_slave);
3689 struct list_head *iter;
3690 bool found = false;
3691 bool should_notify_rtnl = BOND_SLAVE_NOTIFY_LATER;
3692
3693 if (curr_arp_slave && curr_active_slave)
3694 netdev_info(bond->dev, "PROBE: c_arp %s && cas %s BAD\n",
3695 curr_arp_slave->dev->name,
3696 curr_active_slave->dev->name);
3697
3698 if (curr_active_slave) {
3699 bond_send_validate(bond, curr_active_slave);
3700 return should_notify_rtnl;
3701 }
3702
3703 /* if we don't have a curr_active_slave, search for the next available
3704 * backup slave from the current_arp_slave and make it the candidate
3705 * for becoming the curr_active_slave
3706 */
3707
3708 if (!curr_arp_slave) {
3709 curr_arp_slave = bond_first_slave_rcu(bond);
3710 if (!curr_arp_slave)
3711 return should_notify_rtnl;
3712 }
3713
3714 bond_for_each_slave_rcu(bond, slave, iter) {
3715 if (!found && !before && bond_slave_is_up(slave))
3716 before = slave;
3717
3718 if (found && !new_slave && bond_slave_is_up(slave))
3719 new_slave = slave;
3720 /* if the link state is up at this point, we
3721 * mark it down - this can happen if we have
3722 * simultaneous link failures and
3723 * reselect_active_interface doesn't make this
3724 * one the current slave so it is still marked
3725 * up when it is actually down
3726 */
3727 if (!bond_slave_is_up(slave) && slave->link == BOND_LINK_UP) {
3728 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
3729 BOND_SLAVE_NOTIFY_LATER);
3730 if (slave->link_failure_count < UINT_MAX)
3731 slave->link_failure_count++;
3732
3733 bond_set_slave_inactive_flags(slave,
3734 BOND_SLAVE_NOTIFY_LATER);
3735
3736 slave_info(bond->dev, slave->dev, "backup interface is now down\n");
3737 }
3738 if (slave == curr_arp_slave)
3739 found = true;
3740 }
3741
3742 if (!new_slave && before)
3743 new_slave = before;
3744
3745 if (!new_slave)
3746 goto check_state;
3747
3748 bond_set_slave_link_state(new_slave, BOND_LINK_BACK,
3749 BOND_SLAVE_NOTIFY_LATER);
3750 bond_set_slave_active_flags(new_slave, BOND_SLAVE_NOTIFY_LATER);
3751 bond_send_validate(bond, new_slave);
3752 new_slave->last_link_up = jiffies;
3753 rcu_assign_pointer(bond->current_arp_slave, new_slave);
3754
3755check_state:
3756 bond_for_each_slave_rcu(bond, slave, iter) {
3757 if (slave->should_notify || slave->should_notify_link) {
3758 should_notify_rtnl = BOND_SLAVE_NOTIFY_NOW;
3759 break;
3760 }
3761 }
3762 return should_notify_rtnl;
3763}
3764
3765static void bond_activebackup_arp_mon(struct bonding *bond)
3766{
3767 bool should_notify_peers = false;
3768 bool should_notify_rtnl = false;
3769 int delta_in_ticks;
3770
3771 delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
3772
3773 if (!bond_has_slaves(bond))
3774 goto re_arm;
3775
3776 rcu_read_lock();
3777
3778 should_notify_peers = bond_should_notify_peers(bond);
3779
3780 if (bond_ab_arp_inspect(bond)) {
3781 rcu_read_unlock();
3782
3783 /* Race avoidance with bond_close flush of workqueue */
3784 if (!rtnl_trylock()) {
3785 delta_in_ticks = 1;
3786 should_notify_peers = false;
3787 goto re_arm;
3788 }
3789
3790 bond_ab_arp_commit(bond);
3791
3792 rtnl_unlock();
3793 rcu_read_lock();
3794 }
3795
3796 should_notify_rtnl = bond_ab_arp_probe(bond);
3797 rcu_read_unlock();
3798
3799re_arm:
3800 if (bond->params.arp_interval)
3801 queue_delayed_work(bond->wq, &bond->arp_work, delta_in_ticks);
3802
3803 if (should_notify_peers || should_notify_rtnl) {
3804 if (!rtnl_trylock())
3805 return;
3806
3807 if (should_notify_peers) {
3808 bond->send_peer_notif--;
3809 call_netdevice_notifiers(NETDEV_NOTIFY_PEERS,
3810 bond->dev);
3811 }
3812 if (should_notify_rtnl) {
3813 bond_slave_state_notify(bond);
3814 bond_slave_link_notify(bond);
3815 }
3816
3817 rtnl_unlock();
3818 }
3819}
3820
3821static void bond_arp_monitor(struct work_struct *work)
3822{
3823 struct bonding *bond = container_of(work, struct bonding,
3824 arp_work.work);
3825
3826 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
3827 bond_activebackup_arp_mon(bond);
3828 else
3829 bond_loadbalance_arp_mon(bond);
3830}
3831
3832/*-------------------------- netdev event handling --------------------------*/
3833
3834/* Change device name */
3835static int bond_event_changename(struct bonding *bond)
3836{
3837 bond_remove_proc_entry(bond);
3838 bond_create_proc_entry(bond);
3839
3840 bond_debug_reregister(bond);
3841
3842 return NOTIFY_DONE;
3843}
3844
3845static int bond_master_netdev_event(unsigned long event,
3846 struct net_device *bond_dev)
3847{
3848 struct bonding *event_bond = netdev_priv(bond_dev);
3849
3850 netdev_dbg(bond_dev, "%s called\n", __func__);
3851
3852 switch (event) {
3853 case NETDEV_CHANGENAME:
3854 return bond_event_changename(event_bond);
3855 case NETDEV_UNREGISTER:
3856 bond_remove_proc_entry(event_bond);
3857#ifdef CONFIG_XFRM_OFFLOAD
3858 xfrm_dev_state_flush(dev_net(bond_dev), bond_dev, true);
3859#endif /* CONFIG_XFRM_OFFLOAD */
3860 break;
3861 case NETDEV_REGISTER:
3862 bond_create_proc_entry(event_bond);
3863 break;
3864 default:
3865 break;
3866 }
3867
3868 return NOTIFY_DONE;
3869}
3870
3871static int bond_slave_netdev_event(unsigned long event,
3872 struct net_device *slave_dev)
3873{
3874 struct slave *slave = bond_slave_get_rtnl(slave_dev), *primary;
3875 struct bonding *bond;
3876 struct net_device *bond_dev;
3877
3878 /* A netdev event can be generated while enslaving a device
3879 * before netdev_rx_handler_register is called in which case
3880 * slave will be NULL
3881 */
3882 if (!slave) {
3883 netdev_dbg(slave_dev, "%s called on NULL slave\n", __func__);
3884 return NOTIFY_DONE;
3885 }
3886
3887 bond_dev = slave->bond->dev;
3888 bond = slave->bond;
3889 primary = rtnl_dereference(bond->primary_slave);
3890
3891 slave_dbg(bond_dev, slave_dev, "%s called\n", __func__);
3892
3893 switch (event) {
3894 case NETDEV_UNREGISTER:
3895 if (bond_dev->type != ARPHRD_ETHER)
3896 bond_release_and_destroy(bond_dev, slave_dev);
3897 else
3898 __bond_release_one(bond_dev, slave_dev, false, true);
3899 break;
3900 case NETDEV_UP:
3901 case NETDEV_CHANGE:
3902 /* For 802.3ad mode only:
3903 * Getting invalid Speed/Duplex values here will put slave
3904 * in weird state. Mark it as link-fail if the link was
3905 * previously up or link-down if it hasn't yet come up, and
3906 * let link-monitoring (miimon) set it right when correct
3907 * speeds/duplex are available.
3908 */
3909 if (bond_update_speed_duplex(slave) &&
3910 BOND_MODE(bond) == BOND_MODE_8023AD) {
3911 if (slave->last_link_up)
3912 slave->link = BOND_LINK_FAIL;
3913 else
3914 slave->link = BOND_LINK_DOWN;
3915 }
3916
3917 if (BOND_MODE(bond) == BOND_MODE_8023AD)
3918 bond_3ad_adapter_speed_duplex_changed(slave);
3919 fallthrough;
3920 case NETDEV_DOWN:
3921 /* Refresh slave-array if applicable!
3922 * If the setup does not use miimon or arpmon (mode-specific!),
3923 * then these events will not cause the slave-array to be
3924 * refreshed. This will cause xmit to use a slave that is not
3925 * usable. Avoid such situation by refeshing the array at these
3926 * events. If these (miimon/arpmon) parameters are configured
3927 * then array gets refreshed twice and that should be fine!
3928 */
3929 if (bond_mode_can_use_xmit_hash(bond))
3930 bond_update_slave_arr(bond, NULL);
3931 break;
3932 case NETDEV_CHANGEMTU:
3933 /* TODO: Should slaves be allowed to
3934 * independently alter their MTU? For
3935 * an active-backup bond, slaves need
3936 * not be the same type of device, so
3937 * MTUs may vary. For other modes,
3938 * slaves arguably should have the
3939 * same MTUs. To do this, we'd need to
3940 * take over the slave's change_mtu
3941 * function for the duration of their
3942 * servitude.
3943 */
3944 break;
3945 case NETDEV_CHANGENAME:
3946 /* we don't care if we don't have primary set */
3947 if (!bond_uses_primary(bond) ||
3948 !bond->params.primary[0])
3949 break;
3950
3951 if (slave == primary) {
3952 /* slave's name changed - he's no longer primary */
3953 RCU_INIT_POINTER(bond->primary_slave, NULL);
3954 } else if (!strcmp(slave_dev->name, bond->params.primary)) {
3955 /* we have a new primary slave */
3956 rcu_assign_pointer(bond->primary_slave, slave);
3957 } else { /* we didn't change primary - exit */
3958 break;
3959 }
3960
3961 netdev_info(bond->dev, "Primary slave changed to %s, reselecting active slave\n",
3962 primary ? slave_dev->name : "none");
3963
3964 block_netpoll_tx();
3965 bond_select_active_slave(bond);
3966 unblock_netpoll_tx();
3967 break;
3968 case NETDEV_FEAT_CHANGE:
3969 if (!bond->notifier_ctx) {
3970 bond->notifier_ctx = true;
3971 bond_compute_features(bond);
3972 bond->notifier_ctx = false;
3973 }
3974 break;
3975 case NETDEV_RESEND_IGMP:
3976 /* Propagate to master device */
3977 call_netdevice_notifiers(event, slave->bond->dev);
3978 break;
3979 case NETDEV_XDP_FEAT_CHANGE:
3980 bond_xdp_set_features(bond_dev);
3981 break;
3982 default:
3983 break;
3984 }
3985
3986 return NOTIFY_DONE;
3987}
3988
3989/* bond_netdev_event: handle netdev notifier chain events.
3990 *
3991 * This function receives events for the netdev chain. The caller (an
3992 * ioctl handler calling blocking_notifier_call_chain) holds the necessary
3993 * locks for us to safely manipulate the slave devices (RTNL lock,
3994 * dev_probe_lock).
3995 */
3996static int bond_netdev_event(struct notifier_block *this,
3997 unsigned long event, void *ptr)
3998{
3999 struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
4000
4001 netdev_dbg(event_dev, "%s received %s\n",
4002 __func__, netdev_cmd_to_name(event));
4003
4004 if (!(event_dev->priv_flags & IFF_BONDING))
4005 return NOTIFY_DONE;
4006
4007 if (event_dev->flags & IFF_MASTER) {
4008 int ret;
4009
4010 ret = bond_master_netdev_event(event, event_dev);
4011 if (ret != NOTIFY_DONE)
4012 return ret;
4013 }
4014
4015 if (event_dev->flags & IFF_SLAVE)
4016 return bond_slave_netdev_event(event, event_dev);
4017
4018 return NOTIFY_DONE;
4019}
4020
4021static struct notifier_block bond_netdev_notifier = {
4022 .notifier_call = bond_netdev_event,
4023};
4024
4025/*---------------------------- Hashing Policies -----------------------------*/
4026
4027/* Helper to access data in a packet, with or without a backing skb.
4028 * If skb is given the data is linearized if necessary via pskb_may_pull.
4029 */
4030static inline const void *bond_pull_data(struct sk_buff *skb,
4031 const void *data, int hlen, int n)
4032{
4033 if (likely(n <= hlen))
4034 return data;
4035 else if (skb && likely(pskb_may_pull(skb, n)))
4036 return skb->data;
4037
4038 return NULL;
4039}
4040
4041/* L2 hash helper */
4042static inline u32 bond_eth_hash(struct sk_buff *skb, const void *data, int mhoff, int hlen)
4043{
4044 struct ethhdr *ep;
4045
4046 data = bond_pull_data(skb, data, hlen, mhoff + sizeof(struct ethhdr));
4047 if (!data)
4048 return 0;
4049
4050 ep = (struct ethhdr *)(data + mhoff);
4051 return ep->h_dest[5] ^ ep->h_source[5] ^ be16_to_cpu(ep->h_proto);
4052}
4053
4054static bool bond_flow_ip(struct sk_buff *skb, struct flow_keys *fk, const void *data,
4055 int hlen, __be16 l2_proto, int *nhoff, int *ip_proto, bool l34)
4056{
4057 const struct ipv6hdr *iph6;
4058 const struct iphdr *iph;
4059
4060 if (l2_proto == htons(ETH_P_IP)) {
4061 data = bond_pull_data(skb, data, hlen, *nhoff + sizeof(*iph));
4062 if (!data)
4063 return false;
4064
4065 iph = (const struct iphdr *)(data + *nhoff);
4066 iph_to_flow_copy_v4addrs(fk, iph);
4067 *nhoff += iph->ihl << 2;
4068 if (!ip_is_fragment(iph))
4069 *ip_proto = iph->protocol;
4070 } else if (l2_proto == htons(ETH_P_IPV6)) {
4071 data = bond_pull_data(skb, data, hlen, *nhoff + sizeof(*iph6));
4072 if (!data)
4073 return false;
4074
4075 iph6 = (const struct ipv6hdr *)(data + *nhoff);
4076 iph_to_flow_copy_v6addrs(fk, iph6);
4077 *nhoff += sizeof(*iph6);
4078 *ip_proto = iph6->nexthdr;
4079 } else {
4080 return false;
4081 }
4082
4083 if (l34 && *ip_proto >= 0)
4084 fk->ports.ports = __skb_flow_get_ports(skb, *nhoff, *ip_proto, data, hlen);
4085
4086 return true;
4087}
4088
4089static u32 bond_vlan_srcmac_hash(struct sk_buff *skb, const void *data, int mhoff, int hlen)
4090{
4091 u32 srcmac_vendor = 0, srcmac_dev = 0;
4092 struct ethhdr *mac_hdr;
4093 u16 vlan = 0;
4094 int i;
4095
4096 data = bond_pull_data(skb, data, hlen, mhoff + sizeof(struct ethhdr));
4097 if (!data)
4098 return 0;
4099 mac_hdr = (struct ethhdr *)(data + mhoff);
4100
4101 for (i = 0; i < 3; i++)
4102 srcmac_vendor = (srcmac_vendor << 8) | mac_hdr->h_source[i];
4103
4104 for (i = 3; i < ETH_ALEN; i++)
4105 srcmac_dev = (srcmac_dev << 8) | mac_hdr->h_source[i];
4106
4107 if (skb && skb_vlan_tag_present(skb))
4108 vlan = skb_vlan_tag_get(skb);
4109
4110 return vlan ^ srcmac_vendor ^ srcmac_dev;
4111}
4112
4113/* Extract the appropriate headers based on bond's xmit policy */
4114static bool bond_flow_dissect(struct bonding *bond, struct sk_buff *skb, const void *data,
4115 __be16 l2_proto, int nhoff, int hlen, struct flow_keys *fk)
4116{
4117 bool l34 = bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER34;
4118 int ip_proto = -1;
4119
4120 switch (bond->params.xmit_policy) {
4121 case BOND_XMIT_POLICY_ENCAP23:
4122 case BOND_XMIT_POLICY_ENCAP34:
4123 memset(fk, 0, sizeof(*fk));
4124 return __skb_flow_dissect(NULL, skb, &flow_keys_bonding,
4125 fk, data, l2_proto, nhoff, hlen, 0);
4126 default:
4127 break;
4128 }
4129
4130 fk->ports.ports = 0;
4131 memset(&fk->icmp, 0, sizeof(fk->icmp));
4132 if (!bond_flow_ip(skb, fk, data, hlen, l2_proto, &nhoff, &ip_proto, l34))
4133 return false;
4134
4135 /* ICMP error packets contains at least 8 bytes of the header
4136 * of the packet which generated the error. Use this information
4137 * to correlate ICMP error packets within the same flow which
4138 * generated the error.
4139 */
4140 if (ip_proto == IPPROTO_ICMP || ip_proto == IPPROTO_ICMPV6) {
4141 skb_flow_get_icmp_tci(skb, &fk->icmp, data, nhoff, hlen);
4142 if (ip_proto == IPPROTO_ICMP) {
4143 if (!icmp_is_err(fk->icmp.type))
4144 return true;
4145
4146 nhoff += sizeof(struct icmphdr);
4147 } else if (ip_proto == IPPROTO_ICMPV6) {
4148 if (!icmpv6_is_err(fk->icmp.type))
4149 return true;
4150
4151 nhoff += sizeof(struct icmp6hdr);
4152 }
4153 return bond_flow_ip(skb, fk, data, hlen, l2_proto, &nhoff, &ip_proto, l34);
4154 }
4155
4156 return true;
4157}
4158
4159static u32 bond_ip_hash(u32 hash, struct flow_keys *flow, int xmit_policy)
4160{
4161 hash ^= (__force u32)flow_get_u32_dst(flow) ^
4162 (__force u32)flow_get_u32_src(flow);
4163 hash ^= (hash >> 16);
4164 hash ^= (hash >> 8);
4165
4166 /* discard lowest hash bit to deal with the common even ports pattern */
4167 if (xmit_policy == BOND_XMIT_POLICY_LAYER34 ||
4168 xmit_policy == BOND_XMIT_POLICY_ENCAP34)
4169 return hash >> 1;
4170
4171 return hash;
4172}
4173
4174/* Generate hash based on xmit policy. If @skb is given it is used to linearize
4175 * the data as required, but this function can be used without it if the data is
4176 * known to be linear (e.g. with xdp_buff).
4177 */
4178static u32 __bond_xmit_hash(struct bonding *bond, struct sk_buff *skb, const void *data,
4179 __be16 l2_proto, int mhoff, int nhoff, int hlen)
4180{
4181 struct flow_keys flow;
4182 u32 hash;
4183
4184 if (bond->params.xmit_policy == BOND_XMIT_POLICY_VLAN_SRCMAC)
4185 return bond_vlan_srcmac_hash(skb, data, mhoff, hlen);
4186
4187 if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER2 ||
4188 !bond_flow_dissect(bond, skb, data, l2_proto, nhoff, hlen, &flow))
4189 return bond_eth_hash(skb, data, mhoff, hlen);
4190
4191 if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER23 ||
4192 bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP23) {
4193 hash = bond_eth_hash(skb, data, mhoff, hlen);
4194 } else {
4195 if (flow.icmp.id)
4196 memcpy(&hash, &flow.icmp, sizeof(hash));
4197 else
4198 memcpy(&hash, &flow.ports.ports, sizeof(hash));
4199 }
4200
4201 return bond_ip_hash(hash, &flow, bond->params.xmit_policy);
4202}
4203
4204/**
4205 * bond_xmit_hash - generate a hash value based on the xmit policy
4206 * @bond: bonding device
4207 * @skb: buffer to use for headers
4208 *
4209 * This function will extract the necessary headers from the skb buffer and use
4210 * them to generate a hash based on the xmit_policy set in the bonding device
4211 */
4212u32 bond_xmit_hash(struct bonding *bond, struct sk_buff *skb)
4213{
4214 if (bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP34 &&
4215 skb->l4_hash)
4216 return skb->hash;
4217
4218 return __bond_xmit_hash(bond, skb, skb->data, skb->protocol,
4219 0, skb_network_offset(skb),
4220 skb_headlen(skb));
4221}
4222
4223/**
4224 * bond_xmit_hash_xdp - generate a hash value based on the xmit policy
4225 * @bond: bonding device
4226 * @xdp: buffer to use for headers
4227 *
4228 * The XDP variant of bond_xmit_hash.
4229 */
4230static u32 bond_xmit_hash_xdp(struct bonding *bond, struct xdp_buff *xdp)
4231{
4232 struct ethhdr *eth;
4233
4234 if (xdp->data + sizeof(struct ethhdr) > xdp->data_end)
4235 return 0;
4236
4237 eth = (struct ethhdr *)xdp->data;
4238
4239 return __bond_xmit_hash(bond, NULL, xdp->data, eth->h_proto, 0,
4240 sizeof(struct ethhdr), xdp->data_end - xdp->data);
4241}
4242
4243/*-------------------------- Device entry points ----------------------------*/
4244
4245void bond_work_init_all(struct bonding *bond)
4246{
4247 INIT_DELAYED_WORK(&bond->mcast_work,
4248 bond_resend_igmp_join_requests_delayed);
4249 INIT_DELAYED_WORK(&bond->alb_work, bond_alb_monitor);
4250 INIT_DELAYED_WORK(&bond->mii_work, bond_mii_monitor);
4251 INIT_DELAYED_WORK(&bond->arp_work, bond_arp_monitor);
4252 INIT_DELAYED_WORK(&bond->ad_work, bond_3ad_state_machine_handler);
4253 INIT_DELAYED_WORK(&bond->slave_arr_work, bond_slave_arr_handler);
4254}
4255
4256static void bond_work_cancel_all(struct bonding *bond)
4257{
4258 cancel_delayed_work_sync(&bond->mii_work);
4259 cancel_delayed_work_sync(&bond->arp_work);
4260 cancel_delayed_work_sync(&bond->alb_work);
4261 cancel_delayed_work_sync(&bond->ad_work);
4262 cancel_delayed_work_sync(&bond->mcast_work);
4263 cancel_delayed_work_sync(&bond->slave_arr_work);
4264}
4265
4266static int bond_open(struct net_device *bond_dev)
4267{
4268 struct bonding *bond = netdev_priv(bond_dev);
4269 struct list_head *iter;
4270 struct slave *slave;
4271
4272 if (BOND_MODE(bond) == BOND_MODE_ROUNDROBIN && !bond->rr_tx_counter) {
4273 bond->rr_tx_counter = alloc_percpu(u32);
4274 if (!bond->rr_tx_counter)
4275 return -ENOMEM;
4276 }
4277
4278 /* reset slave->backup and slave->inactive */
4279 if (bond_has_slaves(bond)) {
4280 bond_for_each_slave(bond, slave, iter) {
4281 if (bond_uses_primary(bond) &&
4282 slave != rcu_access_pointer(bond->curr_active_slave)) {
4283 bond_set_slave_inactive_flags(slave,
4284 BOND_SLAVE_NOTIFY_NOW);
4285 } else if (BOND_MODE(bond) != BOND_MODE_8023AD) {
4286 bond_set_slave_active_flags(slave,
4287 BOND_SLAVE_NOTIFY_NOW);
4288 }
4289 }
4290 }
4291
4292 if (bond_is_lb(bond)) {
4293 /* bond_alb_initialize must be called before the timer
4294 * is started.
4295 */
4296 if (bond_alb_initialize(bond, (BOND_MODE(bond) == BOND_MODE_ALB)))
4297 return -ENOMEM;
4298 if (bond->params.tlb_dynamic_lb || BOND_MODE(bond) == BOND_MODE_ALB)
4299 queue_delayed_work(bond->wq, &bond->alb_work, 0);
4300 }
4301
4302 if (bond->params.miimon) /* link check interval, in milliseconds. */
4303 queue_delayed_work(bond->wq, &bond->mii_work, 0);
4304
4305 if (bond->params.arp_interval) { /* arp interval, in milliseconds. */
4306 queue_delayed_work(bond->wq, &bond->arp_work, 0);
4307 bond->recv_probe = bond_rcv_validate;
4308 }
4309
4310 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
4311 queue_delayed_work(bond->wq, &bond->ad_work, 0);
4312 /* register to receive LACPDUs */
4313 bond->recv_probe = bond_3ad_lacpdu_recv;
4314 bond_3ad_initiate_agg_selection(bond, 1);
4315
4316 bond_for_each_slave(bond, slave, iter)
4317 dev_mc_add(slave->dev, lacpdu_mcast_addr);
4318 }
4319
4320 if (bond_mode_can_use_xmit_hash(bond))
4321 bond_update_slave_arr(bond, NULL);
4322
4323 return 0;
4324}
4325
4326static int bond_close(struct net_device *bond_dev)
4327{
4328 struct bonding *bond = netdev_priv(bond_dev);
4329 struct slave *slave;
4330
4331 bond_work_cancel_all(bond);
4332 bond->send_peer_notif = 0;
4333 if (bond_is_lb(bond))
4334 bond_alb_deinitialize(bond);
4335 bond->recv_probe = NULL;
4336
4337 if (bond_uses_primary(bond)) {
4338 rcu_read_lock();
4339 slave = rcu_dereference(bond->curr_active_slave);
4340 if (slave)
4341 bond_hw_addr_flush(bond_dev, slave->dev);
4342 rcu_read_unlock();
4343 } else {
4344 struct list_head *iter;
4345
4346 bond_for_each_slave(bond, slave, iter)
4347 bond_hw_addr_flush(bond_dev, slave->dev);
4348 }
4349
4350 return 0;
4351}
4352
4353/* fold stats, assuming all rtnl_link_stats64 fields are u64, but
4354 * that some drivers can provide 32bit values only.
4355 */
4356static void bond_fold_stats(struct rtnl_link_stats64 *_res,
4357 const struct rtnl_link_stats64 *_new,
4358 const struct rtnl_link_stats64 *_old)
4359{
4360 const u64 *new = (const u64 *)_new;
4361 const u64 *old = (const u64 *)_old;
4362 u64 *res = (u64 *)_res;
4363 int i;
4364
4365 for (i = 0; i < sizeof(*_res) / sizeof(u64); i++) {
4366 u64 nv = new[i];
4367 u64 ov = old[i];
4368 s64 delta = nv - ov;
4369
4370 /* detects if this particular field is 32bit only */
4371 if (((nv | ov) >> 32) == 0)
4372 delta = (s64)(s32)((u32)nv - (u32)ov);
4373
4374 /* filter anomalies, some drivers reset their stats
4375 * at down/up events.
4376 */
4377 if (delta > 0)
4378 res[i] += delta;
4379 }
4380}
4381
4382#ifdef CONFIG_LOCKDEP
4383static int bond_get_lowest_level_rcu(struct net_device *dev)
4384{
4385 struct net_device *ldev, *next, *now, *dev_stack[MAX_NEST_DEV + 1];
4386 struct list_head *niter, *iter, *iter_stack[MAX_NEST_DEV + 1];
4387 int cur = 0, max = 0;
4388
4389 now = dev;
4390 iter = &dev->adj_list.lower;
4391
4392 while (1) {
4393 next = NULL;
4394 while (1) {
4395 ldev = netdev_next_lower_dev_rcu(now, &iter);
4396 if (!ldev)
4397 break;
4398
4399 next = ldev;
4400 niter = &ldev->adj_list.lower;
4401 dev_stack[cur] = now;
4402 iter_stack[cur++] = iter;
4403 if (max <= cur)
4404 max = cur;
4405 break;
4406 }
4407
4408 if (!next) {
4409 if (!cur)
4410 return max;
4411 next = dev_stack[--cur];
4412 niter = iter_stack[cur];
4413 }
4414
4415 now = next;
4416 iter = niter;
4417 }
4418
4419 return max;
4420}
4421#endif
4422
4423static void bond_get_stats(struct net_device *bond_dev,
4424 struct rtnl_link_stats64 *stats)
4425{
4426 struct bonding *bond = netdev_priv(bond_dev);
4427 struct rtnl_link_stats64 temp;
4428 struct list_head *iter;
4429 struct slave *slave;
4430 int nest_level = 0;
4431
4432
4433 rcu_read_lock();
4434#ifdef CONFIG_LOCKDEP
4435 nest_level = bond_get_lowest_level_rcu(bond_dev);
4436#endif
4437
4438 spin_lock_nested(&bond->stats_lock, nest_level);
4439 memcpy(stats, &bond->bond_stats, sizeof(*stats));
4440
4441 bond_for_each_slave_rcu(bond, slave, iter) {
4442 const struct rtnl_link_stats64 *new =
4443 dev_get_stats(slave->dev, &temp);
4444
4445 bond_fold_stats(stats, new, &slave->slave_stats);
4446
4447 /* save off the slave stats for the next run */
4448 memcpy(&slave->slave_stats, new, sizeof(*new));
4449 }
4450
4451 memcpy(&bond->bond_stats, stats, sizeof(*stats));
4452 spin_unlock(&bond->stats_lock);
4453 rcu_read_unlock();
4454}
4455
4456static int bond_eth_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
4457{
4458 struct bonding *bond = netdev_priv(bond_dev);
4459 struct mii_ioctl_data *mii = NULL;
4460
4461 netdev_dbg(bond_dev, "bond_eth_ioctl: cmd=%d\n", cmd);
4462
4463 switch (cmd) {
4464 case SIOCGMIIPHY:
4465 mii = if_mii(ifr);
4466 if (!mii)
4467 return -EINVAL;
4468
4469 mii->phy_id = 0;
4470 fallthrough;
4471 case SIOCGMIIREG:
4472 /* We do this again just in case we were called by SIOCGMIIREG
4473 * instead of SIOCGMIIPHY.
4474 */
4475 mii = if_mii(ifr);
4476 if (!mii)
4477 return -EINVAL;
4478
4479 if (mii->reg_num == 1) {
4480 mii->val_out = 0;
4481 if (netif_carrier_ok(bond->dev))
4482 mii->val_out = BMSR_LSTATUS;
4483 }
4484
4485 break;
4486 default:
4487 return -EOPNOTSUPP;
4488 }
4489
4490 return 0;
4491}
4492
4493static int bond_do_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
4494{
4495 struct bonding *bond = netdev_priv(bond_dev);
4496 struct net_device *slave_dev = NULL;
4497 struct ifbond k_binfo;
4498 struct ifbond __user *u_binfo = NULL;
4499 struct ifslave k_sinfo;
4500 struct ifslave __user *u_sinfo = NULL;
4501 struct bond_opt_value newval;
4502 struct net *net;
4503 int res = 0;
4504
4505 netdev_dbg(bond_dev, "bond_ioctl: cmd=%d\n", cmd);
4506
4507 switch (cmd) {
4508 case SIOCBONDINFOQUERY:
4509 u_binfo = (struct ifbond __user *)ifr->ifr_data;
4510
4511 if (copy_from_user(&k_binfo, u_binfo, sizeof(ifbond)))
4512 return -EFAULT;
4513
4514 bond_info_query(bond_dev, &k_binfo);
4515 if (copy_to_user(u_binfo, &k_binfo, sizeof(ifbond)))
4516 return -EFAULT;
4517
4518 return 0;
4519 case SIOCBONDSLAVEINFOQUERY:
4520 u_sinfo = (struct ifslave __user *)ifr->ifr_data;
4521
4522 if (copy_from_user(&k_sinfo, u_sinfo, sizeof(ifslave)))
4523 return -EFAULT;
4524
4525 res = bond_slave_info_query(bond_dev, &k_sinfo);
4526 if (res == 0 &&
4527 copy_to_user(u_sinfo, &k_sinfo, sizeof(ifslave)))
4528 return -EFAULT;
4529
4530 return res;
4531 default:
4532 break;
4533 }
4534
4535 net = dev_net(bond_dev);
4536
4537 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
4538 return -EPERM;
4539
4540 slave_dev = __dev_get_by_name(net, ifr->ifr_slave);
4541
4542 slave_dbg(bond_dev, slave_dev, "slave_dev=%p:\n", slave_dev);
4543
4544 if (!slave_dev)
4545 return -ENODEV;
4546
4547 switch (cmd) {
4548 case SIOCBONDENSLAVE:
4549 res = bond_enslave(bond_dev, slave_dev, NULL);
4550 break;
4551 case SIOCBONDRELEASE:
4552 res = bond_release(bond_dev, slave_dev);
4553 break;
4554 case SIOCBONDSETHWADDR:
4555 res = bond_set_dev_addr(bond_dev, slave_dev);
4556 break;
4557 case SIOCBONDCHANGEACTIVE:
4558 bond_opt_initstr(&newval, slave_dev->name);
4559 res = __bond_opt_set_notify(bond, BOND_OPT_ACTIVE_SLAVE,
4560 &newval);
4561 break;
4562 default:
4563 res = -EOPNOTSUPP;
4564 }
4565
4566 return res;
4567}
4568
4569static int bond_siocdevprivate(struct net_device *bond_dev, struct ifreq *ifr,
4570 void __user *data, int cmd)
4571{
4572 struct ifreq ifrdata = { .ifr_data = data };
4573
4574 switch (cmd) {
4575 case BOND_INFO_QUERY_OLD:
4576 return bond_do_ioctl(bond_dev, &ifrdata, SIOCBONDINFOQUERY);
4577 case BOND_SLAVE_INFO_QUERY_OLD:
4578 return bond_do_ioctl(bond_dev, &ifrdata, SIOCBONDSLAVEINFOQUERY);
4579 case BOND_ENSLAVE_OLD:
4580 return bond_do_ioctl(bond_dev, ifr, SIOCBONDENSLAVE);
4581 case BOND_RELEASE_OLD:
4582 return bond_do_ioctl(bond_dev, ifr, SIOCBONDRELEASE);
4583 case BOND_SETHWADDR_OLD:
4584 return bond_do_ioctl(bond_dev, ifr, SIOCBONDSETHWADDR);
4585 case BOND_CHANGE_ACTIVE_OLD:
4586 return bond_do_ioctl(bond_dev, ifr, SIOCBONDCHANGEACTIVE);
4587 }
4588
4589 return -EOPNOTSUPP;
4590}
4591
4592static void bond_change_rx_flags(struct net_device *bond_dev, int change)
4593{
4594 struct bonding *bond = netdev_priv(bond_dev);
4595
4596 if (change & IFF_PROMISC)
4597 bond_set_promiscuity(bond,
4598 bond_dev->flags & IFF_PROMISC ? 1 : -1);
4599
4600 if (change & IFF_ALLMULTI)
4601 bond_set_allmulti(bond,
4602 bond_dev->flags & IFF_ALLMULTI ? 1 : -1);
4603}
4604
4605static void bond_set_rx_mode(struct net_device *bond_dev)
4606{
4607 struct bonding *bond = netdev_priv(bond_dev);
4608 struct list_head *iter;
4609 struct slave *slave;
4610
4611 rcu_read_lock();
4612 if (bond_uses_primary(bond)) {
4613 slave = rcu_dereference(bond->curr_active_slave);
4614 if (slave) {
4615 dev_uc_sync(slave->dev, bond_dev);
4616 dev_mc_sync(slave->dev, bond_dev);
4617 }
4618 } else {
4619 bond_for_each_slave_rcu(bond, slave, iter) {
4620 dev_uc_sync_multiple(slave->dev, bond_dev);
4621 dev_mc_sync_multiple(slave->dev, bond_dev);
4622 }
4623 }
4624 rcu_read_unlock();
4625}
4626
4627static int bond_neigh_init(struct neighbour *n)
4628{
4629 struct bonding *bond = netdev_priv(n->dev);
4630 const struct net_device_ops *slave_ops;
4631 struct neigh_parms parms;
4632 struct slave *slave;
4633 int ret = 0;
4634
4635 rcu_read_lock();
4636 slave = bond_first_slave_rcu(bond);
4637 if (!slave)
4638 goto out;
4639 slave_ops = slave->dev->netdev_ops;
4640 if (!slave_ops->ndo_neigh_setup)
4641 goto out;
4642
4643 /* TODO: find another way [1] to implement this.
4644 * Passing a zeroed structure is fragile,
4645 * but at least we do not pass garbage.
4646 *
4647 * [1] One way would be that ndo_neigh_setup() never touch
4648 * struct neigh_parms, but propagate the new neigh_setup()
4649 * back to ___neigh_create() / neigh_parms_alloc()
4650 */
4651 memset(&parms, 0, sizeof(parms));
4652 ret = slave_ops->ndo_neigh_setup(slave->dev, &parms);
4653
4654 if (ret)
4655 goto out;
4656
4657 if (parms.neigh_setup)
4658 ret = parms.neigh_setup(n);
4659out:
4660 rcu_read_unlock();
4661 return ret;
4662}
4663
4664/* The bonding ndo_neigh_setup is called at init time beofre any
4665 * slave exists. So we must declare proxy setup function which will
4666 * be used at run time to resolve the actual slave neigh param setup.
4667 *
4668 * It's also called by master devices (such as vlans) to setup their
4669 * underlying devices. In that case - do nothing, we're already set up from
4670 * our init.
4671 */
4672static int bond_neigh_setup(struct net_device *dev,
4673 struct neigh_parms *parms)
4674{
4675 /* modify only our neigh_parms */
4676 if (parms->dev == dev)
4677 parms->neigh_setup = bond_neigh_init;
4678
4679 return 0;
4680}
4681
4682/* Change the MTU of all of a master's slaves to match the master */
4683static int bond_change_mtu(struct net_device *bond_dev, int new_mtu)
4684{
4685 struct bonding *bond = netdev_priv(bond_dev);
4686 struct slave *slave, *rollback_slave;
4687 struct list_head *iter;
4688 int res = 0;
4689
4690 netdev_dbg(bond_dev, "bond=%p, new_mtu=%d\n", bond, new_mtu);
4691
4692 bond_for_each_slave(bond, slave, iter) {
4693 slave_dbg(bond_dev, slave->dev, "s %p c_m %p\n",
4694 slave, slave->dev->netdev_ops->ndo_change_mtu);
4695
4696 res = dev_set_mtu(slave->dev, new_mtu);
4697
4698 if (res) {
4699 /* If we failed to set the slave's mtu to the new value
4700 * we must abort the operation even in ACTIVE_BACKUP
4701 * mode, because if we allow the backup slaves to have
4702 * different mtu values than the active slave we'll
4703 * need to change their mtu when doing a failover. That
4704 * means changing their mtu from timer context, which
4705 * is probably not a good idea.
4706 */
4707 slave_dbg(bond_dev, slave->dev, "err %d setting mtu to %d\n",
4708 res, new_mtu);
4709 goto unwind;
4710 }
4711 }
4712
4713 bond_dev->mtu = new_mtu;
4714
4715 return 0;
4716
4717unwind:
4718 /* unwind from head to the slave that failed */
4719 bond_for_each_slave(bond, rollback_slave, iter) {
4720 int tmp_res;
4721
4722 if (rollback_slave == slave)
4723 break;
4724
4725 tmp_res = dev_set_mtu(rollback_slave->dev, bond_dev->mtu);
4726 if (tmp_res)
4727 slave_dbg(bond_dev, rollback_slave->dev, "unwind err %d\n",
4728 tmp_res);
4729 }
4730
4731 return res;
4732}
4733
4734/* Change HW address
4735 *
4736 * Note that many devices must be down to change the HW address, and
4737 * downing the master releases all slaves. We can make bonds full of
4738 * bonding devices to test this, however.
4739 */
4740static int bond_set_mac_address(struct net_device *bond_dev, void *addr)
4741{
4742 struct bonding *bond = netdev_priv(bond_dev);
4743 struct slave *slave, *rollback_slave;
4744 struct sockaddr_storage *ss = addr, tmp_ss;
4745 struct list_head *iter;
4746 int res = 0;
4747
4748 if (BOND_MODE(bond) == BOND_MODE_ALB)
4749 return bond_alb_set_mac_address(bond_dev, addr);
4750
4751
4752 netdev_dbg(bond_dev, "%s: bond=%p\n", __func__, bond);
4753
4754 /* If fail_over_mac is enabled, do nothing and return success.
4755 * Returning an error causes ifenslave to fail.
4756 */
4757 if (bond->params.fail_over_mac &&
4758 BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
4759 return 0;
4760
4761 if (!is_valid_ether_addr(ss->__data))
4762 return -EADDRNOTAVAIL;
4763
4764 bond_for_each_slave(bond, slave, iter) {
4765 slave_dbg(bond_dev, slave->dev, "%s: slave=%p\n",
4766 __func__, slave);
4767 res = dev_set_mac_address(slave->dev, addr, NULL);
4768 if (res) {
4769 /* TODO: consider downing the slave
4770 * and retry ?
4771 * User should expect communications
4772 * breakage anyway until ARP finish
4773 * updating, so...
4774 */
4775 slave_dbg(bond_dev, slave->dev, "%s: err %d\n",
4776 __func__, res);
4777 goto unwind;
4778 }
4779 }
4780
4781 /* success */
4782 dev_addr_set(bond_dev, ss->__data);
4783 return 0;
4784
4785unwind:
4786 memcpy(tmp_ss.__data, bond_dev->dev_addr, bond_dev->addr_len);
4787 tmp_ss.ss_family = bond_dev->type;
4788
4789 /* unwind from head to the slave that failed */
4790 bond_for_each_slave(bond, rollback_slave, iter) {
4791 int tmp_res;
4792
4793 if (rollback_slave == slave)
4794 break;
4795
4796 tmp_res = dev_set_mac_address(rollback_slave->dev,
4797 (struct sockaddr *)&tmp_ss, NULL);
4798 if (tmp_res) {
4799 slave_dbg(bond_dev, rollback_slave->dev, "%s: unwind err %d\n",
4800 __func__, tmp_res);
4801 }
4802 }
4803
4804 return res;
4805}
4806
4807/**
4808 * bond_get_slave_by_id - get xmit slave with slave_id
4809 * @bond: bonding device that is transmitting
4810 * @slave_id: slave id up to slave_cnt-1 through which to transmit
4811 *
4812 * This function tries to get slave with slave_id but in case
4813 * it fails, it tries to find the first available slave for transmission.
4814 */
4815static struct slave *bond_get_slave_by_id(struct bonding *bond,
4816 int slave_id)
4817{
4818 struct list_head *iter;
4819 struct slave *slave;
4820 int i = slave_id;
4821
4822 /* Here we start from the slave with slave_id */
4823 bond_for_each_slave_rcu(bond, slave, iter) {
4824 if (--i < 0) {
4825 if (bond_slave_can_tx(slave))
4826 return slave;
4827 }
4828 }
4829
4830 /* Here we start from the first slave up to slave_id */
4831 i = slave_id;
4832 bond_for_each_slave_rcu(bond, slave, iter) {
4833 if (--i < 0)
4834 break;
4835 if (bond_slave_can_tx(slave))
4836 return slave;
4837 }
4838 /* no slave that can tx has been found */
4839 return NULL;
4840}
4841
4842/**
4843 * bond_rr_gen_slave_id - generate slave id based on packets_per_slave
4844 * @bond: bonding device to use
4845 *
4846 * Based on the value of the bonding device's packets_per_slave parameter
4847 * this function generates a slave id, which is usually used as the next
4848 * slave to transmit through.
4849 */
4850static u32 bond_rr_gen_slave_id(struct bonding *bond)
4851{
4852 u32 slave_id;
4853 struct reciprocal_value reciprocal_packets_per_slave;
4854 int packets_per_slave = bond->params.packets_per_slave;
4855
4856 switch (packets_per_slave) {
4857 case 0:
4858 slave_id = get_random_u32();
4859 break;
4860 case 1:
4861 slave_id = this_cpu_inc_return(*bond->rr_tx_counter);
4862 break;
4863 default:
4864 reciprocal_packets_per_slave =
4865 bond->params.reciprocal_packets_per_slave;
4866 slave_id = this_cpu_inc_return(*bond->rr_tx_counter);
4867 slave_id = reciprocal_divide(slave_id,
4868 reciprocal_packets_per_slave);
4869 break;
4870 }
4871
4872 return slave_id;
4873}
4874
4875static struct slave *bond_xmit_roundrobin_slave_get(struct bonding *bond,
4876 struct sk_buff *skb)
4877{
4878 struct slave *slave;
4879 int slave_cnt;
4880 u32 slave_id;
4881
4882 /* Start with the curr_active_slave that joined the bond as the
4883 * default for sending IGMP traffic. For failover purposes one
4884 * needs to maintain some consistency for the interface that will
4885 * send the join/membership reports. The curr_active_slave found
4886 * will send all of this type of traffic.
4887 */
4888 if (skb->protocol == htons(ETH_P_IP)) {
4889 int noff = skb_network_offset(skb);
4890 struct iphdr *iph;
4891
4892 if (unlikely(!pskb_may_pull(skb, noff + sizeof(*iph))))
4893 goto non_igmp;
4894
4895 iph = ip_hdr(skb);
4896 if (iph->protocol == IPPROTO_IGMP) {
4897 slave = rcu_dereference(bond->curr_active_slave);
4898 if (slave)
4899 return slave;
4900 return bond_get_slave_by_id(bond, 0);
4901 }
4902 }
4903
4904non_igmp:
4905 slave_cnt = READ_ONCE(bond->slave_cnt);
4906 if (likely(slave_cnt)) {
4907 slave_id = bond_rr_gen_slave_id(bond) % slave_cnt;
4908 return bond_get_slave_by_id(bond, slave_id);
4909 }
4910 return NULL;
4911}
4912
4913static struct slave *bond_xdp_xmit_roundrobin_slave_get(struct bonding *bond,
4914 struct xdp_buff *xdp)
4915{
4916 struct slave *slave;
4917 int slave_cnt;
4918 u32 slave_id;
4919 const struct ethhdr *eth;
4920 void *data = xdp->data;
4921
4922 if (data + sizeof(struct ethhdr) > xdp->data_end)
4923 goto non_igmp;
4924
4925 eth = (struct ethhdr *)data;
4926 data += sizeof(struct ethhdr);
4927
4928 /* See comment on IGMP in bond_xmit_roundrobin_slave_get() */
4929 if (eth->h_proto == htons(ETH_P_IP)) {
4930 const struct iphdr *iph;
4931
4932 if (data + sizeof(struct iphdr) > xdp->data_end)
4933 goto non_igmp;
4934
4935 iph = (struct iphdr *)data;
4936
4937 if (iph->protocol == IPPROTO_IGMP) {
4938 slave = rcu_dereference(bond->curr_active_slave);
4939 if (slave)
4940 return slave;
4941 return bond_get_slave_by_id(bond, 0);
4942 }
4943 }
4944
4945non_igmp:
4946 slave_cnt = READ_ONCE(bond->slave_cnt);
4947 if (likely(slave_cnt)) {
4948 slave_id = bond_rr_gen_slave_id(bond) % slave_cnt;
4949 return bond_get_slave_by_id(bond, slave_id);
4950 }
4951 return NULL;
4952}
4953
4954static netdev_tx_t bond_xmit_roundrobin(struct sk_buff *skb,
4955 struct net_device *bond_dev)
4956{
4957 struct bonding *bond = netdev_priv(bond_dev);
4958 struct slave *slave;
4959
4960 slave = bond_xmit_roundrobin_slave_get(bond, skb);
4961 if (likely(slave))
4962 return bond_dev_queue_xmit(bond, skb, slave->dev);
4963
4964 return bond_tx_drop(bond_dev, skb);
4965}
4966
4967static struct slave *bond_xmit_activebackup_slave_get(struct bonding *bond)
4968{
4969 return rcu_dereference(bond->curr_active_slave);
4970}
4971
4972/* In active-backup mode, we know that bond->curr_active_slave is always valid if
4973 * the bond has a usable interface.
4974 */
4975static netdev_tx_t bond_xmit_activebackup(struct sk_buff *skb,
4976 struct net_device *bond_dev)
4977{
4978 struct bonding *bond = netdev_priv(bond_dev);
4979 struct slave *slave;
4980
4981 slave = bond_xmit_activebackup_slave_get(bond);
4982 if (slave)
4983 return bond_dev_queue_xmit(bond, skb, slave->dev);
4984
4985 return bond_tx_drop(bond_dev, skb);
4986}
4987
4988/* Use this to update slave_array when (a) it's not appropriate to update
4989 * slave_array right away (note that update_slave_array() may sleep)
4990 * and / or (b) RTNL is not held.
4991 */
4992void bond_slave_arr_work_rearm(struct bonding *bond, unsigned long delay)
4993{
4994 queue_delayed_work(bond->wq, &bond->slave_arr_work, delay);
4995}
4996
4997/* Slave array work handler. Holds only RTNL */
4998static void bond_slave_arr_handler(struct work_struct *work)
4999{
5000 struct bonding *bond = container_of(work, struct bonding,
5001 slave_arr_work.work);
5002 int ret;
5003
5004 if (!rtnl_trylock())
5005 goto err;
5006
5007 ret = bond_update_slave_arr(bond, NULL);
5008 rtnl_unlock();
5009 if (ret) {
5010 pr_warn_ratelimited("Failed to update slave array from WT\n");
5011 goto err;
5012 }
5013 return;
5014
5015err:
5016 bond_slave_arr_work_rearm(bond, 1);
5017}
5018
5019static void bond_skip_slave(struct bond_up_slave *slaves,
5020 struct slave *skipslave)
5021{
5022 int idx;
5023
5024 /* Rare situation where caller has asked to skip a specific
5025 * slave but allocation failed (most likely!). BTW this is
5026 * only possible when the call is initiated from
5027 * __bond_release_one(). In this situation; overwrite the
5028 * skipslave entry in the array with the last entry from the
5029 * array to avoid a situation where the xmit path may choose
5030 * this to-be-skipped slave to send a packet out.
5031 */
5032 for (idx = 0; slaves && idx < slaves->count; idx++) {
5033 if (skipslave == slaves->arr[idx]) {
5034 slaves->arr[idx] =
5035 slaves->arr[slaves->count - 1];
5036 slaves->count--;
5037 break;
5038 }
5039 }
5040}
5041
5042static void bond_set_slave_arr(struct bonding *bond,
5043 struct bond_up_slave *usable_slaves,
5044 struct bond_up_slave *all_slaves)
5045{
5046 struct bond_up_slave *usable, *all;
5047
5048 usable = rtnl_dereference(bond->usable_slaves);
5049 rcu_assign_pointer(bond->usable_slaves, usable_slaves);
5050 kfree_rcu(usable, rcu);
5051
5052 all = rtnl_dereference(bond->all_slaves);
5053 rcu_assign_pointer(bond->all_slaves, all_slaves);
5054 kfree_rcu(all, rcu);
5055}
5056
5057static void bond_reset_slave_arr(struct bonding *bond)
5058{
5059 bond_set_slave_arr(bond, NULL, NULL);
5060}
5061
5062/* Build the usable slaves array in control path for modes that use xmit-hash
5063 * to determine the slave interface -
5064 * (a) BOND_MODE_8023AD
5065 * (b) BOND_MODE_XOR
5066 * (c) (BOND_MODE_TLB || BOND_MODE_ALB) && tlb_dynamic_lb == 0
5067 *
5068 * The caller is expected to hold RTNL only and NO other lock!
5069 */
5070int bond_update_slave_arr(struct bonding *bond, struct slave *skipslave)
5071{
5072 struct bond_up_slave *usable_slaves = NULL, *all_slaves = NULL;
5073 struct slave *slave;
5074 struct list_head *iter;
5075 int agg_id = 0;
5076 int ret = 0;
5077
5078 might_sleep();
5079
5080 usable_slaves = kzalloc(struct_size(usable_slaves, arr,
5081 bond->slave_cnt), GFP_KERNEL);
5082 all_slaves = kzalloc(struct_size(all_slaves, arr,
5083 bond->slave_cnt), GFP_KERNEL);
5084 if (!usable_slaves || !all_slaves) {
5085 ret = -ENOMEM;
5086 goto out;
5087 }
5088 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
5089 struct ad_info ad_info;
5090
5091 spin_lock_bh(&bond->mode_lock);
5092 if (bond_3ad_get_active_agg_info(bond, &ad_info)) {
5093 spin_unlock_bh(&bond->mode_lock);
5094 pr_debug("bond_3ad_get_active_agg_info failed\n");
5095 /* No active aggragator means it's not safe to use
5096 * the previous array.
5097 */
5098 bond_reset_slave_arr(bond);
5099 goto out;
5100 }
5101 spin_unlock_bh(&bond->mode_lock);
5102 agg_id = ad_info.aggregator_id;
5103 }
5104 bond_for_each_slave(bond, slave, iter) {
5105 if (skipslave == slave)
5106 continue;
5107
5108 all_slaves->arr[all_slaves->count++] = slave;
5109 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
5110 struct aggregator *agg;
5111
5112 agg = SLAVE_AD_INFO(slave)->port.aggregator;
5113 if (!agg || agg->aggregator_identifier != agg_id)
5114 continue;
5115 }
5116 if (!bond_slave_can_tx(slave))
5117 continue;
5118
5119 slave_dbg(bond->dev, slave->dev, "Adding slave to tx hash array[%d]\n",
5120 usable_slaves->count);
5121
5122 usable_slaves->arr[usable_slaves->count++] = slave;
5123 }
5124
5125 bond_set_slave_arr(bond, usable_slaves, all_slaves);
5126 return ret;
5127out:
5128 if (ret != 0 && skipslave) {
5129 bond_skip_slave(rtnl_dereference(bond->all_slaves),
5130 skipslave);
5131 bond_skip_slave(rtnl_dereference(bond->usable_slaves),
5132 skipslave);
5133 }
5134 kfree_rcu(all_slaves, rcu);
5135 kfree_rcu(usable_slaves, rcu);
5136
5137 return ret;
5138}
5139
5140static struct slave *bond_xmit_3ad_xor_slave_get(struct bonding *bond,
5141 struct sk_buff *skb,
5142 struct bond_up_slave *slaves)
5143{
5144 struct slave *slave;
5145 unsigned int count;
5146 u32 hash;
5147
5148 hash = bond_xmit_hash(bond, skb);
5149 count = slaves ? READ_ONCE(slaves->count) : 0;
5150 if (unlikely(!count))
5151 return NULL;
5152
5153 slave = slaves->arr[hash % count];
5154 return slave;
5155}
5156
5157static struct slave *bond_xdp_xmit_3ad_xor_slave_get(struct bonding *bond,
5158 struct xdp_buff *xdp)
5159{
5160 struct bond_up_slave *slaves;
5161 unsigned int count;
5162 u32 hash;
5163
5164 hash = bond_xmit_hash_xdp(bond, xdp);
5165 slaves = rcu_dereference(bond->usable_slaves);
5166 count = slaves ? READ_ONCE(slaves->count) : 0;
5167 if (unlikely(!count))
5168 return NULL;
5169
5170 return slaves->arr[hash % count];
5171}
5172
5173/* Use this Xmit function for 3AD as well as XOR modes. The current
5174 * usable slave array is formed in the control path. The xmit function
5175 * just calculates hash and sends the packet out.
5176 */
5177static netdev_tx_t bond_3ad_xor_xmit(struct sk_buff *skb,
5178 struct net_device *dev)
5179{
5180 struct bonding *bond = netdev_priv(dev);
5181 struct bond_up_slave *slaves;
5182 struct slave *slave;
5183
5184 slaves = rcu_dereference(bond->usable_slaves);
5185 slave = bond_xmit_3ad_xor_slave_get(bond, skb, slaves);
5186 if (likely(slave))
5187 return bond_dev_queue_xmit(bond, skb, slave->dev);
5188
5189 return bond_tx_drop(dev, skb);
5190}
5191
5192/* in broadcast mode, we send everything to all usable interfaces. */
5193static netdev_tx_t bond_xmit_broadcast(struct sk_buff *skb,
5194 struct net_device *bond_dev)
5195{
5196 struct bonding *bond = netdev_priv(bond_dev);
5197 struct slave *slave = NULL;
5198 struct list_head *iter;
5199 bool xmit_suc = false;
5200 bool skb_used = false;
5201
5202 bond_for_each_slave_rcu(bond, slave, iter) {
5203 struct sk_buff *skb2;
5204
5205 if (!(bond_slave_is_up(slave) && slave->link == BOND_LINK_UP))
5206 continue;
5207
5208 if (bond_is_last_slave(bond, slave)) {
5209 skb2 = skb;
5210 skb_used = true;
5211 } else {
5212 skb2 = skb_clone(skb, GFP_ATOMIC);
5213 if (!skb2) {
5214 net_err_ratelimited("%s: Error: %s: skb_clone() failed\n",
5215 bond_dev->name, __func__);
5216 continue;
5217 }
5218 }
5219
5220 if (bond_dev_queue_xmit(bond, skb2, slave->dev) == NETDEV_TX_OK)
5221 xmit_suc = true;
5222 }
5223
5224 if (!skb_used)
5225 dev_kfree_skb_any(skb);
5226
5227 if (xmit_suc)
5228 return NETDEV_TX_OK;
5229
5230 dev_core_stats_tx_dropped_inc(bond_dev);
5231 return NET_XMIT_DROP;
5232}
5233
5234/*------------------------- Device initialization ---------------------------*/
5235
5236/* Lookup the slave that corresponds to a qid */
5237static inline int bond_slave_override(struct bonding *bond,
5238 struct sk_buff *skb)
5239{
5240 struct slave *slave = NULL;
5241 struct list_head *iter;
5242
5243 if (!skb_rx_queue_recorded(skb))
5244 return 1;
5245
5246 /* Find out if any slaves have the same mapping as this skb. */
5247 bond_for_each_slave_rcu(bond, slave, iter) {
5248 if (slave->queue_id == skb_get_queue_mapping(skb)) {
5249 if (bond_slave_is_up(slave) &&
5250 slave->link == BOND_LINK_UP) {
5251 bond_dev_queue_xmit(bond, skb, slave->dev);
5252 return 0;
5253 }
5254 /* If the slave isn't UP, use default transmit policy. */
5255 break;
5256 }
5257 }
5258
5259 return 1;
5260}
5261
5262
5263static u16 bond_select_queue(struct net_device *dev, struct sk_buff *skb,
5264 struct net_device *sb_dev)
5265{
5266 /* This helper function exists to help dev_pick_tx get the correct
5267 * destination queue. Using a helper function skips a call to
5268 * skb_tx_hash and will put the skbs in the queue we expect on their
5269 * way down to the bonding driver.
5270 */
5271 u16 txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;
5272
5273 /* Save the original txq to restore before passing to the driver */
5274 qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb_get_queue_mapping(skb);
5275
5276 if (unlikely(txq >= dev->real_num_tx_queues)) {
5277 do {
5278 txq -= dev->real_num_tx_queues;
5279 } while (txq >= dev->real_num_tx_queues);
5280 }
5281 return txq;
5282}
5283
5284static struct net_device *bond_xmit_get_slave(struct net_device *master_dev,
5285 struct sk_buff *skb,
5286 bool all_slaves)
5287{
5288 struct bonding *bond = netdev_priv(master_dev);
5289 struct bond_up_slave *slaves;
5290 struct slave *slave = NULL;
5291
5292 switch (BOND_MODE(bond)) {
5293 case BOND_MODE_ROUNDROBIN:
5294 slave = bond_xmit_roundrobin_slave_get(bond, skb);
5295 break;
5296 case BOND_MODE_ACTIVEBACKUP:
5297 slave = bond_xmit_activebackup_slave_get(bond);
5298 break;
5299 case BOND_MODE_8023AD:
5300 case BOND_MODE_XOR:
5301 if (all_slaves)
5302 slaves = rcu_dereference(bond->all_slaves);
5303 else
5304 slaves = rcu_dereference(bond->usable_slaves);
5305 slave = bond_xmit_3ad_xor_slave_get(bond, skb, slaves);
5306 break;
5307 case BOND_MODE_BROADCAST:
5308 break;
5309 case BOND_MODE_ALB:
5310 slave = bond_xmit_alb_slave_get(bond, skb);
5311 break;
5312 case BOND_MODE_TLB:
5313 slave = bond_xmit_tlb_slave_get(bond, skb);
5314 break;
5315 default:
5316 /* Should never happen, mode already checked */
5317 WARN_ONCE(true, "Unknown bonding mode");
5318 break;
5319 }
5320
5321 if (slave)
5322 return slave->dev;
5323 return NULL;
5324}
5325
5326static void bond_sk_to_flow(struct sock *sk, struct flow_keys *flow)
5327{
5328 switch (sk->sk_family) {
5329#if IS_ENABLED(CONFIG_IPV6)
5330 case AF_INET6:
5331 if (ipv6_only_sock(sk) ||
5332 ipv6_addr_type(&sk->sk_v6_daddr) != IPV6_ADDR_MAPPED) {
5333 flow->control.addr_type = FLOW_DISSECTOR_KEY_IPV6_ADDRS;
5334 flow->addrs.v6addrs.src = inet6_sk(sk)->saddr;
5335 flow->addrs.v6addrs.dst = sk->sk_v6_daddr;
5336 break;
5337 }
5338 fallthrough;
5339#endif
5340 default: /* AF_INET */
5341 flow->control.addr_type = FLOW_DISSECTOR_KEY_IPV4_ADDRS;
5342 flow->addrs.v4addrs.src = inet_sk(sk)->inet_rcv_saddr;
5343 flow->addrs.v4addrs.dst = inet_sk(sk)->inet_daddr;
5344 break;
5345 }
5346
5347 flow->ports.src = inet_sk(sk)->inet_sport;
5348 flow->ports.dst = inet_sk(sk)->inet_dport;
5349}
5350
5351/**
5352 * bond_sk_hash_l34 - generate a hash value based on the socket's L3 and L4 fields
5353 * @sk: socket to use for headers
5354 *
5355 * This function will extract the necessary field from the socket and use
5356 * them to generate a hash based on the LAYER34 xmit_policy.
5357 * Assumes that sk is a TCP or UDP socket.
5358 */
5359static u32 bond_sk_hash_l34(struct sock *sk)
5360{
5361 struct flow_keys flow;
5362 u32 hash;
5363
5364 bond_sk_to_flow(sk, &flow);
5365
5366 /* L4 */
5367 memcpy(&hash, &flow.ports.ports, sizeof(hash));
5368 /* L3 */
5369 return bond_ip_hash(hash, &flow, BOND_XMIT_POLICY_LAYER34);
5370}
5371
5372static struct net_device *__bond_sk_get_lower_dev(struct bonding *bond,
5373 struct sock *sk)
5374{
5375 struct bond_up_slave *slaves;
5376 struct slave *slave;
5377 unsigned int count;
5378 u32 hash;
5379
5380 slaves = rcu_dereference(bond->usable_slaves);
5381 count = slaves ? READ_ONCE(slaves->count) : 0;
5382 if (unlikely(!count))
5383 return NULL;
5384
5385 hash = bond_sk_hash_l34(sk);
5386 slave = slaves->arr[hash % count];
5387
5388 return slave->dev;
5389}
5390
5391static struct net_device *bond_sk_get_lower_dev(struct net_device *dev,
5392 struct sock *sk)
5393{
5394 struct bonding *bond = netdev_priv(dev);
5395 struct net_device *lower = NULL;
5396
5397 rcu_read_lock();
5398 if (bond_sk_check(bond))
5399 lower = __bond_sk_get_lower_dev(bond, sk);
5400 rcu_read_unlock();
5401
5402 return lower;
5403}
5404
5405#if IS_ENABLED(CONFIG_TLS_DEVICE)
5406static netdev_tx_t bond_tls_device_xmit(struct bonding *bond, struct sk_buff *skb,
5407 struct net_device *dev)
5408{
5409 struct net_device *tls_netdev = rcu_dereference(tls_get_ctx(skb->sk)->netdev);
5410
5411 /* tls_netdev might become NULL, even if tls_is_skb_tx_device_offloaded
5412 * was true, if tls_device_down is running in parallel, but it's OK,
5413 * because bond_get_slave_by_dev has a NULL check.
5414 */
5415 if (likely(bond_get_slave_by_dev(bond, tls_netdev)))
5416 return bond_dev_queue_xmit(bond, skb, tls_netdev);
5417 return bond_tx_drop(dev, skb);
5418}
5419#endif
5420
5421static netdev_tx_t __bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
5422{
5423 struct bonding *bond = netdev_priv(dev);
5424
5425 if (bond_should_override_tx_queue(bond) &&
5426 !bond_slave_override(bond, skb))
5427 return NETDEV_TX_OK;
5428
5429#if IS_ENABLED(CONFIG_TLS_DEVICE)
5430 if (tls_is_skb_tx_device_offloaded(skb))
5431 return bond_tls_device_xmit(bond, skb, dev);
5432#endif
5433
5434 switch (BOND_MODE(bond)) {
5435 case BOND_MODE_ROUNDROBIN:
5436 return bond_xmit_roundrobin(skb, dev);
5437 case BOND_MODE_ACTIVEBACKUP:
5438 return bond_xmit_activebackup(skb, dev);
5439 case BOND_MODE_8023AD:
5440 case BOND_MODE_XOR:
5441 return bond_3ad_xor_xmit(skb, dev);
5442 case BOND_MODE_BROADCAST:
5443 return bond_xmit_broadcast(skb, dev);
5444 case BOND_MODE_ALB:
5445 return bond_alb_xmit(skb, dev);
5446 case BOND_MODE_TLB:
5447 return bond_tlb_xmit(skb, dev);
5448 default:
5449 /* Should never happen, mode already checked */
5450 netdev_err(dev, "Unknown bonding mode %d\n", BOND_MODE(bond));
5451 WARN_ON_ONCE(1);
5452 return bond_tx_drop(dev, skb);
5453 }
5454}
5455
5456static netdev_tx_t bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
5457{
5458 struct bonding *bond = netdev_priv(dev);
5459 netdev_tx_t ret = NETDEV_TX_OK;
5460
5461 /* If we risk deadlock from transmitting this in the
5462 * netpoll path, tell netpoll to queue the frame for later tx
5463 */
5464 if (unlikely(is_netpoll_tx_blocked(dev)))
5465 return NETDEV_TX_BUSY;
5466
5467 rcu_read_lock();
5468 if (bond_has_slaves(bond))
5469 ret = __bond_start_xmit(skb, dev);
5470 else
5471 ret = bond_tx_drop(dev, skb);
5472 rcu_read_unlock();
5473
5474 return ret;
5475}
5476
5477static struct net_device *
5478bond_xdp_get_xmit_slave(struct net_device *bond_dev, struct xdp_buff *xdp)
5479{
5480 struct bonding *bond = netdev_priv(bond_dev);
5481 struct slave *slave;
5482
5483 /* Caller needs to hold rcu_read_lock() */
5484
5485 switch (BOND_MODE(bond)) {
5486 case BOND_MODE_ROUNDROBIN:
5487 slave = bond_xdp_xmit_roundrobin_slave_get(bond, xdp);
5488 break;
5489
5490 case BOND_MODE_ACTIVEBACKUP:
5491 slave = bond_xmit_activebackup_slave_get(bond);
5492 break;
5493
5494 case BOND_MODE_8023AD:
5495 case BOND_MODE_XOR:
5496 slave = bond_xdp_xmit_3ad_xor_slave_get(bond, xdp);
5497 break;
5498
5499 default:
5500 /* Should never happen. Mode guarded by bond_xdp_check() */
5501 netdev_err(bond_dev, "Unknown bonding mode %d for xdp xmit\n", BOND_MODE(bond));
5502 WARN_ON_ONCE(1);
5503 return NULL;
5504 }
5505
5506 if (slave)
5507 return slave->dev;
5508
5509 return NULL;
5510}
5511
5512static int bond_xdp_xmit(struct net_device *bond_dev,
5513 int n, struct xdp_frame **frames, u32 flags)
5514{
5515 int nxmit, err = -ENXIO;
5516
5517 rcu_read_lock();
5518
5519 for (nxmit = 0; nxmit < n; nxmit++) {
5520 struct xdp_frame *frame = frames[nxmit];
5521 struct xdp_frame *frames1[] = {frame};
5522 struct net_device *slave_dev;
5523 struct xdp_buff xdp;
5524
5525 xdp_convert_frame_to_buff(frame, &xdp);
5526
5527 slave_dev = bond_xdp_get_xmit_slave(bond_dev, &xdp);
5528 if (!slave_dev) {
5529 err = -ENXIO;
5530 break;
5531 }
5532
5533 err = slave_dev->netdev_ops->ndo_xdp_xmit(slave_dev, 1, frames1, flags);
5534 if (err < 1)
5535 break;
5536 }
5537
5538 rcu_read_unlock();
5539
5540 /* If error happened on the first frame then we can pass the error up, otherwise
5541 * report the number of frames that were xmitted.
5542 */
5543 if (err < 0)
5544 return (nxmit == 0 ? err : nxmit);
5545
5546 return nxmit;
5547}
5548
5549static int bond_xdp_set(struct net_device *dev, struct bpf_prog *prog,
5550 struct netlink_ext_ack *extack)
5551{
5552 struct bonding *bond = netdev_priv(dev);
5553 struct list_head *iter;
5554 struct slave *slave, *rollback_slave;
5555 struct bpf_prog *old_prog;
5556 struct netdev_bpf xdp = {
5557 .command = XDP_SETUP_PROG,
5558 .flags = 0,
5559 .prog = prog,
5560 .extack = extack,
5561 };
5562 int err;
5563
5564 ASSERT_RTNL();
5565
5566 if (!bond_xdp_check(bond))
5567 return -EOPNOTSUPP;
5568
5569 old_prog = bond->xdp_prog;
5570 bond->xdp_prog = prog;
5571
5572 bond_for_each_slave(bond, slave, iter) {
5573 struct net_device *slave_dev = slave->dev;
5574
5575 if (!slave_dev->netdev_ops->ndo_bpf ||
5576 !slave_dev->netdev_ops->ndo_xdp_xmit) {
5577 SLAVE_NL_ERR(dev, slave_dev, extack,
5578 "Slave device does not support XDP");
5579 err = -EOPNOTSUPP;
5580 goto err;
5581 }
5582
5583 if (dev_xdp_prog_count(slave_dev) > 0) {
5584 SLAVE_NL_ERR(dev, slave_dev, extack,
5585 "Slave has XDP program loaded, please unload before enslaving");
5586 err = -EOPNOTSUPP;
5587 goto err;
5588 }
5589
5590 err = slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp);
5591 if (err < 0) {
5592 /* ndo_bpf() sets extack error message */
5593 slave_err(dev, slave_dev, "Error %d calling ndo_bpf\n", err);
5594 goto err;
5595 }
5596 if (prog)
5597 bpf_prog_inc(prog);
5598 }
5599
5600 if (prog) {
5601 static_branch_inc(&bpf_master_redirect_enabled_key);
5602 } else if (old_prog) {
5603 bpf_prog_put(old_prog);
5604 static_branch_dec(&bpf_master_redirect_enabled_key);
5605 }
5606
5607 return 0;
5608
5609err:
5610 /* unwind the program changes */
5611 bond->xdp_prog = old_prog;
5612 xdp.prog = old_prog;
5613 xdp.extack = NULL; /* do not overwrite original error */
5614
5615 bond_for_each_slave(bond, rollback_slave, iter) {
5616 struct net_device *slave_dev = rollback_slave->dev;
5617 int err_unwind;
5618
5619 if (slave == rollback_slave)
5620 break;
5621
5622 err_unwind = slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp);
5623 if (err_unwind < 0)
5624 slave_err(dev, slave_dev,
5625 "Error %d when unwinding XDP program change\n", err_unwind);
5626 else if (xdp.prog)
5627 bpf_prog_inc(xdp.prog);
5628 }
5629 return err;
5630}
5631
5632static int bond_xdp(struct net_device *dev, struct netdev_bpf *xdp)
5633{
5634 switch (xdp->command) {
5635 case XDP_SETUP_PROG:
5636 return bond_xdp_set(dev, xdp->prog, xdp->extack);
5637 default:
5638 return -EINVAL;
5639 }
5640}
5641
5642static u32 bond_mode_bcast_speed(struct slave *slave, u32 speed)
5643{
5644 if (speed == 0 || speed == SPEED_UNKNOWN)
5645 speed = slave->speed;
5646 else
5647 speed = min(speed, slave->speed);
5648
5649 return speed;
5650}
5651
5652/* Set the BOND_PHC_INDEX flag to notify user space */
5653static int bond_set_phc_index_flag(struct kernel_hwtstamp_config *kernel_cfg)
5654{
5655 struct ifreq *ifr = kernel_cfg->ifr;
5656 struct hwtstamp_config cfg;
5657
5658 if (kernel_cfg->copied_to_user) {
5659 /* Lower device has a legacy implementation */
5660 if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
5661 return -EFAULT;
5662
5663 cfg.flags |= HWTSTAMP_FLAG_BONDED_PHC_INDEX;
5664 if (copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)))
5665 return -EFAULT;
5666 } else {
5667 kernel_cfg->flags |= HWTSTAMP_FLAG_BONDED_PHC_INDEX;
5668 }
5669
5670 return 0;
5671}
5672
5673static int bond_hwtstamp_get(struct net_device *dev,
5674 struct kernel_hwtstamp_config *cfg)
5675{
5676 struct bonding *bond = netdev_priv(dev);
5677 struct net_device *real_dev;
5678 int err;
5679
5680 real_dev = bond_option_active_slave_get_rcu(bond);
5681 if (!real_dev)
5682 return -EOPNOTSUPP;
5683
5684 err = generic_hwtstamp_get_lower(real_dev, cfg);
5685 if (err)
5686 return err;
5687
5688 return bond_set_phc_index_flag(cfg);
5689}
5690
5691static int bond_hwtstamp_set(struct net_device *dev,
5692 struct kernel_hwtstamp_config *cfg,
5693 struct netlink_ext_ack *extack)
5694{
5695 struct bonding *bond = netdev_priv(dev);
5696 struct net_device *real_dev;
5697 int err;
5698
5699 if (!(cfg->flags & HWTSTAMP_FLAG_BONDED_PHC_INDEX))
5700 return -EOPNOTSUPP;
5701
5702 real_dev = bond_option_active_slave_get_rcu(bond);
5703 if (!real_dev)
5704 return -EOPNOTSUPP;
5705
5706 err = generic_hwtstamp_set_lower(real_dev, cfg, extack);
5707 if (err)
5708 return err;
5709
5710 return bond_set_phc_index_flag(cfg);
5711}
5712
5713static int bond_ethtool_get_link_ksettings(struct net_device *bond_dev,
5714 struct ethtool_link_ksettings *cmd)
5715{
5716 struct bonding *bond = netdev_priv(bond_dev);
5717 struct list_head *iter;
5718 struct slave *slave;
5719 u32 speed = 0;
5720
5721 cmd->base.duplex = DUPLEX_UNKNOWN;
5722 cmd->base.port = PORT_OTHER;
5723
5724 /* Since bond_slave_can_tx returns false for all inactive or down slaves, we
5725 * do not need to check mode. Though link speed might not represent
5726 * the true receive or transmit bandwidth (not all modes are symmetric)
5727 * this is an accurate maximum.
5728 */
5729 bond_for_each_slave(bond, slave, iter) {
5730 if (bond_slave_can_tx(slave)) {
5731 bond_update_speed_duplex(slave);
5732 if (slave->speed != SPEED_UNKNOWN) {
5733 if (BOND_MODE(bond) == BOND_MODE_BROADCAST)
5734 speed = bond_mode_bcast_speed(slave,
5735 speed);
5736 else
5737 speed += slave->speed;
5738 }
5739 if (cmd->base.duplex == DUPLEX_UNKNOWN &&
5740 slave->duplex != DUPLEX_UNKNOWN)
5741 cmd->base.duplex = slave->duplex;
5742 }
5743 }
5744 cmd->base.speed = speed ? : SPEED_UNKNOWN;
5745
5746 return 0;
5747}
5748
5749static void bond_ethtool_get_drvinfo(struct net_device *bond_dev,
5750 struct ethtool_drvinfo *drvinfo)
5751{
5752 strscpy(drvinfo->driver, DRV_NAME, sizeof(drvinfo->driver));
5753 snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version), "%d",
5754 BOND_ABI_VERSION);
5755}
5756
5757static int bond_ethtool_get_ts_info(struct net_device *bond_dev,
5758 struct ethtool_ts_info *info)
5759{
5760 struct bonding *bond = netdev_priv(bond_dev);
5761 struct ethtool_ts_info ts_info;
5762 struct net_device *real_dev;
5763 bool sw_tx_support = false;
5764 struct list_head *iter;
5765 struct slave *slave;
5766 int ret = 0;
5767
5768 rcu_read_lock();
5769 real_dev = bond_option_active_slave_get_rcu(bond);
5770 dev_hold(real_dev);
5771 rcu_read_unlock();
5772
5773 if (real_dev) {
5774 ret = ethtool_get_ts_info_by_layer(real_dev, info);
5775 } else {
5776 /* Check if all slaves support software tx timestamping */
5777 rcu_read_lock();
5778 bond_for_each_slave_rcu(bond, slave, iter) {
5779 ret = ethtool_get_ts_info_by_layer(slave->dev, &ts_info);
5780 if (!ret && (ts_info.so_timestamping & SOF_TIMESTAMPING_TX_SOFTWARE)) {
5781 sw_tx_support = true;
5782 continue;
5783 }
5784
5785 sw_tx_support = false;
5786 break;
5787 }
5788 rcu_read_unlock();
5789 }
5790
5791 if (sw_tx_support)
5792 info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE;
5793
5794 dev_put(real_dev);
5795 return ret;
5796}
5797
5798static const struct ethtool_ops bond_ethtool_ops = {
5799 .get_drvinfo = bond_ethtool_get_drvinfo,
5800 .get_link = ethtool_op_get_link,
5801 .get_link_ksettings = bond_ethtool_get_link_ksettings,
5802 .get_ts_info = bond_ethtool_get_ts_info,
5803};
5804
5805static const struct net_device_ops bond_netdev_ops = {
5806 .ndo_init = bond_init,
5807 .ndo_uninit = bond_uninit,
5808 .ndo_open = bond_open,
5809 .ndo_stop = bond_close,
5810 .ndo_start_xmit = bond_start_xmit,
5811 .ndo_select_queue = bond_select_queue,
5812 .ndo_get_stats64 = bond_get_stats,
5813 .ndo_eth_ioctl = bond_eth_ioctl,
5814 .ndo_siocbond = bond_do_ioctl,
5815 .ndo_siocdevprivate = bond_siocdevprivate,
5816 .ndo_change_rx_flags = bond_change_rx_flags,
5817 .ndo_set_rx_mode = bond_set_rx_mode,
5818 .ndo_change_mtu = bond_change_mtu,
5819 .ndo_set_mac_address = bond_set_mac_address,
5820 .ndo_neigh_setup = bond_neigh_setup,
5821 .ndo_vlan_rx_add_vid = bond_vlan_rx_add_vid,
5822 .ndo_vlan_rx_kill_vid = bond_vlan_rx_kill_vid,
5823#ifdef CONFIG_NET_POLL_CONTROLLER
5824 .ndo_netpoll_setup = bond_netpoll_setup,
5825 .ndo_netpoll_cleanup = bond_netpoll_cleanup,
5826 .ndo_poll_controller = bond_poll_controller,
5827#endif
5828 .ndo_add_slave = bond_enslave,
5829 .ndo_del_slave = bond_release,
5830 .ndo_fix_features = bond_fix_features,
5831 .ndo_features_check = passthru_features_check,
5832 .ndo_get_xmit_slave = bond_xmit_get_slave,
5833 .ndo_sk_get_lower_dev = bond_sk_get_lower_dev,
5834 .ndo_bpf = bond_xdp,
5835 .ndo_xdp_xmit = bond_xdp_xmit,
5836 .ndo_xdp_get_xmit_slave = bond_xdp_get_xmit_slave,
5837 .ndo_hwtstamp_get = bond_hwtstamp_get,
5838 .ndo_hwtstamp_set = bond_hwtstamp_set,
5839};
5840
5841static const struct device_type bond_type = {
5842 .name = "bond",
5843};
5844
5845static void bond_destructor(struct net_device *bond_dev)
5846{
5847 struct bonding *bond = netdev_priv(bond_dev);
5848
5849 if (bond->wq)
5850 destroy_workqueue(bond->wq);
5851
5852 free_percpu(bond->rr_tx_counter);
5853}
5854
5855void bond_setup(struct net_device *bond_dev)
5856{
5857 struct bonding *bond = netdev_priv(bond_dev);
5858
5859 spin_lock_init(&bond->mode_lock);
5860 bond->params = bonding_defaults;
5861
5862 /* Initialize pointers */
5863 bond->dev = bond_dev;
5864
5865 /* Initialize the device entry points */
5866 ether_setup(bond_dev);
5867 bond_dev->max_mtu = ETH_MAX_MTU;
5868 bond_dev->netdev_ops = &bond_netdev_ops;
5869 bond_dev->ethtool_ops = &bond_ethtool_ops;
5870
5871 bond_dev->needs_free_netdev = true;
5872 bond_dev->priv_destructor = bond_destructor;
5873
5874 SET_NETDEV_DEVTYPE(bond_dev, &bond_type);
5875
5876 /* Initialize the device options */
5877 bond_dev->flags |= IFF_MASTER;
5878 bond_dev->priv_flags |= IFF_BONDING | IFF_UNICAST_FLT | IFF_NO_QUEUE;
5879 bond_dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
5880
5881#ifdef CONFIG_XFRM_OFFLOAD
5882 /* set up xfrm device ops (only supported in active-backup right now) */
5883 bond_dev->xfrmdev_ops = &bond_xfrmdev_ops;
5884 INIT_LIST_HEAD(&bond->ipsec_list);
5885 spin_lock_init(&bond->ipsec_lock);
5886#endif /* CONFIG_XFRM_OFFLOAD */
5887
5888 /* don't acquire bond device's netif_tx_lock when transmitting */
5889 bond_dev->features |= NETIF_F_LLTX;
5890
5891 /* By default, we declare the bond to be fully
5892 * VLAN hardware accelerated capable. Special
5893 * care is taken in the various xmit functions
5894 * when there are slaves that are not hw accel
5895 * capable
5896 */
5897
5898 /* Don't allow bond devices to change network namespaces. */
5899 bond_dev->features |= NETIF_F_NETNS_LOCAL;
5900
5901 bond_dev->hw_features = BOND_VLAN_FEATURES |
5902 NETIF_F_HW_VLAN_CTAG_RX |
5903 NETIF_F_HW_VLAN_CTAG_FILTER |
5904 NETIF_F_HW_VLAN_STAG_RX |
5905 NETIF_F_HW_VLAN_STAG_FILTER;
5906
5907 bond_dev->hw_features |= NETIF_F_GSO_ENCAP_ALL;
5908 bond_dev->features |= bond_dev->hw_features;
5909 bond_dev->features |= NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_STAG_TX;
5910#ifdef CONFIG_XFRM_OFFLOAD
5911 bond_dev->hw_features |= BOND_XFRM_FEATURES;
5912 /* Only enable XFRM features if this is an active-backup config */
5913 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
5914 bond_dev->features |= BOND_XFRM_FEATURES;
5915#endif /* CONFIG_XFRM_OFFLOAD */
5916}
5917
5918/* Destroy a bonding device.
5919 * Must be under rtnl_lock when this function is called.
5920 */
5921static void bond_uninit(struct net_device *bond_dev)
5922{
5923 struct bonding *bond = netdev_priv(bond_dev);
5924 struct list_head *iter;
5925 struct slave *slave;
5926
5927 bond_netpoll_cleanup(bond_dev);
5928
5929 /* Release the bonded slaves */
5930 bond_for_each_slave(bond, slave, iter)
5931 __bond_release_one(bond_dev, slave->dev, true, true);
5932 netdev_info(bond_dev, "Released all slaves\n");
5933
5934 bond_set_slave_arr(bond, NULL, NULL);
5935
5936 list_del(&bond->bond_list);
5937
5938 bond_debug_unregister(bond);
5939}
5940
5941/*------------------------- Module initialization ---------------------------*/
5942
5943static int __init bond_check_params(struct bond_params *params)
5944{
5945 int arp_validate_value, fail_over_mac_value, primary_reselect_value, i;
5946 struct bond_opt_value newval;
5947 const struct bond_opt_value *valptr;
5948 int arp_all_targets_value = 0;
5949 u16 ad_actor_sys_prio = 0;
5950 u16 ad_user_port_key = 0;
5951 __be32 arp_target[BOND_MAX_ARP_TARGETS] = { 0 };
5952 int arp_ip_count;
5953 int bond_mode = BOND_MODE_ROUNDROBIN;
5954 int xmit_hashtype = BOND_XMIT_POLICY_LAYER2;
5955 int lacp_fast = 0;
5956 int tlb_dynamic_lb;
5957
5958 /* Convert string parameters. */
5959 if (mode) {
5960 bond_opt_initstr(&newval, mode);
5961 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_MODE), &newval);
5962 if (!valptr) {
5963 pr_err("Error: Invalid bonding mode \"%s\"\n", mode);
5964 return -EINVAL;
5965 }
5966 bond_mode = valptr->value;
5967 }
5968
5969 if (xmit_hash_policy) {
5970 if (bond_mode == BOND_MODE_ROUNDROBIN ||
5971 bond_mode == BOND_MODE_ACTIVEBACKUP ||
5972 bond_mode == BOND_MODE_BROADCAST) {
5973 pr_info("xmit_hash_policy param is irrelevant in mode %s\n",
5974 bond_mode_name(bond_mode));
5975 } else {
5976 bond_opt_initstr(&newval, xmit_hash_policy);
5977 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_XMIT_HASH),
5978 &newval);
5979 if (!valptr) {
5980 pr_err("Error: Invalid xmit_hash_policy \"%s\"\n",
5981 xmit_hash_policy);
5982 return -EINVAL;
5983 }
5984 xmit_hashtype = valptr->value;
5985 }
5986 }
5987
5988 if (lacp_rate) {
5989 if (bond_mode != BOND_MODE_8023AD) {
5990 pr_info("lacp_rate param is irrelevant in mode %s\n",
5991 bond_mode_name(bond_mode));
5992 } else {
5993 bond_opt_initstr(&newval, lacp_rate);
5994 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_LACP_RATE),
5995 &newval);
5996 if (!valptr) {
5997 pr_err("Error: Invalid lacp rate \"%s\"\n",
5998 lacp_rate);
5999 return -EINVAL;
6000 }
6001 lacp_fast = valptr->value;
6002 }
6003 }
6004
6005 if (ad_select) {
6006 bond_opt_initstr(&newval, ad_select);
6007 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_SELECT),
6008 &newval);
6009 if (!valptr) {
6010 pr_err("Error: Invalid ad_select \"%s\"\n", ad_select);
6011 return -EINVAL;
6012 }
6013 params->ad_select = valptr->value;
6014 if (bond_mode != BOND_MODE_8023AD)
6015 pr_warn("ad_select param only affects 802.3ad mode\n");
6016 } else {
6017 params->ad_select = BOND_AD_STABLE;
6018 }
6019
6020 if (max_bonds < 0) {
6021 pr_warn("Warning: max_bonds (%d) not in range %d-%d, so it was reset to BOND_DEFAULT_MAX_BONDS (%d)\n",
6022 max_bonds, 0, INT_MAX, BOND_DEFAULT_MAX_BONDS);
6023 max_bonds = BOND_DEFAULT_MAX_BONDS;
6024 }
6025
6026 if (miimon < 0) {
6027 pr_warn("Warning: miimon module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6028 miimon, INT_MAX);
6029 miimon = 0;
6030 }
6031
6032 if (updelay < 0) {
6033 pr_warn("Warning: updelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6034 updelay, INT_MAX);
6035 updelay = 0;
6036 }
6037
6038 if (downdelay < 0) {
6039 pr_warn("Warning: downdelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6040 downdelay, INT_MAX);
6041 downdelay = 0;
6042 }
6043
6044 if ((use_carrier != 0) && (use_carrier != 1)) {
6045 pr_warn("Warning: use_carrier module parameter (%d), not of valid value (0/1), so it was set to 1\n",
6046 use_carrier);
6047 use_carrier = 1;
6048 }
6049
6050 if (num_peer_notif < 0 || num_peer_notif > 255) {
6051 pr_warn("Warning: num_grat_arp/num_unsol_na (%d) not in range 0-255 so it was reset to 1\n",
6052 num_peer_notif);
6053 num_peer_notif = 1;
6054 }
6055
6056 /* reset values for 802.3ad/TLB/ALB */
6057 if (!bond_mode_uses_arp(bond_mode)) {
6058 if (!miimon) {
6059 pr_warn("Warning: miimon must be specified, otherwise bonding will not detect link failure, speed and duplex which are essential for 802.3ad operation\n");
6060 pr_warn("Forcing miimon to 100msec\n");
6061 miimon = BOND_DEFAULT_MIIMON;
6062 }
6063 }
6064
6065 if (tx_queues < 1 || tx_queues > 255) {
6066 pr_warn("Warning: tx_queues (%d) should be between 1 and 255, resetting to %d\n",
6067 tx_queues, BOND_DEFAULT_TX_QUEUES);
6068 tx_queues = BOND_DEFAULT_TX_QUEUES;
6069 }
6070
6071 if ((all_slaves_active != 0) && (all_slaves_active != 1)) {
6072 pr_warn("Warning: all_slaves_active module parameter (%d), not of valid value (0/1), so it was set to 0\n",
6073 all_slaves_active);
6074 all_slaves_active = 0;
6075 }
6076
6077 if (resend_igmp < 0 || resend_igmp > 255) {
6078 pr_warn("Warning: resend_igmp (%d) should be between 0 and 255, resetting to %d\n",
6079 resend_igmp, BOND_DEFAULT_RESEND_IGMP);
6080 resend_igmp = BOND_DEFAULT_RESEND_IGMP;
6081 }
6082
6083 bond_opt_initval(&newval, packets_per_slave);
6084 if (!bond_opt_parse(bond_opt_get(BOND_OPT_PACKETS_PER_SLAVE), &newval)) {
6085 pr_warn("Warning: packets_per_slave (%d) should be between 0 and %u resetting to 1\n",
6086 packets_per_slave, USHRT_MAX);
6087 packets_per_slave = 1;
6088 }
6089
6090 if (bond_mode == BOND_MODE_ALB) {
6091 pr_notice("In ALB mode you might experience client disconnections upon reconnection of a link if the bonding module updelay parameter (%d msec) is incompatible with the forwarding delay time of the switch\n",
6092 updelay);
6093 }
6094
6095 if (!miimon) {
6096 if (updelay || downdelay) {
6097 /* just warn the user the up/down delay will have
6098 * no effect since miimon is zero...
6099 */
6100 pr_warn("Warning: miimon module parameter not set and updelay (%d) or downdelay (%d) module parameter is set; updelay and downdelay have no effect unless miimon is set\n",
6101 updelay, downdelay);
6102 }
6103 } else {
6104 /* don't allow arp monitoring */
6105 if (arp_interval) {
6106 pr_warn("Warning: miimon (%d) and arp_interval (%d) can't be used simultaneously, disabling ARP monitoring\n",
6107 miimon, arp_interval);
6108 arp_interval = 0;
6109 }
6110
6111 if ((updelay % miimon) != 0) {
6112 pr_warn("Warning: updelay (%d) is not a multiple of miimon (%d), updelay rounded to %d ms\n",
6113 updelay, miimon, (updelay / miimon) * miimon);
6114 }
6115
6116 updelay /= miimon;
6117
6118 if ((downdelay % miimon) != 0) {
6119 pr_warn("Warning: downdelay (%d) is not a multiple of miimon (%d), downdelay rounded to %d ms\n",
6120 downdelay, miimon,
6121 (downdelay / miimon) * miimon);
6122 }
6123
6124 downdelay /= miimon;
6125 }
6126
6127 if (arp_interval < 0) {
6128 pr_warn("Warning: arp_interval module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6129 arp_interval, INT_MAX);
6130 arp_interval = 0;
6131 }
6132
6133 for (arp_ip_count = 0, i = 0;
6134 (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[i]; i++) {
6135 __be32 ip;
6136
6137 /* not a complete check, but good enough to catch mistakes */
6138 if (!in4_pton(arp_ip_target[i], -1, (u8 *)&ip, -1, NULL) ||
6139 !bond_is_ip_target_ok(ip)) {
6140 pr_warn("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n",
6141 arp_ip_target[i]);
6142 arp_interval = 0;
6143 } else {
6144 if (bond_get_targets_ip(arp_target, ip) == -1)
6145 arp_target[arp_ip_count++] = ip;
6146 else
6147 pr_warn("Warning: duplicate address %pI4 in arp_ip_target, skipping\n",
6148 &ip);
6149 }
6150 }
6151
6152 if (arp_interval && !arp_ip_count) {
6153 /* don't allow arping if no arp_ip_target given... */
6154 pr_warn("Warning: arp_interval module parameter (%d) specified without providing an arp_ip_target parameter, arp_interval was reset to 0\n",
6155 arp_interval);
6156 arp_interval = 0;
6157 }
6158
6159 if (arp_validate) {
6160 if (!arp_interval) {
6161 pr_err("arp_validate requires arp_interval\n");
6162 return -EINVAL;
6163 }
6164
6165 bond_opt_initstr(&newval, arp_validate);
6166 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_VALIDATE),
6167 &newval);
6168 if (!valptr) {
6169 pr_err("Error: invalid arp_validate \"%s\"\n",
6170 arp_validate);
6171 return -EINVAL;
6172 }
6173 arp_validate_value = valptr->value;
6174 } else {
6175 arp_validate_value = 0;
6176 }
6177
6178 if (arp_all_targets) {
6179 bond_opt_initstr(&newval, arp_all_targets);
6180 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_ALL_TARGETS),
6181 &newval);
6182 if (!valptr) {
6183 pr_err("Error: invalid arp_all_targets_value \"%s\"\n",
6184 arp_all_targets);
6185 arp_all_targets_value = 0;
6186 } else {
6187 arp_all_targets_value = valptr->value;
6188 }
6189 }
6190
6191 if (miimon) {
6192 pr_info("MII link monitoring set to %d ms\n", miimon);
6193 } else if (arp_interval) {
6194 valptr = bond_opt_get_val(BOND_OPT_ARP_VALIDATE,
6195 arp_validate_value);
6196 pr_info("ARP monitoring set to %d ms, validate %s, with %d target(s):",
6197 arp_interval, valptr->string, arp_ip_count);
6198
6199 for (i = 0; i < arp_ip_count; i++)
6200 pr_cont(" %s", arp_ip_target[i]);
6201
6202 pr_cont("\n");
6203
6204 } else if (max_bonds) {
6205 /* miimon and arp_interval not set, we need one so things
6206 * work as expected, see bonding.txt for details
6207 */
6208 pr_debug("Warning: either miimon or arp_interval and arp_ip_target module parameters must be specified, otherwise bonding will not detect link failures! see bonding.txt for details\n");
6209 }
6210
6211 if (primary && !bond_mode_uses_primary(bond_mode)) {
6212 /* currently, using a primary only makes sense
6213 * in active backup, TLB or ALB modes
6214 */
6215 pr_warn("Warning: %s primary device specified but has no effect in %s mode\n",
6216 primary, bond_mode_name(bond_mode));
6217 primary = NULL;
6218 }
6219
6220 if (primary && primary_reselect) {
6221 bond_opt_initstr(&newval, primary_reselect);
6222 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_PRIMARY_RESELECT),
6223 &newval);
6224 if (!valptr) {
6225 pr_err("Error: Invalid primary_reselect \"%s\"\n",
6226 primary_reselect);
6227 return -EINVAL;
6228 }
6229 primary_reselect_value = valptr->value;
6230 } else {
6231 primary_reselect_value = BOND_PRI_RESELECT_ALWAYS;
6232 }
6233
6234 if (fail_over_mac) {
6235 bond_opt_initstr(&newval, fail_over_mac);
6236 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_FAIL_OVER_MAC),
6237 &newval);
6238 if (!valptr) {
6239 pr_err("Error: invalid fail_over_mac \"%s\"\n",
6240 fail_over_mac);
6241 return -EINVAL;
6242 }
6243 fail_over_mac_value = valptr->value;
6244 if (bond_mode != BOND_MODE_ACTIVEBACKUP)
6245 pr_warn("Warning: fail_over_mac only affects active-backup mode\n");
6246 } else {
6247 fail_over_mac_value = BOND_FOM_NONE;
6248 }
6249
6250 bond_opt_initstr(&newval, "default");
6251 valptr = bond_opt_parse(
6252 bond_opt_get(BOND_OPT_AD_ACTOR_SYS_PRIO),
6253 &newval);
6254 if (!valptr) {
6255 pr_err("Error: No ad_actor_sys_prio default value");
6256 return -EINVAL;
6257 }
6258 ad_actor_sys_prio = valptr->value;
6259
6260 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_USER_PORT_KEY),
6261 &newval);
6262 if (!valptr) {
6263 pr_err("Error: No ad_user_port_key default value");
6264 return -EINVAL;
6265 }
6266 ad_user_port_key = valptr->value;
6267
6268 bond_opt_initstr(&newval, "default");
6269 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_TLB_DYNAMIC_LB), &newval);
6270 if (!valptr) {
6271 pr_err("Error: No tlb_dynamic_lb default value");
6272 return -EINVAL;
6273 }
6274 tlb_dynamic_lb = valptr->value;
6275
6276 if (lp_interval == 0) {
6277 pr_warn("Warning: ip_interval must be between 1 and %d, so it was reset to %d\n",
6278 INT_MAX, BOND_ALB_DEFAULT_LP_INTERVAL);
6279 lp_interval = BOND_ALB_DEFAULT_LP_INTERVAL;
6280 }
6281
6282 /* fill params struct with the proper values */
6283 params->mode = bond_mode;
6284 params->xmit_policy = xmit_hashtype;
6285 params->miimon = miimon;
6286 params->num_peer_notif = num_peer_notif;
6287 params->arp_interval = arp_interval;
6288 params->arp_validate = arp_validate_value;
6289 params->arp_all_targets = arp_all_targets_value;
6290 params->missed_max = 2;
6291 params->updelay = updelay;
6292 params->downdelay = downdelay;
6293 params->peer_notif_delay = 0;
6294 params->use_carrier = use_carrier;
6295 params->lacp_active = 1;
6296 params->lacp_fast = lacp_fast;
6297 params->primary[0] = 0;
6298 params->primary_reselect = primary_reselect_value;
6299 params->fail_over_mac = fail_over_mac_value;
6300 params->tx_queues = tx_queues;
6301 params->all_slaves_active = all_slaves_active;
6302 params->resend_igmp = resend_igmp;
6303 params->min_links = min_links;
6304 params->lp_interval = lp_interval;
6305 params->packets_per_slave = packets_per_slave;
6306 params->tlb_dynamic_lb = tlb_dynamic_lb;
6307 params->ad_actor_sys_prio = ad_actor_sys_prio;
6308 eth_zero_addr(params->ad_actor_system);
6309 params->ad_user_port_key = ad_user_port_key;
6310 params->coupled_control = 1;
6311 if (packets_per_slave > 0) {
6312 params->reciprocal_packets_per_slave =
6313 reciprocal_value(packets_per_slave);
6314 } else {
6315 /* reciprocal_packets_per_slave is unused if
6316 * packets_per_slave is 0 or 1, just initialize it
6317 */
6318 params->reciprocal_packets_per_slave =
6319 (struct reciprocal_value) { 0 };
6320 }
6321
6322 if (primary)
6323 strscpy_pad(params->primary, primary, sizeof(params->primary));
6324
6325 memcpy(params->arp_targets, arp_target, sizeof(arp_target));
6326#if IS_ENABLED(CONFIG_IPV6)
6327 memset(params->ns_targets, 0, sizeof(struct in6_addr) * BOND_MAX_NS_TARGETS);
6328#endif
6329
6330 return 0;
6331}
6332
6333/* Called from registration process */
6334static int bond_init(struct net_device *bond_dev)
6335{
6336 struct bonding *bond = netdev_priv(bond_dev);
6337 struct bond_net *bn = net_generic(dev_net(bond_dev), bond_net_id);
6338
6339 netdev_dbg(bond_dev, "Begin bond_init\n");
6340
6341 bond->wq = alloc_ordered_workqueue(bond_dev->name, WQ_MEM_RECLAIM);
6342 if (!bond->wq)
6343 return -ENOMEM;
6344
6345 bond->notifier_ctx = false;
6346
6347 spin_lock_init(&bond->stats_lock);
6348 netdev_lockdep_set_classes(bond_dev);
6349
6350 list_add_tail(&bond->bond_list, &bn->dev_list);
6351
6352 bond_prepare_sysfs_group(bond);
6353
6354 bond_debug_register(bond);
6355
6356 /* Ensure valid dev_addr */
6357 if (is_zero_ether_addr(bond_dev->dev_addr) &&
6358 bond_dev->addr_assign_type == NET_ADDR_PERM)
6359 eth_hw_addr_random(bond_dev);
6360
6361 return 0;
6362}
6363
6364unsigned int bond_get_num_tx_queues(void)
6365{
6366 return tx_queues;
6367}
6368
6369/* Create a new bond based on the specified name and bonding parameters.
6370 * If name is NULL, obtain a suitable "bond%d" name for us.
6371 * Caller must NOT hold rtnl_lock; we need to release it here before we
6372 * set up our sysfs entries.
6373 */
6374int bond_create(struct net *net, const char *name)
6375{
6376 struct net_device *bond_dev;
6377 struct bonding *bond;
6378 int res = -ENOMEM;
6379
6380 rtnl_lock();
6381
6382 bond_dev = alloc_netdev_mq(sizeof(struct bonding),
6383 name ? name : "bond%d", NET_NAME_UNKNOWN,
6384 bond_setup, tx_queues);
6385 if (!bond_dev)
6386 goto out;
6387
6388 bond = netdev_priv(bond_dev);
6389 dev_net_set(bond_dev, net);
6390 bond_dev->rtnl_link_ops = &bond_link_ops;
6391
6392 res = register_netdevice(bond_dev);
6393 if (res < 0) {
6394 free_netdev(bond_dev);
6395 goto out;
6396 }
6397
6398 netif_carrier_off(bond_dev);
6399
6400 bond_work_init_all(bond);
6401
6402out:
6403 rtnl_unlock();
6404 return res;
6405}
6406
6407static int __net_init bond_net_init(struct net *net)
6408{
6409 struct bond_net *bn = net_generic(net, bond_net_id);
6410
6411 bn->net = net;
6412 INIT_LIST_HEAD(&bn->dev_list);
6413
6414 bond_create_proc_dir(bn);
6415 bond_create_sysfs(bn);
6416
6417 return 0;
6418}
6419
6420/* According to commit 69b0216ac255 ("bonding: fix bonding_masters
6421 * race condition in bond unloading") we need to remove sysfs files
6422 * before we remove our devices (done later in bond_net_exit_batch_rtnl())
6423 */
6424static void __net_exit bond_net_pre_exit(struct net *net)
6425{
6426 struct bond_net *bn = net_generic(net, bond_net_id);
6427
6428 bond_destroy_sysfs(bn);
6429}
6430
6431static void __net_exit bond_net_exit_batch_rtnl(struct list_head *net_list,
6432 struct list_head *dev_kill_list)
6433{
6434 struct bond_net *bn;
6435 struct net *net;
6436
6437 /* Kill off any bonds created after unregistering bond rtnl ops */
6438 list_for_each_entry(net, net_list, exit_list) {
6439 struct bonding *bond, *tmp_bond;
6440
6441 bn = net_generic(net, bond_net_id);
6442 list_for_each_entry_safe(bond, tmp_bond, &bn->dev_list, bond_list)
6443 unregister_netdevice_queue(bond->dev, dev_kill_list);
6444 }
6445}
6446
6447/* According to commit 23fa5c2caae0 ("bonding: destroy proc directory
6448 * only after all bonds are gone") bond_destroy_proc_dir() is called
6449 * after bond_net_exit_batch_rtnl() has completed.
6450 */
6451static void __net_exit bond_net_exit_batch(struct list_head *net_list)
6452{
6453 struct bond_net *bn;
6454 struct net *net;
6455
6456 list_for_each_entry(net, net_list, exit_list) {
6457 bn = net_generic(net, bond_net_id);
6458 bond_destroy_proc_dir(bn);
6459 }
6460}
6461
6462static struct pernet_operations bond_net_ops = {
6463 .init = bond_net_init,
6464 .pre_exit = bond_net_pre_exit,
6465 .exit_batch_rtnl = bond_net_exit_batch_rtnl,
6466 .exit_batch = bond_net_exit_batch,
6467 .id = &bond_net_id,
6468 .size = sizeof(struct bond_net),
6469};
6470
6471static int __init bonding_init(void)
6472{
6473 int i;
6474 int res;
6475
6476 res = bond_check_params(&bonding_defaults);
6477 if (res)
6478 goto out;
6479
6480 res = register_pernet_subsys(&bond_net_ops);
6481 if (res)
6482 goto out;
6483
6484 res = bond_netlink_init();
6485 if (res)
6486 goto err_link;
6487
6488 bond_create_debugfs();
6489
6490 for (i = 0; i < max_bonds; i++) {
6491 res = bond_create(&init_net, NULL);
6492 if (res)
6493 goto err;
6494 }
6495
6496 skb_flow_dissector_init(&flow_keys_bonding,
6497 flow_keys_bonding_keys,
6498 ARRAY_SIZE(flow_keys_bonding_keys));
6499
6500 register_netdevice_notifier(&bond_netdev_notifier);
6501out:
6502 return res;
6503err:
6504 bond_destroy_debugfs();
6505 bond_netlink_fini();
6506err_link:
6507 unregister_pernet_subsys(&bond_net_ops);
6508 goto out;
6509
6510}
6511
6512static void __exit bonding_exit(void)
6513{
6514 unregister_netdevice_notifier(&bond_netdev_notifier);
6515
6516 bond_destroy_debugfs();
6517
6518 bond_netlink_fini();
6519 unregister_pernet_subsys(&bond_net_ops);
6520
6521#ifdef CONFIG_NET_POLL_CONTROLLER
6522 /* Make sure we don't have an imbalance on our netpoll blocking */
6523 WARN_ON(atomic_read(&netpoll_block_tx));
6524#endif
6525}
6526
6527module_init(bonding_init);
6528module_exit(bonding_exit);
6529MODULE_LICENSE("GPL");
6530MODULE_DESCRIPTION(DRV_DESCRIPTION);
6531MODULE_AUTHOR("Thomas Davis, tadavis@lbl.gov and many others");