net_failover.c 23 KB

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