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