1b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy/* 2b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * Copyright (c) 2007 Patrick McHardy <kaber@trash.net> 3b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * 4b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * This program is free software; you can redistribute it and/or 5b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * modify it under the terms of the GNU General Public License as 6b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * published by the Free Software Foundation; either version 2 of 7b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * the License, or (at your option) any later version. 8b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * 9b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * The code this is based on carried the following copyright notice: 10b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * --- 11b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * (C) Copyright 2001-2006 12b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com 13b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * Re-worked by Ben Greear <greearb@candelatech.com> 14b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * --- 15b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy */ 16b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/kernel.h> 17b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/types.h> 18b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/module.h> 19b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/init.h> 20b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/errno.h> 21b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/slab.h> 22b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/string.h> 2382524746c27fa418c250a56dd7606b9d3fc79826Franck Bui-Huu#include <linux/rculist.h> 24b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/notifier.h> 25b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/netdevice.h> 26b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/etherdevice.h> 27b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/ethtool.h> 28b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/if_arp.h> 2987002b03baabd2b8f6281ab6411ed88d24958de1Jiri Pirko#include <linux/if_vlan.h> 30b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/if_link.h> 31b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/if_macvlan.h> 32cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet#include <linux/hash.h> 33412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu#include <linux/workqueue.h> 34b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <net/rtnetlink.h> 35618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann#include <net/xfrm.h> 36688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#include <linux/netpoll.h> 37b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 3879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun#define MACVLAN_HASH_BITS 8 3979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun#define MACVLAN_HASH_SIZE (1<<MACVLAN_HASH_BITS) 4007d92d5cc977a7fe1e683e1d4a6f723f7f2778cbNicolas Dichtel#define MACVLAN_BC_QUEUE_LEN 1000 41b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 42b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystruct macvlan_port { 43b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *dev; 44b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct hlist_head vlan_hash[MACVLAN_HASH_SIZE]; 45b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct list_head vlans; 468b37ef0a1f6c2401fea3536facfa21191936bd6cJiri Pirko struct rcu_head rcu; 47412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct sk_buff_head bc_queue; 48412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct work_struct bc_work; 49eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala bool passthru; 505e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller int count; 5179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_head vlan_source_hash[MACVLAN_HASH_SIZE]; 5279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun}; 5379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 5479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstruct macvlan_source_entry { 5579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_node hlist; 5679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_dev *vlan; 5779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun unsigned char addr[6+2] __aligned(sizeof(u16)); 5879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct rcu_head rcu; 59b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}; 60b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 61412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xustruct macvlan_skb_cb { 62412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu const struct macvlan_dev *src; 63412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu}; 64412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 65412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu#define MACVLAN_SKB_CB(__skb) ((struct macvlan_skb_cb *)&((__skb)->cb[0])) 66412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 67d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biedermanstatic void macvlan_port_destroy(struct net_device *dev); 68d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman 6979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun/* Hash Ethernet address */ 7079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic u32 macvlan_eth_hash(const unsigned char *addr) 7179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 7279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun u64 value = get_unaligned((u64 *)addr); 7379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 7479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun /* only want 6 bytes */ 7579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun#ifdef __BIG_ENDIAN 7679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun value >>= 16; 7779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun#else 7879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun value <<= 16; 7979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun#endif 8079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return hash_64(value, MACVLAN_HASH_BITS); 8179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 8279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 83e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazetstatic struct macvlan_port *macvlan_port_get_rcu(const struct net_device *dev) 84e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet{ 85e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet return rcu_dereference(dev->rx_handler_data); 86e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet} 87e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet 88e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazetstatic struct macvlan_port *macvlan_port_get_rtnl(const struct net_device *dev) 89e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet{ 90e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet return rtnl_dereference(dev->rx_handler_data); 91e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet} 92e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet 93a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko#define macvlan_port_exists(dev) (dev->priv_flags & IFF_MACVLAN_PORT) 94a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko 95b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port, 96b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy const unsigned char *addr) 97b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 98b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan; 9979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun u32 idx = macvlan_eth_hash(addr); 100b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 10179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_for_each_entry_rcu(vlan, &port->vlan_hash[idx], hlist) { 102a6700db17980972199e61c06be535a79e1b0b4e6Joe Perches if (ether_addr_equal_64bits(vlan->dev->dev_addr, addr)) 103b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return vlan; 104b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 105b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return NULL; 106b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 107b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 10879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic struct macvlan_source_entry *macvlan_hash_lookup_source( 10979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const struct macvlan_dev *vlan, 11079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const unsigned char *addr) 11179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 11279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 11379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun u32 idx = macvlan_eth_hash(addr); 11479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_head *h = &vlan->port->vlan_source_hash[idx]; 11579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 11679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_for_each_entry_rcu(entry, h, hlist) { 11779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (ether_addr_equal_64bits(entry->addr, addr) && 11879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry->vlan == vlan) 11979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return entry; 12079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 12179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return NULL; 12279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 12379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 12479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic int macvlan_hash_add_source(struct macvlan_dev *vlan, 12579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const unsigned char *addr) 12679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 12779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_port *port = vlan->port; 12879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 12979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_head *h; 13079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 13179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry = macvlan_hash_lookup_source(vlan, addr); 13279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (entry) 13379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 13479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 13579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry = kmalloc(sizeof(*entry), GFP_KERNEL); 13679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!entry) 13779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -ENOMEM; 13879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 13979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun ether_addr_copy(entry->addr, addr); 14079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry->vlan = vlan; 14179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun h = &port->vlan_source_hash[macvlan_eth_hash(addr)]; 14279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_add_head_rcu(&entry->hlist, h); 14379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun vlan->macaddr_count++; 14479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 14579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 14679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 14779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 148f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic void macvlan_hash_add(struct macvlan_dev *vlan) 149f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{ 150f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman struct macvlan_port *port = vlan->port; 151f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman const unsigned char *addr = vlan->dev->dev_addr; 15279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun u32 idx = macvlan_eth_hash(addr); 153f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 15479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[idx]); 15579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 15679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 15779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic void macvlan_hash_del_source(struct macvlan_source_entry *entry) 15879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 15979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_del_rcu(&entry->hlist); 16079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun kfree_rcu(entry, rcu); 161f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman} 162f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 163449f4544267e73d5db372971da63634707c32299Eric Dumazetstatic void macvlan_hash_del(struct macvlan_dev *vlan, bool sync) 164f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{ 165f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman hlist_del_rcu(&vlan->hlist); 166449f4544267e73d5db372971da63634707c32299Eric Dumazet if (sync) 167449f4544267e73d5db372971da63634707c32299Eric Dumazet synchronize_rcu(); 168f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman} 169f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 170f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic void macvlan_hash_change_addr(struct macvlan_dev *vlan, 171f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman const unsigned char *addr) 172f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{ 173449f4544267e73d5db372971da63634707c32299Eric Dumazet macvlan_hash_del(vlan, true); 174f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman /* Now that we are unhashed it is safe to change the device 175f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman * address without confusing packet delivery. 176f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman */ 177f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman memcpy(vlan->dev->dev_addr, addr, ETH_ALEN); 178f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman macvlan_hash_add(vlan); 179f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman} 180f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 181f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic int macvlan_addr_busy(const struct macvlan_port *port, 182f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman const unsigned char *addr) 183f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{ 184f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman /* Test to see if the specified multicast address is 185f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman * currently in use by the underlying device or 186f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman * another macvlan. 187f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman */ 188a6700db17980972199e61c06be535a79e1b0b4e6Joe Perches if (ether_addr_equal_64bits(port->dev->dev_addr, addr)) 189f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman return 1; 190f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 191f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman if (macvlan_hash_lookup(port, addr)) 192f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman return 1; 193f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 194f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman return 0; 195f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman} 196f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 197a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann 198fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannstatic int macvlan_broadcast_one(struct sk_buff *skb, 199fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann const struct macvlan_dev *vlan, 200618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct ethhdr *eth, bool local) 201a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann{ 202fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann struct net_device *dev = vlan->dev; 203a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann 204618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (local) 205412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu return __dev_forward_skb(dev, skb); 206618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 207a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann skb->dev = dev; 208a6700db17980972199e61c06be535a79e1b0b4e6Joe Perches if (ether_addr_equal_64bits(eth->h_dest, dev->broadcast)) 209a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann skb->pkt_type = PACKET_BROADCAST; 210a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann else 211a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann skb->pkt_type = PACKET_MULTICAST; 212a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann 213412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu return 0; 214a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann} 215a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann 2163807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazetstatic u32 macvlan_hash_mix(const struct macvlan_dev *vlan) 2173807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet{ 2183807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet return (u32)(((unsigned long)vlan) >> L1_CACHE_SHIFT); 2193807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet} 2203807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet 2213807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet 2223807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazetstatic unsigned int mc_hash(const struct macvlan_dev *vlan, 2233807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet const unsigned char *addr) 224cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet{ 225cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet u32 val = __get_unaligned_cpu32(addr + 2); 226cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet 2273807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet val ^= macvlan_hash_mix(vlan); 228cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet return hash_32(val, MACVLAN_MC_FILTER_BITS); 229cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet} 230cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet 231b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_broadcast(struct sk_buff *skb, 232618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct macvlan_port *port, 233618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann struct net_device *src, 234618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann enum macvlan_mode mode) 235b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 236b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy const struct ethhdr *eth = eth_hdr(skb); 237b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy const struct macvlan_dev *vlan; 238b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct sk_buff *nskb; 239b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unsigned int i; 240a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann int err; 2413807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet unsigned int hash; 242b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 243efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy if (skb->protocol == htons(ETH_P_PAUSE)) 244efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy return; 245efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy 246b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 247b67bfe0d42cac56c512dd5da4b1b347a23f4b70aSasha Levin hlist_for_each_entry_rcu(vlan, &port->vlan_hash[i], hlist) { 248618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (vlan->dev == src || !(vlan->mode & mode)) 249618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann continue; 250618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 2513807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet hash = mc_hash(vlan, eth->h_dest); 252cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet if (!test_bit(hash, vlan->mc_filter)) 253cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet continue; 254de9e8f3f4086b1e6ba302487074fb707f1a95fc7Herbert Xu 255de9e8f3f4086b1e6ba302487074fb707f1a95fc7Herbert Xu err = NET_RX_DROP; 256b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy nskb = skb_clone(skb, GFP_ATOMIC); 257de9e8f3f4086b1e6ba302487074fb707f1a95fc7Herbert Xu if (likely(nskb)) 258de9e8f3f4086b1e6ba302487074fb707f1a95fc7Herbert Xu err = macvlan_broadcast_one( 259de9e8f3f4086b1e6ba302487074fb707f1a95fc7Herbert Xu nskb, vlan, eth, 260412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu mode == MACVLAN_MODE_BRIDGE) ?: 261412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu netif_rx_ni(nskb); 262a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann macvlan_count_rx(vlan, skb->len + ETH_HLEN, 2634c9799359bc691becc888f97a4b5bb035cb206f9jbaron@akamai.com err == NET_RX_SUCCESS, true); 264b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 265b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 266b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 267b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 268412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xustatic void macvlan_process_broadcast(struct work_struct *w) 269b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 270412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct macvlan_port *port = container_of(w, struct macvlan_port, 271412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu bc_work); 272412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct sk_buff *skb; 273412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct sk_buff_head list; 274412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 275fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet __skb_queue_head_init(&list); 276412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 277412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu spin_lock_bh(&port->bc_queue.lock); 278412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu skb_queue_splice_tail_init(&port->bc_queue, &list); 279412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu spin_unlock_bh(&port->bc_queue.lock); 280412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 281412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu while ((skb = __skb_dequeue(&list))) { 282412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu const struct macvlan_dev *src = MACVLAN_SKB_CB(skb)->src; 283412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 284412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu rcu_read_lock(); 285b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 286618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (!src) 287618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann /* frame comes from an external address */ 288618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann macvlan_broadcast(skb, port, NULL, 289618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_PRIVATE | 290618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_VEPA | 291eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala MACVLAN_MODE_PASSTHRU| 292618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_BRIDGE); 293618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann else if (src->mode == MACVLAN_MODE_VEPA) 294618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann /* flood to everyone except source */ 295618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann macvlan_broadcast(skb, port, src->dev, 296618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_VEPA | 297618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_BRIDGE); 298412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu else 299618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann /* 300618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann * flood only to VEPA ports, bridge ports 301618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann * already saw the frame on the way out. 302618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann */ 303618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann macvlan_broadcast(skb, port, src->dev, 304618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann MACVLAN_MODE_VEPA); 305412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 306412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu rcu_read_unlock(); 307412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 308412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu kfree_skb(skb); 309412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu } 310412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu} 311412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 312412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xustatic void macvlan_broadcast_enqueue(struct macvlan_port *port, 313412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct sk_buff *skb) 314412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu{ 315e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu struct sk_buff *nskb; 316412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu int err = -ENOMEM; 317412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 318e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu nskb = skb_clone(skb, GFP_ATOMIC); 319e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu if (!nskb) 320412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu goto err; 321412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 322412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu spin_lock(&port->bc_queue.lock); 32307d92d5cc977a7fe1e683e1d4a6f723f7f2778cbNicolas Dichtel if (skb_queue_len(&port->bc_queue) < MACVLAN_BC_QUEUE_LEN) { 324e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu __skb_queue_tail(&port->bc_queue, nskb); 325412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu err = 0; 326412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu } 327412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu spin_unlock(&port->bc_queue.lock); 328412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 329412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu if (err) 330e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu goto free_nskb; 331412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 332412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu schedule_work(&port->bc_work); 333412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu return; 334412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 335e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xufree_nskb: 336e676f197a7a9aae9c75b0d9acc97e07de07dd1f0Herbert Xu kfree_skb(nskb); 337412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xuerr: 338412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu atomic_long_inc(&skb->dev->rx_dropped); 339412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu} 340412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 34179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic void macvlan_flush_sources(struct macvlan_port *port, 34279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_dev *vlan) 34379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 34479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int i; 34579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 34679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 34779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_node *h, *n; 34879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 34979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_for_each_safe(h, n, &port->vlan_source_hash[i]) { 35079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 35179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 35279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry = hlist_entry(h, struct macvlan_source_entry, 35379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist); 35479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (entry->vlan == vlan) 35579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_hash_del_source(entry); 35679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 35779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 35879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun vlan->macaddr_count = 0; 35979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 36079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 36179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic void macvlan_forward_source_one(struct sk_buff *skb, 36279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_dev *vlan) 36379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 36479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct sk_buff *nskb; 36579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct net_device *dev; 36679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int len; 36779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int ret; 36879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 36979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun dev = vlan->dev; 37079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (unlikely(!(dev->flags & IFF_UP))) 37179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return; 37279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 37379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nskb = skb_clone(skb, GFP_ATOMIC); 37479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!nskb) 37579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return; 37679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 37779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun len = nskb->len + ETH_HLEN; 37879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nskb->dev = dev; 37979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nskb->pkt_type = PACKET_HOST; 38079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 38179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun ret = netif_rx(nskb); 3824c9799359bc691becc888f97a4b5bb035cb206f9jbaron@akamai.com macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, false); 38379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 38479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 38579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic void macvlan_forward_source(struct sk_buff *skb, 38679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_port *port, 38779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const unsigned char *addr) 38879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 38979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 39079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun u32 idx = macvlan_eth_hash(addr); 39179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_head *h = &port->vlan_source_hash[idx]; 39279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 39379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_for_each_entry_rcu(entry, h, hlist) { 39479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (ether_addr_equal_64bits(entry->addr, addr)) 39579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (entry->vlan->dev->flags & IFF_UP) 39679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_forward_source_one(skb, entry->vlan); 39779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 39879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 39979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 400412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu/* called under rcu_read_lock() from netif_receive_skb */ 401412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xustatic rx_handler_result_t macvlan_handle_frame(struct sk_buff **pskb) 402412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu{ 403412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct macvlan_port *port; 404412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct sk_buff *skb = *pskb; 405412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu const struct ethhdr *eth = eth_hdr(skb); 406412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu const struct macvlan_dev *vlan; 407412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu const struct macvlan_dev *src; 408412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu struct net_device *dev; 409412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu unsigned int len = 0; 410d1dd911930885659420421cfe123957610c54299jbaron@akamai.com int ret; 411d1dd911930885659420421cfe123957610c54299jbaron@akamai.com rx_handler_result_t handle_res; 412412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 413412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu port = macvlan_port_get_rcu(skb->dev); 414412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu if (is_multicast_ether_addr(eth->h_dest)) { 415412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu skb = ip_check_defrag(skb, IP_DEFRAG_MACVLAN); 416412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu if (!skb) 417412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu return RX_HANDLER_CONSUMED; 418412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu eth = eth_hdr(skb); 41979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_forward_source(skb, port, eth->h_source); 420412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu src = macvlan_hash_lookup(port, eth->h_source); 421412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu if (src && src->mode != MACVLAN_MODE_VEPA && 422412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu src->mode != MACVLAN_MODE_BRIDGE) { 423729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger /* forward to original port. */ 424729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger vlan = src; 425412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu ret = macvlan_broadcast_one(skb, vlan, eth, 0) ?: 426412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu netif_rx(skb); 427d1dd911930885659420421cfe123957610c54299jbaron@akamai.com handle_res = RX_HANDLER_CONSUMED; 428729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger goto out; 429729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger } 430729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger 431412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu MACVLAN_SKB_CB(skb)->src = src; 432412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu macvlan_broadcast_enqueue(port, skb); 433412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 4348a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko return RX_HANDLER_PASS; 435b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 436b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 43779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_forward_source(skb, port, eth->h_source); 438eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala if (port->passthru) 439233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko vlan = list_first_or_null_rcu(&port->vlans, 440233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko struct macvlan_dev, list); 441eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala else 442eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala vlan = macvlan_hash_lookup(port, eth->h_dest); 443b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (vlan == NULL) 4448a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko return RX_HANDLER_PASS; 445b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 446b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev = vlan->dev; 447b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (unlikely(!(dev->flags & IFF_UP))) { 448b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy kfree_skb(skb); 4498a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko return RX_HANDLER_CONSUMED; 450b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 451a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann len = skb->len + ETH_HLEN; 452b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy skb = skb_share_check(skb, GFP_ATOMIC); 453d1dd911930885659420421cfe123957610c54299jbaron@akamai.com if (!skb) { 454d1dd911930885659420421cfe123957610c54299jbaron@akamai.com ret = NET_RX_DROP; 455d1dd911930885659420421cfe123957610c54299jbaron@akamai.com handle_res = RX_HANDLER_CONSUMED; 456ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudrala goto out; 457d1dd911930885659420421cfe123957610c54299jbaron@akamai.com } 458b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 459b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy skb->dev = dev; 460b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy skb->pkt_type = PACKET_HOST; 461b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 462d1dd911930885659420421cfe123957610c54299jbaron@akamai.com ret = NET_RX_SUCCESS; 463d1dd911930885659420421cfe123957610c54299jbaron@akamai.com handle_res = RX_HANDLER_ANOTHER; 464ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudralaout: 4654c9799359bc691becc888f97a4b5bb035cb206f9jbaron@akamai.com macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, false); 466d1dd911930885659420421cfe123957610c54299jbaron@akamai.com return handle_res; 467b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 468b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 469618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannstatic int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) 470618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann{ 471618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct macvlan_dev *vlan = netdev_priv(dev); 472618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct macvlan_port *port = vlan->port; 473618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct macvlan_dev *dest; 474618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 475618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (vlan->mode == MACVLAN_MODE_BRIDGE) { 476618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann const struct ethhdr *eth = (void *)skb->data; 477618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 478618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann /* send to other bridge ports directly */ 479618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (is_multicast_ether_addr(eth->h_dest)) { 480618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE); 481618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann goto xmit_world; 482618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann } 483618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 484618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann dest = macvlan_hash_lookup(port, eth->h_dest); 485618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { 486a37dd3332319260cce81ac91ce25fcc3a31de997David Ward /* send to lowerdev first for its network taps */ 487cb2d0f3e968bff7c6d262aca3e3ab8d4184e69b2David Ward dev_forward_skb(vlan->lowerdev, skb); 488618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 489618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann return NET_XMIT_SUCCESS; 490618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann } 491618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann } 492618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 493618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannxmit_world: 49459b9997baba5242997ddc7bd96b1391f5275a5a4David S. Miller skb->dev = vlan->lowerdev; 495618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann return dev_queue_xmit(skb); 496618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann} 497618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann 498688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic inline netdev_tx_t macvlan_netpoll_send_skb(struct macvlan_dev *vlan, struct sk_buff *skb) 499688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{ 500688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER 501688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong if (vlan->netpoll) 502688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong netpoll_send_skb(vlan->netpoll, skb); 503688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#else 504688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong BUG(); 505688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif 506688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong return NETDEV_TX_OK; 507688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong} 508688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 5090db901bd33f09b0dbf39d12261f689812e343c26stephen hemmingerstatic netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, 5100db901bd33f09b0dbf39d12261f689812e343c26stephen hemminger struct net_device *dev) 511b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 512b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unsigned int len = skb->len; 513b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy int ret; 514688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct macvlan_dev *vlan = netdev_priv(dev); 515688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 516688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong if (unlikely(netpoll_tx_running(dev))) 517688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong return macvlan_netpoll_send_skb(vlan, skb); 518b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 519a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend if (vlan->fwd_priv) { 520a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend skb->dev = vlan->lowerdev; 521f663dd9aaf9ed124f25f0f8452edf238f087ad50Jason Wang ret = dev_queue_xmit_accel(skb, vlan->fwd_priv); 522a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend } else { 523a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend ret = macvlan_queue_xmit(skb, dev); 524a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend } 525a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend 5262d6c9ffcca7808f42ba6b953da0ba60e19a9cbbdEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 527cdf3e274cf1b36e9a2fef2d175cabc566af841b2Li RongQing struct vlan_pcpu_stats *pcpu_stats; 5282c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet 5298ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet pcpu_stats = this_cpu_ptr(vlan->pcpu_stats); 5308ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet u64_stats_update_begin(&pcpu_stats->syncp); 5318ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet pcpu_stats->tx_packets++; 5328ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet pcpu_stats->tx_bytes += len; 5338ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet u64_stats_update_end(&pcpu_stats->syncp); 5348ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet } else { 5358ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet this_cpu_inc(vlan->pcpu_stats->tx_dropped); 5368ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet } 537cbbef5e183079455763fc470ccf69008f92ab4b6Patrick McHardy return ret; 538b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 539b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 540b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev, 5413b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger unsigned short type, const void *daddr, 5423b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger const void *saddr, unsigned len) 543b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 544b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 545b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *lowerdev = vlan->lowerdev; 546b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 5470c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger return dev_hard_header(skb, lowerdev, type, daddr, 5480c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger saddr ? : dev->dev_addr, len); 549b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 550b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 5513b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemmingerstatic const struct header_ops macvlan_hard_header_ops = { 5523b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger .create = macvlan_hard_header, 5533b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger .rebuild = eth_rebuild_header, 5543b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger .parse = eth_header_parse, 5553b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger .cache = eth_header_cache, 5563b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger .cache_update = eth_header_cache_update, 5573b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger}; 5583b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger 559b13ba1b83f524732523db1079e56478b32c85c96Jason Wangstatic struct rtnl_link_ops macvlan_link_ops; 560b13ba1b83f524732523db1079e56478b32c85c96Jason Wang 561b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_open(struct net_device *dev) 562b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 563b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 564b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *lowerdev = vlan->lowerdev; 565b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy int err; 566b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 567eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala if (vlan->port->passthru) { 568787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) { 569787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin err = dev_set_promiscuity(lowerdev, 1); 570787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin if (err < 0) 571787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin goto out; 572787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin } 573eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala goto hash_add; 574eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala } 575eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala 576b13ba1b83f524732523db1079e56478b32c85c96Jason Wang if (lowerdev->features & NETIF_F_HW_L2FW_DOFFLOAD && 577b13ba1b83f524732523db1079e56478b32c85c96Jason Wang dev->rtnl_link_ops == &macvlan_link_ops) { 578a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv = 579a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend lowerdev->netdev_ops->ndo_dfwd_add_station(lowerdev, dev); 580a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend 581a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend /* If we get a NULL pointer back, or if we get an error 582a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend * then we should just fall through to the non accelerated path 583a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend */ 584a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend if (IS_ERR_OR_NULL(vlan->fwd_priv)) { 585a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv = NULL; 586f663dd9aaf9ed124f25f0f8452edf238f087ad50Jason Wang } else 587a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend return 0; 588a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend } 589a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend 590f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman err = -EBUSY; 591f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman if (macvlan_addr_busy(vlan->port, dev->dev_addr)) 592f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman goto out; 593f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 594a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko err = dev_uc_add(lowerdev, dev->dev_addr); 595b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (err < 0) 596b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen goto out; 597b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen if (dev->flags & IFF_ALLMULTI) { 598b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen err = dev_set_allmulti(lowerdev, 1); 599b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen if (err < 0) 600b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen goto del_unicast; 601b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen } 602eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala 603eb06acdc85585f28864261f28659157848762ee4Sridhar Samudralahash_add: 604f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman macvlan_hash_add(vlan); 605b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 606b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen 607b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chendel_unicast: 608a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 609b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chenout: 610a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend if (vlan->fwd_priv) { 611a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev, 612a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv); 613a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv = NULL; 614a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend } 615b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen return err; 616b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 617b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 618b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_stop(struct net_device *dev) 619b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 620b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 621b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *lowerdev = vlan->lowerdev; 622b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 623a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend if (vlan->fwd_priv) { 624a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev, 625a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv); 626a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend vlan->fwd_priv = NULL; 627a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend return 0; 628a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend } 629a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend 630df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend dev_uc_unsync(lowerdev, dev); 631df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend dev_mc_unsync(lowerdev, dev); 632df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 633eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala if (vlan->port->passthru) { 634df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) 635df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend dev_set_promiscuity(lowerdev, -1); 636eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala goto hash_del; 637eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala } 638eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala 639b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (dev->flags & IFF_ALLMULTI) 640b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev_set_allmulti(lowerdev, -1); 641b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 642a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 643b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 644eb06acdc85585f28864261f28659157848762ee4Sridhar Samudralahash_del: 645449f4544267e73d5db372971da63634707c32299Eric Dumazet macvlan_hash_del(vlan, !dev->dismantle); 646b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 647b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 648b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 649e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhongstatic int macvlan_sync_address(struct net_device *dev, unsigned char *addr) 650ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy{ 651ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 652ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy struct net_device *lowerdev = vlan->lowerdev; 653ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy int err; 654ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy 655f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman if (!(dev->flags & IFF_UP)) { 656f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman /* Just copy in the new address */ 657e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong ether_addr_copy(dev->dev_addr, addr); 658f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman } else { 659f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman /* Rehash and update the device filters */ 660e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (macvlan_addr_busy(vlan->port, addr)) 661f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman return -EBUSY; 662ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy 663e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (!vlan->port->passthru) { 664e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong err = dev_uc_add(lowerdev, addr); 665e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (err) 666e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return err; 667ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy 668e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong dev_uc_del(lowerdev, dev->dev_addr); 669e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong } 670f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman 671e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong macvlan_hash_change_addr(vlan, addr); 672f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman } 673ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy return 0; 674ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy} 675ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy 676e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhongstatic int macvlan_set_mac_address(struct net_device *dev, void *p) 677e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong{ 678e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong struct macvlan_dev *vlan = netdev_priv(dev); 679e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong struct sockaddr *addr = p; 680e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 681e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (!is_valid_ether_addr(addr->sa_data)) 682e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return -EADDRNOTAVAIL; 683e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 684e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (vlan->mode == MACVLAN_MODE_PASSTHRU) { 685e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong dev_set_mac_address(vlan->lowerdev, addr); 686e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return 0; 687e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong } 688e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 689e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return macvlan_sync_address(dev, addr->sa_data); 690e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong} 691e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 692b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_change_rx_flags(struct net_device *dev, int change) 693b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 694b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 695b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *lowerdev = vlan->lowerdev; 696b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 697bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen if (dev->flags & IFF_UP) { 698bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen if (change & IFF_ALLMULTI) 699bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); 700bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen } 701b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 702b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 703df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabendstatic void macvlan_set_mac_lists(struct net_device *dev) 704b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 705b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 706b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 707cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) { 708cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet bitmap_fill(vlan->mc_filter, MACVLAN_MC_FILTER_SZ); 709cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet } else { 710cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet struct netdev_hw_addr *ha; 711cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet DECLARE_BITMAP(filter, MACVLAN_MC_FILTER_SZ); 712cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet 713cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet bitmap_zero(filter, MACVLAN_MC_FILTER_SZ); 714cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet netdev_for_each_mc_addr(ha, dev) { 7153807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet __set_bit(mc_hash(vlan, ha->addr), filter); 716cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet } 717d527043040740f41192dfd71793f905a998ee4f6Eric Dumazet 7183807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet __set_bit(mc_hash(vlan, dev->broadcast), filter); 719d527043040740f41192dfd71793f905a998ee4f6Eric Dumazet 720cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet bitmap_copy(vlan->mc_filter, filter, MACVLAN_MC_FILTER_SZ); 721cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet } 722df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend dev_uc_sync(vlan->lowerdev, dev); 723b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev_mc_sync(vlan->lowerdev, dev); 724b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 725b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 726b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_change_mtu(struct net_device *dev, int new_mtu) 727b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 728b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 729b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 730b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu) 731b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EINVAL; 732b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->mtu = new_mtu; 733b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 734b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 735b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 736b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy/* 737b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * macvlan network devices have devices nesting below it and are a special 738b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * "super class" of normal network devices; split their locks off into a 739b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * separate class since they always nest. 740b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy */ 741b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct lock_class_key macvlan_netdev_xmit_lock_key; 742cf508b1211dbe576778ff445ea1b4b0bcfa5c4eaDavid S. Millerstatic struct lock_class_key macvlan_netdev_addr_lock_key; 743b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 7448b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich#define ALWAYS_ON_FEATURES \ 7458b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich (NETIF_F_SG | NETIF_F_GEN_CSUM | NETIF_F_GSO_SOFTWARE | NETIF_F_LLTX) 7468b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich 747b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_FEATURES \ 748b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \ 749b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \ 7508d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \ 75128d2b136ca6c7bf7173a43a90f747ecda5b0520dPatrick McHardy NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER) 752b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 753b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_STATE_MASK \ 754b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) 755b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 756c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevichstatic int macvlan_get_nest_level(struct net_device *dev) 757c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich{ 758c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich return ((struct macvlan_dev *)netdev_priv(dev))->nest_level; 759c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich} 760c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich 761e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Millerstatic void macvlan_set_lockdep_class_one(struct net_device *dev, 762e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller struct netdev_queue *txq, 763e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller void *_unused) 764c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{ 765c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller lockdep_set_class(&txq->_xmit_lock, 766c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller &macvlan_netdev_xmit_lock_key); 767c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller} 768c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller 769c773e847ea8f6812804e40f52399c6921a00eab1David S. Millerstatic void macvlan_set_lockdep_class(struct net_device *dev) 770c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{ 771c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich lockdep_set_class_and_subclass(&dev->addr_list_lock, 772c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich &macvlan_netdev_addr_lock_key, 773c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich macvlan_get_nest_level(dev)); 774e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL); 775c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller} 776c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller 777b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_init(struct net_device *dev) 778b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 779b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 780b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 781b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 782b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->state = (dev->state & ~MACVLAN_STATE_MASK) | 783b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy (lowerdev->state & MACVLAN_STATE_MASK); 784b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->features = lowerdev->features & MACVLAN_FEATURES; 7858b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich dev->features |= ALWAYS_ON_FEATURES; 786081e83a78db9b0ae1f5eabc2dedecc865f509b98Vlad Yasevich dev->vlan_features = lowerdev->vlan_features & MACVLAN_FEATURES; 7878c2acc53fd7987493f11640e266cf7130591e764Patrick McHardy dev->gso_max_size = lowerdev->gso_max_size; 788b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->iflink = lowerdev->ifindex; 789ef5c89967d50042b29937fb724e057c1aa3c5207sg.tweak@gmail.com dev->hard_header_len = lowerdev->hard_header_len; 790b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 791c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller macvlan_set_lockdep_class(dev); 792c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller 7931c213bd24ad04f4430031d20d740d7783162b099WANG Cong vlan->pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats); 7948ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet if (!vlan->pcpu_stats) 795fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet return -ENOMEM; 796fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 797b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 798b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 799b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 800fccaf71011b171883efee5bae321eac4760584d1Eric Dumazetstatic void macvlan_uninit(struct net_device *dev) 801fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{ 802fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 803d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman struct macvlan_port *port = vlan->port; 804fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 8058ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet free_percpu(vlan->pcpu_stats); 806d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman 80779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_flush_sources(port, vlan); 8085e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller port->count -= 1; 8095e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller if (!port->count) 810d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman macvlan_port_destroy(port->dev); 811fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet} 812fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 81328172739f0a276eb8d6ca917b3974c2edb036da3Eric Dumazetstatic struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev, 81428172739f0a276eb8d6ca917b3974c2edb036da3Eric Dumazet struct rtnl_link_stats64 *stats) 815fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{ 816fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 817fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 8188ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet if (vlan->pcpu_stats) { 819cdf3e274cf1b36e9a2fef2d175cabc566af841b2Li RongQing struct vlan_pcpu_stats *p; 8208ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes; 8218ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet u32 rx_errors = 0, tx_dropped = 0; 822bc66154efe163a80f269d448572f7906756e9338Eric Dumazet unsigned int start; 823fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet int i; 824fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 825fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet for_each_possible_cpu(i) { 8268ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet p = per_cpu_ptr(vlan->pcpu_stats, i); 827bc66154efe163a80f269d448572f7906756e9338Eric Dumazet do { 82857a7744e09867ebcfa0ccf1d6d529caa7728d552Eric W. Biederman start = u64_stats_fetch_begin_irq(&p->syncp); 829bc66154efe163a80f269d448572f7906756e9338Eric Dumazet rx_packets = p->rx_packets; 830bc66154efe163a80f269d448572f7906756e9338Eric Dumazet rx_bytes = p->rx_bytes; 831bc66154efe163a80f269d448572f7906756e9338Eric Dumazet rx_multicast = p->rx_multicast; 8328ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet tx_packets = p->tx_packets; 8338ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet tx_bytes = p->tx_bytes; 83457a7744e09867ebcfa0ccf1d6d529caa7728d552Eric W. Biederman } while (u64_stats_fetch_retry_irq(&p->syncp, start)); 8358ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet 8368ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->rx_packets += rx_packets; 8378ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->rx_bytes += rx_bytes; 8388ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->multicast += rx_multicast; 8398ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->tx_packets += tx_packets; 8408ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->tx_bytes += tx_bytes; 8418ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet /* rx_errors & tx_dropped are u32, updated 8428ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet * without syncp protection. 8438ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet */ 8448ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet rx_errors += p->rx_errors; 8458ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet tx_dropped += p->tx_dropped; 846fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet } 8478ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->rx_errors = rx_errors; 8488ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->rx_dropped = rx_errors; 8498ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet stats->tx_dropped = tx_dropped; 850fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet } 851fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet return stats; 852fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet} 853fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet 8548e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirkostatic int macvlan_vlan_rx_add_vid(struct net_device *dev, 85580d5c3689b886308247da295a228a54df49a44f6Patrick McHardy __be16 proto, u16 vid) 8568d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend{ 8578d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 8588d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend struct net_device *lowerdev = vlan->lowerdev; 8598d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend 86080d5c3689b886308247da295a228a54df49a44f6Patrick McHardy return vlan_vid_add(lowerdev, proto, vid); 8618d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend} 8628d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend 8638e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirkostatic int macvlan_vlan_rx_kill_vid(struct net_device *dev, 86480d5c3689b886308247da295a228a54df49a44f6Patrick McHardy __be16 proto, u16 vid) 8658d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend{ 8668d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 8678d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend struct net_device *lowerdev = vlan->lowerdev; 8688d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend 86980d5c3689b886308247da295a228a54df49a44f6Patrick McHardy vlan_vid_del(lowerdev, proto, vid); 8708e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirko return 0; 8718d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend} 8728d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend 873edc7d57327bd08bfd04f41531d49b176369db218stephen hemmingerstatic int macvlan_fdb_add(struct ndmsg *ndm, struct nlattr *tb[], 874df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend struct net_device *dev, 8756b6e27255f29a6191ef8ad96bfcc392ab2ef6c71stephen hemminger const unsigned char *addr, 876df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend u16 flags) 877df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend{ 878df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 879df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend int err = -EINVAL; 880df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 8818a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich /* Support unicast filter only on passthru devices. 8828a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich * Multicast filter should be allowed on all devices. 8838a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich */ 8848a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich if (!vlan->port->passthru && is_unicast_ether_addr(addr)) 885df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend return -EOPNOTSUPP; 886df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 887ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter if (flags & NLM_F_REPLACE) 888ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter return -EOPNOTSUPP; 889ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter 890df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (is_unicast_ether_addr(addr)) 891df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend err = dev_uc_add_excl(dev, addr); 892df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend else if (is_multicast_ether_addr(addr)) 893df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend err = dev_mc_add_excl(dev, addr); 894df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 895df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend return err; 896df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend} 897df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 8981690be63a27b20ae65c792729a44f5970561ffa4Vlad Yasevichstatic int macvlan_fdb_del(struct ndmsg *ndm, struct nlattr *tb[], 899df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend struct net_device *dev, 9006b6e27255f29a6191ef8ad96bfcc392ab2ef6c71stephen hemminger const unsigned char *addr) 901df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend{ 902df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend struct macvlan_dev *vlan = netdev_priv(dev); 903df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend int err = -EINVAL; 904df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 9058a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich /* Support unicast filter only on passthru devices. 9068a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich * Multicast filter should be allowed on all devices. 9078a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich */ 9088a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich if (!vlan->port->passthru && is_unicast_ether_addr(addr)) 909df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend return -EOPNOTSUPP; 910df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 911df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (is_unicast_ether_addr(addr)) 912df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend err = dev_uc_del(dev, addr); 913df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend else if (is_multicast_ether_addr(addr)) 914df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend err = dev_mc_del(dev, addr); 915df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 916df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend return err; 917df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend} 918df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 919b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_ethtool_get_drvinfo(struct net_device *dev, 920b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct ethtool_drvinfo *drvinfo) 921b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 9227826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko strlcpy(drvinfo->driver, "macvlan", sizeof(drvinfo->driver)); 9237826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko strlcpy(drvinfo->version, "0.1", sizeof(drvinfo->version)); 924b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 925b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 9269edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemmingerstatic int macvlan_ethtool_get_settings(struct net_device *dev, 9279edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger struct ethtool_cmd *cmd) 9289edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger{ 9299edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 9304bc71cb983fd2844e603bf633df2bb53385182d2Jiri Pirko 9314bc71cb983fd2844e603bf633df2bb53385182d2Jiri Pirko return __ethtool_get_settings(vlan->lowerdev, cmd); 9329edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger} 9339edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger 9342be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevichstatic netdev_features_t macvlan_fix_features(struct net_device *dev, 9352be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich netdev_features_t features) 9362be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich{ 9372be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich struct macvlan_dev *vlan = netdev_priv(dev); 938797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal netdev_features_t mask; 9392be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich 940797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal features |= NETIF_F_ALL_FOR_ALL; 941797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal features &= (vlan->set_features | ~MACVLAN_FEATURES); 942797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal mask = features; 943797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal 944797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal features = netdev_increment_features(vlan->lowerdev->features, 945797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal features, 946797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal mask); 9478b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich features |= ALWAYS_ON_FEATURES; 9480d0162e7a33d3710b9604e7c68c0f31f5c457428Francesco Ruggeri features &= ~NETIF_F_NETNS_LOCAL; 949797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal 950797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal return features; 9512be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich} 9522be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich 953688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER 954688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic void macvlan_dev_poll_controller(struct net_device *dev) 955688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{ 956688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong return; 957688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong} 958688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 959688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic int macvlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo) 960688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{ 961688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct macvlan_dev *vlan = netdev_priv(dev); 962688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct net_device *real_dev = vlan->lowerdev; 963688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct netpoll *netpoll; 964688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong int err = 0; 965688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 966688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL); 967688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong err = -ENOMEM; 968688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong if (!netpoll) 969688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong goto out; 970688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 971688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong err = __netpoll_setup(netpoll, real_dev); 972688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong if (err) { 973688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong kfree(netpoll); 974688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong goto out; 975688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong } 976688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 977688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong vlan->netpoll = netpoll; 978688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 979688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongout: 980688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong return err; 981688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong} 982688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 983688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic void macvlan_dev_netpoll_cleanup(struct net_device *dev) 984688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{ 985688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct macvlan_dev *vlan = netdev_priv(dev); 986688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong struct netpoll *netpoll = vlan->netpoll; 987688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 988688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong if (!netpoll) 989688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong return; 990688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 991688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong vlan->netpoll = NULL; 992688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 993688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong __netpoll_free_async(netpoll); 994688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong} 995688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif /* CONFIG_NET_POLL_CONTROLLER */ 996688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong 997b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic const struct ethtool_ops macvlan_ethtool_ops = { 998b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .get_link = ethtool_op_get_link, 9999edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger .get_settings = macvlan_ethtool_get_settings, 1000b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .get_drvinfo = macvlan_ethtool_get_drvinfo, 1001b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}; 1002b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 100354a30c975b6b27c0c9268461b647576b146d39bbStephen Hemmingerstatic const struct net_device_ops macvlan_netdev_ops = { 100454a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_init = macvlan_init, 1005fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet .ndo_uninit = macvlan_uninit, 100654a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_open = macvlan_open, 100754a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_stop = macvlan_stop, 1008008298231abbeb91bc7be9e8b078607b816d1a4aStephen Hemminger .ndo_start_xmit = macvlan_start_xmit, 100954a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_change_mtu = macvlan_change_mtu, 10102be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich .ndo_fix_features = macvlan_fix_features, 101154a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_change_rx_flags = macvlan_change_rx_flags, 101254a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_set_mac_address = macvlan_set_mac_address, 1013df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend .ndo_set_rx_mode = macvlan_set_mac_lists, 1014bc66154efe163a80f269d448572f7906756e9338Eric Dumazet .ndo_get_stats64 = macvlan_dev_get_stats64, 101554a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger .ndo_validate_addr = eth_validate_addr, 10168d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend .ndo_vlan_rx_add_vid = macvlan_vlan_rx_add_vid, 10178d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend .ndo_vlan_rx_kill_vid = macvlan_vlan_rx_kill_vid, 1018df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend .ndo_fdb_add = macvlan_fdb_add, 1019df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend .ndo_fdb_del = macvlan_fdb_del, 1020df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend .ndo_fdb_dump = ndo_dflt_fdb_dump, 1021c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich .ndo_get_lock_subclass = macvlan_get_nest_level, 1022688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER 1023688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong .ndo_poll_controller = macvlan_dev_poll_controller, 1024688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong .ndo_netpoll_setup = macvlan_dev_netpoll_setup, 1025688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong .ndo_netpoll_cleanup = macvlan_dev_netpoll_cleanup, 1026688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif 102754a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger}; 102854a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger 10298a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xuvoid macvlan_common_setup(struct net_device *dev) 1030b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1031b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy ether_setup(dev); 1032b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 10330287587884b15041203b3a362d485e1ab1f24445Eric Dumazet dev->priv_flags &= ~IFF_TX_SKB_SHARING; 10340287587884b15041203b3a362d485e1ab1f24445Eric Dumazet netif_keep_dst(dev); 103587ab7f6f2874f1115817e394a7ed2dea1c72549eVlad Yasevich dev->priv_flags |= IFF_UNICAST_FLT; 103654a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger dev->netdev_ops = &macvlan_netdev_ops; 1037b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->destructor = free_netdev; 10387174012955d0e545e5253192e2cd37fedbc405f9Lutz Jaenicke dev->header_ops = &macvlan_hard_header_ops; 1039b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->ethtool_ops = &macvlan_ethtool_ops; 10408a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu} 10418a35747a5d13b99e076b0222729e0caa48cb69b6Herbert XuEXPORT_SYMBOL_GPL(macvlan_common_setup); 10428a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu 10438a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xustatic void macvlan_setup(struct net_device *dev) 10448a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu{ 10458a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu macvlan_common_setup(dev); 1046b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->tx_queue_len = 0; 1047b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1048b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1049b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_port_create(struct net_device *dev) 1050b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1051b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_port *port; 1052b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unsigned int i; 1053ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko int err; 1054b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1055b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) 1056b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EINVAL; 1057b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1058b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy port = kzalloc(sizeof(*port), GFP_KERNEL); 1059b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (port == NULL) 1060b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -ENOMEM; 1061b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1062eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala port->passthru = false; 1063b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy port->dev = dev; 1064b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy INIT_LIST_HEAD(&port->vlans); 1065b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) 1066b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy INIT_HLIST_HEAD(&port->vlan_hash[i]); 106779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun for (i = 0; i < MACVLAN_HASH_SIZE; i++) 106879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun INIT_HLIST_HEAD(&port->vlan_source_hash[i]); 1069ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko 1070412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu skb_queue_head_init(&port->bc_queue); 1071412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu INIT_WORK(&port->bc_work, macvlan_process_broadcast); 1072412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu 1073a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko err = netdev_rx_handler_register(dev, macvlan_handle_frame, port); 1074a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko if (err) 1075ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko kfree(port); 1076d93515611bbc70c2fe4db232e5feb448ed8e4cc9Eric Dumazet else 1077d93515611bbc70c2fe4db232e5feb448ed8e4cc9Eric Dumazet dev->priv_flags |= IFF_MACVLAN_PORT; 1078ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko return err; 1079b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1080b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1081b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_port_destroy(struct net_device *dev) 1082b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1083e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet struct macvlan_port *port = macvlan_port_get_rtnl(dev); 1084b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1085a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko dev->priv_flags &= ~IFF_MACVLAN_PORT; 1086ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko netdev_rx_handler_unregister(dev); 1087fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet 1088fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet /* After this point, no packet can schedule bc_work anymore, 1089fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet * but we need to cancel it and purge left skbs if any. 1090fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet */ 1091fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet cancel_work_sync(&port->bc_work); 1092fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet __skb_queue_purge(&port->bc_queue); 1093fe0ca7328d03d36aafecebb3af650e1bb2841c20Eric Dumazet 10946e070aecd9e304264a6b8655f49aa7e6db0e55f2Lai Jiangshan kfree_rcu(port, rcu); 1095b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1096b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1097b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) 1098b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1099b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (tb[IFLA_ADDRESS]) { 1100b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) 1101b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EINVAL; 1102b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) 1103b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EADDRNOTAVAIL; 1104b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 110527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 11061512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin if (data && data[IFLA_MACVLAN_FLAGS] && 11071512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin nla_get_u16(data[IFLA_MACVLAN_FLAGS]) & ~MACVLAN_FLAG_NOPROMISC) 11081512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin return -EINVAL; 11091512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin 111027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) { 111127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) { 111227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann case MACVLAN_MODE_PRIVATE: 111327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann case MACVLAN_MODE_VEPA: 111427c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann case MACVLAN_MODE_BRIDGE: 1115eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala case MACVLAN_MODE_PASSTHRU: 111679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun case MACVLAN_MODE_SOURCE: 111779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun break; 111879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun default: 111979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 112079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 112179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 112279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 112379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data && data[IFLA_MACVLAN_MACADDR_MODE]) { 112479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun switch (nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE])) { 112579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun case MACVLAN_MACADDR_ADD: 112679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun case MACVLAN_MACADDR_DEL: 112779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun case MACVLAN_MACADDR_FLUSH: 112879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun case MACVLAN_MACADDR_SET: 112927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann break; 113027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann default: 113127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann return -EINVAL; 113227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann } 113327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann } 113479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 113579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data && data[IFLA_MACVLAN_MACADDR]) { 113679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (nla_len(data[IFLA_MACVLAN_MACADDR]) != ETH_ALEN) 113779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 113879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 113979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!is_valid_ether_addr(nla_data(data[IFLA_MACVLAN_MACADDR]))) 114079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EADDRNOTAVAIL; 114179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 114279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 114379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data && data[IFLA_MACVLAN_MACADDR_COUNT]) 114479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 114579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 114679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 114779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 114879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 114979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun/** 115079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * reconfigure list of remote source mac address 115179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * (only for macvlan devices in source mode) 115279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * Note regarding alignment: all netlink data is aligned to 4 Byte, which 115379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * suffices for both ether_addr_copy and ether_addr_equal_64bits usage. 115479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun */ 115579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic int macvlan_changelink_sources(struct macvlan_dev *vlan, u32 mode, 115679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct nlattr *data[]) 115779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 115879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun char *addr = NULL; 115979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int ret, rem, len; 116079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct nlattr *nla, *head; 116179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 116279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 116379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data[IFLA_MACVLAN_MACADDR]) 116479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun addr = nla_data(data[IFLA_MACVLAN_MACADDR]); 116579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 116679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (mode == MACVLAN_MACADDR_ADD) { 116779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!addr) 116879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 116979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 117079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return macvlan_hash_add_source(vlan, addr); 117179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 117279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } else if (mode == MACVLAN_MACADDR_DEL) { 117379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!addr) 117479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 117579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 117679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun entry = macvlan_hash_lookup_source(vlan, addr); 117779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (entry) { 117879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_hash_del_source(entry); 117979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun vlan->macaddr_count--; 118079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 118179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } else if (mode == MACVLAN_MACADDR_FLUSH) { 118279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_flush_sources(vlan->port, vlan); 118379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } else if (mode == MACVLAN_MACADDR_SET) { 118479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_flush_sources(vlan->port, vlan); 118579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 118679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (addr) { 118779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun ret = macvlan_hash_add_source(vlan, addr); 118879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (ret) 118979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return ret; 119079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 119179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 119279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (!data || !data[IFLA_MACVLAN_MACADDR_DATA]) 119379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 119479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 119579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun head = nla_data(data[IFLA_MACVLAN_MACADDR_DATA]); 119679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun len = nla_len(data[IFLA_MACVLAN_MACADDR_DATA]); 119779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 119879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nla_for_each_attr(nla, head, len, rem) { 119979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (nla_type(nla) != IFLA_MACVLAN_MACADDR || 120079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nla_len(nla) != ETH_ALEN) 120179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun continue; 120279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 120379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun addr = nla_data(nla); 120479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun ret = macvlan_hash_add_source(vlan, addr); 120579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (ret) 120679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return ret; 120779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 120879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } else { 120979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 121079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 121179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 1212b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 1213b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1214b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1215fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannint macvlan_common_newlink(struct net *src_net, struct net_device *dev, 12162f6a1b6607fd6b0eb9501843a40e0c7555f37b4aVlad Yasevich struct nlattr *tb[], struct nlattr *data[]) 1217b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1218b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 1219b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_port *port; 1220b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct net_device *lowerdev; 1221b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy int err; 122279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int macmode; 1223b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1224b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (!tb[IFLA_LINK]) 1225b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EINVAL; 1226b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 122781adee47dfb608df3ad0b91d230fb3cef75f0060Eric W. Biederman lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK])); 1228b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (lowerdev == NULL) 1229b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -ENODEV; 1230b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1231d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace /* When creating macvlans or macvtaps on top of other macvlans - use 1232b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman * the real device as the lowerdev. 1233a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy */ 1234d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace if (netif_is_macvlan(lowerdev)) 1235d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace lowerdev = macvlan_dev_real_dev(lowerdev); 1236a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy 1237b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (!tb[IFLA_MTU]) 1238b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy dev->mtu = lowerdev->mtu; 1239b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy else if (dev->mtu > lowerdev->mtu) 1240b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return -EINVAL; 1241b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1242b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (!tb[IFLA_ADDRESS]) 12437ce5d222190cb3ce3ae88bafde7c4fa52a5103e0Danny Kukawka eth_hw_addr_random(dev); 1244b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1245a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko if (!macvlan_port_exists(lowerdev)) { 1246b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy err = macvlan_port_create(lowerdev); 1247b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (err < 0) 1248b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return err; 1249b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 1250e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet port = macvlan_port_get_rtnl(lowerdev); 1251b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1252eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala /* Only 1 macvlan device can be created in passthru mode */ 1253eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala if (port->passthru) 1254eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala return -EINVAL; 1255eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala 1256b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy vlan->lowerdev = lowerdev; 1257b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy vlan->dev = dev; 1258b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy vlan->port = port; 12592be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich vlan->set_features = MACVLAN_FEATURES; 1260c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich vlan->nest_level = dev_get_nest_level(lowerdev, netif_is_macvlan) + 1; 1261b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 126227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann vlan->mode = MACVLAN_MODE_VEPA; 126327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 126427c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 126527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 1266df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (data && data[IFLA_MACVLAN_FLAGS]) 1267df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend vlan->flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); 1268df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend 1269eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala if (vlan->mode == MACVLAN_MODE_PASSTHRU) { 12705e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller if (port->count) 1271eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala return -EINVAL; 1272eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala port->passthru = true; 12738b98604e398418b9f1a1e44ac79fbbc134818f50Bjørn Mork eth_hw_addr_inherit(dev, lowerdev); 1274eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala } 1275eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala 127679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data && data[IFLA_MACVLAN_MACADDR_MODE]) { 127779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->mode != MACVLAN_MODE_SOURCE) 127879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 127979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]); 128079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun err = macvlan_changelink_sources(vlan, macmode, data); 128179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (err) 128279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return err; 128379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 128479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 12855e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller port->count += 1; 128647d4ab91e4472723f181075c81627374ca86816cJohn Fastabend err = register_netdevice(dev); 128747d4ab91e4472723f181075c81627374ca86816cJohn Fastabend if (err < 0) 128847d4ab91e4472723f181075c81627374ca86816cJohn Fastabend goto destroy_port; 128947d4ab91e4472723f181075c81627374ca86816cJohn Fastabend 1290a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend dev->priv_flags |= IFF_MACVLAN; 12917cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko err = netdev_upper_dev_link(lowerdev, dev); 12927cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko if (err) 1293da37705cef30841616ed644ff33455bbc7374db0Cong Wang goto unregister_netdev; 1294b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1295233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko list_add_tail_rcu(&vlan->list, &port->vlans); 1296fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney netif_stacked_transfer_operstate(lowerdev, dev); 1297f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko 1298b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 1299f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko 1300da37705cef30841616ed644ff33455bbc7374db0Cong Wangunregister_netdev: 1301da37705cef30841616ed644ff33455bbc7374db0Cong Wang unregister_netdevice(dev); 1302f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirkodestroy_port: 13035e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller port->count -= 1; 13045e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller if (!port->count) 1305f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko macvlan_port_destroy(lowerdev); 1306f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko 1307f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko return err; 1308b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1309fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_common_newlink); 1310b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1311fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannstatic int macvlan_newlink(struct net *src_net, struct net_device *dev, 1312fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 1313fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann{ 13142f6a1b6607fd6b0eb9501843a40e0c7555f37b4aVlad Yasevich return macvlan_common_newlink(src_net, dev, tb, data); 1315fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann} 1316fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann 1317fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannvoid macvlan_dellink(struct net_device *dev, struct list_head *head) 1318b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1319b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 1320b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 132179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->mode == MACVLAN_MODE_SOURCE) 132279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_flush_sources(vlan->port, vlan); 1323233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko list_del_rcu(&vlan->list); 132423289a37e2b127dfc4de1313fba15bb4c9f0cd5bEric Dumazet unregister_netdevice_queue(dev, head); 13257cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko netdev_upper_dev_unlink(vlan->lowerdev, dev); 1326b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1327fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_dellink); 1328b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 132927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic int macvlan_changelink(struct net_device *dev, 133027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 133127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{ 133227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 1333266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin enum macvlan_mode mode; 1334266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin bool set_mode = false; 133579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun enum macvlan_macaddr_mode macmode; 133679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int ret; 1337266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin 1338266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin /* Validate mode, but don't set yet: setting flags may fail. */ 1339266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin if (data && data[IFLA_MACVLAN_MODE]) { 1340266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin set_mode = true; 1341266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 1342266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin /* Passthrough mode can't be set or cleared dynamically */ 1343266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin if ((mode == MACVLAN_MODE_PASSTHRU) != 1344266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin (vlan->mode == MACVLAN_MODE_PASSTHRU)) 1345266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin return -EINVAL; 134679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->mode == MACVLAN_MODE_SOURCE && 134779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun vlan->mode != mode) 134879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macvlan_flush_sources(vlan->port, vlan); 1349266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin } 135099ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin 1351df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (data && data[IFLA_MACVLAN_FLAGS]) { 1352df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend __u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); 1353df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC; 135499ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin if (vlan->port->passthru && promisc) { 135599ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin int err; 135699ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin 135799ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin if (flags & MACVLAN_FLAG_NOPROMISC) 135899ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin err = dev_set_promiscuity(vlan->lowerdev, -1); 135999ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin else 136099ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin err = dev_set_promiscuity(vlan->lowerdev, 1); 136199ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin if (err < 0) 136299ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin return err; 136399ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin } 1364df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend vlan->flags = flags; 1365df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend } 1366266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin if (set_mode) 1367266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin vlan->mode = mode; 136879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (data && data[IFLA_MACVLAN_MACADDR_MODE]) { 136979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->mode != MACVLAN_MODE_SOURCE) 137079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return -EINVAL; 137179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]); 137279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun ret = macvlan_changelink_sources(vlan, macmode, data); 137379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (ret) 137479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return ret; 137579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 137627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann return 0; 137727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann} 137827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 137979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic size_t macvlan_get_size_mac(const struct macvlan_dev *vlan) 138079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 138179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->macaddr_count == 0) 138279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 138379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return nla_total_size(0) /* IFLA_MACVLAN_MACADDR_DATA */ 138479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun + vlan->macaddr_count * nla_total_size(sizeof(u8) * ETH_ALEN); 138579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 138679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 138727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic size_t macvlan_get_size(const struct net_device *dev) 138827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{ 138979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_dev *vlan = netdev_priv(dev); 139079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 139101fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet return (0 139201fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet + nla_total_size(4) /* IFLA_MACVLAN_MODE */ 139301fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet + nla_total_size(2) /* IFLA_MACVLAN_FLAGS */ 139479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun + nla_total_size(4) /* IFLA_MACVLAN_MACADDR_COUNT */ 139579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun + macvlan_get_size_mac(vlan) /* IFLA_MACVLAN_MACADDR */ 139601fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet ); 139727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann} 139827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 139979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic int macvlan_fill_info_macaddr(struct sk_buff *skb, 140079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const struct macvlan_dev *vlan, 140179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun const int i) 140279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{ 140379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct hlist_head *h = &vlan->port->vlan_source_hash[i]; 140479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct macvlan_source_entry *entry; 140579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 140679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun hlist_for_each_entry_rcu(entry, h, hlist) { 140779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (entry->vlan != vlan) 140879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun continue; 140979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (nla_put(skb, IFLA_MACVLAN_MACADDR, ETH_ALEN, entry->addr)) 141079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 1; 141179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 141279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun return 0; 141379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun} 141479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 141527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic int macvlan_fill_info(struct sk_buff *skb, 141627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann const struct net_device *dev) 141727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{ 141827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 141979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun int i; 142079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun struct nlattr *nest; 142127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 1422ead9a76ceec34df18dc84cb22053253bd5564376David S. Miller if (nla_put_u32(skb, IFLA_MACVLAN_MODE, vlan->mode)) 1423ead9a76ceec34df18dc84cb22053253bd5564376David S. Miller goto nla_put_failure; 1424df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend if (nla_put_u16(skb, IFLA_MACVLAN_FLAGS, vlan->flags)) 1425df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend goto nla_put_failure; 142679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (nla_put_u32(skb, IFLA_MACVLAN_MACADDR_COUNT, vlan->macaddr_count)) 142779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun goto nla_put_failure; 142879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (vlan->macaddr_count > 0) { 142979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nest = nla_nest_start(skb, IFLA_MACVLAN_MACADDR_DATA); 143079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (nest == NULL) 143179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun goto nla_put_failure; 143279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun 143379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 143479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun if (macvlan_fill_info_macaddr(skb, vlan, i)) 143579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun goto nla_put_failure; 143679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 143779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun nla_nest_end(skb, nest); 143879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun } 143927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann return 0; 144027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 144127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannnla_put_failure: 144227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann return -EMSGSIZE; 144327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann} 144427c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 144527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = { 1446df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend [IFLA_MACVLAN_MODE] = { .type = NLA_U32 }, 1447df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend [IFLA_MACVLAN_FLAGS] = { .type = NLA_U16 }, 144879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun [IFLA_MACVLAN_MACADDR_MODE] = { .type = NLA_U32 }, 144979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun [IFLA_MACVLAN_MACADDR] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN }, 145079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun [IFLA_MACVLAN_MACADDR_DATA] = { .type = NLA_NESTED }, 145179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun [IFLA_MACVLAN_MACADDR_COUNT] = { .type = NLA_U32 }, 145227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann}; 145327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann 1454fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannint macvlan_link_register(struct rtnl_link_ops *ops) 1455fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann{ 1456fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann /* common fields */ 1457fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->priv_size = sizeof(struct macvlan_dev); 1458fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->validate = macvlan_validate; 1459fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->maxtype = IFLA_MACVLAN_MAX; 1460fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->policy = macvlan_policy; 1461fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->changelink = macvlan_changelink; 1462fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->get_size = macvlan_get_size; 1463fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann ops->fill_info = macvlan_fill_info; 1464fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann 1465fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann return rtnl_link_register(ops); 1466fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann}; 1467fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_link_register); 1468fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann 1469fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannstatic struct rtnl_link_ops macvlan_link_ops = { 1470b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .kind = "macvlan", 14718a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu .setup = macvlan_setup, 1472b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .newlink = macvlan_newlink, 1473b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .dellink = macvlan_dellink, 1474b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}; 1475b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1476b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_device_event(struct notifier_block *unused, 1477b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unsigned long event, void *ptr) 1478b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1479351638e7deeed2ec8ce451b53d33921b3da68f83Jiri Pirko struct net_device *dev = netdev_notifier_info_to_dev(ptr); 1480b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_dev *vlan, *next; 1481b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy struct macvlan_port *port; 1482226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet LIST_HEAD(list_kill); 1483b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1484a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko if (!macvlan_port_exists(dev)) 1485b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return NOTIFY_DONE; 1486b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1487e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet port = macvlan_port_get_rtnl(dev); 1488a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko 1489b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy switch (event) { 1490b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy case NETDEV_CHANGE: 1491b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy list_for_each_entry(vlan, &port->vlans, list) 1492fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney netif_stacked_transfer_operstate(vlan->lowerdev, 1493fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney vlan->dev); 1494b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy break; 1495b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy case NETDEV_FEAT_CHANGE: 1496b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy list_for_each_entry(vlan, &port->vlans, list) { 14978c2acc53fd7987493f11640e266cf7130591e764Patrick McHardy vlan->dev->gso_max_size = dev->gso_max_size; 1498797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal netdev_update_features(vlan->dev); 1499b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 1500b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy break; 15013763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong case NETDEV_CHANGEMTU: 15023763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong list_for_each_entry(vlan, &port->vlans, list) { 15033763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong if (vlan->dev->mtu <= dev->mtu) 15043763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong continue; 15053763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong dev_set_mtu(vlan->dev, dev->mtu); 15063763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong } 15073763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong break; 1508e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong case NETDEV_CHANGEADDR: 1509e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (!port->passthru) 1510e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return NOTIFY_DONE; 1511e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 1512e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong vlan = list_first_entry_or_null(&port->vlans, 1513e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong struct macvlan_dev, 1514e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong list); 1515e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 1516e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong if (macvlan_sync_address(vlan->dev, dev->dev_addr)) 1517e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong return NOTIFY_BAD; 1518e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong 1519e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong break; 1520b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy case NETDEV_UNREGISTER: 15213b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter /* twiddle thumbs on netns device moves */ 15223b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter if (dev->reg_state != NETREG_UNREGISTERING) 15233b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter break; 15243b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter 1525b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy list_for_each_entry_safe(vlan, next, &port->vlans, list) 1526226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet vlan->dev->rtnl_link_ops->dellink(vlan->dev, &list_kill); 1527226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet unregister_netdevice_many(&list_kill); 1528b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy break; 15291c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko case NETDEV_PRE_TYPE_CHANGE: 15301c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko /* Forbid underlaying device to change its type. */ 15311c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko return NOTIFY_BAD; 15324c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich 15334c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich case NETDEV_NOTIFY_PEERS: 15344c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich case NETDEV_BONDING_FAILOVER: 15354c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich case NETDEV_RESEND_IGMP: 15364c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich /* Propagate to all vlans */ 15374c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich list_for_each_entry(vlan, &port->vlans, list) 15384c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich call_netdevice_notifiers(event, vlan->dev); 1539b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy } 1540b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return NOTIFY_DONE; 1541b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1542b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1543b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct notifier_block macvlan_notifier_block __read_mostly = { 1544b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy .notifier_call = macvlan_device_event, 1545b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}; 1546b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1547b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int __init macvlan_init_module(void) 1548b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1549b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy int err; 1550b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1551b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy register_netdevice_notifier(&macvlan_notifier_block); 1552b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1553fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann err = macvlan_link_register(&macvlan_link_ops); 1554b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy if (err < 0) 1555b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy goto err1; 1556b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return 0; 1557b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyerr1: 1558b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 1559b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy return err; 1560b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1561b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1562b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void __exit macvlan_cleanup_module(void) 1563b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{ 1564b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy rtnl_link_unregister(&macvlan_link_ops); 1565b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 1566b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy} 1567b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1568b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_init(macvlan_init_module); 1569b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_exit(macvlan_cleanup_module); 1570b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy 1571b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_LICENSE("GPL"); 1572b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); 1573b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_DESCRIPTION("Driver for MAC address based VLANs"); 1574b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_ALIAS_RTNL_LINK("macvlan"); 1575