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