1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2018, Intel Corporation. */
3 
4 /* This provides a net_failover interface for paravirtual drivers to
5  * provide an alternate datapath by exporting APIs to create and
6  * destroy a upper 'net_failover' netdev. The upper dev manages the
7  * original paravirtual interface as a 'standby' netdev and uses the
8  * generic failover infrastructure to register and manage a direct
9  * attached VF as a 'primary' netdev. This enables live migration of
10  * a VM with direct attached VF by failing over to the paravirtual
11  * datapath when the VF is unplugged.
12  *
13  * Some of the netdev management routines are based on bond/team driver as
14  * this driver provides active-backup functionality similar to those drivers.
15  */
16 
17 #include <linux/netdevice.h>
18 #include <linux/etherdevice.h>
19 #include <linux/ethtool.h>
20 #include <linux/module.h>
21 #include <linux/slab.h>
22 #include <linux/netpoll.h>
23 #include <linux/rtnetlink.h>
24 #include <linux/if_vlan.h>
25 #include <linux/pci.h>
26 #include <net/sch_generic.h>
27 #include <uapi/linux/if_arp.h>
28 #include <net/net_failover.h>
29 
net_failover_xmit_ready(struct net_device * dev)30 static bool net_failover_xmit_ready(struct net_device *dev)
31 {
32 	return netif_running(dev) && netif_carrier_ok(dev);
33 }
34 
net_failover_open(struct net_device * dev)35 static int net_failover_open(struct net_device *dev)
36 {
37 	struct net_failover_info *nfo_info = netdev_priv(dev);
38 	struct net_device *primary_dev, *standby_dev;
39 	int err;
40 
41 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
42 	if (primary_dev) {
43 		err = dev_open(primary_dev, NULL);
44 		if (err)
45 			goto err_primary_open;
46 	}
47 
48 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
49 	if (standby_dev) {
50 		err = dev_open(standby_dev, NULL);
51 		if (err)
52 			goto err_standby_open;
53 	}
54 
55 	if ((primary_dev && net_failover_xmit_ready(primary_dev)) ||
56 	    (standby_dev && net_failover_xmit_ready(standby_dev))) {
57 		netif_carrier_on(dev);
58 		netif_tx_wake_all_queues(dev);
59 	}
60 
61 	return 0;
62 
63 err_standby_open:
64 	if (primary_dev)
65 		dev_close(primary_dev);
66 err_primary_open:
67 	netif_tx_disable(dev);
68 	return err;
69 }
70 
net_failover_close(struct net_device * dev)71 static int net_failover_close(struct net_device *dev)
72 {
73 	struct net_failover_info *nfo_info = netdev_priv(dev);
74 	struct net_device *slave_dev;
75 
76 	netif_tx_disable(dev);
77 
78 	slave_dev = rtnl_dereference(nfo_info->primary_dev);
79 	if (slave_dev)
80 		dev_close(slave_dev);
81 
82 	slave_dev = rtnl_dereference(nfo_info->standby_dev);
83 	if (slave_dev)
84 		dev_close(slave_dev);
85 
86 	return 0;
87 }
88 
net_failover_drop_xmit(struct sk_buff * skb,struct net_device * dev)89 static netdev_tx_t net_failover_drop_xmit(struct sk_buff *skb,
90 					  struct net_device *dev)
91 {
92 	atomic_long_inc(&dev->tx_dropped);
93 	dev_kfree_skb_any(skb);
94 	return NETDEV_TX_OK;
95 }
96 
net_failover_start_xmit(struct sk_buff * skb,struct net_device * dev)97 static netdev_tx_t net_failover_start_xmit(struct sk_buff *skb,
98 					   struct net_device *dev)
99 {
100 	struct net_failover_info *nfo_info = netdev_priv(dev);
101 	struct net_device *xmit_dev;
102 
103 	/* Try xmit via primary netdev followed by standby netdev */
104 	xmit_dev = rcu_dereference_bh(nfo_info->primary_dev);
105 	if (!xmit_dev || !net_failover_xmit_ready(xmit_dev)) {
106 		xmit_dev = rcu_dereference_bh(nfo_info->standby_dev);
107 		if (!xmit_dev || !net_failover_xmit_ready(xmit_dev))
108 			return net_failover_drop_xmit(skb, dev);
109 	}
110 
111 	skb->dev = xmit_dev;
112 	skb->queue_mapping = qdisc_skb_cb(skb)->slave_dev_queue_mapping;
113 
114 	return dev_queue_xmit(skb);
115 }
116 
net_failover_select_queue(struct net_device * dev,struct sk_buff * skb,struct net_device * sb_dev)117 static u16 net_failover_select_queue(struct net_device *dev,
118 				     struct sk_buff *skb,
119 				     struct net_device *sb_dev)
120 {
121 	struct net_failover_info *nfo_info = netdev_priv(dev);
122 	struct net_device *primary_dev;
123 	u16 txq;
124 
125 	primary_dev = rcu_dereference(nfo_info->primary_dev);
126 	if (primary_dev) {
127 		const struct net_device_ops *ops = primary_dev->netdev_ops;
128 
129 		if (ops->ndo_select_queue)
130 			txq = ops->ndo_select_queue(primary_dev, skb, sb_dev);
131 		else
132 			txq = netdev_pick_tx(primary_dev, skb, NULL);
133 
134 		qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb->queue_mapping;
135 
136 		return txq;
137 	}
138 
139 	txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) : 0;
140 
141 	/* Save the original txq to restore before passing to the driver */
142 	qdisc_skb_cb(skb)->slave_dev_queue_mapping = skb->queue_mapping;
143 
144 	if (unlikely(txq >= dev->real_num_tx_queues)) {
145 		do {
146 			txq -= dev->real_num_tx_queues;
147 		} while (txq >= dev->real_num_tx_queues);
148 	}
149 
150 	return txq;
151 }
152 
153 /* fold stats, assuming all rtnl_link_stats64 fields are u64, but
154  * that some drivers can provide 32bit values only.
155  */
net_failover_fold_stats(struct rtnl_link_stats64 * _res,const struct rtnl_link_stats64 * _new,const struct rtnl_link_stats64 * _old)156 static void net_failover_fold_stats(struct rtnl_link_stats64 *_res,
157 				    const struct rtnl_link_stats64 *_new,
158 				    const struct rtnl_link_stats64 *_old)
159 {
160 	const u64 *new = (const u64 *)_new;
161 	const u64 *old = (const u64 *)_old;
162 	u64 *res = (u64 *)_res;
163 	int i;
164 
165 	for (i = 0; i < sizeof(*_res) / sizeof(u64); i++) {
166 		u64 nv = new[i];
167 		u64 ov = old[i];
168 		s64 delta = nv - ov;
169 
170 		/* detects if this particular field is 32bit only */
171 		if (((nv | ov) >> 32) == 0)
172 			delta = (s64)(s32)((u32)nv - (u32)ov);
173 
174 		/* filter anomalies, some drivers reset their stats
175 		 * at down/up events.
176 		 */
177 		if (delta > 0)
178 			res[i] += delta;
179 	}
180 }
181 
net_failover_get_stats(struct net_device * dev,struct rtnl_link_stats64 * stats)182 static void net_failover_get_stats(struct net_device *dev,
183 				   struct rtnl_link_stats64 *stats)
184 {
185 	struct net_failover_info *nfo_info = netdev_priv(dev);
186 	const struct rtnl_link_stats64 *new;
187 	struct rtnl_link_stats64 temp;
188 	struct net_device *slave_dev;
189 
190 	spin_lock(&nfo_info->stats_lock);
191 	memcpy(stats, &nfo_info->failover_stats, sizeof(*stats));
192 
193 	rcu_read_lock();
194 
195 	slave_dev = rcu_dereference(nfo_info->primary_dev);
196 	if (slave_dev) {
197 		new = dev_get_stats(slave_dev, &temp);
198 		net_failover_fold_stats(stats, new, &nfo_info->primary_stats);
199 		memcpy(&nfo_info->primary_stats, new, sizeof(*new));
200 	}
201 
202 	slave_dev = rcu_dereference(nfo_info->standby_dev);
203 	if (slave_dev) {
204 		new = dev_get_stats(slave_dev, &temp);
205 		net_failover_fold_stats(stats, new, &nfo_info->standby_stats);
206 		memcpy(&nfo_info->standby_stats, new, sizeof(*new));
207 	}
208 
209 	rcu_read_unlock();
210 
211 	memcpy(&nfo_info->failover_stats, stats, sizeof(*stats));
212 	spin_unlock(&nfo_info->stats_lock);
213 }
214 
net_failover_change_mtu(struct net_device * dev,int new_mtu)215 static int net_failover_change_mtu(struct net_device *dev, int new_mtu)
216 {
217 	struct net_failover_info *nfo_info = netdev_priv(dev);
218 	struct net_device *primary_dev, *standby_dev;
219 	int ret = 0;
220 
221 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
222 	if (primary_dev) {
223 		ret = dev_set_mtu(primary_dev, new_mtu);
224 		if (ret)
225 			return ret;
226 	}
227 
228 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
229 	if (standby_dev) {
230 		ret = dev_set_mtu(standby_dev, new_mtu);
231 		if (ret) {
232 			if (primary_dev)
233 				dev_set_mtu(primary_dev, dev->mtu);
234 			return ret;
235 		}
236 	}
237 
238 	dev->mtu = new_mtu;
239 
240 	return 0;
241 }
242 
net_failover_set_rx_mode(struct net_device * dev)243 static void net_failover_set_rx_mode(struct net_device *dev)
244 {
245 	struct net_failover_info *nfo_info = netdev_priv(dev);
246 	struct net_device *slave_dev;
247 
248 	rcu_read_lock();
249 
250 	slave_dev = rcu_dereference(nfo_info->primary_dev);
251 	if (slave_dev) {
252 		dev_uc_sync_multiple(slave_dev, dev);
253 		dev_mc_sync_multiple(slave_dev, dev);
254 	}
255 
256 	slave_dev = rcu_dereference(nfo_info->standby_dev);
257 	if (slave_dev) {
258 		dev_uc_sync_multiple(slave_dev, dev);
259 		dev_mc_sync_multiple(slave_dev, dev);
260 	}
261 
262 	rcu_read_unlock();
263 }
264 
net_failover_vlan_rx_add_vid(struct net_device * dev,__be16 proto,u16 vid)265 static int net_failover_vlan_rx_add_vid(struct net_device *dev, __be16 proto,
266 					u16 vid)
267 {
268 	struct net_failover_info *nfo_info = netdev_priv(dev);
269 	struct net_device *primary_dev, *standby_dev;
270 	int ret = 0;
271 
272 	primary_dev = rcu_dereference(nfo_info->primary_dev);
273 	if (primary_dev) {
274 		ret = vlan_vid_add(primary_dev, proto, vid);
275 		if (ret)
276 			return ret;
277 	}
278 
279 	standby_dev = rcu_dereference(nfo_info->standby_dev);
280 	if (standby_dev) {
281 		ret = vlan_vid_add(standby_dev, proto, vid);
282 		if (ret)
283 			if (primary_dev)
284 				vlan_vid_del(primary_dev, proto, vid);
285 	}
286 
287 	return ret;
288 }
289 
net_failover_vlan_rx_kill_vid(struct net_device * dev,__be16 proto,u16 vid)290 static int net_failover_vlan_rx_kill_vid(struct net_device *dev, __be16 proto,
291 					 u16 vid)
292 {
293 	struct net_failover_info *nfo_info = netdev_priv(dev);
294 	struct net_device *slave_dev;
295 
296 	slave_dev = rcu_dereference(nfo_info->primary_dev);
297 	if (slave_dev)
298 		vlan_vid_del(slave_dev, proto, vid);
299 
300 	slave_dev = rcu_dereference(nfo_info->standby_dev);
301 	if (slave_dev)
302 		vlan_vid_del(slave_dev, proto, vid);
303 
304 	return 0;
305 }
306 
307 static const struct net_device_ops failover_dev_ops = {
308 	.ndo_open		= net_failover_open,
309 	.ndo_stop		= net_failover_close,
310 	.ndo_start_xmit		= net_failover_start_xmit,
311 	.ndo_select_queue	= net_failover_select_queue,
312 	.ndo_get_stats64	= net_failover_get_stats,
313 	.ndo_change_mtu		= net_failover_change_mtu,
314 	.ndo_set_rx_mode	= net_failover_set_rx_mode,
315 	.ndo_vlan_rx_add_vid	= net_failover_vlan_rx_add_vid,
316 	.ndo_vlan_rx_kill_vid	= net_failover_vlan_rx_kill_vid,
317 	.ndo_validate_addr	= eth_validate_addr,
318 	.ndo_features_check	= passthru_features_check,
319 };
320 
321 #define FAILOVER_NAME "net_failover"
322 #define FAILOVER_VERSION "0.1"
323 
nfo_ethtool_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * drvinfo)324 static void nfo_ethtool_get_drvinfo(struct net_device *dev,
325 				    struct ethtool_drvinfo *drvinfo)
326 {
327 	strlcpy(drvinfo->driver, FAILOVER_NAME, sizeof(drvinfo->driver));
328 	strlcpy(drvinfo->version, FAILOVER_VERSION, sizeof(drvinfo->version));
329 }
330 
nfo_ethtool_get_link_ksettings(struct net_device * dev,struct ethtool_link_ksettings * cmd)331 static int nfo_ethtool_get_link_ksettings(struct net_device *dev,
332 					  struct ethtool_link_ksettings *cmd)
333 {
334 	struct net_failover_info *nfo_info = netdev_priv(dev);
335 	struct net_device *slave_dev;
336 
337 	slave_dev = rtnl_dereference(nfo_info->primary_dev);
338 	if (!slave_dev || !net_failover_xmit_ready(slave_dev)) {
339 		slave_dev = rtnl_dereference(nfo_info->standby_dev);
340 		if (!slave_dev || !net_failover_xmit_ready(slave_dev)) {
341 			cmd->base.duplex = DUPLEX_UNKNOWN;
342 			cmd->base.port = PORT_OTHER;
343 			cmd->base.speed = SPEED_UNKNOWN;
344 
345 			return 0;
346 		}
347 	}
348 
349 	return __ethtool_get_link_ksettings(slave_dev, cmd);
350 }
351 
352 static const struct ethtool_ops failover_ethtool_ops = {
353 	.get_drvinfo            = nfo_ethtool_get_drvinfo,
354 	.get_link               = ethtool_op_get_link,
355 	.get_link_ksettings     = nfo_ethtool_get_link_ksettings,
356 };
357 
358 /* Called when slave dev is injecting data into network stack.
359  * Change the associated network device from lower dev to failover dev.
360  * note: already called with rcu_read_lock
361  */
net_failover_handle_frame(struct sk_buff ** pskb)362 static rx_handler_result_t net_failover_handle_frame(struct sk_buff **pskb)
363 {
364 	struct sk_buff *skb = *pskb;
365 	struct net_device *dev = rcu_dereference(skb->dev->rx_handler_data);
366 	struct net_failover_info *nfo_info = netdev_priv(dev);
367 	struct net_device *primary_dev, *standby_dev;
368 
369 	primary_dev = rcu_dereference(nfo_info->primary_dev);
370 	standby_dev = rcu_dereference(nfo_info->standby_dev);
371 
372 	if (primary_dev && skb->dev == standby_dev)
373 		return RX_HANDLER_EXACT;
374 
375 	skb->dev = dev;
376 
377 	return RX_HANDLER_ANOTHER;
378 }
379 
net_failover_compute_features(struct net_device * dev)380 static void net_failover_compute_features(struct net_device *dev)
381 {
382 	netdev_features_t vlan_features = FAILOVER_VLAN_FEATURES &
383 					  NETIF_F_ALL_FOR_ALL;
384 	netdev_features_t enc_features  = FAILOVER_ENC_FEATURES;
385 	unsigned short max_hard_header_len = ETH_HLEN;
386 	unsigned int dst_release_flag = IFF_XMIT_DST_RELEASE |
387 					IFF_XMIT_DST_RELEASE_PERM;
388 	struct net_failover_info *nfo_info = netdev_priv(dev);
389 	struct net_device *primary_dev, *standby_dev;
390 
391 	primary_dev = rcu_dereference(nfo_info->primary_dev);
392 	if (primary_dev) {
393 		vlan_features =
394 			netdev_increment_features(vlan_features,
395 						  primary_dev->vlan_features,
396 						  FAILOVER_VLAN_FEATURES);
397 		enc_features =
398 			netdev_increment_features(enc_features,
399 						  primary_dev->hw_enc_features,
400 						  FAILOVER_ENC_FEATURES);
401 
402 		dst_release_flag &= primary_dev->priv_flags;
403 		if (primary_dev->hard_header_len > max_hard_header_len)
404 			max_hard_header_len = primary_dev->hard_header_len;
405 	}
406 
407 	standby_dev = rcu_dereference(nfo_info->standby_dev);
408 	if (standby_dev) {
409 		vlan_features =
410 			netdev_increment_features(vlan_features,
411 						  standby_dev->vlan_features,
412 						  FAILOVER_VLAN_FEATURES);
413 		enc_features =
414 			netdev_increment_features(enc_features,
415 						  standby_dev->hw_enc_features,
416 						  FAILOVER_ENC_FEATURES);
417 
418 		dst_release_flag &= standby_dev->priv_flags;
419 		if (standby_dev->hard_header_len > max_hard_header_len)
420 			max_hard_header_len = standby_dev->hard_header_len;
421 	}
422 
423 	dev->vlan_features = vlan_features;
424 	dev->hw_enc_features = enc_features | NETIF_F_GSO_ENCAP_ALL;
425 	dev->hard_header_len = max_hard_header_len;
426 
427 	dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
428 	if (dst_release_flag == (IFF_XMIT_DST_RELEASE |
429 				 IFF_XMIT_DST_RELEASE_PERM))
430 		dev->priv_flags |= IFF_XMIT_DST_RELEASE;
431 
432 	netdev_change_features(dev);
433 }
434 
net_failover_lower_state_changed(struct net_device * slave_dev,struct net_device * primary_dev,struct net_device * standby_dev)435 static void net_failover_lower_state_changed(struct net_device *slave_dev,
436 					     struct net_device *primary_dev,
437 					     struct net_device *standby_dev)
438 {
439 	struct netdev_lag_lower_state_info info;
440 
441 	if (netif_carrier_ok(slave_dev))
442 		info.link_up = true;
443 	else
444 		info.link_up = false;
445 
446 	if (slave_dev == primary_dev) {
447 		if (netif_running(primary_dev))
448 			info.tx_enabled = true;
449 		else
450 			info.tx_enabled = false;
451 	} else {
452 		if ((primary_dev && netif_running(primary_dev)) ||
453 		    (!netif_running(standby_dev)))
454 			info.tx_enabled = false;
455 		else
456 			info.tx_enabled = true;
457 	}
458 
459 	netdev_lower_state_changed(slave_dev, &info);
460 }
461 
net_failover_slave_pre_register(struct net_device * slave_dev,struct net_device * failover_dev)462 static int net_failover_slave_pre_register(struct net_device *slave_dev,
463 					   struct net_device *failover_dev)
464 {
465 	struct net_device *standby_dev, *primary_dev;
466 	struct net_failover_info *nfo_info;
467 	bool slave_is_standby;
468 
469 	nfo_info = netdev_priv(failover_dev);
470 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
471 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
472 	slave_is_standby = slave_dev->dev.parent == failover_dev->dev.parent;
473 	if (slave_is_standby ? standby_dev : primary_dev) {
474 		netdev_err(failover_dev, "%s attempting to register as slave dev when %s already present\n",
475 			   slave_dev->name,
476 			   slave_is_standby ? "standby" : "primary");
477 		return -EINVAL;
478 	}
479 
480 	/* We want to allow only a direct attached VF device as a primary
481 	 * netdev. As there is no easy way to check for a VF device, restrict
482 	 * this to a pci device.
483 	 */
484 	if (!slave_is_standby && (!slave_dev->dev.parent ||
485 				  !dev_is_pci(slave_dev->dev.parent)))
486 		return -EINVAL;
487 
488 	if (failover_dev->features & NETIF_F_VLAN_CHALLENGED &&
489 	    vlan_uses_dev(failover_dev)) {
490 		netdev_err(failover_dev, "Device %s is VLAN challenged and failover device has VLAN set up\n",
491 			   failover_dev->name);
492 		return -EINVAL;
493 	}
494 
495 	return 0;
496 }
497 
net_failover_slave_register(struct net_device * slave_dev,struct net_device * failover_dev)498 static int net_failover_slave_register(struct net_device *slave_dev,
499 				       struct net_device *failover_dev)
500 {
501 	struct net_device *standby_dev, *primary_dev;
502 	struct net_failover_info *nfo_info;
503 	bool slave_is_standby;
504 	u32 orig_mtu;
505 	int err;
506 
507 	/* Align MTU of slave with failover dev */
508 	orig_mtu = slave_dev->mtu;
509 	err = dev_set_mtu(slave_dev, failover_dev->mtu);
510 	if (err) {
511 		netdev_err(failover_dev, "unable to change mtu of %s to %u register failed\n",
512 			   slave_dev->name, failover_dev->mtu);
513 		goto done;
514 	}
515 
516 	dev_hold(slave_dev);
517 
518 	if (netif_running(failover_dev)) {
519 		err = dev_open(slave_dev, NULL);
520 		if (err && (err != -EBUSY)) {
521 			netdev_err(failover_dev, "Opening slave %s failed err:%d\n",
522 				   slave_dev->name, err);
523 			goto err_dev_open;
524 		}
525 	}
526 
527 	netif_addr_lock_bh(failover_dev);
528 	dev_uc_sync_multiple(slave_dev, failover_dev);
529 	dev_mc_sync_multiple(slave_dev, failover_dev);
530 	netif_addr_unlock_bh(failover_dev);
531 
532 	err = vlan_vids_add_by_dev(slave_dev, failover_dev);
533 	if (err) {
534 		netdev_err(failover_dev, "Failed to add vlan ids to device %s err:%d\n",
535 			   slave_dev->name, err);
536 		goto err_vlan_add;
537 	}
538 
539 	nfo_info = netdev_priv(failover_dev);
540 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
541 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
542 	slave_is_standby = slave_dev->dev.parent == failover_dev->dev.parent;
543 
544 	if (slave_is_standby) {
545 		rcu_assign_pointer(nfo_info->standby_dev, slave_dev);
546 		standby_dev = slave_dev;
547 		dev_get_stats(standby_dev, &nfo_info->standby_stats);
548 	} else {
549 		rcu_assign_pointer(nfo_info->primary_dev, slave_dev);
550 		primary_dev = slave_dev;
551 		dev_get_stats(primary_dev, &nfo_info->primary_stats);
552 		failover_dev->min_mtu = slave_dev->min_mtu;
553 		failover_dev->max_mtu = slave_dev->max_mtu;
554 	}
555 
556 	net_failover_lower_state_changed(slave_dev, primary_dev, standby_dev);
557 	net_failover_compute_features(failover_dev);
558 
559 	call_netdevice_notifiers(NETDEV_JOIN, slave_dev);
560 
561 	netdev_info(failover_dev, "failover %s slave:%s registered\n",
562 		    slave_is_standby ? "standby" : "primary", slave_dev->name);
563 
564 	return 0;
565 
566 err_vlan_add:
567 	dev_uc_unsync(slave_dev, failover_dev);
568 	dev_mc_unsync(slave_dev, failover_dev);
569 	dev_close(slave_dev);
570 err_dev_open:
571 	dev_put(slave_dev);
572 	dev_set_mtu(slave_dev, orig_mtu);
573 done:
574 	return err;
575 }
576 
net_failover_slave_pre_unregister(struct net_device * slave_dev,struct net_device * failover_dev)577 static int net_failover_slave_pre_unregister(struct net_device *slave_dev,
578 					     struct net_device *failover_dev)
579 {
580 	struct net_device *standby_dev, *primary_dev;
581 	struct net_failover_info *nfo_info;
582 
583 	nfo_info = netdev_priv(failover_dev);
584 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
585 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
586 
587 	if (slave_dev != primary_dev && slave_dev != standby_dev)
588 		return -ENODEV;
589 
590 	return 0;
591 }
592 
net_failover_slave_unregister(struct net_device * slave_dev,struct net_device * failover_dev)593 static int net_failover_slave_unregister(struct net_device *slave_dev,
594 					 struct net_device *failover_dev)
595 {
596 	struct net_device *standby_dev, *primary_dev;
597 	struct net_failover_info *nfo_info;
598 	bool slave_is_standby;
599 
600 	nfo_info = netdev_priv(failover_dev);
601 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
602 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
603 
604 	if (WARN_ON_ONCE(slave_dev != primary_dev && slave_dev != standby_dev))
605 		return -ENODEV;
606 
607 	vlan_vids_del_by_dev(slave_dev, failover_dev);
608 	dev_uc_unsync(slave_dev, failover_dev);
609 	dev_mc_unsync(slave_dev, failover_dev);
610 	dev_close(slave_dev);
611 
612 	nfo_info = netdev_priv(failover_dev);
613 	dev_get_stats(failover_dev, &nfo_info->failover_stats);
614 
615 	slave_is_standby = slave_dev->dev.parent == failover_dev->dev.parent;
616 	if (slave_is_standby) {
617 		RCU_INIT_POINTER(nfo_info->standby_dev, NULL);
618 	} else {
619 		RCU_INIT_POINTER(nfo_info->primary_dev, NULL);
620 		if (standby_dev) {
621 			failover_dev->min_mtu = standby_dev->min_mtu;
622 			failover_dev->max_mtu = standby_dev->max_mtu;
623 		}
624 	}
625 
626 	dev_put(slave_dev);
627 
628 	net_failover_compute_features(failover_dev);
629 
630 	netdev_info(failover_dev, "failover %s slave:%s unregistered\n",
631 		    slave_is_standby ? "standby" : "primary", slave_dev->name);
632 
633 	return 0;
634 }
635 
net_failover_slave_link_change(struct net_device * slave_dev,struct net_device * failover_dev)636 static int net_failover_slave_link_change(struct net_device *slave_dev,
637 					  struct net_device *failover_dev)
638 {
639 	struct net_device *primary_dev, *standby_dev;
640 	struct net_failover_info *nfo_info;
641 
642 	nfo_info = netdev_priv(failover_dev);
643 
644 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
645 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
646 
647 	if (slave_dev != primary_dev && slave_dev != standby_dev)
648 		return -ENODEV;
649 
650 	if ((primary_dev && net_failover_xmit_ready(primary_dev)) ||
651 	    (standby_dev && net_failover_xmit_ready(standby_dev))) {
652 		netif_carrier_on(failover_dev);
653 		netif_tx_wake_all_queues(failover_dev);
654 	} else {
655 		dev_get_stats(failover_dev, &nfo_info->failover_stats);
656 		netif_carrier_off(failover_dev);
657 		netif_tx_stop_all_queues(failover_dev);
658 	}
659 
660 	net_failover_lower_state_changed(slave_dev, primary_dev, standby_dev);
661 
662 	return 0;
663 }
664 
net_failover_slave_name_change(struct net_device * slave_dev,struct net_device * failover_dev)665 static int net_failover_slave_name_change(struct net_device *slave_dev,
666 					  struct net_device *failover_dev)
667 {
668 	struct net_device *primary_dev, *standby_dev;
669 	struct net_failover_info *nfo_info;
670 
671 	nfo_info = netdev_priv(failover_dev);
672 
673 	primary_dev = rtnl_dereference(nfo_info->primary_dev);
674 	standby_dev = rtnl_dereference(nfo_info->standby_dev);
675 
676 	if (slave_dev != primary_dev && slave_dev != standby_dev)
677 		return -ENODEV;
678 
679 	/* We need to bring up the slave after the rename by udev in case
680 	 * open failed with EBUSY when it was registered.
681 	 */
682 	dev_open(slave_dev, NULL);
683 
684 	return 0;
685 }
686 
687 static struct failover_ops net_failover_ops = {
688 	.slave_pre_register	= net_failover_slave_pre_register,
689 	.slave_register		= net_failover_slave_register,
690 	.slave_pre_unregister	= net_failover_slave_pre_unregister,
691 	.slave_unregister	= net_failover_slave_unregister,
692 	.slave_link_change	= net_failover_slave_link_change,
693 	.slave_name_change	= net_failover_slave_name_change,
694 	.slave_handle_frame	= net_failover_handle_frame,
695 };
696 
697 /**
698  * net_failover_create - Create and register a failover instance
699  *
700  * @standby_dev: standby netdev
701  *
702  * Creates a failover netdev and registers a failover instance for a standby
703  * netdev. Used by paravirtual drivers that use 3-netdev model.
704  * The failover netdev acts as a master device and controls 2 slave devices -
705  * the original standby netdev and a VF netdev with the same MAC gets
706  * registered as primary netdev.
707  *
708  * Return: pointer to failover instance
709  */
net_failover_create(struct net_device * standby_dev)710 struct failover *net_failover_create(struct net_device *standby_dev)
711 {
712 	struct device *dev = standby_dev->dev.parent;
713 	struct net_device *failover_dev;
714 	struct failover *failover;
715 	int err;
716 
717 	/* Alloc at least 2 queues, for now we are going with 16 assuming
718 	 * that VF devices being enslaved won't have too many queues.
719 	 */
720 	failover_dev = alloc_etherdev_mq(sizeof(struct net_failover_info), 16);
721 	if (!failover_dev) {
722 		dev_err(dev, "Unable to allocate failover_netdev!\n");
723 		return ERR_PTR(-ENOMEM);
724 	}
725 
726 	dev_net_set(failover_dev, dev_net(standby_dev));
727 	SET_NETDEV_DEV(failover_dev, dev);
728 
729 	failover_dev->netdev_ops = &failover_dev_ops;
730 	failover_dev->ethtool_ops = &failover_ethtool_ops;
731 
732 	/* Initialize the device options */
733 	failover_dev->priv_flags |= IFF_UNICAST_FLT | IFF_NO_QUEUE;
734 	failover_dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE |
735 				       IFF_TX_SKB_SHARING);
736 
737 	/* don't acquire failover netdev's netif_tx_lock when transmitting */
738 	failover_dev->features |= NETIF_F_LLTX;
739 
740 	/* Don't allow failover devices to change network namespaces. */
741 	failover_dev->features |= NETIF_F_NETNS_LOCAL;
742 
743 	failover_dev->hw_features = FAILOVER_VLAN_FEATURES |
744 				    NETIF_F_HW_VLAN_CTAG_TX |
745 				    NETIF_F_HW_VLAN_CTAG_RX |
746 				    NETIF_F_HW_VLAN_CTAG_FILTER;
747 
748 	failover_dev->hw_features |= NETIF_F_GSO_ENCAP_ALL;
749 	failover_dev->features |= failover_dev->hw_features;
750 
751 	memcpy(failover_dev->dev_addr, standby_dev->dev_addr,
752 	       failover_dev->addr_len);
753 
754 	failover_dev->min_mtu = standby_dev->min_mtu;
755 	failover_dev->max_mtu = standby_dev->max_mtu;
756 
757 	err = register_netdev(failover_dev);
758 	if (err) {
759 		dev_err(dev, "Unable to register failover_dev!\n");
760 		goto err_register_netdev;
761 	}
762 
763 	netif_carrier_off(failover_dev);
764 
765 	failover = failover_register(failover_dev, &net_failover_ops);
766 	if (IS_ERR(failover)) {
767 		err = PTR_ERR(failover);
768 		goto err_failover_register;
769 	}
770 
771 	return failover;
772 
773 err_failover_register:
774 	unregister_netdev(failover_dev);
775 err_register_netdev:
776 	free_netdev(failover_dev);
777 
778 	return ERR_PTR(err);
779 }
780 EXPORT_SYMBOL_GPL(net_failover_create);
781 
782 /**
783  * net_failover_destroy - Destroy a failover instance
784  *
785  * @failover: pointer to failover instance
786  *
787  * Unregisters any slave netdevs associated with the failover instance by
788  * calling failover_slave_unregister().
789  * unregisters the failover instance itself and finally frees the failover
790  * netdev. Used by paravirtual drivers that use 3-netdev model.
791  *
792  */
net_failover_destroy(struct failover * failover)793 void net_failover_destroy(struct failover *failover)
794 {
795 	struct net_failover_info *nfo_info;
796 	struct net_device *failover_dev;
797 	struct net_device *slave_dev;
798 
799 	if (!failover)
800 		return;
801 
802 	failover_dev = rcu_dereference(failover->failover_dev);
803 	nfo_info = netdev_priv(failover_dev);
804 
805 	netif_device_detach(failover_dev);
806 
807 	rtnl_lock();
808 
809 	slave_dev = rtnl_dereference(nfo_info->primary_dev);
810 	if (slave_dev)
811 		failover_slave_unregister(slave_dev);
812 
813 	slave_dev = rtnl_dereference(nfo_info->standby_dev);
814 	if (slave_dev)
815 		failover_slave_unregister(slave_dev);
816 
817 	failover_unregister(failover);
818 
819 	unregister_netdevice(failover_dev);
820 
821 	rtnl_unlock();
822 
823 	free_netdev(failover_dev);
824 }
825 EXPORT_SYMBOL_GPL(net_failover_destroy);
826 
827 static __init int
net_failover_init(void)828 net_failover_init(void)
829 {
830 	return 0;
831 }
832 module_init(net_failover_init);
833 
834 static __exit
net_failover_exit(void)835 void net_failover_exit(void)
836 {
837 }
838 module_exit(net_failover_exit);
839 
840 MODULE_DESCRIPTION("Failover driver for Paravirtual drivers");
841 MODULE_LICENSE("GPL v2");
842