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) {
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 slave_info(bond->dev, slave->dev, "link status up again after %d ms\n",
2629 (bond->params.downdelay - slave->delay) *
2630 bond->params.miimon);
2631 commit++;
2632 continue;
2633 }
2634
2635 if (slave->delay <= 0) {
2636 bond_propose_link_state(slave, BOND_LINK_DOWN);
2637 commit++;
2638 continue;
2639 }
2640
2641 slave->delay--;
2642 break;
2643
2644 case BOND_LINK_DOWN:
2645 if (!link_state)
2646 continue;
2647
2648 bond_propose_link_state(slave, BOND_LINK_BACK);
2649 commit++;
2650 slave->delay = bond->params.updelay;
2651
2652 if (slave->delay) {
2653 slave_info(bond->dev, slave->dev, "link status up, enabling it in %d ms\n",
2654 ignore_updelay ? 0 :
2655 bond->params.updelay *
2656 bond->params.miimon);
2657 }
2658 fallthrough;
2659 case BOND_LINK_BACK:
2660 if (!link_state) {
2661 bond_propose_link_state(slave, BOND_LINK_DOWN);
2662 slave_info(bond->dev, slave->dev, "link status down again after %d ms\n",
2663 (bond->params.updelay - slave->delay) *
2664 bond->params.miimon);
2665 commit++;
2666 continue;
2667 }
2668
2669 if (ignore_updelay)
2670 slave->delay = 0;
2671
2672 if (slave->delay <= 0) {
2673 bond_propose_link_state(slave, BOND_LINK_UP);
2674 commit++;
2675 ignore_updelay = false;
2676 continue;
2677 }
2678
2679 slave->delay--;
2680 break;
2681 }
2682 }
2683
2684 return commit;
2685}
2686
2687static void bond_miimon_link_change(struct bonding *bond,
2688 struct slave *slave,
2689 char link)
2690{
2691 switch (BOND_MODE(bond)) {
2692 case BOND_MODE_8023AD:
2693 bond_3ad_handle_link_change(slave, link);
2694 break;
2695 case BOND_MODE_TLB:
2696 case BOND_MODE_ALB:
2697 bond_alb_handle_link_change(bond, slave, link);
2698 break;
2699 case BOND_MODE_XOR:
2700 bond_update_slave_arr(bond, NULL);
2701 break;
2702 }
2703}
2704
2705static void bond_miimon_commit(struct bonding *bond)
2706{
2707 struct slave *slave, *primary, *active;
2708 bool do_failover = false;
2709 struct list_head *iter;
2710
2711 ASSERT_RTNL();
2712
2713 bond_for_each_slave(bond, slave, iter) {
2714 switch (slave->link_new_state) {
2715 case BOND_LINK_NOCHANGE:
2716 /* For 802.3ad mode, check current slave speed and
2717 * duplex again in case its port was disabled after
2718 * invalid speed/duplex reporting but recovered before
2719 * link monitoring could make a decision on the actual
2720 * link status
2721 */
2722 if (BOND_MODE(bond) == BOND_MODE_8023AD &&
2723 slave->link == BOND_LINK_UP)
2724 bond_3ad_adapter_speed_duplex_changed(slave);
2725 continue;
2726
2727 case BOND_LINK_UP:
2728 if (bond_update_speed_duplex(slave) &&
2729 bond_needs_speed_duplex(bond)) {
2730 slave->link = BOND_LINK_DOWN;
2731 if (net_ratelimit())
2732 slave_warn(bond->dev, slave->dev,
2733 "failed to get link speed/duplex\n");
2734 continue;
2735 }
2736 bond_set_slave_link_state(slave, BOND_LINK_UP,
2737 BOND_SLAVE_NOTIFY_NOW);
2738 slave->last_link_up = jiffies;
2739
2740 primary = rtnl_dereference(bond->primary_slave);
2741 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
2742 /* prevent it from being the active one */
2743 bond_set_backup_slave(slave);
2744 } else if (BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
2745 /* make it immediately active */
2746 bond_set_active_slave(slave);
2747 }
2748
2749 slave_info(bond->dev, slave->dev, "link status definitely up, %u Mbps %s duplex\n",
2750 slave->speed == SPEED_UNKNOWN ? 0 : slave->speed,
2751 slave->duplex ? "full" : "half");
2752
2753 bond_miimon_link_change(bond, slave, BOND_LINK_UP);
2754
2755 active = rtnl_dereference(bond->curr_active_slave);
2756 if (!active || slave == primary || slave->prio > active->prio)
2757 do_failover = true;
2758
2759 continue;
2760
2761 case BOND_LINK_DOWN:
2762 if (slave->link_failure_count < UINT_MAX)
2763 slave->link_failure_count++;
2764
2765 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
2766 BOND_SLAVE_NOTIFY_NOW);
2767
2768 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP ||
2769 BOND_MODE(bond) == BOND_MODE_8023AD)
2770 bond_set_slave_inactive_flags(slave,
2771 BOND_SLAVE_NOTIFY_NOW);
2772
2773 slave_info(bond->dev, slave->dev, "link status definitely down, disabling slave\n");
2774
2775 bond_miimon_link_change(bond, slave, BOND_LINK_DOWN);
2776
2777 if (slave == rcu_access_pointer(bond->curr_active_slave))
2778 do_failover = true;
2779
2780 continue;
2781
2782 default:
2783 slave_err(bond->dev, slave->dev, "invalid new link %d on slave\n",
2784 slave->link_new_state);
2785 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
2786
2787 continue;
2788 }
2789 }
2790
2791 if (do_failover) {
2792 block_netpoll_tx();
2793 bond_select_active_slave(bond);
2794 unblock_netpoll_tx();
2795 }
2796
2797 bond_set_carrier(bond);
2798}
2799
2800/* bond_mii_monitor
2801 *
2802 * Really a wrapper that splits the mii monitor into two phases: an
2803 * inspection, then (if inspection indicates something needs to be done)
2804 * an acquisition of appropriate locks followed by a commit phase to
2805 * implement whatever link state changes are indicated.
2806 */
2807static void bond_mii_monitor(struct work_struct *work)
2808{
2809 struct bonding *bond = container_of(work, struct bonding,
2810 mii_work.work);
2811 bool should_notify_peers = false;
2812 bool commit;
2813 unsigned long delay;
2814 struct slave *slave;
2815 struct list_head *iter;
2816
2817 delay = msecs_to_jiffies(bond->params.miimon);
2818
2819 if (!bond_has_slaves(bond))
2820 goto re_arm;
2821
2822 rcu_read_lock();
2823 should_notify_peers = bond_should_notify_peers(bond);
2824 commit = !!bond_miimon_inspect(bond);
2825 if (bond->send_peer_notif) {
2826 rcu_read_unlock();
2827 if (rtnl_trylock()) {
2828 bond->send_peer_notif--;
2829 rtnl_unlock();
2830 }
2831 } else {
2832 rcu_read_unlock();
2833 }
2834
2835 if (commit) {
2836 /* Race avoidance with bond_close cancel of workqueue */
2837 if (!rtnl_trylock()) {
2838 delay = 1;
2839 should_notify_peers = false;
2840 goto re_arm;
2841 }
2842
2843 bond_for_each_slave(bond, slave, iter) {
2844 bond_commit_link_state(slave, BOND_SLAVE_NOTIFY_LATER);
2845 }
2846 bond_miimon_commit(bond);
2847
2848 rtnl_unlock(); /* might sleep, hold no other locks */
2849 }
2850
2851re_arm:
2852 if (bond->params.miimon)
2853 queue_delayed_work(bond->wq, &bond->mii_work, delay);
2854
2855 if (should_notify_peers) {
2856 if (!rtnl_trylock())
2857 return;
2858 call_netdevice_notifiers(NETDEV_NOTIFY_PEERS, bond->dev);
2859 rtnl_unlock();
2860 }
2861}
2862
2863static int bond_upper_dev_walk(struct net_device *upper,
2864 struct netdev_nested_priv *priv)
2865{
2866 __be32 ip = *(__be32 *)priv->data;
2867
2868 return ip == bond_confirm_addr(upper, 0, ip);
2869}
2870
2871static bool bond_has_this_ip(struct bonding *bond, __be32 ip)
2872{
2873 struct netdev_nested_priv priv = {
2874 .data = (void *)&ip,
2875 };
2876 bool ret = false;
2877
2878 if (ip == bond_confirm_addr(bond->dev, 0, ip))
2879 return true;
2880
2881 rcu_read_lock();
2882 if (netdev_walk_all_upper_dev_rcu(bond->dev, bond_upper_dev_walk, &priv))
2883 ret = true;
2884 rcu_read_unlock();
2885
2886 return ret;
2887}
2888
2889#define BOND_VLAN_PROTO_NONE cpu_to_be16(0xffff)
2890
2891static bool bond_handle_vlan(struct slave *slave, struct bond_vlan_tag *tags,
2892 struct sk_buff *skb)
2893{
2894 struct net_device *bond_dev = slave->bond->dev;
2895 struct net_device *slave_dev = slave->dev;
2896 struct bond_vlan_tag *outer_tag = tags;
2897
2898 if (!tags || tags->vlan_proto == BOND_VLAN_PROTO_NONE)
2899 return true;
2900
2901 tags++;
2902
2903 /* Go through all the tags backwards and add them to the packet */
2904 while (tags->vlan_proto != BOND_VLAN_PROTO_NONE) {
2905 if (!tags->vlan_id) {
2906 tags++;
2907 continue;
2908 }
2909
2910 slave_dbg(bond_dev, slave_dev, "inner tag: proto %X vid %X\n",
2911 ntohs(outer_tag->vlan_proto), tags->vlan_id);
2912 skb = vlan_insert_tag_set_proto(skb, tags->vlan_proto,
2913 tags->vlan_id);
2914 if (!skb) {
2915 net_err_ratelimited("failed to insert inner VLAN tag\n");
2916 return false;
2917 }
2918
2919 tags++;
2920 }
2921 /* Set the outer tag */
2922 if (outer_tag->vlan_id) {
2923 slave_dbg(bond_dev, slave_dev, "outer tag: proto %X vid %X\n",
2924 ntohs(outer_tag->vlan_proto), outer_tag->vlan_id);
2925 __vlan_hwaccel_put_tag(skb, outer_tag->vlan_proto,
2926 outer_tag->vlan_id);
2927 }
2928
2929 return true;
2930}
2931
2932/* We go to the (large) trouble of VLAN tagging ARP frames because
2933 * switches in VLAN mode (especially if ports are configured as
2934 * "native" to a VLAN) might not pass non-tagged frames.
2935 */
2936static void bond_arp_send(struct slave *slave, int arp_op, __be32 dest_ip,
2937 __be32 src_ip, struct bond_vlan_tag *tags)
2938{
2939 struct net_device *bond_dev = slave->bond->dev;
2940 struct net_device *slave_dev = slave->dev;
2941 struct sk_buff *skb;
2942
2943 slave_dbg(bond_dev, slave_dev, "arp %d on slave: dst %pI4 src %pI4\n",
2944 arp_op, &dest_ip, &src_ip);
2945
2946 skb = arp_create(arp_op, ETH_P_ARP, dest_ip, slave_dev, src_ip,
2947 NULL, slave_dev->dev_addr, NULL);
2948
2949 if (!skb) {
2950 net_err_ratelimited("ARP packet allocation failed\n");
2951 return;
2952 }
2953
2954 if (bond_handle_vlan(slave, tags, skb)) {
2955 slave_update_last_tx(slave);
2956 arp_xmit(skb);
2957 }
2958
2959 return;
2960}
2961
2962/* Validate the device path between the @start_dev and the @end_dev.
2963 * The path is valid if the @end_dev is reachable through device
2964 * stacking.
2965 * When the path is validated, collect any vlan information in the
2966 * path.
2967 */
2968struct bond_vlan_tag *bond_verify_device_path(struct net_device *start_dev,
2969 struct net_device *end_dev,
2970 int level)
2971{
2972 struct bond_vlan_tag *tags;
2973 struct net_device *upper;
2974 struct list_head *iter;
2975
2976 if (start_dev == end_dev) {
2977 tags = kcalloc(level + 1, sizeof(*tags), GFP_ATOMIC);
2978 if (!tags)
2979 return ERR_PTR(-ENOMEM);
2980 tags[level].vlan_proto = BOND_VLAN_PROTO_NONE;
2981 return tags;
2982 }
2983
2984 netdev_for_each_upper_dev_rcu(start_dev, upper, iter) {
2985 tags = bond_verify_device_path(upper, end_dev, level + 1);
2986 if (IS_ERR_OR_NULL(tags)) {
2987 if (IS_ERR(tags))
2988 return tags;
2989 continue;
2990 }
2991 if (is_vlan_dev(upper)) {
2992 tags[level].vlan_proto = vlan_dev_vlan_proto(upper);
2993 tags[level].vlan_id = vlan_dev_vlan_id(upper);
2994 }
2995
2996 return tags;
2997 }
2998
2999 return NULL;
3000}
3001
3002static void bond_arp_send_all(struct bonding *bond, struct slave *slave)
3003{
3004 struct rtable *rt;
3005 struct bond_vlan_tag *tags;
3006 __be32 *targets = bond->params.arp_targets, addr;
3007 int i;
3008
3009 for (i = 0; i < BOND_MAX_ARP_TARGETS && targets[i]; i++) {
3010 slave_dbg(bond->dev, slave->dev, "%s: target %pI4\n",
3011 __func__, &targets[i]);
3012 tags = NULL;
3013
3014 /* Find out through which dev should the packet go */
3015 rt = ip_route_output(dev_net(bond->dev), targets[i], 0,
3016 RTO_ONLINK, 0);
3017 if (IS_ERR(rt)) {
3018 /* there's no route to target - try to send arp
3019 * probe to generate any traffic (arp_validate=0)
3020 */
3021 if (bond->params.arp_validate)
3022 pr_warn_once("%s: no route to arp_ip_target %pI4 and arp_validate is set\n",
3023 bond->dev->name,
3024 &targets[i]);
3025 bond_arp_send(slave, ARPOP_REQUEST, targets[i],
3026 0, tags);
3027 continue;
3028 }
3029
3030 /* bond device itself */
3031 if (rt->dst.dev == bond->dev)
3032 goto found;
3033
3034 rcu_read_lock();
3035 tags = bond_verify_device_path(bond->dev, rt->dst.dev, 0);
3036 rcu_read_unlock();
3037
3038 if (!IS_ERR_OR_NULL(tags))
3039 goto found;
3040
3041 /* Not our device - skip */
3042 slave_dbg(bond->dev, slave->dev, "no path to arp_ip_target %pI4 via rt.dev %s\n",
3043 &targets[i], rt->dst.dev ? rt->dst.dev->name : "NULL");
3044
3045 ip_rt_put(rt);
3046 continue;
3047
3048found:
3049 addr = bond_confirm_addr(rt->dst.dev, targets[i], 0);
3050 ip_rt_put(rt);
3051 bond_arp_send(slave, ARPOP_REQUEST, targets[i], addr, tags);
3052 kfree(tags);
3053 }
3054}
3055
3056static void bond_validate_arp(struct bonding *bond, struct slave *slave, __be32 sip, __be32 tip)
3057{
3058 int i;
3059
3060 if (!sip || !bond_has_this_ip(bond, tip)) {
3061 slave_dbg(bond->dev, slave->dev, "%s: sip %pI4 tip %pI4 not found\n",
3062 __func__, &sip, &tip);
3063 return;
3064 }
3065
3066 i = bond_get_targets_ip(bond->params.arp_targets, sip);
3067 if (i == -1) {
3068 slave_dbg(bond->dev, slave->dev, "%s: sip %pI4 not found in targets\n",
3069 __func__, &sip);
3070 return;
3071 }
3072 slave->last_rx = jiffies;
3073 slave->target_last_arp_rx[i] = jiffies;
3074}
3075
3076static int bond_arp_rcv(const struct sk_buff *skb, struct bonding *bond,
3077 struct slave *slave)
3078{
3079 struct arphdr *arp = (struct arphdr *)skb->data;
3080 struct slave *curr_active_slave, *curr_arp_slave;
3081 unsigned char *arp_ptr;
3082 __be32 sip, tip;
3083 unsigned int alen;
3084
3085 alen = arp_hdr_len(bond->dev);
3086
3087 if (alen > skb_headlen(skb)) {
3088 arp = kmalloc(alen, GFP_ATOMIC);
3089 if (!arp)
3090 goto out_unlock;
3091 if (skb_copy_bits(skb, 0, arp, alen) < 0)
3092 goto out_unlock;
3093 }
3094
3095 if (arp->ar_hln != bond->dev->addr_len ||
3096 skb->pkt_type == PACKET_OTHERHOST ||
3097 skb->pkt_type == PACKET_LOOPBACK ||
3098 arp->ar_hrd != htons(ARPHRD_ETHER) ||
3099 arp->ar_pro != htons(ETH_P_IP) ||
3100 arp->ar_pln != 4)
3101 goto out_unlock;
3102
3103 arp_ptr = (unsigned char *)(arp + 1);
3104 arp_ptr += bond->dev->addr_len;
3105 memcpy(&sip, arp_ptr, 4);
3106 arp_ptr += 4 + bond->dev->addr_len;
3107 memcpy(&tip, arp_ptr, 4);
3108
3109 slave_dbg(bond->dev, slave->dev, "%s: %s/%d av %d sv %d sip %pI4 tip %pI4\n",
3110 __func__, slave->dev->name, bond_slave_state(slave),
3111 bond->params.arp_validate, slave_do_arp_validate(bond, slave),
3112 &sip, &tip);
3113
3114 curr_active_slave = rcu_dereference(bond->curr_active_slave);
3115 curr_arp_slave = rcu_dereference(bond->current_arp_slave);
3116
3117 /* We 'trust' the received ARP enough to validate it if:
3118 *
3119 * (a) the slave receiving the ARP is active (which includes the
3120 * current ARP slave, if any), or
3121 *
3122 * (b) the receiving slave isn't active, but there is a currently
3123 * active slave and it received valid arp reply(s) after it became
3124 * the currently active slave, or
3125 *
3126 * (c) there is an ARP slave that sent an ARP during the prior ARP
3127 * interval, and we receive an ARP reply on any slave. We accept
3128 * these because switch FDB update delays may deliver the ARP
3129 * reply to a slave other than the sender of the ARP request.
3130 *
3131 * Note: for (b), backup slaves are receiving the broadcast ARP
3132 * request, not a reply. This request passes from the sending
3133 * slave through the L2 switch(es) to the receiving slave. Since
3134 * this is checking the request, sip/tip are swapped for
3135 * validation.
3136 *
3137 * This is done to avoid endless looping when we can't reach the
3138 * arp_ip_target and fool ourselves with our own arp requests.
3139 */
3140 if (bond_is_active_slave(slave))
3141 bond_validate_arp(bond, slave, sip, tip);
3142 else if (curr_active_slave &&
3143 time_after(slave_last_rx(bond, curr_active_slave),
3144 curr_active_slave->last_link_up))
3145 bond_validate_arp(bond, slave, tip, sip);
3146 else if (curr_arp_slave && (arp->ar_op == htons(ARPOP_REPLY)) &&
3147 bond_time_in_interval(bond, slave_last_tx(curr_arp_slave), 1))
3148 bond_validate_arp(bond, slave, sip, tip);
3149
3150out_unlock:
3151 if (arp != (struct arphdr *)skb->data)
3152 kfree(arp);
3153 return RX_HANDLER_ANOTHER;
3154}
3155
3156#if IS_ENABLED(CONFIG_IPV6)
3157static void bond_ns_send(struct slave *slave, const struct in6_addr *daddr,
3158 const struct in6_addr *saddr, struct bond_vlan_tag *tags)
3159{
3160 struct net_device *bond_dev = slave->bond->dev;
3161 struct net_device *slave_dev = slave->dev;
3162 struct in6_addr mcaddr;
3163 struct sk_buff *skb;
3164
3165 slave_dbg(bond_dev, slave_dev, "NS on slave: dst %pI6c src %pI6c\n",
3166 daddr, saddr);
3167
3168 skb = ndisc_ns_create(slave_dev, daddr, saddr, 0);
3169 if (!skb) {
3170 net_err_ratelimited("NS packet allocation failed\n");
3171 return;
3172 }
3173
3174 addrconf_addr_solict_mult(daddr, &mcaddr);
3175 if (bond_handle_vlan(slave, tags, skb)) {
3176 slave_update_last_tx(slave);
3177 ndisc_send_skb(skb, &mcaddr, saddr);
3178 }
3179}
3180
3181static void bond_ns_send_all(struct bonding *bond, struct slave *slave)
3182{
3183 struct in6_addr *targets = bond->params.ns_targets;
3184 struct bond_vlan_tag *tags;
3185 struct dst_entry *dst;
3186 struct in6_addr saddr;
3187 struct flowi6 fl6;
3188 int i;
3189
3190 for (i = 0; i < BOND_MAX_NS_TARGETS && !ipv6_addr_any(&targets[i]); i++) {
3191 slave_dbg(bond->dev, slave->dev, "%s: target %pI6c\n",
3192 __func__, &targets[i]);
3193 tags = NULL;
3194
3195 /* Find out through which dev should the packet go */
3196 memset(&fl6, 0, sizeof(struct flowi6));
3197 fl6.daddr = targets[i];
3198 fl6.flowi6_oif = bond->dev->ifindex;
3199
3200 dst = ip6_route_output(dev_net(bond->dev), NULL, &fl6);
3201 if (dst->error) {
3202 dst_release(dst);
3203 /* there's no route to target - try to send arp
3204 * probe to generate any traffic (arp_validate=0)
3205 */
3206 if (bond->params.arp_validate)
3207 pr_warn_once("%s: no route to ns_ip6_target %pI6c and arp_validate is set\n",
3208 bond->dev->name,
3209 &targets[i]);
3210 bond_ns_send(slave, &targets[i], &in6addr_any, tags);
3211 continue;
3212 }
3213
3214 /* bond device itself */
3215 if (dst->dev == bond->dev)
3216 goto found;
3217
3218 rcu_read_lock();
3219 tags = bond_verify_device_path(bond->dev, dst->dev, 0);
3220 rcu_read_unlock();
3221
3222 if (!IS_ERR_OR_NULL(tags))
3223 goto found;
3224
3225 /* Not our device - skip */
3226 slave_dbg(bond->dev, slave->dev, "no path to ns_ip6_target %pI6c via dst->dev %s\n",
3227 &targets[i], dst->dev ? dst->dev->name : "NULL");
3228
3229 dst_release(dst);
3230 continue;
3231
3232found:
3233 if (!ipv6_dev_get_saddr(dev_net(dst->dev), dst->dev, &targets[i], 0, &saddr))
3234 bond_ns_send(slave, &targets[i], &saddr, tags);
3235 else
3236 bond_ns_send(slave, &targets[i], &in6addr_any, tags);
3237
3238 dst_release(dst);
3239 kfree(tags);
3240 }
3241}
3242
3243static int bond_confirm_addr6(struct net_device *dev,
3244 struct netdev_nested_priv *priv)
3245{
3246 struct in6_addr *addr = (struct in6_addr *)priv->data;
3247
3248 return ipv6_chk_addr(dev_net(dev), addr, dev, 0);
3249}
3250
3251static bool bond_has_this_ip6(struct bonding *bond, struct in6_addr *addr)
3252{
3253 struct netdev_nested_priv priv = {
3254 .data = addr,
3255 };
3256 int ret = false;
3257
3258 if (bond_confirm_addr6(bond->dev, &priv))
3259 return true;
3260
3261 rcu_read_lock();
3262 if (netdev_walk_all_upper_dev_rcu(bond->dev, bond_confirm_addr6, &priv))
3263 ret = true;
3264 rcu_read_unlock();
3265
3266 return ret;
3267}
3268
3269static void bond_validate_na(struct bonding *bond, struct slave *slave,
3270 struct in6_addr *saddr, struct in6_addr *daddr)
3271{
3272 int i;
3273
3274 /* Ignore NAs that:
3275 * 1. Source address is unspecified address.
3276 * 2. Dest address is neither all-nodes multicast address nor
3277 * exist on bond interface.
3278 */
3279 if (ipv6_addr_any(saddr) ||
3280 (!ipv6_addr_equal(daddr, &in6addr_linklocal_allnodes) &&
3281 !bond_has_this_ip6(bond, daddr))) {
3282 slave_dbg(bond->dev, slave->dev, "%s: sip %pI6c tip %pI6c not found\n",
3283 __func__, saddr, daddr);
3284 return;
3285 }
3286
3287 i = bond_get_targets_ip6(bond->params.ns_targets, saddr);
3288 if (i == -1) {
3289 slave_dbg(bond->dev, slave->dev, "%s: sip %pI6c not found in targets\n",
3290 __func__, saddr);
3291 return;
3292 }
3293 slave->last_rx = jiffies;
3294 slave->target_last_arp_rx[i] = jiffies;
3295}
3296
3297static int bond_na_rcv(const struct sk_buff *skb, struct bonding *bond,
3298 struct slave *slave)
3299{
3300 struct slave *curr_active_slave, *curr_arp_slave;
3301 struct in6_addr *saddr, *daddr;
3302 struct {
3303 struct ipv6hdr ip6;
3304 struct icmp6hdr icmp6;
3305 } *combined, _combined;
3306
3307 if (skb->pkt_type == PACKET_OTHERHOST ||
3308 skb->pkt_type == PACKET_LOOPBACK)
3309 goto out;
3310
3311 combined = skb_header_pointer(skb, 0, sizeof(_combined), &_combined);
3312 if (!combined || combined->ip6.nexthdr != NEXTHDR_ICMP ||
3313 (combined->icmp6.icmp6_type != NDISC_NEIGHBOUR_SOLICITATION &&
3314 combined->icmp6.icmp6_type != NDISC_NEIGHBOUR_ADVERTISEMENT))
3315 goto out;
3316
3317 saddr = &combined->ip6.saddr;
3318 daddr = &combined->ip6.daddr;
3319
3320 slave_dbg(bond->dev, slave->dev, "%s: %s/%d av %d sv %d sip %pI6c tip %pI6c\n",
3321 __func__, slave->dev->name, bond_slave_state(slave),
3322 bond->params.arp_validate, slave_do_arp_validate(bond, slave),
3323 saddr, daddr);
3324
3325 curr_active_slave = rcu_dereference(bond->curr_active_slave);
3326 curr_arp_slave = rcu_dereference(bond->current_arp_slave);
3327
3328 /* We 'trust' the received ARP enough to validate it if:
3329 * see bond_arp_rcv().
3330 */
3331 if (bond_is_active_slave(slave))
3332 bond_validate_na(bond, slave, saddr, daddr);
3333 else if (curr_active_slave &&
3334 time_after(slave_last_rx(bond, curr_active_slave),
3335 curr_active_slave->last_link_up))
3336 bond_validate_na(bond, slave, daddr, saddr);
3337 else if (curr_arp_slave &&
3338 bond_time_in_interval(bond, slave_last_tx(curr_arp_slave), 1))
3339 bond_validate_na(bond, slave, saddr, daddr);
3340
3341out:
3342 return RX_HANDLER_ANOTHER;
3343}
3344#endif
3345
3346int bond_rcv_validate(const struct sk_buff *skb, struct bonding *bond,
3347 struct slave *slave)
3348{
3349#if IS_ENABLED(CONFIG_IPV6)
3350 bool is_ipv6 = skb->protocol == __cpu_to_be16(ETH_P_IPV6);
3351#endif
3352 bool is_arp = skb->protocol == __cpu_to_be16(ETH_P_ARP);
3353
3354 slave_dbg(bond->dev, slave->dev, "%s: skb->dev %s\n",
3355 __func__, skb->dev->name);
3356
3357 /* Use arp validate logic for both ARP and NS */
3358 if (!slave_do_arp_validate(bond, slave)) {
3359 if ((slave_do_arp_validate_only(bond) && is_arp) ||
3360#if IS_ENABLED(CONFIG_IPV6)
3361 (slave_do_arp_validate_only(bond) && is_ipv6) ||
3362#endif
3363 !slave_do_arp_validate_only(bond))
3364 slave->last_rx = jiffies;
3365 return RX_HANDLER_ANOTHER;
3366 } else if (is_arp) {
3367 return bond_arp_rcv(skb, bond, slave);
3368#if IS_ENABLED(CONFIG_IPV6)
3369 } else if (is_ipv6) {
3370 return bond_na_rcv(skb, bond, slave);
3371#endif
3372 } else {
3373 return RX_HANDLER_ANOTHER;
3374 }
3375}
3376
3377static void bond_send_validate(struct bonding *bond, struct slave *slave)
3378{
3379 bond_arp_send_all(bond, slave);
3380#if IS_ENABLED(CONFIG_IPV6)
3381 bond_ns_send_all(bond, slave);
3382#endif
3383}
3384
3385/* function to verify if we're in the arp_interval timeslice, returns true if
3386 * (last_act - arp_interval) <= jiffies <= (last_act + mod * arp_interval +
3387 * arp_interval/2) . the arp_interval/2 is needed for really fast networks.
3388 */
3389static bool bond_time_in_interval(struct bonding *bond, unsigned long last_act,
3390 int mod)
3391{
3392 int delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
3393
3394 return time_in_range(jiffies,
3395 last_act - delta_in_ticks,
3396 last_act + mod * delta_in_ticks + delta_in_ticks/2);
3397}
3398
3399/* This function is called regularly to monitor each slave's link
3400 * ensuring that traffic is being sent and received when arp monitoring
3401 * is used in load-balancing mode. if the adapter has been dormant, then an
3402 * arp is transmitted to generate traffic. see activebackup_arp_monitor for
3403 * arp monitoring in active backup mode.
3404 */
3405static void bond_loadbalance_arp_mon(struct bonding *bond)
3406{
3407 struct slave *slave, *oldcurrent;
3408 struct list_head *iter;
3409 int do_failover = 0, slave_state_changed = 0;
3410
3411 if (!bond_has_slaves(bond))
3412 goto re_arm;
3413
3414 rcu_read_lock();
3415
3416 oldcurrent = rcu_dereference(bond->curr_active_slave);
3417 /* see if any of the previous devices are up now (i.e. they have
3418 * xmt and rcv traffic). the curr_active_slave does not come into
3419 * the picture unless it is null. also, slave->last_link_up is not
3420 * needed here because we send an arp on each slave and give a slave
3421 * as long as it needs to get the tx/rx within the delta.
3422 * TODO: what about up/down delay in arp mode? it wasn't here before
3423 * so it can wait
3424 */
3425 bond_for_each_slave_rcu(bond, slave, iter) {
3426 unsigned long last_tx = slave_last_tx(slave);
3427
3428 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
3429
3430 if (slave->link != BOND_LINK_UP) {
3431 if (bond_time_in_interval(bond, last_tx, 1) &&
3432 bond_time_in_interval(bond, slave->last_rx, 1)) {
3433
3434 bond_propose_link_state(slave, BOND_LINK_UP);
3435 slave_state_changed = 1;
3436
3437 /* primary_slave has no meaning in round-robin
3438 * mode. the window of a slave being up and
3439 * curr_active_slave being null after enslaving
3440 * is closed.
3441 */
3442 if (!oldcurrent) {
3443 slave_info(bond->dev, slave->dev, "link status definitely up\n");
3444 do_failover = 1;
3445 } else {
3446 slave_info(bond->dev, slave->dev, "interface is now up\n");
3447 }
3448 }
3449 } else {
3450 /* slave->link == BOND_LINK_UP */
3451
3452 /* not all switches will respond to an arp request
3453 * when the source ip is 0, so don't take the link down
3454 * if we don't know our ip yet
3455 */
3456 if (!bond_time_in_interval(bond, last_tx, bond->params.missed_max) ||
3457 !bond_time_in_interval(bond, slave->last_rx, bond->params.missed_max)) {
3458
3459 bond_propose_link_state(slave, BOND_LINK_DOWN);
3460 slave_state_changed = 1;
3461
3462 if (slave->link_failure_count < UINT_MAX)
3463 slave->link_failure_count++;
3464
3465 slave_info(bond->dev, slave->dev, "interface is now down\n");
3466
3467 if (slave == oldcurrent)
3468 do_failover = 1;
3469 }
3470 }
3471
3472 /* note: if switch is in round-robin mode, all links
3473 * must tx arp to ensure all links rx an arp - otherwise
3474 * links may oscillate or not come up at all; if switch is
3475 * in something like xor mode, there is nothing we can
3476 * do - all replies will be rx'ed on same link causing slaves
3477 * to be unstable during low/no traffic periods
3478 */
3479 if (bond_slave_is_up(slave))
3480 bond_send_validate(bond, slave);
3481 }
3482
3483 rcu_read_unlock();
3484
3485 if (do_failover || slave_state_changed) {
3486 if (!rtnl_trylock())
3487 goto re_arm;
3488
3489 bond_for_each_slave(bond, slave, iter) {
3490 if (slave->link_new_state != BOND_LINK_NOCHANGE)
3491 slave->link = slave->link_new_state;
3492 }
3493
3494 if (slave_state_changed) {
3495 bond_slave_state_change(bond);
3496 if (BOND_MODE(bond) == BOND_MODE_XOR)
3497 bond_update_slave_arr(bond, NULL);
3498 }
3499 if (do_failover) {
3500 block_netpoll_tx();
3501 bond_select_active_slave(bond);
3502 unblock_netpoll_tx();
3503 }
3504 rtnl_unlock();
3505 }
3506
3507re_arm:
3508 if (bond->params.arp_interval)
3509 queue_delayed_work(bond->wq, &bond->arp_work,
3510 msecs_to_jiffies(bond->params.arp_interval));
3511}
3512
3513/* Called to inspect slaves for active-backup mode ARP monitor link state
3514 * changes. Sets proposed link state in slaves to specify what action
3515 * should take place for the slave. Returns 0 if no changes are found, >0
3516 * if changes to link states must be committed.
3517 *
3518 * Called with rcu_read_lock held.
3519 */
3520static int bond_ab_arp_inspect(struct bonding *bond)
3521{
3522 unsigned long last_tx, last_rx;
3523 struct list_head *iter;
3524 struct slave *slave;
3525 int commit = 0;
3526
3527 bond_for_each_slave_rcu(bond, slave, iter) {
3528 bond_propose_link_state(slave, BOND_LINK_NOCHANGE);
3529 last_rx = slave_last_rx(bond, slave);
3530
3531 if (slave->link != BOND_LINK_UP) {
3532 if (bond_time_in_interval(bond, last_rx, 1)) {
3533 bond_propose_link_state(slave, BOND_LINK_UP);
3534 commit++;
3535 } else if (slave->link == BOND_LINK_BACK) {
3536 bond_propose_link_state(slave, BOND_LINK_FAIL);
3537 commit++;
3538 }
3539 continue;
3540 }
3541
3542 /* Give slaves 2*delta after being enslaved or made
3543 * active. This avoids bouncing, as the last receive
3544 * times need a full ARP monitor cycle to be updated.
3545 */
3546 if (bond_time_in_interval(bond, slave->last_link_up, 2))
3547 continue;
3548
3549 /* Backup slave is down if:
3550 * - No current_arp_slave AND
3551 * - more than (missed_max+1)*delta since last receive AND
3552 * - the bond has an IP address
3553 *
3554 * Note: a non-null current_arp_slave indicates
3555 * the curr_active_slave went down and we are
3556 * searching for a new one; under this condition
3557 * we only take the curr_active_slave down - this
3558 * gives each slave a chance to tx/rx traffic
3559 * before being taken out
3560 */
3561 if (!bond_is_active_slave(slave) &&
3562 !rcu_access_pointer(bond->current_arp_slave) &&
3563 !bond_time_in_interval(bond, last_rx, bond->params.missed_max + 1)) {
3564 bond_propose_link_state(slave, BOND_LINK_DOWN);
3565 commit++;
3566 }
3567
3568 /* Active slave is down if:
3569 * - more than missed_max*delta since transmitting OR
3570 * - (more than missed_max*delta since receive AND
3571 * the bond has an IP address)
3572 */
3573 last_tx = slave_last_tx(slave);
3574 if (bond_is_active_slave(slave) &&
3575 (!bond_time_in_interval(bond, last_tx, bond->params.missed_max) ||
3576 !bond_time_in_interval(bond, last_rx, bond->params.missed_max))) {
3577 bond_propose_link_state(slave, BOND_LINK_DOWN);
3578 commit++;
3579 }
3580 }
3581
3582 return commit;
3583}
3584
3585/* Called to commit link state changes noted by inspection step of
3586 * active-backup mode ARP monitor.
3587 *
3588 * Called with RTNL hold.
3589 */
3590static void bond_ab_arp_commit(struct bonding *bond)
3591{
3592 bool do_failover = false;
3593 struct list_head *iter;
3594 unsigned long last_tx;
3595 struct slave *slave;
3596
3597 bond_for_each_slave(bond, slave, iter) {
3598 switch (slave->link_new_state) {
3599 case BOND_LINK_NOCHANGE:
3600 continue;
3601
3602 case BOND_LINK_UP:
3603 last_tx = slave_last_tx(slave);
3604 if (rtnl_dereference(bond->curr_active_slave) != slave ||
3605 (!rtnl_dereference(bond->curr_active_slave) &&
3606 bond_time_in_interval(bond, last_tx, 1))) {
3607 struct slave *current_arp_slave;
3608
3609 current_arp_slave = rtnl_dereference(bond->current_arp_slave);
3610 bond_set_slave_link_state(slave, BOND_LINK_UP,
3611 BOND_SLAVE_NOTIFY_NOW);
3612 if (current_arp_slave) {
3613 bond_set_slave_inactive_flags(
3614 current_arp_slave,
3615 BOND_SLAVE_NOTIFY_NOW);
3616 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3617 }
3618
3619 slave_info(bond->dev, slave->dev, "link status definitely up\n");
3620
3621 if (!rtnl_dereference(bond->curr_active_slave) ||
3622 slave == rtnl_dereference(bond->primary_slave) ||
3623 slave->prio > rtnl_dereference(bond->curr_active_slave)->prio)
3624 do_failover = true;
3625
3626 }
3627
3628 continue;
3629
3630 case BOND_LINK_DOWN:
3631 if (slave->link_failure_count < UINT_MAX)
3632 slave->link_failure_count++;
3633
3634 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
3635 BOND_SLAVE_NOTIFY_NOW);
3636 bond_set_slave_inactive_flags(slave,
3637 BOND_SLAVE_NOTIFY_NOW);
3638
3639 slave_info(bond->dev, slave->dev, "link status definitely down, disabling slave\n");
3640
3641 if (slave == rtnl_dereference(bond->curr_active_slave)) {
3642 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3643 do_failover = true;
3644 }
3645
3646 continue;
3647
3648 case BOND_LINK_FAIL:
3649 bond_set_slave_link_state(slave, BOND_LINK_FAIL,
3650 BOND_SLAVE_NOTIFY_NOW);
3651 bond_set_slave_inactive_flags(slave,
3652 BOND_SLAVE_NOTIFY_NOW);
3653
3654 /* A slave has just been enslaved and has become
3655 * the current active slave.
3656 */
3657 if (rtnl_dereference(bond->curr_active_slave))
3658 RCU_INIT_POINTER(bond->current_arp_slave, NULL);
3659 continue;
3660
3661 default:
3662 slave_err(bond->dev, slave->dev,
3663 "impossible: link_new_state %d on slave\n",
3664 slave->link_new_state);
3665 continue;
3666 }
3667 }
3668
3669 if (do_failover) {
3670 block_netpoll_tx();
3671 bond_select_active_slave(bond);
3672 unblock_netpoll_tx();
3673 }
3674
3675 bond_set_carrier(bond);
3676}
3677
3678/* Send ARP probes for active-backup mode ARP monitor.
3679 *
3680 * Called with rcu_read_lock held.
3681 */
3682static bool bond_ab_arp_probe(struct bonding *bond)
3683{
3684 struct slave *slave, *before = NULL, *new_slave = NULL,
3685 *curr_arp_slave = rcu_dereference(bond->current_arp_slave),
3686 *curr_active_slave = rcu_dereference(bond->curr_active_slave);
3687 struct list_head *iter;
3688 bool found = false;
3689 bool should_notify_rtnl = BOND_SLAVE_NOTIFY_LATER;
3690
3691 if (curr_arp_slave && curr_active_slave)
3692 netdev_info(bond->dev, "PROBE: c_arp %s && cas %s BAD\n",
3693 curr_arp_slave->dev->name,
3694 curr_active_slave->dev->name);
3695
3696 if (curr_active_slave) {
3697 bond_send_validate(bond, curr_active_slave);
3698 return should_notify_rtnl;
3699 }
3700
3701 /* if we don't have a curr_active_slave, search for the next available
3702 * backup slave from the current_arp_slave and make it the candidate
3703 * for becoming the curr_active_slave
3704 */
3705
3706 if (!curr_arp_slave) {
3707 curr_arp_slave = bond_first_slave_rcu(bond);
3708 if (!curr_arp_slave)
3709 return should_notify_rtnl;
3710 }
3711
3712 bond_for_each_slave_rcu(bond, slave, iter) {
3713 if (!found && !before && bond_slave_is_up(slave))
3714 before = slave;
3715
3716 if (found && !new_slave && bond_slave_is_up(slave))
3717 new_slave = slave;
3718 /* if the link state is up at this point, we
3719 * mark it down - this can happen if we have
3720 * simultaneous link failures and
3721 * reselect_active_interface doesn't make this
3722 * one the current slave so it is still marked
3723 * up when it is actually down
3724 */
3725 if (!bond_slave_is_up(slave) && slave->link == BOND_LINK_UP) {
3726 bond_set_slave_link_state(slave, BOND_LINK_DOWN,
3727 BOND_SLAVE_NOTIFY_LATER);
3728 if (slave->link_failure_count < UINT_MAX)
3729 slave->link_failure_count++;
3730
3731 bond_set_slave_inactive_flags(slave,
3732 BOND_SLAVE_NOTIFY_LATER);
3733
3734 slave_info(bond->dev, slave->dev, "backup interface is now down\n");
3735 }
3736 if (slave == curr_arp_slave)
3737 found = true;
3738 }
3739
3740 if (!new_slave && before)
3741 new_slave = before;
3742
3743 if (!new_slave)
3744 goto check_state;
3745
3746 bond_set_slave_link_state(new_slave, BOND_LINK_BACK,
3747 BOND_SLAVE_NOTIFY_LATER);
3748 bond_set_slave_active_flags(new_slave, BOND_SLAVE_NOTIFY_LATER);
3749 bond_send_validate(bond, new_slave);
3750 new_slave->last_link_up = jiffies;
3751 rcu_assign_pointer(bond->current_arp_slave, new_slave);
3752
3753check_state:
3754 bond_for_each_slave_rcu(bond, slave, iter) {
3755 if (slave->should_notify || slave->should_notify_link) {
3756 should_notify_rtnl = BOND_SLAVE_NOTIFY_NOW;
3757 break;
3758 }
3759 }
3760 return should_notify_rtnl;
3761}
3762
3763static void bond_activebackup_arp_mon(struct bonding *bond)
3764{
3765 bool should_notify_peers = false;
3766 bool should_notify_rtnl = false;
3767 int delta_in_ticks;
3768
3769 delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);
3770
3771 if (!bond_has_slaves(bond))
3772 goto re_arm;
3773
3774 rcu_read_lock();
3775
3776 should_notify_peers = bond_should_notify_peers(bond);
3777
3778 if (bond_ab_arp_inspect(bond)) {
3779 rcu_read_unlock();
3780
3781 /* Race avoidance with bond_close flush of workqueue */
3782 if (!rtnl_trylock()) {
3783 delta_in_ticks = 1;
3784 should_notify_peers = false;
3785 goto re_arm;
3786 }
3787
3788 bond_ab_arp_commit(bond);
3789
3790 rtnl_unlock();
3791 rcu_read_lock();
3792 }
3793
3794 should_notify_rtnl = bond_ab_arp_probe(bond);
3795 rcu_read_unlock();
3796
3797re_arm:
3798 if (bond->params.arp_interval)
3799 queue_delayed_work(bond->wq, &bond->arp_work, delta_in_ticks);
3800
3801 if (should_notify_peers || should_notify_rtnl) {
3802 if (!rtnl_trylock())
3803 return;
3804
3805 if (should_notify_peers) {
3806 bond->send_peer_notif--;
3807 call_netdevice_notifiers(NETDEV_NOTIFY_PEERS,
3808 bond->dev);
3809 }
3810 if (should_notify_rtnl) {
3811 bond_slave_state_notify(bond);
3812 bond_slave_link_notify(bond);
3813 }
3814
3815 rtnl_unlock();
3816 }
3817}
3818
3819static void bond_arp_monitor(struct work_struct *work)
3820{
3821 struct bonding *bond = container_of(work, struct bonding,
3822 arp_work.work);
3823
3824 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
3825 bond_activebackup_arp_mon(bond);
3826 else
3827 bond_loadbalance_arp_mon(bond);
3828}
3829
3830/*-------------------------- netdev event handling --------------------------*/
3831
3832/* Change device name */
3833static int bond_event_changename(struct bonding *bond)
3834{
3835 bond_remove_proc_entry(bond);
3836 bond_create_proc_entry(bond);
3837
3838 bond_debug_reregister(bond);
3839
3840 return NOTIFY_DONE;
3841}
3842
3843static int bond_master_netdev_event(unsigned long event,
3844 struct net_device *bond_dev)
3845{
3846 struct bonding *event_bond = netdev_priv(bond_dev);
3847
3848 netdev_dbg(bond_dev, "%s called\n", __func__);
3849
3850 switch (event) {
3851 case NETDEV_CHANGENAME:
3852 return bond_event_changename(event_bond);
3853 case NETDEV_UNREGISTER:
3854 bond_remove_proc_entry(event_bond);
3855#ifdef CONFIG_XFRM_OFFLOAD
3856 xfrm_dev_state_flush(dev_net(bond_dev), bond_dev, true);
3857#endif /* CONFIG_XFRM_OFFLOAD */
3858 break;
3859 case NETDEV_REGISTER:
3860 bond_create_proc_entry(event_bond);
3861 break;
3862 default:
3863 break;
3864 }
3865
3866 return NOTIFY_DONE;
3867}
3868
3869static int bond_slave_netdev_event(unsigned long event,
3870 struct net_device *slave_dev)
3871{
3872 struct slave *slave = bond_slave_get_rtnl(slave_dev), *primary;
3873 struct bonding *bond;
3874 struct net_device *bond_dev;
3875
3876 /* A netdev event can be generated while enslaving a device
3877 * before netdev_rx_handler_register is called in which case
3878 * slave will be NULL
3879 */
3880 if (!slave) {
3881 netdev_dbg(slave_dev, "%s called on NULL slave\n", __func__);
3882 return NOTIFY_DONE;
3883 }
3884
3885 bond_dev = slave->bond->dev;
3886 bond = slave->bond;
3887 primary = rtnl_dereference(bond->primary_slave);
3888
3889 slave_dbg(bond_dev, slave_dev, "%s called\n", __func__);
3890
3891 switch (event) {
3892 case NETDEV_UNREGISTER:
3893 if (bond_dev->type != ARPHRD_ETHER)
3894 bond_release_and_destroy(bond_dev, slave_dev);
3895 else
3896 __bond_release_one(bond_dev, slave_dev, false, true);
3897 break;
3898 case NETDEV_UP:
3899 case NETDEV_CHANGE:
3900 /* For 802.3ad mode only:
3901 * Getting invalid Speed/Duplex values here will put slave
3902 * in weird state. Mark it as link-fail if the link was
3903 * previously up or link-down if it hasn't yet come up, and
3904 * let link-monitoring (miimon) set it right when correct
3905 * speeds/duplex are available.
3906 */
3907 if (bond_update_speed_duplex(slave) &&
3908 BOND_MODE(bond) == BOND_MODE_8023AD) {
3909 if (slave->last_link_up)
3910 slave->link = BOND_LINK_FAIL;
3911 else
3912 slave->link = BOND_LINK_DOWN;
3913 }
3914
3915 if (BOND_MODE(bond) == BOND_MODE_8023AD)
3916 bond_3ad_adapter_speed_duplex_changed(slave);
3917 fallthrough;
3918 case NETDEV_DOWN:
3919 /* Refresh slave-array if applicable!
3920 * If the setup does not use miimon or arpmon (mode-specific!),
3921 * then these events will not cause the slave-array to be
3922 * refreshed. This will cause xmit to use a slave that is not
3923 * usable. Avoid such situation by refeshing the array at these
3924 * events. If these (miimon/arpmon) parameters are configured
3925 * then array gets refreshed twice and that should be fine!
3926 */
3927 if (bond_mode_can_use_xmit_hash(bond))
3928 bond_update_slave_arr(bond, NULL);
3929 break;
3930 case NETDEV_CHANGEMTU:
3931 /* TODO: Should slaves be allowed to
3932 * independently alter their MTU? For
3933 * an active-backup bond, slaves need
3934 * not be the same type of device, so
3935 * MTUs may vary. For other modes,
3936 * slaves arguably should have the
3937 * same MTUs. To do this, we'd need to
3938 * take over the slave's change_mtu
3939 * function for the duration of their
3940 * servitude.
3941 */
3942 break;
3943 case NETDEV_CHANGENAME:
3944 /* we don't care if we don't have primary set */
3945 if (!bond_uses_primary(bond) ||
3946 !bond->params.primary[0])
3947 break;
3948
3949 if (slave == primary) {
3950 /* slave's name changed - he's no longer primary */
3951 RCU_INIT_POINTER(bond->primary_slave, NULL);
3952 } else if (!strcmp(slave_dev->name, bond->params.primary)) {
3953 /* we have a new primary slave */
3954 rcu_assign_pointer(bond->primary_slave, slave);
3955 } else { /* we didn't change primary - exit */
3956 break;
3957 }
3958
3959 netdev_info(bond->dev, "Primary slave changed to %s, reselecting active slave\n",
3960 primary ? slave_dev->name : "none");
3961
3962 block_netpoll_tx();
3963 bond_select_active_slave(bond);
3964 unblock_netpoll_tx();
3965 break;
3966 case NETDEV_FEAT_CHANGE:
3967 if (!bond->notifier_ctx) {
3968 bond->notifier_ctx = true;
3969 bond_compute_features(bond);
3970 bond->notifier_ctx = false;
3971 }
3972 break;
3973 case NETDEV_RESEND_IGMP:
3974 /* Propagate to master device */
3975 call_netdevice_notifiers(event, slave->bond->dev);
3976 break;
3977 case NETDEV_XDP_FEAT_CHANGE:
3978 bond_xdp_set_features(bond_dev);
3979 break;
3980 default:
3981 break;
3982 }
3983
3984 return NOTIFY_DONE;
3985}
3986
3987/* bond_netdev_event: handle netdev notifier chain events.
3988 *
3989 * This function receives events for the netdev chain. The caller (an
3990 * ioctl handler calling blocking_notifier_call_chain) holds the necessary
3991 * locks for us to safely manipulate the slave devices (RTNL lock,
3992 * dev_probe_lock).
3993 */
3994static int bond_netdev_event(struct notifier_block *this,
3995 unsigned long event, void *ptr)
3996{
3997 struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
3998
3999 netdev_dbg(event_dev, "%s received %s\n",
4000 __func__, netdev_cmd_to_name(event));
4001
4002 if (!(event_dev->priv_flags & IFF_BONDING))
4003 return NOTIFY_DONE;
4004
4005 if (event_dev->flags & IFF_MASTER) {
4006 int ret;
4007
4008 ret = bond_master_netdev_event(event, event_dev);
4009 if (ret != NOTIFY_DONE)
4010 return ret;
4011 }
4012
4013 if (event_dev->flags & IFF_SLAVE)
4014 return bond_slave_netdev_event(event, event_dev);
4015
4016 return NOTIFY_DONE;
4017}
4018
4019static struct notifier_block bond_netdev_notifier = {
4020 .notifier_call = bond_netdev_event,
4021};
4022
4023/*---------------------------- Hashing Policies -----------------------------*/
4024
4025/* Helper to access data in a packet, with or without a backing skb.
4026 * If skb is given the data is linearized if necessary via pskb_may_pull.
4027 */
4028static inline const void *bond_pull_data(struct sk_buff *skb,
4029 const void *data, int hlen, int n)
4030{
4031 if (likely(n <= hlen))
4032 return data;
4033 else if (skb && likely(pskb_may_pull(skb, n)))
4034 return skb->data;
4035
4036 return NULL;
4037}
4038
4039/* L2 hash helper */
4040static inline u32 bond_eth_hash(struct sk_buff *skb, const void *data, int mhoff, int hlen)
4041{
4042 struct ethhdr *ep;
4043
4044 data = bond_pull_data(skb, data, hlen, mhoff + sizeof(struct ethhdr));
4045 if (!data)
4046 return 0;
4047
4048 ep = (struct ethhdr *)(data + mhoff);
4049 return ep->h_dest[5] ^ ep->h_source[5] ^ be16_to_cpu(ep->h_proto);
4050}
4051
4052static bool bond_flow_ip(struct sk_buff *skb, struct flow_keys *fk, const void *data,
4053 int hlen, __be16 l2_proto, int *nhoff, int *ip_proto, bool l34)
4054{
4055 const struct ipv6hdr *iph6;
4056 const struct iphdr *iph;
4057
4058 if (l2_proto == htons(ETH_P_IP)) {
4059 data = bond_pull_data(skb, data, hlen, *nhoff + sizeof(*iph));
4060 if (!data)
4061 return false;
4062
4063 iph = (const struct iphdr *)(data + *nhoff);
4064 iph_to_flow_copy_v4addrs(fk, iph);
4065 *nhoff += iph->ihl << 2;
4066 if (!ip_is_fragment(iph))
4067 *ip_proto = iph->protocol;
4068 } else if (l2_proto == htons(ETH_P_IPV6)) {
4069 data = bond_pull_data(skb, data, hlen, *nhoff + sizeof(*iph6));
4070 if (!data)
4071 return false;
4072
4073 iph6 = (const struct ipv6hdr *)(data + *nhoff);
4074 iph_to_flow_copy_v6addrs(fk, iph6);
4075 *nhoff += sizeof(*iph6);
4076 *ip_proto = iph6->nexthdr;
4077 } else {
4078 return false;
4079 }
4080
4081 if (l34 && *ip_proto >= 0)
4082 fk->ports.ports = __skb_flow_get_ports(skb, *nhoff, *ip_proto, data, hlen);
4083
4084 return true;
4085}
4086
4087static u32 bond_vlan_srcmac_hash(struct sk_buff *skb, const void *data, int mhoff, int hlen)
4088{
4089 u32 srcmac_vendor = 0, srcmac_dev = 0;
4090 struct ethhdr *mac_hdr;
4091 u16 vlan = 0;
4092 int i;
4093
4094 data = bond_pull_data(skb, data, hlen, mhoff + sizeof(struct ethhdr));
4095 if (!data)
4096 return 0;
4097 mac_hdr = (struct ethhdr *)(data + mhoff);
4098
4099 for (i = 0; i < 3; i++)
4100 srcmac_vendor = (srcmac_vendor << 8) | mac_hdr->h_source[i];
4101
4102 for (i = 3; i < ETH_ALEN; i++)
4103 srcmac_dev = (srcmac_dev << 8) | mac_hdr->h_source[i];
4104
4105 if (skb && skb_vlan_tag_present(skb))
4106 vlan = skb_vlan_tag_get(skb);
4107
4108 return vlan ^ srcmac_vendor ^ srcmac_dev;
4109}
4110
4111/* Extract the appropriate headers based on bond's xmit policy */
4112static bool bond_flow_dissect(struct bonding *bond, struct sk_buff *skb, const void *data,
4113 __be16 l2_proto, int nhoff, int hlen, struct flow_keys *fk)
4114{
4115 bool l34 = bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER34;
4116 int ip_proto = -1;
4117
4118 switch (bond->params.xmit_policy) {
4119 case BOND_XMIT_POLICY_ENCAP23:
4120 case BOND_XMIT_POLICY_ENCAP34:
4121 memset(fk, 0, sizeof(*fk));
4122 return __skb_flow_dissect(NULL, skb, &flow_keys_bonding,
4123 fk, data, l2_proto, nhoff, hlen, 0);
4124 default:
4125 break;
4126 }
4127
4128 fk->ports.ports = 0;
4129 memset(&fk->icmp, 0, sizeof(fk->icmp));
4130 if (!bond_flow_ip(skb, fk, data, hlen, l2_proto, &nhoff, &ip_proto, l34))
4131 return false;
4132
4133 /* ICMP error packets contains at least 8 bytes of the header
4134 * of the packet which generated the error. Use this information
4135 * to correlate ICMP error packets within the same flow which
4136 * generated the error.
4137 */
4138 if (ip_proto == IPPROTO_ICMP || ip_proto == IPPROTO_ICMPV6) {
4139 skb_flow_get_icmp_tci(skb, &fk->icmp, data, nhoff, hlen);
4140 if (ip_proto == IPPROTO_ICMP) {
4141 if (!icmp_is_err(fk->icmp.type))
4142 return true;
4143
4144 nhoff += sizeof(struct icmphdr);
4145 } else if (ip_proto == IPPROTO_ICMPV6) {
4146 if (!icmpv6_is_err(fk->icmp.type))
4147 return true;
4148
4149 nhoff += sizeof(struct icmp6hdr);
4150 }
4151 return bond_flow_ip(skb, fk, data, hlen, l2_proto, &nhoff, &ip_proto, l34);
4152 }
4153
4154 return true;
4155}
4156
4157static u32 bond_ip_hash(u32 hash, struct flow_keys *flow, int xmit_policy)
4158{
4159 hash ^= (__force u32)flow_get_u32_dst(flow) ^
4160 (__force u32)flow_get_u32_src(flow);
4161 hash ^= (hash >> 16);
4162 hash ^= (hash >> 8);
4163
4164 /* discard lowest hash bit to deal with the common even ports pattern */
4165 if (xmit_policy == BOND_XMIT_POLICY_LAYER34 ||
4166 xmit_policy == BOND_XMIT_POLICY_ENCAP34)
4167 return hash >> 1;
4168
4169 return hash;
4170}
4171
4172/* Generate hash based on xmit policy. If @skb is given it is used to linearize
4173 * the data as required, but this function can be used without it if the data is
4174 * known to be linear (e.g. with xdp_buff).
4175 */
4176static u32 __bond_xmit_hash(struct bonding *bond, struct sk_buff *skb, const void *data,
4177 __be16 l2_proto, int mhoff, int nhoff, int hlen)
4178{
4179 struct flow_keys flow;
4180 u32 hash;
4181
4182 if (bond->params.xmit_policy == BOND_XMIT_POLICY_VLAN_SRCMAC)
4183 return bond_vlan_srcmac_hash(skb, data, mhoff, hlen);
4184
4185 if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER2 ||
4186 !bond_flow_dissect(bond, skb, data, l2_proto, nhoff, hlen, &flow))
4187 return bond_eth_hash(skb, data, mhoff, hlen);
4188
4189 if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER23 ||
4190 bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP23) {
4191 hash = bond_eth_hash(skb, data, mhoff, hlen);
4192 } else {
4193 if (flow.icmp.id)
4194 memcpy(&hash, &flow.icmp, sizeof(hash));
4195 else
4196 memcpy(&hash, &flow.ports.ports, sizeof(hash));
4197 }
4198
4199 return bond_ip_hash(hash, &flow, bond->params.xmit_policy);
4200}
4201
4202/**
4203 * bond_xmit_hash - generate a hash value based on the xmit policy
4204 * @bond: bonding device
4205 * @skb: buffer to use for headers
4206 *
4207 * This function will extract the necessary headers from the skb buffer and use
4208 * them to generate a hash based on the xmit_policy set in the bonding device
4209 */
4210u32 bond_xmit_hash(struct bonding *bond, struct sk_buff *skb)
4211{
4212 if (bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP34 &&
4213 skb->l4_hash)
4214 return skb->hash;
4215
4216 return __bond_xmit_hash(bond, skb, skb->data, skb->protocol,
4217 0, skb_network_offset(skb),
4218 skb_headlen(skb));
4219}
4220
4221/**
4222 * bond_xmit_hash_xdp - generate a hash value based on the xmit policy
4223 * @bond: bonding device
4224 * @xdp: buffer to use for headers
4225 *
4226 * The XDP variant of bond_xmit_hash.
4227 */
4228static u32 bond_xmit_hash_xdp(struct bonding *bond, struct xdp_buff *xdp)
4229{
4230 struct ethhdr *eth;
4231
4232 if (xdp->data + sizeof(struct ethhdr) > xdp->data_end)
4233 return 0;
4234
4235 eth = (struct ethhdr *)xdp->data;
4236
4237 return __bond_xmit_hash(bond, NULL, xdp->data, eth->h_proto, 0,
4238 sizeof(struct ethhdr), xdp->data_end - xdp->data);
4239}
4240
4241/*-------------------------- Device entry points ----------------------------*/
4242
4243void bond_work_init_all(struct bonding *bond)
4244{
4245 INIT_DELAYED_WORK(&bond->mcast_work,
4246 bond_resend_igmp_join_requests_delayed);
4247 INIT_DELAYED_WORK(&bond->alb_work, bond_alb_monitor);
4248 INIT_DELAYED_WORK(&bond->mii_work, bond_mii_monitor);
4249 INIT_DELAYED_WORK(&bond->arp_work, bond_arp_monitor);
4250 INIT_DELAYED_WORK(&bond->ad_work, bond_3ad_state_machine_handler);
4251 INIT_DELAYED_WORK(&bond->slave_arr_work, bond_slave_arr_handler);
4252}
4253
4254static void bond_work_cancel_all(struct bonding *bond)
4255{
4256 cancel_delayed_work_sync(&bond->mii_work);
4257 cancel_delayed_work_sync(&bond->arp_work);
4258 cancel_delayed_work_sync(&bond->alb_work);
4259 cancel_delayed_work_sync(&bond->ad_work);
4260 cancel_delayed_work_sync(&bond->mcast_work);
4261 cancel_delayed_work_sync(&bond->slave_arr_work);
4262}
4263
4264static int bond_open(struct net_device *bond_dev)
4265{
4266 struct bonding *bond = netdev_priv(bond_dev);
4267 struct list_head *iter;
4268 struct slave *slave;
4269
4270 if (BOND_MODE(bond) == BOND_MODE_ROUNDROBIN && !bond->rr_tx_counter) {
4271 bond->rr_tx_counter = alloc_percpu(u32);
4272 if (!bond->rr_tx_counter)
4273 return -ENOMEM;
4274 }
4275
4276 /* reset slave->backup and slave->inactive */
4277 if (bond_has_slaves(bond)) {
4278 bond_for_each_slave(bond, slave, iter) {
4279 if (bond_uses_primary(bond) &&
4280 slave != rcu_access_pointer(bond->curr_active_slave)) {
4281 bond_set_slave_inactive_flags(slave,
4282 BOND_SLAVE_NOTIFY_NOW);
4283 } else if (BOND_MODE(bond) != BOND_MODE_8023AD) {
4284 bond_set_slave_active_flags(slave,
4285 BOND_SLAVE_NOTIFY_NOW);
4286 }
4287 }
4288 }
4289
4290 if (bond_is_lb(bond)) {
4291 /* bond_alb_initialize must be called before the timer
4292 * is started.
4293 */
4294 if (bond_alb_initialize(bond, (BOND_MODE(bond) == BOND_MODE_ALB)))
4295 return -ENOMEM;
4296 if (bond->params.tlb_dynamic_lb || BOND_MODE(bond) == BOND_MODE_ALB)
4297 queue_delayed_work(bond->wq, &bond->alb_work, 0);
4298 }
4299
4300 if (bond->params.miimon) /* link check interval, in milliseconds. */
4301 queue_delayed_work(bond->wq, &bond->mii_work, 0);
4302
4303 if (bond->params.arp_interval) { /* arp interval, in milliseconds. */
4304 queue_delayed_work(bond->wq, &bond->arp_work, 0);
4305 bond->recv_probe = bond_rcv_validate;
4306 }
4307
4308 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
4309 queue_delayed_work(bond->wq, &bond->ad_work, 0);
4310 /* register to receive LACPDUs */
4311 bond->recv_probe = bond_3ad_lacpdu_recv;
4312 bond_3ad_initiate_agg_selection(bond, 1);
4313
4314 bond_for_each_slave(bond, slave, iter)
4315 dev_mc_add(slave->dev, lacpdu_mcast_addr);
4316 }
4317
4318 if (bond_mode_can_use_xmit_hash(bond))
4319 bond_update_slave_arr(bond, NULL);
4320
4321 return 0;
4322}
4323
4324static int bond_close(struct net_device *bond_dev)
4325{
4326 struct bonding *bond = netdev_priv(bond_dev);
4327 struct slave *slave;
4328
4329 bond_work_cancel_all(bond);
4330 bond->send_peer_notif = 0;
4331 if (bond_is_lb(bond))
4332 bond_alb_deinitialize(bond);
4333 bond->recv_probe = NULL;
4334
4335 if (bond_uses_primary(bond)) {
4336 rcu_read_lock();
4337 slave = rcu_dereference(bond->curr_active_slave);
4338 if (slave)
4339 bond_hw_addr_flush(bond_dev, slave->dev);
4340 rcu_read_unlock();
4341 } else {
4342 struct list_head *iter;
4343
4344 bond_for_each_slave(bond, slave, iter)
4345 bond_hw_addr_flush(bond_dev, slave->dev);
4346 }
4347
4348 return 0;
4349}
4350
4351/* fold stats, assuming all rtnl_link_stats64 fields are u64, but
4352 * that some drivers can provide 32bit values only.
4353 */
4354static void bond_fold_stats(struct rtnl_link_stats64 *_res,
4355 const struct rtnl_link_stats64 *_new,
4356 const struct rtnl_link_stats64 *_old)
4357{
4358 const u64 *new = (const u64 *)_new;
4359 const u64 *old = (const u64 *)_old;
4360 u64 *res = (u64 *)_res;
4361 int i;
4362
4363 for (i = 0; i < sizeof(*_res) / sizeof(u64); i++) {
4364 u64 nv = new[i];
4365 u64 ov = old[i];
4366 s64 delta = nv - ov;
4367
4368 /* detects if this particular field is 32bit only */
4369 if (((nv | ov) >> 32) == 0)
4370 delta = (s64)(s32)((u32)nv - (u32)ov);
4371
4372 /* filter anomalies, some drivers reset their stats
4373 * at down/up events.
4374 */
4375 if (delta > 0)
4376 res[i] += delta;
4377 }
4378}
4379
4380#ifdef CONFIG_LOCKDEP
4381static int bond_get_lowest_level_rcu(struct net_device *dev)
4382{
4383 struct net_device *ldev, *next, *now, *dev_stack[MAX_NEST_DEV + 1];
4384 struct list_head *niter, *iter, *iter_stack[MAX_NEST_DEV + 1];
4385 int cur = 0, max = 0;
4386
4387 now = dev;
4388 iter = &dev->adj_list.lower;
4389
4390 while (1) {
4391 next = NULL;
4392 while (1) {
4393 ldev = netdev_next_lower_dev_rcu(now, &iter);
4394 if (!ldev)
4395 break;
4396
4397 next = ldev;
4398 niter = &ldev->adj_list.lower;
4399 dev_stack[cur] = now;
4400 iter_stack[cur++] = iter;
4401 if (max <= cur)
4402 max = cur;
4403 break;
4404 }
4405
4406 if (!next) {
4407 if (!cur)
4408 return max;
4409 next = dev_stack[--cur];
4410 niter = iter_stack[cur];
4411 }
4412
4413 now = next;
4414 iter = niter;
4415 }
4416
4417 return max;
4418}
4419#endif
4420
4421static void bond_get_stats(struct net_device *bond_dev,
4422 struct rtnl_link_stats64 *stats)
4423{
4424 struct bonding *bond = netdev_priv(bond_dev);
4425 struct rtnl_link_stats64 temp;
4426 struct list_head *iter;
4427 struct slave *slave;
4428 int nest_level = 0;
4429
4430
4431 rcu_read_lock();
4432#ifdef CONFIG_LOCKDEP
4433 nest_level = bond_get_lowest_level_rcu(bond_dev);
4434#endif
4435
4436 spin_lock_nested(&bond->stats_lock, nest_level);
4437 memcpy(stats, &bond->bond_stats, sizeof(*stats));
4438
4439 bond_for_each_slave_rcu(bond, slave, iter) {
4440 const struct rtnl_link_stats64 *new =
4441 dev_get_stats(slave->dev, &temp);
4442
4443 bond_fold_stats(stats, new, &slave->slave_stats);
4444
4445 /* save off the slave stats for the next run */
4446 memcpy(&slave->slave_stats, new, sizeof(*new));
4447 }
4448
4449 memcpy(&bond->bond_stats, stats, sizeof(*stats));
4450 spin_unlock(&bond->stats_lock);
4451 rcu_read_unlock();
4452}
4453
4454static int bond_eth_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
4455{
4456 struct bonding *bond = netdev_priv(bond_dev);
4457 struct mii_ioctl_data *mii = NULL;
4458
4459 netdev_dbg(bond_dev, "bond_eth_ioctl: cmd=%d\n", cmd);
4460
4461 switch (cmd) {
4462 case SIOCGMIIPHY:
4463 mii = if_mii(ifr);
4464 if (!mii)
4465 return -EINVAL;
4466
4467 mii->phy_id = 0;
4468 fallthrough;
4469 case SIOCGMIIREG:
4470 /* We do this again just in case we were called by SIOCGMIIREG
4471 * instead of SIOCGMIIPHY.
4472 */
4473 mii = if_mii(ifr);
4474 if (!mii)
4475 return -EINVAL;
4476
4477 if (mii->reg_num == 1) {
4478 mii->val_out = 0;
4479 if (netif_carrier_ok(bond->dev))
4480 mii->val_out = BMSR_LSTATUS;
4481 }
4482
4483 break;
4484 default:
4485 return -EOPNOTSUPP;
4486 }
4487
4488 return 0;
4489}
4490
4491static int bond_do_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
4492{
4493 struct bonding *bond = netdev_priv(bond_dev);
4494 struct net_device *slave_dev = NULL;
4495 struct ifbond k_binfo;
4496 struct ifbond __user *u_binfo = NULL;
4497 struct ifslave k_sinfo;
4498 struct ifslave __user *u_sinfo = NULL;
4499 struct bond_opt_value newval;
4500 struct net *net;
4501 int res = 0;
4502
4503 netdev_dbg(bond_dev, "bond_ioctl: cmd=%d\n", cmd);
4504
4505 switch (cmd) {
4506 case SIOCBONDINFOQUERY:
4507 u_binfo = (struct ifbond __user *)ifr->ifr_data;
4508
4509 if (copy_from_user(&k_binfo, u_binfo, sizeof(ifbond)))
4510 return -EFAULT;
4511
4512 bond_info_query(bond_dev, &k_binfo);
4513 if (copy_to_user(u_binfo, &k_binfo, sizeof(ifbond)))
4514 return -EFAULT;
4515
4516 return 0;
4517 case SIOCBONDSLAVEINFOQUERY:
4518 u_sinfo = (struct ifslave __user *)ifr->ifr_data;
4519
4520 if (copy_from_user(&k_sinfo, u_sinfo, sizeof(ifslave)))
4521 return -EFAULT;
4522
4523 res = bond_slave_info_query(bond_dev, &k_sinfo);
4524 if (res == 0 &&
4525 copy_to_user(u_sinfo, &k_sinfo, sizeof(ifslave)))
4526 return -EFAULT;
4527
4528 return res;
4529 default:
4530 break;
4531 }
4532
4533 net = dev_net(bond_dev);
4534
4535 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
4536 return -EPERM;
4537
4538 slave_dev = __dev_get_by_name(net, ifr->ifr_slave);
4539
4540 slave_dbg(bond_dev, slave_dev, "slave_dev=%p:\n", slave_dev);
4541
4542 if (!slave_dev)
4543 return -ENODEV;
4544
4545 switch (cmd) {
4546 case SIOCBONDENSLAVE:
4547 res = bond_enslave(bond_dev, slave_dev, NULL);
4548 break;
4549 case SIOCBONDRELEASE:
4550 res = bond_release(bond_dev, slave_dev);
4551 break;
4552 case SIOCBONDSETHWADDR:
4553 res = bond_set_dev_addr(bond_dev, slave_dev);
4554 break;
4555 case SIOCBONDCHANGEACTIVE:
4556 bond_opt_initstr(&newval, slave_dev->name);
4557 res = __bond_opt_set_notify(bond, BOND_OPT_ACTIVE_SLAVE,
4558 &newval);
4559 break;
4560 default:
4561 res = -EOPNOTSUPP;
4562 }
4563
4564 return res;
4565}
4566
4567static int bond_siocdevprivate(struct net_device *bond_dev, struct ifreq *ifr,
4568 void __user *data, int cmd)
4569{
4570 struct ifreq ifrdata = { .ifr_data = data };
4571
4572 switch (cmd) {
4573 case BOND_INFO_QUERY_OLD:
4574 return bond_do_ioctl(bond_dev, &ifrdata, SIOCBONDINFOQUERY);
4575 case BOND_SLAVE_INFO_QUERY_OLD:
4576 return bond_do_ioctl(bond_dev, &ifrdata, SIOCBONDSLAVEINFOQUERY);
4577 case BOND_ENSLAVE_OLD:
4578 return bond_do_ioctl(bond_dev, ifr, SIOCBONDENSLAVE);
4579 case BOND_RELEASE_OLD:
4580 return bond_do_ioctl(bond_dev, ifr, SIOCBONDRELEASE);
4581 case BOND_SETHWADDR_OLD:
4582 return bond_do_ioctl(bond_dev, ifr, SIOCBONDSETHWADDR);
4583 case BOND_CHANGE_ACTIVE_OLD:
4584 return bond_do_ioctl(bond_dev, ifr, SIOCBONDCHANGEACTIVE);
4585 }
4586
4587 return -EOPNOTSUPP;
4588}
4589
4590static void bond_change_rx_flags(struct net_device *bond_dev, int change)
4591{
4592 struct bonding *bond = netdev_priv(bond_dev);
4593
4594 if (change & IFF_PROMISC)
4595 bond_set_promiscuity(bond,
4596 bond_dev->flags & IFF_PROMISC ? 1 : -1);
4597
4598 if (change & IFF_ALLMULTI)
4599 bond_set_allmulti(bond,
4600 bond_dev->flags & IFF_ALLMULTI ? 1 : -1);
4601}
4602
4603static void bond_set_rx_mode(struct net_device *bond_dev)
4604{
4605 struct bonding *bond = netdev_priv(bond_dev);
4606 struct list_head *iter;
4607 struct slave *slave;
4608
4609 rcu_read_lock();
4610 if (bond_uses_primary(bond)) {
4611 slave = rcu_dereference(bond->curr_active_slave);
4612 if (slave) {
4613 dev_uc_sync(slave->dev, bond_dev);
4614 dev_mc_sync(slave->dev, bond_dev);
4615 }
4616 } else {
4617 bond_for_each_slave_rcu(bond, slave, iter) {
4618 dev_uc_sync_multiple(slave->dev, bond_dev);
4619 dev_mc_sync_multiple(slave->dev, bond_dev);
4620 }
4621 }
4622 rcu_read_unlock();
4623}
4624
4625static int bond_neigh_init(struct neighbour *n)
4626{
4627 struct bonding *bond = netdev_priv(n->dev);
4628 const struct net_device_ops *slave_ops;
4629 struct neigh_parms parms;
4630 struct slave *slave;
4631 int ret = 0;
4632
4633 rcu_read_lock();
4634 slave = bond_first_slave_rcu(bond);
4635 if (!slave)
4636 goto out;
4637 slave_ops = slave->dev->netdev_ops;
4638 if (!slave_ops->ndo_neigh_setup)
4639 goto out;
4640
4641 /* TODO: find another way [1] to implement this.
4642 * Passing a zeroed structure is fragile,
4643 * but at least we do not pass garbage.
4644 *
4645 * [1] One way would be that ndo_neigh_setup() never touch
4646 * struct neigh_parms, but propagate the new neigh_setup()
4647 * back to ___neigh_create() / neigh_parms_alloc()
4648 */
4649 memset(&parms, 0, sizeof(parms));
4650 ret = slave_ops->ndo_neigh_setup(slave->dev, &parms);
4651
4652 if (ret)
4653 goto out;
4654
4655 if (parms.neigh_setup)
4656 ret = parms.neigh_setup(n);
4657out:
4658 rcu_read_unlock();
4659 return ret;
4660}
4661
4662/* The bonding ndo_neigh_setup is called at init time beofre any
4663 * slave exists. So we must declare proxy setup function which will
4664 * be used at run time to resolve the actual slave neigh param setup.
4665 *
4666 * It's also called by master devices (such as vlans) to setup their
4667 * underlying devices. In that case - do nothing, we're already set up from
4668 * our init.
4669 */
4670static int bond_neigh_setup(struct net_device *dev,
4671 struct neigh_parms *parms)
4672{
4673 /* modify only our neigh_parms */
4674 if (parms->dev == dev)
4675 parms->neigh_setup = bond_neigh_init;
4676
4677 return 0;
4678}
4679
4680/* Change the MTU of all of a master's slaves to match the master */
4681static int bond_change_mtu(struct net_device *bond_dev, int new_mtu)
4682{
4683 struct bonding *bond = netdev_priv(bond_dev);
4684 struct slave *slave, *rollback_slave;
4685 struct list_head *iter;
4686 int res = 0;
4687
4688 netdev_dbg(bond_dev, "bond=%p, new_mtu=%d\n", bond, new_mtu);
4689
4690 bond_for_each_slave(bond, slave, iter) {
4691 slave_dbg(bond_dev, slave->dev, "s %p c_m %p\n",
4692 slave, slave->dev->netdev_ops->ndo_change_mtu);
4693
4694 res = dev_set_mtu(slave->dev, new_mtu);
4695
4696 if (res) {
4697 /* If we failed to set the slave's mtu to the new value
4698 * we must abort the operation even in ACTIVE_BACKUP
4699 * mode, because if we allow the backup slaves to have
4700 * different mtu values than the active slave we'll
4701 * need to change their mtu when doing a failover. That
4702 * means changing their mtu from timer context, which
4703 * is probably not a good idea.
4704 */
4705 slave_dbg(bond_dev, slave->dev, "err %d setting mtu to %d\n",
4706 res, new_mtu);
4707 goto unwind;
4708 }
4709 }
4710
4711 bond_dev->mtu = new_mtu;
4712
4713 return 0;
4714
4715unwind:
4716 /* unwind from head to the slave that failed */
4717 bond_for_each_slave(bond, rollback_slave, iter) {
4718 int tmp_res;
4719
4720 if (rollback_slave == slave)
4721 break;
4722
4723 tmp_res = dev_set_mtu(rollback_slave->dev, bond_dev->mtu);
4724 if (tmp_res)
4725 slave_dbg(bond_dev, rollback_slave->dev, "unwind err %d\n",
4726 tmp_res);
4727 }
4728
4729 return res;
4730}
4731
4732/* Change HW address
4733 *
4734 * Note that many devices must be down to change the HW address, and
4735 * downing the master releases all slaves. We can make bonds full of
4736 * bonding devices to test this, however.
4737 */
4738static int bond_set_mac_address(struct net_device *bond_dev, void *addr)
4739{
4740 struct bonding *bond = netdev_priv(bond_dev);
4741 struct slave *slave, *rollback_slave;
4742 struct sockaddr_storage *ss = addr, tmp_ss;
4743 struct list_head *iter;
4744 int res = 0;
4745
4746 if (BOND_MODE(bond) == BOND_MODE_ALB)
4747 return bond_alb_set_mac_address(bond_dev, addr);
4748
4749
4750 netdev_dbg(bond_dev, "%s: bond=%p\n", __func__, bond);
4751
4752 /* If fail_over_mac is enabled, do nothing and return success.
4753 * Returning an error causes ifenslave to fail.
4754 */
4755 if (bond->params.fail_over_mac &&
4756 BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
4757 return 0;
4758
4759 if (!is_valid_ether_addr(ss->__data))
4760 return -EADDRNOTAVAIL;
4761
4762 bond_for_each_slave(bond, slave, iter) {
4763 slave_dbg(bond_dev, slave->dev, "%s: slave=%p\n",
4764 __func__, slave);
4765 res = dev_set_mac_address(slave->dev, addr, NULL);
4766 if (res) {
4767 /* TODO: consider downing the slave
4768 * and retry ?
4769 * User should expect communications
4770 * breakage anyway until ARP finish
4771 * updating, so...
4772 */
4773 slave_dbg(bond_dev, slave->dev, "%s: err %d\n",
4774 __func__, res);
4775 goto unwind;
4776 }
4777 }
4778
4779 /* success */
4780 dev_addr_set(bond_dev, ss->__data);
4781 return 0;
4782
4783unwind:
4784 memcpy(tmp_ss.__data, bond_dev->dev_addr, bond_dev->addr_len);
4785 tmp_ss.ss_family = bond_dev->type;
4786
4787 /* unwind from head to the slave that failed */
4788 bond_for_each_slave(bond, rollback_slave, iter) {
4789 int tmp_res;
4790
4791 if (rollback_slave == slave)
4792 break;
4793
4794 tmp_res = dev_set_mac_address(rollback_slave->dev,
4795 (struct sockaddr *)&tmp_ss, NULL);
4796 if (tmp_res) {
4797 slave_dbg(bond_dev, rollback_slave->dev, "%s: unwind err %d\n",
4798 __func__, tmp_res);
4799 }
4800 }
4801
4802 return res;
4803}
4804
4805/**
4806 * bond_get_slave_by_id - get xmit slave with slave_id
4807 * @bond: bonding device that is transmitting
4808 * @slave_id: slave id up to slave_cnt-1 through which to transmit
4809 *
4810 * This function tries to get slave with slave_id but in case
4811 * it fails, it tries to find the first available slave for transmission.
4812 */
4813static struct slave *bond_get_slave_by_id(struct bonding *bond,
4814 int slave_id)
4815{
4816 struct list_head *iter;
4817 struct slave *slave;
4818 int i = slave_id;
4819
4820 /* Here we start from the slave with slave_id */
4821 bond_for_each_slave_rcu(bond, slave, iter) {
4822 if (--i < 0) {
4823 if (bond_slave_can_tx(slave))
4824 return slave;
4825 }
4826 }
4827
4828 /* Here we start from the first slave up to slave_id */
4829 i = slave_id;
4830 bond_for_each_slave_rcu(bond, slave, iter) {
4831 if (--i < 0)
4832 break;
4833 if (bond_slave_can_tx(slave))
4834 return slave;
4835 }
4836 /* no slave that can tx has been found */
4837 return NULL;
4838}
4839
4840/**
4841 * bond_rr_gen_slave_id - generate slave id based on packets_per_slave
4842 * @bond: bonding device to use
4843 *
4844 * Based on the value of the bonding device's packets_per_slave parameter
4845 * this function generates a slave id, which is usually used as the next
4846 * slave to transmit through.
4847 */
4848static u32 bond_rr_gen_slave_id(struct bonding *bond)
4849{
4850 u32 slave_id;
4851 struct reciprocal_value reciprocal_packets_per_slave;
4852 int packets_per_slave = bond->params.packets_per_slave;
4853
4854 switch (packets_per_slave) {
4855 case 0:
4856 slave_id = get_random_u32();
4857 break;
4858 case 1:
4859 slave_id = this_cpu_inc_return(*bond->rr_tx_counter);
4860 break;
4861 default:
4862 reciprocal_packets_per_slave =
4863 bond->params.reciprocal_packets_per_slave;
4864 slave_id = this_cpu_inc_return(*bond->rr_tx_counter);
4865 slave_id = reciprocal_divide(slave_id,
4866 reciprocal_packets_per_slave);
4867 break;
4868 }
4869
4870 return slave_id;
4871}
4872
4873static struct slave *bond_xmit_roundrobin_slave_get(struct bonding *bond,
4874 struct sk_buff *skb)
4875{
4876 struct slave *slave;
4877 int slave_cnt;
4878 u32 slave_id;
4879
4880 /* Start with the curr_active_slave that joined the bond as the
4881 * default for sending IGMP traffic. For failover purposes one
4882 * needs to maintain some consistency for the interface that will
4883 * send the join/membership reports. The curr_active_slave found
4884 * will send all of this type of traffic.
4885 */
4886 if (skb->protocol == htons(ETH_P_IP)) {
4887 int noff = skb_network_offset(skb);
4888 struct iphdr *iph;
4889
4890 if (unlikely(!pskb_may_pull(skb, noff + sizeof(*iph))))
4891 goto non_igmp;
4892
4893 iph = ip_hdr(skb);
4894 if (iph->protocol == IPPROTO_IGMP) {
4895 slave = rcu_dereference(bond->curr_active_slave);
4896 if (slave)
4897 return slave;
4898 return bond_get_slave_by_id(bond, 0);
4899 }
4900 }
4901
4902non_igmp:
4903 slave_cnt = READ_ONCE(bond->slave_cnt);
4904 if (likely(slave_cnt)) {
4905 slave_id = bond_rr_gen_slave_id(bond) % slave_cnt;
4906 return bond_get_slave_by_id(bond, slave_id);
4907 }
4908 return NULL;
4909}
4910
4911static struct slave *bond_xdp_xmit_roundrobin_slave_get(struct bonding *bond,
4912 struct xdp_buff *xdp)
4913{
4914 struct slave *slave;
4915 int slave_cnt;
4916 u32 slave_id;
4917 const struct ethhdr *eth;
4918 void *data = xdp->data;
4919
4920 if (data + sizeof(struct ethhdr) > xdp->data_end)
4921 goto non_igmp;
4922
4923 eth = (struct ethhdr *)data;
4924 data += sizeof(struct ethhdr);
4925
4926 /* See comment on IGMP in bond_xmit_roundrobin_slave_get() */
4927 if (eth->h_proto == htons(ETH_P_IP)) {
4928 const struct iphdr *iph;
4929
4930 if (data + sizeof(struct iphdr) > xdp->data_end)
4931 goto non_igmp;
4932
4933 iph = (struct iphdr *)data;
4934
4935 if (iph->protocol == IPPROTO_IGMP) {
4936 slave = rcu_dereference(bond->curr_active_slave);
4937 if (slave)
4938 return slave;
4939 return bond_get_slave_by_id(bond, 0);
4940 }
4941 }
4942
4943non_igmp:
4944 slave_cnt = READ_ONCE(bond->slave_cnt);
4945 if (likely(slave_cnt)) {
4946 slave_id = bond_rr_gen_slave_id(bond) % slave_cnt;
4947 return bond_get_slave_by_id(bond, slave_id);
4948 }
4949 return NULL;
4950}
4951
4952static netdev_tx_t bond_xmit_roundrobin(struct sk_buff *skb,
4953 struct net_device *bond_dev)
4954{
4955 struct bonding *bond = netdev_priv(bond_dev);
4956 struct slave *slave;
4957
4958 slave = bond_xmit_roundrobin_slave_get(bond, skb);
4959 if (likely(slave))
4960 return bond_dev_queue_xmit(bond, skb, slave->dev);
4961
4962 return bond_tx_drop(bond_dev, skb);
4963}
4964
4965static struct slave *bond_xmit_activebackup_slave_get(struct bonding *bond)
4966{
4967 return rcu_dereference(bond->curr_active_slave);
4968}
4969
4970/* In active-backup mode, we know that bond->curr_active_slave is always valid if
4971 * the bond has a usable interface.
4972 */
4973static netdev_tx_t bond_xmit_activebackup(struct sk_buff *skb,
4974 struct net_device *bond_dev)
4975{
4976 struct bonding *bond = netdev_priv(bond_dev);
4977 struct slave *slave;
4978
4979 slave = bond_xmit_activebackup_slave_get(bond);
4980 if (slave)
4981 return bond_dev_queue_xmit(bond, skb, slave->dev);
4982
4983 return bond_tx_drop(bond_dev, skb);
4984}
4985
4986/* Use this to update slave_array when (a) it's not appropriate to update
4987 * slave_array right away (note that update_slave_array() may sleep)
4988 * and / or (b) RTNL is not held.
4989 */
4990void bond_slave_arr_work_rearm(struct bonding *bond, unsigned long delay)
4991{
4992 queue_delayed_work(bond->wq, &bond->slave_arr_work, delay);
4993}
4994
4995/* Slave array work handler. Holds only RTNL */
4996static void bond_slave_arr_handler(struct work_struct *work)
4997{
4998 struct bonding *bond = container_of(work, struct bonding,
4999 slave_arr_work.work);
5000 int ret;
5001
5002 if (!rtnl_trylock())
5003 goto err;
5004
5005 ret = bond_update_slave_arr(bond, NULL);
5006 rtnl_unlock();
5007 if (ret) {
5008 pr_warn_ratelimited("Failed to update slave array from WT\n");
5009 goto err;
5010 }
5011 return;
5012
5013err:
5014 bond_slave_arr_work_rearm(bond, 1);
5015}
5016
5017static void bond_skip_slave(struct bond_up_slave *slaves,
5018 struct slave *skipslave)
5019{
5020 int idx;
5021
5022 /* Rare situation where caller has asked to skip a specific
5023 * slave but allocation failed (most likely!). BTW this is
5024 * only possible when the call is initiated from
5025 * __bond_release_one(). In this situation; overwrite the
5026 * skipslave entry in the array with the last entry from the
5027 * array to avoid a situation where the xmit path may choose
5028 * this to-be-skipped slave to send a packet out.
5029 */
5030 for (idx = 0; slaves && idx < slaves->count; idx++) {
5031 if (skipslave == slaves->arr[idx]) {
5032 slaves->arr[idx] =
5033 slaves->arr[slaves->count - 1];
5034 slaves->count--;
5035 break;
5036 }
5037 }
5038}
5039
5040static void bond_set_slave_arr(struct bonding *bond,
5041 struct bond_up_slave *usable_slaves,
5042 struct bond_up_slave *all_slaves)
5043{
5044 struct bond_up_slave *usable, *all;
5045
5046 usable = rtnl_dereference(bond->usable_slaves);
5047 rcu_assign_pointer(bond->usable_slaves, usable_slaves);
5048 kfree_rcu(usable, rcu);
5049
5050 all = rtnl_dereference(bond->all_slaves);
5051 rcu_assign_pointer(bond->all_slaves, all_slaves);
5052 kfree_rcu(all, rcu);
5053}
5054
5055static void bond_reset_slave_arr(struct bonding *bond)
5056{
5057 bond_set_slave_arr(bond, NULL, NULL);
5058}
5059
5060/* Build the usable slaves array in control path for modes that use xmit-hash
5061 * to determine the slave interface -
5062 * (a) BOND_MODE_8023AD
5063 * (b) BOND_MODE_XOR
5064 * (c) (BOND_MODE_TLB || BOND_MODE_ALB) && tlb_dynamic_lb == 0
5065 *
5066 * The caller is expected to hold RTNL only and NO other lock!
5067 */
5068int bond_update_slave_arr(struct bonding *bond, struct slave *skipslave)
5069{
5070 struct bond_up_slave *usable_slaves = NULL, *all_slaves = NULL;
5071 struct slave *slave;
5072 struct list_head *iter;
5073 int agg_id = 0;
5074 int ret = 0;
5075
5076 might_sleep();
5077
5078 usable_slaves = kzalloc(struct_size(usable_slaves, arr,
5079 bond->slave_cnt), GFP_KERNEL);
5080 all_slaves = kzalloc(struct_size(all_slaves, arr,
5081 bond->slave_cnt), GFP_KERNEL);
5082 if (!usable_slaves || !all_slaves) {
5083 ret = -ENOMEM;
5084 goto out;
5085 }
5086 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
5087 struct ad_info ad_info;
5088
5089 spin_lock_bh(&bond->mode_lock);
5090 if (bond_3ad_get_active_agg_info(bond, &ad_info)) {
5091 spin_unlock_bh(&bond->mode_lock);
5092 pr_debug("bond_3ad_get_active_agg_info failed\n");
5093 /* No active aggragator means it's not safe to use
5094 * the previous array.
5095 */
5096 bond_reset_slave_arr(bond);
5097 goto out;
5098 }
5099 spin_unlock_bh(&bond->mode_lock);
5100 agg_id = ad_info.aggregator_id;
5101 }
5102 bond_for_each_slave(bond, slave, iter) {
5103 if (skipslave == slave)
5104 continue;
5105
5106 all_slaves->arr[all_slaves->count++] = slave;
5107 if (BOND_MODE(bond) == BOND_MODE_8023AD) {
5108 struct aggregator *agg;
5109
5110 agg = SLAVE_AD_INFO(slave)->port.aggregator;
5111 if (!agg || agg->aggregator_identifier != agg_id)
5112 continue;
5113 }
5114 if (!bond_slave_can_tx(slave))
5115 continue;
5116
5117 slave_dbg(bond->dev, slave->dev, "Adding slave to tx hash array[%d]\n",
5118 usable_slaves->count);
5119
5120 usable_slaves->arr[usable_slaves->count++] = slave;
5121 }
5122
5123 bond_set_slave_arr(bond, usable_slaves, all_slaves);
5124 return ret;
5125out:
5126 if (ret != 0 && skipslave) {
5127 bond_skip_slave(rtnl_dereference(bond->all_slaves),
5128 skipslave);
5129 bond_skip_slave(rtnl_dereference(bond->usable_slaves),
5130 skipslave);
5131 }
5132 kfree_rcu(all_slaves, rcu);
5133 kfree_rcu(usable_slaves, rcu);
5134
5135 return ret;
5136}
5137
5138static struct slave *bond_xmit_3ad_xor_slave_get(struct bonding *bond,
5139 struct sk_buff *skb,
5140 struct bond_up_slave *slaves)
5141{
5142 struct slave *slave;
5143 unsigned int count;
5144 u32 hash;
5145
5146 hash = bond_xmit_hash(bond, skb);
5147 count = slaves ? READ_ONCE(slaves->count) : 0;
5148 if (unlikely(!count))
5149 return NULL;
5150
5151 slave = slaves->arr[hash % count];
5152 return slave;
5153}
5154
5155static struct slave *bond_xdp_xmit_3ad_xor_slave_get(struct bonding *bond,
5156 struct xdp_buff *xdp)
5157{
5158 struct bond_up_slave *slaves;
5159 unsigned int count;
5160 u32 hash;
5161
5162 hash = bond_xmit_hash_xdp(bond, xdp);
5163 slaves = rcu_dereference(bond->usable_slaves);
5164 count = slaves ? READ_ONCE(slaves->count) : 0;
5165 if (unlikely(!count))
5166 return NULL;
5167
5168 return slaves->arr[hash % count];
5169}
5170
5171/* Use this Xmit function for 3AD as well as XOR modes. The current
5172 * usable slave array is formed in the control path. The xmit function
5173 * just calculates hash and sends the packet out.
5174 */
5175static netdev_tx_t bond_3ad_xor_xmit(struct sk_buff *skb,
5176 struct net_device *dev)
5177{
5178 struct bonding *bond = netdev_priv(dev);
5179 struct bond_up_slave *slaves;
5180 struct slave *slave;
5181
5182 slaves = rcu_dereference(bond->usable_slaves);
5183 slave = bond_xmit_3ad_xor_slave_get(bond, skb, slaves);
5184 if (likely(slave))
5185 return bond_dev_queue_xmit(bond, skb, slave->dev);
5186
5187 return bond_tx_drop(dev, skb);
5188}
5189
5190/* in broadcast mode, we send everything to all usable interfaces. */
5191static netdev_tx_t bond_xmit_broadcast(struct sk_buff *skb,
5192 struct net_device *bond_dev)
5193{
5194 struct bonding *bond = netdev_priv(bond_dev);
5195 struct slave *slave = NULL;
5196 struct list_head *iter;
5197 bool xmit_suc = false;
5198 bool skb_used = false;
5199
5200 bond_for_each_slave_rcu(bond, slave, iter) {
5201 struct sk_buff *skb2;
5202
5203 if (!(bond_slave_is_up(slave) && slave->link == BOND_LINK_UP))
5204 continue;
5205
5206 if (bond_is_last_slave(bond, slave)) {
5207 skb2 = skb;
5208 skb_used = true;
5209 } else {
5210 skb2 = skb_clone(skb, GFP_ATOMIC);
5211 if (!skb2) {
5212 net_err_ratelimited("%s: Error: %s: skb_clone() failed\n",
5213 bond_dev->name, __func__);
5214 continue;
5215 }
5216 }
5217
5218 if (bond_dev_queue_xmit(bond, skb2, slave->dev) == NETDEV_TX_OK)
5219 xmit_suc = true;
5220 }
5221
5222 if (!skb_used)
5223 dev_kfree_skb_any(skb);
5224
5225 if (xmit_suc)
5226 return NETDEV_TX_OK;
5227
5228 dev_core_stats_tx_dropped_inc(bond_dev);
5229 return NET_XMIT_DROP;
5230}
5231
5232/*------------------------- Device initialization ---------------------------*/
5233
5234/* Lookup the slave that corresponds to a qid */
5235static inline int bond_slave_override(struct bonding *bond,
5236 struct sk_buff *skb)
5237{
5238 struct slave *slave = NULL;
5239 struct list_head *iter;
5240
5241 if (!skb_rx_queue_recorded(skb))
5242 return 1;
5243
5244 /* Find out if any slaves have the same mapping as this skb. */
5245 bond_for_each_slave_rcu(bond, slave, iter) {
5246 if (slave->queue_id == skb_get_queue_mapping(skb)) {
5247 if (bond_slave_is_up(slave) &&
5248 slave->link == BOND_LINK_UP) {
5249 bond_dev_queue_xmit(bond, skb, slave->dev);
5250 return 0;
5251 }
5252 /* If the slave isn't UP, use default transmit policy. */
5253 break;
5254 }
5255 }
5256
5257 return 1;
5258}
5259
5260
5261static u16 bond_select_queue(struct net_device *dev, struct sk_buff *skb,
5262 struct net_device *sb_dev)
5263{
5264 /* This helper function exists to help dev_pick_tx get the correct
5265 * destination queue. Using a helper function skips a call to
5266 * skb_tx_hash and will put the skbs in the queue we expect on their
5267 * way down to the bonding driver.
5268 */
5269 u16 txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;
5270
5271 /* Save the original txq to restore before passing to the driver */
5272 qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb_get_queue_mapping(skb);
5273
5274 if (unlikely(txq >= dev->real_num_tx_queues)) {
5275 do {
5276 txq -= dev->real_num_tx_queues;
5277 } while (txq >= dev->real_num_tx_queues);
5278 }
5279 return txq;
5280}
5281
5282static struct net_device *bond_xmit_get_slave(struct net_device *master_dev,
5283 struct sk_buff *skb,
5284 bool all_slaves)
5285{
5286 struct bonding *bond = netdev_priv(master_dev);
5287 struct bond_up_slave *slaves;
5288 struct slave *slave = NULL;
5289
5290 switch (BOND_MODE(bond)) {
5291 case BOND_MODE_ROUNDROBIN:
5292 slave = bond_xmit_roundrobin_slave_get(bond, skb);
5293 break;
5294 case BOND_MODE_ACTIVEBACKUP:
5295 slave = bond_xmit_activebackup_slave_get(bond);
5296 break;
5297 case BOND_MODE_8023AD:
5298 case BOND_MODE_XOR:
5299 if (all_slaves)
5300 slaves = rcu_dereference(bond->all_slaves);
5301 else
5302 slaves = rcu_dereference(bond->usable_slaves);
5303 slave = bond_xmit_3ad_xor_slave_get(bond, skb, slaves);
5304 break;
5305 case BOND_MODE_BROADCAST:
5306 break;
5307 case BOND_MODE_ALB:
5308 slave = bond_xmit_alb_slave_get(bond, skb);
5309 break;
5310 case BOND_MODE_TLB:
5311 slave = bond_xmit_tlb_slave_get(bond, skb);
5312 break;
5313 default:
5314 /* Should never happen, mode already checked */
5315 WARN_ONCE(true, "Unknown bonding mode");
5316 break;
5317 }
5318
5319 if (slave)
5320 return slave->dev;
5321 return NULL;
5322}
5323
5324static void bond_sk_to_flow(struct sock *sk, struct flow_keys *flow)
5325{
5326 switch (sk->sk_family) {
5327#if IS_ENABLED(CONFIG_IPV6)
5328 case AF_INET6:
5329 if (ipv6_only_sock(sk) ||
5330 ipv6_addr_type(&sk->sk_v6_daddr) != IPV6_ADDR_MAPPED) {
5331 flow->control.addr_type = FLOW_DISSECTOR_KEY_IPV6_ADDRS;
5332 flow->addrs.v6addrs.src = inet6_sk(sk)->saddr;
5333 flow->addrs.v6addrs.dst = sk->sk_v6_daddr;
5334 break;
5335 }
5336 fallthrough;
5337#endif
5338 default: /* AF_INET */
5339 flow->control.addr_type = FLOW_DISSECTOR_KEY_IPV4_ADDRS;
5340 flow->addrs.v4addrs.src = inet_sk(sk)->inet_rcv_saddr;
5341 flow->addrs.v4addrs.dst = inet_sk(sk)->inet_daddr;
5342 break;
5343 }
5344
5345 flow->ports.src = inet_sk(sk)->inet_sport;
5346 flow->ports.dst = inet_sk(sk)->inet_dport;
5347}
5348
5349/**
5350 * bond_sk_hash_l34 - generate a hash value based on the socket's L3 and L4 fields
5351 * @sk: socket to use for headers
5352 *
5353 * This function will extract the necessary field from the socket and use
5354 * them to generate a hash based on the LAYER34 xmit_policy.
5355 * Assumes that sk is a TCP or UDP socket.
5356 */
5357static u32 bond_sk_hash_l34(struct sock *sk)
5358{
5359 struct flow_keys flow;
5360 u32 hash;
5361
5362 bond_sk_to_flow(sk, &flow);
5363
5364 /* L4 */
5365 memcpy(&hash, &flow.ports.ports, sizeof(hash));
5366 /* L3 */
5367 return bond_ip_hash(hash, &flow, BOND_XMIT_POLICY_LAYER34);
5368}
5369
5370static struct net_device *__bond_sk_get_lower_dev(struct bonding *bond,
5371 struct sock *sk)
5372{
5373 struct bond_up_slave *slaves;
5374 struct slave *slave;
5375 unsigned int count;
5376 u32 hash;
5377
5378 slaves = rcu_dereference(bond->usable_slaves);
5379 count = slaves ? READ_ONCE(slaves->count) : 0;
5380 if (unlikely(!count))
5381 return NULL;
5382
5383 hash = bond_sk_hash_l34(sk);
5384 slave = slaves->arr[hash % count];
5385
5386 return slave->dev;
5387}
5388
5389static struct net_device *bond_sk_get_lower_dev(struct net_device *dev,
5390 struct sock *sk)
5391{
5392 struct bonding *bond = netdev_priv(dev);
5393 struct net_device *lower = NULL;
5394
5395 rcu_read_lock();
5396 if (bond_sk_check(bond))
5397 lower = __bond_sk_get_lower_dev(bond, sk);
5398 rcu_read_unlock();
5399
5400 return lower;
5401}
5402
5403#if IS_ENABLED(CONFIG_TLS_DEVICE)
5404static netdev_tx_t bond_tls_device_xmit(struct bonding *bond, struct sk_buff *skb,
5405 struct net_device *dev)
5406{
5407 struct net_device *tls_netdev = rcu_dereference(tls_get_ctx(skb->sk)->netdev);
5408
5409 /* tls_netdev might become NULL, even if tls_is_skb_tx_device_offloaded
5410 * was true, if tls_device_down is running in parallel, but it's OK,
5411 * because bond_get_slave_by_dev has a NULL check.
5412 */
5413 if (likely(bond_get_slave_by_dev(bond, tls_netdev)))
5414 return bond_dev_queue_xmit(bond, skb, tls_netdev);
5415 return bond_tx_drop(dev, skb);
5416}
5417#endif
5418
5419static netdev_tx_t __bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
5420{
5421 struct bonding *bond = netdev_priv(dev);
5422
5423 if (bond_should_override_tx_queue(bond) &&
5424 !bond_slave_override(bond, skb))
5425 return NETDEV_TX_OK;
5426
5427#if IS_ENABLED(CONFIG_TLS_DEVICE)
5428 if (tls_is_skb_tx_device_offloaded(skb))
5429 return bond_tls_device_xmit(bond, skb, dev);
5430#endif
5431
5432 switch (BOND_MODE(bond)) {
5433 case BOND_MODE_ROUNDROBIN:
5434 return bond_xmit_roundrobin(skb, dev);
5435 case BOND_MODE_ACTIVEBACKUP:
5436 return bond_xmit_activebackup(skb, dev);
5437 case BOND_MODE_8023AD:
5438 case BOND_MODE_XOR:
5439 return bond_3ad_xor_xmit(skb, dev);
5440 case BOND_MODE_BROADCAST:
5441 return bond_xmit_broadcast(skb, dev);
5442 case BOND_MODE_ALB:
5443 return bond_alb_xmit(skb, dev);
5444 case BOND_MODE_TLB:
5445 return bond_tlb_xmit(skb, dev);
5446 default:
5447 /* Should never happen, mode already checked */
5448 netdev_err(dev, "Unknown bonding mode %d\n", BOND_MODE(bond));
5449 WARN_ON_ONCE(1);
5450 return bond_tx_drop(dev, skb);
5451 }
5452}
5453
5454static netdev_tx_t bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
5455{
5456 struct bonding *bond = netdev_priv(dev);
5457 netdev_tx_t ret = NETDEV_TX_OK;
5458
5459 /* If we risk deadlock from transmitting this in the
5460 * netpoll path, tell netpoll to queue the frame for later tx
5461 */
5462 if (unlikely(is_netpoll_tx_blocked(dev)))
5463 return NETDEV_TX_BUSY;
5464
5465 rcu_read_lock();
5466 if (bond_has_slaves(bond))
5467 ret = __bond_start_xmit(skb, dev);
5468 else
5469 ret = bond_tx_drop(dev, skb);
5470 rcu_read_unlock();
5471
5472 return ret;
5473}
5474
5475static struct net_device *
5476bond_xdp_get_xmit_slave(struct net_device *bond_dev, struct xdp_buff *xdp)
5477{
5478 struct bonding *bond = netdev_priv(bond_dev);
5479 struct slave *slave;
5480
5481 /* Caller needs to hold rcu_read_lock() */
5482
5483 switch (BOND_MODE(bond)) {
5484 case BOND_MODE_ROUNDROBIN:
5485 slave = bond_xdp_xmit_roundrobin_slave_get(bond, xdp);
5486 break;
5487
5488 case BOND_MODE_ACTIVEBACKUP:
5489 slave = bond_xmit_activebackup_slave_get(bond);
5490 break;
5491
5492 case BOND_MODE_8023AD:
5493 case BOND_MODE_XOR:
5494 slave = bond_xdp_xmit_3ad_xor_slave_get(bond, xdp);
5495 break;
5496
5497 default:
5498 /* Should never happen. Mode guarded by bond_xdp_check() */
5499 netdev_err(bond_dev, "Unknown bonding mode %d for xdp xmit\n", BOND_MODE(bond));
5500 WARN_ON_ONCE(1);
5501 return NULL;
5502 }
5503
5504 if (slave)
5505 return slave->dev;
5506
5507 return NULL;
5508}
5509
5510static int bond_xdp_xmit(struct net_device *bond_dev,
5511 int n, struct xdp_frame **frames, u32 flags)
5512{
5513 int nxmit, err = -ENXIO;
5514
5515 rcu_read_lock();
5516
5517 for (nxmit = 0; nxmit < n; nxmit++) {
5518 struct xdp_frame *frame = frames[nxmit];
5519 struct xdp_frame *frames1[] = {frame};
5520 struct net_device *slave_dev;
5521 struct xdp_buff xdp;
5522
5523 xdp_convert_frame_to_buff(frame, &xdp);
5524
5525 slave_dev = bond_xdp_get_xmit_slave(bond_dev, &xdp);
5526 if (!slave_dev) {
5527 err = -ENXIO;
5528 break;
5529 }
5530
5531 err = slave_dev->netdev_ops->ndo_xdp_xmit(slave_dev, 1, frames1, flags);
5532 if (err < 1)
5533 break;
5534 }
5535
5536 rcu_read_unlock();
5537
5538 /* If error happened on the first frame then we can pass the error up, otherwise
5539 * report the number of frames that were xmitted.
5540 */
5541 if (err < 0)
5542 return (nxmit == 0 ? err : nxmit);
5543
5544 return nxmit;
5545}
5546
5547static int bond_xdp_set(struct net_device *dev, struct bpf_prog *prog,
5548 struct netlink_ext_ack *extack)
5549{
5550 struct bonding *bond = netdev_priv(dev);
5551 struct list_head *iter;
5552 struct slave *slave, *rollback_slave;
5553 struct bpf_prog *old_prog;
5554 struct netdev_bpf xdp = {
5555 .command = XDP_SETUP_PROG,
5556 .flags = 0,
5557 .prog = prog,
5558 .extack = extack,
5559 };
5560 int err;
5561
5562 ASSERT_RTNL();
5563
5564 if (!bond_xdp_check(bond))
5565 return -EOPNOTSUPP;
5566
5567 old_prog = bond->xdp_prog;
5568 bond->xdp_prog = prog;
5569
5570 bond_for_each_slave(bond, slave, iter) {
5571 struct net_device *slave_dev = slave->dev;
5572
5573 if (!slave_dev->netdev_ops->ndo_bpf ||
5574 !slave_dev->netdev_ops->ndo_xdp_xmit) {
5575 SLAVE_NL_ERR(dev, slave_dev, extack,
5576 "Slave device does not support XDP");
5577 err = -EOPNOTSUPP;
5578 goto err;
5579 }
5580
5581 if (dev_xdp_prog_count(slave_dev) > 0) {
5582 SLAVE_NL_ERR(dev, slave_dev, extack,
5583 "Slave has XDP program loaded, please unload before enslaving");
5584 err = -EOPNOTSUPP;
5585 goto err;
5586 }
5587
5588 err = slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp);
5589 if (err < 0) {
5590 /* ndo_bpf() sets extack error message */
5591 slave_err(dev, slave_dev, "Error %d calling ndo_bpf\n", err);
5592 goto err;
5593 }
5594 if (prog)
5595 bpf_prog_inc(prog);
5596 }
5597
5598 if (prog) {
5599 static_branch_inc(&bpf_master_redirect_enabled_key);
5600 } else if (old_prog) {
5601 bpf_prog_put(old_prog);
5602 static_branch_dec(&bpf_master_redirect_enabled_key);
5603 }
5604
5605 return 0;
5606
5607err:
5608 /* unwind the program changes */
5609 bond->xdp_prog = old_prog;
5610 xdp.prog = old_prog;
5611 xdp.extack = NULL; /* do not overwrite original error */
5612
5613 bond_for_each_slave(bond, rollback_slave, iter) {
5614 struct net_device *slave_dev = rollback_slave->dev;
5615 int err_unwind;
5616
5617 if (slave == rollback_slave)
5618 break;
5619
5620 err_unwind = slave_dev->netdev_ops->ndo_bpf(slave_dev, &xdp);
5621 if (err_unwind < 0)
5622 slave_err(dev, slave_dev,
5623 "Error %d when unwinding XDP program change\n", err_unwind);
5624 else if (xdp.prog)
5625 bpf_prog_inc(xdp.prog);
5626 }
5627 return err;
5628}
5629
5630static int bond_xdp(struct net_device *dev, struct netdev_bpf *xdp)
5631{
5632 switch (xdp->command) {
5633 case XDP_SETUP_PROG:
5634 return bond_xdp_set(dev, xdp->prog, xdp->extack);
5635 default:
5636 return -EINVAL;
5637 }
5638}
5639
5640static u32 bond_mode_bcast_speed(struct slave *slave, u32 speed)
5641{
5642 if (speed == 0 || speed == SPEED_UNKNOWN)
5643 speed = slave->speed;
5644 else
5645 speed = min(speed, slave->speed);
5646
5647 return speed;
5648}
5649
5650/* Set the BOND_PHC_INDEX flag to notify user space */
5651static int bond_set_phc_index_flag(struct kernel_hwtstamp_config *kernel_cfg)
5652{
5653 struct ifreq *ifr = kernel_cfg->ifr;
5654 struct hwtstamp_config cfg;
5655
5656 if (kernel_cfg->copied_to_user) {
5657 /* Lower device has a legacy implementation */
5658 if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
5659 return -EFAULT;
5660
5661 cfg.flags |= HWTSTAMP_FLAG_BONDED_PHC_INDEX;
5662 if (copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)))
5663 return -EFAULT;
5664 } else {
5665 kernel_cfg->flags |= HWTSTAMP_FLAG_BONDED_PHC_INDEX;
5666 }
5667
5668 return 0;
5669}
5670
5671static int bond_hwtstamp_get(struct net_device *dev,
5672 struct kernel_hwtstamp_config *cfg)
5673{
5674 struct bonding *bond = netdev_priv(dev);
5675 struct net_device *real_dev;
5676 int err;
5677
5678 real_dev = bond_option_active_slave_get_rcu(bond);
5679 if (!real_dev)
5680 return -EOPNOTSUPP;
5681
5682 err = generic_hwtstamp_get_lower(real_dev, cfg);
5683 if (err)
5684 return err;
5685
5686 return bond_set_phc_index_flag(cfg);
5687}
5688
5689static int bond_hwtstamp_set(struct net_device *dev,
5690 struct kernel_hwtstamp_config *cfg,
5691 struct netlink_ext_ack *extack)
5692{
5693 struct bonding *bond = netdev_priv(dev);
5694 struct net_device *real_dev;
5695 int err;
5696
5697 if (!(cfg->flags & HWTSTAMP_FLAG_BONDED_PHC_INDEX))
5698 return -EOPNOTSUPP;
5699
5700 real_dev = bond_option_active_slave_get_rcu(bond);
5701 if (!real_dev)
5702 return -EOPNOTSUPP;
5703
5704 err = generic_hwtstamp_set_lower(real_dev, cfg, extack);
5705 if (err)
5706 return err;
5707
5708 return bond_set_phc_index_flag(cfg);
5709}
5710
5711static int bond_ethtool_get_link_ksettings(struct net_device *bond_dev,
5712 struct ethtool_link_ksettings *cmd)
5713{
5714 struct bonding *bond = netdev_priv(bond_dev);
5715 struct list_head *iter;
5716 struct slave *slave;
5717 u32 speed = 0;
5718
5719 cmd->base.duplex = DUPLEX_UNKNOWN;
5720 cmd->base.port = PORT_OTHER;
5721
5722 /* Since bond_slave_can_tx returns false for all inactive or down slaves, we
5723 * do not need to check mode. Though link speed might not represent
5724 * the true receive or transmit bandwidth (not all modes are symmetric)
5725 * this is an accurate maximum.
5726 */
5727 bond_for_each_slave(bond, slave, iter) {
5728 if (bond_slave_can_tx(slave)) {
5729 bond_update_speed_duplex(slave);
5730 if (slave->speed != SPEED_UNKNOWN) {
5731 if (BOND_MODE(bond) == BOND_MODE_BROADCAST)
5732 speed = bond_mode_bcast_speed(slave,
5733 speed);
5734 else
5735 speed += slave->speed;
5736 }
5737 if (cmd->base.duplex == DUPLEX_UNKNOWN &&
5738 slave->duplex != DUPLEX_UNKNOWN)
5739 cmd->base.duplex = slave->duplex;
5740 }
5741 }
5742 cmd->base.speed = speed ? : SPEED_UNKNOWN;
5743
5744 return 0;
5745}
5746
5747static void bond_ethtool_get_drvinfo(struct net_device *bond_dev,
5748 struct ethtool_drvinfo *drvinfo)
5749{
5750 strscpy(drvinfo->driver, DRV_NAME, sizeof(drvinfo->driver));
5751 snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version), "%d",
5752 BOND_ABI_VERSION);
5753}
5754
5755static int bond_ethtool_get_ts_info(struct net_device *bond_dev,
5756 struct ethtool_ts_info *info)
5757{
5758 struct bonding *bond = netdev_priv(bond_dev);
5759 struct ethtool_ts_info ts_info;
5760 struct net_device *real_dev;
5761 bool sw_tx_support = false;
5762 struct list_head *iter;
5763 struct slave *slave;
5764 int ret = 0;
5765
5766 rcu_read_lock();
5767 real_dev = bond_option_active_slave_get_rcu(bond);
5768 dev_hold(real_dev);
5769 rcu_read_unlock();
5770
5771 if (real_dev) {
5772 ret = ethtool_get_ts_info_by_layer(real_dev, info);
5773 } else {
5774 /* Check if all slaves support software tx timestamping */
5775 rcu_read_lock();
5776 bond_for_each_slave_rcu(bond, slave, iter) {
5777 ret = ethtool_get_ts_info_by_layer(slave->dev, &ts_info);
5778 if (!ret && (ts_info.so_timestamping & SOF_TIMESTAMPING_TX_SOFTWARE)) {
5779 sw_tx_support = true;
5780 continue;
5781 }
5782
5783 sw_tx_support = false;
5784 break;
5785 }
5786 rcu_read_unlock();
5787 }
5788
5789 if (sw_tx_support)
5790 info->so_timestamping |= SOF_TIMESTAMPING_TX_SOFTWARE;
5791
5792 dev_put(real_dev);
5793 return ret;
5794}
5795
5796static const struct ethtool_ops bond_ethtool_ops = {
5797 .get_drvinfo = bond_ethtool_get_drvinfo,
5798 .get_link = ethtool_op_get_link,
5799 .get_link_ksettings = bond_ethtool_get_link_ksettings,
5800 .get_ts_info = bond_ethtool_get_ts_info,
5801};
5802
5803static const struct net_device_ops bond_netdev_ops = {
5804 .ndo_init = bond_init,
5805 .ndo_uninit = bond_uninit,
5806 .ndo_open = bond_open,
5807 .ndo_stop = bond_close,
5808 .ndo_start_xmit = bond_start_xmit,
5809 .ndo_select_queue = bond_select_queue,
5810 .ndo_get_stats64 = bond_get_stats,
5811 .ndo_eth_ioctl = bond_eth_ioctl,
5812 .ndo_siocbond = bond_do_ioctl,
5813 .ndo_siocdevprivate = bond_siocdevprivate,
5814 .ndo_change_rx_flags = bond_change_rx_flags,
5815 .ndo_set_rx_mode = bond_set_rx_mode,
5816 .ndo_change_mtu = bond_change_mtu,
5817 .ndo_set_mac_address = bond_set_mac_address,
5818 .ndo_neigh_setup = bond_neigh_setup,
5819 .ndo_vlan_rx_add_vid = bond_vlan_rx_add_vid,
5820 .ndo_vlan_rx_kill_vid = bond_vlan_rx_kill_vid,
5821#ifdef CONFIG_NET_POLL_CONTROLLER
5822 .ndo_netpoll_setup = bond_netpoll_setup,
5823 .ndo_netpoll_cleanup = bond_netpoll_cleanup,
5824 .ndo_poll_controller = bond_poll_controller,
5825#endif
5826 .ndo_add_slave = bond_enslave,
5827 .ndo_del_slave = bond_release,
5828 .ndo_fix_features = bond_fix_features,
5829 .ndo_features_check = passthru_features_check,
5830 .ndo_get_xmit_slave = bond_xmit_get_slave,
5831 .ndo_sk_get_lower_dev = bond_sk_get_lower_dev,
5832 .ndo_bpf = bond_xdp,
5833 .ndo_xdp_xmit = bond_xdp_xmit,
5834 .ndo_xdp_get_xmit_slave = bond_xdp_get_xmit_slave,
5835 .ndo_hwtstamp_get = bond_hwtstamp_get,
5836 .ndo_hwtstamp_set = bond_hwtstamp_set,
5837};
5838
5839static const struct device_type bond_type = {
5840 .name = "bond",
5841};
5842
5843static void bond_destructor(struct net_device *bond_dev)
5844{
5845 struct bonding *bond = netdev_priv(bond_dev);
5846
5847 if (bond->wq)
5848 destroy_workqueue(bond->wq);
5849
5850 free_percpu(bond->rr_tx_counter);
5851}
5852
5853void bond_setup(struct net_device *bond_dev)
5854{
5855 struct bonding *bond = netdev_priv(bond_dev);
5856
5857 spin_lock_init(&bond->mode_lock);
5858 bond->params = bonding_defaults;
5859
5860 /* Initialize pointers */
5861 bond->dev = bond_dev;
5862
5863 /* Initialize the device entry points */
5864 ether_setup(bond_dev);
5865 bond_dev->max_mtu = ETH_MAX_MTU;
5866 bond_dev->netdev_ops = &bond_netdev_ops;
5867 bond_dev->ethtool_ops = &bond_ethtool_ops;
5868
5869 bond_dev->needs_free_netdev = true;
5870 bond_dev->priv_destructor = bond_destructor;
5871
5872 SET_NETDEV_DEVTYPE(bond_dev, &bond_type);
5873
5874 /* Initialize the device options */
5875 bond_dev->flags |= IFF_MASTER;
5876 bond_dev->priv_flags |= IFF_BONDING | IFF_UNICAST_FLT | IFF_NO_QUEUE;
5877 bond_dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
5878
5879#ifdef CONFIG_XFRM_OFFLOAD
5880 /* set up xfrm device ops (only supported in active-backup right now) */
5881 bond_dev->xfrmdev_ops = &bond_xfrmdev_ops;
5882 INIT_LIST_HEAD(&bond->ipsec_list);
5883 spin_lock_init(&bond->ipsec_lock);
5884#endif /* CONFIG_XFRM_OFFLOAD */
5885
5886 /* don't acquire bond device's netif_tx_lock when transmitting */
5887 bond_dev->features |= NETIF_F_LLTX;
5888
5889 /* By default, we declare the bond to be fully
5890 * VLAN hardware accelerated capable. Special
5891 * care is taken in the various xmit functions
5892 * when there are slaves that are not hw accel
5893 * capable
5894 */
5895
5896 /* Don't allow bond devices to change network namespaces. */
5897 bond_dev->features |= NETIF_F_NETNS_LOCAL;
5898
5899 bond_dev->hw_features = BOND_VLAN_FEATURES |
5900 NETIF_F_HW_VLAN_CTAG_RX |
5901 NETIF_F_HW_VLAN_CTAG_FILTER |
5902 NETIF_F_HW_VLAN_STAG_RX |
5903 NETIF_F_HW_VLAN_STAG_FILTER;
5904
5905 bond_dev->hw_features |= NETIF_F_GSO_ENCAP_ALL;
5906 bond_dev->features |= bond_dev->hw_features;
5907 bond_dev->features |= NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_STAG_TX;
5908#ifdef CONFIG_XFRM_OFFLOAD
5909 bond_dev->hw_features |= BOND_XFRM_FEATURES;
5910 /* Only enable XFRM features if this is an active-backup config */
5911 if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
5912 bond_dev->features |= BOND_XFRM_FEATURES;
5913#endif /* CONFIG_XFRM_OFFLOAD */
5914}
5915
5916/* Destroy a bonding device.
5917 * Must be under rtnl_lock when this function is called.
5918 */
5919static void bond_uninit(struct net_device *bond_dev)
5920{
5921 struct bonding *bond = netdev_priv(bond_dev);
5922 struct list_head *iter;
5923 struct slave *slave;
5924
5925 bond_netpoll_cleanup(bond_dev);
5926
5927 /* Release the bonded slaves */
5928 bond_for_each_slave(bond, slave, iter)
5929 __bond_release_one(bond_dev, slave->dev, true, true);
5930 netdev_info(bond_dev, "Released all slaves\n");
5931
5932 bond_set_slave_arr(bond, NULL, NULL);
5933
5934 list_del(&bond->bond_list);
5935
5936 bond_debug_unregister(bond);
5937}
5938
5939/*------------------------- Module initialization ---------------------------*/
5940
5941static int __init bond_check_params(struct bond_params *params)
5942{
5943 int arp_validate_value, fail_over_mac_value, primary_reselect_value, i;
5944 struct bond_opt_value newval;
5945 const struct bond_opt_value *valptr;
5946 int arp_all_targets_value = 0;
5947 u16 ad_actor_sys_prio = 0;
5948 u16 ad_user_port_key = 0;
5949 __be32 arp_target[BOND_MAX_ARP_TARGETS] = { 0 };
5950 int arp_ip_count;
5951 int bond_mode = BOND_MODE_ROUNDROBIN;
5952 int xmit_hashtype = BOND_XMIT_POLICY_LAYER2;
5953 int lacp_fast = 0;
5954 int tlb_dynamic_lb;
5955
5956 /* Convert string parameters. */
5957 if (mode) {
5958 bond_opt_initstr(&newval, mode);
5959 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_MODE), &newval);
5960 if (!valptr) {
5961 pr_err("Error: Invalid bonding mode \"%s\"\n", mode);
5962 return -EINVAL;
5963 }
5964 bond_mode = valptr->value;
5965 }
5966
5967 if (xmit_hash_policy) {
5968 if (bond_mode == BOND_MODE_ROUNDROBIN ||
5969 bond_mode == BOND_MODE_ACTIVEBACKUP ||
5970 bond_mode == BOND_MODE_BROADCAST) {
5971 pr_info("xmit_hash_policy param is irrelevant in mode %s\n",
5972 bond_mode_name(bond_mode));
5973 } else {
5974 bond_opt_initstr(&newval, xmit_hash_policy);
5975 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_XMIT_HASH),
5976 &newval);
5977 if (!valptr) {
5978 pr_err("Error: Invalid xmit_hash_policy \"%s\"\n",
5979 xmit_hash_policy);
5980 return -EINVAL;
5981 }
5982 xmit_hashtype = valptr->value;
5983 }
5984 }
5985
5986 if (lacp_rate) {
5987 if (bond_mode != BOND_MODE_8023AD) {
5988 pr_info("lacp_rate param is irrelevant in mode %s\n",
5989 bond_mode_name(bond_mode));
5990 } else {
5991 bond_opt_initstr(&newval, lacp_rate);
5992 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_LACP_RATE),
5993 &newval);
5994 if (!valptr) {
5995 pr_err("Error: Invalid lacp rate \"%s\"\n",
5996 lacp_rate);
5997 return -EINVAL;
5998 }
5999 lacp_fast = valptr->value;
6000 }
6001 }
6002
6003 if (ad_select) {
6004 bond_opt_initstr(&newval, ad_select);
6005 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_SELECT),
6006 &newval);
6007 if (!valptr) {
6008 pr_err("Error: Invalid ad_select \"%s\"\n", ad_select);
6009 return -EINVAL;
6010 }
6011 params->ad_select = valptr->value;
6012 if (bond_mode != BOND_MODE_8023AD)
6013 pr_warn("ad_select param only affects 802.3ad mode\n");
6014 } else {
6015 params->ad_select = BOND_AD_STABLE;
6016 }
6017
6018 if (max_bonds < 0) {
6019 pr_warn("Warning: max_bonds (%d) not in range %d-%d, so it was reset to BOND_DEFAULT_MAX_BONDS (%d)\n",
6020 max_bonds, 0, INT_MAX, BOND_DEFAULT_MAX_BONDS);
6021 max_bonds = BOND_DEFAULT_MAX_BONDS;
6022 }
6023
6024 if (miimon < 0) {
6025 pr_warn("Warning: miimon module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6026 miimon, INT_MAX);
6027 miimon = 0;
6028 }
6029
6030 if (updelay < 0) {
6031 pr_warn("Warning: updelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6032 updelay, INT_MAX);
6033 updelay = 0;
6034 }
6035
6036 if (downdelay < 0) {
6037 pr_warn("Warning: downdelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6038 downdelay, INT_MAX);
6039 downdelay = 0;
6040 }
6041
6042 if ((use_carrier != 0) && (use_carrier != 1)) {
6043 pr_warn("Warning: use_carrier module parameter (%d), not of valid value (0/1), so it was set to 1\n",
6044 use_carrier);
6045 use_carrier = 1;
6046 }
6047
6048 if (num_peer_notif < 0 || num_peer_notif > 255) {
6049 pr_warn("Warning: num_grat_arp/num_unsol_na (%d) not in range 0-255 so it was reset to 1\n",
6050 num_peer_notif);
6051 num_peer_notif = 1;
6052 }
6053
6054 /* reset values for 802.3ad/TLB/ALB */
6055 if (!bond_mode_uses_arp(bond_mode)) {
6056 if (!miimon) {
6057 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");
6058 pr_warn("Forcing miimon to 100msec\n");
6059 miimon = BOND_DEFAULT_MIIMON;
6060 }
6061 }
6062
6063 if (tx_queues < 1 || tx_queues > 255) {
6064 pr_warn("Warning: tx_queues (%d) should be between 1 and 255, resetting to %d\n",
6065 tx_queues, BOND_DEFAULT_TX_QUEUES);
6066 tx_queues = BOND_DEFAULT_TX_QUEUES;
6067 }
6068
6069 if ((all_slaves_active != 0) && (all_slaves_active != 1)) {
6070 pr_warn("Warning: all_slaves_active module parameter (%d), not of valid value (0/1), so it was set to 0\n",
6071 all_slaves_active);
6072 all_slaves_active = 0;
6073 }
6074
6075 if (resend_igmp < 0 || resend_igmp > 255) {
6076 pr_warn("Warning: resend_igmp (%d) should be between 0 and 255, resetting to %d\n",
6077 resend_igmp, BOND_DEFAULT_RESEND_IGMP);
6078 resend_igmp = BOND_DEFAULT_RESEND_IGMP;
6079 }
6080
6081 bond_opt_initval(&newval, packets_per_slave);
6082 if (!bond_opt_parse(bond_opt_get(BOND_OPT_PACKETS_PER_SLAVE), &newval)) {
6083 pr_warn("Warning: packets_per_slave (%d) should be between 0 and %u resetting to 1\n",
6084 packets_per_slave, USHRT_MAX);
6085 packets_per_slave = 1;
6086 }
6087
6088 if (bond_mode == BOND_MODE_ALB) {
6089 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",
6090 updelay);
6091 }
6092
6093 if (!miimon) {
6094 if (updelay || downdelay) {
6095 /* just warn the user the up/down delay will have
6096 * no effect since miimon is zero...
6097 */
6098 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",
6099 updelay, downdelay);
6100 }
6101 } else {
6102 /* don't allow arp monitoring */
6103 if (arp_interval) {
6104 pr_warn("Warning: miimon (%d) and arp_interval (%d) can't be used simultaneously, disabling ARP monitoring\n",
6105 miimon, arp_interval);
6106 arp_interval = 0;
6107 }
6108
6109 if ((updelay % miimon) != 0) {
6110 pr_warn("Warning: updelay (%d) is not a multiple of miimon (%d), updelay rounded to %d ms\n",
6111 updelay, miimon, (updelay / miimon) * miimon);
6112 }
6113
6114 updelay /= miimon;
6115
6116 if ((downdelay % miimon) != 0) {
6117 pr_warn("Warning: downdelay (%d) is not a multiple of miimon (%d), downdelay rounded to %d ms\n",
6118 downdelay, miimon,
6119 (downdelay / miimon) * miimon);
6120 }
6121
6122 downdelay /= miimon;
6123 }
6124
6125 if (arp_interval < 0) {
6126 pr_warn("Warning: arp_interval module parameter (%d), not in range 0-%d, so it was reset to 0\n",
6127 arp_interval, INT_MAX);
6128 arp_interval = 0;
6129 }
6130
6131 for (arp_ip_count = 0, i = 0;
6132 (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[i]; i++) {
6133 __be32 ip;
6134
6135 /* not a complete check, but good enough to catch mistakes */
6136 if (!in4_pton(arp_ip_target[i], -1, (u8 *)&ip, -1, NULL) ||
6137 !bond_is_ip_target_ok(ip)) {
6138 pr_warn("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n",
6139 arp_ip_target[i]);
6140 arp_interval = 0;
6141 } else {
6142 if (bond_get_targets_ip(arp_target, ip) == -1)
6143 arp_target[arp_ip_count++] = ip;
6144 else
6145 pr_warn("Warning: duplicate address %pI4 in arp_ip_target, skipping\n",
6146 &ip);
6147 }
6148 }
6149
6150 if (arp_interval && !arp_ip_count) {
6151 /* don't allow arping if no arp_ip_target given... */
6152 pr_warn("Warning: arp_interval module parameter (%d) specified without providing an arp_ip_target parameter, arp_interval was reset to 0\n",
6153 arp_interval);
6154 arp_interval = 0;
6155 }
6156
6157 if (arp_validate) {
6158 if (!arp_interval) {
6159 pr_err("arp_validate requires arp_interval\n");
6160 return -EINVAL;
6161 }
6162
6163 bond_opt_initstr(&newval, arp_validate);
6164 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_VALIDATE),
6165 &newval);
6166 if (!valptr) {
6167 pr_err("Error: invalid arp_validate \"%s\"\n",
6168 arp_validate);
6169 return -EINVAL;
6170 }
6171 arp_validate_value = valptr->value;
6172 } else {
6173 arp_validate_value = 0;
6174 }
6175
6176 if (arp_all_targets) {
6177 bond_opt_initstr(&newval, arp_all_targets);
6178 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_ALL_TARGETS),
6179 &newval);
6180 if (!valptr) {
6181 pr_err("Error: invalid arp_all_targets_value \"%s\"\n",
6182 arp_all_targets);
6183 arp_all_targets_value = 0;
6184 } else {
6185 arp_all_targets_value = valptr->value;
6186 }
6187 }
6188
6189 if (miimon) {
6190 pr_info("MII link monitoring set to %d ms\n", miimon);
6191 } else if (arp_interval) {
6192 valptr = bond_opt_get_val(BOND_OPT_ARP_VALIDATE,
6193 arp_validate_value);
6194 pr_info("ARP monitoring set to %d ms, validate %s, with %d target(s):",
6195 arp_interval, valptr->string, arp_ip_count);
6196
6197 for (i = 0; i < arp_ip_count; i++)
6198 pr_cont(" %s", arp_ip_target[i]);
6199
6200 pr_cont("\n");
6201
6202 } else if (max_bonds) {
6203 /* miimon and arp_interval not set, we need one so things
6204 * work as expected, see bonding.txt for details
6205 */
6206 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");
6207 }
6208
6209 if (primary && !bond_mode_uses_primary(bond_mode)) {
6210 /* currently, using a primary only makes sense
6211 * in active backup, TLB or ALB modes
6212 */
6213 pr_warn("Warning: %s primary device specified but has no effect in %s mode\n",
6214 primary, bond_mode_name(bond_mode));
6215 primary = NULL;
6216 }
6217
6218 if (primary && primary_reselect) {
6219 bond_opt_initstr(&newval, primary_reselect);
6220 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_PRIMARY_RESELECT),
6221 &newval);
6222 if (!valptr) {
6223 pr_err("Error: Invalid primary_reselect \"%s\"\n",
6224 primary_reselect);
6225 return -EINVAL;
6226 }
6227 primary_reselect_value = valptr->value;
6228 } else {
6229 primary_reselect_value = BOND_PRI_RESELECT_ALWAYS;
6230 }
6231
6232 if (fail_over_mac) {
6233 bond_opt_initstr(&newval, fail_over_mac);
6234 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_FAIL_OVER_MAC),
6235 &newval);
6236 if (!valptr) {
6237 pr_err("Error: invalid fail_over_mac \"%s\"\n",
6238 fail_over_mac);
6239 return -EINVAL;
6240 }
6241 fail_over_mac_value = valptr->value;
6242 if (bond_mode != BOND_MODE_ACTIVEBACKUP)
6243 pr_warn("Warning: fail_over_mac only affects active-backup mode\n");
6244 } else {
6245 fail_over_mac_value = BOND_FOM_NONE;
6246 }
6247
6248 bond_opt_initstr(&newval, "default");
6249 valptr = bond_opt_parse(
6250 bond_opt_get(BOND_OPT_AD_ACTOR_SYS_PRIO),
6251 &newval);
6252 if (!valptr) {
6253 pr_err("Error: No ad_actor_sys_prio default value");
6254 return -EINVAL;
6255 }
6256 ad_actor_sys_prio = valptr->value;
6257
6258 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_USER_PORT_KEY),
6259 &newval);
6260 if (!valptr) {
6261 pr_err("Error: No ad_user_port_key default value");
6262 return -EINVAL;
6263 }
6264 ad_user_port_key = valptr->value;
6265
6266 bond_opt_initstr(&newval, "default");
6267 valptr = bond_opt_parse(bond_opt_get(BOND_OPT_TLB_DYNAMIC_LB), &newval);
6268 if (!valptr) {
6269 pr_err("Error: No tlb_dynamic_lb default value");
6270 return -EINVAL;
6271 }
6272 tlb_dynamic_lb = valptr->value;
6273
6274 if (lp_interval == 0) {
6275 pr_warn("Warning: ip_interval must be between 1 and %d, so it was reset to %d\n",
6276 INT_MAX, BOND_ALB_DEFAULT_LP_INTERVAL);
6277 lp_interval = BOND_ALB_DEFAULT_LP_INTERVAL;
6278 }
6279
6280 /* fill params struct with the proper values */
6281 params->mode = bond_mode;
6282 params->xmit_policy = xmit_hashtype;
6283 params->miimon = miimon;
6284 params->num_peer_notif = num_peer_notif;
6285 params->arp_interval = arp_interval;
6286 params->arp_validate = arp_validate_value;
6287 params->arp_all_targets = arp_all_targets_value;
6288 params->missed_max = 2;
6289 params->updelay = updelay;
6290 params->downdelay = downdelay;
6291 params->peer_notif_delay = 0;
6292 params->use_carrier = use_carrier;
6293 params->lacp_active = 1;
6294 params->lacp_fast = lacp_fast;
6295 params->primary[0] = 0;
6296 params->primary_reselect = primary_reselect_value;
6297 params->fail_over_mac = fail_over_mac_value;
6298 params->tx_queues = tx_queues;
6299 params->all_slaves_active = all_slaves_active;
6300 params->resend_igmp = resend_igmp;
6301 params->min_links = min_links;
6302 params->lp_interval = lp_interval;
6303 params->packets_per_slave = packets_per_slave;
6304 params->tlb_dynamic_lb = tlb_dynamic_lb;
6305 params->ad_actor_sys_prio = ad_actor_sys_prio;
6306 eth_zero_addr(params->ad_actor_system);
6307 params->ad_user_port_key = ad_user_port_key;
6308 if (packets_per_slave > 0) {
6309 params->reciprocal_packets_per_slave =
6310 reciprocal_value(packets_per_slave);
6311 } else {
6312 /* reciprocal_packets_per_slave is unused if
6313 * packets_per_slave is 0 or 1, just initialize it
6314 */
6315 params->reciprocal_packets_per_slave =
6316 (struct reciprocal_value) { 0 };
6317 }
6318
6319 if (primary)
6320 strscpy_pad(params->primary, primary, sizeof(params->primary));
6321
6322 memcpy(params->arp_targets, arp_target, sizeof(arp_target));
6323#if IS_ENABLED(CONFIG_IPV6)
6324 memset(params->ns_targets, 0, sizeof(struct in6_addr) * BOND_MAX_NS_TARGETS);
6325#endif
6326
6327 return 0;
6328}
6329
6330/* Called from registration process */
6331static int bond_init(struct net_device *bond_dev)
6332{
6333 struct bonding *bond = netdev_priv(bond_dev);
6334 struct bond_net *bn = net_generic(dev_net(bond_dev), bond_net_id);
6335
6336 netdev_dbg(bond_dev, "Begin bond_init\n");
6337
6338 bond->wq = alloc_ordered_workqueue(bond_dev->name, WQ_MEM_RECLAIM);
6339 if (!bond->wq)
6340 return -ENOMEM;
6341
6342 bond->notifier_ctx = false;
6343
6344 spin_lock_init(&bond->stats_lock);
6345 netdev_lockdep_set_classes(bond_dev);
6346
6347 list_add_tail(&bond->bond_list, &bn->dev_list);
6348
6349 bond_prepare_sysfs_group(bond);
6350
6351 bond_debug_register(bond);
6352
6353 /* Ensure valid dev_addr */
6354 if (is_zero_ether_addr(bond_dev->dev_addr) &&
6355 bond_dev->addr_assign_type == NET_ADDR_PERM)
6356 eth_hw_addr_random(bond_dev);
6357
6358 return 0;
6359}
6360
6361unsigned int bond_get_num_tx_queues(void)
6362{
6363 return tx_queues;
6364}
6365
6366/* Create a new bond based on the specified name and bonding parameters.
6367 * If name is NULL, obtain a suitable "bond%d" name for us.
6368 * Caller must NOT hold rtnl_lock; we need to release it here before we
6369 * set up our sysfs entries.
6370 */
6371int bond_create(struct net *net, const char *name)
6372{
6373 struct net_device *bond_dev;
6374 struct bonding *bond;
6375 int res = -ENOMEM;
6376
6377 rtnl_lock();
6378
6379 bond_dev = alloc_netdev_mq(sizeof(struct bonding),
6380 name ? name : "bond%d", NET_NAME_UNKNOWN,
6381 bond_setup, tx_queues);
6382 if (!bond_dev)
6383 goto out;
6384
6385 bond = netdev_priv(bond_dev);
6386 dev_net_set(bond_dev, net);
6387 bond_dev->rtnl_link_ops = &bond_link_ops;
6388
6389 res = register_netdevice(bond_dev);
6390 if (res < 0) {
6391 free_netdev(bond_dev);
6392 goto out;
6393 }
6394
6395 netif_carrier_off(bond_dev);
6396
6397 bond_work_init_all(bond);
6398
6399out:
6400 rtnl_unlock();
6401 return res;
6402}
6403
6404static int __net_init bond_net_init(struct net *net)
6405{
6406 struct bond_net *bn = net_generic(net, bond_net_id);
6407
6408 bn->net = net;
6409 INIT_LIST_HEAD(&bn->dev_list);
6410
6411 bond_create_proc_dir(bn);
6412 bond_create_sysfs(bn);
6413
6414 return 0;
6415}
6416
6417static void __net_exit bond_net_exit_batch(struct list_head *net_list)
6418{
6419 struct bond_net *bn;
6420 struct net *net;
6421 LIST_HEAD(list);
6422
6423 list_for_each_entry(net, net_list, exit_list) {
6424 bn = net_generic(net, bond_net_id);
6425 bond_destroy_sysfs(bn);
6426 }
6427
6428 /* Kill off any bonds created after unregistering bond rtnl ops */
6429 rtnl_lock();
6430 list_for_each_entry(net, net_list, exit_list) {
6431 struct bonding *bond, *tmp_bond;
6432
6433 bn = net_generic(net, bond_net_id);
6434 list_for_each_entry_safe(bond, tmp_bond, &bn->dev_list, bond_list)
6435 unregister_netdevice_queue(bond->dev, &list);
6436 }
6437 unregister_netdevice_many(&list);
6438 rtnl_unlock();
6439
6440 list_for_each_entry(net, net_list, exit_list) {
6441 bn = net_generic(net, bond_net_id);
6442 bond_destroy_proc_dir(bn);
6443 }
6444}
6445
6446static struct pernet_operations bond_net_ops = {
6447 .init = bond_net_init,
6448 .exit_batch = bond_net_exit_batch,
6449 .id = &bond_net_id,
6450 .size = sizeof(struct bond_net),
6451};
6452
6453static int __init bonding_init(void)
6454{
6455 int i;
6456 int res;
6457
6458 res = bond_check_params(&bonding_defaults);
6459 if (res)
6460 goto out;
6461
6462 res = register_pernet_subsys(&bond_net_ops);
6463 if (res)
6464 goto out;
6465
6466 res = bond_netlink_init();
6467 if (res)
6468 goto err_link;
6469
6470 bond_create_debugfs();
6471
6472 for (i = 0; i < max_bonds; i++) {
6473 res = bond_create(&init_net, NULL);
6474 if (res)
6475 goto err;
6476 }
6477
6478 skb_flow_dissector_init(&flow_keys_bonding,
6479 flow_keys_bonding_keys,
6480 ARRAY_SIZE(flow_keys_bonding_keys));
6481
6482 register_netdevice_notifier(&bond_netdev_notifier);
6483out:
6484 return res;
6485err:
6486 bond_destroy_debugfs();
6487 bond_netlink_fini();
6488err_link:
6489 unregister_pernet_subsys(&bond_net_ops);
6490 goto out;
6491
6492}
6493
6494static void __exit bonding_exit(void)
6495{
6496 unregister_netdevice_notifier(&bond_netdev_notifier);
6497
6498 bond_destroy_debugfs();
6499
6500 bond_netlink_fini();
6501 unregister_pernet_subsys(&bond_net_ops);
6502
6503#ifdef CONFIG_NET_POLL_CONTROLLER
6504 /* Make sure we don't have an imbalance on our netpoll blocking */
6505 WARN_ON(atomic_read(&netpoll_block_tx));
6506#endif
6507}
6508
6509module_init(bonding_init);
6510module_exit(bonding_exit);
6511MODULE_LICENSE("GPL");
6512MODULE_DESCRIPTION(DRV_DESCRIPTION);
6513MODULE_AUTHOR("Thomas Davis, tadavis@lbl.gov and many others");