ipvlan_main.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784
  1. /* Copyright (c) 2014 Mahesh Bandewar <maheshb@google.com>
  2. *
  3. * This program is free software; you can redistribute it and/or
  4. * modify it under the terms of the GNU General Public License as
  5. * published by the Free Software Foundation; either version 2 of
  6. * the License, or (at your option) any later version.
  7. *
  8. */
  9. #include "ipvlan.h"
  10. static void ipvlan_adjust_mtu(struct ipvl_dev *ipvlan, struct net_device *dev)
  11. {
  12. ipvlan->dev->mtu = dev->mtu - ipvlan->mtu_adj;
  13. }
  14. static void ipvlan_set_port_mode(struct ipvl_port *port, u16 nval)
  15. {
  16. struct ipvl_dev *ipvlan;
  17. if (port->mode != nval) {
  18. list_for_each_entry(ipvlan, &port->ipvlans, pnode) {
  19. if (nval == IPVLAN_MODE_L3)
  20. ipvlan->dev->flags |= IFF_NOARP;
  21. else
  22. ipvlan->dev->flags &= ~IFF_NOARP;
  23. }
  24. port->mode = nval;
  25. }
  26. }
  27. static int ipvlan_port_create(struct net_device *dev)
  28. {
  29. struct ipvl_port *port;
  30. int err, idx;
  31. if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) {
  32. netdev_err(dev, "Master is either lo or non-ether device\n");
  33. return -EINVAL;
  34. }
  35. if (netif_is_macvlan_port(dev)) {
  36. netdev_err(dev, "Master is a macvlan port.\n");
  37. return -EBUSY;
  38. }
  39. port = kzalloc(sizeof(struct ipvl_port), GFP_KERNEL);
  40. if (!port)
  41. return -ENOMEM;
  42. port->dev = dev;
  43. port->mode = IPVLAN_MODE_L3;
  44. INIT_LIST_HEAD(&port->ipvlans);
  45. for (idx = 0; idx < IPVLAN_HASH_SIZE; idx++)
  46. INIT_HLIST_HEAD(&port->hlhead[idx]);
  47. skb_queue_head_init(&port->backlog);
  48. INIT_WORK(&port->wq, ipvlan_process_multicast);
  49. err = netdev_rx_handler_register(dev, ipvlan_handle_frame, port);
  50. if (err)
  51. goto err;
  52. dev->priv_flags |= IFF_IPVLAN_MASTER;
  53. return 0;
  54. err:
  55. kfree_rcu(port, rcu);
  56. return err;
  57. }
  58. static void ipvlan_port_destroy(struct net_device *dev)
  59. {
  60. struct ipvl_port *port = ipvlan_port_get_rtnl(dev);
  61. dev->priv_flags &= ~IFF_IPVLAN_MASTER;
  62. netdev_rx_handler_unregister(dev);
  63. cancel_work_sync(&port->wq);
  64. __skb_queue_purge(&port->backlog);
  65. kfree_rcu(port, rcu);
  66. }
  67. #define IPVLAN_FEATURES \
  68. (NETIF_F_SG | NETIF_F_HW_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
  69. NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
  70. NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \
  71. NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER)
  72. #define IPVLAN_STATE_MASK \
  73. ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))
  74. static int ipvlan_init(struct net_device *dev)
  75. {
  76. struct ipvl_dev *ipvlan = netdev_priv(dev);
  77. const struct net_device *phy_dev = ipvlan->phy_dev;
  78. struct ipvl_port *port = ipvlan->port;
  79. dev->state = (dev->state & ~IPVLAN_STATE_MASK) |
  80. (phy_dev->state & IPVLAN_STATE_MASK);
  81. dev->features = phy_dev->features & IPVLAN_FEATURES;
  82. dev->features |= NETIF_F_LLTX;
  83. dev->gso_max_size = phy_dev->gso_max_size;
  84. dev->gso_max_segs = phy_dev->gso_max_segs;
  85. dev->hard_header_len = phy_dev->hard_header_len;
  86. netdev_lockdep_set_classes(dev);
  87. ipvlan->pcpu_stats = alloc_percpu(struct ipvl_pcpu_stats);
  88. if (!ipvlan->pcpu_stats)
  89. return -ENOMEM;
  90. port->count += 1;
  91. return 0;
  92. }
  93. static void ipvlan_uninit(struct net_device *dev)
  94. {
  95. struct ipvl_dev *ipvlan = netdev_priv(dev);
  96. struct ipvl_port *port = ipvlan->port;
  97. free_percpu(ipvlan->pcpu_stats);
  98. port->count -= 1;
  99. if (!port->count)
  100. ipvlan_port_destroy(port->dev);
  101. }
  102. static int ipvlan_open(struct net_device *dev)
  103. {
  104. struct ipvl_dev *ipvlan = netdev_priv(dev);
  105. struct net_device *phy_dev = ipvlan->phy_dev;
  106. struct ipvl_addr *addr;
  107. if (ipvlan->port->mode == IPVLAN_MODE_L3)
  108. dev->flags |= IFF_NOARP;
  109. else
  110. dev->flags &= ~IFF_NOARP;
  111. list_for_each_entry(addr, &ipvlan->addrs, anode)
  112. ipvlan_ht_addr_add(ipvlan, addr);
  113. return dev_uc_add(phy_dev, phy_dev->dev_addr);
  114. }
  115. static int ipvlan_stop(struct net_device *dev)
  116. {
  117. struct ipvl_dev *ipvlan = netdev_priv(dev);
  118. struct net_device *phy_dev = ipvlan->phy_dev;
  119. struct ipvl_addr *addr;
  120. dev_uc_unsync(phy_dev, dev);
  121. dev_mc_unsync(phy_dev, dev);
  122. dev_uc_del(phy_dev, phy_dev->dev_addr);
  123. list_for_each_entry(addr, &ipvlan->addrs, anode)
  124. ipvlan_ht_addr_del(addr);
  125. return 0;
  126. }
  127. static netdev_tx_t ipvlan_start_xmit(struct sk_buff *skb,
  128. struct net_device *dev)
  129. {
  130. const struct ipvl_dev *ipvlan = netdev_priv(dev);
  131. int skblen = skb->len;
  132. int ret;
  133. ret = ipvlan_queue_xmit(skb, dev);
  134. if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
  135. struct ipvl_pcpu_stats *pcptr;
  136. pcptr = this_cpu_ptr(ipvlan->pcpu_stats);
  137. u64_stats_update_begin(&pcptr->syncp);
  138. pcptr->tx_pkts++;
  139. pcptr->tx_bytes += skblen;
  140. u64_stats_update_end(&pcptr->syncp);
  141. } else {
  142. this_cpu_inc(ipvlan->pcpu_stats->tx_drps);
  143. }
  144. return ret;
  145. }
  146. static netdev_features_t ipvlan_fix_features(struct net_device *dev,
  147. netdev_features_t features)
  148. {
  149. struct ipvl_dev *ipvlan = netdev_priv(dev);
  150. return features & (ipvlan->sfeatures | ~IPVLAN_FEATURES);
  151. }
  152. static void ipvlan_change_rx_flags(struct net_device *dev, int change)
  153. {
  154. struct ipvl_dev *ipvlan = netdev_priv(dev);
  155. struct net_device *phy_dev = ipvlan->phy_dev;
  156. if (change & IFF_ALLMULTI)
  157. dev_set_allmulti(phy_dev, dev->flags & IFF_ALLMULTI? 1 : -1);
  158. }
  159. static void ipvlan_set_multicast_mac_filter(struct net_device *dev)
  160. {
  161. struct ipvl_dev *ipvlan = netdev_priv(dev);
  162. if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) {
  163. bitmap_fill(ipvlan->mac_filters, IPVLAN_MAC_FILTER_SIZE);
  164. } else {
  165. struct netdev_hw_addr *ha;
  166. DECLARE_BITMAP(mc_filters, IPVLAN_MAC_FILTER_SIZE);
  167. bitmap_zero(mc_filters, IPVLAN_MAC_FILTER_SIZE);
  168. netdev_for_each_mc_addr(ha, dev)
  169. __set_bit(ipvlan_mac_hash(ha->addr), mc_filters);
  170. /* Turn-on broadcast bit irrespective of address family,
  171. * since broadcast is deferred to a work-queue, hence no
  172. * impact on fast-path processing.
  173. */
  174. __set_bit(ipvlan_mac_hash(dev->broadcast), mc_filters);
  175. bitmap_copy(ipvlan->mac_filters, mc_filters,
  176. IPVLAN_MAC_FILTER_SIZE);
  177. }
  178. dev_uc_sync(ipvlan->phy_dev, dev);
  179. dev_mc_sync(ipvlan->phy_dev, dev);
  180. }
  181. static struct rtnl_link_stats64 *ipvlan_get_stats64(struct net_device *dev,
  182. struct rtnl_link_stats64 *s)
  183. {
  184. struct ipvl_dev *ipvlan = netdev_priv(dev);
  185. if (ipvlan->pcpu_stats) {
  186. struct ipvl_pcpu_stats *pcptr;
  187. u64 rx_pkts, rx_bytes, rx_mcast, tx_pkts, tx_bytes;
  188. u32 rx_errs = 0, tx_drps = 0;
  189. u32 strt;
  190. int idx;
  191. for_each_possible_cpu(idx) {
  192. pcptr = per_cpu_ptr(ipvlan->pcpu_stats, idx);
  193. do {
  194. strt= u64_stats_fetch_begin_irq(&pcptr->syncp);
  195. rx_pkts = pcptr->rx_pkts;
  196. rx_bytes = pcptr->rx_bytes;
  197. rx_mcast = pcptr->rx_mcast;
  198. tx_pkts = pcptr->tx_pkts;
  199. tx_bytes = pcptr->tx_bytes;
  200. } while (u64_stats_fetch_retry_irq(&pcptr->syncp,
  201. strt));
  202. s->rx_packets += rx_pkts;
  203. s->rx_bytes += rx_bytes;
  204. s->multicast += rx_mcast;
  205. s->tx_packets += tx_pkts;
  206. s->tx_bytes += tx_bytes;
  207. /* u32 values are updated without syncp protection. */
  208. rx_errs += pcptr->rx_errs;
  209. tx_drps += pcptr->tx_drps;
  210. }
  211. s->rx_errors = rx_errs;
  212. s->rx_dropped = rx_errs;
  213. s->tx_dropped = tx_drps;
  214. }
  215. return s;
  216. }
  217. static int ipvlan_vlan_rx_add_vid(struct net_device *dev, __be16 proto, u16 vid)
  218. {
  219. struct ipvl_dev *ipvlan = netdev_priv(dev);
  220. struct net_device *phy_dev = ipvlan->phy_dev;
  221. return vlan_vid_add(phy_dev, proto, vid);
  222. }
  223. static int ipvlan_vlan_rx_kill_vid(struct net_device *dev, __be16 proto,
  224. u16 vid)
  225. {
  226. struct ipvl_dev *ipvlan = netdev_priv(dev);
  227. struct net_device *phy_dev = ipvlan->phy_dev;
  228. vlan_vid_del(phy_dev, proto, vid);
  229. return 0;
  230. }
  231. static int ipvlan_get_iflink(const struct net_device *dev)
  232. {
  233. struct ipvl_dev *ipvlan = netdev_priv(dev);
  234. return ipvlan->phy_dev->ifindex;
  235. }
  236. static const struct net_device_ops ipvlan_netdev_ops = {
  237. .ndo_init = ipvlan_init,
  238. .ndo_uninit = ipvlan_uninit,
  239. .ndo_open = ipvlan_open,
  240. .ndo_stop = ipvlan_stop,
  241. .ndo_start_xmit = ipvlan_start_xmit,
  242. .ndo_fix_features = ipvlan_fix_features,
  243. .ndo_change_rx_flags = ipvlan_change_rx_flags,
  244. .ndo_set_rx_mode = ipvlan_set_multicast_mac_filter,
  245. .ndo_get_stats64 = ipvlan_get_stats64,
  246. .ndo_vlan_rx_add_vid = ipvlan_vlan_rx_add_vid,
  247. .ndo_vlan_rx_kill_vid = ipvlan_vlan_rx_kill_vid,
  248. .ndo_get_iflink = ipvlan_get_iflink,
  249. };
  250. static int ipvlan_hard_header(struct sk_buff *skb, struct net_device *dev,
  251. unsigned short type, const void *daddr,
  252. const void *saddr, unsigned len)
  253. {
  254. const struct ipvl_dev *ipvlan = netdev_priv(dev);
  255. struct net_device *phy_dev = ipvlan->phy_dev;
  256. /* TODO Probably use a different field than dev_addr so that the
  257. * mac-address on the virtual device is portable and can be carried
  258. * while the packets use the mac-addr on the physical device.
  259. */
  260. return dev_hard_header(skb, phy_dev, type, daddr,
  261. saddr ? : dev->dev_addr, len);
  262. }
  263. static const struct header_ops ipvlan_header_ops = {
  264. .create = ipvlan_hard_header,
  265. .parse = eth_header_parse,
  266. .cache = eth_header_cache,
  267. .cache_update = eth_header_cache_update,
  268. };
  269. static int ipvlan_ethtool_get_link_ksettings(struct net_device *dev,
  270. struct ethtool_link_ksettings *cmd)
  271. {
  272. const struct ipvl_dev *ipvlan = netdev_priv(dev);
  273. return __ethtool_get_link_ksettings(ipvlan->phy_dev, cmd);
  274. }
  275. static void ipvlan_ethtool_get_drvinfo(struct net_device *dev,
  276. struct ethtool_drvinfo *drvinfo)
  277. {
  278. strlcpy(drvinfo->driver, IPVLAN_DRV, sizeof(drvinfo->driver));
  279. strlcpy(drvinfo->version, IPV_DRV_VER, sizeof(drvinfo->version));
  280. }
  281. static u32 ipvlan_ethtool_get_msglevel(struct net_device *dev)
  282. {
  283. const struct ipvl_dev *ipvlan = netdev_priv(dev);
  284. return ipvlan->msg_enable;
  285. }
  286. static void ipvlan_ethtool_set_msglevel(struct net_device *dev, u32 value)
  287. {
  288. struct ipvl_dev *ipvlan = netdev_priv(dev);
  289. ipvlan->msg_enable = value;
  290. }
  291. static const struct ethtool_ops ipvlan_ethtool_ops = {
  292. .get_link = ethtool_op_get_link,
  293. .get_link_ksettings = ipvlan_ethtool_get_link_ksettings,
  294. .get_drvinfo = ipvlan_ethtool_get_drvinfo,
  295. .get_msglevel = ipvlan_ethtool_get_msglevel,
  296. .set_msglevel = ipvlan_ethtool_set_msglevel,
  297. };
  298. static int ipvlan_nl_changelink(struct net_device *dev,
  299. struct nlattr *tb[], struct nlattr *data[])
  300. {
  301. struct ipvl_dev *ipvlan = netdev_priv(dev);
  302. struct ipvl_port *port = ipvlan_port_get_rtnl(ipvlan->phy_dev);
  303. if (data && data[IFLA_IPVLAN_MODE]) {
  304. u16 nmode = nla_get_u16(data[IFLA_IPVLAN_MODE]);
  305. ipvlan_set_port_mode(port, nmode);
  306. }
  307. return 0;
  308. }
  309. static size_t ipvlan_nl_getsize(const struct net_device *dev)
  310. {
  311. return (0
  312. + nla_total_size(2) /* IFLA_IPVLAN_MODE */
  313. );
  314. }
  315. static int ipvlan_nl_validate(struct nlattr *tb[], struct nlattr *data[])
  316. {
  317. if (data && data[IFLA_IPVLAN_MODE]) {
  318. u16 mode = nla_get_u16(data[IFLA_IPVLAN_MODE]);
  319. if (mode < IPVLAN_MODE_L2 || mode >= IPVLAN_MODE_MAX)
  320. return -EINVAL;
  321. }
  322. return 0;
  323. }
  324. static int ipvlan_nl_fillinfo(struct sk_buff *skb,
  325. const struct net_device *dev)
  326. {
  327. struct ipvl_dev *ipvlan = netdev_priv(dev);
  328. struct ipvl_port *port = ipvlan_port_get_rtnl(ipvlan->phy_dev);
  329. int ret = -EINVAL;
  330. if (!port)
  331. goto err;
  332. ret = -EMSGSIZE;
  333. if (nla_put_u16(skb, IFLA_IPVLAN_MODE, port->mode))
  334. goto err;
  335. return 0;
  336. err:
  337. return ret;
  338. }
  339. static int ipvlan_link_new(struct net *src_net, struct net_device *dev,
  340. struct nlattr *tb[], struct nlattr *data[])
  341. {
  342. struct ipvl_dev *ipvlan = netdev_priv(dev);
  343. struct ipvl_port *port;
  344. struct net_device *phy_dev;
  345. int err;
  346. u16 mode = IPVLAN_MODE_L3;
  347. if (!tb[IFLA_LINK])
  348. return -EINVAL;
  349. phy_dev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
  350. if (!phy_dev)
  351. return -ENODEV;
  352. if (netif_is_ipvlan(phy_dev)) {
  353. struct ipvl_dev *tmp = netdev_priv(phy_dev);
  354. phy_dev = tmp->phy_dev;
  355. } else if (!netif_is_ipvlan_port(phy_dev)) {
  356. err = ipvlan_port_create(phy_dev);
  357. if (err < 0)
  358. return err;
  359. }
  360. if (data && data[IFLA_IPVLAN_MODE])
  361. mode = nla_get_u16(data[IFLA_IPVLAN_MODE]);
  362. port = ipvlan_port_get_rtnl(phy_dev);
  363. ipvlan->phy_dev = phy_dev;
  364. ipvlan->dev = dev;
  365. ipvlan->port = port;
  366. ipvlan->sfeatures = IPVLAN_FEATURES;
  367. ipvlan_adjust_mtu(ipvlan, phy_dev);
  368. INIT_LIST_HEAD(&ipvlan->addrs);
  369. /* TODO Probably put random address here to be presented to the
  370. * world but keep using the physical-dev address for the outgoing
  371. * packets.
  372. */
  373. memcpy(dev->dev_addr, phy_dev->dev_addr, ETH_ALEN);
  374. dev->priv_flags |= IFF_IPVLAN_SLAVE;
  375. err = register_netdevice(dev);
  376. if (err < 0)
  377. return err;
  378. err = netdev_upper_dev_link(phy_dev, dev);
  379. if (err) {
  380. unregister_netdevice(dev);
  381. return err;
  382. }
  383. list_add_tail_rcu(&ipvlan->pnode, &port->ipvlans);
  384. ipvlan_set_port_mode(port, mode);
  385. netif_stacked_transfer_operstate(phy_dev, dev);
  386. return 0;
  387. }
  388. static void ipvlan_link_delete(struct net_device *dev, struct list_head *head)
  389. {
  390. struct ipvl_dev *ipvlan = netdev_priv(dev);
  391. struct ipvl_addr *addr, *next;
  392. list_for_each_entry_safe(addr, next, &ipvlan->addrs, anode) {
  393. ipvlan_ht_addr_del(addr);
  394. list_del(&addr->anode);
  395. kfree_rcu(addr, rcu);
  396. }
  397. list_del_rcu(&ipvlan->pnode);
  398. unregister_netdevice_queue(dev, head);
  399. netdev_upper_dev_unlink(ipvlan->phy_dev, dev);
  400. }
  401. static void ipvlan_link_setup(struct net_device *dev)
  402. {
  403. ether_setup(dev);
  404. dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
  405. dev->priv_flags |= IFF_UNICAST_FLT | IFF_NO_QUEUE;
  406. dev->netdev_ops = &ipvlan_netdev_ops;
  407. dev->destructor = free_netdev;
  408. dev->header_ops = &ipvlan_header_ops;
  409. dev->ethtool_ops = &ipvlan_ethtool_ops;
  410. }
  411. static const struct nla_policy ipvlan_nl_policy[IFLA_IPVLAN_MAX + 1] =
  412. {
  413. [IFLA_IPVLAN_MODE] = { .type = NLA_U16 },
  414. };
  415. static struct rtnl_link_ops ipvlan_link_ops = {
  416. .kind = "ipvlan",
  417. .priv_size = sizeof(struct ipvl_dev),
  418. .get_size = ipvlan_nl_getsize,
  419. .policy = ipvlan_nl_policy,
  420. .validate = ipvlan_nl_validate,
  421. .fill_info = ipvlan_nl_fillinfo,
  422. .changelink = ipvlan_nl_changelink,
  423. .maxtype = IFLA_IPVLAN_MAX,
  424. .setup = ipvlan_link_setup,
  425. .newlink = ipvlan_link_new,
  426. .dellink = ipvlan_link_delete,
  427. };
  428. static int ipvlan_link_register(struct rtnl_link_ops *ops)
  429. {
  430. return rtnl_link_register(ops);
  431. }
  432. static int ipvlan_device_event(struct notifier_block *unused,
  433. unsigned long event, void *ptr)
  434. {
  435. struct net_device *dev = netdev_notifier_info_to_dev(ptr);
  436. struct ipvl_dev *ipvlan, *next;
  437. struct ipvl_port *port;
  438. LIST_HEAD(lst_kill);
  439. if (!netif_is_ipvlan_port(dev))
  440. return NOTIFY_DONE;
  441. port = ipvlan_port_get_rtnl(dev);
  442. switch (event) {
  443. case NETDEV_CHANGE:
  444. list_for_each_entry(ipvlan, &port->ipvlans, pnode)
  445. netif_stacked_transfer_operstate(ipvlan->phy_dev,
  446. ipvlan->dev);
  447. break;
  448. case NETDEV_UNREGISTER:
  449. if (dev->reg_state != NETREG_UNREGISTERING)
  450. break;
  451. list_for_each_entry_safe(ipvlan, next, &port->ipvlans,
  452. pnode)
  453. ipvlan->dev->rtnl_link_ops->dellink(ipvlan->dev,
  454. &lst_kill);
  455. unregister_netdevice_many(&lst_kill);
  456. break;
  457. case NETDEV_FEAT_CHANGE:
  458. list_for_each_entry(ipvlan, &port->ipvlans, pnode) {
  459. ipvlan->dev->features = dev->features & IPVLAN_FEATURES;
  460. ipvlan->dev->gso_max_size = dev->gso_max_size;
  461. ipvlan->dev->gso_max_segs = dev->gso_max_segs;
  462. netdev_features_change(ipvlan->dev);
  463. }
  464. break;
  465. case NETDEV_CHANGEMTU:
  466. list_for_each_entry(ipvlan, &port->ipvlans, pnode)
  467. ipvlan_adjust_mtu(ipvlan, dev);
  468. break;
  469. case NETDEV_PRE_TYPE_CHANGE:
  470. /* Forbid underlying device to change its type. */
  471. return NOTIFY_BAD;
  472. }
  473. return NOTIFY_DONE;
  474. }
  475. static int ipvlan_add_addr6(struct ipvl_dev *ipvlan, struct in6_addr *ip6_addr)
  476. {
  477. struct ipvl_addr *addr;
  478. if (ipvlan_addr_busy(ipvlan->port, ip6_addr, true)) {
  479. netif_err(ipvlan, ifup, ipvlan->dev,
  480. "Failed to add IPv6=%pI6c addr for %s intf\n",
  481. ip6_addr, ipvlan->dev->name);
  482. return -EINVAL;
  483. }
  484. addr = kzalloc(sizeof(struct ipvl_addr), GFP_ATOMIC);
  485. if (!addr)
  486. return -ENOMEM;
  487. addr->master = ipvlan;
  488. memcpy(&addr->ip6addr, ip6_addr, sizeof(struct in6_addr));
  489. addr->atype = IPVL_IPV6;
  490. list_add_tail(&addr->anode, &ipvlan->addrs);
  491. /* If the interface is not up, the address will be added to the hash
  492. * list by ipvlan_open.
  493. */
  494. if (netif_running(ipvlan->dev))
  495. ipvlan_ht_addr_add(ipvlan, addr);
  496. return 0;
  497. }
  498. static void ipvlan_del_addr6(struct ipvl_dev *ipvlan, struct in6_addr *ip6_addr)
  499. {
  500. struct ipvl_addr *addr;
  501. addr = ipvlan_find_addr(ipvlan, ip6_addr, true);
  502. if (!addr)
  503. return;
  504. ipvlan_ht_addr_del(addr);
  505. list_del(&addr->anode);
  506. kfree_rcu(addr, rcu);
  507. return;
  508. }
  509. static int ipvlan_addr6_event(struct notifier_block *unused,
  510. unsigned long event, void *ptr)
  511. {
  512. struct inet6_ifaddr *if6 = (struct inet6_ifaddr *)ptr;
  513. struct net_device *dev = (struct net_device *)if6->idev->dev;
  514. struct ipvl_dev *ipvlan = netdev_priv(dev);
  515. /* FIXME IPv6 autoconf calls us from bh without RTNL */
  516. if (in_softirq())
  517. return NOTIFY_DONE;
  518. if (!netif_is_ipvlan(dev))
  519. return NOTIFY_DONE;
  520. if (!ipvlan || !ipvlan->port)
  521. return NOTIFY_DONE;
  522. switch (event) {
  523. case NETDEV_UP:
  524. if (ipvlan_add_addr6(ipvlan, &if6->addr))
  525. return NOTIFY_BAD;
  526. break;
  527. case NETDEV_DOWN:
  528. ipvlan_del_addr6(ipvlan, &if6->addr);
  529. break;
  530. }
  531. return NOTIFY_OK;
  532. }
  533. static int ipvlan_add_addr4(struct ipvl_dev *ipvlan, struct in_addr *ip4_addr)
  534. {
  535. struct ipvl_addr *addr;
  536. if (ipvlan_addr_busy(ipvlan->port, ip4_addr, false)) {
  537. netif_err(ipvlan, ifup, ipvlan->dev,
  538. "Failed to add IPv4=%pI4 on %s intf.\n",
  539. ip4_addr, ipvlan->dev->name);
  540. return -EINVAL;
  541. }
  542. addr = kzalloc(sizeof(struct ipvl_addr), GFP_KERNEL);
  543. if (!addr)
  544. return -ENOMEM;
  545. addr->master = ipvlan;
  546. memcpy(&addr->ip4addr, ip4_addr, sizeof(struct in_addr));
  547. addr->atype = IPVL_IPV4;
  548. list_add_tail(&addr->anode, &ipvlan->addrs);
  549. /* If the interface is not up, the address will be added to the hash
  550. * list by ipvlan_open.
  551. */
  552. if (netif_running(ipvlan->dev))
  553. ipvlan_ht_addr_add(ipvlan, addr);
  554. return 0;
  555. }
  556. static void ipvlan_del_addr4(struct ipvl_dev *ipvlan, struct in_addr *ip4_addr)
  557. {
  558. struct ipvl_addr *addr;
  559. addr = ipvlan_find_addr(ipvlan, ip4_addr, false);
  560. if (!addr)
  561. return;
  562. ipvlan_ht_addr_del(addr);
  563. list_del(&addr->anode);
  564. kfree_rcu(addr, rcu);
  565. return;
  566. }
  567. static int ipvlan_addr4_event(struct notifier_block *unused,
  568. unsigned long event, void *ptr)
  569. {
  570. struct in_ifaddr *if4 = (struct in_ifaddr *)ptr;
  571. struct net_device *dev = (struct net_device *)if4->ifa_dev->dev;
  572. struct ipvl_dev *ipvlan = netdev_priv(dev);
  573. struct in_addr ip4_addr;
  574. if (!netif_is_ipvlan(dev))
  575. return NOTIFY_DONE;
  576. if (!ipvlan || !ipvlan->port)
  577. return NOTIFY_DONE;
  578. switch (event) {
  579. case NETDEV_UP:
  580. ip4_addr.s_addr = if4->ifa_address;
  581. if (ipvlan_add_addr4(ipvlan, &ip4_addr))
  582. return NOTIFY_BAD;
  583. break;
  584. case NETDEV_DOWN:
  585. ip4_addr.s_addr = if4->ifa_address;
  586. ipvlan_del_addr4(ipvlan, &ip4_addr);
  587. break;
  588. }
  589. return NOTIFY_OK;
  590. }
  591. static struct notifier_block ipvlan_addr4_notifier_block __read_mostly = {
  592. .notifier_call = ipvlan_addr4_event,
  593. };
  594. static struct notifier_block ipvlan_notifier_block __read_mostly = {
  595. .notifier_call = ipvlan_device_event,
  596. };
  597. static struct notifier_block ipvlan_addr6_notifier_block __read_mostly = {
  598. .notifier_call = ipvlan_addr6_event,
  599. };
  600. static int __init ipvlan_init_module(void)
  601. {
  602. int err;
  603. ipvlan_init_secret();
  604. register_netdevice_notifier(&ipvlan_notifier_block);
  605. register_inet6addr_notifier(&ipvlan_addr6_notifier_block);
  606. register_inetaddr_notifier(&ipvlan_addr4_notifier_block);
  607. err = ipvlan_link_register(&ipvlan_link_ops);
  608. if (err < 0)
  609. goto error;
  610. return 0;
  611. error:
  612. unregister_inetaddr_notifier(&ipvlan_addr4_notifier_block);
  613. unregister_inet6addr_notifier(&ipvlan_addr6_notifier_block);
  614. unregister_netdevice_notifier(&ipvlan_notifier_block);
  615. return err;
  616. }
  617. static void __exit ipvlan_cleanup_module(void)
  618. {
  619. rtnl_link_unregister(&ipvlan_link_ops);
  620. unregister_netdevice_notifier(&ipvlan_notifier_block);
  621. unregister_inetaddr_notifier(&ipvlan_addr4_notifier_block);
  622. unregister_inet6addr_notifier(&ipvlan_addr6_notifier_block);
  623. }
  624. module_init(ipvlan_init_module);
  625. module_exit(ipvlan_cleanup_module);
  626. MODULE_LICENSE("GPL");
  627. MODULE_AUTHOR("Mahesh Bandewar <maheshb@google.com>");
  628. MODULE_DESCRIPTION("Driver for L3 (IPv6/IPv4) based VLANs");
  629. MODULE_ALIAS_RTNL_LINK("ipvlan");