macvlan.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801
  1. /*
  2. * Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License as
  6. * published by the Free Software Foundation; either version 2 of
  7. * the License, or (at your option) any later version.
  8. *
  9. * The code this is based on carried the following copyright notice:
  10. * ---
  11. * (C) Copyright 2001-2006
  12. * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com
  13. * Re-worked by Ben Greear <greearb@candelatech.com>
  14. * ---
  15. */
  16. #include <linux/kernel.h>
  17. #include <linux/types.h>
  18. #include <linux/module.h>
  19. #include <linux/init.h>
  20. #include <linux/errno.h>
  21. #include <linux/slab.h>
  22. #include <linux/string.h>
  23. #include <linux/rculist.h>
  24. #include <linux/notifier.h>
  25. #include <linux/netdevice.h>
  26. #include <linux/etherdevice.h>
  27. #include <linux/ethtool.h>
  28. #include <linux/if_arp.h>
  29. #include <linux/if_link.h>
  30. #include <linux/if_macvlan.h>
  31. #include <net/rtnetlink.h>
  32. #include <net/xfrm.h>
  33. #define MACVLAN_HASH_SIZE (1 << BITS_PER_BYTE)
  34. struct macvlan_port {
  35. struct net_device *dev;
  36. struct hlist_head vlan_hash[MACVLAN_HASH_SIZE];
  37. struct list_head vlans;
  38. };
  39. static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port,
  40. const unsigned char *addr)
  41. {
  42. struct macvlan_dev *vlan;
  43. struct hlist_node *n;
  44. hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) {
  45. if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr))
  46. return vlan;
  47. }
  48. return NULL;
  49. }
  50. static void macvlan_hash_add(struct macvlan_dev *vlan)
  51. {
  52. struct macvlan_port *port = vlan->port;
  53. const unsigned char *addr = vlan->dev->dev_addr;
  54. hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]);
  55. }
  56. static void macvlan_hash_del(struct macvlan_dev *vlan)
  57. {
  58. hlist_del_rcu(&vlan->hlist);
  59. synchronize_rcu();
  60. }
  61. static void macvlan_hash_change_addr(struct macvlan_dev *vlan,
  62. const unsigned char *addr)
  63. {
  64. macvlan_hash_del(vlan);
  65. /* Now that we are unhashed it is safe to change the device
  66. * address without confusing packet delivery.
  67. */
  68. memcpy(vlan->dev->dev_addr, addr, ETH_ALEN);
  69. macvlan_hash_add(vlan);
  70. }
  71. static int macvlan_addr_busy(const struct macvlan_port *port,
  72. const unsigned char *addr)
  73. {
  74. /* Test to see if the specified multicast address is
  75. * currently in use by the underlying device or
  76. * another macvlan.
  77. */
  78. if (!compare_ether_addr_64bits(port->dev->dev_addr, addr))
  79. return 1;
  80. if (macvlan_hash_lookup(port, addr))
  81. return 1;
  82. return 0;
  83. }
  84. static int macvlan_broadcast_one(struct sk_buff *skb,
  85. const struct macvlan_dev *vlan,
  86. const struct ethhdr *eth, bool local)
  87. {
  88. struct net_device *dev = vlan->dev;
  89. if (!skb)
  90. return NET_RX_DROP;
  91. if (local)
  92. return vlan->forward(dev, skb);
  93. skb->dev = dev;
  94. if (!compare_ether_addr_64bits(eth->h_dest,
  95. dev->broadcast))
  96. skb->pkt_type = PACKET_BROADCAST;
  97. else
  98. skb->pkt_type = PACKET_MULTICAST;
  99. return vlan->receive(skb);
  100. }
  101. static void macvlan_broadcast(struct sk_buff *skb,
  102. const struct macvlan_port *port,
  103. struct net_device *src,
  104. enum macvlan_mode mode)
  105. {
  106. const struct ethhdr *eth = eth_hdr(skb);
  107. const struct macvlan_dev *vlan;
  108. struct hlist_node *n;
  109. struct sk_buff *nskb;
  110. unsigned int i;
  111. int err;
  112. if (skb->protocol == htons(ETH_P_PAUSE))
  113. return;
  114. for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
  115. hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) {
  116. if (vlan->dev == src || !(vlan->mode & mode))
  117. continue;
  118. nskb = skb_clone(skb, GFP_ATOMIC);
  119. err = macvlan_broadcast_one(nskb, vlan, eth,
  120. mode == MACVLAN_MODE_BRIDGE);
  121. macvlan_count_rx(vlan, skb->len + ETH_HLEN,
  122. err == NET_RX_SUCCESS, 1);
  123. }
  124. }
  125. }
  126. /* called under rcu_read_lock() from netif_receive_skb */
  127. static struct sk_buff *macvlan_handle_frame(struct macvlan_port *port,
  128. struct sk_buff *skb)
  129. {
  130. const struct ethhdr *eth = eth_hdr(skb);
  131. const struct macvlan_dev *vlan;
  132. const struct macvlan_dev *src;
  133. struct net_device *dev;
  134. unsigned int len;
  135. if (is_multicast_ether_addr(eth->h_dest)) {
  136. src = macvlan_hash_lookup(port, eth->h_source);
  137. if (!src)
  138. /* frame comes from an external address */
  139. macvlan_broadcast(skb, port, NULL,
  140. MACVLAN_MODE_PRIVATE |
  141. MACVLAN_MODE_VEPA |
  142. MACVLAN_MODE_BRIDGE);
  143. else if (src->mode == MACVLAN_MODE_VEPA)
  144. /* flood to everyone except source */
  145. macvlan_broadcast(skb, port, src->dev,
  146. MACVLAN_MODE_VEPA |
  147. MACVLAN_MODE_BRIDGE);
  148. else if (src->mode == MACVLAN_MODE_BRIDGE)
  149. /*
  150. * flood only to VEPA ports, bridge ports
  151. * already saw the frame on the way out.
  152. */
  153. macvlan_broadcast(skb, port, src->dev,
  154. MACVLAN_MODE_VEPA);
  155. return skb;
  156. }
  157. vlan = macvlan_hash_lookup(port, eth->h_dest);
  158. if (vlan == NULL)
  159. return skb;
  160. dev = vlan->dev;
  161. if (unlikely(!(dev->flags & IFF_UP))) {
  162. kfree_skb(skb);
  163. return NULL;
  164. }
  165. len = skb->len + ETH_HLEN;
  166. skb = skb_share_check(skb, GFP_ATOMIC);
  167. macvlan_count_rx(vlan, len, skb != NULL, 0);
  168. if (!skb)
  169. return NULL;
  170. skb->dev = dev;
  171. skb->pkt_type = PACKET_HOST;
  172. vlan->receive(skb);
  173. return NULL;
  174. }
  175. static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev)
  176. {
  177. const struct macvlan_dev *vlan = netdev_priv(dev);
  178. const struct macvlan_port *port = vlan->port;
  179. const struct macvlan_dev *dest;
  180. if (vlan->mode == MACVLAN_MODE_BRIDGE) {
  181. const struct ethhdr *eth = (void *)skb->data;
  182. /* send to other bridge ports directly */
  183. if (is_multicast_ether_addr(eth->h_dest)) {
  184. macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE);
  185. goto xmit_world;
  186. }
  187. dest = macvlan_hash_lookup(port, eth->h_dest);
  188. if (dest && dest->mode == MACVLAN_MODE_BRIDGE) {
  189. unsigned int length = skb->len + ETH_HLEN;
  190. int ret = dest->forward(dest->dev, skb);
  191. macvlan_count_rx(dest, length,
  192. ret == NET_RX_SUCCESS, 0);
  193. return NET_XMIT_SUCCESS;
  194. }
  195. }
  196. xmit_world:
  197. skb_set_dev(skb, vlan->lowerdev);
  198. return dev_queue_xmit(skb);
  199. }
  200. netdev_tx_t macvlan_start_xmit(struct sk_buff *skb,
  201. struct net_device *dev)
  202. {
  203. int i = skb_get_queue_mapping(skb);
  204. struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
  205. unsigned int len = skb->len;
  206. int ret;
  207. ret = macvlan_queue_xmit(skb, dev);
  208. if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
  209. txq->tx_packets++;
  210. txq->tx_bytes += len;
  211. } else
  212. txq->tx_dropped++;
  213. return ret;
  214. }
  215. EXPORT_SYMBOL_GPL(macvlan_start_xmit);
  216. static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev,
  217. unsigned short type, const void *daddr,
  218. const void *saddr, unsigned len)
  219. {
  220. const struct macvlan_dev *vlan = netdev_priv(dev);
  221. struct net_device *lowerdev = vlan->lowerdev;
  222. return dev_hard_header(skb, lowerdev, type, daddr,
  223. saddr ? : dev->dev_addr, len);
  224. }
  225. static const struct header_ops macvlan_hard_header_ops = {
  226. .create = macvlan_hard_header,
  227. .rebuild = eth_rebuild_header,
  228. .parse = eth_header_parse,
  229. .cache = eth_header_cache,
  230. .cache_update = eth_header_cache_update,
  231. };
  232. static int macvlan_open(struct net_device *dev)
  233. {
  234. struct macvlan_dev *vlan = netdev_priv(dev);
  235. struct net_device *lowerdev = vlan->lowerdev;
  236. int err;
  237. err = -EBUSY;
  238. if (macvlan_addr_busy(vlan->port, dev->dev_addr))
  239. goto out;
  240. err = dev_uc_add(lowerdev, dev->dev_addr);
  241. if (err < 0)
  242. goto out;
  243. if (dev->flags & IFF_ALLMULTI) {
  244. err = dev_set_allmulti(lowerdev, 1);
  245. if (err < 0)
  246. goto del_unicast;
  247. }
  248. macvlan_hash_add(vlan);
  249. return 0;
  250. del_unicast:
  251. dev_uc_del(lowerdev, dev->dev_addr);
  252. out:
  253. return err;
  254. }
  255. static int macvlan_stop(struct net_device *dev)
  256. {
  257. struct macvlan_dev *vlan = netdev_priv(dev);
  258. struct net_device *lowerdev = vlan->lowerdev;
  259. dev_mc_unsync(lowerdev, dev);
  260. if (dev->flags & IFF_ALLMULTI)
  261. dev_set_allmulti(lowerdev, -1);
  262. dev_uc_del(lowerdev, dev->dev_addr);
  263. macvlan_hash_del(vlan);
  264. return 0;
  265. }
  266. static int macvlan_set_mac_address(struct net_device *dev, void *p)
  267. {
  268. struct macvlan_dev *vlan = netdev_priv(dev);
  269. struct net_device *lowerdev = vlan->lowerdev;
  270. struct sockaddr *addr = p;
  271. int err;
  272. if (!is_valid_ether_addr(addr->sa_data))
  273. return -EADDRNOTAVAIL;
  274. if (!(dev->flags & IFF_UP)) {
  275. /* Just copy in the new address */
  276. memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN);
  277. } else {
  278. /* Rehash and update the device filters */
  279. if (macvlan_addr_busy(vlan->port, addr->sa_data))
  280. return -EBUSY;
  281. err = dev_uc_add(lowerdev, addr->sa_data);
  282. if (err)
  283. return err;
  284. dev_uc_del(lowerdev, dev->dev_addr);
  285. macvlan_hash_change_addr(vlan, addr->sa_data);
  286. }
  287. return 0;
  288. }
  289. static void macvlan_change_rx_flags(struct net_device *dev, int change)
  290. {
  291. struct macvlan_dev *vlan = netdev_priv(dev);
  292. struct net_device *lowerdev = vlan->lowerdev;
  293. if (change & IFF_ALLMULTI)
  294. dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1);
  295. }
  296. static void macvlan_set_multicast_list(struct net_device *dev)
  297. {
  298. struct macvlan_dev *vlan = netdev_priv(dev);
  299. dev_mc_sync(vlan->lowerdev, dev);
  300. }
  301. static int macvlan_change_mtu(struct net_device *dev, int new_mtu)
  302. {
  303. struct macvlan_dev *vlan = netdev_priv(dev);
  304. if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu)
  305. return -EINVAL;
  306. dev->mtu = new_mtu;
  307. return 0;
  308. }
  309. /*
  310. * macvlan network devices have devices nesting below it and are a special
  311. * "super class" of normal network devices; split their locks off into a
  312. * separate class since they always nest.
  313. */
  314. static struct lock_class_key macvlan_netdev_xmit_lock_key;
  315. static struct lock_class_key macvlan_netdev_addr_lock_key;
  316. #define MACVLAN_FEATURES \
  317. (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
  318. NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
  319. NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO)
  320. #define MACVLAN_STATE_MASK \
  321. ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))
  322. static void macvlan_set_lockdep_class_one(struct net_device *dev,
  323. struct netdev_queue *txq,
  324. void *_unused)
  325. {
  326. lockdep_set_class(&txq->_xmit_lock,
  327. &macvlan_netdev_xmit_lock_key);
  328. }
  329. static void macvlan_set_lockdep_class(struct net_device *dev)
  330. {
  331. lockdep_set_class(&dev->addr_list_lock,
  332. &macvlan_netdev_addr_lock_key);
  333. netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL);
  334. }
  335. static int macvlan_init(struct net_device *dev)
  336. {
  337. struct macvlan_dev *vlan = netdev_priv(dev);
  338. const struct net_device *lowerdev = vlan->lowerdev;
  339. dev->state = (dev->state & ~MACVLAN_STATE_MASK) |
  340. (lowerdev->state & MACVLAN_STATE_MASK);
  341. dev->features = lowerdev->features & MACVLAN_FEATURES;
  342. dev->gso_max_size = lowerdev->gso_max_size;
  343. dev->iflink = lowerdev->ifindex;
  344. dev->hard_header_len = lowerdev->hard_header_len;
  345. macvlan_set_lockdep_class(dev);
  346. vlan->rx_stats = alloc_percpu(struct macvlan_rx_stats);
  347. if (!vlan->rx_stats)
  348. return -ENOMEM;
  349. return 0;
  350. }
  351. static void macvlan_uninit(struct net_device *dev)
  352. {
  353. struct macvlan_dev *vlan = netdev_priv(dev);
  354. free_percpu(vlan->rx_stats);
  355. }
  356. static struct net_device_stats *macvlan_dev_get_stats(struct net_device *dev)
  357. {
  358. struct net_device_stats *stats = &dev->stats;
  359. struct macvlan_dev *vlan = netdev_priv(dev);
  360. dev_txq_stats_fold(dev, stats);
  361. if (vlan->rx_stats) {
  362. struct macvlan_rx_stats *p, rx = {0};
  363. int i;
  364. for_each_possible_cpu(i) {
  365. p = per_cpu_ptr(vlan->rx_stats, i);
  366. rx.rx_packets += p->rx_packets;
  367. rx.rx_bytes += p->rx_bytes;
  368. rx.rx_errors += p->rx_errors;
  369. rx.multicast += p->multicast;
  370. }
  371. stats->rx_packets = rx.rx_packets;
  372. stats->rx_bytes = rx.rx_bytes;
  373. stats->rx_errors = rx.rx_errors;
  374. stats->rx_dropped = rx.rx_errors;
  375. stats->multicast = rx.multicast;
  376. }
  377. return stats;
  378. }
  379. static void macvlan_ethtool_get_drvinfo(struct net_device *dev,
  380. struct ethtool_drvinfo *drvinfo)
  381. {
  382. snprintf(drvinfo->driver, 32, "macvlan");
  383. snprintf(drvinfo->version, 32, "0.1");
  384. }
  385. static u32 macvlan_ethtool_get_rx_csum(struct net_device *dev)
  386. {
  387. const struct macvlan_dev *vlan = netdev_priv(dev);
  388. return dev_ethtool_get_rx_csum(vlan->lowerdev);
  389. }
  390. static int macvlan_ethtool_get_settings(struct net_device *dev,
  391. struct ethtool_cmd *cmd)
  392. {
  393. const struct macvlan_dev *vlan = netdev_priv(dev);
  394. return dev_ethtool_get_settings(vlan->lowerdev, cmd);
  395. }
  396. static u32 macvlan_ethtool_get_flags(struct net_device *dev)
  397. {
  398. const struct macvlan_dev *vlan = netdev_priv(dev);
  399. return dev_ethtool_get_flags(vlan->lowerdev);
  400. }
  401. static const struct ethtool_ops macvlan_ethtool_ops = {
  402. .get_link = ethtool_op_get_link,
  403. .get_settings = macvlan_ethtool_get_settings,
  404. .get_rx_csum = macvlan_ethtool_get_rx_csum,
  405. .get_drvinfo = macvlan_ethtool_get_drvinfo,
  406. .get_flags = macvlan_ethtool_get_flags,
  407. };
  408. static const struct net_device_ops macvlan_netdev_ops = {
  409. .ndo_init = macvlan_init,
  410. .ndo_uninit = macvlan_uninit,
  411. .ndo_open = macvlan_open,
  412. .ndo_stop = macvlan_stop,
  413. .ndo_start_xmit = macvlan_start_xmit,
  414. .ndo_change_mtu = macvlan_change_mtu,
  415. .ndo_change_rx_flags = macvlan_change_rx_flags,
  416. .ndo_set_mac_address = macvlan_set_mac_address,
  417. .ndo_set_multicast_list = macvlan_set_multicast_list,
  418. .ndo_get_stats = macvlan_dev_get_stats,
  419. .ndo_validate_addr = eth_validate_addr,
  420. };
  421. void macvlan_common_setup(struct net_device *dev)
  422. {
  423. ether_setup(dev);
  424. dev->priv_flags &= ~IFF_XMIT_DST_RELEASE;
  425. dev->netdev_ops = &macvlan_netdev_ops;
  426. dev->destructor = free_netdev;
  427. dev->header_ops = &macvlan_hard_header_ops,
  428. dev->ethtool_ops = &macvlan_ethtool_ops;
  429. }
  430. EXPORT_SYMBOL_GPL(macvlan_common_setup);
  431. static void macvlan_setup(struct net_device *dev)
  432. {
  433. macvlan_common_setup(dev);
  434. dev->tx_queue_len = 0;
  435. }
  436. static int macvlan_port_create(struct net_device *dev)
  437. {
  438. struct macvlan_port *port;
  439. unsigned int i;
  440. if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK)
  441. return -EINVAL;
  442. port = kzalloc(sizeof(*port), GFP_KERNEL);
  443. if (port == NULL)
  444. return -ENOMEM;
  445. port->dev = dev;
  446. INIT_LIST_HEAD(&port->vlans);
  447. for (i = 0; i < MACVLAN_HASH_SIZE; i++)
  448. INIT_HLIST_HEAD(&port->vlan_hash[i]);
  449. rcu_assign_pointer(dev->macvlan_port, port);
  450. return 0;
  451. }
  452. static void macvlan_port_destroy(struct net_device *dev)
  453. {
  454. struct macvlan_port *port = dev->macvlan_port;
  455. rcu_assign_pointer(dev->macvlan_port, NULL);
  456. synchronize_rcu();
  457. kfree(port);
  458. }
  459. static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])
  460. {
  461. if (tb[IFLA_ADDRESS]) {
  462. if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
  463. return -EINVAL;
  464. if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
  465. return -EADDRNOTAVAIL;
  466. }
  467. if (data && data[IFLA_MACVLAN_MODE]) {
  468. switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) {
  469. case MACVLAN_MODE_PRIVATE:
  470. case MACVLAN_MODE_VEPA:
  471. case MACVLAN_MODE_BRIDGE:
  472. break;
  473. default:
  474. return -EINVAL;
  475. }
  476. }
  477. return 0;
  478. }
  479. static int macvlan_get_tx_queues(struct net *net,
  480. struct nlattr *tb[],
  481. unsigned int *num_tx_queues,
  482. unsigned int *real_num_tx_queues)
  483. {
  484. struct net_device *real_dev;
  485. if (!tb[IFLA_LINK])
  486. return -EINVAL;
  487. real_dev = __dev_get_by_index(net, nla_get_u32(tb[IFLA_LINK]));
  488. if (!real_dev)
  489. return -ENODEV;
  490. *num_tx_queues = real_dev->num_tx_queues;
  491. *real_num_tx_queues = real_dev->real_num_tx_queues;
  492. return 0;
  493. }
  494. int macvlan_common_newlink(struct net *src_net, struct net_device *dev,
  495. struct nlattr *tb[], struct nlattr *data[],
  496. int (*receive)(struct sk_buff *skb),
  497. int (*forward)(struct net_device *dev,
  498. struct sk_buff *skb))
  499. {
  500. struct macvlan_dev *vlan = netdev_priv(dev);
  501. struct macvlan_port *port;
  502. struct net_device *lowerdev;
  503. int err;
  504. if (!tb[IFLA_LINK])
  505. return -EINVAL;
  506. lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
  507. if (lowerdev == NULL)
  508. return -ENODEV;
  509. /* When creating macvlans on top of other macvlans - use
  510. * the real device as the lowerdev.
  511. */
  512. if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) {
  513. struct macvlan_dev *lowervlan = netdev_priv(lowerdev);
  514. lowerdev = lowervlan->lowerdev;
  515. }
  516. if (!tb[IFLA_MTU])
  517. dev->mtu = lowerdev->mtu;
  518. else if (dev->mtu > lowerdev->mtu)
  519. return -EINVAL;
  520. if (!tb[IFLA_ADDRESS])
  521. random_ether_addr(dev->dev_addr);
  522. if (lowerdev->macvlan_port == NULL) {
  523. err = macvlan_port_create(lowerdev);
  524. if (err < 0)
  525. return err;
  526. }
  527. port = lowerdev->macvlan_port;
  528. vlan->lowerdev = lowerdev;
  529. vlan->dev = dev;
  530. vlan->port = port;
  531. vlan->receive = receive;
  532. vlan->forward = forward;
  533. vlan->mode = MACVLAN_MODE_VEPA;
  534. if (data && data[IFLA_MACVLAN_MODE])
  535. vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);
  536. err = register_netdevice(dev);
  537. if (err < 0)
  538. goto destroy_port;
  539. list_add_tail(&vlan->list, &port->vlans);
  540. netif_stacked_transfer_operstate(lowerdev, dev);
  541. return 0;
  542. destroy_port:
  543. if (list_empty(&port->vlans))
  544. macvlan_port_destroy(lowerdev);
  545. return err;
  546. }
  547. EXPORT_SYMBOL_GPL(macvlan_common_newlink);
  548. static int macvlan_newlink(struct net *src_net, struct net_device *dev,
  549. struct nlattr *tb[], struct nlattr *data[])
  550. {
  551. return macvlan_common_newlink(src_net, dev, tb, data,
  552. netif_rx,
  553. dev_forward_skb);
  554. }
  555. void macvlan_dellink(struct net_device *dev, struct list_head *head)
  556. {
  557. struct macvlan_dev *vlan = netdev_priv(dev);
  558. struct macvlan_port *port = vlan->port;
  559. list_del(&vlan->list);
  560. unregister_netdevice_queue(dev, head);
  561. if (list_empty(&port->vlans))
  562. macvlan_port_destroy(port->dev);
  563. }
  564. EXPORT_SYMBOL_GPL(macvlan_dellink);
  565. static int macvlan_changelink(struct net_device *dev,
  566. struct nlattr *tb[], struct nlattr *data[])
  567. {
  568. struct macvlan_dev *vlan = netdev_priv(dev);
  569. if (data && data[IFLA_MACVLAN_MODE])
  570. vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);
  571. return 0;
  572. }
  573. static size_t macvlan_get_size(const struct net_device *dev)
  574. {
  575. return nla_total_size(4);
  576. }
  577. static int macvlan_fill_info(struct sk_buff *skb,
  578. const struct net_device *dev)
  579. {
  580. struct macvlan_dev *vlan = netdev_priv(dev);
  581. NLA_PUT_U32(skb, IFLA_MACVLAN_MODE, vlan->mode);
  582. return 0;
  583. nla_put_failure:
  584. return -EMSGSIZE;
  585. }
  586. static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = {
  587. [IFLA_MACVLAN_MODE] = { .type = NLA_U32 },
  588. };
  589. int macvlan_link_register(struct rtnl_link_ops *ops)
  590. {
  591. /* common fields */
  592. ops->priv_size = sizeof(struct macvlan_dev);
  593. ops->get_tx_queues = macvlan_get_tx_queues;
  594. ops->validate = macvlan_validate;
  595. ops->maxtype = IFLA_MACVLAN_MAX;
  596. ops->policy = macvlan_policy;
  597. ops->changelink = macvlan_changelink;
  598. ops->get_size = macvlan_get_size;
  599. ops->fill_info = macvlan_fill_info;
  600. return rtnl_link_register(ops);
  601. };
  602. EXPORT_SYMBOL_GPL(macvlan_link_register);
  603. static struct rtnl_link_ops macvlan_link_ops = {
  604. .kind = "macvlan",
  605. .setup = macvlan_setup,
  606. .newlink = macvlan_newlink,
  607. .dellink = macvlan_dellink,
  608. };
  609. static int macvlan_device_event(struct notifier_block *unused,
  610. unsigned long event, void *ptr)
  611. {
  612. struct net_device *dev = ptr;
  613. struct macvlan_dev *vlan, *next;
  614. struct macvlan_port *port;
  615. port = dev->macvlan_port;
  616. if (port == NULL)
  617. return NOTIFY_DONE;
  618. switch (event) {
  619. case NETDEV_CHANGE:
  620. list_for_each_entry(vlan, &port->vlans, list)
  621. netif_stacked_transfer_operstate(vlan->lowerdev,
  622. vlan->dev);
  623. break;
  624. case NETDEV_FEAT_CHANGE:
  625. list_for_each_entry(vlan, &port->vlans, list) {
  626. vlan->dev->features = dev->features & MACVLAN_FEATURES;
  627. vlan->dev->gso_max_size = dev->gso_max_size;
  628. netdev_features_change(vlan->dev);
  629. }
  630. break;
  631. case NETDEV_UNREGISTER:
  632. list_for_each_entry_safe(vlan, next, &port->vlans, list)
  633. vlan->dev->rtnl_link_ops->dellink(vlan->dev, NULL);
  634. break;
  635. case NETDEV_PRE_TYPE_CHANGE:
  636. /* Forbid underlaying device to change its type. */
  637. return NOTIFY_BAD;
  638. }
  639. return NOTIFY_DONE;
  640. }
  641. static struct notifier_block macvlan_notifier_block __read_mostly = {
  642. .notifier_call = macvlan_device_event,
  643. };
  644. static int __init macvlan_init_module(void)
  645. {
  646. int err;
  647. register_netdevice_notifier(&macvlan_notifier_block);
  648. macvlan_handle_frame_hook = macvlan_handle_frame;
  649. err = macvlan_link_register(&macvlan_link_ops);
  650. if (err < 0)
  651. goto err1;
  652. return 0;
  653. err1:
  654. macvlan_handle_frame_hook = NULL;
  655. unregister_netdevice_notifier(&macvlan_notifier_block);
  656. return err;
  657. }
  658. static void __exit macvlan_cleanup_module(void)
  659. {
  660. rtnl_link_unregister(&macvlan_link_ops);
  661. macvlan_handle_frame_hook = NULL;
  662. unregister_netdevice_notifier(&macvlan_notifier_block);
  663. }
  664. module_init(macvlan_init_module);
  665. module_exit(macvlan_cleanup_module);
  666. MODULE_LICENSE("GPL");
  667. MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
  668. MODULE_DESCRIPTION("Driver for MAC address based VLANs");
  669. MODULE_ALIAS_RTNL_LINK("macvlan");