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> 2987002b03SJiri Pirko #include <linux/if_vlan.h> 30b863ceb7SPatrick McHardy #include <linux/if_link.h> 31b863ceb7SPatrick McHardy #include <linux/if_macvlan.h> 32b863ceb7SPatrick McHardy #include <net/rtnetlink.h> 33618e1b74SArnd Bergmann #include <net/xfrm.h> 34b863ceb7SPatrick McHardy 35b863ceb7SPatrick McHardy #define MACVLAN_HASH_SIZE (1 << BITS_PER_BYTE) 36b863ceb7SPatrick McHardy 37b863ceb7SPatrick McHardy struct macvlan_port { 38b863ceb7SPatrick McHardy struct net_device *dev; 39b863ceb7SPatrick McHardy struct hlist_head vlan_hash[MACVLAN_HASH_SIZE]; 40b863ceb7SPatrick McHardy struct list_head vlans; 418b37ef0aSJiri Pirko struct rcu_head rcu; 42eb06acdcSSridhar Samudrala bool passthru; 43d5cd9244SEric W. Biederman int count; 44b863ceb7SPatrick McHardy }; 45b863ceb7SPatrick McHardy 46d5cd9244SEric W. Biederman static void macvlan_port_destroy(struct net_device *dev); 47d5cd9244SEric W. Biederman 48a35e2c1bSJiri Pirko #define macvlan_port_get_rcu(dev) \ 49a35e2c1bSJiri Pirko ((struct macvlan_port *) rcu_dereference(dev->rx_handler_data)) 50a35e2c1bSJiri Pirko #define macvlan_port_get(dev) ((struct macvlan_port *) dev->rx_handler_data) 51a35e2c1bSJiri Pirko #define macvlan_port_exists(dev) (dev->priv_flags & IFF_MACVLAN_PORT) 52a35e2c1bSJiri Pirko 53b863ceb7SPatrick McHardy static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port, 54b863ceb7SPatrick McHardy const unsigned char *addr) 55b863ceb7SPatrick McHardy { 56b863ceb7SPatrick McHardy struct macvlan_dev *vlan; 57b863ceb7SPatrick McHardy struct hlist_node *n; 58b863ceb7SPatrick McHardy 59b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) { 60ac06713dSEric Dumazet if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr)) 61b863ceb7SPatrick McHardy return vlan; 62b863ceb7SPatrick McHardy } 63b863ceb7SPatrick McHardy return NULL; 64b863ceb7SPatrick McHardy } 65b863ceb7SPatrick McHardy 66f9ac30f0SEric Biederman static void macvlan_hash_add(struct macvlan_dev *vlan) 67f9ac30f0SEric Biederman { 68f9ac30f0SEric Biederman struct macvlan_port *port = vlan->port; 69f9ac30f0SEric Biederman const unsigned char *addr = vlan->dev->dev_addr; 70f9ac30f0SEric Biederman 71f9ac30f0SEric Biederman hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]); 72f9ac30f0SEric Biederman } 73f9ac30f0SEric Biederman 74449f4544SEric Dumazet static void macvlan_hash_del(struct macvlan_dev *vlan, bool sync) 75f9ac30f0SEric Biederman { 76f9ac30f0SEric Biederman hlist_del_rcu(&vlan->hlist); 77449f4544SEric Dumazet if (sync) 78f9ac30f0SEric Biederman synchronize_rcu(); 79f9ac30f0SEric Biederman } 80f9ac30f0SEric Biederman 81f9ac30f0SEric Biederman static void macvlan_hash_change_addr(struct macvlan_dev *vlan, 82f9ac30f0SEric Biederman const unsigned char *addr) 83f9ac30f0SEric Biederman { 84449f4544SEric Dumazet macvlan_hash_del(vlan, true); 85f9ac30f0SEric Biederman /* Now that we are unhashed it is safe to change the device 86f9ac30f0SEric Biederman * address without confusing packet delivery. 87f9ac30f0SEric Biederman */ 88f9ac30f0SEric Biederman memcpy(vlan->dev->dev_addr, addr, ETH_ALEN); 89f9ac30f0SEric Biederman macvlan_hash_add(vlan); 90f9ac30f0SEric Biederman } 91f9ac30f0SEric Biederman 92f9ac30f0SEric Biederman static int macvlan_addr_busy(const struct macvlan_port *port, 93f9ac30f0SEric Biederman const unsigned char *addr) 94f9ac30f0SEric Biederman { 95f9ac30f0SEric Biederman /* Test to see if the specified multicast address is 96f9ac30f0SEric Biederman * currently in use by the underlying device or 97f9ac30f0SEric Biederman * another macvlan. 98f9ac30f0SEric Biederman */ 99ac06713dSEric Dumazet if (!compare_ether_addr_64bits(port->dev->dev_addr, addr)) 100f9ac30f0SEric Biederman return 1; 101f9ac30f0SEric Biederman 102f9ac30f0SEric Biederman if (macvlan_hash_lookup(port, addr)) 103f9ac30f0SEric Biederman return 1; 104f9ac30f0SEric Biederman 105f9ac30f0SEric Biederman return 0; 106f9ac30f0SEric Biederman } 107f9ac30f0SEric Biederman 108a1e514c5SArnd Bergmann 109fc0663d6SArnd Bergmann static int macvlan_broadcast_one(struct sk_buff *skb, 110fc0663d6SArnd Bergmann const struct macvlan_dev *vlan, 111618e1b74SArnd Bergmann const struct ethhdr *eth, bool local) 112a1e514c5SArnd Bergmann { 113fc0663d6SArnd Bergmann struct net_device *dev = vlan->dev; 114a1e514c5SArnd Bergmann if (!skb) 115a1e514c5SArnd Bergmann return NET_RX_DROP; 116a1e514c5SArnd Bergmann 117618e1b74SArnd Bergmann if (local) 118fc0663d6SArnd Bergmann return vlan->forward(dev, skb); 119618e1b74SArnd Bergmann 120a1e514c5SArnd Bergmann skb->dev = dev; 121a1e514c5SArnd Bergmann if (!compare_ether_addr_64bits(eth->h_dest, 122a1e514c5SArnd Bergmann dev->broadcast)) 123a1e514c5SArnd Bergmann skb->pkt_type = PACKET_BROADCAST; 124a1e514c5SArnd Bergmann else 125a1e514c5SArnd Bergmann skb->pkt_type = PACKET_MULTICAST; 126a1e514c5SArnd Bergmann 127fc0663d6SArnd Bergmann return vlan->receive(skb); 128a1e514c5SArnd Bergmann } 129a1e514c5SArnd Bergmann 130b863ceb7SPatrick McHardy static void macvlan_broadcast(struct sk_buff *skb, 131618e1b74SArnd Bergmann const struct macvlan_port *port, 132618e1b74SArnd Bergmann struct net_device *src, 133618e1b74SArnd Bergmann enum macvlan_mode mode) 134b863ceb7SPatrick McHardy { 135b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 136b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 137b863ceb7SPatrick McHardy struct hlist_node *n; 138b863ceb7SPatrick McHardy struct sk_buff *nskb; 139b863ceb7SPatrick McHardy unsigned int i; 140a1e514c5SArnd Bergmann int err; 141b863ceb7SPatrick McHardy 142efbbced3SPatrick McHardy if (skb->protocol == htons(ETH_P_PAUSE)) 143efbbced3SPatrick McHardy return; 144efbbced3SPatrick McHardy 145b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 146b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) { 147618e1b74SArnd Bergmann if (vlan->dev == src || !(vlan->mode & mode)) 148618e1b74SArnd Bergmann continue; 149618e1b74SArnd Bergmann 150b863ceb7SPatrick McHardy nskb = skb_clone(skb, GFP_ATOMIC); 151fc0663d6SArnd Bergmann err = macvlan_broadcast_one(nskb, vlan, eth, 152618e1b74SArnd Bergmann mode == MACVLAN_MODE_BRIDGE); 153a1e514c5SArnd Bergmann macvlan_count_rx(vlan, skb->len + ETH_HLEN, 154a1e514c5SArnd Bergmann err == NET_RX_SUCCESS, 1); 155b863ceb7SPatrick McHardy } 156b863ceb7SPatrick McHardy } 157b863ceb7SPatrick McHardy } 158b863ceb7SPatrick McHardy 159b863ceb7SPatrick McHardy /* called under rcu_read_lock() from netif_receive_skb */ 1608a4eb573SJiri Pirko static rx_handler_result_t macvlan_handle_frame(struct sk_buff **pskb) 161b863ceb7SPatrick McHardy { 162ab95bfe0SJiri Pirko struct macvlan_port *port; 1638a4eb573SJiri Pirko struct sk_buff *skb = *pskb; 164b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 165b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 166618e1b74SArnd Bergmann const struct macvlan_dev *src; 167b863ceb7SPatrick McHardy struct net_device *dev; 168ba01877fSSridhar Samudrala unsigned int len = 0; 169ba01877fSSridhar Samudrala int ret = NET_RX_DROP; 170b863ceb7SPatrick McHardy 171a35e2c1bSJiri Pirko port = macvlan_port_get_rcu(skb->dev); 172b863ceb7SPatrick McHardy if (is_multicast_ether_addr(eth->h_dest)) { 173bc416d97SEric Dumazet skb = ip_check_defrag(skb, IP_DEFRAG_MACVLAN); 174bc416d97SEric Dumazet if (!skb) 175bc416d97SEric Dumazet return RX_HANDLER_CONSUMED; 1764ec7ac12SEric Dumazet eth = eth_hdr(skb); 177618e1b74SArnd Bergmann src = macvlan_hash_lookup(port, eth->h_source); 178618e1b74SArnd Bergmann if (!src) 179618e1b74SArnd Bergmann /* frame comes from an external address */ 180618e1b74SArnd Bergmann macvlan_broadcast(skb, port, NULL, 181618e1b74SArnd Bergmann MACVLAN_MODE_PRIVATE | 182618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 183eb06acdcSSridhar Samudrala MACVLAN_MODE_PASSTHRU| 184618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 185618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_VEPA) 186618e1b74SArnd Bergmann /* flood to everyone except source */ 187618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 188618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 189618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 190618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_BRIDGE) 191618e1b74SArnd Bergmann /* 192618e1b74SArnd Bergmann * flood only to VEPA ports, bridge ports 193618e1b74SArnd Bergmann * already saw the frame on the way out. 194618e1b74SArnd Bergmann */ 195618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 196618e1b74SArnd Bergmann MACVLAN_MODE_VEPA); 197729e72a1Sstephen hemminger else { 198729e72a1Sstephen hemminger /* forward to original port. */ 199729e72a1Sstephen hemminger vlan = src; 200729e72a1Sstephen hemminger ret = macvlan_broadcast_one(skb, vlan, eth, 0); 201729e72a1Sstephen hemminger goto out; 202729e72a1Sstephen hemminger } 203729e72a1Sstephen hemminger 2048a4eb573SJiri Pirko return RX_HANDLER_PASS; 205b863ceb7SPatrick McHardy } 206b863ceb7SPatrick McHardy 207eb06acdcSSridhar Samudrala if (port->passthru) 208eb06acdcSSridhar Samudrala vlan = list_first_entry(&port->vlans, struct macvlan_dev, list); 209eb06acdcSSridhar Samudrala else 210b863ceb7SPatrick McHardy vlan = macvlan_hash_lookup(port, eth->h_dest); 211b863ceb7SPatrick McHardy if (vlan == NULL) 2128a4eb573SJiri Pirko return RX_HANDLER_PASS; 213b863ceb7SPatrick McHardy 214b863ceb7SPatrick McHardy dev = vlan->dev; 215b863ceb7SPatrick McHardy if (unlikely(!(dev->flags & IFF_UP))) { 216b863ceb7SPatrick McHardy kfree_skb(skb); 2178a4eb573SJiri Pirko return RX_HANDLER_CONSUMED; 218b863ceb7SPatrick McHardy } 219a1e514c5SArnd Bergmann len = skb->len + ETH_HLEN; 220b863ceb7SPatrick McHardy skb = skb_share_check(skb, GFP_ATOMIC); 221a1e514c5SArnd Bergmann if (!skb) 222ba01877fSSridhar Samudrala goto out; 223b863ceb7SPatrick McHardy 224b863ceb7SPatrick McHardy skb->dev = dev; 225b863ceb7SPatrick McHardy skb->pkt_type = PACKET_HOST; 226b863ceb7SPatrick McHardy 227ba01877fSSridhar Samudrala ret = vlan->receive(skb); 228ba01877fSSridhar Samudrala 229ba01877fSSridhar Samudrala out: 230ba01877fSSridhar Samudrala macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, 0); 2318a4eb573SJiri Pirko return RX_HANDLER_CONSUMED; 232b863ceb7SPatrick McHardy } 233b863ceb7SPatrick McHardy 234618e1b74SArnd Bergmann static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) 235618e1b74SArnd Bergmann { 236618e1b74SArnd Bergmann const struct macvlan_dev *vlan = netdev_priv(dev); 237618e1b74SArnd Bergmann const struct macvlan_port *port = vlan->port; 238618e1b74SArnd Bergmann const struct macvlan_dev *dest; 23912a2856bSDaniel Lezcano __u8 ip_summed = skb->ip_summed; 240618e1b74SArnd Bergmann 241618e1b74SArnd Bergmann if (vlan->mode == MACVLAN_MODE_BRIDGE) { 242618e1b74SArnd Bergmann const struct ethhdr *eth = (void *)skb->data; 24312a2856bSDaniel Lezcano skb->ip_summed = CHECKSUM_UNNECESSARY; 244618e1b74SArnd Bergmann 245618e1b74SArnd Bergmann /* send to other bridge ports directly */ 246618e1b74SArnd Bergmann if (is_multicast_ether_addr(eth->h_dest)) { 247618e1b74SArnd Bergmann macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE); 248618e1b74SArnd Bergmann goto xmit_world; 249618e1b74SArnd Bergmann } 250618e1b74SArnd Bergmann 251618e1b74SArnd Bergmann dest = macvlan_hash_lookup(port, eth->h_dest); 252618e1b74SArnd Bergmann if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { 253a37dd333SDavid Ward /* send to lowerdev first for its network taps */ 254cb2d0f3eSDavid Ward dev_forward_skb(vlan->lowerdev, skb); 255618e1b74SArnd Bergmann 256618e1b74SArnd Bergmann return NET_XMIT_SUCCESS; 257618e1b74SArnd Bergmann } 258618e1b74SArnd Bergmann } 259618e1b74SArnd Bergmann 260618e1b74SArnd Bergmann xmit_world: 26112a2856bSDaniel Lezcano skb->ip_summed = ip_summed; 2628a83a00bSArnd Bergmann skb_set_dev(skb, vlan->lowerdev); 263618e1b74SArnd Bergmann return dev_queue_xmit(skb); 264618e1b74SArnd Bergmann } 265618e1b74SArnd Bergmann 266fc0663d6SArnd Bergmann netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, 267424efe9cSStephen Hemminger struct net_device *dev) 268b863ceb7SPatrick McHardy { 269b863ceb7SPatrick McHardy unsigned int len = skb->len; 270b863ceb7SPatrick McHardy int ret; 2718ffab51bSEric Dumazet const struct macvlan_dev *vlan = netdev_priv(dev); 272b863ceb7SPatrick McHardy 273618e1b74SArnd Bergmann ret = macvlan_queue_xmit(skb, dev); 2742d6c9ffcSEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 2758ffab51bSEric Dumazet struct macvlan_pcpu_stats *pcpu_stats; 2762c114553SEric Dumazet 2778ffab51bSEric Dumazet pcpu_stats = this_cpu_ptr(vlan->pcpu_stats); 2788ffab51bSEric Dumazet u64_stats_update_begin(&pcpu_stats->syncp); 2798ffab51bSEric Dumazet pcpu_stats->tx_packets++; 2808ffab51bSEric Dumazet pcpu_stats->tx_bytes += len; 2818ffab51bSEric Dumazet u64_stats_update_end(&pcpu_stats->syncp); 2828ffab51bSEric Dumazet } else { 2838ffab51bSEric Dumazet this_cpu_inc(vlan->pcpu_stats->tx_dropped); 2848ffab51bSEric Dumazet } 285cbbef5e1SPatrick McHardy return ret; 286b863ceb7SPatrick McHardy } 287fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_start_xmit); 288b863ceb7SPatrick McHardy 289b863ceb7SPatrick McHardy static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev, 2903b04dddeSStephen Hemminger unsigned short type, const void *daddr, 2913b04dddeSStephen Hemminger const void *saddr, unsigned len) 292b863ceb7SPatrick McHardy { 293b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 294b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 295b863ceb7SPatrick McHardy 2960c4e8581SStephen Hemminger return dev_hard_header(skb, lowerdev, type, daddr, 297b863ceb7SPatrick McHardy saddr ? : dev->dev_addr, len); 298b863ceb7SPatrick McHardy } 299b863ceb7SPatrick McHardy 3003b04dddeSStephen Hemminger static const struct header_ops macvlan_hard_header_ops = { 3013b04dddeSStephen Hemminger .create = macvlan_hard_header, 3023b04dddeSStephen Hemminger .rebuild = eth_rebuild_header, 3033b04dddeSStephen Hemminger .parse = eth_header_parse, 3043b04dddeSStephen Hemminger .cache = eth_header_cache, 3053b04dddeSStephen Hemminger .cache_update = eth_header_cache_update, 3063b04dddeSStephen Hemminger }; 3073b04dddeSStephen Hemminger 308b863ceb7SPatrick McHardy static int macvlan_open(struct net_device *dev) 309b863ceb7SPatrick McHardy { 310b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 311b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 312b863ceb7SPatrick McHardy int err; 313b863ceb7SPatrick McHardy 314eb06acdcSSridhar Samudrala if (vlan->port->passthru) { 315*df8ef8f3SJohn Fastabend if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) 316eb06acdcSSridhar Samudrala dev_set_promiscuity(lowerdev, 1); 317eb06acdcSSridhar Samudrala goto hash_add; 318eb06acdcSSridhar Samudrala } 319eb06acdcSSridhar Samudrala 320f9ac30f0SEric Biederman err = -EBUSY; 321f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, dev->dev_addr)) 322f9ac30f0SEric Biederman goto out; 323f9ac30f0SEric Biederman 324a748ee24SJiri Pirko err = dev_uc_add(lowerdev, dev->dev_addr); 325b863ceb7SPatrick McHardy if (err < 0) 326b89fb7daSWang Chen goto out; 327b89fb7daSWang Chen if (dev->flags & IFF_ALLMULTI) { 328b89fb7daSWang Chen err = dev_set_allmulti(lowerdev, 1); 329b89fb7daSWang Chen if (err < 0) 330b89fb7daSWang Chen goto del_unicast; 331b89fb7daSWang Chen } 332eb06acdcSSridhar Samudrala 333eb06acdcSSridhar Samudrala hash_add: 334f9ac30f0SEric Biederman macvlan_hash_add(vlan); 335b863ceb7SPatrick McHardy return 0; 336b89fb7daSWang Chen 337b89fb7daSWang Chen del_unicast: 338a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 339b89fb7daSWang Chen out: 340b89fb7daSWang Chen return err; 341b863ceb7SPatrick McHardy } 342b863ceb7SPatrick McHardy 343b863ceb7SPatrick McHardy static int macvlan_stop(struct net_device *dev) 344b863ceb7SPatrick McHardy { 345b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 346b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 347b863ceb7SPatrick McHardy 348*df8ef8f3SJohn Fastabend dev_uc_unsync(lowerdev, dev); 349*df8ef8f3SJohn Fastabend dev_mc_unsync(lowerdev, dev); 350*df8ef8f3SJohn Fastabend 351eb06acdcSSridhar Samudrala if (vlan->port->passthru) { 352*df8ef8f3SJohn Fastabend if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) 353eb06acdcSSridhar Samudrala dev_set_promiscuity(lowerdev, -1); 354eb06acdcSSridhar Samudrala goto hash_del; 355eb06acdcSSridhar Samudrala } 356eb06acdcSSridhar Samudrala 357b863ceb7SPatrick McHardy if (dev->flags & IFF_ALLMULTI) 358b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, -1); 359b863ceb7SPatrick McHardy 360a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 361b863ceb7SPatrick McHardy 362eb06acdcSSridhar Samudrala hash_del: 363449f4544SEric Dumazet macvlan_hash_del(vlan, !dev->dismantle); 364b863ceb7SPatrick McHardy return 0; 365b863ceb7SPatrick McHardy } 366b863ceb7SPatrick McHardy 367ad5d20a6SPatrick McHardy static int macvlan_set_mac_address(struct net_device *dev, void *p) 368ad5d20a6SPatrick McHardy { 369ad5d20a6SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 370ad5d20a6SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 371ad5d20a6SPatrick McHardy struct sockaddr *addr = p; 372ad5d20a6SPatrick McHardy int err; 373ad5d20a6SPatrick McHardy 374ad5d20a6SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 375ad5d20a6SPatrick McHardy return -EADDRNOTAVAIL; 376ad5d20a6SPatrick McHardy 377f9ac30f0SEric Biederman if (!(dev->flags & IFF_UP)) { 378f9ac30f0SEric Biederman /* Just copy in the new address */ 3797ce5d222SDanny Kukawka dev->addr_assign_type &= ~NET_ADDR_RANDOM; 380f9ac30f0SEric Biederman memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); 381f9ac30f0SEric Biederman } else { 382f9ac30f0SEric Biederman /* Rehash and update the device filters */ 383f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, addr->sa_data)) 384f9ac30f0SEric Biederman return -EBUSY; 385ad5d20a6SPatrick McHardy 386a748ee24SJiri Pirko err = dev_uc_add(lowerdev, addr->sa_data); 387ccffad25SJiri Pirko if (err) 388ad5d20a6SPatrick McHardy return err; 389f9ac30f0SEric Biederman 390a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 391ad5d20a6SPatrick McHardy 392f9ac30f0SEric Biederman macvlan_hash_change_addr(vlan, addr->sa_data); 393f9ac30f0SEric Biederman } 394ad5d20a6SPatrick McHardy return 0; 395ad5d20a6SPatrick McHardy } 396ad5d20a6SPatrick McHardy 397b863ceb7SPatrick McHardy static void macvlan_change_rx_flags(struct net_device *dev, int change) 398b863ceb7SPatrick McHardy { 399b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 400b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 401b863ceb7SPatrick McHardy 402b863ceb7SPatrick McHardy if (change & IFF_ALLMULTI) 403b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); 404b863ceb7SPatrick McHardy } 405b863ceb7SPatrick McHardy 406*df8ef8f3SJohn Fastabend static void macvlan_set_mac_lists(struct net_device *dev) 407b863ceb7SPatrick McHardy { 408b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 409b863ceb7SPatrick McHardy 410*df8ef8f3SJohn Fastabend dev_uc_sync(vlan->lowerdev, dev); 411b863ceb7SPatrick McHardy dev_mc_sync(vlan->lowerdev, dev); 412b863ceb7SPatrick McHardy } 413b863ceb7SPatrick McHardy 414b863ceb7SPatrick McHardy static int macvlan_change_mtu(struct net_device *dev, int new_mtu) 415b863ceb7SPatrick McHardy { 416b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 417b863ceb7SPatrick McHardy 418b863ceb7SPatrick McHardy if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu) 419b863ceb7SPatrick McHardy return -EINVAL; 420b863ceb7SPatrick McHardy dev->mtu = new_mtu; 421b863ceb7SPatrick McHardy return 0; 422b863ceb7SPatrick McHardy } 423b863ceb7SPatrick McHardy 424b863ceb7SPatrick McHardy /* 425b863ceb7SPatrick McHardy * macvlan network devices have devices nesting below it and are a special 426b863ceb7SPatrick McHardy * "super class" of normal network devices; split their locks off into a 427b863ceb7SPatrick McHardy * separate class since they always nest. 428b863ceb7SPatrick McHardy */ 429b863ceb7SPatrick McHardy static struct lock_class_key macvlan_netdev_xmit_lock_key; 430cf508b12SDavid S. Miller static struct lock_class_key macvlan_netdev_addr_lock_key; 431b863ceb7SPatrick McHardy 432b863ceb7SPatrick McHardy #define MACVLAN_FEATURES \ 433b863ceb7SPatrick McHardy (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \ 434b863ceb7SPatrick McHardy NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \ 4358d13e670SJohn Fastabend NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \ 4368d13e670SJohn Fastabend NETIF_F_HW_VLAN_FILTER) 437b863ceb7SPatrick McHardy 438b863ceb7SPatrick McHardy #define MACVLAN_STATE_MASK \ 439b863ceb7SPatrick McHardy ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) 440b863ceb7SPatrick McHardy 441e8a0464cSDavid S. Miller static void macvlan_set_lockdep_class_one(struct net_device *dev, 442e8a0464cSDavid S. Miller struct netdev_queue *txq, 443e8a0464cSDavid S. Miller void *_unused) 444c773e847SDavid S. Miller { 445c773e847SDavid S. Miller lockdep_set_class(&txq->_xmit_lock, 446c773e847SDavid S. Miller &macvlan_netdev_xmit_lock_key); 447c773e847SDavid S. Miller } 448c773e847SDavid S. Miller 449c773e847SDavid S. Miller static void macvlan_set_lockdep_class(struct net_device *dev) 450c773e847SDavid S. Miller { 451cf508b12SDavid S. Miller lockdep_set_class(&dev->addr_list_lock, 452cf508b12SDavid S. Miller &macvlan_netdev_addr_lock_key); 453e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL); 454c773e847SDavid S. Miller } 455c773e847SDavid S. Miller 456b863ceb7SPatrick McHardy static int macvlan_init(struct net_device *dev) 457b863ceb7SPatrick McHardy { 458b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 459b863ceb7SPatrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 460b863ceb7SPatrick McHardy 461b863ceb7SPatrick McHardy dev->state = (dev->state & ~MACVLAN_STATE_MASK) | 462b863ceb7SPatrick McHardy (lowerdev->state & MACVLAN_STATE_MASK); 463b863ceb7SPatrick McHardy dev->features = lowerdev->features & MACVLAN_FEATURES; 4648ffab51bSEric Dumazet dev->features |= NETIF_F_LLTX; 4658c2acc53SPatrick McHardy dev->gso_max_size = lowerdev->gso_max_size; 466b863ceb7SPatrick McHardy dev->iflink = lowerdev->ifindex; 467ef5c8996Ssg.tweak@gmail.com dev->hard_header_len = lowerdev->hard_header_len; 468b863ceb7SPatrick McHardy 469c773e847SDavid S. Miller macvlan_set_lockdep_class(dev); 470c773e847SDavid S. Miller 4718ffab51bSEric Dumazet vlan->pcpu_stats = alloc_percpu(struct macvlan_pcpu_stats); 4728ffab51bSEric Dumazet if (!vlan->pcpu_stats) 473fccaf710SEric Dumazet return -ENOMEM; 474fccaf710SEric Dumazet 475b863ceb7SPatrick McHardy return 0; 476b863ceb7SPatrick McHardy } 477b863ceb7SPatrick McHardy 478fccaf710SEric Dumazet static void macvlan_uninit(struct net_device *dev) 479fccaf710SEric Dumazet { 480fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 481d5cd9244SEric W. Biederman struct macvlan_port *port = vlan->port; 482fccaf710SEric Dumazet 4838ffab51bSEric Dumazet free_percpu(vlan->pcpu_stats); 484d5cd9244SEric W. Biederman 485d5cd9244SEric W. Biederman port->count -= 1; 486d5cd9244SEric W. Biederman if (!port->count) 487d5cd9244SEric W. Biederman macvlan_port_destroy(port->dev); 488fccaf710SEric Dumazet } 489fccaf710SEric Dumazet 49028172739SEric Dumazet static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev, 49128172739SEric Dumazet struct rtnl_link_stats64 *stats) 492fccaf710SEric Dumazet { 493fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 494fccaf710SEric Dumazet 4958ffab51bSEric Dumazet if (vlan->pcpu_stats) { 4968ffab51bSEric Dumazet struct macvlan_pcpu_stats *p; 4978ffab51bSEric Dumazet u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes; 4988ffab51bSEric Dumazet u32 rx_errors = 0, tx_dropped = 0; 499bc66154eSEric Dumazet unsigned int start; 500fccaf710SEric Dumazet int i; 501fccaf710SEric Dumazet 502fccaf710SEric Dumazet for_each_possible_cpu(i) { 5038ffab51bSEric Dumazet p = per_cpu_ptr(vlan->pcpu_stats, i); 504bc66154eSEric Dumazet do { 505bc66154eSEric Dumazet start = u64_stats_fetch_begin_bh(&p->syncp); 506bc66154eSEric Dumazet rx_packets = p->rx_packets; 507bc66154eSEric Dumazet rx_bytes = p->rx_bytes; 508bc66154eSEric Dumazet rx_multicast = p->rx_multicast; 5098ffab51bSEric Dumazet tx_packets = p->tx_packets; 5108ffab51bSEric Dumazet tx_bytes = p->tx_bytes; 511bc66154eSEric Dumazet } while (u64_stats_fetch_retry_bh(&p->syncp, start)); 5128ffab51bSEric Dumazet 5138ffab51bSEric Dumazet stats->rx_packets += rx_packets; 5148ffab51bSEric Dumazet stats->rx_bytes += rx_bytes; 5158ffab51bSEric Dumazet stats->multicast += rx_multicast; 5168ffab51bSEric Dumazet stats->tx_packets += tx_packets; 5178ffab51bSEric Dumazet stats->tx_bytes += tx_bytes; 5188ffab51bSEric Dumazet /* rx_errors & tx_dropped are u32, updated 5198ffab51bSEric Dumazet * without syncp protection. 5208ffab51bSEric Dumazet */ 5218ffab51bSEric Dumazet rx_errors += p->rx_errors; 5228ffab51bSEric Dumazet tx_dropped += p->tx_dropped; 523fccaf710SEric Dumazet } 5248ffab51bSEric Dumazet stats->rx_errors = rx_errors; 5258ffab51bSEric Dumazet stats->rx_dropped = rx_errors; 5268ffab51bSEric Dumazet stats->tx_dropped = tx_dropped; 527fccaf710SEric Dumazet } 528fccaf710SEric Dumazet return stats; 529fccaf710SEric Dumazet } 530fccaf710SEric Dumazet 5318e586137SJiri Pirko static int macvlan_vlan_rx_add_vid(struct net_device *dev, 5328d13e670SJohn Fastabend unsigned short vid) 5338d13e670SJohn Fastabend { 5348d13e670SJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 5358d13e670SJohn Fastabend struct net_device *lowerdev = vlan->lowerdev; 5368d13e670SJohn Fastabend 53787002b03SJiri Pirko return vlan_vid_add(lowerdev, vid); 5388d13e670SJohn Fastabend } 5398d13e670SJohn Fastabend 5408e586137SJiri Pirko static int macvlan_vlan_rx_kill_vid(struct net_device *dev, 5418d13e670SJohn Fastabend unsigned short vid) 5428d13e670SJohn Fastabend { 5438d13e670SJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 5448d13e670SJohn Fastabend struct net_device *lowerdev = vlan->lowerdev; 5458d13e670SJohn Fastabend 54687002b03SJiri Pirko vlan_vid_del(lowerdev, vid); 5478e586137SJiri Pirko return 0; 5488d13e670SJohn Fastabend } 5498d13e670SJohn Fastabend 550*df8ef8f3SJohn Fastabend static int macvlan_fdb_add(struct ndmsg *ndm, 551*df8ef8f3SJohn Fastabend struct net_device *dev, 552*df8ef8f3SJohn Fastabend unsigned char *addr, 553*df8ef8f3SJohn Fastabend u16 flags) 554*df8ef8f3SJohn Fastabend { 555*df8ef8f3SJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 556*df8ef8f3SJohn Fastabend int err = -EINVAL; 557*df8ef8f3SJohn Fastabend 558*df8ef8f3SJohn Fastabend if (!vlan->port->passthru) 559*df8ef8f3SJohn Fastabend return -EOPNOTSUPP; 560*df8ef8f3SJohn Fastabend 561*df8ef8f3SJohn Fastabend if (is_unicast_ether_addr(addr)) 562*df8ef8f3SJohn Fastabend err = dev_uc_add_excl(dev, addr); 563*df8ef8f3SJohn Fastabend else if (is_multicast_ether_addr(addr)) 564*df8ef8f3SJohn Fastabend err = dev_mc_add_excl(dev, addr); 565*df8ef8f3SJohn Fastabend 566*df8ef8f3SJohn Fastabend return err; 567*df8ef8f3SJohn Fastabend } 568*df8ef8f3SJohn Fastabend 569*df8ef8f3SJohn Fastabend static int macvlan_fdb_del(struct ndmsg *ndm, 570*df8ef8f3SJohn Fastabend struct net_device *dev, 571*df8ef8f3SJohn Fastabend unsigned char *addr) 572*df8ef8f3SJohn Fastabend { 573*df8ef8f3SJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 574*df8ef8f3SJohn Fastabend int err = -EINVAL; 575*df8ef8f3SJohn Fastabend 576*df8ef8f3SJohn Fastabend if (!vlan->port->passthru) 577*df8ef8f3SJohn Fastabend return -EOPNOTSUPP; 578*df8ef8f3SJohn Fastabend 579*df8ef8f3SJohn Fastabend if (is_unicast_ether_addr(addr)) 580*df8ef8f3SJohn Fastabend err = dev_uc_del(dev, addr); 581*df8ef8f3SJohn Fastabend else if (is_multicast_ether_addr(addr)) 582*df8ef8f3SJohn Fastabend err = dev_mc_del(dev, addr); 583*df8ef8f3SJohn Fastabend 584*df8ef8f3SJohn Fastabend return err; 585*df8ef8f3SJohn Fastabend } 586*df8ef8f3SJohn Fastabend 587b863ceb7SPatrick McHardy static void macvlan_ethtool_get_drvinfo(struct net_device *dev, 588b863ceb7SPatrick McHardy struct ethtool_drvinfo *drvinfo) 589b863ceb7SPatrick McHardy { 590b863ceb7SPatrick McHardy snprintf(drvinfo->driver, 32, "macvlan"); 591b863ceb7SPatrick McHardy snprintf(drvinfo->version, 32, "0.1"); 592b863ceb7SPatrick McHardy } 593b863ceb7SPatrick McHardy 5949edb8bb6SStephen Hemminger static int macvlan_ethtool_get_settings(struct net_device *dev, 5959edb8bb6SStephen Hemminger struct ethtool_cmd *cmd) 5969edb8bb6SStephen Hemminger { 5979edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 5984bc71cb9SJiri Pirko 5994bc71cb9SJiri Pirko return __ethtool_get_settings(vlan->lowerdev, cmd); 6009edb8bb6SStephen Hemminger } 6019edb8bb6SStephen Hemminger 602b863ceb7SPatrick McHardy static const struct ethtool_ops macvlan_ethtool_ops = { 603b863ceb7SPatrick McHardy .get_link = ethtool_op_get_link, 6049edb8bb6SStephen Hemminger .get_settings = macvlan_ethtool_get_settings, 605b863ceb7SPatrick McHardy .get_drvinfo = macvlan_ethtool_get_drvinfo, 606b863ceb7SPatrick McHardy }; 607b863ceb7SPatrick McHardy 60854a30c97SStephen Hemminger static const struct net_device_ops macvlan_netdev_ops = { 60954a30c97SStephen Hemminger .ndo_init = macvlan_init, 610fccaf710SEric Dumazet .ndo_uninit = macvlan_uninit, 61154a30c97SStephen Hemminger .ndo_open = macvlan_open, 61254a30c97SStephen Hemminger .ndo_stop = macvlan_stop, 61300829823SStephen Hemminger .ndo_start_xmit = macvlan_start_xmit, 61454a30c97SStephen Hemminger .ndo_change_mtu = macvlan_change_mtu, 61554a30c97SStephen Hemminger .ndo_change_rx_flags = macvlan_change_rx_flags, 61654a30c97SStephen Hemminger .ndo_set_mac_address = macvlan_set_mac_address, 617*df8ef8f3SJohn Fastabend .ndo_set_rx_mode = macvlan_set_mac_lists, 618bc66154eSEric Dumazet .ndo_get_stats64 = macvlan_dev_get_stats64, 61954a30c97SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 6208d13e670SJohn Fastabend .ndo_vlan_rx_add_vid = macvlan_vlan_rx_add_vid, 6218d13e670SJohn Fastabend .ndo_vlan_rx_kill_vid = macvlan_vlan_rx_kill_vid, 622*df8ef8f3SJohn Fastabend .ndo_fdb_add = macvlan_fdb_add, 623*df8ef8f3SJohn Fastabend .ndo_fdb_del = macvlan_fdb_del, 624*df8ef8f3SJohn Fastabend .ndo_fdb_dump = ndo_dflt_fdb_dump, 62554a30c97SStephen Hemminger }; 62654a30c97SStephen Hemminger 6278a35747aSHerbert Xu void macvlan_common_setup(struct net_device *dev) 628b863ceb7SPatrick McHardy { 629b863ceb7SPatrick McHardy ether_setup(dev); 630b863ceb7SPatrick McHardy 631550fd08cSNeil Horman dev->priv_flags &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING); 63254a30c97SStephen Hemminger dev->netdev_ops = &macvlan_netdev_ops; 633b863ceb7SPatrick McHardy dev->destructor = free_netdev; 6343b04dddeSStephen Hemminger dev->header_ops = &macvlan_hard_header_ops, 635b863ceb7SPatrick McHardy dev->ethtool_ops = &macvlan_ethtool_ops; 6368a35747aSHerbert Xu } 6378a35747aSHerbert Xu EXPORT_SYMBOL_GPL(macvlan_common_setup); 6388a35747aSHerbert Xu 6398a35747aSHerbert Xu static void macvlan_setup(struct net_device *dev) 6408a35747aSHerbert Xu { 6418a35747aSHerbert Xu macvlan_common_setup(dev); 642b863ceb7SPatrick McHardy dev->tx_queue_len = 0; 643b863ceb7SPatrick McHardy } 644b863ceb7SPatrick McHardy 645b863ceb7SPatrick McHardy static int macvlan_port_create(struct net_device *dev) 646b863ceb7SPatrick McHardy { 647b863ceb7SPatrick McHardy struct macvlan_port *port; 648b863ceb7SPatrick McHardy unsigned int i; 649ab95bfe0SJiri Pirko int err; 650b863ceb7SPatrick McHardy 651b863ceb7SPatrick McHardy if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) 652b863ceb7SPatrick McHardy return -EINVAL; 653b863ceb7SPatrick McHardy 654b863ceb7SPatrick McHardy port = kzalloc(sizeof(*port), GFP_KERNEL); 655b863ceb7SPatrick McHardy if (port == NULL) 656b863ceb7SPatrick McHardy return -ENOMEM; 657b863ceb7SPatrick McHardy 658eb06acdcSSridhar Samudrala port->passthru = false; 659b863ceb7SPatrick McHardy port->dev = dev; 660b863ceb7SPatrick McHardy INIT_LIST_HEAD(&port->vlans); 661b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) 662b863ceb7SPatrick McHardy INIT_HLIST_HEAD(&port->vlan_hash[i]); 663ab95bfe0SJiri Pirko 664a35e2c1bSJiri Pirko err = netdev_rx_handler_register(dev, macvlan_handle_frame, port); 665a35e2c1bSJiri Pirko if (err) 666ab95bfe0SJiri Pirko kfree(port); 667d9351561SEric Dumazet else 668a35e2c1bSJiri Pirko dev->priv_flags |= IFF_MACVLAN_PORT; 669ab95bfe0SJiri Pirko return err; 670b863ceb7SPatrick McHardy } 671b863ceb7SPatrick McHardy 672b863ceb7SPatrick McHardy static void macvlan_port_destroy(struct net_device *dev) 673b863ceb7SPatrick McHardy { 674a35e2c1bSJiri Pirko struct macvlan_port *port = macvlan_port_get(dev); 675b863ceb7SPatrick McHardy 676a35e2c1bSJiri Pirko dev->priv_flags &= ~IFF_MACVLAN_PORT; 677ab95bfe0SJiri Pirko netdev_rx_handler_unregister(dev); 6786e070aecSLai Jiangshan kfree_rcu(port, rcu); 679b863ceb7SPatrick McHardy } 680b863ceb7SPatrick McHardy 681b863ceb7SPatrick McHardy static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) 682b863ceb7SPatrick McHardy { 683b863ceb7SPatrick McHardy if (tb[IFLA_ADDRESS]) { 684b863ceb7SPatrick McHardy if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) 685b863ceb7SPatrick McHardy return -EINVAL; 686b863ceb7SPatrick McHardy if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) 687b863ceb7SPatrick McHardy return -EADDRNOTAVAIL; 688b863ceb7SPatrick McHardy } 68927c0b1a8SArnd Bergmann 69027c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) { 69127c0b1a8SArnd Bergmann switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) { 69227c0b1a8SArnd Bergmann case MACVLAN_MODE_PRIVATE: 69327c0b1a8SArnd Bergmann case MACVLAN_MODE_VEPA: 69427c0b1a8SArnd Bergmann case MACVLAN_MODE_BRIDGE: 695eb06acdcSSridhar Samudrala case MACVLAN_MODE_PASSTHRU: 69627c0b1a8SArnd Bergmann break; 69727c0b1a8SArnd Bergmann default: 69827c0b1a8SArnd Bergmann return -EINVAL; 69927c0b1a8SArnd Bergmann } 70027c0b1a8SArnd Bergmann } 701b863ceb7SPatrick McHardy return 0; 702b863ceb7SPatrick McHardy } 703b863ceb7SPatrick McHardy 704fc0663d6SArnd Bergmann int macvlan_common_newlink(struct net *src_net, struct net_device *dev, 705fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[], 706fc0663d6SArnd Bergmann int (*receive)(struct sk_buff *skb), 707fc0663d6SArnd Bergmann int (*forward)(struct net_device *dev, 708fc0663d6SArnd Bergmann struct sk_buff *skb)) 709b863ceb7SPatrick McHardy { 710b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 711b863ceb7SPatrick McHardy struct macvlan_port *port; 712b863ceb7SPatrick McHardy struct net_device *lowerdev; 713b863ceb7SPatrick McHardy int err; 714b863ceb7SPatrick McHardy 715b863ceb7SPatrick McHardy if (!tb[IFLA_LINK]) 716b863ceb7SPatrick McHardy return -EINVAL; 717b863ceb7SPatrick McHardy 71881adee47SEric W. Biederman lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK])); 719b863ceb7SPatrick McHardy if (lowerdev == NULL) 720b863ceb7SPatrick McHardy return -ENODEV; 721b863ceb7SPatrick McHardy 722b0832a29SEric Biederman /* When creating macvlans on top of other macvlans - use 723b0832a29SEric Biederman * the real device as the lowerdev. 724a6ca5f1dSPatrick McHardy */ 725b0832a29SEric Biederman if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) { 726b0832a29SEric Biederman struct macvlan_dev *lowervlan = netdev_priv(lowerdev); 727b0832a29SEric Biederman lowerdev = lowervlan->lowerdev; 728b0832a29SEric Biederman } 729a6ca5f1dSPatrick McHardy 730b863ceb7SPatrick McHardy if (!tb[IFLA_MTU]) 731b863ceb7SPatrick McHardy dev->mtu = lowerdev->mtu; 732b863ceb7SPatrick McHardy else if (dev->mtu > lowerdev->mtu) 733b863ceb7SPatrick McHardy return -EINVAL; 734b863ceb7SPatrick McHardy 735b863ceb7SPatrick McHardy if (!tb[IFLA_ADDRESS]) 7367ce5d222SDanny Kukawka eth_hw_addr_random(dev); 737b863ceb7SPatrick McHardy 738a35e2c1bSJiri Pirko if (!macvlan_port_exists(lowerdev)) { 739b863ceb7SPatrick McHardy err = macvlan_port_create(lowerdev); 740b863ceb7SPatrick McHardy if (err < 0) 741b863ceb7SPatrick McHardy return err; 742b863ceb7SPatrick McHardy } 743a35e2c1bSJiri Pirko port = macvlan_port_get(lowerdev); 744b863ceb7SPatrick McHardy 745eb06acdcSSridhar Samudrala /* Only 1 macvlan device can be created in passthru mode */ 746eb06acdcSSridhar Samudrala if (port->passthru) 747eb06acdcSSridhar Samudrala return -EINVAL; 748eb06acdcSSridhar Samudrala 749b863ceb7SPatrick McHardy vlan->lowerdev = lowerdev; 750b863ceb7SPatrick McHardy vlan->dev = dev; 751b863ceb7SPatrick McHardy vlan->port = port; 752fc0663d6SArnd Bergmann vlan->receive = receive; 753fc0663d6SArnd Bergmann vlan->forward = forward; 754b863ceb7SPatrick McHardy 75527c0b1a8SArnd Bergmann vlan->mode = MACVLAN_MODE_VEPA; 75627c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 75727c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 75827c0b1a8SArnd Bergmann 759*df8ef8f3SJohn Fastabend if (data && data[IFLA_MACVLAN_FLAGS]) 760*df8ef8f3SJohn Fastabend vlan->flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); 761*df8ef8f3SJohn Fastabend 762eb06acdcSSridhar Samudrala if (vlan->mode == MACVLAN_MODE_PASSTHRU) { 763d5cd9244SEric W. Biederman if (port->count) 764eb06acdcSSridhar Samudrala return -EINVAL; 765eb06acdcSSridhar Samudrala port->passthru = true; 766eb06acdcSSridhar Samudrala memcpy(dev->dev_addr, lowerdev->dev_addr, ETH_ALEN); 767eb06acdcSSridhar Samudrala } 768eb06acdcSSridhar Samudrala 769d5cd9244SEric W. Biederman port->count += 1; 770b863ceb7SPatrick McHardy err = register_netdevice(dev); 771b863ceb7SPatrick McHardy if (err < 0) 772f16d3d57SJiri Pirko goto destroy_port; 773b863ceb7SPatrick McHardy 774b863ceb7SPatrick McHardy list_add_tail(&vlan->list, &port->vlans); 775fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(lowerdev, dev); 776f16d3d57SJiri Pirko 777b863ceb7SPatrick McHardy return 0; 778f16d3d57SJiri Pirko 779f16d3d57SJiri Pirko destroy_port: 780d5cd9244SEric W. Biederman port->count -= 1; 781d5cd9244SEric W. Biederman if (!port->count) 782f16d3d57SJiri Pirko macvlan_port_destroy(lowerdev); 783f16d3d57SJiri Pirko 784f16d3d57SJiri Pirko return err; 785b863ceb7SPatrick McHardy } 786fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_common_newlink); 787b863ceb7SPatrick McHardy 788fc0663d6SArnd Bergmann static int macvlan_newlink(struct net *src_net, struct net_device *dev, 789fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 790fc0663d6SArnd Bergmann { 791fc0663d6SArnd Bergmann return macvlan_common_newlink(src_net, dev, tb, data, 792fc0663d6SArnd Bergmann netif_rx, 793fc0663d6SArnd Bergmann dev_forward_skb); 794fc0663d6SArnd Bergmann } 795fc0663d6SArnd Bergmann 796fc0663d6SArnd Bergmann void macvlan_dellink(struct net_device *dev, struct list_head *head) 797b863ceb7SPatrick McHardy { 798b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 799b863ceb7SPatrick McHardy 800b863ceb7SPatrick McHardy list_del(&vlan->list); 80123289a37SEric Dumazet unregister_netdevice_queue(dev, head); 802b863ceb7SPatrick McHardy } 803fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_dellink); 804b863ceb7SPatrick McHardy 80527c0b1a8SArnd Bergmann static int macvlan_changelink(struct net_device *dev, 80627c0b1a8SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 80727c0b1a8SArnd Bergmann { 80827c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 80927c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 81027c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 811*df8ef8f3SJohn Fastabend if (data && data[IFLA_MACVLAN_FLAGS]) { 812*df8ef8f3SJohn Fastabend __u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); 813*df8ef8f3SJohn Fastabend bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC; 814*df8ef8f3SJohn Fastabend 815*df8ef8f3SJohn Fastabend if (promisc && (flags & MACVLAN_FLAG_NOPROMISC)) 816*df8ef8f3SJohn Fastabend dev_set_promiscuity(vlan->lowerdev, -1); 817*df8ef8f3SJohn Fastabend else if (promisc && !(flags & MACVLAN_FLAG_NOPROMISC)) 818*df8ef8f3SJohn Fastabend dev_set_promiscuity(vlan->lowerdev, 1); 819*df8ef8f3SJohn Fastabend vlan->flags = flags; 820*df8ef8f3SJohn Fastabend } 82127c0b1a8SArnd Bergmann return 0; 82227c0b1a8SArnd Bergmann } 82327c0b1a8SArnd Bergmann 82427c0b1a8SArnd Bergmann static size_t macvlan_get_size(const struct net_device *dev) 82527c0b1a8SArnd Bergmann { 82627c0b1a8SArnd Bergmann return nla_total_size(4); 82727c0b1a8SArnd Bergmann } 82827c0b1a8SArnd Bergmann 82927c0b1a8SArnd Bergmann static int macvlan_fill_info(struct sk_buff *skb, 83027c0b1a8SArnd Bergmann const struct net_device *dev) 83127c0b1a8SArnd Bergmann { 83227c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 83327c0b1a8SArnd Bergmann 834ead9a76cSDavid S. Miller if (nla_put_u32(skb, IFLA_MACVLAN_MODE, vlan->mode)) 835ead9a76cSDavid S. Miller goto nla_put_failure; 836*df8ef8f3SJohn Fastabend if (nla_put_u16(skb, IFLA_MACVLAN_FLAGS, vlan->flags)) 837*df8ef8f3SJohn Fastabend goto nla_put_failure; 83827c0b1a8SArnd Bergmann return 0; 83927c0b1a8SArnd Bergmann 84027c0b1a8SArnd Bergmann nla_put_failure: 84127c0b1a8SArnd Bergmann return -EMSGSIZE; 84227c0b1a8SArnd Bergmann } 84327c0b1a8SArnd Bergmann 84427c0b1a8SArnd Bergmann static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = { 84527c0b1a8SArnd Bergmann [IFLA_MACVLAN_MODE] = { .type = NLA_U32 }, 846*df8ef8f3SJohn Fastabend [IFLA_MACVLAN_FLAGS] = { .type = NLA_U16 }, 84727c0b1a8SArnd Bergmann }; 84827c0b1a8SArnd Bergmann 849fc0663d6SArnd Bergmann int macvlan_link_register(struct rtnl_link_ops *ops) 850fc0663d6SArnd Bergmann { 851fc0663d6SArnd Bergmann /* common fields */ 852fc0663d6SArnd Bergmann ops->priv_size = sizeof(struct macvlan_dev); 853fc0663d6SArnd Bergmann ops->validate = macvlan_validate; 854fc0663d6SArnd Bergmann ops->maxtype = IFLA_MACVLAN_MAX; 855fc0663d6SArnd Bergmann ops->policy = macvlan_policy; 856fc0663d6SArnd Bergmann ops->changelink = macvlan_changelink; 857fc0663d6SArnd Bergmann ops->get_size = macvlan_get_size; 858fc0663d6SArnd Bergmann ops->fill_info = macvlan_fill_info; 859fc0663d6SArnd Bergmann 860fc0663d6SArnd Bergmann return rtnl_link_register(ops); 861fc0663d6SArnd Bergmann }; 862fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_link_register); 863fc0663d6SArnd Bergmann 864fc0663d6SArnd Bergmann static struct rtnl_link_ops macvlan_link_ops = { 865b863ceb7SPatrick McHardy .kind = "macvlan", 8668a35747aSHerbert Xu .setup = macvlan_setup, 867b863ceb7SPatrick McHardy .newlink = macvlan_newlink, 868b863ceb7SPatrick McHardy .dellink = macvlan_dellink, 869b863ceb7SPatrick McHardy }; 870b863ceb7SPatrick McHardy 871b863ceb7SPatrick McHardy static int macvlan_device_event(struct notifier_block *unused, 872b863ceb7SPatrick McHardy unsigned long event, void *ptr) 873b863ceb7SPatrick McHardy { 874b863ceb7SPatrick McHardy struct net_device *dev = ptr; 875b863ceb7SPatrick McHardy struct macvlan_dev *vlan, *next; 876b863ceb7SPatrick McHardy struct macvlan_port *port; 877226bd341SEric Dumazet LIST_HEAD(list_kill); 878b863ceb7SPatrick McHardy 879a35e2c1bSJiri Pirko if (!macvlan_port_exists(dev)) 880b863ceb7SPatrick McHardy return NOTIFY_DONE; 881b863ceb7SPatrick McHardy 882a35e2c1bSJiri Pirko port = macvlan_port_get(dev); 883a35e2c1bSJiri Pirko 884b863ceb7SPatrick McHardy switch (event) { 885b863ceb7SPatrick McHardy case NETDEV_CHANGE: 886b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) 887fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(vlan->lowerdev, 888fc4a7489SPatrick Mullaney vlan->dev); 889b863ceb7SPatrick McHardy break; 890b863ceb7SPatrick McHardy case NETDEV_FEAT_CHANGE: 891b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) { 892b863ceb7SPatrick McHardy vlan->dev->features = dev->features & MACVLAN_FEATURES; 8938c2acc53SPatrick McHardy vlan->dev->gso_max_size = dev->gso_max_size; 894b863ceb7SPatrick McHardy netdev_features_change(vlan->dev); 895b863ceb7SPatrick McHardy } 896b863ceb7SPatrick McHardy break; 897b863ceb7SPatrick McHardy case NETDEV_UNREGISTER: 8983b27e105SDavid Lamparter /* twiddle thumbs on netns device moves */ 8993b27e105SDavid Lamparter if (dev->reg_state != NETREG_UNREGISTERING) 9003b27e105SDavid Lamparter break; 9013b27e105SDavid Lamparter 902b863ceb7SPatrick McHardy list_for_each_entry_safe(vlan, next, &port->vlans, list) 903226bd341SEric Dumazet vlan->dev->rtnl_link_ops->dellink(vlan->dev, &list_kill); 904226bd341SEric Dumazet unregister_netdevice_many(&list_kill); 905226bd341SEric Dumazet list_del(&list_kill); 906b863ceb7SPatrick McHardy break; 9071c01fe14SJiri Pirko case NETDEV_PRE_TYPE_CHANGE: 9081c01fe14SJiri Pirko /* Forbid underlaying device to change its type. */ 9091c01fe14SJiri Pirko return NOTIFY_BAD; 910b863ceb7SPatrick McHardy } 911b863ceb7SPatrick McHardy return NOTIFY_DONE; 912b863ceb7SPatrick McHardy } 913b863ceb7SPatrick McHardy 914b863ceb7SPatrick McHardy static struct notifier_block macvlan_notifier_block __read_mostly = { 915b863ceb7SPatrick McHardy .notifier_call = macvlan_device_event, 916b863ceb7SPatrick McHardy }; 917b863ceb7SPatrick McHardy 918b863ceb7SPatrick McHardy static int __init macvlan_init_module(void) 919b863ceb7SPatrick McHardy { 920b863ceb7SPatrick McHardy int err; 921b863ceb7SPatrick McHardy 922b863ceb7SPatrick McHardy register_netdevice_notifier(&macvlan_notifier_block); 923b863ceb7SPatrick McHardy 924fc0663d6SArnd Bergmann err = macvlan_link_register(&macvlan_link_ops); 925b863ceb7SPatrick McHardy if (err < 0) 926b863ceb7SPatrick McHardy goto err1; 927b863ceb7SPatrick McHardy return 0; 928b863ceb7SPatrick McHardy err1: 929b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 930b863ceb7SPatrick McHardy return err; 931b863ceb7SPatrick McHardy } 932b863ceb7SPatrick McHardy 933b863ceb7SPatrick McHardy static void __exit macvlan_cleanup_module(void) 934b863ceb7SPatrick McHardy { 935b863ceb7SPatrick McHardy rtnl_link_unregister(&macvlan_link_ops); 936b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 937b863ceb7SPatrick McHardy } 938b863ceb7SPatrick McHardy 939b863ceb7SPatrick McHardy module_init(macvlan_init_module); 940b863ceb7SPatrick McHardy module_exit(macvlan_cleanup_module); 941b863ceb7SPatrick McHardy 942b863ceb7SPatrick McHardy MODULE_LICENSE("GPL"); 943b863ceb7SPatrick McHardy MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); 944b863ceb7SPatrick McHardy MODULE_DESCRIPTION("Driver for MAC address based VLANs"); 945b863ceb7SPatrick McHardy MODULE_ALIAS_RTNL_LINK("macvlan"); 946