1b863ceb7SPatrick McHardy /* 2b863ceb7SPatrick McHardy * Copyright (c) 2007 Patrick McHardy <kaber@trash.net> 3b863ceb7SPatrick McHardy * 4b863ceb7SPatrick McHardy * This program is free software; you can redistribute it and/or 5b863ceb7SPatrick McHardy * modify it under the terms of the GNU General Public License as 6b863ceb7SPatrick McHardy * published by the Free Software Foundation; either version 2 of 7b863ceb7SPatrick McHardy * the License, or (at your option) any later version. 8b863ceb7SPatrick McHardy * 9b863ceb7SPatrick McHardy * The code this is based on carried the following copyright notice: 10b863ceb7SPatrick McHardy * --- 11b863ceb7SPatrick McHardy * (C) Copyright 2001-2006 12b863ceb7SPatrick McHardy * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com 13b863ceb7SPatrick McHardy * Re-worked by Ben Greear <greearb@candelatech.com> 14b863ceb7SPatrick McHardy * --- 15b863ceb7SPatrick McHardy */ 16b863ceb7SPatrick McHardy #include <linux/kernel.h> 17b863ceb7SPatrick McHardy #include <linux/types.h> 18b863ceb7SPatrick McHardy #include <linux/module.h> 19b863ceb7SPatrick McHardy #include <linux/init.h> 20b863ceb7SPatrick McHardy #include <linux/errno.h> 21b863ceb7SPatrick McHardy #include <linux/slab.h> 22b863ceb7SPatrick McHardy #include <linux/string.h> 2382524746SFranck Bui-Huu #include <linux/rculist.h> 24b863ceb7SPatrick McHardy #include <linux/notifier.h> 25b863ceb7SPatrick McHardy #include <linux/netdevice.h> 26b863ceb7SPatrick McHardy #include <linux/etherdevice.h> 27b863ceb7SPatrick McHardy #include <linux/ethtool.h> 28b863ceb7SPatrick McHardy #include <linux/if_arp.h> 29b863ceb7SPatrick McHardy #include <linux/if_link.h> 30b863ceb7SPatrick McHardy #include <linux/if_macvlan.h> 31b863ceb7SPatrick McHardy #include <net/rtnetlink.h> 32*618e1b74SArnd Bergmann #include <net/xfrm.h> 33b863ceb7SPatrick McHardy 34b863ceb7SPatrick McHardy #define MACVLAN_HASH_SIZE (1 << BITS_PER_BYTE) 35b863ceb7SPatrick McHardy 36*618e1b74SArnd Bergmann enum macvlan_mode { 37*618e1b74SArnd Bergmann MACVLAN_MODE_PRIVATE = 1, 38*618e1b74SArnd Bergmann MACVLAN_MODE_VEPA = 2, 39*618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE = 4, 40*618e1b74SArnd Bergmann }; 41*618e1b74SArnd Bergmann 42b863ceb7SPatrick McHardy struct macvlan_port { 43b863ceb7SPatrick McHardy struct net_device *dev; 44b863ceb7SPatrick McHardy struct hlist_head vlan_hash[MACVLAN_HASH_SIZE]; 45b863ceb7SPatrick McHardy struct list_head vlans; 46b863ceb7SPatrick McHardy }; 47b863ceb7SPatrick McHardy 48fccaf710SEric Dumazet /** 49fccaf710SEric Dumazet * struct macvlan_rx_stats - MACVLAN percpu rx stats 50fccaf710SEric Dumazet * @rx_packets: number of received packets 51fccaf710SEric Dumazet * @rx_bytes: number of received bytes 52fccaf710SEric Dumazet * @multicast: number of received multicast packets 53fccaf710SEric Dumazet * @rx_errors: number of errors 54fccaf710SEric Dumazet */ 55fccaf710SEric Dumazet struct macvlan_rx_stats { 56fccaf710SEric Dumazet unsigned long rx_packets; 57fccaf710SEric Dumazet unsigned long rx_bytes; 58fccaf710SEric Dumazet unsigned long multicast; 59fccaf710SEric Dumazet unsigned long rx_errors; 60fccaf710SEric Dumazet }; 61fccaf710SEric Dumazet 62b863ceb7SPatrick McHardy struct macvlan_dev { 63b863ceb7SPatrick McHardy struct net_device *dev; 64b863ceb7SPatrick McHardy struct list_head list; 65b863ceb7SPatrick McHardy struct hlist_node hlist; 66b863ceb7SPatrick McHardy struct macvlan_port *port; 67b863ceb7SPatrick McHardy struct net_device *lowerdev; 68fccaf710SEric Dumazet struct macvlan_rx_stats *rx_stats; 69*618e1b74SArnd Bergmann enum macvlan_mode mode; 70b863ceb7SPatrick McHardy }; 71b863ceb7SPatrick McHardy 72b863ceb7SPatrick McHardy 73b863ceb7SPatrick McHardy static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port, 74b863ceb7SPatrick McHardy const unsigned char *addr) 75b863ceb7SPatrick McHardy { 76b863ceb7SPatrick McHardy struct macvlan_dev *vlan; 77b863ceb7SPatrick McHardy struct hlist_node *n; 78b863ceb7SPatrick McHardy 79b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) { 80ac06713dSEric Dumazet if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr)) 81b863ceb7SPatrick McHardy return vlan; 82b863ceb7SPatrick McHardy } 83b863ceb7SPatrick McHardy return NULL; 84b863ceb7SPatrick McHardy } 85b863ceb7SPatrick McHardy 86f9ac30f0SEric Biederman static void macvlan_hash_add(struct macvlan_dev *vlan) 87f9ac30f0SEric Biederman { 88f9ac30f0SEric Biederman struct macvlan_port *port = vlan->port; 89f9ac30f0SEric Biederman const unsigned char *addr = vlan->dev->dev_addr; 90f9ac30f0SEric Biederman 91f9ac30f0SEric Biederman hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]); 92f9ac30f0SEric Biederman } 93f9ac30f0SEric Biederman 94f9ac30f0SEric Biederman static void macvlan_hash_del(struct macvlan_dev *vlan) 95f9ac30f0SEric Biederman { 96f9ac30f0SEric Biederman hlist_del_rcu(&vlan->hlist); 97f9ac30f0SEric Biederman synchronize_rcu(); 98f9ac30f0SEric Biederman } 99f9ac30f0SEric Biederman 100f9ac30f0SEric Biederman static void macvlan_hash_change_addr(struct macvlan_dev *vlan, 101f9ac30f0SEric Biederman const unsigned char *addr) 102f9ac30f0SEric Biederman { 103f9ac30f0SEric Biederman macvlan_hash_del(vlan); 104f9ac30f0SEric Biederman /* Now that we are unhashed it is safe to change the device 105f9ac30f0SEric Biederman * address without confusing packet delivery. 106f9ac30f0SEric Biederman */ 107f9ac30f0SEric Biederman memcpy(vlan->dev->dev_addr, addr, ETH_ALEN); 108f9ac30f0SEric Biederman macvlan_hash_add(vlan); 109f9ac30f0SEric Biederman } 110f9ac30f0SEric Biederman 111f9ac30f0SEric Biederman static int macvlan_addr_busy(const struct macvlan_port *port, 112f9ac30f0SEric Biederman const unsigned char *addr) 113f9ac30f0SEric Biederman { 114f9ac30f0SEric Biederman /* Test to see if the specified multicast address is 115f9ac30f0SEric Biederman * currently in use by the underlying device or 116f9ac30f0SEric Biederman * another macvlan. 117f9ac30f0SEric Biederman */ 118ac06713dSEric Dumazet if (!compare_ether_addr_64bits(port->dev->dev_addr, addr)) 119f9ac30f0SEric Biederman return 1; 120f9ac30f0SEric Biederman 121f9ac30f0SEric Biederman if (macvlan_hash_lookup(port, addr)) 122f9ac30f0SEric Biederman return 1; 123f9ac30f0SEric Biederman 124f9ac30f0SEric Biederman return 0; 125f9ac30f0SEric Biederman } 126f9ac30f0SEric Biederman 127a1e514c5SArnd Bergmann static inline void macvlan_count_rx(const struct macvlan_dev *vlan, 128a1e514c5SArnd Bergmann unsigned int len, bool success, 129a1e514c5SArnd Bergmann bool multicast) 130a1e514c5SArnd Bergmann { 131a1e514c5SArnd Bergmann struct macvlan_rx_stats *rx_stats; 132a1e514c5SArnd Bergmann 133a1e514c5SArnd Bergmann rx_stats = per_cpu_ptr(vlan->rx_stats, smp_processor_id()); 134a1e514c5SArnd Bergmann if (likely(success)) { 135a1e514c5SArnd Bergmann rx_stats->rx_packets++;; 136a1e514c5SArnd Bergmann rx_stats->rx_bytes += len; 137a1e514c5SArnd Bergmann if (multicast) 138a1e514c5SArnd Bergmann rx_stats->multicast++; 139a1e514c5SArnd Bergmann } else { 140a1e514c5SArnd Bergmann rx_stats->rx_errors++; 141a1e514c5SArnd Bergmann } 142a1e514c5SArnd Bergmann } 143a1e514c5SArnd Bergmann 144a1e514c5SArnd Bergmann static int macvlan_broadcast_one(struct sk_buff *skb, struct net_device *dev, 145*618e1b74SArnd Bergmann const struct ethhdr *eth, bool local) 146a1e514c5SArnd Bergmann { 147a1e514c5SArnd Bergmann if (!skb) 148a1e514c5SArnd Bergmann return NET_RX_DROP; 149a1e514c5SArnd Bergmann 150*618e1b74SArnd Bergmann if (local) 151*618e1b74SArnd Bergmann return dev_forward_skb(dev, skb); 152*618e1b74SArnd Bergmann 153a1e514c5SArnd Bergmann skb->dev = dev; 154a1e514c5SArnd Bergmann if (!compare_ether_addr_64bits(eth->h_dest, 155a1e514c5SArnd Bergmann dev->broadcast)) 156a1e514c5SArnd Bergmann skb->pkt_type = PACKET_BROADCAST; 157a1e514c5SArnd Bergmann else 158a1e514c5SArnd Bergmann skb->pkt_type = PACKET_MULTICAST; 159a1e514c5SArnd Bergmann 160a1e514c5SArnd Bergmann return netif_rx(skb); 161a1e514c5SArnd Bergmann } 162a1e514c5SArnd Bergmann 163b863ceb7SPatrick McHardy static void macvlan_broadcast(struct sk_buff *skb, 164*618e1b74SArnd Bergmann const struct macvlan_port *port, 165*618e1b74SArnd Bergmann struct net_device *src, 166*618e1b74SArnd Bergmann enum macvlan_mode mode) 167b863ceb7SPatrick McHardy { 168b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 169b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 170b863ceb7SPatrick McHardy struct hlist_node *n; 171b863ceb7SPatrick McHardy struct sk_buff *nskb; 172b863ceb7SPatrick McHardy unsigned int i; 173a1e514c5SArnd Bergmann int err; 174b863ceb7SPatrick McHardy 175efbbced3SPatrick McHardy if (skb->protocol == htons(ETH_P_PAUSE)) 176efbbced3SPatrick McHardy return; 177efbbced3SPatrick McHardy 178b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 179b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) { 180*618e1b74SArnd Bergmann if (vlan->dev == src || !(vlan->mode & mode)) 181*618e1b74SArnd Bergmann continue; 182*618e1b74SArnd Bergmann 183b863ceb7SPatrick McHardy nskb = skb_clone(skb, GFP_ATOMIC); 184*618e1b74SArnd Bergmann err = macvlan_broadcast_one(nskb, vlan->dev, eth, 185*618e1b74SArnd Bergmann mode == MACVLAN_MODE_BRIDGE); 186a1e514c5SArnd Bergmann macvlan_count_rx(vlan, skb->len + ETH_HLEN, 187a1e514c5SArnd Bergmann err == NET_RX_SUCCESS, 1); 188b863ceb7SPatrick McHardy } 189b863ceb7SPatrick McHardy } 190b863ceb7SPatrick McHardy } 191b863ceb7SPatrick McHardy 192b863ceb7SPatrick McHardy /* called under rcu_read_lock() from netif_receive_skb */ 193b863ceb7SPatrick McHardy static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb) 194b863ceb7SPatrick McHardy { 195b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 196b863ceb7SPatrick McHardy const struct macvlan_port *port; 197b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 198*618e1b74SArnd Bergmann const struct macvlan_dev *src; 199b863ceb7SPatrick McHardy struct net_device *dev; 200a1e514c5SArnd Bergmann unsigned int len; 201b863ceb7SPatrick McHardy 202b863ceb7SPatrick McHardy port = rcu_dereference(skb->dev->macvlan_port); 203b863ceb7SPatrick McHardy if (port == NULL) 204b863ceb7SPatrick McHardy return skb; 205b863ceb7SPatrick McHardy 206b863ceb7SPatrick McHardy if (is_multicast_ether_addr(eth->h_dest)) { 207*618e1b74SArnd Bergmann src = macvlan_hash_lookup(port, eth->h_source); 208*618e1b74SArnd Bergmann if (!src) 209*618e1b74SArnd Bergmann /* frame comes from an external address */ 210*618e1b74SArnd Bergmann macvlan_broadcast(skb, port, NULL, 211*618e1b74SArnd Bergmann MACVLAN_MODE_PRIVATE | 212*618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 213*618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 214*618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_VEPA) 215*618e1b74SArnd Bergmann /* flood to everyone except source */ 216*618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 217*618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 218*618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 219*618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_BRIDGE) 220*618e1b74SArnd Bergmann /* 221*618e1b74SArnd Bergmann * flood only to VEPA ports, bridge ports 222*618e1b74SArnd Bergmann * already saw the frame on the way out. 223*618e1b74SArnd Bergmann */ 224*618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 225*618e1b74SArnd Bergmann MACVLAN_MODE_VEPA); 226b863ceb7SPatrick McHardy return skb; 227b863ceb7SPatrick McHardy } 228b863ceb7SPatrick McHardy 229b863ceb7SPatrick McHardy vlan = macvlan_hash_lookup(port, eth->h_dest); 230b863ceb7SPatrick McHardy if (vlan == NULL) 231b863ceb7SPatrick McHardy return skb; 232b863ceb7SPatrick McHardy 233b863ceb7SPatrick McHardy dev = vlan->dev; 234b863ceb7SPatrick McHardy if (unlikely(!(dev->flags & IFF_UP))) { 235b863ceb7SPatrick McHardy kfree_skb(skb); 236b863ceb7SPatrick McHardy return NULL; 237b863ceb7SPatrick McHardy } 238a1e514c5SArnd Bergmann len = skb->len + ETH_HLEN; 239b863ceb7SPatrick McHardy skb = skb_share_check(skb, GFP_ATOMIC); 240a1e514c5SArnd Bergmann macvlan_count_rx(vlan, len, skb != NULL, 0); 241a1e514c5SArnd Bergmann if (!skb) 242b863ceb7SPatrick McHardy return NULL; 243b863ceb7SPatrick McHardy 244b863ceb7SPatrick McHardy skb->dev = dev; 245b863ceb7SPatrick McHardy skb->pkt_type = PACKET_HOST; 246b863ceb7SPatrick McHardy 247b863ceb7SPatrick McHardy netif_rx(skb); 248b863ceb7SPatrick McHardy return NULL; 249b863ceb7SPatrick McHardy } 250b863ceb7SPatrick McHardy 251*618e1b74SArnd Bergmann static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) 252*618e1b74SArnd Bergmann { 253*618e1b74SArnd Bergmann const struct macvlan_dev *vlan = netdev_priv(dev); 254*618e1b74SArnd Bergmann const struct macvlan_port *port = vlan->port; 255*618e1b74SArnd Bergmann const struct macvlan_dev *dest; 256*618e1b74SArnd Bergmann 257*618e1b74SArnd Bergmann if (vlan->mode == MACVLAN_MODE_BRIDGE) { 258*618e1b74SArnd Bergmann const struct ethhdr *eth = (void *)skb->data; 259*618e1b74SArnd Bergmann 260*618e1b74SArnd Bergmann /* send to other bridge ports directly */ 261*618e1b74SArnd Bergmann if (is_multicast_ether_addr(eth->h_dest)) { 262*618e1b74SArnd Bergmann macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE); 263*618e1b74SArnd Bergmann goto xmit_world; 264*618e1b74SArnd Bergmann } 265*618e1b74SArnd Bergmann 266*618e1b74SArnd Bergmann dest = macvlan_hash_lookup(port, eth->h_dest); 267*618e1b74SArnd Bergmann if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { 268*618e1b74SArnd Bergmann unsigned int length = skb->len + ETH_HLEN; 269*618e1b74SArnd Bergmann int ret = dev_forward_skb(dest->dev, skb); 270*618e1b74SArnd Bergmann macvlan_count_rx(dest, length, 271*618e1b74SArnd Bergmann ret == NET_RX_SUCCESS, 0); 272*618e1b74SArnd Bergmann 273*618e1b74SArnd Bergmann return NET_XMIT_SUCCESS; 274*618e1b74SArnd Bergmann } 275*618e1b74SArnd Bergmann } 276*618e1b74SArnd Bergmann 277*618e1b74SArnd Bergmann xmit_world: 278*618e1b74SArnd Bergmann skb->dev = vlan->lowerdev; 279*618e1b74SArnd Bergmann return dev_queue_xmit(skb); 280*618e1b74SArnd Bergmann } 281*618e1b74SArnd Bergmann 282424efe9cSStephen Hemminger static netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, 283424efe9cSStephen Hemminger struct net_device *dev) 284b863ceb7SPatrick McHardy { 2852c114553SEric Dumazet int i = skb_get_queue_mapping(skb); 2862c114553SEric Dumazet struct netdev_queue *txq = netdev_get_tx_queue(dev, i); 287b863ceb7SPatrick McHardy unsigned int len = skb->len; 288b863ceb7SPatrick McHardy int ret; 289b863ceb7SPatrick McHardy 290*618e1b74SArnd Bergmann ret = macvlan_queue_xmit(skb, dev); 291b863ceb7SPatrick McHardy if (likely(ret == NET_XMIT_SUCCESS)) { 2922c114553SEric Dumazet txq->tx_packets++; 2932c114553SEric Dumazet txq->tx_bytes += len; 2942c114553SEric Dumazet } else 2952c114553SEric Dumazet txq->tx_dropped++; 2962c114553SEric Dumazet 297cbbef5e1SPatrick McHardy return ret; 298b863ceb7SPatrick McHardy } 299b863ceb7SPatrick McHardy 300b863ceb7SPatrick McHardy static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev, 3013b04dddeSStephen Hemminger unsigned short type, const void *daddr, 3023b04dddeSStephen Hemminger const void *saddr, unsigned len) 303b863ceb7SPatrick McHardy { 304b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 305b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 306b863ceb7SPatrick McHardy 3070c4e8581SStephen Hemminger return dev_hard_header(skb, lowerdev, type, daddr, 308b863ceb7SPatrick McHardy saddr ? : dev->dev_addr, len); 309b863ceb7SPatrick McHardy } 310b863ceb7SPatrick McHardy 3113b04dddeSStephen Hemminger static const struct header_ops macvlan_hard_header_ops = { 3123b04dddeSStephen Hemminger .create = macvlan_hard_header, 3133b04dddeSStephen Hemminger .rebuild = eth_rebuild_header, 3143b04dddeSStephen Hemminger .parse = eth_header_parse, 3153b04dddeSStephen Hemminger .cache = eth_header_cache, 3163b04dddeSStephen Hemminger .cache_update = eth_header_cache_update, 3173b04dddeSStephen Hemminger }; 3183b04dddeSStephen Hemminger 319b863ceb7SPatrick McHardy static int macvlan_open(struct net_device *dev) 320b863ceb7SPatrick McHardy { 321b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 322b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 323b863ceb7SPatrick McHardy int err; 324b863ceb7SPatrick McHardy 325f9ac30f0SEric Biederman err = -EBUSY; 326f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, dev->dev_addr)) 327f9ac30f0SEric Biederman goto out; 328f9ac30f0SEric Biederman 329ccffad25SJiri Pirko err = dev_unicast_add(lowerdev, dev->dev_addr); 330b863ceb7SPatrick McHardy if (err < 0) 331b89fb7daSWang Chen goto out; 332b89fb7daSWang Chen if (dev->flags & IFF_ALLMULTI) { 333b89fb7daSWang Chen err = dev_set_allmulti(lowerdev, 1); 334b89fb7daSWang Chen if (err < 0) 335b89fb7daSWang Chen goto del_unicast; 336b89fb7daSWang Chen } 337f9ac30f0SEric Biederman macvlan_hash_add(vlan); 338b863ceb7SPatrick McHardy return 0; 339b89fb7daSWang Chen 340b89fb7daSWang Chen del_unicast: 341ccffad25SJiri Pirko dev_unicast_delete(lowerdev, dev->dev_addr); 342b89fb7daSWang Chen out: 343b89fb7daSWang Chen return err; 344b863ceb7SPatrick McHardy } 345b863ceb7SPatrick McHardy 346b863ceb7SPatrick McHardy static int macvlan_stop(struct net_device *dev) 347b863ceb7SPatrick McHardy { 348b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 349b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 350b863ceb7SPatrick McHardy 351b863ceb7SPatrick McHardy dev_mc_unsync(lowerdev, dev); 352b863ceb7SPatrick McHardy if (dev->flags & IFF_ALLMULTI) 353b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, -1); 354b863ceb7SPatrick McHardy 355ccffad25SJiri Pirko dev_unicast_delete(lowerdev, dev->dev_addr); 356b863ceb7SPatrick McHardy 357f9ac30f0SEric Biederman macvlan_hash_del(vlan); 358b863ceb7SPatrick McHardy return 0; 359b863ceb7SPatrick McHardy } 360b863ceb7SPatrick McHardy 361ad5d20a6SPatrick McHardy static int macvlan_set_mac_address(struct net_device *dev, void *p) 362ad5d20a6SPatrick McHardy { 363ad5d20a6SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 364ad5d20a6SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 365ad5d20a6SPatrick McHardy struct sockaddr *addr = p; 366ad5d20a6SPatrick McHardy int err; 367ad5d20a6SPatrick McHardy 368ad5d20a6SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 369ad5d20a6SPatrick McHardy return -EADDRNOTAVAIL; 370ad5d20a6SPatrick McHardy 371f9ac30f0SEric Biederman if (!(dev->flags & IFF_UP)) { 372f9ac30f0SEric Biederman /* Just copy in the new address */ 373f9ac30f0SEric Biederman memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); 374f9ac30f0SEric Biederman } else { 375f9ac30f0SEric Biederman /* Rehash and update the device filters */ 376f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, addr->sa_data)) 377f9ac30f0SEric Biederman return -EBUSY; 378ad5d20a6SPatrick McHardy 379ccffad25SJiri Pirko err = dev_unicast_add(lowerdev, addr->sa_data); 380ccffad25SJiri Pirko if (err) 381ad5d20a6SPatrick McHardy return err; 382f9ac30f0SEric Biederman 383ccffad25SJiri Pirko dev_unicast_delete(lowerdev, dev->dev_addr); 384ad5d20a6SPatrick McHardy 385f9ac30f0SEric Biederman macvlan_hash_change_addr(vlan, addr->sa_data); 386f9ac30f0SEric Biederman } 387ad5d20a6SPatrick McHardy return 0; 388ad5d20a6SPatrick McHardy } 389ad5d20a6SPatrick McHardy 390b863ceb7SPatrick McHardy static void macvlan_change_rx_flags(struct net_device *dev, int change) 391b863ceb7SPatrick McHardy { 392b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 393b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 394b863ceb7SPatrick McHardy 395b863ceb7SPatrick McHardy if (change & IFF_ALLMULTI) 396b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); 397b863ceb7SPatrick McHardy } 398b863ceb7SPatrick McHardy 399b863ceb7SPatrick McHardy static void macvlan_set_multicast_list(struct net_device *dev) 400b863ceb7SPatrick McHardy { 401b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 402b863ceb7SPatrick McHardy 403b863ceb7SPatrick McHardy dev_mc_sync(vlan->lowerdev, dev); 404b863ceb7SPatrick McHardy } 405b863ceb7SPatrick McHardy 406b863ceb7SPatrick McHardy static int macvlan_change_mtu(struct net_device *dev, int new_mtu) 407b863ceb7SPatrick McHardy { 408b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 409b863ceb7SPatrick McHardy 410b863ceb7SPatrick McHardy if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu) 411b863ceb7SPatrick McHardy return -EINVAL; 412b863ceb7SPatrick McHardy dev->mtu = new_mtu; 413b863ceb7SPatrick McHardy return 0; 414b863ceb7SPatrick McHardy } 415b863ceb7SPatrick McHardy 416b863ceb7SPatrick McHardy /* 417b863ceb7SPatrick McHardy * macvlan network devices have devices nesting below it and are a special 418b863ceb7SPatrick McHardy * "super class" of normal network devices; split their locks off into a 419b863ceb7SPatrick McHardy * separate class since they always nest. 420b863ceb7SPatrick McHardy */ 421b863ceb7SPatrick McHardy static struct lock_class_key macvlan_netdev_xmit_lock_key; 422cf508b12SDavid S. Miller static struct lock_class_key macvlan_netdev_addr_lock_key; 423b863ceb7SPatrick McHardy 424b863ceb7SPatrick McHardy #define MACVLAN_FEATURES \ 425b863ceb7SPatrick McHardy (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \ 426b863ceb7SPatrick McHardy NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \ 427b863ceb7SPatrick McHardy NETIF_F_TSO_ECN | NETIF_F_TSO6) 428b863ceb7SPatrick McHardy 429b863ceb7SPatrick McHardy #define MACVLAN_STATE_MASK \ 430b863ceb7SPatrick McHardy ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) 431b863ceb7SPatrick McHardy 432e8a0464cSDavid S. Miller static void macvlan_set_lockdep_class_one(struct net_device *dev, 433e8a0464cSDavid S. Miller struct netdev_queue *txq, 434e8a0464cSDavid S. Miller void *_unused) 435c773e847SDavid S. Miller { 436c773e847SDavid S. Miller lockdep_set_class(&txq->_xmit_lock, 437c773e847SDavid S. Miller &macvlan_netdev_xmit_lock_key); 438c773e847SDavid S. Miller } 439c773e847SDavid S. Miller 440c773e847SDavid S. Miller static void macvlan_set_lockdep_class(struct net_device *dev) 441c773e847SDavid S. Miller { 442cf508b12SDavid S. Miller lockdep_set_class(&dev->addr_list_lock, 443cf508b12SDavid S. Miller &macvlan_netdev_addr_lock_key); 444e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL); 445c773e847SDavid S. Miller } 446c773e847SDavid S. Miller 447b863ceb7SPatrick McHardy static int macvlan_init(struct net_device *dev) 448b863ceb7SPatrick McHardy { 449b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 450b863ceb7SPatrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 451b863ceb7SPatrick McHardy 452b863ceb7SPatrick McHardy dev->state = (dev->state & ~MACVLAN_STATE_MASK) | 453b863ceb7SPatrick McHardy (lowerdev->state & MACVLAN_STATE_MASK); 454b863ceb7SPatrick McHardy dev->features = lowerdev->features & MACVLAN_FEATURES; 455b863ceb7SPatrick McHardy dev->iflink = lowerdev->ifindex; 456ef5c8996Ssg.tweak@gmail.com dev->hard_header_len = lowerdev->hard_header_len; 457b863ceb7SPatrick McHardy 458c773e847SDavid S. Miller macvlan_set_lockdep_class(dev); 459c773e847SDavid S. Miller 460fccaf710SEric Dumazet vlan->rx_stats = alloc_percpu(struct macvlan_rx_stats); 461fccaf710SEric Dumazet if (!vlan->rx_stats) 462fccaf710SEric Dumazet return -ENOMEM; 463fccaf710SEric Dumazet 464b863ceb7SPatrick McHardy return 0; 465b863ceb7SPatrick McHardy } 466b863ceb7SPatrick McHardy 467fccaf710SEric Dumazet static void macvlan_uninit(struct net_device *dev) 468fccaf710SEric Dumazet { 469fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 470fccaf710SEric Dumazet 471fccaf710SEric Dumazet free_percpu(vlan->rx_stats); 472fccaf710SEric Dumazet } 473fccaf710SEric Dumazet 474fccaf710SEric Dumazet static struct net_device_stats *macvlan_dev_get_stats(struct net_device *dev) 475fccaf710SEric Dumazet { 476fccaf710SEric Dumazet struct net_device_stats *stats = &dev->stats; 477fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 478fccaf710SEric Dumazet 479fccaf710SEric Dumazet dev_txq_stats_fold(dev, stats); 480fccaf710SEric Dumazet 481fccaf710SEric Dumazet if (vlan->rx_stats) { 482fccaf710SEric Dumazet struct macvlan_rx_stats *p, rx = {0}; 483fccaf710SEric Dumazet int i; 484fccaf710SEric Dumazet 485fccaf710SEric Dumazet for_each_possible_cpu(i) { 486fccaf710SEric Dumazet p = per_cpu_ptr(vlan->rx_stats, i); 487fccaf710SEric Dumazet rx.rx_packets += p->rx_packets; 488fccaf710SEric Dumazet rx.rx_bytes += p->rx_bytes; 489fccaf710SEric Dumazet rx.rx_errors += p->rx_errors; 490fccaf710SEric Dumazet rx.multicast += p->multicast; 491fccaf710SEric Dumazet } 492fccaf710SEric Dumazet stats->rx_packets = rx.rx_packets; 493fccaf710SEric Dumazet stats->rx_bytes = rx.rx_bytes; 494fccaf710SEric Dumazet stats->rx_errors = rx.rx_errors; 495fccaf710SEric Dumazet stats->rx_dropped = rx.rx_errors; 496fccaf710SEric Dumazet stats->multicast = rx.multicast; 497fccaf710SEric Dumazet } 498fccaf710SEric Dumazet return stats; 499fccaf710SEric Dumazet } 500fccaf710SEric Dumazet 501b863ceb7SPatrick McHardy static void macvlan_ethtool_get_drvinfo(struct net_device *dev, 502b863ceb7SPatrick McHardy struct ethtool_drvinfo *drvinfo) 503b863ceb7SPatrick McHardy { 504b863ceb7SPatrick McHardy snprintf(drvinfo->driver, 32, "macvlan"); 505b863ceb7SPatrick McHardy snprintf(drvinfo->version, 32, "0.1"); 506b863ceb7SPatrick McHardy } 507b863ceb7SPatrick McHardy 508b863ceb7SPatrick McHardy static u32 macvlan_ethtool_get_rx_csum(struct net_device *dev) 509b863ceb7SPatrick McHardy { 510b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 511b1b67dd4SPatrick McHardy return dev_ethtool_get_rx_csum(vlan->lowerdev); 512b863ceb7SPatrick McHardy } 513b863ceb7SPatrick McHardy 5149edb8bb6SStephen Hemminger static int macvlan_ethtool_get_settings(struct net_device *dev, 5159edb8bb6SStephen Hemminger struct ethtool_cmd *cmd) 5169edb8bb6SStephen Hemminger { 5179edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 518b1b67dd4SPatrick McHardy return dev_ethtool_get_settings(vlan->lowerdev, cmd); 5199edb8bb6SStephen Hemminger } 5209edb8bb6SStephen Hemminger 5219edb8bb6SStephen Hemminger static u32 macvlan_ethtool_get_flags(struct net_device *dev) 5229edb8bb6SStephen Hemminger { 5239edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 524b1b67dd4SPatrick McHardy return dev_ethtool_get_flags(vlan->lowerdev); 5259edb8bb6SStephen Hemminger } 5269edb8bb6SStephen Hemminger 527b863ceb7SPatrick McHardy static const struct ethtool_ops macvlan_ethtool_ops = { 528b863ceb7SPatrick McHardy .get_link = ethtool_op_get_link, 5299edb8bb6SStephen Hemminger .get_settings = macvlan_ethtool_get_settings, 530b863ceb7SPatrick McHardy .get_rx_csum = macvlan_ethtool_get_rx_csum, 531b863ceb7SPatrick McHardy .get_drvinfo = macvlan_ethtool_get_drvinfo, 5329edb8bb6SStephen Hemminger .get_flags = macvlan_ethtool_get_flags, 533b863ceb7SPatrick McHardy }; 534b863ceb7SPatrick McHardy 53554a30c97SStephen Hemminger static const struct net_device_ops macvlan_netdev_ops = { 53654a30c97SStephen Hemminger .ndo_init = macvlan_init, 537fccaf710SEric Dumazet .ndo_uninit = macvlan_uninit, 53854a30c97SStephen Hemminger .ndo_open = macvlan_open, 53954a30c97SStephen Hemminger .ndo_stop = macvlan_stop, 54000829823SStephen Hemminger .ndo_start_xmit = macvlan_start_xmit, 54154a30c97SStephen Hemminger .ndo_change_mtu = macvlan_change_mtu, 54254a30c97SStephen Hemminger .ndo_change_rx_flags = macvlan_change_rx_flags, 54354a30c97SStephen Hemminger .ndo_set_mac_address = macvlan_set_mac_address, 54454a30c97SStephen Hemminger .ndo_set_multicast_list = macvlan_set_multicast_list, 545fccaf710SEric Dumazet .ndo_get_stats = macvlan_dev_get_stats, 54654a30c97SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 54754a30c97SStephen Hemminger }; 54854a30c97SStephen Hemminger 549b863ceb7SPatrick McHardy static void macvlan_setup(struct net_device *dev) 550b863ceb7SPatrick McHardy { 551b863ceb7SPatrick McHardy ether_setup(dev); 552b863ceb7SPatrick McHardy 55393f154b5SEric Dumazet dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; 55454a30c97SStephen Hemminger dev->netdev_ops = &macvlan_netdev_ops; 555b863ceb7SPatrick McHardy dev->destructor = free_netdev; 5563b04dddeSStephen Hemminger dev->header_ops = &macvlan_hard_header_ops, 557b863ceb7SPatrick McHardy dev->ethtool_ops = &macvlan_ethtool_ops; 558b863ceb7SPatrick McHardy dev->tx_queue_len = 0; 559b863ceb7SPatrick McHardy } 560b863ceb7SPatrick McHardy 561b863ceb7SPatrick McHardy static int macvlan_port_create(struct net_device *dev) 562b863ceb7SPatrick McHardy { 563b863ceb7SPatrick McHardy struct macvlan_port *port; 564b863ceb7SPatrick McHardy unsigned int i; 565b863ceb7SPatrick McHardy 566b863ceb7SPatrick McHardy if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) 567b863ceb7SPatrick McHardy return -EINVAL; 568b863ceb7SPatrick McHardy 569b863ceb7SPatrick McHardy port = kzalloc(sizeof(*port), GFP_KERNEL); 570b863ceb7SPatrick McHardy if (port == NULL) 571b863ceb7SPatrick McHardy return -ENOMEM; 572b863ceb7SPatrick McHardy 573b863ceb7SPatrick McHardy port->dev = dev; 574b863ceb7SPatrick McHardy INIT_LIST_HEAD(&port->vlans); 575b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) 576b863ceb7SPatrick McHardy INIT_HLIST_HEAD(&port->vlan_hash[i]); 577b863ceb7SPatrick McHardy rcu_assign_pointer(dev->macvlan_port, port); 578b863ceb7SPatrick McHardy return 0; 579b863ceb7SPatrick McHardy } 580b863ceb7SPatrick McHardy 581b863ceb7SPatrick McHardy static void macvlan_port_destroy(struct net_device *dev) 582b863ceb7SPatrick McHardy { 583b863ceb7SPatrick McHardy struct macvlan_port *port = dev->macvlan_port; 584b863ceb7SPatrick McHardy 585b863ceb7SPatrick McHardy rcu_assign_pointer(dev->macvlan_port, NULL); 586b863ceb7SPatrick McHardy synchronize_rcu(); 587b863ceb7SPatrick McHardy kfree(port); 588b863ceb7SPatrick McHardy } 589b863ceb7SPatrick McHardy 590b863ceb7SPatrick McHardy static void macvlan_transfer_operstate(struct net_device *dev) 591b863ceb7SPatrick McHardy { 592b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 593b863ceb7SPatrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 594b863ceb7SPatrick McHardy 595b863ceb7SPatrick McHardy if (lowerdev->operstate == IF_OPER_DORMANT) 596b863ceb7SPatrick McHardy netif_dormant_on(dev); 597b863ceb7SPatrick McHardy else 598b863ceb7SPatrick McHardy netif_dormant_off(dev); 599b863ceb7SPatrick McHardy 600b863ceb7SPatrick McHardy if (netif_carrier_ok(lowerdev)) { 601b863ceb7SPatrick McHardy if (!netif_carrier_ok(dev)) 602b863ceb7SPatrick McHardy netif_carrier_on(dev); 603b863ceb7SPatrick McHardy } else { 604f12ca5f9SPatrick McHardy if (netif_carrier_ok(dev)) 605b863ceb7SPatrick McHardy netif_carrier_off(dev); 606b863ceb7SPatrick McHardy } 607b863ceb7SPatrick McHardy } 608b863ceb7SPatrick McHardy 609b863ceb7SPatrick McHardy static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) 610b863ceb7SPatrick McHardy { 611b863ceb7SPatrick McHardy if (tb[IFLA_ADDRESS]) { 612b863ceb7SPatrick McHardy if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) 613b863ceb7SPatrick McHardy return -EINVAL; 614b863ceb7SPatrick McHardy if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) 615b863ceb7SPatrick McHardy return -EADDRNOTAVAIL; 616b863ceb7SPatrick McHardy } 617b863ceb7SPatrick McHardy return 0; 618b863ceb7SPatrick McHardy } 619b863ceb7SPatrick McHardy 6202c114553SEric Dumazet static int macvlan_get_tx_queues(struct net *net, 6212c114553SEric Dumazet struct nlattr *tb[], 6222c114553SEric Dumazet unsigned int *num_tx_queues, 6232c114553SEric Dumazet unsigned int *real_num_tx_queues) 6242c114553SEric Dumazet { 6252c114553SEric Dumazet struct net_device *real_dev; 6262c114553SEric Dumazet 6272c114553SEric Dumazet if (!tb[IFLA_LINK]) 6282c114553SEric Dumazet return -EINVAL; 6292c114553SEric Dumazet 6302c114553SEric Dumazet real_dev = __dev_get_by_index(net, nla_get_u32(tb[IFLA_LINK])); 6312c114553SEric Dumazet if (!real_dev) 6322c114553SEric Dumazet return -ENODEV; 6332c114553SEric Dumazet 6342c114553SEric Dumazet *num_tx_queues = real_dev->num_tx_queues; 6352c114553SEric Dumazet *real_num_tx_queues = real_dev->real_num_tx_queues; 6362c114553SEric Dumazet return 0; 6372c114553SEric Dumazet } 6382c114553SEric Dumazet 63981adee47SEric W. Biederman static int macvlan_newlink(struct net *src_net, struct net_device *dev, 640b863ceb7SPatrick McHardy struct nlattr *tb[], struct nlattr *data[]) 641b863ceb7SPatrick McHardy { 642b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 643b863ceb7SPatrick McHardy struct macvlan_port *port; 644b863ceb7SPatrick McHardy struct net_device *lowerdev; 645b863ceb7SPatrick McHardy int err; 646b863ceb7SPatrick McHardy 647b863ceb7SPatrick McHardy if (!tb[IFLA_LINK]) 648b863ceb7SPatrick McHardy return -EINVAL; 649b863ceb7SPatrick McHardy 65081adee47SEric W. Biederman lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK])); 651b863ceb7SPatrick McHardy if (lowerdev == NULL) 652b863ceb7SPatrick McHardy return -ENODEV; 653b863ceb7SPatrick McHardy 654b0832a29SEric Biederman /* When creating macvlans on top of other macvlans - use 655b0832a29SEric Biederman * the real device as the lowerdev. 656a6ca5f1dSPatrick McHardy */ 657b0832a29SEric Biederman if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) { 658b0832a29SEric Biederman struct macvlan_dev *lowervlan = netdev_priv(lowerdev); 659b0832a29SEric Biederman lowerdev = lowervlan->lowerdev; 660b0832a29SEric Biederman } 661a6ca5f1dSPatrick McHardy 662b863ceb7SPatrick McHardy if (!tb[IFLA_MTU]) 663b863ceb7SPatrick McHardy dev->mtu = lowerdev->mtu; 664b863ceb7SPatrick McHardy else if (dev->mtu > lowerdev->mtu) 665b863ceb7SPatrick McHardy return -EINVAL; 666b863ceb7SPatrick McHardy 667b863ceb7SPatrick McHardy if (!tb[IFLA_ADDRESS]) 668b863ceb7SPatrick McHardy random_ether_addr(dev->dev_addr); 669b863ceb7SPatrick McHardy 670b863ceb7SPatrick McHardy if (lowerdev->macvlan_port == NULL) { 671b863ceb7SPatrick McHardy err = macvlan_port_create(lowerdev); 672b863ceb7SPatrick McHardy if (err < 0) 673b863ceb7SPatrick McHardy return err; 674b863ceb7SPatrick McHardy } 675b863ceb7SPatrick McHardy port = lowerdev->macvlan_port; 676b863ceb7SPatrick McHardy 677b863ceb7SPatrick McHardy vlan->lowerdev = lowerdev; 678b863ceb7SPatrick McHardy vlan->dev = dev; 679b863ceb7SPatrick McHardy vlan->port = port; 680b863ceb7SPatrick McHardy 681b863ceb7SPatrick McHardy err = register_netdevice(dev); 682b863ceb7SPatrick McHardy if (err < 0) 683b863ceb7SPatrick McHardy return err; 684b863ceb7SPatrick McHardy 685b863ceb7SPatrick McHardy list_add_tail(&vlan->list, &port->vlans); 686b863ceb7SPatrick McHardy macvlan_transfer_operstate(dev); 687b863ceb7SPatrick McHardy return 0; 688b863ceb7SPatrick McHardy } 689b863ceb7SPatrick McHardy 69023289a37SEric Dumazet static void macvlan_dellink(struct net_device *dev, struct list_head *head) 691b863ceb7SPatrick McHardy { 692b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 693b863ceb7SPatrick McHardy struct macvlan_port *port = vlan->port; 694b863ceb7SPatrick McHardy 695b863ceb7SPatrick McHardy list_del(&vlan->list); 69623289a37SEric Dumazet unregister_netdevice_queue(dev, head); 697b863ceb7SPatrick McHardy 698b863ceb7SPatrick McHardy if (list_empty(&port->vlans)) 69973120964SPatrick McHardy macvlan_port_destroy(port->dev); 700b863ceb7SPatrick McHardy } 701b863ceb7SPatrick McHardy 702b863ceb7SPatrick McHardy static struct rtnl_link_ops macvlan_link_ops __read_mostly = { 703b863ceb7SPatrick McHardy .kind = "macvlan", 704b863ceb7SPatrick McHardy .priv_size = sizeof(struct macvlan_dev), 7052c114553SEric Dumazet .get_tx_queues = macvlan_get_tx_queues, 706b863ceb7SPatrick McHardy .setup = macvlan_setup, 707b863ceb7SPatrick McHardy .validate = macvlan_validate, 708b863ceb7SPatrick McHardy .newlink = macvlan_newlink, 709b863ceb7SPatrick McHardy .dellink = macvlan_dellink, 710b863ceb7SPatrick McHardy }; 711b863ceb7SPatrick McHardy 712b863ceb7SPatrick McHardy static int macvlan_device_event(struct notifier_block *unused, 713b863ceb7SPatrick McHardy unsigned long event, void *ptr) 714b863ceb7SPatrick McHardy { 715b863ceb7SPatrick McHardy struct net_device *dev = ptr; 716b863ceb7SPatrick McHardy struct macvlan_dev *vlan, *next; 717b863ceb7SPatrick McHardy struct macvlan_port *port; 718b863ceb7SPatrick McHardy 719b863ceb7SPatrick McHardy port = dev->macvlan_port; 720b863ceb7SPatrick McHardy if (port == NULL) 721b863ceb7SPatrick McHardy return NOTIFY_DONE; 722b863ceb7SPatrick McHardy 723b863ceb7SPatrick McHardy switch (event) { 724b863ceb7SPatrick McHardy case NETDEV_CHANGE: 725b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) 726b863ceb7SPatrick McHardy macvlan_transfer_operstate(vlan->dev); 727b863ceb7SPatrick McHardy break; 728b863ceb7SPatrick McHardy case NETDEV_FEAT_CHANGE: 729b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) { 730b863ceb7SPatrick McHardy vlan->dev->features = dev->features & MACVLAN_FEATURES; 731b863ceb7SPatrick McHardy netdev_features_change(vlan->dev); 732b863ceb7SPatrick McHardy } 733b863ceb7SPatrick McHardy break; 734b863ceb7SPatrick McHardy case NETDEV_UNREGISTER: 735b863ceb7SPatrick McHardy list_for_each_entry_safe(vlan, next, &port->vlans, list) 73623289a37SEric Dumazet macvlan_dellink(vlan->dev, NULL); 737b863ceb7SPatrick McHardy break; 738b863ceb7SPatrick McHardy } 739b863ceb7SPatrick McHardy return NOTIFY_DONE; 740b863ceb7SPatrick McHardy } 741b863ceb7SPatrick McHardy 742b863ceb7SPatrick McHardy static struct notifier_block macvlan_notifier_block __read_mostly = { 743b863ceb7SPatrick McHardy .notifier_call = macvlan_device_event, 744b863ceb7SPatrick McHardy }; 745b863ceb7SPatrick McHardy 746b863ceb7SPatrick McHardy static int __init macvlan_init_module(void) 747b863ceb7SPatrick McHardy { 748b863ceb7SPatrick McHardy int err; 749b863ceb7SPatrick McHardy 750b863ceb7SPatrick McHardy register_netdevice_notifier(&macvlan_notifier_block); 751b863ceb7SPatrick McHardy macvlan_handle_frame_hook = macvlan_handle_frame; 752b863ceb7SPatrick McHardy 753b863ceb7SPatrick McHardy err = rtnl_link_register(&macvlan_link_ops); 754b863ceb7SPatrick McHardy if (err < 0) 755b863ceb7SPatrick McHardy goto err1; 756b863ceb7SPatrick McHardy return 0; 757b863ceb7SPatrick McHardy err1: 75852913246SRami Rosen macvlan_handle_frame_hook = NULL; 759b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 760b863ceb7SPatrick McHardy return err; 761b863ceb7SPatrick McHardy } 762b863ceb7SPatrick McHardy 763b863ceb7SPatrick McHardy static void __exit macvlan_cleanup_module(void) 764b863ceb7SPatrick McHardy { 765b863ceb7SPatrick McHardy rtnl_link_unregister(&macvlan_link_ops); 766b863ceb7SPatrick McHardy macvlan_handle_frame_hook = NULL; 767b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 768b863ceb7SPatrick McHardy } 769b863ceb7SPatrick McHardy 770b863ceb7SPatrick McHardy module_init(macvlan_init_module); 771b863ceb7SPatrick McHardy module_exit(macvlan_cleanup_module); 772b863ceb7SPatrick McHardy 773b863ceb7SPatrick McHardy MODULE_LICENSE("GPL"); 774b863ceb7SPatrick McHardy MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); 775b863ceb7SPatrick McHardy MODULE_DESCRIPTION("Driver for MAC address based VLANs"); 776b863ceb7SPatrick McHardy MODULE_ALIAS_RTNL_LINK("macvlan"); 777