bond_main.c 136.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
/*
 * originally based on the dummy device.
 *
 * Copyright 1999, Thomas Davis, tadavis@lbl.gov.
 * Licensed under the GPL. Based on dummy.c, and eql.c devices.
 *
 * bonding.c: an Ethernet Bonding driver
 *
 * This is useful to talk to a Cisco EtherChannel compatible equipment:
 *	Cisco 5500
 *	Sun Trunking (Solaris)
 *	Alteon AceDirector Trunks
 *	Linux Bonding
 *	and probably many L2 switches ...
 *
 * How it works:
 *    ifconfig bond0 ipaddress netmask up
 *      will setup a network device, with an ip address.  No mac address
 *	will be assigned at this time.  The hw mac address will come from
 *	the first slave bonded to the channel.  All slaves will then use
 *	this hw mac address.
 *
 *    ifconfig bond0 down
 *         will release all slaves, marking them as down.
 *
 *    ifenslave bond0 eth0
 *	will attach eth0 to bond0 as a slave.  eth0 hw mac address will either
 *	a: be used as initial mac address
 *	b: if a hw mac address already is there, eth0's hw mac address
 *	   will then be set from bond0.
 *
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/interrupt.h>
#include <linux/ptrace.h>
#include <linux/ioport.h>
#include <linux/in.h>
42
#include <net/ip.h>
L
Linus Torvalds 已提交
43
#include <linux/ip.h>
44 45
#include <linux/tcp.h>
#include <linux/udp.h>
L
Linus Torvalds 已提交
46 47 48 49 50 51 52 53
#include <linux/slab.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/timer.h>
#include <linux/socket.h>
#include <linux/ctype.h>
#include <linux/inet.h>
#include <linux/bitops.h>
S
Stephen Hemminger 已提交
54
#include <linux/io.h>
L
Linus Torvalds 已提交
55
#include <asm/dma.h>
S
Stephen Hemminger 已提交
56
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
57 58 59
#include <linux/errno.h>
#include <linux/netdevice.h>
#include <linux/inetdevice.h>
60
#include <linux/igmp.h>
L
Linus Torvalds 已提交
61 62 63 64 65 66 67 68 69 70 71
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
#include <net/sock.h>
#include <linux/rtnetlink.h>
#include <linux/smp.h>
#include <linux/if_ether.h>
#include <net/arp.h>
#include <linux/mii.h>
#include <linux/ethtool.h>
#include <linux/if_vlan.h>
#include <linux/if_bonding.h>
D
David Sterba 已提交
72
#include <linux/jiffies.h>
73
#include <linux/preempt.h>
J
Jay Vosburgh 已提交
74
#include <net/route.h>
75
#include <net/net_namespace.h>
76
#include <net/netns/generic.h>
77
#include <net/pkt_sched.h>
78
#include <linux/rculist.h>
79
#include <net/flow_dissector.h>
80
#include <net/switchdev.h>
81 82 83
#include <net/bonding.h>
#include <net/bond_3ad.h>
#include <net/bond_alb.h>
L
Linus Torvalds 已提交
84

85 86
#include "bonding_priv.h"

L
Linus Torvalds 已提交
87 88 89 90 91
/*---------------------------- Module parameters ----------------------------*/

/* monitor all links that often (in milliseconds). <=0 disables monitoring */

static int max_bonds	= BOND_DEFAULT_MAX_BONDS;
92
static int tx_queues	= BOND_DEFAULT_TX_QUEUES;
93
static int num_peer_notif = 1;
94
static int miimon;
S
Stephen Hemminger 已提交
95 96
static int updelay;
static int downdelay;
L
Linus Torvalds 已提交
97
static int use_carrier	= 1;
S
Stephen Hemminger 已提交
98 99
static char *mode;
static char *primary;
100
static char *primary_reselect;
S
Stephen Hemminger 已提交
101
static char *lacp_rate;
102
static int min_links;
S
Stephen Hemminger 已提交
103 104
static char *ad_select;
static char *xmit_hash_policy;
105
static int arp_interval;
S
Stephen Hemminger 已提交
106 107
static char *arp_ip_target[BOND_MAX_ARP_TARGETS];
static char *arp_validate;
108
static char *arp_all_targets;
S
Stephen Hemminger 已提交
109
static char *fail_over_mac;
110
static int all_slaves_active;
111
static struct bond_params bonding_defaults;
112
static int resend_igmp = BOND_DEFAULT_RESEND_IGMP;
113
static int packets_per_slave = 1;
114
static int lp_interval = BOND_ALB_DEFAULT_LP_INTERVAL;
L
Linus Torvalds 已提交
115 116 117

module_param(max_bonds, int, 0);
MODULE_PARM_DESC(max_bonds, "Max number of bonded devices");
118 119
module_param(tx_queues, int, 0);
MODULE_PARM_DESC(tx_queues, "Max number of transmit queues (default = 16)");
120
module_param_named(num_grat_arp, num_peer_notif, int, 0644);
121 122
MODULE_PARM_DESC(num_grat_arp, "Number of peer notifications to send on "
			       "failover event (alias of num_unsol_na)");
123
module_param_named(num_unsol_na, num_peer_notif, int, 0644);
124 125
MODULE_PARM_DESC(num_unsol_na, "Number of peer notifications to send on "
			       "failover event (alias of num_grat_arp)");
L
Linus Torvalds 已提交
126 127 128 129 130
module_param(miimon, int, 0);
MODULE_PARM_DESC(miimon, "Link check interval in milliseconds");
module_param(updelay, int, 0);
MODULE_PARM_DESC(updelay, "Delay before considering link up, in milliseconds");
module_param(downdelay, int, 0);
131 132
MODULE_PARM_DESC(downdelay, "Delay before considering link down, "
			    "in milliseconds");
L
Linus Torvalds 已提交
133
module_param(use_carrier, int, 0);
134
MODULE_PARM_DESC(use_carrier, "Use netif_carrier_ok (vs MII ioctls) in miimon; "
135
			      "0 for off, 1 for on (default)");
L
Linus Torvalds 已提交
136
module_param(mode, charp, 0);
137
MODULE_PARM_DESC(mode, "Mode of operation; 0 for balance-rr, "
138 139 140
		       "1 for active-backup, 2 for balance-xor, "
		       "3 for broadcast, 4 for 802.3ad, 5 for balance-tlb, "
		       "6 for balance-alb");
L
Linus Torvalds 已提交
141 142
module_param(primary, charp, 0);
MODULE_PARM_DESC(primary, "Primary network device to use");
143 144 145 146 147 148 149 150
module_param(primary_reselect, charp, 0);
MODULE_PARM_DESC(primary_reselect, "Reselect primary slave "
				   "once it comes up; "
				   "0 for always (default), "
				   "1 for only if speed of primary is "
				   "better, "
				   "2 for only on active slave "
				   "failure");
L
Linus Torvalds 已提交
151
module_param(lacp_rate, charp, 0);
152 153
MODULE_PARM_DESC(lacp_rate, "LACPDU tx rate to request from 802.3ad partner; "
			    "0 for slow, 1 for fast");
154
module_param(ad_select, charp, 0);
Z
Zhu Yanjun 已提交
155
MODULE_PARM_DESC(ad_select, "802.3ad aggregation selection logic; "
156 157
			    "0 for stable (default), 1 for bandwidth, "
			    "2 for count");
158 159 160
module_param(min_links, int, 0);
MODULE_PARM_DESC(min_links, "Minimum number of available links before turning on carrier");

161
module_param(xmit_hash_policy, charp, 0);
162
MODULE_PARM_DESC(xmit_hash_policy, "balance-alb, balance-tlb, balance-xor, 802.3ad hashing method; "
163
				   "0 for layer 2 (default), 1 for layer 3+4, "
164 165
				   "2 for layer 2+3, 3 for encap layer 2+3, "
				   "4 for encap layer 3+4");
L
Linus Torvalds 已提交
166 167 168 169
module_param(arp_interval, int, 0);
MODULE_PARM_DESC(arp_interval, "arp interval in milliseconds");
module_param_array(arp_ip_target, charp, NULL, 0);
MODULE_PARM_DESC(arp_ip_target, "arp targets in n.n.n.n form");
170
module_param(arp_validate, charp, 0);
171 172 173
MODULE_PARM_DESC(arp_validate, "validate src/dst of ARP probes; "
			       "0 for none (default), 1 for active, "
			       "2 for backup, 3 for all");
174 175
module_param(arp_all_targets, charp, 0);
MODULE_PARM_DESC(arp_all_targets, "fail on any/all arp targets timeout; 0 for any (default), 1 for all");
176
module_param(fail_over_mac, charp, 0);
177 178 179
MODULE_PARM_DESC(fail_over_mac, "For active-backup, do not set all slaves to "
				"the same MAC; 0 for none (default), "
				"1 for active, 2 for follow");
180
module_param(all_slaves_active, int, 0);
181
MODULE_PARM_DESC(all_slaves_active, "Keep all frames received on an interface "
182
				     "by setting active flag for all slaves; "
183
				     "0 for never (default), 1 for always.");
184
module_param(resend_igmp, int, 0);
185 186
MODULE_PARM_DESC(resend_igmp, "Number of IGMP membership reports to send on "
			      "link failure");
187 188 189 190
module_param(packets_per_slave, int, 0);
MODULE_PARM_DESC(packets_per_slave, "Packets to send per slave in balance-rr "
				    "mode; 0 for a random slave, 1 packet per "
				    "slave (default), >1 packets per slave.");
191 192 193 194
module_param(lp_interval, uint, 0);
MODULE_PARM_DESC(lp_interval, "The number of seconds between instances where "
			      "the bonding driver sends learning packets to "
			      "each slaves peer switch. The default is 1.");
L
Linus Torvalds 已提交
195 196 197

/*----------------------------- Global variables ----------------------------*/

198
#ifdef CONFIG_NET_POLL_CONTROLLER
199
atomic_t netpoll_block_tx = ATOMIC_INIT(0);
200 201
#endif

202
unsigned int bond_net_id __read_mostly;
L
Linus Torvalds 已提交
203 204 205

/*-------------------------- Forward declarations ---------------------------*/

206
static int bond_init(struct net_device *bond_dev);
207
static void bond_uninit(struct net_device *bond_dev);
208 209
static void bond_get_stats(struct net_device *bond_dev,
			   struct rtnl_link_stats64 *stats);
210
static void bond_slave_arr_handler(struct work_struct *work);
211 212
static bool bond_time_in_interval(struct bonding *bond, unsigned long last_act,
				  int mod);
213
static void bond_netdev_notify_work(struct work_struct *work);
L
Linus Torvalds 已提交
214 215 216

/*---------------------------- General routines -----------------------------*/

217
const char *bond_mode_name(int mode)
L
Linus Torvalds 已提交
218
{
219 220 221 222 223
	static const char *names[] = {
		[BOND_MODE_ROUNDROBIN] = "load balancing (round-robin)",
		[BOND_MODE_ACTIVEBACKUP] = "fault-tolerance (active-backup)",
		[BOND_MODE_XOR] = "load balancing (xor)",
		[BOND_MODE_BROADCAST] = "fault-tolerance (broadcast)",
S
Stephen Hemminger 已提交
224
		[BOND_MODE_8023AD] = "IEEE 802.3ad Dynamic link aggregation",
225 226 227 228
		[BOND_MODE_TLB] = "transmit load balancing",
		[BOND_MODE_ALB] = "adaptive load balancing",
	};

229
	if (mode < BOND_MODE_ROUNDROBIN || mode > BOND_MODE_ALB)
L
Linus Torvalds 已提交
230
		return "unknown";
231 232

	return names[mode];
L
Linus Torvalds 已提交
233 234 235 236 237 238
}

/*---------------------------------- VLAN -----------------------------------*/

/**
 * bond_dev_queue_xmit - Prepare skb for xmit.
S
Stephen Hemminger 已提交
239
 *
L
Linus Torvalds 已提交
240 241 242 243
 * @bond: bond device that got this skb for tx.
 * @skb: hw accel VLAN tagged skb to transmit
 * @slave_dev: slave that is supposed to xmit this skbuff
 */
244
void bond_dev_queue_xmit(struct bonding *bond, struct sk_buff *skb,
S
Stephen Hemminger 已提交
245
			struct net_device *slave_dev)
L
Linus Torvalds 已提交
246
{
247
	skb->dev = slave_dev;
248

249
	BUILD_BUG_ON(sizeof(skb->queue_mapping) !=
250
		     sizeof(qdisc_skb_cb(skb)->slave_dev_queue_mapping));
251
	skb_set_queue_mapping(skb, qdisc_skb_cb(skb)->slave_dev_queue_mapping);
252

253
	if (unlikely(netpoll_tx_running(bond->dev)))
254
		bond_netpoll_send_skb(bond_get_slave_by_dev(bond, slave_dev), skb);
255
	else
256
		dev_queue_xmit(skb);
L
Linus Torvalds 已提交
257 258
}

259
/* In the following 2 functions, bond_vlan_rx_add_vid and bond_vlan_rx_kill_vid,
J
Jiri Pirko 已提交
260
 * We don't protect the slave list iteration with a lock because:
L
Linus Torvalds 已提交
261 262 263 264
 * a. This operation is performed in IOCTL context,
 * b. The operation is protected by the RTNL semaphore in the 8021q code,
 * c. Holding a lock with BH disabled while directly calling a base driver
 *    entry point is generally a BAD idea.
S
Stephen Hemminger 已提交
265
 *
L
Linus Torvalds 已提交
266 267 268 269 270 271 272 273 274 275 276 277 278 279
 * The design of synchronization/protection for this operation in the 8021q
 * module is good for one or more VLAN devices over a single physical device
 * and cannot be extended for a teaming solution like bonding, so there is a
 * potential race condition here where a net device from the vlan group might
 * be referenced (either by a base driver or the 8021q code) while it is being
 * removed from the system. However, it turns out we're not making matters
 * worse, and if it works for regular VLAN usage it will work here too.
*/

/**
 * bond_vlan_rx_add_vid - Propagates adding an id to slaves
 * @bond_dev: bonding net device that got called
 * @vid: vlan id being added
 */
280 281
static int bond_vlan_rx_add_vid(struct net_device *bond_dev,
				__be16 proto, u16 vid)
L
Linus Torvalds 已提交
282
{
283
	struct bonding *bond = netdev_priv(bond_dev);
284
	struct slave *slave, *rollback_slave;
285
	struct list_head *iter;
286
	int res;
L
Linus Torvalds 已提交
287

288
	bond_for_each_slave(bond, slave, iter) {
289
		res = vlan_vid_add(slave->dev, proto, vid);
290 291
		if (res)
			goto unwind;
L
Linus Torvalds 已提交
292 293
	}

294
	return 0;
295 296

unwind:
297
	/* unwind to the slave that failed */
298
	bond_for_each_slave(bond, rollback_slave, iter) {
299 300 301 302 303
		if (rollback_slave == slave)
			break;

		vlan_vid_del(rollback_slave->dev, proto, vid);
	}
304 305

	return res;
L
Linus Torvalds 已提交
306 307 308 309 310 311 312
}

/**
 * bond_vlan_rx_kill_vid - Propagates deleting an id to slaves
 * @bond_dev: bonding net device that got called
 * @vid: vlan id being removed
 */
313 314
static int bond_vlan_rx_kill_vid(struct net_device *bond_dev,
				 __be16 proto, u16 vid)
L
Linus Torvalds 已提交
315
{
316
	struct bonding *bond = netdev_priv(bond_dev);
317
	struct list_head *iter;
L
Linus Torvalds 已提交
318 319
	struct slave *slave;

320
	bond_for_each_slave(bond, slave, iter)
321
		vlan_vid_del(slave->dev, proto, vid);
L
Linus Torvalds 已提交
322

323 324
	if (bond_is_lb(bond))
		bond_alb_clear_vlan(bond, vid);
325 326

	return 0;
L
Linus Torvalds 已提交
327 328 329 330
}

/*------------------------------- Link status -------------------------------*/

331
/* Set the carrier state for the master according to the state of its
332 333 334 335 336
 * slaves.  If any slaves are up, the master is up.  In 802.3ad mode,
 * do special 802.3ad magic.
 *
 * Returns zero if carrier state does not change, nonzero if it does.
 */
337
int bond_set_carrier(struct bonding *bond)
338
{
339
	struct list_head *iter;
340 341
	struct slave *slave;

342
	if (!bond_has_slaves(bond))
343 344
		goto down;

345
	if (BOND_MODE(bond) == BOND_MODE_8023AD)
346 347
		return bond_3ad_set_carrier(bond);

348
	bond_for_each_slave(bond, slave, iter) {
349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365
		if (slave->link == BOND_LINK_UP) {
			if (!netif_carrier_ok(bond->dev)) {
				netif_carrier_on(bond->dev);
				return 1;
			}
			return 0;
		}
	}

down:
	if (netif_carrier_ok(bond->dev)) {
		netif_carrier_off(bond->dev);
		return 1;
	}
	return 0;
}

366
/* Get link speed and duplex from the slave's base driver
L
Linus Torvalds 已提交
367
 * using ethtool. If for some reason the call fails or the
368
 * values are invalid, set speed and duplex to -1,
369 370
 * and return. Return 1 if speed or duplex settings are
 * UNKNOWN; 0 otherwise.
L
Linus Torvalds 已提交
371
 */
372
static int bond_update_speed_duplex(struct slave *slave)
L
Linus Torvalds 已提交
373 374
{
	struct net_device *slave_dev = slave->dev;
375
	struct ethtool_link_ksettings ecmd;
376
	int res;
L
Linus Torvalds 已提交
377

378 379
	slave->speed = SPEED_UNKNOWN;
	slave->duplex = DUPLEX_UNKNOWN;
L
Linus Torvalds 已提交
380

381
	res = __ethtool_get_link_ksettings(slave_dev, &ecmd);
382
	if (res < 0)
383
		return 1;
384
	if (ecmd.base.speed == 0 || ecmd.base.speed == ((__u32)-1))
385
		return 1;
386
	switch (ecmd.base.duplex) {
L
Linus Torvalds 已提交
387 388 389 390
	case DUPLEX_FULL:
	case DUPLEX_HALF:
		break;
	default:
391
		return 1;
L
Linus Torvalds 已提交
392 393
	}

394 395
	slave->speed = ecmd.base.speed;
	slave->duplex = ecmd.base.duplex;
L
Linus Torvalds 已提交
396

397
	return 0;
L
Linus Torvalds 已提交
398 399
}

400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415
const char *bond_slave_link_status(s8 link)
{
	switch (link) {
	case BOND_LINK_UP:
		return "up";
	case BOND_LINK_FAIL:
		return "going down";
	case BOND_LINK_DOWN:
		return "down";
	case BOND_LINK_BACK:
		return "going back";
	default:
		return "unknown";
	}
}

416
/* if <dev> supports MII link status reporting, check its link status.
L
Linus Torvalds 已提交
417 418
 *
 * We either do MII/ETHTOOL ioctls, or check netif_carrier_ok(),
S
Stephen Hemminger 已提交
419
 * depending upon the setting of the use_carrier parameter.
L
Linus Torvalds 已提交
420 421 422 423 424 425 426 427 428 429 430
 *
 * Return either BMSR_LSTATUS, meaning that the link is up (or we
 * can't tell and just pretend it is), or 0, meaning that the link is
 * down.
 *
 * If reporting is non-zero, instead of faking link up, return -1 if
 * both ETHTOOL and MII ioctls fail (meaning the device does not
 * support them).  If use_carrier is set, return whatever it says.
 * It'd be nice if there was a good way to tell if a driver supports
 * netif_carrier, but there really isn't.
 */
S
Stephen Hemminger 已提交
431 432
static int bond_check_dev_link(struct bonding *bond,
			       struct net_device *slave_dev, int reporting)
L
Linus Torvalds 已提交
433
{
434
	const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
435
	int (*ioctl)(struct net_device *, struct ifreq *, int);
L
Linus Torvalds 已提交
436 437 438
	struct ifreq ifr;
	struct mii_ioctl_data *mii;

439 440 441
	if (!reporting && !netif_running(slave_dev))
		return 0;

442
	if (bond->params.use_carrier)
443
		return netif_carrier_ok(slave_dev) ? BMSR_LSTATUS : 0;
L
Linus Torvalds 已提交
444

445
	/* Try to get link status using Ethtool first. */
446 447 448
	if (slave_dev->ethtool_ops->get_link)
		return slave_dev->ethtool_ops->get_link(slave_dev) ?
			BMSR_LSTATUS : 0;
449

S
Stephen Hemminger 已提交
450
	/* Ethtool can't be used, fallback to MII ioctls. */
451
	ioctl = slave_ops->ndo_do_ioctl;
L
Linus Torvalds 已提交
452
	if (ioctl) {
453 454 455 456 457 458 459 460
		/* TODO: set pointer to correct ioctl on a per team member
		 *       bases to make this more efficient. that is, once
		 *       we determine the correct ioctl, we will always
		 *       call it and not the others for that team
		 *       member.
		 */

		/* We cannot assume that SIOCGMIIPHY will also read a
L
Linus Torvalds 已提交
461 462 463 464 465 466 467
		 * register; not all network drivers (e.g., e100)
		 * support that.
		 */

		/* Yes, the mii is overlaid on the ifreq.ifr_ifru */
		strncpy(ifr.ifr_name, slave_dev->name, IFNAMSIZ);
		mii = if_mii(&ifr);
A
Al Viro 已提交
468
		if (ioctl(slave_dev, &ifr, SIOCGMIIPHY) == 0) {
L
Linus Torvalds 已提交
469
			mii->reg_num = MII_BMSR;
A
Al Viro 已提交
470
			if (ioctl(slave_dev, &ifr, SIOCGMIIREG) == 0)
S
Stephen Hemminger 已提交
471
				return mii->val_out & BMSR_LSTATUS;
L
Linus Torvalds 已提交
472 473 474
		}
	}

475
	/* If reporting, report that either there's no dev->do_ioctl,
476
	 * or both SIOCGMIIREG and get_link failed (meaning that we
L
Linus Torvalds 已提交
477 478 479
	 * cannot report link status).  If not reporting, pretend
	 * we're ok.
	 */
S
Stephen Hemminger 已提交
480
	return reporting ? -1 : BMSR_LSTATUS;
L
Linus Torvalds 已提交
481 482 483 484
}

/*----------------------------- Multicast list ------------------------------*/

485
/* Push the promiscuity flag down to appropriate slaves */
486
static int bond_set_promiscuity(struct bonding *bond, int inc)
L
Linus Torvalds 已提交
487
{
488
	struct list_head *iter;
489
	int err = 0;
490

491
	if (bond_uses_primary(bond)) {
492
		struct slave *curr_active = rtnl_dereference(bond->curr_active_slave);
493 494 495

		if (curr_active)
			err = dev_set_promiscuity(curr_active->dev, inc);
L
Linus Torvalds 已提交
496 497
	} else {
		struct slave *slave;
498

499
		bond_for_each_slave(bond, slave, iter) {
500 501 502
			err = dev_set_promiscuity(slave->dev, inc);
			if (err)
				return err;
L
Linus Torvalds 已提交
503 504
		}
	}
505
	return err;
L
Linus Torvalds 已提交
506 507
}

508
/* Push the allmulti flag down to all slaves */
509
static int bond_set_allmulti(struct bonding *bond, int inc)
L
Linus Torvalds 已提交
510
{
511
	struct list_head *iter;
512
	int err = 0;
513

514
	if (bond_uses_primary(bond)) {
515
		struct slave *curr_active = rtnl_dereference(bond->curr_active_slave);
516 517 518

		if (curr_active)
			err = dev_set_allmulti(curr_active->dev, inc);
L
Linus Torvalds 已提交
519 520
	} else {
		struct slave *slave;
521

522
		bond_for_each_slave(bond, slave, iter) {
523 524 525
			err = dev_set_allmulti(slave->dev, inc);
			if (err)
				return err;
L
Linus Torvalds 已提交
526 527
		}
	}
528
	return err;
L
Linus Torvalds 已提交
529 530
}

531
/* Retrieve the list of registered multicast addresses for the bonding
532 533 534
 * device and retransmit an IGMP JOIN request to the current active
 * slave.
 */
535
static void bond_resend_igmp_join_requests_delayed(struct work_struct *work)
536
{
537 538 539
	struct bonding *bond = container_of(work, struct bonding,
					    mcast_work.work);

540
	if (!rtnl_trylock()) {
541
		queue_delayed_work(bond->wq, &bond->mcast_work, 1);
542
		return;
543
	}
544
	call_netdevice_notifiers(NETDEV_RESEND_IGMP, bond->dev);
545

546 547
	if (bond->igmp_retrans > 1) {
		bond->igmp_retrans--;
548
		queue_delayed_work(bond->wq, &bond->mcast_work, HZ/5);
549
	}
550
	rtnl_unlock();
551 552
}

553
/* Flush bond's hardware addresses from slave */
554
static void bond_hw_addr_flush(struct net_device *bond_dev,
S
Stephen Hemminger 已提交
555
			       struct net_device *slave_dev)
L
Linus Torvalds 已提交
556
{
557
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
558

559 560
	dev_uc_unsync(slave_dev, bond_dev);
	dev_mc_unsync(slave_dev, bond_dev);
L
Linus Torvalds 已提交
561

562
	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
L
Linus Torvalds 已提交
563 564 565
		/* del lacpdu mc addr from mc list */
		u8 lacpdu_multicast[ETH_ALEN] = MULTICAST_LACPDU_ADDR;

566
		dev_mc_del(slave_dev, lacpdu_multicast);
L
Linus Torvalds 已提交
567 568 569 570 571
	}
}

/*--------------------------- Active slave change ---------------------------*/

572
/* Update the hardware address list and promisc/allmulti for the new and
573 574
 * old active slaves (if any).  Modes that are not using primary keep all
 * slaves up date at all times; only the modes that use primary need to call
575
 * this function to swap these settings during a failover.
L
Linus Torvalds 已提交
576
 */
577 578
static void bond_hw_addr_swap(struct bonding *bond, struct slave *new_active,
			      struct slave *old_active)
L
Linus Torvalds 已提交
579 580
{
	if (old_active) {
S
Stephen Hemminger 已提交
581
		if (bond->dev->flags & IFF_PROMISC)
L
Linus Torvalds 已提交
582 583
			dev_set_promiscuity(old_active->dev, -1);

S
Stephen Hemminger 已提交
584
		if (bond->dev->flags & IFF_ALLMULTI)
L
Linus Torvalds 已提交
585 586
			dev_set_allmulti(old_active->dev, -1);

587
		bond_hw_addr_flush(bond->dev, old_active->dev);
L
Linus Torvalds 已提交
588 589 590
	}

	if (new_active) {
591
		/* FIXME: Signal errors upstream. */
S
Stephen Hemminger 已提交
592
		if (bond->dev->flags & IFF_PROMISC)
L
Linus Torvalds 已提交
593 594
			dev_set_promiscuity(new_active->dev, 1);

S
Stephen Hemminger 已提交
595
		if (bond->dev->flags & IFF_ALLMULTI)
L
Linus Torvalds 已提交
596 597
			dev_set_allmulti(new_active->dev, 1);

598
		netif_addr_lock_bh(bond->dev);
599 600
		dev_uc_sync(new_active->dev, bond->dev);
		dev_mc_sync(new_active->dev, bond->dev);
601
		netif_addr_unlock_bh(bond->dev);
L
Linus Torvalds 已提交
602 603 604
	}
}

605 606 607 608 609 610 611 612 613 614
/**
 * bond_set_dev_addr - clone slave's address to bond
 * @bond_dev: bond net device
 * @slave_dev: slave net device
 *
 * Should be called with RTNL held.
 */
static void bond_set_dev_addr(struct net_device *bond_dev,
			      struct net_device *slave_dev)
{
615 616
	netdev_dbg(bond_dev, "bond_dev=%p slave_dev=%p slave_dev->name=%s slave_dev->addr_len=%d\n",
		   bond_dev, slave_dev, slave_dev->name, slave_dev->addr_len);
617 618 619 620 621
	memcpy(bond_dev->dev_addr, slave_dev->dev_addr, slave_dev->addr_len);
	bond_dev->addr_assign_type = NET_ADDR_STOLEN;
	call_netdevice_notifiers(NETDEV_CHANGEADDR, bond_dev);
}

622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
static struct slave *bond_get_old_active(struct bonding *bond,
					 struct slave *new_active)
{
	struct slave *slave;
	struct list_head *iter;

	bond_for_each_slave(bond, slave, iter) {
		if (slave == new_active)
			continue;

		if (ether_addr_equal(bond->dev->dev_addr, slave->dev->dev_addr))
			return slave;
	}

	return NULL;
}

639
/* bond_do_fail_over_mac
640 641 642
 *
 * Perform special MAC address swapping for fail_over_mac settings
 *
643
 * Called with RTNL
644 645 646 647 648
 */
static void bond_do_fail_over_mac(struct bonding *bond,
				  struct slave *new_active,
				  struct slave *old_active)
{
649 650
	u8 tmp_mac[MAX_ADDR_LEN];
	struct sockaddr_storage ss;
651 652 653 654
	int rv;

	switch (bond->params.fail_over_mac) {
	case BOND_FOM_ACTIVE:
655
		if (new_active)
656
			bond_set_dev_addr(bond->dev, new_active->dev);
657 658
		break;
	case BOND_FOM_FOLLOW:
659
		/* if new_active && old_active, swap them
660 661 662 663 664 665
		 * if just old_active, do nothing (going to no active slave)
		 * if just new_active, set new_active to bond's MAC
		 */
		if (!new_active)
			return;

666 667 668
		if (!old_active)
			old_active = bond_get_old_active(bond, new_active);

669
		if (old_active) {
670 671 672 673 674 675
			bond_hw_addr_copy(tmp_mac, new_active->dev->dev_addr,
					  new_active->dev->addr_len);
			bond_hw_addr_copy(ss.__data,
					  old_active->dev->dev_addr,
					  old_active->dev->addr_len);
			ss.ss_family = new_active->dev->type;
676
		} else {
677 678 679
			bond_hw_addr_copy(ss.__data, bond->dev->dev_addr,
					  bond->dev->addr_len);
			ss.ss_family = bond->dev->type;
680 681
		}

682 683
		rv = dev_set_mac_address(new_active->dev,
					 (struct sockaddr *)&ss);
684
		if (rv) {
685 686
			netdev_err(bond->dev, "Error %d setting MAC of slave %s\n",
				   -rv, new_active->dev->name);
687 688 689 690 691 692
			goto out;
		}

		if (!old_active)
			goto out;

693 694 695
		bond_hw_addr_copy(ss.__data, tmp_mac,
				  new_active->dev->addr_len);
		ss.ss_family = old_active->dev->type;
696

697 698
		rv = dev_set_mac_address(old_active->dev,
					 (struct sockaddr *)&ss);
699
		if (rv)
700 701
			netdev_err(bond->dev, "Error %d setting MAC of slave %s\n",
				   -rv, new_active->dev->name);
702 703 704
out:
		break;
	default:
705 706
		netdev_err(bond->dev, "bond_do_fail_over_mac impossible: bad policy %d\n",
			   bond->params.fail_over_mac);
707 708 709 710 711
		break;
	}

}

712
static struct slave *bond_choose_primary_or_current(struct bonding *bond)
713
{
714
	struct slave *prim = rtnl_dereference(bond->primary_slave);
715
	struct slave *curr = rtnl_dereference(bond->curr_active_slave);
716

717 718 719 720 721 722
	if (!prim || prim->link != BOND_LINK_UP) {
		if (!curr || curr->link != BOND_LINK_UP)
			return NULL;
		return curr;
	}

723 724
	if (bond->force_primary) {
		bond->force_primary = false;
725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746
		return prim;
	}

	if (!curr || curr->link != BOND_LINK_UP)
		return prim;

	/* At this point, prim and curr are both up */
	switch (bond->params.primary_reselect) {
	case BOND_PRI_RESELECT_ALWAYS:
		return prim;
	case BOND_PRI_RESELECT_BETTER:
		if (prim->speed < curr->speed)
			return curr;
		if (prim->speed == curr->speed && prim->duplex <= curr->duplex)
			return curr;
		return prim;
	case BOND_PRI_RESELECT_FAILURE:
		return curr;
	default:
		netdev_err(bond->dev, "impossible primary_reselect %d\n",
			   bond->params.primary_reselect);
		return curr;
747 748
	}
}
749

L
Linus Torvalds 已提交
750
/**
751
 * bond_find_best_slave - select the best available slave to be the active one
L
Linus Torvalds 已提交
752 753 754 755
 * @bond: our bonding struct
 */
static struct slave *bond_find_best_slave(struct bonding *bond)
{
756
	struct slave *slave, *bestslave = NULL;
757
	struct list_head *iter;
L
Linus Torvalds 已提交
758 759
	int mintime = bond->params.updelay;

760 761 762
	slave = bond_choose_primary_or_current(bond);
	if (slave)
		return slave;
L
Linus Torvalds 已提交
763

764 765 766
	bond_for_each_slave(bond, slave, iter) {
		if (slave->link == BOND_LINK_UP)
			return slave;
767
		if (slave->link == BOND_LINK_BACK && bond_slave_is_up(slave) &&
768 769 770
		    slave->delay < mintime) {
			mintime = slave->delay;
			bestslave = slave;
L
Linus Torvalds 已提交
771 772 773 774 775 776
		}
	}

	return bestslave;
}

777 778
static bool bond_should_notify_peers(struct bonding *bond)
{
779 780 781 782 783
	struct slave *slave;

	rcu_read_lock();
	slave = rcu_dereference(bond->curr_active_slave);
	rcu_read_unlock();
784

785 786
	netdev_dbg(bond->dev, "bond_should_notify_peers: slave %s\n",
		   slave ? slave->dev->name : "NULL");
787 788

	if (!slave || !bond->send_peer_notif ||
789
	    !netif_carrier_ok(bond->dev) ||
790 791 792 793 794 795
	    test_bit(__LINK_STATE_LINKWATCH_PENDING, &slave->dev->state))
		return false;

	return true;
}

L
Linus Torvalds 已提交
796 797 798 799 800 801 802 803 804 805 806 807 808
/**
 * change_active_interface - change the active slave into the specified one
 * @bond: our bonding struct
 * @new: the new slave to make the active one
 *
 * Set the new slave to the bond's settings and unset them on the old
 * curr_active_slave.
 * Setting include flags, mc-list, promiscuity, allmulti, etc.
 *
 * If @new's link state is %BOND_LINK_BACK we'll set it to %BOND_LINK_UP,
 * because it is apparently the best available slave we have, even though its
 * updelay hasn't timed out yet.
 *
809
 * Caller must hold RTNL.
L
Linus Torvalds 已提交
810
 */
811
void bond_change_active_slave(struct bonding *bond, struct slave *new_active)
L
Linus Torvalds 已提交
812
{
813 814
	struct slave *old_active;

815 816 817
	ASSERT_RTNL();

	old_active = rtnl_dereference(bond->curr_active_slave);
L
Linus Torvalds 已提交
818

S
Stephen Hemminger 已提交
819
	if (old_active == new_active)
L
Linus Torvalds 已提交
820 821 822
		return;

	if (new_active) {
823
		new_active->last_link_up = jiffies;
824

L
Linus Torvalds 已提交
825
		if (new_active->link == BOND_LINK_BACK) {
826
			if (bond_uses_primary(bond)) {
827 828 829
				netdev_info(bond->dev, "making interface %s the new active one %d ms earlier\n",
					    new_active->dev->name,
					    (bond->params.updelay - new_active->delay) * bond->params.miimon);
L
Linus Torvalds 已提交
830 831 832
			}

			new_active->delay = 0;
833 834
			bond_set_slave_link_state(new_active, BOND_LINK_UP,
						  BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
835

836
			if (BOND_MODE(bond) == BOND_MODE_8023AD)
L
Linus Torvalds 已提交
837 838
				bond_3ad_handle_link_change(new_active, BOND_LINK_UP);

839
			if (bond_is_lb(bond))
L
Linus Torvalds 已提交
840 841
				bond_alb_handle_link_change(bond, new_active, BOND_LINK_UP);
		} else {
842
			if (bond_uses_primary(bond)) {
843 844
				netdev_info(bond->dev, "making interface %s the new active one\n",
					    new_active->dev->name);
L
Linus Torvalds 已提交
845 846 847 848
			}
		}
	}

849
	if (bond_uses_primary(bond))
850
		bond_hw_addr_swap(bond, new_active, old_active);
L
Linus Torvalds 已提交
851

852
	if (bond_is_lb(bond)) {
L
Linus Torvalds 已提交
853
		bond_alb_handle_active_change(bond, new_active);
854
		if (old_active)
855 856
			bond_set_slave_inactive_flags(old_active,
						      BOND_SLAVE_NOTIFY_NOW);
857
		if (new_active)
858 859
			bond_set_slave_active_flags(new_active,
						    BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
860
	} else {
861
		rcu_assign_pointer(bond->curr_active_slave, new_active);
L
Linus Torvalds 已提交
862
	}
J
Jay Vosburgh 已提交
863

864
	if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP) {
S
Stephen Hemminger 已提交
865
		if (old_active)
866 867
			bond_set_slave_inactive_flags(old_active,
						      BOND_SLAVE_NOTIFY_NOW);
J
Jay Vosburgh 已提交
868 869

		if (new_active) {
870 871
			bool should_notify_peers = false;

872 873
			bond_set_slave_active_flags(new_active,
						    BOND_SLAVE_NOTIFY_NOW);
874

875 876 877
			if (bond->params.fail_over_mac)
				bond_do_fail_over_mac(bond, new_active,
						      old_active);
878

879 880 881 882 883 884 885
			if (netif_running(bond->dev)) {
				bond->send_peer_notif =
					bond->params.num_peer_notif;
				should_notify_peers =
					bond_should_notify_peers(bond);
			}

886
			call_netdevice_notifiers(NETDEV_BONDING_FAILOVER, bond->dev);
887
			if (should_notify_peers)
888 889
				call_netdevice_notifiers(NETDEV_NOTIFY_PEERS,
							 bond->dev);
890
		}
J
Jay Vosburgh 已提交
891
	}
892

893
	/* resend IGMP joins since active slave has changed or
894 895
	 * all were sent on curr_active_slave.
	 * resend only if bond is brought up with the affected
896 897
	 * bonding modes and the retransmission is enabled
	 */
898
	if (netif_running(bond->dev) && (bond->params.resend_igmp > 0) &&
899
	    ((bond_uses_primary(bond) && new_active) ||
900
	     BOND_MODE(bond) == BOND_MODE_ROUNDROBIN)) {
901
		bond->igmp_retrans = bond->params.resend_igmp;
902
		queue_delayed_work(bond->wq, &bond->mcast_work, 1);
903
	}
L
Linus Torvalds 已提交
904 905 906 907 908 909
}

/**
 * bond_select_active_slave - select a new active slave, if needed
 * @bond: our bonding struct
 *
S
Stephen Hemminger 已提交
910
 * This functions should be called when one of the following occurs:
L
Linus Torvalds 已提交
911 912 913 914
 * - The old curr_active_slave has been released or lost its link.
 * - The primary_slave has got its link back.
 * - A slave has got its link back and there's no old curr_active_slave.
 *
915
 * Caller must hold RTNL.
L
Linus Torvalds 已提交
916
 */
917
void bond_select_active_slave(struct bonding *bond)
L
Linus Torvalds 已提交
918 919
{
	struct slave *best_slave;
920
	int rv;
L
Linus Torvalds 已提交
921

922 923
	ASSERT_RTNL();

L
Linus Torvalds 已提交
924
	best_slave = bond_find_best_slave(bond);
925
	if (best_slave != rtnl_dereference(bond->curr_active_slave)) {
L
Linus Torvalds 已提交
926
		bond_change_active_slave(bond, best_slave);
927 928 929 930
		rv = bond_set_carrier(bond);
		if (!rv)
			return;

Z
Zhang Shengju 已提交
931
		if (netif_carrier_ok(bond->dev))
932
			netdev_info(bond->dev, "first active interface up!\n");
Z
Zhang Shengju 已提交
933
		else
934
			netdev_info(bond->dev, "now running without any active interface!\n");
L
Linus Torvalds 已提交
935 936 937
	}
}

938
#ifdef CONFIG_NET_POLL_CONTROLLER
939
static inline int slave_enable_netpoll(struct slave *slave)
940
{
941 942
	struct netpoll *np;
	int err = 0;
943

944
	np = kzalloc(sizeof(*np), GFP_KERNEL);
945 946 947 948
	err = -ENOMEM;
	if (!np)
		goto out;

949
	err = __netpoll_setup(np, slave->dev);
950 951 952
	if (err) {
		kfree(np);
		goto out;
953
	}
954 955 956 957 958 959 960 961 962 963 964 965
	slave->np = np;
out:
	return err;
}
static inline void slave_disable_netpoll(struct slave *slave)
{
	struct netpoll *np = slave->np;

	if (!np)
		return;

	slave->np = NULL;
966
	__netpoll_free_async(np);
967
}
968 969 970

static void bond_poll_controller(struct net_device *bond_dev)
{
971 972 973 974 975 976 977 978 979 980
	struct bonding *bond = netdev_priv(bond_dev);
	struct slave *slave = NULL;
	struct list_head *iter;
	struct ad_info ad_info;

	if (BOND_MODE(bond) == BOND_MODE_8023AD)
		if (bond_3ad_get_active_agg_info(bond, &ad_info))
			return;

	bond_for_each_slave_rcu(bond, slave, iter) {
981
		if (!bond_slave_is_up(slave))
982 983 984 985 986 987 988 989 990 991 992
			continue;

		if (BOND_MODE(bond) == BOND_MODE_8023AD) {
			struct aggregator *agg =
			    SLAVE_AD_INFO(slave)->port.aggregator;

			if (agg &&
			    agg->aggregator_identifier != ad_info.aggregator_id)
				continue;
		}

993
		netpoll_poll_dev(slave->dev);
994
	}
995 996
}

997
static void bond_netpoll_cleanup(struct net_device *bond_dev)
998
{
999
	struct bonding *bond = netdev_priv(bond_dev);
1000
	struct list_head *iter;
1001 1002
	struct slave *slave;

1003
	bond_for_each_slave(bond, slave, iter)
1004
		if (bond_slave_is_up(slave))
1005
			slave_disable_netpoll(slave);
1006
}
1007

1008
static int bond_netpoll_setup(struct net_device *dev, struct netpoll_info *ni)
1009 1010
{
	struct bonding *bond = netdev_priv(dev);
1011
	struct list_head *iter;
1012
	struct slave *slave;
1013
	int err = 0;
1014

1015
	bond_for_each_slave(bond, slave, iter) {
1016 1017
		err = slave_enable_netpoll(slave);
		if (err) {
1018
			bond_netpoll_cleanup(dev);
1019
			break;
1020 1021
		}
	}
1022
	return err;
1023
}
1024 1025 1026 1027 1028 1029 1030 1031
#else
static inline int slave_enable_netpoll(struct slave *slave)
{
	return 0;
}
static inline void slave_disable_netpoll(struct slave *slave)
{
}
1032 1033 1034 1035 1036
static void bond_netpoll_cleanup(struct net_device *bond_dev)
{
}
#endif

L
Linus Torvalds 已提交
1037 1038
/*---------------------------------- IOCTL ----------------------------------*/

1039
static netdev_features_t bond_fix_features(struct net_device *dev,
1040
					   netdev_features_t features)
1041
{
1042
	struct bonding *bond = netdev_priv(dev);
1043
	struct list_head *iter;
1044
	netdev_features_t mask;
1045
	struct slave *slave;
1046

1047
	mask = features;
1048

1049
	features &= ~NETIF_F_ONE_FOR_ALL;
1050
	features |= NETIF_F_ALL_FOR_ALL;
1051

1052
	bond_for_each_slave(bond, slave, iter) {
1053 1054
		features = netdev_increment_features(features,
						     slave->dev->features,
1055 1056
						     mask);
	}
1057
	features = netdev_add_tso_features(features, mask);
1058 1059 1060 1061

	return features;
}

1062
#define BOND_VLAN_FEATURES	(NETIF_F_HW_CSUM | NETIF_F_SG | \
1063 1064
				 NETIF_F_FRAGLIST | NETIF_F_ALL_TSO | \
				 NETIF_F_HIGHDMA | NETIF_F_LRO)
1065

1066 1067
#define BOND_ENC_FEATURES	(NETIF_F_HW_CSUM | NETIF_F_SG | \
				 NETIF_F_RXCSUM | NETIF_F_ALL_TSO)
1068

1069 1070
static void bond_compute_features(struct bonding *bond)
{
1071 1072
	unsigned int dst_release_flag = IFF_XMIT_DST_RELEASE |
					IFF_XMIT_DST_RELEASE_PERM;
1073
	netdev_features_t vlan_features = BOND_VLAN_FEATURES;
1074
	netdev_features_t enc_features  = BOND_ENC_FEATURES;
1075 1076 1077
	struct net_device *bond_dev = bond->dev;
	struct list_head *iter;
	struct slave *slave;
1078
	unsigned short max_hard_header_len = ETH_HLEN;
1079 1080
	unsigned int gso_max_size = GSO_MAX_SIZE;
	u16 gso_max_segs = GSO_MAX_SEGS;
1081

1082
	if (!bond_has_slaves(bond))
1083
		goto done;
1084
	vlan_features &= NETIF_F_ALL_FOR_ALL;
1085

1086
	bond_for_each_slave(bond, slave, iter) {
1087
		vlan_features = netdev_increment_features(vlan_features,
1088 1089
			slave->dev->vlan_features, BOND_VLAN_FEATURES);

1090 1091 1092
		enc_features = netdev_increment_features(enc_features,
							 slave->dev->hw_enc_features,
							 BOND_ENC_FEATURES);
1093
		dst_release_flag &= slave->dev->priv_flags;
1094 1095
		if (slave->dev->hard_header_len > max_hard_header_len)
			max_hard_header_len = slave->dev->hard_header_len;
1096 1097 1098

		gso_max_size = min(gso_max_size, slave->dev->gso_max_size);
		gso_max_segs = min(gso_max_segs, slave->dev->gso_max_segs);
1099
	}
1100
	bond_dev->hard_header_len = max_hard_header_len;
1101

1102
done:
1103
	bond_dev->vlan_features = vlan_features;
1104 1105
	bond_dev->hw_enc_features = enc_features | NETIF_F_GSO_ENCAP_ALL |
				    NETIF_F_GSO_UDP_L4;
1106 1107
	bond_dev->gso_max_segs = gso_max_segs;
	netif_set_gso_max_size(bond_dev, gso_max_size);
1108

1109 1110 1111 1112
	bond_dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
	if ((bond_dev->priv_flags & IFF_XMIT_DST_RELEASE_PERM) &&
	    dst_release_flag == (IFF_XMIT_DST_RELEASE | IFF_XMIT_DST_RELEASE_PERM))
		bond_dev->priv_flags |= IFF_XMIT_DST_RELEASE;
1113

1114
	netdev_change_features(bond_dev);
1115 1116
}

1117 1118 1119
static void bond_setup_by_slave(struct net_device *bond_dev,
				struct net_device *slave_dev)
{
1120
	bond_dev->header_ops	    = slave_dev->header_ops;
1121 1122 1123 1124 1125 1126 1127 1128 1129

	bond_dev->type		    = slave_dev->type;
	bond_dev->hard_header_len   = slave_dev->hard_header_len;
	bond_dev->addr_len	    = slave_dev->addr_len;

	memcpy(bond_dev->broadcast, slave_dev->broadcast,
		slave_dev->addr_len);
}

1130
/* On bonding slaves other than the currently active slave, suppress
1131
 * duplicates except for alb non-mcast/bcast.
1132 1133
 */
static bool bond_should_deliver_exact_match(struct sk_buff *skb,
1134 1135
					    struct slave *slave,
					    struct bonding *bond)
1136
{
1137
	if (bond_is_slave_inactive(slave)) {
1138
		if (BOND_MODE(bond) == BOND_MODE_ALB &&
1139 1140 1141 1142 1143 1144 1145 1146
		    skb->pkt_type != PACKET_BROADCAST &&
		    skb->pkt_type != PACKET_MULTICAST)
			return false;
		return true;
	}
	return false;
}

1147
static rx_handler_result_t bond_handle_frame(struct sk_buff **pskb)
1148
{
1149
	struct sk_buff *skb = *pskb;
1150
	struct slave *slave;
1151
	struct bonding *bond;
1152 1153
	int (*recv_probe)(const struct sk_buff *, struct bonding *,
			  struct slave *);
1154
	int ret = RX_HANDLER_ANOTHER;
1155

1156 1157 1158 1159 1160
	skb = skb_share_check(skb, GFP_ATOMIC);
	if (unlikely(!skb))
		return RX_HANDLER_CONSUMED;

	*pskb = skb;
1161

J
Jiri Pirko 已提交
1162 1163
	slave = bond_slave_get_rcu(skb->dev);
	bond = slave->bond;
1164

1165
	recv_probe = READ_ONCE(bond->recv_probe);
1166
	if (recv_probe) {
1167 1168 1169 1170
		ret = recv_probe(skb, bond, slave);
		if (ret == RX_HANDLER_CONSUMED) {
			consume_skb(skb);
			return ret;
1171 1172 1173
		}
	}

1174 1175 1176 1177 1178 1179 1180 1181 1182 1183
	/*
	 * For packets determined by bond_should_deliver_exact_match() call to
	 * be suppressed we want to make an exception for link-local packets.
	 * This is necessary for e.g. LLDP daemons to be able to monitor
	 * inactive slave links without being forced to bind to them
	 * explicitly.
	 *
	 * At the same time, packets that are passed to the bonding master
	 * (including link-local ones) can have their originating interface
	 * determined via PACKET_ORIGDEV socket option.
1184
	 */
1185 1186 1187
	if (bond_should_deliver_exact_match(skb, slave, bond)) {
		if (is_link_local_ether_addr(eth_hdr(skb)->h_dest))
			return RX_HANDLER_PASS;
1188
		return RX_HANDLER_EXACT;
1189
	}
1190

J
Jiri Pirko 已提交
1191
	skb->dev = bond->dev;
1192

1193
	if (BOND_MODE(bond) == BOND_MODE_ALB &&
J
Jiri Pirko 已提交
1194
	    bond->dev->priv_flags & IFF_BRIDGE_PORT &&
1195 1196
	    skb->pkt_type == PACKET_HOST) {

1197 1198 1199
		if (unlikely(skb_cow_head(skb,
					  skb->data - skb_mac_header(skb)))) {
			kfree_skb(skb);
1200
			return RX_HANDLER_CONSUMED;
1201
		}
1202 1203
		bond_hw_addr_copy(eth_hdr(skb)->h_dest, bond->dev->dev_addr,
				  bond->dev->addr_len);
1204 1205
	}

1206
	return ret;
1207 1208
}

1209
static enum netdev_lag_tx_type bond_lag_tx_type(struct bonding *bond)
1210
{
1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225
	switch (BOND_MODE(bond)) {
	case BOND_MODE_ROUNDROBIN:
		return NETDEV_LAG_TX_TYPE_ROUNDROBIN;
	case BOND_MODE_ACTIVEBACKUP:
		return NETDEV_LAG_TX_TYPE_ACTIVEBACKUP;
	case BOND_MODE_BROADCAST:
		return NETDEV_LAG_TX_TYPE_BROADCAST;
	case BOND_MODE_XOR:
	case BOND_MODE_8023AD:
		return NETDEV_LAG_TX_TYPE_HASH;
	default:
		return NETDEV_LAG_TX_TYPE_UNKNOWN;
	}
}

1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247
static enum netdev_lag_hash bond_lag_hash_type(struct bonding *bond,
					       enum netdev_lag_tx_type type)
{
	if (type != NETDEV_LAG_TX_TYPE_HASH)
		return NETDEV_LAG_HASH_NONE;

	switch (bond->params.xmit_policy) {
	case BOND_XMIT_POLICY_LAYER2:
		return NETDEV_LAG_HASH_L2;
	case BOND_XMIT_POLICY_LAYER34:
		return NETDEV_LAG_HASH_L34;
	case BOND_XMIT_POLICY_LAYER23:
		return NETDEV_LAG_HASH_L23;
	case BOND_XMIT_POLICY_ENCAP23:
		return NETDEV_LAG_HASH_E23;
	case BOND_XMIT_POLICY_ENCAP34:
		return NETDEV_LAG_HASH_E34;
	default:
		return NETDEV_LAG_HASH_UNKNOWN;
	}
}

1248 1249
static int bond_master_upper_dev_link(struct bonding *bond, struct slave *slave,
				      struct netlink_ext_ack *extack)
1250 1251
{
	struct netdev_lag_upper_info lag_upper_info;
1252
	enum netdev_lag_tx_type type;
1253

1254 1255 1256
	type = bond_lag_tx_type(bond);
	lag_upper_info.tx_type = type;
	lag_upper_info.hash_type = bond_lag_hash_type(bond, type);
1257 1258 1259

	return netdev_master_upper_dev_link(slave->dev, bond->dev, slave,
					    &lag_upper_info, extack);
1260 1261
}

1262
static void bond_upper_dev_unlink(struct bonding *bond, struct slave *slave)
1263
{
1264 1265
	netdev_upper_dev_unlink(slave->dev, bond->dev);
	slave->dev->flags &= ~IFF_SLAVE;
1266 1267
}

1268 1269 1270 1271
static struct slave *bond_alloc_slave(struct bonding *bond)
{
	struct slave *slave = NULL;

Z
Zhang Shengju 已提交
1272
	slave = kzalloc(sizeof(*slave), GFP_KERNEL);
1273 1274 1275
	if (!slave)
		return NULL;

1276
	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
1277 1278 1279 1280 1281 1282 1283
		SLAVE_AD_INFO(slave) = kzalloc(sizeof(struct ad_slave_info),
					       GFP_KERNEL);
		if (!SLAVE_AD_INFO(slave)) {
			kfree(slave);
			return NULL;
		}
	}
1284 1285
	INIT_DELAYED_WORK(&slave->notify_work, bond_netdev_notify_work);

1286 1287 1288 1289 1290 1291 1292
	return slave;
}

static void bond_free_slave(struct slave *slave)
{
	struct bonding *bond = bond_get_bond_by_slave(slave);

1293
	cancel_delayed_work_sync(&slave->notify_work);
1294
	if (BOND_MODE(bond) == BOND_MODE_8023AD)
1295 1296 1297 1298 1299
		kfree(SLAVE_AD_INFO(slave));

	kfree(slave);
}

1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314
static void bond_fill_ifbond(struct bonding *bond, struct ifbond *info)
{
	info->bond_mode = BOND_MODE(bond);
	info->miimon = bond->params.miimon;
	info->num_slaves = bond->slave_cnt;
}

static void bond_fill_ifslave(struct slave *slave, struct ifslave *info)
{
	strcpy(info->slave_name, slave->dev->name);
	info->link = slave->link;
	info->state = bond_slave_state(slave);
	info->link_failure_count = slave->link_failure_count;
}

1315 1316
static void bond_netdev_notify_work(struct work_struct *_work)
{
1317 1318 1319 1320 1321
	struct slave *slave = container_of(_work, struct slave,
					   notify_work.work);

	if (rtnl_trylock()) {
		struct netdev_bonding_info binfo;
1322

1323 1324 1325 1326 1327 1328 1329
		bond_fill_ifslave(slave, &binfo.slave);
		bond_fill_ifbond(slave->bond, &binfo.master);
		netdev_bonding_info_change(slave->dev, &binfo);
		rtnl_unlock();
	} else {
		queue_delayed_work(slave->bond->wq, &slave->notify_work, 1);
	}
1330 1331 1332 1333
}

void bond_queue_slave_event(struct slave *slave)
{
1334
	queue_delayed_work(slave->bond->wq, &slave->notify_work, 0);
1335 1336
}

1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
void bond_lower_state_changed(struct slave *slave)
{
	struct netdev_lag_lower_state_info info;

	info.link_up = slave->link == BOND_LINK_UP ||
		       slave->link == BOND_LINK_FAIL;
	info.tx_enabled = bond_is_active_slave(slave);
	netdev_lower_state_changed(slave->dev, &info);
}

L
Linus Torvalds 已提交
1347
/* enslave device <slave> to bond device <master> */
D
David Ahern 已提交
1348 1349
int bond_enslave(struct net_device *bond_dev, struct net_device *slave_dev,
		 struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
1350
{
1351
	struct bonding *bond = netdev_priv(bond_dev);
1352
	const struct net_device_ops *slave_ops = slave_dev->netdev_ops;
1353
	struct slave *new_slave = NULL, *prev_slave;
1354
	struct sockaddr_storage ss;
L
Linus Torvalds 已提交
1355
	int link_reporting;
1356
	int res = 0, i;
L
Linus Torvalds 已提交
1357

1358 1359 1360
	if (!bond->params.use_carrier &&
	    slave_dev->ethtool_ops->get_link == NULL &&
	    slave_ops->ndo_do_ioctl == NULL) {
1361 1362
		netdev_warn(bond_dev, "no link monitoring support for %s\n",
			    slave_dev->name);
L
Linus Torvalds 已提交
1363 1364
	}

M
Mahesh Bandewar 已提交
1365 1366
	/* already in-use? */
	if (netdev_is_rx_handler_busy(slave_dev)) {
1367
		NL_SET_ERR_MSG(extack, "Device is in use and cannot be enslaved");
M
Mahesh Bandewar 已提交
1368 1369
		netdev_err(bond_dev,
			   "Error: Device is in use and cannot be enslaved\n");
L
Linus Torvalds 已提交
1370 1371 1372
		return -EBUSY;
	}

1373
	if (bond_dev == slave_dev) {
1374
		NL_SET_ERR_MSG(extack, "Cannot enslave bond to itself.");
1375
		netdev_err(bond_dev, "cannot enslave bond to itself.\n");
1376 1377 1378
		return -EPERM;
	}

L
Linus Torvalds 已提交
1379 1380 1381
	/* vlan challenged mutual exclusion */
	/* no need to lock since we're protected by rtnl_lock */
	if (slave_dev->features & NETIF_F_VLAN_CHALLENGED) {
1382 1383
		netdev_dbg(bond_dev, "%s is NETIF_F_VLAN_CHALLENGED\n",
			   slave_dev->name);
1384
		if (vlan_uses_dev(bond_dev)) {
1385
			NL_SET_ERR_MSG(extack, "Can not enslave VLAN challenged device to VLAN enabled bond");
1386 1387
			netdev_err(bond_dev, "Error: cannot enslave VLAN challenged slave %s on VLAN enabled bond %s\n",
				   slave_dev->name, bond_dev->name);
L
Linus Torvalds 已提交
1388 1389
			return -EPERM;
		} else {
1390 1391 1392
			netdev_warn(bond_dev, "enslaved VLAN challenged slave %s. Adding VLANs will be blocked as long as %s is part of bond %s\n",
				    slave_dev->name, slave_dev->name,
				    bond_dev->name);
L
Linus Torvalds 已提交
1393 1394
		}
	} else {
1395 1396
		netdev_dbg(bond_dev, "%s is !NETIF_F_VLAN_CHALLENGED\n",
			   slave_dev->name);
L
Linus Torvalds 已提交
1397 1398
	}

1399
	/* Old ifenslave binaries are no longer supported.  These can
S
Stephen Hemminger 已提交
1400
	 * be identified with moderate accuracy by the state of the slave:
1401 1402 1403
	 * the current ifenslave will set the interface down prior to
	 * enslaving it; the old ifenslave will not.
	 */
Y
yzhu1 已提交
1404
	if (slave_dev->flags & IFF_UP) {
1405
		NL_SET_ERR_MSG(extack, "Device can not be enslaved while up");
1406 1407
		netdev_err(bond_dev, "%s is up - this may be due to an out of date ifenslave\n",
			   slave_dev->name);
1408
		return -EPERM;
1409
	}
L
Linus Torvalds 已提交
1410

1411 1412 1413 1414 1415 1416 1417
	/* set bonding device ether type by slave - bonding netdevices are
	 * created with ether_setup, so when the slave type is not ARPHRD_ETHER
	 * there is a need to override some of the type dependent attribs/funcs.
	 *
	 * bond ether type mutual exclusion - don't allow slaves of dissimilar
	 * ether type (eg ARPHRD_ETHER and ARPHRD_INFINIBAND) share the same bond
	 */
1418
	if (!bond_has_slaves(bond)) {
1419
		if (bond_dev->type != slave_dev->type) {
1420 1421
			netdev_dbg(bond_dev, "change device type from %d to %d\n",
				   bond_dev->type, slave_dev->type);
1422

1423 1424
			res = call_netdevice_notifiers(NETDEV_PRE_TYPE_CHANGE,
						       bond_dev);
1425 1426
			res = notifier_to_errno(res);
			if (res) {
1427
				netdev_err(bond_dev, "refused to change device type\n");
1428
				return -EBUSY;
1429
			}
1430

1431
			/* Flush unicast and multicast addresses */
1432
			dev_uc_flush(bond_dev);
1433
			dev_mc_flush(bond_dev);
1434

1435 1436
			if (slave_dev->type != ARPHRD_ETHER)
				bond_setup_by_slave(bond_dev, slave_dev);
1437
			else {
1438
				ether_setup(bond_dev);
1439 1440
				bond_dev->priv_flags &= ~IFF_TX_SKB_SHARING;
			}
1441

1442 1443
			call_netdevice_notifiers(NETDEV_POST_TYPE_CHANGE,
						 bond_dev);
1444
		}
1445
	} else if (bond_dev->type != slave_dev->type) {
1446
		NL_SET_ERR_MSG(extack, "Device type is different from other slaves");
1447 1448
		netdev_err(bond_dev, "%s ether type (%d) is different from other slaves (%d), can not enslave it\n",
			   slave_dev->name, slave_dev->type, bond_dev->type);
1449
		return -EINVAL;
1450 1451
	}

1452 1453
	if (slave_dev->type == ARPHRD_INFINIBAND &&
	    BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1454
		NL_SET_ERR_MSG(extack, "Only active-backup mode is supported for infiniband slaves");
1455 1456 1457 1458 1459 1460 1461 1462
		netdev_warn(bond_dev, "Type (%d) supports only active-backup mode\n",
			    slave_dev->type);
		res = -EOPNOTSUPP;
		goto err_undo_flags;
	}

	if (!slave_ops->ndo_set_mac_address ||
	    slave_dev->type == ARPHRD_INFINIBAND) {
1463
		netdev_warn(bond_dev, "The slave device specified does not support setting the MAC address\n");
1464 1465 1466
		if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP &&
		    bond->params.fail_over_mac != BOND_FOM_ACTIVE) {
			if (!bond_has_slaves(bond)) {
1467
				bond->params.fail_over_mac = BOND_FOM_ACTIVE;
1468
				netdev_warn(bond_dev, "Setting fail_over_mac to active for active-backup mode\n");
1469
			} else {
1470
				NL_SET_ERR_MSG(extack, "Slave device does not support setting the MAC address, but fail_over_mac is not set to active");
1471
				netdev_err(bond_dev, "The slave device specified does not support setting the MAC address, but fail_over_mac is not set to active\n");
1472 1473
				res = -EOPNOTSUPP;
				goto err_undo_flags;
1474
			}
1475
		}
L
Linus Torvalds 已提交
1476 1477
	}

1478 1479
	call_netdevice_notifiers(NETDEV_JOIN, slave_dev);

1480
	/* If this is the first slave, then we need to set the master's hardware
1481 1482
	 * address to be the same as the slave's.
	 */
1483
	if (!bond_has_slaves(bond) &&
1484
	    bond->dev->addr_assign_type == NET_ADDR_RANDOM)
1485
		bond_set_dev_addr(bond->dev, slave_dev);
1486

1487
	new_slave = bond_alloc_slave(bond);
L
Linus Torvalds 已提交
1488 1489 1490 1491
	if (!new_slave) {
		res = -ENOMEM;
		goto err_undo_flags;
	}
1492

1493 1494
	new_slave->bond = bond;
	new_slave->dev = slave_dev;
1495
	/* Set the new_slave's queue_id to be zero.  Queue ID mapping
1496 1497 1498 1499
	 * is set via sysfs or module option if desired.
	 */
	new_slave->queue_id = 0;

1500 1501 1502 1503
	/* Save slave's original mtu and then set it to match the bond */
	new_slave->original_mtu = slave_dev->mtu;
	res = dev_set_mtu(slave_dev, bond->dev->mtu);
	if (res) {
1504
		netdev_dbg(bond_dev, "Error %d calling dev_set_mtu\n", res);
1505 1506 1507
		goto err_free;
	}

1508
	/* Save slave's original ("permanent") mac address for modes
1509 1510 1511
	 * that need it, and for restoring it upon release, and then
	 * set it to the master's address
	 */
1512 1513
	bond_hw_addr_copy(new_slave->perm_hwaddr, slave_dev->dev_addr,
			  slave_dev->addr_len);
L
Linus Torvalds 已提交
1514

1515
	if (!bond->params.fail_over_mac ||
1516
	    BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1517
		/* Set slave to master's mac address.  The application already
1518 1519
		 * set the master's mac address to that of the first slave
		 */
1520 1521 1522
		memcpy(ss.__data, bond_dev->dev_addr, bond_dev->addr_len);
		ss.ss_family = slave_dev->type;
		res = dev_set_mac_address(slave_dev, (struct sockaddr *)&ss);
1523
		if (res) {
1524
			netdev_dbg(bond_dev, "Error %d calling set_mac_address\n", res);
1525
			goto err_restore_mtu;
1526
		}
1527
	}
L
Linus Torvalds 已提交
1528

1529 1530 1531
	/* set slave flag before open to prevent IPv6 addrconf */
	slave_dev->flags |= IFF_SLAVE;

1532 1533 1534
	/* open the slave since the application closed it */
	res = dev_open(slave_dev);
	if (res) {
1535
		netdev_dbg(bond_dev, "Opening slave %s failed\n", slave_dev->name);
1536
		goto err_restore_mac;
L
Linus Torvalds 已提交
1537 1538
	}

1539
	slave_dev->priv_flags |= IFF_BONDING;
1540 1541
	/* initialize slave stats */
	dev_get_stats(new_slave->dev, &new_slave->slave_stats);
L
Linus Torvalds 已提交
1542

1543
	if (bond_is_lb(bond)) {
L
Linus Torvalds 已提交
1544 1545 1546 1547
		/* bond_alb_init_slave() must be called before all other stages since
		 * it might fail and we do not want to have to undo everything
		 */
		res = bond_alb_init_slave(bond, new_slave);
S
Stephen Hemminger 已提交
1548
		if (res)
1549
			goto err_close;
L
Linus Torvalds 已提交
1550 1551
	}

1552 1553
	res = vlan_vids_add_by_dev(slave_dev, bond_dev);
	if (res) {
1554 1555
		netdev_err(bond_dev, "Couldn't add bond vlan ids to %s\n",
			   slave_dev->name);
1556
		goto err_close;
1557
	}
L
Linus Torvalds 已提交
1558

1559
	prev_slave = bond_last_slave(bond);
L
Linus Torvalds 已提交
1560 1561 1562 1563

	new_slave->delay = 0;
	new_slave->link_failure_count = 0;

1564 1565
	if (bond_update_speed_duplex(new_slave) &&
	    bond_needs_speed_duplex(bond))
1566
		new_slave->link = BOND_LINK_DOWN;
1567

1568
	new_slave->last_rx = jiffies -
1569
		(msecs_to_jiffies(bond->params.arp_interval) + 1);
1570
	for (i = 0; i < BOND_MAX_ARP_TARGETS; i++)
1571
		new_slave->target_last_arp_rx[i] = new_slave->last_rx;
1572

L
Linus Torvalds 已提交
1573 1574 1575 1576
	if (bond->params.miimon && !bond->params.use_carrier) {
		link_reporting = bond_check_dev_link(bond, slave_dev, 1);

		if ((link_reporting == -1) && !bond->params.arp_interval) {
1577
			/* miimon is set but a bonded network driver
L
Linus Torvalds 已提交
1578 1579 1580 1581 1582 1583 1584
			 * does not support ETHTOOL/MII and
			 * arp_interval is not set.  Note: if
			 * use_carrier is enabled, we will never go
			 * here (because netif_carrier is always
			 * supported); thus, we don't need to change
			 * the messages for netif_carrier.
			 */
1585 1586
			netdev_warn(bond_dev, "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",
				    slave_dev->name);
L
Linus Torvalds 已提交
1587 1588
		} else if (link_reporting == -1) {
			/* unable get link status using mii/ethtool */
1589 1590
			netdev_warn(bond_dev, "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",
				    slave_dev->name);
L
Linus Torvalds 已提交
1591 1592 1593 1594
		}
	}

	/* check for initial state */
1595
	new_slave->link = BOND_LINK_NOCHANGE;
1596 1597 1598
	if (bond->params.miimon) {
		if (bond_check_dev_link(bond, slave_dev, 0) == BMSR_LSTATUS) {
			if (bond->params.updelay) {
1599
				bond_set_slave_link_state(new_slave,
1600 1601
							  BOND_LINK_BACK,
							  BOND_SLAVE_NOTIFY_NOW);
1602 1603
				new_slave->delay = bond->params.updelay;
			} else {
1604
				bond_set_slave_link_state(new_slave,
1605 1606
							  BOND_LINK_UP,
							  BOND_SLAVE_NOTIFY_NOW);
1607
			}
L
Linus Torvalds 已提交
1608
		} else {
1609 1610
			bond_set_slave_link_state(new_slave, BOND_LINK_DOWN,
						  BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1611
		}
1612
	} else if (bond->params.arp_interval) {
1613 1614
		bond_set_slave_link_state(new_slave,
					  (netif_carrier_ok(slave_dev) ?
1615 1616
					  BOND_LINK_UP : BOND_LINK_DOWN),
					  BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1617
	} else {
1618 1619
		bond_set_slave_link_state(new_slave, BOND_LINK_UP,
					  BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1620 1621
	}

1622
	if (new_slave->link != BOND_LINK_DOWN)
1623
		new_slave->last_link_up = jiffies;
1624 1625 1626
	netdev_dbg(bond_dev, "Initial state of slave_dev is BOND_LINK_%s\n",
		   new_slave->link == BOND_LINK_DOWN ? "DOWN" :
		   (new_slave->link == BOND_LINK_UP ? "UP" : "BACK"));
1627

1628
	if (bond_uses_primary(bond) && bond->params.primary[0]) {
L
Linus Torvalds 已提交
1629
		/* if there is a primary slave, remember it */
1630
		if (strcmp(bond->params.primary, new_slave->dev->name) == 0) {
1631
			rcu_assign_pointer(bond->primary_slave, new_slave);
1632 1633
			bond->force_primary = true;
		}
L
Linus Torvalds 已提交
1634 1635
	}

1636
	switch (BOND_MODE(bond)) {
L
Linus Torvalds 已提交
1637
	case BOND_MODE_ACTIVEBACKUP:
1638 1639
		bond_set_slave_inactive_flags(new_slave,
					      BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1640 1641 1642 1643 1644 1645
		break;
	case BOND_MODE_8023AD:
		/* in 802.3ad mode, the internal mechanism
		 * will activate the slaves in the selected
		 * aggregator
		 */
1646
		bond_set_slave_inactive_flags(new_slave, BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1647
		/* if this is the first slave */
1648
		if (!prev_slave) {
1649
			SLAVE_AD_INFO(new_slave)->id = 1;
L
Linus Torvalds 已提交
1650 1651 1652
			/* Initialize AD with the number of times that the AD timer is called in 1 second
			 * can be called only after the mac address of the bond is set
			 */
1653
			bond_3ad_initialize(bond, 1000/AD_TIMER_INTERVAL);
L
Linus Torvalds 已提交
1654
		} else {
1655 1656
			SLAVE_AD_INFO(new_slave)->id =
				SLAVE_AD_INFO(prev_slave)->id + 1;
L
Linus Torvalds 已提交
1657 1658 1659 1660 1661 1662
		}

		bond_3ad_bind_slave(new_slave);
		break;
	case BOND_MODE_TLB:
	case BOND_MODE_ALB:
J
Jiri Pirko 已提交
1663
		bond_set_active_slave(new_slave);
1664
		bond_set_slave_inactive_flags(new_slave, BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
1665 1666
		break;
	default:
1667
		netdev_dbg(bond_dev, "This slave is always active in trunk mode\n");
L
Linus Torvalds 已提交
1668 1669

		/* always active in trunk mode */
J
Jiri Pirko 已提交
1670
		bond_set_active_slave(new_slave);
L
Linus Torvalds 已提交
1671 1672 1673 1674 1675

		/* In trunking mode there is little meaning to curr_active_slave
		 * anyway (it holds no special properties of the bond device),
		 * so we can change it without calling change_active_interface()
		 */
1676 1677
		if (!rcu_access_pointer(bond->curr_active_slave) &&
		    new_slave->link == BOND_LINK_UP)
1678
			rcu_assign_pointer(bond->curr_active_slave, new_slave);
S
Stephen Hemminger 已提交
1679

L
Linus Torvalds 已提交
1680 1681 1682
		break;
	} /* switch(bond_mode) */

1683
#ifdef CONFIG_NET_POLL_CONTROLLER
1684
	if (bond->dev->npinfo) {
1685
		if (slave_enable_netpoll(new_slave)) {
1686
			netdev_info(bond_dev, "master_dev is using netpoll, but new slave device does not support netpoll\n");
1687
			res = -EBUSY;
1688
			goto err_detach;
1689
		}
1690 1691
	}
#endif
1692

1693 1694 1695
	if (!(bond_dev->features & NETIF_F_LRO))
		dev_disable_lro(slave_dev);

J
Jiri Pirko 已提交
1696 1697 1698
	res = netdev_rx_handler_register(slave_dev, bond_handle_frame,
					 new_slave);
	if (res) {
1699
		netdev_dbg(bond_dev, "Error %d calling netdev_rx_handler_register\n", res);
1700
		goto err_detach;
J
Jiri Pirko 已提交
1701 1702
	}

1703
	res = bond_master_upper_dev_link(bond, new_slave, extack);
1704
	if (res) {
1705
		netdev_dbg(bond_dev, "Error %d calling bond_master_upper_dev_link\n", res);
1706 1707 1708
		goto err_unregister;
	}

1709 1710
	res = bond_sysfs_slave_add(new_slave);
	if (res) {
1711
		netdev_dbg(bond_dev, "Error %d calling bond_sysfs_slave_add\n", res);
1712 1713 1714
		goto err_upper_unlink;
	}

1715 1716
	bond->nest_level = dev_get_nest_level(bond_dev) + 1;

1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730
	/* If the mode uses primary, then the following is handled by
	 * bond_change_active_slave().
	 */
	if (!bond_uses_primary(bond)) {
		/* set promiscuity level to new slave */
		if (bond_dev->flags & IFF_PROMISC) {
			res = dev_set_promiscuity(slave_dev, 1);
			if (res)
				goto err_sysfs_del;
		}

		/* set allmulti level to new slave */
		if (bond_dev->flags & IFF_ALLMULTI) {
			res = dev_set_allmulti(slave_dev, 1);
1731 1732 1733
			if (res) {
				if (bond_dev->flags & IFF_PROMISC)
					dev_set_promiscuity(slave_dev, -1);
1734
				goto err_sysfs_del;
1735
			}
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750
		}

		netif_addr_lock_bh(bond_dev);
		dev_mc_sync_multiple(slave_dev, bond_dev);
		dev_uc_sync_multiple(slave_dev, bond_dev);
		netif_addr_unlock_bh(bond_dev);

		if (BOND_MODE(bond) == BOND_MODE_8023AD) {
			/* add lacpdu mc addr to mc list */
			u8 lacpdu_multicast[ETH_ALEN] = MULTICAST_LACPDU_ADDR;

			dev_mc_add(slave_dev, lacpdu_multicast);
		}
	}

1751 1752 1753 1754
	bond->slave_cnt++;
	bond_compute_features(bond);
	bond_set_carrier(bond);

1755
	if (bond_uses_primary(bond)) {
1756
		block_netpoll_tx();
1757
		bond_select_active_slave(bond);
1758
		unblock_netpoll_tx();
1759
	}
1760

1761
	if (bond_mode_can_use_xmit_hash(bond))
1762 1763
		bond_update_slave_arr(bond, NULL);

1764

1765 1766 1767 1768
	netdev_info(bond_dev, "Enslaving %s as %s interface with %s link\n",
		    slave_dev->name,
		    bond_is_active_slave(new_slave) ? "an active" : "a backup",
		    new_slave->link != BOND_LINK_DOWN ? "an up" : "a down");
L
Linus Torvalds 已提交
1769 1770

	/* enslave is successful */
1771
	bond_queue_slave_event(new_slave);
L
Linus Torvalds 已提交
1772 1773 1774
	return 0;

/* Undo stages on error */
1775 1776 1777
err_sysfs_del:
	bond_sysfs_slave_del(new_slave);

1778
err_upper_unlink:
1779
	bond_upper_dev_unlink(bond, new_slave);
1780

1781 1782 1783
err_unregister:
	netdev_rx_handler_unregister(slave_dev);

1784
err_detach:
1785
	vlan_vids_del_by_dev(slave_dev, bond_dev);
1786 1787
	if (rcu_access_pointer(bond->primary_slave) == new_slave)
		RCU_INIT_POINTER(bond->primary_slave, NULL);
1788
	if (rcu_access_pointer(bond->curr_active_slave) == new_slave) {
1789
		block_netpoll_tx();
1790
		bond_change_active_slave(bond, NULL);
1791
		bond_select_active_slave(bond);
1792
		unblock_netpoll_tx();
1793
	}
1794 1795
	/* either primary_slave or curr_active_slave might've changed */
	synchronize_rcu();
1796
	slave_disable_netpoll(new_slave);
1797

L
Linus Torvalds 已提交
1798
err_close:
1799
	slave_dev->priv_flags &= ~IFF_BONDING;
L
Linus Torvalds 已提交
1800 1801 1802
	dev_close(slave_dev);

err_restore_mac:
1803
	slave_dev->flags &= ~IFF_SLAVE;
1804
	if (!bond->params.fail_over_mac ||
1805
	    BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1806 1807 1808 1809
		/* XXX TODO - fom follow mode needs to change master's
		 * MAC if this slave's MAC is in use by the bond, or at
		 * least print a warning.
		 */
1810 1811 1812 1813
		bond_hw_addr_copy(ss.__data, new_slave->perm_hwaddr,
				  new_slave->dev->addr_len);
		ss.ss_family = slave_dev->type;
		dev_set_mac_address(slave_dev, (struct sockaddr *)&ss);
1814
	}
L
Linus Torvalds 已提交
1815

1816 1817 1818
err_restore_mtu:
	dev_set_mtu(slave_dev, new_slave->original_mtu);

L
Linus Torvalds 已提交
1819
err_free:
1820
	bond_free_slave(new_slave);
L
Linus Torvalds 已提交
1821 1822

err_undo_flags:
1823
	/* Enslave of first slave has failed and we need to fix master's mac */
1824 1825 1826 1827 1828
	if (!bond_has_slaves(bond)) {
		if (ether_addr_equal_64bits(bond_dev->dev_addr,
					    slave_dev->dev_addr))
			eth_hw_addr_random(bond_dev);
		if (bond_dev->type != ARPHRD_ETHER) {
1829
			dev_close(bond_dev);
1830 1831 1832 1833 1834
			ether_setup(bond_dev);
			bond_dev->flags |= IFF_MASTER;
			bond_dev->priv_flags &= ~IFF_TX_SKB_SHARING;
		}
	}
S
Stephen Hemminger 已提交
1835

L
Linus Torvalds 已提交
1836 1837 1838
	return res;
}

1839
/* Try to release the slave device <slave> from the bond device <master>
L
Linus Torvalds 已提交
1840
 * It is legal to access curr_active_slave without a lock because all the function
1841
 * is RTNL-locked. If "all" is true it means that the function is being called
1842
 * while destroying a bond interface and all slaves are being released.
L
Linus Torvalds 已提交
1843 1844 1845 1846 1847 1848 1849
 *
 * The rules for slave state should be:
 *   for Active/Backup:
 *     Active stays on all backups go down
 *   for Bonded connections:
 *     The first up interface should be left on and all others downed.
 */
1850 1851
static int __bond_release_one(struct net_device *bond_dev,
			      struct net_device *slave_dev,
1852
			      bool all, bool unregister)
L
Linus Torvalds 已提交
1853
{
1854
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
1855
	struct slave *slave, *oldcurrent;
1856
	struct sockaddr_storage ss;
1857
	int old_flags = bond_dev->flags;
1858
	netdev_features_t old_features = bond_dev->features;
L
Linus Torvalds 已提交
1859 1860 1861

	/* slave is not a slave or master is not master of this slave */
	if (!(slave_dev->flags & IFF_SLAVE) ||
1862
	    !netdev_has_upper_dev(slave_dev, bond_dev)) {
1863
		netdev_dbg(bond_dev, "cannot release %s\n",
1864
			   slave_dev->name);
L
Linus Torvalds 已提交
1865 1866 1867
		return -EINVAL;
	}

1868
	block_netpoll_tx();
L
Linus Torvalds 已提交
1869 1870 1871 1872

	slave = bond_get_slave_by_dev(bond, slave_dev);
	if (!slave) {
		/* not a slave of this bond */
1873 1874
		netdev_info(bond_dev, "%s not enslaved\n",
			    slave_dev->name);
1875
		unblock_netpoll_tx();
L
Linus Torvalds 已提交
1876 1877 1878
		return -EINVAL;
	}

1879 1880
	bond_set_slave_inactive_flags(slave, BOND_SLAVE_NOTIFY_NOW);

1881 1882
	bond_sysfs_slave_del(slave);

1883 1884 1885
	/* recompute stats just before removing the slave */
	bond_get_stats(bond->dev, &bond->bond_stats);

1886
	bond_upper_dev_unlink(bond, slave);
J
Jiri Pirko 已提交
1887 1888 1889 1890 1891
	/* unregister rx_handler early so bond_handle_frame wouldn't be called
	 * for this slave anymore.
	 */
	netdev_rx_handler_unregister(slave_dev);

1892
	if (BOND_MODE(bond) == BOND_MODE_8023AD)
L
Linus Torvalds 已提交
1893 1894
		bond_3ad_unbind_slave(slave);

1895
	if (bond_mode_can_use_xmit_hash(bond))
1896 1897
		bond_update_slave_arr(bond, slave);

1898 1899 1900
	netdev_info(bond_dev, "Releasing %s interface %s\n",
		    bond_is_active_slave(slave) ? "active" : "backup",
		    slave_dev->name);
L
Linus Torvalds 已提交
1901

1902
	oldcurrent = rcu_access_pointer(bond->curr_active_slave);
L
Linus Torvalds 已提交
1903

1904
	RCU_INIT_POINTER(bond->current_arp_slave, NULL);
L
Linus Torvalds 已提交
1905

1906
	if (!all && (!bond->params.fail_over_mac ||
1907
		     BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP)) {
1908
		if (ether_addr_equal_64bits(bond_dev->dev_addr, slave->perm_hwaddr) &&
1909
		    bond_has_slaves(bond))
1910 1911 1912
			netdev_warn(bond_dev, "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",
				    slave_dev->name, slave->perm_hwaddr,
				    bond_dev->name, slave_dev->name);
1913 1914
	}

1915 1916
	if (rtnl_dereference(bond->primary_slave) == slave)
		RCU_INIT_POINTER(bond->primary_slave, NULL);
L
Linus Torvalds 已提交
1917

1918
	if (oldcurrent == slave)
L
Linus Torvalds 已提交
1919 1920
		bond_change_active_slave(bond, NULL);

1921
	if (bond_is_lb(bond)) {
L
Linus Torvalds 已提交
1922 1923 1924 1925 1926 1927 1928 1929
		/* Must be called only after the slave has been
		 * detached from the list and the curr_active_slave
		 * has been cleared (if our_slave == old_current),
		 * but before a new active slave is selected.
		 */
		bond_alb_deinit_slave(bond, slave);
	}

1930
	if (all) {
1931
		RCU_INIT_POINTER(bond->curr_active_slave, NULL);
1932
	} else if (oldcurrent == slave) {
1933
		/* Note that we hold RTNL over this sequence, so there
1934 1935 1936
		 * is no concern that another slave add/remove event
		 * will interfere.
		 */
L
Linus Torvalds 已提交
1937
		bond_select_active_slave(bond);
1938 1939
	}

1940
	if (!bond_has_slaves(bond)) {
1941
		bond_set_carrier(bond);
1942
		eth_hw_addr_random(bond_dev);
1943 1944 1945
		bond->nest_level = SINGLE_DEPTH_NESTING;
	} else {
		bond->nest_level = dev_get_nest_level(bond_dev) + 1;
L
Linus Torvalds 已提交
1946 1947
	}

1948
	unblock_netpoll_tx();
1949
	synchronize_rcu();
1950
	bond->slave_cnt--;
L
Linus Torvalds 已提交
1951

1952
	if (!bond_has_slaves(bond)) {
1953
		call_netdevice_notifiers(NETDEV_CHANGEADDR, bond->dev);
1954 1955
		call_netdevice_notifiers(NETDEV_RELEASE, bond->dev);
	}
1956

1957 1958 1959
	bond_compute_features(bond);
	if (!(bond_dev->features & NETIF_F_VLAN_CHALLENGED) &&
	    (old_features & NETIF_F_VLAN_CHALLENGED))
1960 1961
		netdev_info(bond_dev, "last VLAN challenged slave %s left bond %s - VLAN blocking is removed\n",
			    slave_dev->name, bond_dev->name);
1962

1963
	vlan_vids_del_by_dev(slave_dev, bond_dev);
L
Linus Torvalds 已提交
1964

1965
	/* If the mode uses primary, then this case was handled above by
1966
	 * bond_change_active_slave(..., NULL)
L
Linus Torvalds 已提交
1967
	 */
1968
	if (!bond_uses_primary(bond)) {
1969 1970 1971 1972 1973 1974 1975 1976
		/* unset promiscuity level from slave
		 * NOTE: The NETDEV_CHANGEADDR call above may change the value
		 * of the IFF_PROMISC flag in the bond_dev, but we need the
		 * value of that flag before that change, as that was the value
		 * when this slave was attached, so we cache at the start of the
		 * function and use it here. Same goes for ALLMULTI below
		 */
		if (old_flags & IFF_PROMISC)
L
Linus Torvalds 已提交
1977 1978 1979
			dev_set_promiscuity(slave_dev, -1);

		/* unset allmulti level from slave */
1980
		if (old_flags & IFF_ALLMULTI)
L
Linus Torvalds 已提交
1981 1982
			dev_set_allmulti(slave_dev, -1);

1983
		bond_hw_addr_flush(bond_dev, slave_dev);
L
Linus Torvalds 已提交
1984 1985
	}

1986
	slave_disable_netpoll(slave);
1987

L
Linus Torvalds 已提交
1988 1989 1990
	/* close slave before restoring its mac address */
	dev_close(slave_dev);

1991
	if (bond->params.fail_over_mac != BOND_FOM_ACTIVE ||
1992
	    BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
1993
		/* restore original ("permanent") mac address */
1994 1995 1996 1997
		bond_hw_addr_copy(ss.__data, slave->perm_hwaddr,
				  slave->dev->addr_len);
		ss.ss_family = slave_dev->type;
		dev_set_mac_address(slave_dev, (struct sockaddr *)&ss);
1998
	}
L
Linus Torvalds 已提交
1999

2000 2001 2002 2003
	if (unregister)
		__dev_set_mtu(slave_dev, slave->original_mtu);
	else
		dev_set_mtu(slave_dev, slave->original_mtu);
2004

2005
	slave_dev->priv_flags &= ~IFF_BONDING;
L
Linus Torvalds 已提交
2006

2007
	bond_free_slave(slave);
L
Linus Torvalds 已提交
2008

2009
	return 0;
L
Linus Torvalds 已提交
2010 2011
}

2012 2013 2014
/* A wrapper used because of ndo_del_link */
int bond_release(struct net_device *bond_dev, struct net_device *slave_dev)
{
2015
	return __bond_release_one(bond_dev, slave_dev, false, false);
2016 2017
}

2018 2019 2020
/* First release a slave and then destroy the bond if no more slaves are left.
 * Must be under rtnl_lock when this function is called.
 */
2021 2022
static int  bond_release_and_destroy(struct net_device *bond_dev,
				     struct net_device *slave_dev)
2023
{
2024
	struct bonding *bond = netdev_priv(bond_dev);
2025 2026
	int ret;

2027
	ret = __bond_release_one(bond_dev, slave_dev, false, true);
2028
	if (ret == 0 && !bond_has_slaves(bond)) {
2029
		bond_dev->priv_flags |= IFF_DISABLE_NETPOLL;
2030 2031
		netdev_info(bond_dev, "Destroying bond %s\n",
			    bond_dev->name);
2032
		bond_remove_proc_entry(bond);
S
Stephen Hemminger 已提交
2033
		unregister_netdevice(bond_dev);
2034 2035 2036 2037
	}
	return ret;
}

2038
static void bond_info_query(struct net_device *bond_dev, struct ifbond *info)
L
Linus Torvalds 已提交
2039
{
2040
	struct bonding *bond = netdev_priv(bond_dev);
2041
	bond_fill_ifbond(bond, info);
L
Linus Torvalds 已提交
2042 2043 2044 2045
}

static int bond_slave_info_query(struct net_device *bond_dev, struct ifslave *info)
{
2046
	struct bonding *bond = netdev_priv(bond_dev);
2047
	struct list_head *iter;
2048
	int i = 0, res = -ENODEV;
L
Linus Torvalds 已提交
2049 2050
	struct slave *slave;

2051
	bond_for_each_slave(bond, slave, iter) {
2052
		if (i++ == (int)info->slave_id) {
2053
			res = 0;
2054
			bond_fill_ifslave(slave, info);
L
Linus Torvalds 已提交
2055 2056 2057 2058
			break;
		}
	}

2059
	return res;
L
Linus Torvalds 已提交
2060 2061 2062 2063
}

/*-------------------------------- Monitoring -------------------------------*/

2064
/* called with rcu_read_lock() */
J
Jay Vosburgh 已提交
2065 2066
static int bond_miimon_inspect(struct bonding *bond)
{
2067
	int link_state, commit = 0;
2068
	struct list_head *iter;
J
Jay Vosburgh 已提交
2069
	struct slave *slave;
2070 2071
	bool ignore_updelay;

2072
	ignore_updelay = !rcu_dereference(bond->curr_active_slave);
L
Linus Torvalds 已提交
2073

2074
	bond_for_each_slave_rcu(bond, slave, iter) {
J
Jay Vosburgh 已提交
2075
		slave->new_link = BOND_LINK_NOCHANGE;
2076
		slave->link_new_state = slave->link;
L
Linus Torvalds 已提交
2077

J
Jay Vosburgh 已提交
2078
		link_state = bond_check_dev_link(bond, slave->dev, 0);
L
Linus Torvalds 已提交
2079 2080

		switch (slave->link) {
J
Jay Vosburgh 已提交
2081 2082 2083
		case BOND_LINK_UP:
			if (link_state)
				continue;
L
Linus Torvalds 已提交
2084

2085
			bond_propose_link_state(slave, BOND_LINK_FAIL);
2086
			commit++;
J
Jay Vosburgh 已提交
2087 2088
			slave->delay = bond->params.downdelay;
			if (slave->delay) {
2089 2090 2091 2092 2093 2094 2095
				netdev_info(bond->dev, "link status down for %sinterface %s, disabling it in %d ms\n",
					    (BOND_MODE(bond) ==
					     BOND_MODE_ACTIVEBACKUP) ?
					     (bond_is_active_slave(slave) ?
					      "active " : "backup ") : "",
					    slave->dev->name,
					    bond->params.downdelay * bond->params.miimon);
L
Linus Torvalds 已提交
2096
			}
J
Jay Vosburgh 已提交
2097 2098 2099
			/*FALLTHRU*/
		case BOND_LINK_FAIL:
			if (link_state) {
2100
				/* recovered before downdelay expired */
2101
				bond_propose_link_state(slave, BOND_LINK_UP);
2102
				slave->last_link_up = jiffies;
2103 2104 2105 2106
				netdev_info(bond->dev, "link status up again after %d ms for interface %s\n",
					    (bond->params.downdelay - slave->delay) *
					    bond->params.miimon,
					    slave->dev->name);
2107
				commit++;
J
Jay Vosburgh 已提交
2108
				continue;
L
Linus Torvalds 已提交
2109
			}
J
Jay Vosburgh 已提交
2110 2111 2112 2113 2114

			if (slave->delay <= 0) {
				slave->new_link = BOND_LINK_DOWN;
				commit++;
				continue;
L
Linus Torvalds 已提交
2115 2116
			}

J
Jay Vosburgh 已提交
2117 2118 2119 2120 2121 2122 2123
			slave->delay--;
			break;

		case BOND_LINK_DOWN:
			if (!link_state)
				continue;

2124
			bond_propose_link_state(slave, BOND_LINK_BACK);
2125
			commit++;
J
Jay Vosburgh 已提交
2126 2127 2128
			slave->delay = bond->params.updelay;

			if (slave->delay) {
2129 2130 2131 2132 2133
				netdev_info(bond->dev, "link status up for interface %s, enabling it in %d ms\n",
					    slave->dev->name,
					    ignore_updelay ? 0 :
					    bond->params.updelay *
					    bond->params.miimon);
J
Jay Vosburgh 已提交
2134 2135 2136 2137
			}
			/*FALLTHRU*/
		case BOND_LINK_BACK:
			if (!link_state) {
2138
				bond_propose_link_state(slave, BOND_LINK_DOWN);
2139 2140 2141 2142
				netdev_info(bond->dev, "link status down again after %d ms for interface %s\n",
					    (bond->params.updelay - slave->delay) *
					    bond->params.miimon,
					    slave->dev->name);
2143
				commit++;
J
Jay Vosburgh 已提交
2144 2145 2146
				continue;
			}

2147 2148 2149
			if (ignore_updelay)
				slave->delay = 0;

J
Jay Vosburgh 已提交
2150 2151 2152
			if (slave->delay <= 0) {
				slave->new_link = BOND_LINK_UP;
				commit++;
2153
				ignore_updelay = false;
J
Jay Vosburgh 已提交
2154
				continue;
L
Linus Torvalds 已提交
2155
			}
J
Jay Vosburgh 已提交
2156 2157

			slave->delay--;
L
Linus Torvalds 已提交
2158
			break;
J
Jay Vosburgh 已提交
2159 2160
		}
	}
L
Linus Torvalds 已提交
2161

J
Jay Vosburgh 已提交
2162 2163
	return commit;
}
L
Linus Torvalds 已提交
2164

2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182
static void bond_miimon_link_change(struct bonding *bond,
				    struct slave *slave,
				    char link)
{
	switch (BOND_MODE(bond)) {
	case BOND_MODE_8023AD:
		bond_3ad_handle_link_change(slave, link);
		break;
	case BOND_MODE_TLB:
	case BOND_MODE_ALB:
		bond_alb_handle_link_change(bond, slave, link);
		break;
	case BOND_MODE_XOR:
		bond_update_slave_arr(bond, NULL);
		break;
	}
}

J
Jay Vosburgh 已提交
2183 2184
static void bond_miimon_commit(struct bonding *bond)
{
2185
	struct list_head *iter;
2186
	struct slave *slave, *primary;
J
Jay Vosburgh 已提交
2187

2188
	bond_for_each_slave(bond, slave, iter) {
J
Jay Vosburgh 已提交
2189 2190 2191
		switch (slave->new_link) {
		case BOND_LINK_NOCHANGE:
			continue;
L
Linus Torvalds 已提交
2192

J
Jay Vosburgh 已提交
2193
		case BOND_LINK_UP:
2194 2195
			if (bond_update_speed_duplex(slave) &&
			    bond_needs_speed_duplex(bond)) {
2196
				slave->link = BOND_LINK_DOWN;
2197 2198 2199 2200
				if (net_ratelimit())
					netdev_warn(bond->dev,
						    "failed to get link speed/duplex for %s\n",
						    slave->dev->name);
2201 2202
				continue;
			}
2203 2204
			bond_set_slave_link_state(slave, BOND_LINK_UP,
						  BOND_SLAVE_NOTIFY_NOW);
2205
			slave->last_link_up = jiffies;
J
Jay Vosburgh 已提交
2206

2207
			primary = rtnl_dereference(bond->primary_slave);
2208
			if (BOND_MODE(bond) == BOND_MODE_8023AD) {
J
Jay Vosburgh 已提交
2209
				/* prevent it from being the active one */
J
Jiri Pirko 已提交
2210
				bond_set_backup_slave(slave);
2211
			} else if (BOND_MODE(bond) != BOND_MODE_ACTIVEBACKUP) {
J
Jay Vosburgh 已提交
2212
				/* make it immediately active */
J
Jiri Pirko 已提交
2213
				bond_set_active_slave(slave);
2214
			} else if (slave != primary) {
J
Jay Vosburgh 已提交
2215
				/* prevent it from being the active one */
J
Jiri Pirko 已提交
2216
				bond_set_backup_slave(slave);
L
Linus Torvalds 已提交
2217 2218
			}

2219 2220 2221 2222
			netdev_info(bond->dev, "link status definitely up for interface %s, %u Mbps %s duplex\n",
				    slave->dev->name,
				    slave->speed == SPEED_UNKNOWN ? 0 : slave->speed,
				    slave->duplex ? "full" : "half");
L
Linus Torvalds 已提交
2223

2224
			bond_miimon_link_change(bond, slave, BOND_LINK_UP);
2225

2226
			if (!bond->curr_active_slave || slave == primary)
J
Jay Vosburgh 已提交
2227
				goto do_failover;
L
Linus Torvalds 已提交
2228

J
Jay Vosburgh 已提交
2229
			continue;
2230

J
Jay Vosburgh 已提交
2231
		case BOND_LINK_DOWN:
J
Jay Vosburgh 已提交
2232 2233 2234
			if (slave->link_failure_count < UINT_MAX)
				slave->link_failure_count++;

2235 2236
			bond_set_slave_link_state(slave, BOND_LINK_DOWN,
						  BOND_SLAVE_NOTIFY_NOW);
L
Linus Torvalds 已提交
2237

2238 2239
			if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP ||
			    BOND_MODE(bond) == BOND_MODE_8023AD)
2240 2241
				bond_set_slave_inactive_flags(slave,
							      BOND_SLAVE_NOTIFY_NOW);
J
Jay Vosburgh 已提交
2242

2243 2244
			netdev_info(bond->dev, "link status definitely down for interface %s, disabling it\n",
				    slave->dev->name);
J
Jay Vosburgh 已提交
2245

2246
			bond_miimon_link_change(bond, slave, BOND_LINK_DOWN);
2247

2248
			if (slave == rcu_access_pointer(bond->curr_active_slave))
J
Jay Vosburgh 已提交
2249 2250 2251 2252 2253
				goto do_failover;

			continue;

		default:
2254 2255
			netdev_err(bond->dev, "invalid new link %d on slave %s\n",
				   slave->new_link, slave->dev->name);
J
Jay Vosburgh 已提交
2256 2257 2258 2259 2260 2261
			slave->new_link = BOND_LINK_NOCHANGE;

			continue;
		}

do_failover:
2262
		block_netpoll_tx();
J
Jay Vosburgh 已提交
2263
		bond_select_active_slave(bond);
2264
		unblock_netpoll_tx();
J
Jay Vosburgh 已提交
2265 2266 2267
	}

	bond_set_carrier(bond);
L
Linus Torvalds 已提交
2268 2269
}

2270
/* bond_mii_monitor
2271 2272
 *
 * Really a wrapper that splits the mii monitor into two phases: an
J
Jay Vosburgh 已提交
2273 2274 2275
 * inspection, then (if inspection indicates something needs to be done)
 * an acquisition of appropriate locks followed by a commit phase to
 * implement whatever link state changes are indicated.
2276
 */
2277
static void bond_mii_monitor(struct work_struct *work)
2278 2279 2280
{
	struct bonding *bond = container_of(work, struct bonding,
					    mii_work.work);
2281
	bool should_notify_peers = false;
2282
	unsigned long delay;
2283 2284
	struct slave *slave;
	struct list_head *iter;
2285

2286 2287 2288
	delay = msecs_to_jiffies(bond->params.miimon);

	if (!bond_has_slaves(bond))
J
Jay Vosburgh 已提交
2289
		goto re_arm;
2290

2291 2292
	rcu_read_lock();

2293 2294
	should_notify_peers = bond_should_notify_peers(bond);

2295
	if (bond_miimon_inspect(bond)) {
2296
		rcu_read_unlock();
J
Jay Vosburgh 已提交
2297

2298 2299 2300 2301 2302 2303
		/* Race avoidance with bond_close cancel of workqueue */
		if (!rtnl_trylock()) {
			delay = 1;
			should_notify_peers = false;
			goto re_arm;
		}
2304

2305 2306 2307
		bond_for_each_slave(bond, slave, iter) {
			bond_commit_link_state(slave, BOND_SLAVE_NOTIFY_LATER);
		}
2308 2309 2310
		bond_miimon_commit(bond);

		rtnl_unlock();	/* might sleep, hold no other locks */
2311 2312
	} else
		rcu_read_unlock();
2313

J
Jay Vosburgh 已提交
2314
re_arm:
2315
	if (bond->params.miimon)
2316 2317 2318 2319 2320 2321 2322 2323
		queue_delayed_work(bond->wq, &bond->mii_work, delay);

	if (should_notify_peers) {
		if (!rtnl_trylock())
			return;
		call_netdevice_notifiers(NETDEV_NOTIFY_PEERS, bond->dev);
		rtnl_unlock();
	}
2324
}
J
Jay Vosburgh 已提交
2325

2326 2327 2328 2329 2330 2331 2332
static int bond_upper_dev_walk(struct net_device *upper, void *data)
{
	__be32 ip = *((__be32 *)data);

	return ip == bond_confirm_addr(upper, 0, ip);
}

2333
static bool bond_has_this_ip(struct bonding *bond, __be32 ip)
2334
{
2335
	bool ret = false;
2336

2337
	if (ip == bond_confirm_addr(bond->dev, 0, ip))
2338
		return true;
2339

2340
	rcu_read_lock();
2341 2342
	if (netdev_walk_all_upper_dev_rcu(bond->dev, bond_upper_dev_walk, &ip))
		ret = true;
2343
	rcu_read_unlock();
2344

2345
	return ret;
2346 2347
}

2348
/* We go to the (large) trouble of VLAN tagging ARP frames because
J
Jay Vosburgh 已提交
2349 2350 2351
 * switches in VLAN mode (especially if ports are configured as
 * "native" to a VLAN) might not pass non-tagged frames.
 */
2352 2353
static void bond_arp_send(struct net_device *slave_dev, int arp_op,
			  __be32 dest_ip, __be32 src_ip,
2354
			  struct bond_vlan_tag *tags)
J
Jay Vosburgh 已提交
2355 2356
{
	struct sk_buff *skb;
2357
	struct bond_vlan_tag *outer_tag = tags;
J
Jay Vosburgh 已提交
2358

2359 2360
	netdev_dbg(slave_dev, "arp %d on slave %s: dst %pI4 src %pI4\n",
		   arp_op, slave_dev->name, &dest_ip, &src_ip);
S
Stephen Hemminger 已提交
2361

J
Jay Vosburgh 已提交
2362 2363 2364 2365
	skb = arp_create(arp_op, ETH_P_ARP, dest_ip, slave_dev, src_ip,
			 NULL, slave_dev->dev_addr, NULL);

	if (!skb) {
2366
		net_err_ratelimited("ARP packet allocation failed\n");
J
Jay Vosburgh 已提交
2367 2368
		return;
	}
2369

2370 2371 2372 2373 2374
	if (!tags || tags->vlan_proto == VLAN_N_VID)
		goto xmit;

	tags++;

2375
	/* Go through all the tags backwards and add them to the packet */
2376 2377 2378
	while (tags->vlan_proto != VLAN_N_VID) {
		if (!tags->vlan_id) {
			tags++;
2379
			continue;
2380
		}
2381

2382
		netdev_dbg(slave_dev, "inner tag: proto %X vid %X\n",
2383
			   ntohs(outer_tag->vlan_proto), tags->vlan_id);
2384 2385
		skb = vlan_insert_tag_set_proto(skb, tags->vlan_proto,
						tags->vlan_id);
2386 2387 2388 2389
		if (!skb) {
			net_err_ratelimited("failed to insert inner VLAN tag\n");
			return;
		}
2390 2391

		tags++;
2392 2393
	}
	/* Set the outer tag */
2394
	if (outer_tag->vlan_id) {
2395
		netdev_dbg(slave_dev, "outer tag: proto %X vid %X\n",
2396
			   ntohs(outer_tag->vlan_proto), outer_tag->vlan_id);
J
Jiri Pirko 已提交
2397 2398
		__vlan_hwaccel_put_tag(skb, outer_tag->vlan_proto,
				       outer_tag->vlan_id);
J
Jay Vosburgh 已提交
2399
	}
2400 2401

xmit:
J
Jay Vosburgh 已提交
2402 2403 2404
	arp_xmit(skb);
}

2405 2406 2407 2408 2409 2410
/* Validate the device path between the @start_dev and the @end_dev.
 * The path is valid if the @end_dev is reachable through device
 * stacking.
 * When the path is validated, collect any vlan information in the
 * path.
 */
2411 2412 2413
struct bond_vlan_tag *bond_verify_device_path(struct net_device *start_dev,
					      struct net_device *end_dev,
					      int level)
2414
{
2415
	struct bond_vlan_tag *tags;
2416 2417 2418
	struct net_device *upper;
	struct list_head  *iter;

2419
	if (start_dev == end_dev) {
K
Kees Cook 已提交
2420
		tags = kcalloc(level + 1, sizeof(*tags), GFP_ATOMIC);
2421 2422 2423 2424 2425
		if (!tags)
			return ERR_PTR(-ENOMEM);
		tags[level].vlan_proto = VLAN_N_VID;
		return tags;
	}
2426 2427

	netdev_for_each_upper_dev_rcu(start_dev, upper, iter) {
2428 2429 2430 2431 2432
		tags = bond_verify_device_path(upper, end_dev, level + 1);
		if (IS_ERR_OR_NULL(tags)) {
			if (IS_ERR(tags))
				return tags;
			continue;
2433
		}
2434 2435 2436 2437 2438 2439
		if (is_vlan_dev(upper)) {
			tags[level].vlan_proto = vlan_dev_vlan_proto(upper);
			tags[level].vlan_id = vlan_dev_vlan_id(upper);
		}

		return tags;
2440 2441
	}

2442
	return NULL;
2443
}
J
Jay Vosburgh 已提交
2444

L
Linus Torvalds 已提交
2445 2446
static void bond_arp_send_all(struct bonding *bond, struct slave *slave)
{
J
Jay Vosburgh 已提交
2447
	struct rtable *rt;
2448
	struct bond_vlan_tag *tags;
2449
	__be32 *targets = bond->params.arp_targets, addr;
2450
	int i;
L
Linus Torvalds 已提交
2451

2452
	for (i = 0; i < BOND_MAX_ARP_TARGETS && targets[i]; i++) {
2453
		netdev_dbg(bond->dev, "basa: target %pI4\n", &targets[i]);
2454
		tags = NULL;
J
Jay Vosburgh 已提交
2455

2456
		/* Find out through which dev should the packet go */
2457 2458
		rt = ip_route_output(dev_net(bond->dev), targets[i], 0,
				     RTO_ONLINK, 0);
2459
		if (IS_ERR(rt)) {
2460 2461 2462
			/* there's no route to target - try to send arp
			 * probe to generate any traffic (arp_validate=0)
			 */
2463 2464 2465 2466
			if (bond->params.arp_validate)
				net_warn_ratelimited("%s: no route to arp_ip_target %pI4 and arp_validate is set\n",
						     bond->dev->name,
						     &targets[i]);
2467 2468
			bond_arp_send(slave->dev, ARPOP_REQUEST, targets[i],
				      0, tags);
J
Jay Vosburgh 已提交
2469 2470 2471
			continue;
		}

2472 2473 2474 2475 2476
		/* bond device itself */
		if (rt->dst.dev == bond->dev)
			goto found;

		rcu_read_lock();
2477
		tags = bond_verify_device_path(bond->dev, rt->dst.dev, 0);
2478
		rcu_read_unlock();
J
Jay Vosburgh 已提交
2479

2480
		if (!IS_ERR_OR_NULL(tags))
2481 2482
			goto found;

2483
		/* Not our device - skip */
2484 2485
		netdev_dbg(bond->dev, "no path to arp_ip_target %pI4 via rt.dev %s\n",
			   &targets[i], rt->dst.dev ? rt->dst.dev->name : "NULL");
2486

2487
		ip_rt_put(rt);
2488 2489 2490 2491 2492 2493
		continue;

found:
		addr = bond_confirm_addr(rt->dst.dev, targets[i], 0);
		ip_rt_put(rt);
		bond_arp_send(slave->dev, ARPOP_REQUEST, targets[i],
2494
			      addr, tags);
2495
		kfree(tags);
J
Jay Vosburgh 已提交
2496 2497 2498
	}
}

2499
static void bond_validate_arp(struct bonding *bond, struct slave *slave, __be32 sip, __be32 tip)
2500
{
2501 2502
	int i;

2503
	if (!sip || !bond_has_this_ip(bond, tip)) {
2504 2505
		netdev_dbg(bond->dev, "bva: sip %pI4 tip %pI4 not found\n",
			   &sip, &tip);
2506 2507
		return;
	}
2508

2509 2510
	i = bond_get_targets_ip(bond->params.arp_targets, sip);
	if (i == -1) {
2511 2512
		netdev_dbg(bond->dev, "bva: sip %pI4 not found in targets\n",
			   &sip);
2513
		return;
2514
	}
2515
	slave->last_rx = jiffies;
2516
	slave->target_last_arp_rx[i] = jiffies;
2517 2518
}

2519 2520
int bond_arp_rcv(const struct sk_buff *skb, struct bonding *bond,
		 struct slave *slave)
2521
{
2522
	struct arphdr *arp = (struct arphdr *)skb->data;
2523
	struct slave *curr_active_slave, *curr_arp_slave;
2524
	unsigned char *arp_ptr;
2525
	__be32 sip, tip;
2526 2527
	int is_arp = skb->protocol == __cpu_to_be16(ETH_P_ARP);
	unsigned int alen;
2528

2529
	if (!slave_do_arp_validate(bond, slave)) {
2530 2531
		if ((slave_do_arp_validate_only(bond) && is_arp) ||
		    !slave_do_arp_validate_only(bond))
2532
			slave->last_rx = jiffies;
2533
		return RX_HANDLER_ANOTHER;
2534 2535 2536
	} else if (!is_arp) {
		return RX_HANDLER_ANOTHER;
	}
2537

2538
	alen = arp_hdr_len(bond->dev);
2539

2540 2541
	netdev_dbg(bond->dev, "bond_arp_rcv: skb->dev %s\n",
		   skb->dev->name);
2542

2543 2544 2545 2546 2547 2548 2549
	if (alen > skb_headlen(skb)) {
		arp = kmalloc(alen, GFP_ATOMIC);
		if (!arp)
			goto out_unlock;
		if (skb_copy_bits(skb, 0, arp, alen) < 0)
			goto out_unlock;
	}
2550

2551
	if (arp->ar_hln != bond->dev->addr_len ||
2552 2553 2554 2555 2556 2557 2558 2559
	    skb->pkt_type == PACKET_OTHERHOST ||
	    skb->pkt_type == PACKET_LOOPBACK ||
	    arp->ar_hrd != htons(ARPHRD_ETHER) ||
	    arp->ar_pro != htons(ETH_P_IP) ||
	    arp->ar_pln != 4)
		goto out_unlock;

	arp_ptr = (unsigned char *)(arp + 1);
2560
	arp_ptr += bond->dev->addr_len;
2561
	memcpy(&sip, arp_ptr, 4);
2562
	arp_ptr += 4 + bond->dev->addr_len;
2563 2564
	memcpy(&tip, arp_ptr, 4);

2565 2566 2567 2568
	netdev_dbg(bond->dev, "bond_arp_rcv: %s/%d av %d sv %d sip %pI4 tip %pI4\n",
		   slave->dev->name, bond_slave_state(slave),
		     bond->params.arp_validate, slave_do_arp_validate(bond, slave),
		     &sip, &tip);
2569

2570
	curr_active_slave = rcu_dereference(bond->curr_active_slave);
2571
	curr_arp_slave = rcu_dereference(bond->current_arp_slave);
2572

2573
	/* We 'trust' the received ARP enough to validate it if:
2574
	 *
2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593
	 * (a) the slave receiving the ARP is active (which includes the
	 * current ARP slave, if any), or
	 *
	 * (b) the receiving slave isn't active, but there is a currently
	 * active slave and it received valid arp reply(s) after it became
	 * the currently active slave, or
	 *
	 * (c) there is an ARP slave that sent an ARP during the prior ARP
	 * interval, and we receive an ARP reply on any slave.  We accept
	 * these because switch FDB update delays may deliver the ARP
	 * reply to a slave other than the sender of the ARP request.
	 *
	 * Note: for (b), backup slaves are receiving the broadcast ARP
	 * request, not a reply.  This request passes from the sending
	 * slave through the L2 switch(es) to the receiving slave.  Since
	 * this is checking the request, sip/tip are swapped for
	 * validation.
	 *
	 * This is done to avoid endless looping when we can't reach the
2594
	 * arp_ip_target and fool ourselves with our own arp requests.
2595
	 */
J
Jiri Pirko 已提交
2596
	if (bond_is_active_slave(slave))
2597
		bond_validate_arp(bond, slave, sip, tip);
2598 2599 2600
	else if (curr_active_slave &&
		 time_after(slave_last_rx(bond, curr_active_slave),
			    curr_active_slave->last_link_up))
2601
		bond_validate_arp(bond, slave, tip, sip);
2602 2603 2604 2605
	else if (curr_arp_slave && (arp->ar_op == htons(ARPOP_REPLY)) &&
		 bond_time_in_interval(bond,
				       dev_trans_start(curr_arp_slave->dev), 1))
		bond_validate_arp(bond, slave, sip, tip);
2606 2607

out_unlock:
2608 2609
	if (arp != (struct arphdr *)skb->data)
		kfree(arp);
2610
	return RX_HANDLER_ANOTHER;
2611 2612
}

2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626
/* function to verify if we're in the arp_interval timeslice, returns true if
 * (last_act - arp_interval) <= jiffies <= (last_act + mod * arp_interval +
 * arp_interval/2) . the arp_interval/2 is needed for really fast networks.
 */
static bool bond_time_in_interval(struct bonding *bond, unsigned long last_act,
				  int mod)
{
	int delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);

	return time_in_range(jiffies,
			     last_act - delta_in_ticks,
			     last_act + mod * delta_in_ticks + delta_in_ticks/2);
}

2627
/* This function is called regularly to monitor each slave's link
L
Linus Torvalds 已提交
2628 2629 2630 2631 2632
 * ensuring that traffic is being sent and received when arp monitoring
 * is used in load-balancing mode. if the adapter has been dormant, then an
 * arp is transmitted to generate traffic. see activebackup_arp_monitor for
 * arp monitoring in active backup mode.
 */
2633
static void bond_loadbalance_arp_mon(struct bonding *bond)
L
Linus Torvalds 已提交
2634 2635
{
	struct slave *slave, *oldcurrent;
2636
	struct list_head *iter;
2637
	int do_failover = 0, slave_state_changed = 0;
L
Linus Torvalds 已提交
2638

2639
	if (!bond_has_slaves(bond))
L
Linus Torvalds 已提交
2640 2641
		goto re_arm;

2642 2643
	rcu_read_lock();

2644
	oldcurrent = rcu_dereference(bond->curr_active_slave);
L
Linus Torvalds 已提交
2645 2646
	/* see if any of the previous devices are up now (i.e. they have
	 * xmt and rcv traffic). the curr_active_slave does not come into
2647 2648 2649
	 * the picture unless it is null. also, slave->last_link_up is not
	 * needed here because we send an arp on each slave and give a slave
	 * as long as it needs to get the tx/rx within the delta.
L
Linus Torvalds 已提交
2650 2651 2652
	 * TODO: what about up/down delay in arp mode? it wasn't here before
	 *       so it can wait
	 */
2653
	bond_for_each_slave_rcu(bond, slave, iter) {
2654 2655
		unsigned long trans_start = dev_trans_start(slave->dev);

2656 2657
		slave->new_link = BOND_LINK_NOCHANGE;

L
Linus Torvalds 已提交
2658
		if (slave->link != BOND_LINK_UP) {
2659
			if (bond_time_in_interval(bond, trans_start, 1) &&
2660
			    bond_time_in_interval(bond, slave->last_rx, 1)) {
L
Linus Torvalds 已提交
2661

2662
				slave->new_link = BOND_LINK_UP;
2663
				slave_state_changed = 1;
L
Linus Torvalds 已提交
2664 2665 2666 2667 2668 2669 2670

				/* primary_slave has no meaning in round-robin
				 * mode. the window of a slave being up and
				 * curr_active_slave being null after enslaving
				 * is closed.
				 */
				if (!oldcurrent) {
2671 2672
					netdev_info(bond->dev, "link status definitely up for interface %s\n",
						    slave->dev->name);
L
Linus Torvalds 已提交
2673 2674
					do_failover = 1;
				} else {
2675 2676
					netdev_info(bond->dev, "interface %s is now up\n",
						    slave->dev->name);
L
Linus Torvalds 已提交
2677 2678 2679 2680 2681 2682 2683 2684 2685
				}
			}
		} else {
			/* slave->link == BOND_LINK_UP */

			/* not all switches will respond to an arp request
			 * when the source ip is 0, so don't take the link down
			 * if we don't know our ip yet
			 */
2686
			if (!bond_time_in_interval(bond, trans_start, 2) ||
2687
			    !bond_time_in_interval(bond, slave->last_rx, 2)) {
L
Linus Torvalds 已提交
2688

2689
				slave->new_link = BOND_LINK_DOWN;
2690
				slave_state_changed = 1;
L
Linus Torvalds 已提交
2691

S
Stephen Hemminger 已提交
2692
				if (slave->link_failure_count < UINT_MAX)
L
Linus Torvalds 已提交
2693 2694
					slave->link_failure_count++;

2695 2696
				netdev_info(bond->dev, "interface %s is now down\n",
					    slave->dev->name);
L
Linus Torvalds 已提交
2697

S
Stephen Hemminger 已提交
2698
				if (slave == oldcurrent)
L
Linus Torvalds 已提交
2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709
					do_failover = 1;
			}
		}

		/* note: if switch is in round-robin mode, all links
		 * must tx arp to ensure all links rx an arp - otherwise
		 * links may oscillate or not come up at all; if switch is
		 * in something like xor mode, there is nothing we can
		 * do - all replies will be rx'ed on same link causing slaves
		 * to be unstable during low/no traffic periods
		 */
2710
		if (bond_slave_is_up(slave))
L
Linus Torvalds 已提交
2711 2712 2713
			bond_arp_send_all(bond, slave);
	}

2714 2715
	rcu_read_unlock();

2716
	if (do_failover || slave_state_changed) {
2717 2718
		if (!rtnl_trylock())
			goto re_arm;
L
Linus Torvalds 已提交
2719

2720 2721 2722 2723 2724
		bond_for_each_slave(bond, slave, iter) {
			if (slave->new_link != BOND_LINK_NOCHANGE)
				slave->link = slave->new_link;
		}

2725 2726
		if (slave_state_changed) {
			bond_slave_state_change(bond);
2727 2728
			if (BOND_MODE(bond) == BOND_MODE_XOR)
				bond_update_slave_arr(bond, NULL);
2729 2730
		}
		if (do_failover) {
2731 2732 2733 2734
			block_netpoll_tx();
			bond_select_active_slave(bond);
			unblock_netpoll_tx();
		}
2735
		rtnl_unlock();
L
Linus Torvalds 已提交
2736 2737 2738
	}

re_arm:
2739
	if (bond->params.arp_interval)
2740 2741
		queue_delayed_work(bond->wq, &bond->arp_work,
				   msecs_to_jiffies(bond->params.arp_interval));
L
Linus Torvalds 已提交
2742 2743
}

2744
/* Called to inspect slaves for active-backup mode ARP monitor link state
2745 2746 2747 2748
 * changes.  Sets new_link in slaves to specify what action should take
 * place for the slave.  Returns 0 if no changes are found, >0 if changes
 * to link states must be committed.
 *
2749
 * Called with rcu_read_lock held.
L
Linus Torvalds 已提交
2750
 */
2751
static int bond_ab_arp_inspect(struct bonding *bond)
L
Linus Torvalds 已提交
2752
{
2753
	unsigned long trans_start, last_rx;
2754
	struct list_head *iter;
2755 2756
	struct slave *slave;
	int commit = 0;
2757

2758
	bond_for_each_slave_rcu(bond, slave, iter) {
2759
		slave->new_link = BOND_LINK_NOCHANGE;
2760
		last_rx = slave_last_rx(bond, slave);
L
Linus Torvalds 已提交
2761

2762
		if (slave->link != BOND_LINK_UP) {
2763
			if (bond_time_in_interval(bond, last_rx, 1)) {
2764 2765 2766 2767 2768
				slave->new_link = BOND_LINK_UP;
				commit++;
			}
			continue;
		}
L
Linus Torvalds 已提交
2769

2770
		/* Give slaves 2*delta after being enslaved or made
2771 2772 2773
		 * active.  This avoids bouncing, as the last receive
		 * times need a full ARP monitor cycle to be updated.
		 */
2774
		if (bond_time_in_interval(bond, slave->last_link_up, 2))
2775 2776
			continue;

2777
		/* Backup slave is down if:
2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788
		 * - No current_arp_slave AND
		 * - more than 3*delta since last receive AND
		 * - the bond has an IP address
		 *
		 * Note: a non-null current_arp_slave indicates
		 * the curr_active_slave went down and we are
		 * searching for a new one; under this condition
		 * we only take the curr_active_slave down - this
		 * gives each slave a chance to tx/rx traffic
		 * before being taken out
		 */
J
Jiri Pirko 已提交
2789
		if (!bond_is_active_slave(slave) &&
2790
		    !rcu_access_pointer(bond->current_arp_slave) &&
2791
		    !bond_time_in_interval(bond, last_rx, 3)) {
2792 2793 2794 2795
			slave->new_link = BOND_LINK_DOWN;
			commit++;
		}

2796
		/* Active slave is down if:
2797 2798 2799 2800
		 * - more than 2*delta since transmitting OR
		 * - (more than 2*delta since receive AND
		 *    the bond has an IP address)
		 */
2801
		trans_start = dev_trans_start(slave->dev);
J
Jiri Pirko 已提交
2802
		if (bond_is_active_slave(slave) &&
2803 2804
		    (!bond_time_in_interval(bond, trans_start, 2) ||
		     !bond_time_in_interval(bond, last_rx, 2))) {
2805 2806 2807
			slave->new_link = BOND_LINK_DOWN;
			commit++;
		}
L
Linus Torvalds 已提交
2808 2809
	}

2810 2811
	return commit;
}
L
Linus Torvalds 已提交
2812

2813
/* Called to commit link state changes noted by inspection step of
2814 2815
 * active-backup mode ARP monitor.
 *
2816
 * Called with RTNL hold.
2817
 */
2818
static void bond_ab_arp_commit(struct bonding *bond)
2819
{
2820
	unsigned long trans_start;
2821
	struct list_head *iter;
2822
	struct slave *slave;
L
Linus Torvalds 已提交
2823

2824
	bond_for_each_slave(bond, slave, iter) {
2825 2826 2827
		switch (slave->new_link) {
		case BOND_LINK_NOCHANGE:
			continue;
2828

2829
		case BOND_LINK_UP:
2830
			trans_start = dev_trans_start(slave->dev);
2831 2832
			if (rtnl_dereference(bond->curr_active_slave) != slave ||
			    (!rtnl_dereference(bond->curr_active_slave) &&
2833
			     bond_time_in_interval(bond, trans_start, 1))) {
2834 2835 2836
				struct slave *current_arp_slave;

				current_arp_slave = rtnl_dereference(bond->current_arp_slave);
2837 2838
				bond_set_slave_link_state(slave, BOND_LINK_UP,
							  BOND_SLAVE_NOTIFY_NOW);
2839
				if (current_arp_slave) {
2840
					bond_set_slave_inactive_flags(
2841
						current_arp_slave,
2842
						BOND_SLAVE_NOTIFY_NOW);
2843
					RCU_INIT_POINTER(bond->current_arp_slave, NULL);
2844
				}
2845

2846 2847
				netdev_info(bond->dev, "link status definitely up for interface %s\n",
					    slave->dev->name);
2848

2849
				if (!rtnl_dereference(bond->curr_active_slave) ||
2850
				    slave == rtnl_dereference(bond->primary_slave))
2851
					goto do_failover;
L
Linus Torvalds 已提交
2852

2853
			}
L
Linus Torvalds 已提交
2854

2855
			continue;
L
Linus Torvalds 已提交
2856

2857 2858 2859 2860
		case BOND_LINK_DOWN:
			if (slave->link_failure_count < UINT_MAX)
				slave->link_failure_count++;

2861 2862
			bond_set_slave_link_state(slave, BOND_LINK_DOWN,
						  BOND_SLAVE_NOTIFY_NOW);
2863 2864
			bond_set_slave_inactive_flags(slave,
						      BOND_SLAVE_NOTIFY_NOW);
2865

2866 2867
			netdev_info(bond->dev, "link status definitely down for interface %s, disabling it\n",
				    slave->dev->name);
2868

2869
			if (slave == rtnl_dereference(bond->curr_active_slave)) {
2870
				RCU_INIT_POINTER(bond->current_arp_slave, NULL);
2871
				goto do_failover;
L
Linus Torvalds 已提交
2872
			}
2873 2874

			continue;
2875 2876

		default:
2877 2878
			netdev_err(bond->dev, "impossible: new_link %d on slave %s\n",
				   slave->new_link, slave->dev->name);
2879
			continue;
L
Linus Torvalds 已提交
2880 2881
		}

2882
do_failover:
2883
		block_netpoll_tx();
2884
		bond_select_active_slave(bond);
2885
		unblock_netpoll_tx();
2886
	}
L
Linus Torvalds 已提交
2887

2888 2889
	bond_set_carrier(bond);
}
L
Linus Torvalds 已提交
2890

2891
/* Send ARP probes for active-backup mode ARP monitor.
2892
 *
2893
 * Called with rcu_read_lock held.
2894
 */
2895
static bool bond_ab_arp_probe(struct bonding *bond)
2896
{
2897
	struct slave *slave, *before = NULL, *new_slave = NULL,
2898 2899
		     *curr_arp_slave = rcu_dereference(bond->current_arp_slave),
		     *curr_active_slave = rcu_dereference(bond->curr_active_slave);
2900 2901
	struct list_head *iter;
	bool found = false;
2902
	bool should_notify_rtnl = BOND_SLAVE_NOTIFY_LATER;
2903

2904
	if (curr_arp_slave && curr_active_slave)
2905 2906 2907
		netdev_info(bond->dev, "PROBE: c_arp %s && cas %s BAD\n",
			    curr_arp_slave->dev->name,
			    curr_active_slave->dev->name);
L
Linus Torvalds 已提交
2908

2909 2910
	if (curr_active_slave) {
		bond_arp_send_all(bond, curr_active_slave);
2911
		return should_notify_rtnl;
2912
	}
L
Linus Torvalds 已提交
2913

2914 2915 2916 2917
	/* if we don't have a curr_active_slave, search for the next available
	 * backup slave from the current_arp_slave and make it the candidate
	 * for becoming the curr_active_slave
	 */
L
Linus Torvalds 已提交
2918

2919
	if (!curr_arp_slave) {
2920 2921 2922
		curr_arp_slave = bond_first_slave_rcu(bond);
		if (!curr_arp_slave)
			return should_notify_rtnl;
2923
	}
L
Linus Torvalds 已提交
2924

2925
	bond_set_slave_inactive_flags(curr_arp_slave, BOND_SLAVE_NOTIFY_LATER);
2926

2927
	bond_for_each_slave_rcu(bond, slave, iter) {
2928
		if (!found && !before && bond_slave_is_up(slave))
2929
			before = slave;
L
Linus Torvalds 已提交
2930

2931
		if (found && !new_slave && bond_slave_is_up(slave))
2932
			new_slave = slave;
2933 2934 2935 2936 2937 2938
		/* if the link state is up at this point, we
		 * mark it down - this can happen if we have
		 * simultaneous link failures and
		 * reselect_active_interface doesn't make this
		 * one the current slave so it is still marked
		 * up when it is actually down
L
Linus Torvalds 已提交
2939
		 */
2940
		if (!bond_slave_is_up(slave) && slave->link == BOND_LINK_UP) {
2941 2942
			bond_set_slave_link_state(slave, BOND_LINK_DOWN,
						  BOND_SLAVE_NOTIFY_LATER);
2943 2944
			if (slave->link_failure_count < UINT_MAX)
				slave->link_failure_count++;
L
Linus Torvalds 已提交
2945

2946
			bond_set_slave_inactive_flags(slave,
2947
						      BOND_SLAVE_NOTIFY_LATER);
2948

2949 2950
			netdev_info(bond->dev, "backup interface %s is now down\n",
				    slave->dev->name);
L
Linus Torvalds 已提交
2951
		}
2952
		if (slave == curr_arp_slave)
2953
			found = true;
2954
	}
2955 2956 2957 2958

	if (!new_slave && before)
		new_slave = before;

2959 2960
	if (!new_slave)
		goto check_state;
2961

2962 2963
	bond_set_slave_link_state(new_slave, BOND_LINK_BACK,
				  BOND_SLAVE_NOTIFY_LATER);
2964
	bond_set_slave_active_flags(new_slave, BOND_SLAVE_NOTIFY_LATER);
2965
	bond_arp_send_all(bond, new_slave);
2966
	new_slave->last_link_up = jiffies;
2967
	rcu_assign_pointer(bond->current_arp_slave, new_slave);
2968

2969 2970
check_state:
	bond_for_each_slave_rcu(bond, slave, iter) {
2971
		if (slave->should_notify || slave->should_notify_link) {
2972 2973 2974 2975 2976
			should_notify_rtnl = BOND_SLAVE_NOTIFY_NOW;
			break;
		}
	}
	return should_notify_rtnl;
2977
}
L
Linus Torvalds 已提交
2978

2979
static void bond_activebackup_arp_mon(struct bonding *bond)
2980
{
2981 2982
	bool should_notify_peers = false;
	bool should_notify_rtnl = false;
2983
	int delta_in_ticks;
L
Linus Torvalds 已提交
2984

2985 2986 2987
	delta_in_ticks = msecs_to_jiffies(bond->params.arp_interval);

	if (!bond_has_slaves(bond))
2988 2989
		goto re_arm;

2990
	rcu_read_lock();
2991

2992 2993
	should_notify_peers = bond_should_notify_peers(bond);

2994 2995 2996
	if (bond_ab_arp_inspect(bond)) {
		rcu_read_unlock();

2997 2998 2999 3000 3001 3002
		/* Race avoidance with bond_close flush of workqueue */
		if (!rtnl_trylock()) {
			delta_in_ticks = 1;
			should_notify_peers = false;
			goto re_arm;
		}
3003

3004
		bond_ab_arp_commit(bond);
3005

3006
		rtnl_unlock();
3007
		rcu_read_lock();
3008 3009
	}

3010 3011
	should_notify_rtnl = bond_ab_arp_probe(bond);
	rcu_read_unlock();
3012

3013 3014
re_arm:
	if (bond->params.arp_interval)
3015 3016
		queue_delayed_work(bond->wq, &bond->arp_work, delta_in_ticks);

3017
	if (should_notify_peers || should_notify_rtnl) {
3018 3019
		if (!rtnl_trylock())
			return;
3020 3021 3022 3023

		if (should_notify_peers)
			call_netdevice_notifiers(NETDEV_NOTIFY_PEERS,
						 bond->dev);
3024
		if (should_notify_rtnl) {
3025
			bond_slave_state_notify(bond);
3026 3027
			bond_slave_link_notify(bond);
		}
3028

3029 3030
		rtnl_unlock();
	}
L
Linus Torvalds 已提交
3031 3032
}

3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043
static void bond_arp_monitor(struct work_struct *work)
{
	struct bonding *bond = container_of(work, struct bonding,
					    arp_work.work);

	if (BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
		bond_activebackup_arp_mon(bond);
	else
		bond_loadbalance_arp_mon(bond);
}

L
Linus Torvalds 已提交
3044 3045
/*-------------------------- netdev event handling --------------------------*/

3046
/* Change device name */
L
Linus Torvalds 已提交
3047 3048 3049 3050
static int bond_event_changename(struct bonding *bond)
{
	bond_remove_proc_entry(bond);
	bond_create_proc_entry(bond);
3051

3052 3053
	bond_debug_reregister(bond);

L
Linus Torvalds 已提交
3054 3055 3056
	return NOTIFY_DONE;
}

S
Stephen Hemminger 已提交
3057 3058
static int bond_master_netdev_event(unsigned long event,
				    struct net_device *bond_dev)
L
Linus Torvalds 已提交
3059
{
3060
	struct bonding *event_bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
3061 3062 3063 3064

	switch (event) {
	case NETDEV_CHANGENAME:
		return bond_event_changename(event_bond);
3065 3066 3067 3068 3069 3070
	case NETDEV_UNREGISTER:
		bond_remove_proc_entry(event_bond);
		break;
	case NETDEV_REGISTER:
		bond_create_proc_entry(event_bond);
		break;
3071 3072 3073 3074
	case NETDEV_NOTIFY_PEERS:
		if (event_bond->send_peer_notif)
			event_bond->send_peer_notif--;
		break;
L
Linus Torvalds 已提交
3075 3076 3077 3078 3079 3080 3081
	default:
		break;
	}

	return NOTIFY_DONE;
}

S
Stephen Hemminger 已提交
3082 3083
static int bond_slave_netdev_event(unsigned long event,
				   struct net_device *slave_dev)
L
Linus Torvalds 已提交
3084
{
3085
	struct slave *slave = bond_slave_get_rtnl(slave_dev), *primary;
3086 3087
	struct bonding *bond;
	struct net_device *bond_dev;
L
Linus Torvalds 已提交
3088

3089 3090 3091 3092 3093 3094 3095 3096
	/* A netdev event can be generated while enslaving a device
	 * before netdev_rx_handler_register is called in which case
	 * slave will be NULL
	 */
	if (!slave)
		return NOTIFY_DONE;
	bond_dev = slave->bond->dev;
	bond = slave->bond;
3097
	primary = rtnl_dereference(bond->primary_slave);
3098

L
Linus Torvalds 已提交
3099 3100
	switch (event) {
	case NETDEV_UNREGISTER:
3101
		if (bond_dev->type != ARPHRD_ETHER)
3102 3103
			bond_release_and_destroy(bond_dev, slave_dev);
		else
3104
			__bond_release_one(bond_dev, slave_dev, false, true);
L
Linus Torvalds 已提交
3105
		break;
3106
	case NETDEV_UP:
L
Linus Torvalds 已提交
3107
	case NETDEV_CHANGE:
3108 3109
		/* For 802.3ad mode only:
		 * Getting invalid Speed/Duplex values here will put slave
3110 3111 3112 3113
		 * in weird state. Mark it as link-fail if the link was
		 * previously up or link-down if it hasn't yet come up, and
		 * let link-monitoring (miimon) set it right when correct
		 * speeds/duplex are available.
3114 3115
		 */
		if (bond_update_speed_duplex(slave) &&
3116 3117 3118 3119 3120 3121
		    BOND_MODE(bond) == BOND_MODE_8023AD) {
			if (slave->last_link_up)
				slave->link = BOND_LINK_FAIL;
			else
				slave->link = BOND_LINK_DOWN;
		}
3122

3123 3124
		if (BOND_MODE(bond) == BOND_MODE_8023AD)
			bond_3ad_adapter_speed_duplex_changed(slave);
M
Mahesh Bandewar 已提交
3125 3126
		/* Fallthrough */
	case NETDEV_DOWN:
3127 3128 3129 3130 3131 3132 3133 3134
		/* Refresh slave-array if applicable!
		 * If the setup does not use miimon or arpmon (mode-specific!),
		 * then these events will not cause the slave-array to be
		 * refreshed. This will cause xmit to use a slave that is not
		 * usable. Avoid such situation by refeshing the array at these
		 * events. If these (miimon/arpmon) parameters are configured
		 * then array gets refreshed twice and that should be fine!
		 */
3135
		if (bond_mode_can_use_xmit_hash(bond))
3136
			bond_update_slave_arr(bond, NULL);
L
Linus Torvalds 已提交
3137 3138
		break;
	case NETDEV_CHANGEMTU:
3139
		/* TODO: Should slaves be allowed to
L
Linus Torvalds 已提交
3140 3141 3142 3143 3144 3145 3146 3147 3148 3149 3150 3151
		 * independently alter their MTU?  For
		 * an active-backup bond, slaves need
		 * not be the same type of device, so
		 * MTUs may vary.  For other modes,
		 * slaves arguably should have the
		 * same MTUs. To do this, we'd need to
		 * take over the slave's change_mtu
		 * function for the duration of their
		 * servitude.
		 */
		break;
	case NETDEV_CHANGENAME:
3152
		/* we don't care if we don't have primary set */
3153
		if (!bond_uses_primary(bond) ||
3154 3155 3156
		    !bond->params.primary[0])
			break;

3157
		if (slave == primary) {
3158
			/* slave's name changed - he's no longer primary */
3159
			RCU_INIT_POINTER(bond->primary_slave, NULL);
3160 3161
		} else if (!strcmp(slave_dev->name, bond->params.primary)) {
			/* we have a new primary slave */
3162
			rcu_assign_pointer(bond->primary_slave, slave);
3163 3164 3165 3166
		} else { /* we didn't change primary - exit */
			break;
		}

3167
		netdev_info(bond->dev, "Primary slave changed to %s, reselecting active slave\n",
3168
			    primary ? slave_dev->name : "none");
3169 3170

		block_netpoll_tx();
3171
		bond_select_active_slave(bond);
3172
		unblock_netpoll_tx();
L
Linus Torvalds 已提交
3173
		break;
3174 3175 3176
	case NETDEV_FEAT_CHANGE:
		bond_compute_features(bond);
		break;
3177 3178 3179 3180
	case NETDEV_RESEND_IGMP:
		/* Propagate to master device */
		call_netdevice_notifiers(event, slave->bond->dev);
		break;
L
Linus Torvalds 已提交
3181 3182 3183 3184 3185 3186 3187
	default:
		break;
	}

	return NOTIFY_DONE;
}

3188
/* bond_netdev_event: handle netdev notifier chain events.
L
Linus Torvalds 已提交
3189 3190
 *
 * This function receives events for the netdev chain.  The caller (an
3191
 * ioctl handler calling blocking_notifier_call_chain) holds the necessary
L
Linus Torvalds 已提交
3192 3193 3194
 * locks for us to safely manipulate the slave devices (RTNL lock,
 * dev_probe_lock).
 */
S
Stephen Hemminger 已提交
3195 3196
static int bond_netdev_event(struct notifier_block *this,
			     unsigned long event, void *ptr)
L
Linus Torvalds 已提交
3197
{
3198
	struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
L
Linus Torvalds 已提交
3199

3200
	netdev_dbg(event_dev, "event: %lx\n", event);
L
Linus Torvalds 已提交
3201

3202 3203 3204
	if (!(event_dev->priv_flags & IFF_BONDING))
		return NOTIFY_DONE;

L
Linus Torvalds 已提交
3205
	if (event_dev->flags & IFF_MASTER) {
3206 3207
		int ret;

3208
		netdev_dbg(event_dev, "IFF_MASTER\n");
3209 3210 3211
		ret = bond_master_netdev_event(event, event_dev);
		if (ret != NOTIFY_DONE)
			return ret;
L
Linus Torvalds 已提交
3212 3213 3214
	}

	if (event_dev->flags & IFF_SLAVE) {
3215
		netdev_dbg(event_dev, "IFF_SLAVE\n");
L
Linus Torvalds 已提交
3216 3217 3218 3219 3220 3221 3222 3223 3224 3225
		return bond_slave_netdev_event(event, event_dev);
	}

	return NOTIFY_DONE;
}

static struct notifier_block bond_netdev_notifier = {
	.notifier_call = bond_netdev_event,
};

3226 3227
/*---------------------------- Hashing Policies -----------------------------*/

3228 3229
/* L2 hash helper */
static inline u32 bond_eth_hash(struct sk_buff *skb)
3230
{
3231
	struct ethhdr *ep, hdr_tmp;
3232

3233 3234 3235
	ep = skb_header_pointer(skb, 0, sizeof(hdr_tmp), &hdr_tmp);
	if (ep)
		return ep->h_dest[5] ^ ep->h_source[5] ^ ep->h_proto;
3236 3237 3238
	return 0;
}

3239 3240 3241
/* Extract the appropriate headers based on bond's xmit policy */
static bool bond_flow_dissect(struct bonding *bond, struct sk_buff *skb,
			      struct flow_keys *fk)
3242
{
3243
	const struct ipv6hdr *iph6;
3244
	const struct iphdr *iph;
3245
	int noff, proto = -1;
3246

3247
	if (bond->params.xmit_policy > BOND_XMIT_POLICY_LAYER23)
3248
		return skb_flow_dissect_flow_keys(skb, fk, 0);
3249

3250
	fk->ports.ports = 0;
3251 3252
	noff = skb_network_offset(skb);
	if (skb->protocol == htons(ETH_P_IP)) {
3253
		if (unlikely(!pskb_may_pull(skb, noff + sizeof(*iph))))
3254
			return false;
3255
		iph = ip_hdr(skb);
3256
		iph_to_flow_copy_v4addrs(fk, iph);
3257 3258 3259 3260
		noff += iph->ihl << 2;
		if (!ip_is_fragment(iph))
			proto = iph->protocol;
	} else if (skb->protocol == htons(ETH_P_IPV6)) {
3261
		if (unlikely(!pskb_may_pull(skb, noff + sizeof(*iph6))))
3262 3263
			return false;
		iph6 = ipv6_hdr(skb);
3264
		iph_to_flow_copy_v6addrs(fk, iph6);
3265 3266 3267 3268
		noff += sizeof(*iph6);
		proto = iph6->nexthdr;
	} else {
		return false;
3269
	}
3270
	if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER34 && proto >= 0)
3271
		fk->ports.ports = skb_flow_get_ports(skb, noff, proto);
3272

3273
	return true;
3274 3275
}

3276 3277 3278 3279 3280 3281 3282
/**
 * bond_xmit_hash - generate a hash value based on the xmit policy
 * @bond: bonding device
 * @skb: buffer to use for headers
 *
 * This function will extract the necessary headers from the skb buffer and use
 * them to generate a hash based on the xmit_policy set in the bonding device
3283
 */
3284
u32 bond_xmit_hash(struct bonding *bond, struct sk_buff *skb)
3285
{
3286 3287
	struct flow_keys flow;
	u32 hash;
3288

E
Eric Dumazet 已提交
3289 3290 3291 3292
	if (bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP34 &&
	    skb->l4_hash)
		return skb->hash;

3293 3294
	if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER2 ||
	    !bond_flow_dissect(bond, skb, &flow))
3295
		return bond_eth_hash(skb);
3296

3297 3298 3299 3300
	if (bond->params.xmit_policy == BOND_XMIT_POLICY_LAYER23 ||
	    bond->params.xmit_policy == BOND_XMIT_POLICY_ENCAP23)
		hash = bond_eth_hash(skb);
	else
3301
		hash = (__force u32)flow.ports.ports;
3302 3303
	hash ^= (__force u32)flow_get_u32_dst(&flow) ^
		(__force u32)flow_get_u32_src(&flow);
3304 3305 3306
	hash ^= (hash >> 16);
	hash ^= (hash >> 8);

3307
	return hash >> 1;
3308 3309
}

L
Linus Torvalds 已提交
3310 3311
/*-------------------------- Device entry points ----------------------------*/

3312
void bond_work_init_all(struct bonding *bond)
3313 3314 3315 3316 3317
{
	INIT_DELAYED_WORK(&bond->mcast_work,
			  bond_resend_igmp_join_requests_delayed);
	INIT_DELAYED_WORK(&bond->alb_work, bond_alb_monitor);
	INIT_DELAYED_WORK(&bond->mii_work, bond_mii_monitor);
3318
	INIT_DELAYED_WORK(&bond->arp_work, bond_arp_monitor);
3319
	INIT_DELAYED_WORK(&bond->ad_work, bond_3ad_state_machine_handler);
3320
	INIT_DELAYED_WORK(&bond->slave_arr_work, bond_slave_arr_handler);
3321 3322 3323 3324 3325 3326 3327 3328 3329
}

static void bond_work_cancel_all(struct bonding *bond)
{
	cancel_delayed_work_sync(&bond->mii_work);
	cancel_delayed_work_sync(&bond->arp_work);
	cancel_delayed_work_sync(&bond->alb_work);
	cancel_delayed_work_sync(&bond->ad_work);
	cancel_delayed_work_sync(&bond->mcast_work);
3330
	cancel_delayed_work_sync(&bond->slave_arr_work);
3331 3332
}

L
Linus Torvalds 已提交
3333 3334
static int bond_open(struct net_device *bond_dev)
{
3335
	struct bonding *bond = netdev_priv(bond_dev);
3336
	struct list_head *iter;
3337
	struct slave *slave;
L
Linus Torvalds 已提交
3338

3339
	/* reset slave->backup and slave->inactive */
3340
	if (bond_has_slaves(bond)) {
3341
		bond_for_each_slave(bond, slave, iter) {
3342 3343
			if (bond_uses_primary(bond) &&
			    slave != rcu_access_pointer(bond->curr_active_slave)) {
3344 3345
				bond_set_slave_inactive_flags(slave,
							      BOND_SLAVE_NOTIFY_NOW);
3346
			} else if (BOND_MODE(bond) != BOND_MODE_8023AD) {
3347 3348
				bond_set_slave_active_flags(slave,
							    BOND_SLAVE_NOTIFY_NOW);
3349 3350 3351 3352
			}
		}
	}

3353
	if (bond_is_lb(bond)) {
L
Linus Torvalds 已提交
3354 3355 3356
		/* bond_alb_initialize must be called before the timer
		 * is started.
		 */
3357
		if (bond_alb_initialize(bond, (BOND_MODE(bond) == BOND_MODE_ALB)))
3358
			return -ENOMEM;
3359
		if (bond->params.tlb_dynamic_lb || BOND_MODE(bond) == BOND_MODE_ALB)
3360
			queue_delayed_work(bond->wq, &bond->alb_work, 0);
L
Linus Torvalds 已提交
3361 3362
	}

3363
	if (bond->params.miimon)  /* link check interval, in milliseconds. */
3364
		queue_delayed_work(bond->wq, &bond->mii_work, 0);
L
Linus Torvalds 已提交
3365 3366

	if (bond->params.arp_interval) {  /* arp interval, in milliseconds. */
3367
		queue_delayed_work(bond->wq, &bond->arp_work, 0);
3368
		bond->recv_probe = bond_arp_rcv;
L
Linus Torvalds 已提交
3369 3370
	}

3371
	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
3372
		queue_delayed_work(bond->wq, &bond->ad_work, 0);
L
Linus Torvalds 已提交
3373
		/* register to receive LACPDUs */
3374
		bond->recv_probe = bond_3ad_lacpdu_recv;
3375
		bond_3ad_initiate_agg_selection(bond, 1);
L
Linus Torvalds 已提交
3376 3377
	}

3378
	if (bond_mode_can_use_xmit_hash(bond))
3379 3380
		bond_update_slave_arr(bond, NULL);

L
Linus Torvalds 已提交
3381 3382 3383 3384 3385
	return 0;
}

static int bond_close(struct net_device *bond_dev)
{
3386
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
3387

3388
	bond_work_cancel_all(bond);
3389
	bond->send_peer_notif = 0;
3390
	if (bond_is_lb(bond))
L
Linus Torvalds 已提交
3391
		bond_alb_deinitialize(bond);
3392
	bond->recv_probe = NULL;
L
Linus Torvalds 已提交
3393 3394 3395 3396

	return 0;
}

E
Eric Dumazet 已提交
3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411
/* fold stats, assuming all rtnl_link_stats64 fields are u64, but
 * that some drivers can provide 32bit values only.
 */
static void bond_fold_stats(struct rtnl_link_stats64 *_res,
			    const struct rtnl_link_stats64 *_new,
			    const struct rtnl_link_stats64 *_old)
{
	const u64 *new = (const u64 *)_new;
	const u64 *old = (const u64 *)_old;
	u64 *res = (u64 *)_res;
	int i;

	for (i = 0; i < sizeof(*_res) / sizeof(u64); i++) {
		u64 nv = new[i];
		u64 ov = old[i];
3412
		s64 delta = nv - ov;
E
Eric Dumazet 已提交
3413 3414 3415

		/* detects if this particular field is 32bit only */
		if (((nv | ov) >> 32) == 0)
3416 3417 3418 3419 3420 3421 3422
			delta = (s64)(s32)((u32)nv - (u32)ov);

		/* filter anomalies, some drivers reset their stats
		 * at down/up events.
		 */
		if (delta > 0)
			res[i] += delta;
E
Eric Dumazet 已提交
3423 3424 3425
	}
}

3426 3427 3428 3429 3430 3431 3432
static int bond_get_nest_level(struct net_device *bond_dev)
{
	struct bonding *bond = netdev_priv(bond_dev);

	return bond->nest_level;
}

3433 3434
static void bond_get_stats(struct net_device *bond_dev,
			   struct rtnl_link_stats64 *stats)
L
Linus Torvalds 已提交
3435
{
3436
	struct bonding *bond = netdev_priv(bond_dev);
3437
	struct rtnl_link_stats64 temp;
3438
	struct list_head *iter;
L
Linus Torvalds 已提交
3439 3440
	struct slave *slave;

3441
	spin_lock_nested(&bond->stats_lock, bond_get_nest_level(bond_dev));
3442
	memcpy(stats, &bond->bond_stats, sizeof(*stats));
L
Linus Torvalds 已提交
3443

E
Eric Dumazet 已提交
3444 3445 3446
	rcu_read_lock();
	bond_for_each_slave_rcu(bond, slave, iter) {
		const struct rtnl_link_stats64 *new =
3447
			dev_get_stats(slave->dev, &temp);
E
Eric Dumazet 已提交
3448 3449

		bond_fold_stats(stats, new, &slave->slave_stats);
3450 3451

		/* save off the slave stats for the next run */
E
Eric Dumazet 已提交
3452
		memcpy(&slave->slave_stats, new, sizeof(*new));
3453
	}
E
Eric Dumazet 已提交
3454 3455
	rcu_read_unlock();

3456
	memcpy(&bond->bond_stats, stats, sizeof(*stats));
E
Eric Dumazet 已提交
3457
	spin_unlock(&bond->stats_lock);
L
Linus Torvalds 已提交
3458 3459 3460 3461
}

static int bond_do_ioctl(struct net_device *bond_dev, struct ifreq *ifr, int cmd)
{
3462
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
3463 3464 3465 3466 3467 3468
	struct net_device *slave_dev = NULL;
	struct ifbond k_binfo;
	struct ifbond __user *u_binfo = NULL;
	struct ifslave k_sinfo;
	struct ifslave __user *u_sinfo = NULL;
	struct mii_ioctl_data *mii = NULL;
3469
	struct bond_opt_value newval;
3470
	struct net *net;
L
Linus Torvalds 已提交
3471 3472
	int res = 0;

3473
	netdev_dbg(bond_dev, "bond_ioctl: cmd=%d\n", cmd);
L
Linus Torvalds 已提交
3474 3475 3476 3477

	switch (cmd) {
	case SIOCGMIIPHY:
		mii = if_mii(ifr);
S
Stephen Hemminger 已提交
3478
		if (!mii)
L
Linus Torvalds 已提交
3479
			return -EINVAL;
S
Stephen Hemminger 已提交
3480

L
Linus Torvalds 已提交
3481 3482 3483
		mii->phy_id = 0;
		/* Fall Through */
	case SIOCGMIIREG:
3484
		/* We do this again just in case we were called by SIOCGMIIREG
L
Linus Torvalds 已提交
3485 3486 3487
		 * instead of SIOCGMIIPHY.
		 */
		mii = if_mii(ifr);
S
Stephen Hemminger 已提交
3488
		if (!mii)
L
Linus Torvalds 已提交
3489
			return -EINVAL;
S
Stephen Hemminger 已提交
3490

L
Linus Torvalds 已提交
3491 3492
		if (mii->reg_num == 1) {
			mii->val_out = 0;
S
Stephen Hemminger 已提交
3493
			if (netif_carrier_ok(bond->dev))
L
Linus Torvalds 已提交
3494 3495 3496 3497 3498 3499 3500 3501
				mii->val_out = BMSR_LSTATUS;
		}

		return 0;
	case BOND_INFO_QUERY_OLD:
	case SIOCBONDINFOQUERY:
		u_binfo = (struct ifbond __user *)ifr->ifr_data;

S
Stephen Hemminger 已提交
3502
		if (copy_from_user(&k_binfo, u_binfo, sizeof(ifbond)))
L
Linus Torvalds 已提交
3503 3504
			return -EFAULT;

3505 3506
		bond_info_query(bond_dev, &k_binfo);
		if (copy_to_user(u_binfo, &k_binfo, sizeof(ifbond)))
S
Stephen Hemminger 已提交
3507
			return -EFAULT;
L
Linus Torvalds 已提交
3508

3509
		return 0;
L
Linus Torvalds 已提交
3510 3511 3512 3513
	case BOND_SLAVE_INFO_QUERY_OLD:
	case SIOCBONDSLAVEINFOQUERY:
		u_sinfo = (struct ifslave __user *)ifr->ifr_data;

S
Stephen Hemminger 已提交
3514
		if (copy_from_user(&k_sinfo, u_sinfo, sizeof(ifslave)))
L
Linus Torvalds 已提交
3515 3516 3517
			return -EFAULT;

		res = bond_slave_info_query(bond_dev, &k_sinfo);
S
Stephen Hemminger 已提交
3518 3519 3520
		if (res == 0 &&
		    copy_to_user(u_sinfo, &k_sinfo, sizeof(ifslave)))
			return -EFAULT;
L
Linus Torvalds 已提交
3521 3522 3523 3524 3525 3526

		return res;
	default:
		break;
	}

3527 3528 3529
	net = dev_net(bond_dev);

	if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
L
Linus Torvalds 已提交
3530 3531
		return -EPERM;

3532
	slave_dev = __dev_get_by_name(net, ifr->ifr_slave);
L
Linus Torvalds 已提交
3533

3534
	netdev_dbg(bond_dev, "slave_dev=%p:\n", slave_dev);
L
Linus Torvalds 已提交
3535

S
Stephen Hemminger 已提交
3536
	if (!slave_dev)
3537
		return -ENODEV;
L
Linus Torvalds 已提交
3538

3539
	netdev_dbg(bond_dev, "slave_dev->name=%s:\n", slave_dev->name);
3540 3541 3542
	switch (cmd) {
	case BOND_ENSLAVE_OLD:
	case SIOCBONDENSLAVE:
D
David Ahern 已提交
3543
		res = bond_enslave(bond_dev, slave_dev, NULL);
3544 3545 3546 3547 3548 3549 3550 3551 3552 3553 3554 3555
		break;
	case BOND_RELEASE_OLD:
	case SIOCBONDRELEASE:
		res = bond_release(bond_dev, slave_dev);
		break;
	case BOND_SETHWADDR_OLD:
	case SIOCBONDSETHWADDR:
		bond_set_dev_addr(bond_dev, slave_dev);
		res = 0;
		break;
	case BOND_CHANGE_ACTIVE_OLD:
	case SIOCBONDCHANGEACTIVE:
3556
		bond_opt_initstr(&newval, slave_dev->name);
3557 3558
		res = __bond_opt_set_notify(bond, BOND_OPT_ACTIVE_SLAVE,
					    &newval);
3559 3560 3561
		break;
	default:
		res = -EOPNOTSUPP;
L
Linus Torvalds 已提交
3562 3563 3564 3565 3566
	}

	return res;
}

3567
static void bond_change_rx_flags(struct net_device *bond_dev, int change)
L
Linus Torvalds 已提交
3568
{
3569
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
3570

3571 3572 3573
	if (change & IFF_PROMISC)
		bond_set_promiscuity(bond,
				     bond_dev->flags & IFF_PROMISC ? 1 : -1);
S
Stephen Hemminger 已提交
3574

3575 3576 3577 3578
	if (change & IFF_ALLMULTI)
		bond_set_allmulti(bond,
				  bond_dev->flags & IFF_ALLMULTI ? 1 : -1);
}
L
Linus Torvalds 已提交
3579

3580
static void bond_set_rx_mode(struct net_device *bond_dev)
3581 3582
{
	struct bonding *bond = netdev_priv(bond_dev);
3583
	struct list_head *iter;
3584
	struct slave *slave;
L
Linus Torvalds 已提交
3585

3586
	rcu_read_lock();
3587
	if (bond_uses_primary(bond)) {
3588
		slave = rcu_dereference(bond->curr_active_slave);
3589 3590 3591 3592 3593
		if (slave) {
			dev_uc_sync(slave->dev, bond_dev);
			dev_mc_sync(slave->dev, bond_dev);
		}
	} else {
3594
		bond_for_each_slave_rcu(bond, slave, iter) {
3595 3596 3597
			dev_uc_sync_multiple(slave->dev, bond_dev);
			dev_mc_sync_multiple(slave->dev, bond_dev);
		}
L
Linus Torvalds 已提交
3598
	}
3599
	rcu_read_unlock();
L
Linus Torvalds 已提交
3600 3601
}

3602
static int bond_neigh_init(struct neighbour *n)
3603
{
3604 3605 3606
	struct bonding *bond = netdev_priv(n->dev);
	const struct net_device_ops *slave_ops;
	struct neigh_parms parms;
3607
	struct slave *slave;
3608 3609
	int ret;

3610
	slave = bond_first_slave(bond);
3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622
	if (!slave)
		return 0;
	slave_ops = slave->dev->netdev_ops;
	if (!slave_ops->ndo_neigh_setup)
		return 0;

	parms.neigh_setup = NULL;
	parms.neigh_cleanup = NULL;
	ret = slave_ops->ndo_neigh_setup(slave->dev, &parms);
	if (ret)
		return ret;

3623
	/* Assign slave's neigh_cleanup to neighbour in case cleanup is called
3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634 3635
	 * after the last slave has been detached.  Assumes that all slaves
	 * utilize the same neigh_cleanup (true at this writing as only user
	 * is ipoib).
	 */
	n->parms->neigh_cleanup = parms.neigh_cleanup;

	if (!parms.neigh_setup)
		return 0;

	return parms.neigh_setup(n);
}

3636
/* The bonding ndo_neigh_setup is called at init time beofre any
3637 3638
 * slave exists. So we must declare proxy setup function which will
 * be used at run time to resolve the actual slave neigh param setup.
3639 3640 3641 3642
 *
 * It's also called by master devices (such as vlans) to setup their
 * underlying devices. In that case - do nothing, we're already set up from
 * our init.
3643 3644 3645 3646
 */
static int bond_neigh_setup(struct net_device *dev,
			    struct neigh_parms *parms)
{
3647 3648 3649
	/* modify only our neigh_parms */
	if (parms->dev == dev)
		parms->neigh_setup = bond_neigh_init;
3650 3651 3652 3653

	return 0;
}

3654
/* Change the MTU of all of a master's slaves to match the master */
L
Linus Torvalds 已提交
3655 3656
static int bond_change_mtu(struct net_device *bond_dev, int new_mtu)
{
3657
	struct bonding *bond = netdev_priv(bond_dev);
3658
	struct slave *slave, *rollback_slave;
3659
	struct list_head *iter;
L
Linus Torvalds 已提交
3660 3661
	int res = 0;

3662
	netdev_dbg(bond_dev, "bond=%p, new_mtu=%d\n", bond, new_mtu);
L
Linus Torvalds 已提交
3663

3664
	bond_for_each_slave(bond, slave, iter) {
3665 3666
		netdev_dbg(bond_dev, "s %p c_m %p\n",
			   slave, slave->dev->netdev_ops->ndo_change_mtu);
3667

L
Linus Torvalds 已提交
3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678
		res = dev_set_mtu(slave->dev, new_mtu);

		if (res) {
			/* If we failed to set the slave's mtu to the new value
			 * we must abort the operation even in ACTIVE_BACKUP
			 * mode, because if we allow the backup slaves to have
			 * different mtu values than the active slave we'll
			 * need to change their mtu when doing a failover. That
			 * means changing their mtu from timer context, which
			 * is probably not a good idea.
			 */
3679 3680
			netdev_dbg(bond_dev, "err %d %s\n", res,
				   slave->dev->name);
L
Linus Torvalds 已提交
3681 3682 3683 3684 3685 3686 3687 3688 3689 3690
			goto unwind;
		}
	}

	bond_dev->mtu = new_mtu;

	return 0;

unwind:
	/* unwind from head to the slave that failed */
3691
	bond_for_each_slave(bond, rollback_slave, iter) {
L
Linus Torvalds 已提交
3692 3693
		int tmp_res;

3694 3695 3696 3697
		if (rollback_slave == slave)
			break;

		tmp_res = dev_set_mtu(rollback_slave->dev, bond_dev->mtu);
L
Linus Torvalds 已提交
3698
		if (tmp_res) {
3699 3700
			netdev_dbg(bond_dev, "unwind err %d dev %s\n",
				   tmp_res, rollback_slave->dev->name);
L
Linus Torvalds 已提交
3701 3702 3703 3704 3705 3706
		}
	}

	return res;
}

3707
/* Change HW address
L
Linus Torvalds 已提交
3708 3709 3710 3711 3712 3713 3714
 *
 * Note that many devices must be down to change the HW address, and
 * downing the master releases all slaves.  We can make bonds full of
 * bonding devices to test this, however.
 */
static int bond_set_mac_address(struct net_device *bond_dev, void *addr)
{
3715
	struct bonding *bond = netdev_priv(bond_dev);
3716
	struct slave *slave, *rollback_slave;
3717
	struct sockaddr_storage *ss = addr, tmp_ss;
3718
	struct list_head *iter;
L
Linus Torvalds 已提交
3719 3720
	int res = 0;

3721
	if (BOND_MODE(bond) == BOND_MODE_ALB)
3722 3723 3724
		return bond_alb_set_mac_address(bond_dev, addr);


3725
	netdev_dbg(bond_dev, "bond=%p\n", bond);
L
Linus Torvalds 已提交
3726

3727 3728
	/* If fail_over_mac is enabled, do nothing and return success.
	 * Returning an error causes ifenslave to fail.
3729
	 */
3730
	if (bond->params.fail_over_mac &&
3731
	    BOND_MODE(bond) == BOND_MODE_ACTIVEBACKUP)
3732
		return 0;
3733

3734
	if (!is_valid_ether_addr(ss->__data))
L
Linus Torvalds 已提交
3735 3736
		return -EADDRNOTAVAIL;

3737
	bond_for_each_slave(bond, slave, iter) {
3738
		netdev_dbg(bond_dev, "slave %p %s\n", slave, slave->dev->name);
L
Linus Torvalds 已提交
3739 3740 3741 3742 3743 3744 3745 3746
		res = dev_set_mac_address(slave->dev, addr);
		if (res) {
			/* TODO: consider downing the slave
			 * and retry ?
			 * User should expect communications
			 * breakage anyway until ARP finish
			 * updating, so...
			 */
3747
			netdev_dbg(bond_dev, "err %d %s\n", res, slave->dev->name);
L
Linus Torvalds 已提交
3748 3749 3750 3751 3752
			goto unwind;
		}
	}

	/* success */
3753
	memcpy(bond_dev->dev_addr, ss->__data, bond_dev->addr_len);
L
Linus Torvalds 已提交
3754 3755 3756
	return 0;

unwind:
3757 3758
	memcpy(tmp_ss.__data, bond_dev->dev_addr, bond_dev->addr_len);
	tmp_ss.ss_family = bond_dev->type;
L
Linus Torvalds 已提交
3759 3760

	/* unwind from head to the slave that failed */
3761
	bond_for_each_slave(bond, rollback_slave, iter) {
L
Linus Torvalds 已提交
3762 3763
		int tmp_res;

3764 3765 3766
		if (rollback_slave == slave)
			break;

3767 3768
		tmp_res = dev_set_mac_address(rollback_slave->dev,
					      (struct sockaddr *)&tmp_ss);
L
Linus Torvalds 已提交
3769
		if (tmp_res) {
3770 3771
			netdev_dbg(bond_dev, "unwind err %d dev %s\n",
				   tmp_res, rollback_slave->dev->name);
L
Linus Torvalds 已提交
3772 3773 3774 3775 3776 3777
		}
	}

	return res;
}

3778 3779 3780 3781 3782 3783 3784 3785 3786 3787
/**
 * bond_xmit_slave_id - transmit skb through slave with slave_id
 * @bond: bonding device that is transmitting
 * @skb: buffer to transmit
 * @slave_id: slave id up to slave_cnt-1 through which to transmit
 *
 * This function tries to transmit through slave with slave_id but in case
 * it fails, it tries to find the first available slave for transmission.
 * The skb is consumed in all cases, thus the function is void.
 */
3788
static void bond_xmit_slave_id(struct bonding *bond, struct sk_buff *skb, int slave_id)
3789
{
3790
	struct list_head *iter;
3791 3792 3793 3794
	struct slave *slave;
	int i = slave_id;

	/* Here we start from the slave with slave_id */
3795
	bond_for_each_slave_rcu(bond, slave, iter) {
3796
		if (--i < 0) {
3797
			if (bond_slave_can_tx(slave)) {
3798 3799 3800 3801 3802 3803 3804 3805
				bond_dev_queue_xmit(bond, skb, slave->dev);
				return;
			}
		}
	}

	/* Here we start from the first slave up to slave_id */
	i = slave_id;
3806
	bond_for_each_slave_rcu(bond, slave, iter) {
3807 3808
		if (--i < 0)
			break;
3809
		if (bond_slave_can_tx(slave)) {
3810 3811 3812 3813 3814
			bond_dev_queue_xmit(bond, skb, slave->dev);
			return;
		}
	}
	/* no slave that can tx has been found */
E
Eric Dumazet 已提交
3815
	bond_tx_drop(bond->dev, skb);
3816 3817
}

3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828
/**
 * bond_rr_gen_slave_id - generate slave id based on packets_per_slave
 * @bond: bonding device to use
 *
 * Based on the value of the bonding device's packets_per_slave parameter
 * this function generates a slave id, which is usually used as the next
 * slave to transmit through.
 */
static u32 bond_rr_gen_slave_id(struct bonding *bond)
{
	u32 slave_id;
3829 3830
	struct reciprocal_value reciprocal_packets_per_slave;
	int packets_per_slave = bond->params.packets_per_slave;
3831 3832 3833 3834 3835 3836 3837 3838 3839

	switch (packets_per_slave) {
	case 0:
		slave_id = prandom_u32();
		break;
	case 1:
		slave_id = bond->rr_tx_counter;
		break;
	default:
3840 3841
		reciprocal_packets_per_slave =
			bond->params.reciprocal_packets_per_slave;
3842
		slave_id = reciprocal_divide(bond->rr_tx_counter,
3843
					     reciprocal_packets_per_slave);
3844 3845 3846 3847 3848 3849 3850
		break;
	}
	bond->rr_tx_counter++;

	return slave_id;
}

3851 3852
static netdev_tx_t bond_xmit_roundrobin(struct sk_buff *skb,
					struct net_device *bond_dev)
L
Linus Torvalds 已提交
3853
{
3854
	struct bonding *bond = netdev_priv(bond_dev);
3855
	struct iphdr *iph = ip_hdr(skb);
3856
	struct slave *slave;
3857
	u32 slave_id;
L
Linus Torvalds 已提交
3858

3859
	/* Start with the curr_active_slave that joined the bond as the
3860 3861 3862 3863
	 * default for sending IGMP traffic.  For failover purposes one
	 * needs to maintain some consistency for the interface that will
	 * send the join/membership reports.  The curr_active_slave found
	 * will send all of this type of traffic.
3864
	 */
3865
	if (iph->protocol == IPPROTO_IGMP && skb->protocol == htons(ETH_P_IP)) {
3866
		slave = rcu_dereference(bond->curr_active_slave);
3867
		if (slave)
3868 3869 3870
			bond_dev_queue_xmit(bond, skb, slave->dev);
		else
			bond_xmit_slave_id(bond, skb, 0);
3871
	} else {
3872
		int slave_cnt = READ_ONCE(bond->slave_cnt);
3873 3874 3875 3876 3877

		if (likely(slave_cnt)) {
			slave_id = bond_rr_gen_slave_id(bond);
			bond_xmit_slave_id(bond, skb, slave_id % slave_cnt);
		} else {
E
Eric Dumazet 已提交
3878
			bond_tx_drop(bond_dev, skb);
3879
		}
L
Linus Torvalds 已提交
3880
	}
3881

3882
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
3883 3884
}

3885
/* In active-backup mode, we know that bond->curr_active_slave is always valid if
L
Linus Torvalds 已提交
3886 3887
 * the bond has a usable interface.
 */
3888 3889
static netdev_tx_t bond_xmit_activebackup(struct sk_buff *skb,
					  struct net_device *bond_dev)
L
Linus Torvalds 已提交
3890
{
3891
	struct bonding *bond = netdev_priv(bond_dev);
3892
	struct slave *slave;
L
Linus Torvalds 已提交
3893

3894
	slave = rcu_dereference(bond->curr_active_slave);
3895
	if (slave)
3896 3897
		bond_dev_queue_xmit(bond, skb, slave->dev);
	else
E
Eric Dumazet 已提交
3898
		bond_tx_drop(bond_dev, skb);
3899

3900
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
3901 3902
}

3903 3904 3905
/* Use this to update slave_array when (a) it's not appropriate to update
 * slave_array right away (note that update_slave_array() may sleep)
 * and / or (b) RTNL is not held.
L
Linus Torvalds 已提交
3906
 */
3907
void bond_slave_arr_work_rearm(struct bonding *bond, unsigned long delay)
L
Linus Torvalds 已提交
3908
{
3909 3910
	queue_delayed_work(bond->wq, &bond->slave_arr_work, delay);
}
L
Linus Torvalds 已提交
3911

3912 3913 3914 3915 3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937
/* Slave array work handler. Holds only RTNL */
static void bond_slave_arr_handler(struct work_struct *work)
{
	struct bonding *bond = container_of(work, struct bonding,
					    slave_arr_work.work);
	int ret;

	if (!rtnl_trylock())
		goto err;

	ret = bond_update_slave_arr(bond, NULL);
	rtnl_unlock();
	if (ret) {
		pr_warn_ratelimited("Failed to update slave array from WT\n");
		goto err;
	}
	return;

err:
	bond_slave_arr_work_rearm(bond, 1);
}

/* Build the usable slaves array in control path for modes that use xmit-hash
 * to determine the slave interface -
 * (a) BOND_MODE_8023AD
 * (b) BOND_MODE_XOR
3938
 * (c) (BOND_MODE_TLB || BOND_MODE_ALB) && tlb_dynamic_lb == 0
3939 3940 3941 3942 3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990
 *
 * The caller is expected to hold RTNL only and NO other lock!
 */
int bond_update_slave_arr(struct bonding *bond, struct slave *skipslave)
{
	struct slave *slave;
	struct list_head *iter;
	struct bond_up_slave *new_arr, *old_arr;
	int agg_id = 0;
	int ret = 0;

#ifdef CONFIG_LOCKDEP
	WARN_ON(lockdep_is_held(&bond->mode_lock));
#endif

	new_arr = kzalloc(offsetof(struct bond_up_slave, arr[bond->slave_cnt]),
			  GFP_KERNEL);
	if (!new_arr) {
		ret = -ENOMEM;
		pr_err("Failed to build slave-array.\n");
		goto out;
	}
	if (BOND_MODE(bond) == BOND_MODE_8023AD) {
		struct ad_info ad_info;

		if (bond_3ad_get_active_agg_info(bond, &ad_info)) {
			pr_debug("bond_3ad_get_active_agg_info failed\n");
			kfree_rcu(new_arr, rcu);
			/* No active aggragator means it's not safe to use
			 * the previous array.
			 */
			old_arr = rtnl_dereference(bond->slave_arr);
			if (old_arr) {
				RCU_INIT_POINTER(bond->slave_arr, NULL);
				kfree_rcu(old_arr, rcu);
			}
			goto out;
		}
		agg_id = ad_info.aggregator_id;
	}
	bond_for_each_slave(bond, slave, iter) {
		if (BOND_MODE(bond) == BOND_MODE_8023AD) {
			struct aggregator *agg;

			agg = SLAVE_AD_INFO(slave)->port.aggregator;
			if (!agg || agg->aggregator_identifier != agg_id)
				continue;
		}
		if (!bond_slave_can_tx(slave))
			continue;
		if (skipslave == slave)
			continue;
3991 3992 3993 3994 3995

		netdev_dbg(bond->dev,
			   "Adding slave dev %s to tx hash array[%d]\n",
			   slave->dev->name, new_arr->count);

3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031
		new_arr->arr[new_arr->count++] = slave;
	}

	old_arr = rtnl_dereference(bond->slave_arr);
	rcu_assign_pointer(bond->slave_arr, new_arr);
	if (old_arr)
		kfree_rcu(old_arr, rcu);
out:
	if (ret != 0 && skipslave) {
		int idx;

		/* Rare situation where caller has asked to skip a specific
		 * slave but allocation failed (most likely!). BTW this is
		 * only possible when the call is initiated from
		 * __bond_release_one(). In this situation; overwrite the
		 * skipslave entry in the array with the last entry from the
		 * array to avoid a situation where the xmit path may choose
		 * this to-be-skipped slave to send a packet out.
		 */
		old_arr = rtnl_dereference(bond->slave_arr);
		for (idx = 0; idx < old_arr->count; idx++) {
			if (skipslave == old_arr->arr[idx]) {
				old_arr->arr[idx] =
				    old_arr->arr[old_arr->count-1];
				old_arr->count--;
				break;
			}
		}
	}
	return ret;
}

/* Use this Xmit function for 3AD as well as XOR modes. The current
 * usable slave array is formed in the control path. The xmit function
 * just calculates hash and sends the packet out.
 */
4032 4033
static netdev_tx_t bond_3ad_xor_xmit(struct sk_buff *skb,
				     struct net_device *dev)
4034 4035 4036 4037 4038 4039 4040
{
	struct bonding *bond = netdev_priv(dev);
	struct slave *slave;
	struct bond_up_slave *slaves;
	unsigned int count;

	slaves = rcu_dereference(bond->slave_arr);
4041
	count = slaves ? READ_ONCE(slaves->count) : 0;
4042 4043 4044 4045
	if (likely(count)) {
		slave = slaves->arr[bond_xmit_hash(bond, skb) % count];
		bond_dev_queue_xmit(bond, skb, slave->dev);
	} else {
E
Eric Dumazet 已提交
4046
		bond_tx_drop(dev, skb);
4047
	}
4048

4049
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
4050 4051
}

4052
/* in broadcast mode, we send everything to all usable interfaces. */
4053 4054
static netdev_tx_t bond_xmit_broadcast(struct sk_buff *skb,
				       struct net_device *bond_dev)
L
Linus Torvalds 已提交
4055
{
4056
	struct bonding *bond = netdev_priv(bond_dev);
4057
	struct slave *slave = NULL;
4058
	struct list_head *iter;
L
Linus Torvalds 已提交
4059

4060
	bond_for_each_slave_rcu(bond, slave, iter) {
4061 4062
		if (bond_is_last_slave(bond, slave))
			break;
4063
		if (bond_slave_is_up(slave) && slave->link == BOND_LINK_UP) {
4064
			struct sk_buff *skb2 = skb_clone(skb, GFP_ATOMIC);
L
Linus Torvalds 已提交
4065

4066
			if (!skb2) {
4067 4068
				net_err_ratelimited("%s: Error: %s: skb_clone() failed\n",
						    bond_dev->name, __func__);
4069
				continue;
L
Linus Torvalds 已提交
4070
			}
4071
			bond_dev_queue_xmit(bond, skb2, slave->dev);
L
Linus Torvalds 已提交
4072 4073
		}
	}
4074
	if (slave && bond_slave_is_up(slave) && slave->link == BOND_LINK_UP)
4075 4076
		bond_dev_queue_xmit(bond, skb, slave->dev);
	else
E
Eric Dumazet 已提交
4077
		bond_tx_drop(bond_dev, skb);
S
Stephen Hemminger 已提交
4078

4079
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
4080 4081 4082 4083
}

/*------------------------- Device initialization ---------------------------*/

4084
/* Lookup the slave that corresponds to a qid */
4085 4086 4087 4088
static inline int bond_slave_override(struct bonding *bond,
				      struct sk_buff *skb)
{
	struct slave *slave = NULL;
4089
	struct list_head *iter;
4090

4091
	if (!skb_rx_queue_recorded(skb))
4092
		return 1;
4093 4094

	/* Find out if any slaves have the same mapping as this skb. */
4095
	bond_for_each_slave_rcu(bond, slave, iter) {
4096
		if (slave->queue_id == skb_get_queue_mapping(skb)) {
4097 4098
			if (bond_slave_is_up(slave) &&
			    slave->link == BOND_LINK_UP) {
4099 4100 4101 4102
				bond_dev_queue_xmit(bond, skb, slave->dev);
				return 0;
			}
			/* If the slave isn't UP, use default transmit policy. */
4103 4104 4105 4106
			break;
		}
	}

4107
	return 1;
4108 4109
}

4110

4111
static u16 bond_select_queue(struct net_device *dev, struct sk_buff *skb,
4112 4113
			     struct net_device *sb_dev,
			     select_queue_fallback_t fallback)
4114
{
4115
	/* This helper function exists to help dev_pick_tx get the correct
P
Phil Oester 已提交
4116
	 * destination queue.  Using a helper function skips a call to
4117 4118 4119
	 * skb_tx_hash and will put the skbs in the queue we expect on their
	 * way down to the bonding driver.
	 */
P
Phil Oester 已提交
4120 4121
	u16 txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;

4122
	/* Save the original txq to restore before passing to the driver */
4123
	qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb_get_queue_mapping(skb);
4124

P
Phil Oester 已提交
4125
	if (unlikely(txq >= dev->real_num_tx_queues)) {
4126
		do {
P
Phil Oester 已提交
4127
			txq -= dev->real_num_tx_queues;
4128
		} while (txq >= dev->real_num_tx_queues);
P
Phil Oester 已提交
4129 4130
	}
	return txq;
4131 4132
}

4133
static netdev_tx_t __bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
4134
{
4135 4136
	struct bonding *bond = netdev_priv(dev);

4137 4138 4139
	if (bond_should_override_tx_queue(bond) &&
	    !bond_slave_override(bond, skb))
		return NETDEV_TX_OK;
4140

4141
	switch (BOND_MODE(bond)) {
4142 4143 4144 4145
	case BOND_MODE_ROUNDROBIN:
		return bond_xmit_roundrobin(skb, dev);
	case BOND_MODE_ACTIVEBACKUP:
		return bond_xmit_activebackup(skb, dev);
4146
	case BOND_MODE_8023AD:
4147
	case BOND_MODE_XOR:
4148
		return bond_3ad_xor_xmit(skb, dev);
4149 4150 4151 4152
	case BOND_MODE_BROADCAST:
		return bond_xmit_broadcast(skb, dev);
	case BOND_MODE_ALB:
		return bond_alb_xmit(skb, dev);
4153 4154
	case BOND_MODE_TLB:
		return bond_tlb_xmit(skb, dev);
4155 4156
	default:
		/* Should never happen, mode already checked */
4157
		netdev_err(dev, "Unknown bonding mode %d\n", BOND_MODE(bond));
4158
		WARN_ON_ONCE(1);
E
Eric Dumazet 已提交
4159
		bond_tx_drop(dev, skb);
4160 4161 4162 4163
		return NETDEV_TX_OK;
	}
}

4164 4165 4166 4167 4168
static netdev_tx_t bond_start_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct bonding *bond = netdev_priv(dev);
	netdev_tx_t ret = NETDEV_TX_OK;

4169
	/* If we risk deadlock from transmitting this in the
4170 4171
	 * netpoll path, tell netpoll to queue the frame for later tx
	 */
4172
	if (unlikely(is_netpoll_tx_blocked(dev)))
4173 4174
		return NETDEV_TX_BUSY;

4175
	rcu_read_lock();
4176
	if (bond_has_slaves(bond))
4177 4178
		ret = __bond_start_xmit(skb, dev);
	else
E
Eric Dumazet 已提交
4179
		bond_tx_drop(dev, skb);
4180
	rcu_read_unlock();
4181 4182 4183

	return ret;
}
4184

4185 4186
static int bond_ethtool_get_link_ksettings(struct net_device *bond_dev,
					   struct ethtool_link_ksettings *cmd)
4187 4188 4189
{
	struct bonding *bond = netdev_priv(bond_dev);
	unsigned long speed = 0;
4190
	struct list_head *iter;
4191
	struct slave *slave;
4192

4193 4194
	cmd->base.duplex = DUPLEX_UNKNOWN;
	cmd->base.port = PORT_OTHER;
4195

4196
	/* Since bond_slave_can_tx returns false for all inactive or down slaves, we
4197 4198 4199 4200
	 * do not need to check mode.  Though link speed might not represent
	 * the true receive or transmit bandwidth (not all modes are symmetric)
	 * this is an accurate maximum.
	 */
4201
	bond_for_each_slave(bond, slave, iter) {
4202
		if (bond_slave_can_tx(slave)) {
4203 4204
			if (slave->speed != SPEED_UNKNOWN)
				speed += slave->speed;
4205
			if (cmd->base.duplex == DUPLEX_UNKNOWN &&
4206
			    slave->duplex != DUPLEX_UNKNOWN)
4207
				cmd->base.duplex = slave->duplex;
4208 4209
		}
	}
4210
	cmd->base.speed = speed ? : SPEED_UNKNOWN;
4211

4212 4213 4214
	return 0;
}

4215
static void bond_ethtool_get_drvinfo(struct net_device *bond_dev,
4216
				     struct ethtool_drvinfo *drvinfo)
4217
{
4218 4219 4220 4221
	strlcpy(drvinfo->driver, DRV_NAME, sizeof(drvinfo->driver));
	strlcpy(drvinfo->version, DRV_VERSION, sizeof(drvinfo->version));
	snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version), "%d",
		 BOND_ABI_VERSION);
4222 4223
}

4224
static const struct ethtool_ops bond_ethtool_ops = {
4225
	.get_drvinfo		= bond_ethtool_get_drvinfo,
4226
	.get_link		= ethtool_op_get_link,
4227
	.get_link_ksettings	= bond_ethtool_get_link_ksettings,
4228 4229
};

4230
static const struct net_device_ops bond_netdev_ops = {
4231
	.ndo_init		= bond_init,
S
Stephen Hemminger 已提交
4232
	.ndo_uninit		= bond_uninit,
4233 4234
	.ndo_open		= bond_open,
	.ndo_stop		= bond_close,
4235
	.ndo_start_xmit		= bond_start_xmit,
4236
	.ndo_select_queue	= bond_select_queue,
4237
	.ndo_get_stats64	= bond_get_stats,
4238
	.ndo_do_ioctl		= bond_do_ioctl,
4239
	.ndo_change_rx_flags	= bond_change_rx_flags,
4240
	.ndo_set_rx_mode	= bond_set_rx_mode,
4241
	.ndo_change_mtu		= bond_change_mtu,
J
Jiri Pirko 已提交
4242
	.ndo_set_mac_address	= bond_set_mac_address,
4243
	.ndo_neigh_setup	= bond_neigh_setup,
J
Jiri Pirko 已提交
4244
	.ndo_vlan_rx_add_vid	= bond_vlan_rx_add_vid,
4245
	.ndo_vlan_rx_kill_vid	= bond_vlan_rx_kill_vid,
4246
	.ndo_get_lock_subclass  = bond_get_nest_level,
4247
#ifdef CONFIG_NET_POLL_CONTROLLER
4248
	.ndo_netpoll_setup	= bond_netpoll_setup,
4249 4250 4251
	.ndo_netpoll_cleanup	= bond_netpoll_cleanup,
	.ndo_poll_controller	= bond_poll_controller,
#endif
J
Jiri Pirko 已提交
4252 4253
	.ndo_add_slave		= bond_enslave,
	.ndo_del_slave		= bond_release,
4254
	.ndo_fix_features	= bond_fix_features,
4255
	.ndo_features_check	= passthru_features_check,
4256 4257
};

4258 4259 4260 4261
static const struct device_type bond_type = {
	.name = "bond",
};

4262 4263 4264 4265 4266 4267 4268
static void bond_destructor(struct net_device *bond_dev)
{
	struct bonding *bond = netdev_priv(bond_dev);
	if (bond->wq)
		destroy_workqueue(bond->wq);
}

4269
void bond_setup(struct net_device *bond_dev)
L
Linus Torvalds 已提交
4270
{
4271
	struct bonding *bond = netdev_priv(bond_dev);
L
Linus Torvalds 已提交
4272

4273
	spin_lock_init(&bond->mode_lock);
E
Eric Dumazet 已提交
4274
	spin_lock_init(&bond->stats_lock);
4275
	bond->params = bonding_defaults;
L
Linus Torvalds 已提交
4276 4277 4278 4279 4280

	/* Initialize pointers */
	bond->dev = bond_dev;

	/* Initialize the device entry points */
4281
	ether_setup(bond_dev);
W
WANG Cong 已提交
4282
	bond_dev->max_mtu = ETH_MAX_MTU;
4283
	bond_dev->netdev_ops = &bond_netdev_ops;
4284
	bond_dev->ethtool_ops = &bond_ethtool_ops;
L
Linus Torvalds 已提交
4285

4286 4287
	bond_dev->needs_free_netdev = true;
	bond_dev->priv_destructor = bond_destructor;
L
Linus Torvalds 已提交
4288

4289 4290
	SET_NETDEV_DEVTYPE(bond_dev, &bond_type);

L
Linus Torvalds 已提交
4291
	/* Initialize the device options */
4292
	bond_dev->flags |= IFF_MASTER;
4293
	bond_dev->priv_flags |= IFF_BONDING | IFF_UNICAST_FLT | IFF_NO_QUEUE;
4294
	bond_dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
4295

4296
	/* don't acquire bond device's netif_tx_lock when transmitting */
L
Linus Torvalds 已提交
4297 4298 4299 4300 4301 4302 4303 4304 4305
	bond_dev->features |= NETIF_F_LLTX;

	/* By default, we declare the bond to be fully
	 * VLAN hardware accelerated capable. Special
	 * care is taken in the various xmit functions
	 * when there are slaves that are not hw accel
	 * capable
	 */

4306 4307 4308
	/* Don't allow bond devices to change network namespaces. */
	bond_dev->features |= NETIF_F_NETNS_LOCAL;

4309
	bond_dev->hw_features = BOND_VLAN_FEATURES |
4310 4311 4312
				NETIF_F_HW_VLAN_CTAG_TX |
				NETIF_F_HW_VLAN_CTAG_RX |
				NETIF_F_HW_VLAN_CTAG_FILTER;
4313

4314
	bond_dev->hw_features |= NETIF_F_GSO_ENCAP_ALL | NETIF_F_GSO_UDP_L4;
4315
	bond_dev->features |= bond_dev->hw_features;
L
Linus Torvalds 已提交
4316 4317
}

4318 4319 4320
/* Destroy a bonding device.
 * Must be under rtnl_lock when this function is called.
 */
4321
static void bond_uninit(struct net_device *bond_dev)
J
Jay Vosburgh 已提交
4322
{
4323
	struct bonding *bond = netdev_priv(bond_dev);
4324 4325
	struct list_head *iter;
	struct slave *slave;
4326
	struct bond_up_slave *arr;
J
Jay Vosburgh 已提交
4327

4328 4329
	bond_netpoll_cleanup(bond_dev);

4330
	/* Release the bonded slaves */
4331
	bond_for_each_slave(bond, slave, iter)
4332
		__bond_release_one(bond_dev, slave->dev, true, true);
4333
	netdev_info(bond_dev, "Released all slaves\n");
4334

4335 4336 4337 4338 4339 4340
	arr = rtnl_dereference(bond->slave_arr);
	if (arr) {
		RCU_INIT_POINTER(bond->slave_arr, NULL);
		kfree_rcu(arr, rcu);
	}

J
Jay Vosburgh 已提交
4341 4342
	list_del(&bond->bond_list);

4343
	bond_debug_unregister(bond);
J
Jay Vosburgh 已提交
4344 4345
}

L
Linus Torvalds 已提交
4346 4347 4348 4349
/*------------------------- Module initialization ---------------------------*/

static int bond_check_params(struct bond_params *params)
{
4350
	int arp_validate_value, fail_over_mac_value, primary_reselect_value, i;
4351 4352
	struct bond_opt_value newval;
	const struct bond_opt_value *valptr;
4353
	int arp_all_targets_value = 0;
4354
	u16 ad_actor_sys_prio = 0;
4355
	u16 ad_user_port_key = 0;
4356
	__be32 arp_target[BOND_MAX_ARP_TARGETS] = { 0 };
4357 4358 4359 4360
	int arp_ip_count;
	int bond_mode	= BOND_MODE_ROUNDROBIN;
	int xmit_hashtype = BOND_XMIT_POLICY_LAYER2;
	int lacp_fast = 0;
4361
	int tlb_dynamic_lb;
4362

4363
	/* Convert string parameters. */
L
Linus Torvalds 已提交
4364
	if (mode) {
4365 4366 4367 4368
		bond_opt_initstr(&newval, mode);
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_MODE), &newval);
		if (!valptr) {
			pr_err("Error: Invalid bonding mode \"%s\"\n", mode);
L
Linus Torvalds 已提交
4369 4370
			return -EINVAL;
		}
4371
		bond_mode = valptr->value;
L
Linus Torvalds 已提交
4372 4373
	}

4374
	if (xmit_hash_policy) {
4375 4376 4377
		if (bond_mode == BOND_MODE_ROUNDROBIN ||
		    bond_mode == BOND_MODE_ACTIVEBACKUP ||
		    bond_mode == BOND_MODE_BROADCAST) {
J
Joe Perches 已提交
4378
			pr_info("xmit_hash_policy param is irrelevant in mode %s\n",
J
Joe Perches 已提交
4379
				bond_mode_name(bond_mode));
4380
		} else {
4381 4382 4383 4384
			bond_opt_initstr(&newval, xmit_hash_policy);
			valptr = bond_opt_parse(bond_opt_get(BOND_OPT_XMIT_HASH),
						&newval);
			if (!valptr) {
J
Joe Perches 已提交
4385
				pr_err("Error: Invalid xmit_hash_policy \"%s\"\n",
4386 4387 4388
				       xmit_hash_policy);
				return -EINVAL;
			}
4389
			xmit_hashtype = valptr->value;
4390 4391 4392
		}
	}

L
Linus Torvalds 已提交
4393 4394
	if (lacp_rate) {
		if (bond_mode != BOND_MODE_8023AD) {
J
Joe Perches 已提交
4395 4396
			pr_info("lacp_rate param is irrelevant in mode %s\n",
				bond_mode_name(bond_mode));
L
Linus Torvalds 已提交
4397
		} else {
4398 4399 4400 4401
			bond_opt_initstr(&newval, lacp_rate);
			valptr = bond_opt_parse(bond_opt_get(BOND_OPT_LACP_RATE),
						&newval);
			if (!valptr) {
J
Joe Perches 已提交
4402
				pr_err("Error: Invalid lacp rate \"%s\"\n",
4403
				       lacp_rate);
L
Linus Torvalds 已提交
4404 4405
				return -EINVAL;
			}
4406
			lacp_fast = valptr->value;
L
Linus Torvalds 已提交
4407 4408 4409
		}
	}

4410
	if (ad_select) {
4411
		bond_opt_initstr(&newval, ad_select);
4412 4413 4414 4415
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_SELECT),
					&newval);
		if (!valptr) {
			pr_err("Error: Invalid ad_select \"%s\"\n", ad_select);
4416 4417
			return -EINVAL;
		}
4418 4419
		params->ad_select = valptr->value;
		if (bond_mode != BOND_MODE_8023AD)
4420
			pr_warn("ad_select param only affects 802.3ad mode\n");
4421 4422 4423 4424
	} else {
		params->ad_select = BOND_AD_STABLE;
	}

4425
	if (max_bonds < 0) {
4426 4427
		pr_warn("Warning: max_bonds (%d) not in range %d-%d, so it was reset to BOND_DEFAULT_MAX_BONDS (%d)\n",
			max_bonds, 0, INT_MAX, BOND_DEFAULT_MAX_BONDS);
L
Linus Torvalds 已提交
4428 4429 4430 4431
		max_bonds = BOND_DEFAULT_MAX_BONDS;
	}

	if (miimon < 0) {
4432 4433
		pr_warn("Warning: miimon module parameter (%d), not in range 0-%d, so it was reset to 0\n",
			miimon, INT_MAX);
4434
		miimon = 0;
L
Linus Torvalds 已提交
4435 4436 4437
	}

	if (updelay < 0) {
4438 4439
		pr_warn("Warning: updelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
			updelay, INT_MAX);
L
Linus Torvalds 已提交
4440 4441 4442 4443
		updelay = 0;
	}

	if (downdelay < 0) {
4444 4445
		pr_warn("Warning: downdelay module parameter (%d), not in range 0-%d, so it was reset to 0\n",
			downdelay, INT_MAX);
L
Linus Torvalds 已提交
4446 4447 4448
		downdelay = 0;
	}

4449 4450
	if ((use_carrier != 0) && (use_carrier != 1)) {
		pr_warn("Warning: use_carrier module parameter (%d), not of valid value (0/1), so it was set to 1\n",
4451
			use_carrier);
L
Linus Torvalds 已提交
4452 4453 4454
		use_carrier = 1;
	}

4455
	if (num_peer_notif < 0 || num_peer_notif > 255) {
4456 4457
		pr_warn("Warning: num_grat_arp/num_unsol_na (%d) not in range 0-255 so it was reset to 1\n",
			num_peer_notif);
4458 4459 4460
		num_peer_notif = 1;
	}

4461
	/* reset values for 802.3ad/TLB/ALB */
4462
	if (!bond_mode_uses_arp(bond_mode)) {
L
Linus Torvalds 已提交
4463
		if (!miimon) {
4464 4465
			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");
			pr_warn("Forcing miimon to 100msec\n");
4466
			miimon = BOND_DEFAULT_MIIMON;
L
Linus Torvalds 已提交
4467 4468 4469
		}
	}

4470
	if (tx_queues < 1 || tx_queues > 255) {
4471 4472
		pr_warn("Warning: tx_queues (%d) should be between 1 and 255, resetting to %d\n",
			tx_queues, BOND_DEFAULT_TX_QUEUES);
4473 4474 4475
		tx_queues = BOND_DEFAULT_TX_QUEUES;
	}

4476
	if ((all_slaves_active != 0) && (all_slaves_active != 1)) {
4477 4478
		pr_warn("Warning: all_slaves_active module parameter (%d), not of valid value (0/1), so it was set to 0\n",
			all_slaves_active);
4479 4480 4481
		all_slaves_active = 0;
	}

4482
	if (resend_igmp < 0 || resend_igmp > 255) {
4483 4484
		pr_warn("Warning: resend_igmp (%d) should be between 0 and 255, resetting to %d\n",
			resend_igmp, BOND_DEFAULT_RESEND_IGMP);
4485 4486 4487
		resend_igmp = BOND_DEFAULT_RESEND_IGMP;
	}

4488 4489
	bond_opt_initval(&newval, packets_per_slave);
	if (!bond_opt_parse(bond_opt_get(BOND_OPT_PACKETS_PER_SLAVE), &newval)) {
4490 4491 4492 4493 4494
		pr_warn("Warning: packets_per_slave (%d) should be between 0 and %u resetting to 1\n",
			packets_per_slave, USHRT_MAX);
		packets_per_slave = 1;
	}

L
Linus Torvalds 已提交
4495
	if (bond_mode == BOND_MODE_ALB) {
J
Joe Perches 已提交
4496 4497
		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",
			  updelay);
L
Linus Torvalds 已提交
4498 4499 4500 4501 4502 4503 4504
	}

	if (!miimon) {
		if (updelay || downdelay) {
			/* just warn the user the up/down delay will have
			 * no effect since miimon is zero...
			 */
4505 4506
			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",
				updelay, downdelay);
L
Linus Torvalds 已提交
4507 4508 4509 4510
		}
	} else {
		/* don't allow arp monitoring */
		if (arp_interval) {
4511 4512
			pr_warn("Warning: miimon (%d) and arp_interval (%d) can't be used simultaneously, disabling ARP monitoring\n",
				miimon, arp_interval);
L
Linus Torvalds 已提交
4513 4514 4515 4516
			arp_interval = 0;
		}

		if ((updelay % miimon) != 0) {
4517 4518
			pr_warn("Warning: updelay (%d) is not a multiple of miimon (%d), updelay rounded to %d ms\n",
				updelay, miimon, (updelay / miimon) * miimon);
L
Linus Torvalds 已提交
4519 4520 4521 4522 4523
		}

		updelay /= miimon;

		if ((downdelay % miimon) != 0) {
4524 4525 4526
			pr_warn("Warning: downdelay (%d) is not a multiple of miimon (%d), downdelay rounded to %d ms\n",
				downdelay, miimon,
				(downdelay / miimon) * miimon);
L
Linus Torvalds 已提交
4527 4528 4529 4530 4531 4532
		}

		downdelay /= miimon;
	}

	if (arp_interval < 0) {
4533 4534
		pr_warn("Warning: arp_interval module parameter (%d), not in range 0-%d, so it was reset to 0\n",
			arp_interval, INT_MAX);
4535
		arp_interval = 0;
L
Linus Torvalds 已提交
4536 4537
	}

4538 4539
	for (arp_ip_count = 0, i = 0;
	     (arp_ip_count < BOND_MAX_ARP_TARGETS) && arp_ip_target[i]; i++) {
4540
		__be32 ip;
4541 4542

		/* not a complete check, but good enough to catch mistakes */
4543
		if (!in4_pton(arp_ip_target[i], -1, (u8 *)&ip, -1, NULL) ||
4544
		    !bond_is_ip_target_ok(ip)) {
4545 4546
			pr_warn("Warning: bad arp_ip_target module parameter (%s), ARP monitoring will not be performed\n",
				arp_ip_target[i]);
L
Linus Torvalds 已提交
4547 4548
			arp_interval = 0;
		} else {
4549 4550 4551
			if (bond_get_targets_ip(arp_target, ip) == -1)
				arp_target[arp_ip_count++] = ip;
			else
4552 4553
				pr_warn("Warning: duplicate address %pI4 in arp_ip_target, skipping\n",
					&ip);
L
Linus Torvalds 已提交
4554 4555 4556 4557 4558
		}
	}

	if (arp_interval && !arp_ip_count) {
		/* don't allow arping if no arp_ip_target given... */
4559 4560
		pr_warn("Warning: arp_interval module parameter (%d) specified without providing an arp_ip_target parameter, arp_interval was reset to 0\n",
			arp_interval);
L
Linus Torvalds 已提交
4561 4562 4563
		arp_interval = 0;
	}

4564 4565
	if (arp_validate) {
		if (!arp_interval) {
J
Joe Perches 已提交
4566
			pr_err("arp_validate requires arp_interval\n");
4567 4568 4569
			return -EINVAL;
		}

4570 4571 4572 4573
		bond_opt_initstr(&newval, arp_validate);
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_VALIDATE),
					&newval);
		if (!valptr) {
J
Joe Perches 已提交
4574
			pr_err("Error: invalid arp_validate \"%s\"\n",
4575
			       arp_validate);
4576 4577
			return -EINVAL;
		}
4578 4579
		arp_validate_value = valptr->value;
	} else {
4580
		arp_validate_value = 0;
4581
	}
4582

4583
	if (arp_all_targets) {
4584 4585 4586 4587
		bond_opt_initstr(&newval, arp_all_targets);
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_ARP_ALL_TARGETS),
					&newval);
		if (!valptr) {
4588 4589 4590
			pr_err("Error: invalid arp_all_targets_value \"%s\"\n",
			       arp_all_targets);
			arp_all_targets_value = 0;
4591 4592
		} else {
			arp_all_targets_value = valptr->value;
4593 4594 4595
		}
	}

L
Linus Torvalds 已提交
4596
	if (miimon) {
J
Joe Perches 已提交
4597
		pr_info("MII link monitoring set to %d ms\n", miimon);
L
Linus Torvalds 已提交
4598
	} else if (arp_interval) {
4599 4600
		valptr = bond_opt_get_val(BOND_OPT_ARP_VALIDATE,
					  arp_validate_value);
J
Joe Perches 已提交
4601
		pr_info("ARP monitoring set to %d ms, validate %s, with %d target(s):",
4602
			arp_interval, valptr->string, arp_ip_count);
L
Linus Torvalds 已提交
4603 4604

		for (i = 0; i < arp_ip_count; i++)
J
Joe Perches 已提交
4605
			pr_cont(" %s", arp_ip_target[i]);
L
Linus Torvalds 已提交
4606

J
Joe Perches 已提交
4607
		pr_cont("\n");
L
Linus Torvalds 已提交
4608

4609
	} else if (max_bonds) {
L
Linus Torvalds 已提交
4610 4611 4612
		/* miimon and arp_interval not set, we need one so things
		 * work as expected, see bonding.txt for details
		 */
J
Joe Perches 已提交
4613
		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");
L
Linus Torvalds 已提交
4614 4615
	}

4616
	if (primary && !bond_mode_uses_primary(bond_mode)) {
L
Linus Torvalds 已提交
4617 4618 4619
		/* currently, using a primary only makes sense
		 * in active backup, TLB or ALB modes
		 */
4620 4621
		pr_warn("Warning: %s primary device specified but has no effect in %s mode\n",
			primary, bond_mode_name(bond_mode));
L
Linus Torvalds 已提交
4622 4623 4624
		primary = NULL;
	}

4625
	if (primary && primary_reselect) {
4626 4627 4628 4629
		bond_opt_initstr(&newval, primary_reselect);
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_PRIMARY_RESELECT),
					&newval);
		if (!valptr) {
J
Joe Perches 已提交
4630
			pr_err("Error: Invalid primary_reselect \"%s\"\n",
4631
			       primary_reselect);
4632 4633
			return -EINVAL;
		}
4634
		primary_reselect_value = valptr->value;
4635 4636 4637 4638
	} else {
		primary_reselect_value = BOND_PRI_RESELECT_ALWAYS;
	}

4639
	if (fail_over_mac) {
4640 4641 4642 4643
		bond_opt_initstr(&newval, fail_over_mac);
		valptr = bond_opt_parse(bond_opt_get(BOND_OPT_FAIL_OVER_MAC),
					&newval);
		if (!valptr) {
J
Joe Perches 已提交
4644
			pr_err("Error: invalid fail_over_mac \"%s\"\n",
4645
			       fail_over_mac);
4646 4647
			return -EINVAL;
		}
4648
		fail_over_mac_value = valptr->value;
4649
		if (bond_mode != BOND_MODE_ACTIVEBACKUP)
4650
			pr_warn("Warning: fail_over_mac only affects active-backup mode\n");
4651 4652 4653
	} else {
		fail_over_mac_value = BOND_FOM_NONE;
	}
4654

4655 4656 4657 4658 4659 4660 4661 4662 4663 4664
	bond_opt_initstr(&newval, "default");
	valptr = bond_opt_parse(
			bond_opt_get(BOND_OPT_AD_ACTOR_SYS_PRIO),
				     &newval);
	if (!valptr) {
		pr_err("Error: No ad_actor_sys_prio default value");
		return -EINVAL;
	}
	ad_actor_sys_prio = valptr->value;

4665 4666 4667 4668 4669 4670 4671 4672
	valptr = bond_opt_parse(bond_opt_get(BOND_OPT_AD_USER_PORT_KEY),
				&newval);
	if (!valptr) {
		pr_err("Error: No ad_user_port_key default value");
		return -EINVAL;
	}
	ad_user_port_key = valptr->value;

4673 4674 4675 4676 4677
	bond_opt_initstr(&newval, "default");
	valptr = bond_opt_parse(bond_opt_get(BOND_OPT_TLB_DYNAMIC_LB), &newval);
	if (!valptr) {
		pr_err("Error: No tlb_dynamic_lb default value");
		return -EINVAL;
4678
	}
4679
	tlb_dynamic_lb = valptr->value;
4680

4681
	if (lp_interval == 0) {
4682 4683
		pr_warn("Warning: ip_interval must be between 1 and %d, so it was reset to %d\n",
			INT_MAX, BOND_ALB_DEFAULT_LP_INTERVAL);
4684 4685 4686
		lp_interval = BOND_ALB_DEFAULT_LP_INTERVAL;
	}

L
Linus Torvalds 已提交
4687 4688
	/* fill params struct with the proper values */
	params->mode = bond_mode;
4689
	params->xmit_policy = xmit_hashtype;
L
Linus Torvalds 已提交
4690
	params->miimon = miimon;
4691
	params->num_peer_notif = num_peer_notif;
L
Linus Torvalds 已提交
4692
	params->arp_interval = arp_interval;
4693
	params->arp_validate = arp_validate_value;
4694
	params->arp_all_targets = arp_all_targets_value;
L
Linus Torvalds 已提交
4695 4696 4697 4698 4699
	params->updelay = updelay;
	params->downdelay = downdelay;
	params->use_carrier = use_carrier;
	params->lacp_fast = lacp_fast;
	params->primary[0] = 0;
4700
	params->primary_reselect = primary_reselect_value;
4701
	params->fail_over_mac = fail_over_mac_value;
4702
	params->tx_queues = tx_queues;
4703
	params->all_slaves_active = all_slaves_active;
4704
	params->resend_igmp = resend_igmp;
4705
	params->min_links = min_links;
4706
	params->lp_interval = lp_interval;
4707
	params->packets_per_slave = packets_per_slave;
4708
	params->tlb_dynamic_lb = tlb_dynamic_lb;
4709
	params->ad_actor_sys_prio = ad_actor_sys_prio;
4710
	eth_zero_addr(params->ad_actor_system);
4711
	params->ad_user_port_key = ad_user_port_key;
4712 4713 4714 4715 4716 4717 4718 4719 4720 4721 4722
	if (packets_per_slave > 0) {
		params->reciprocal_packets_per_slave =
			reciprocal_value(packets_per_slave);
	} else {
		/* reciprocal_packets_per_slave is unused if
		 * packets_per_slave is 0 or 1, just initialize it
		 */
		params->reciprocal_packets_per_slave =
			(struct reciprocal_value) { 0 };
	}

L
Linus Torvalds 已提交
4723 4724 4725 4726 4727 4728 4729 4730 4731 4732
	if (primary) {
		strncpy(params->primary, primary, IFNAMSIZ);
		params->primary[IFNAMSIZ - 1] = 0;
	}

	memcpy(params->arp_targets, arp_target, sizeof(arp_target));

	return 0;
}

4733
/* Called from registration process */
4734 4735 4736
static int bond_init(struct net_device *bond_dev)
{
	struct bonding *bond = netdev_priv(bond_dev);
4737
	struct bond_net *bn = net_generic(dev_net(bond_dev), bond_net_id);
4738

4739
	netdev_dbg(bond_dev, "Begin bond_init\n");
4740

4741
	bond->wq = alloc_ordered_workqueue(bond_dev->name, WQ_MEM_RECLAIM);
4742 4743 4744
	if (!bond->wq)
		return -ENOMEM;

4745
	bond->nest_level = SINGLE_DEPTH_NESTING;
4746
	netdev_lockdep_set_classes(bond_dev);
4747

4748
	list_add_tail(&bond->bond_list, &bn->dev_list);
4749

4750
	bond_prepare_sysfs_group(bond);
4751

4752 4753
	bond_debug_register(bond);

4754 4755
	/* Ensure valid dev_addr */
	if (is_zero_ether_addr(bond_dev->dev_addr) &&
4756
	    bond_dev->addr_assign_type == NET_ADDR_PERM)
4757 4758
		eth_hw_addr_random(bond_dev);

4759 4760 4761
	return 0;
}

4762
unsigned int bond_get_num_tx_queues(void)
4763
{
4764
	return tx_queues;
4765 4766
}

4767
/* Create a new bond based on the specified name and bonding parameters.
4768
 * If name is NULL, obtain a suitable "bond%d" name for us.
4769 4770 4771
 * Caller must NOT hold rtnl_lock; we need to release it here before we
 * set up our sysfs entries.
 */
4772
int bond_create(struct net *net, const char *name)
4773 4774
{
	struct net_device *bond_dev;
4775 4776
	struct bonding *bond;
	struct alb_bond_info *bond_info;
4777 4778 4779
	int res;

	rtnl_lock();
4780

4781
	bond_dev = alloc_netdev_mq(sizeof(struct bonding),
4782
				   name ? name : "bond%d", NET_NAME_UNKNOWN,
4783
				   bond_setup, tx_queues);
4784
	if (!bond_dev) {
J
Joe Perches 已提交
4785
		pr_err("%s: eek! can't alloc netdev!\n", name);
4786 4787
		rtnl_unlock();
		return -ENOMEM;
4788 4789
	}

4790 4791 4792 4793 4794 4795 4796 4797
	/*
	 * Initialize rx_hashtbl_used_head to RLB_NULL_INDEX.
	 * It is set to 0 by default which is wrong.
	 */
	bond = netdev_priv(bond_dev);
	bond_info = &(BOND_ALB_INFO(bond));
	bond_info->rx_hashtbl_used_head = RLB_NULL_INDEX;

4798
	dev_net_set(bond_dev, net);
4799 4800
	bond_dev->rtnl_link_ops = &bond_link_ops;

4801
	res = register_netdevice(bond_dev);
4802

4803 4804
	netif_carrier_off(bond_dev);

4805 4806
	bond_work_init_all(bond);

4807
	rtnl_unlock();
4808
	if (res < 0)
4809
		free_netdev(bond_dev);
E
Eric W. Biederman 已提交
4810
	return res;
4811 4812
}

4813
static int __net_init bond_net_init(struct net *net)
4814
{
4815
	struct bond_net *bn = net_generic(net, bond_net_id);
4816 4817 4818 4819 4820

	bn->net = net;
	INIT_LIST_HEAD(&bn->dev_list);

	bond_create_proc_dir(bn);
4821
	bond_create_sysfs(bn);
4822

4823
	return 0;
4824 4825
}

4826
static void __net_exit bond_net_exit(struct net *net)
4827
{
4828
	struct bond_net *bn = net_generic(net, bond_net_id);
4829 4830
	struct bonding *bond, *tmp_bond;
	LIST_HEAD(list);
4831

4832
	bond_destroy_sysfs(bn);
4833 4834 4835 4836 4837 4838 4839

	/* Kill off any bonds created after unregistering bond rtnl ops */
	rtnl_lock();
	list_for_each_entry_safe(bond, tmp_bond, &bn->dev_list, bond_list)
		unregister_netdevice_queue(bond->dev, &list);
	unregister_netdevice_many(&list);
	rtnl_unlock();
4840 4841

	bond_destroy_proc_dir(bn);
4842 4843 4844 4845 4846
}

static struct pernet_operations bond_net_ops = {
	.init = bond_net_init,
	.exit = bond_net_exit,
4847 4848
	.id   = &bond_net_id,
	.size = sizeof(struct bond_net),
4849 4850
};

L
Linus Torvalds 已提交
4851 4852 4853 4854 4855
static int __init bonding_init(void)
{
	int i;
	int res;

4856
	pr_info("%s", bond_version);
L
Linus Torvalds 已提交
4857

4858
	res = bond_check_params(&bonding_defaults);
S
Stephen Hemminger 已提交
4859
	if (res)
4860
		goto out;
L
Linus Torvalds 已提交
4861

4862
	res = register_pernet_subsys(&bond_net_ops);
4863 4864
	if (res)
		goto out;
4865

4866
	res = bond_netlink_init();
4867
	if (res)
4868
		goto err_link;
4869

4870 4871
	bond_create_debugfs();

L
Linus Torvalds 已提交
4872
	for (i = 0; i < max_bonds; i++) {
4873
		res = bond_create(&init_net, NULL);
4874 4875
		if (res)
			goto err;
L
Linus Torvalds 已提交
4876 4877 4878
	}

	register_netdevice_notifier(&bond_netdev_notifier);
4879
out:
L
Linus Torvalds 已提交
4880
	return res;
4881
err:
4882
	bond_destroy_debugfs();
4883
	bond_netlink_fini();
4884
err_link:
4885
	unregister_pernet_subsys(&bond_net_ops);
4886
	goto out;
4887

L
Linus Torvalds 已提交
4888 4889 4890 4891 4892 4893
}

static void __exit bonding_exit(void)
{
	unregister_netdevice_notifier(&bond_netdev_notifier);

4894
	bond_destroy_debugfs();
4895

4896
	bond_netlink_fini();
4897
	unregister_pernet_subsys(&bond_net_ops);
4898 4899

#ifdef CONFIG_NET_POLL_CONTROLLER
4900
	/* Make sure we don't have an imbalance on our netpoll blocking */
4901
	WARN_ON(atomic_read(&netpoll_block_tx));
4902
#endif
L
Linus Torvalds 已提交
4903 4904 4905 4906 4907 4908 4909 4910
}

module_init(bonding_init);
module_exit(bonding_exit);
MODULE_LICENSE("GPL");
MODULE_VERSION(DRV_VERSION);
MODULE_DESCRIPTION(DRV_DESCRIPTION ", v" DRV_VERSION);
MODULE_AUTHOR("Thomas Davis, tadavis@lbl.gov and many others");