macvlan.c revision 79cf79abce71eb7dbc40e2f3121048ca5405cb47
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,
263a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann					 err == NET_RX_SUCCESS, 1);
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
275412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	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);
38279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, 0);
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;
410412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	int ret = NET_RX_DROP;
411412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu
412412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	port = macvlan_port_get_rcu(skb->dev);
413412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	if (is_multicast_ether_addr(eth->h_dest)) {
414412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		skb = ip_check_defrag(skb, IP_DEFRAG_MACVLAN);
415412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		if (!skb)
416412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu			return RX_HANDLER_CONSUMED;
417412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		eth = eth_hdr(skb);
41879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macvlan_forward_source(skb, port, eth->h_source);
419412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		src = macvlan_hash_lookup(port, eth->h_source);
420412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		if (src && src->mode != MACVLAN_MODE_VEPA &&
421412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		    src->mode != MACVLAN_MODE_BRIDGE) {
422729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger			/* forward to original port. */
423729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger			vlan = src;
424412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu			ret = macvlan_broadcast_one(skb, vlan, eth, 0) ?:
425412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu			      netif_rx(skb);
426729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger			goto out;
427729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger		}
428729e72a10930ef765c11a5a35031ba47f18221c4stephen hemminger
429412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		MACVLAN_SKB_CB(skb)->src = src;
430412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu		macvlan_broadcast_enqueue(port, skb);
431412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu
4328a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko		return RX_HANDLER_PASS;
433b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
434b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
43579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	macvlan_forward_source(skb, port, eth->h_source);
436eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	if (port->passthru)
437233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko		vlan = list_first_or_null_rcu(&port->vlans,
438233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko					      struct macvlan_dev, list);
439eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	else
440eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		vlan = macvlan_hash_lookup(port, eth->h_dest);
441b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (vlan == NULL)
4428a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko		return RX_HANDLER_PASS;
443b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
444b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev = vlan->dev;
445b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (unlikely(!(dev->flags & IFF_UP))) {
446b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		kfree_skb(skb);
4478a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko		return RX_HANDLER_CONSUMED;
448b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
449a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	len = skb->len + ETH_HLEN;
450b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb = skb_share_check(skb, GFP_ATOMIC);
451a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	if (!skb)
452ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudrala		goto out;
453b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
454b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb->dev = dev;
455b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb->pkt_type = PACKET_HOST;
456b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
4572f6a1b6607fd6b0eb9501843a40e0c7555f37b4aVlad Yasevich	ret = netif_rx(skb);
458ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudrala
459ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudralaout:
460ba01877f56c3244b21746d3f1537f7647ed97984Sridhar Samudrala	macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, 0);
4618a4eb5734e8d1dc60a8c28576bbbdfdcc643626dJiri Pirko	return RX_HANDLER_CONSUMED;
462b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
463b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
464618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannstatic int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev)
465618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann{
466618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_dev *vlan = netdev_priv(dev);
467618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_port *port = vlan->port;
468618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_dev *dest;
469618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
470618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	if (vlan->mode == MACVLAN_MODE_BRIDGE) {
471618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		const struct ethhdr *eth = (void *)skb->data;
472618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
473618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		/* send to other bridge ports directly */
474618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		if (is_multicast_ether_addr(eth->h_dest)) {
475618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE);
476618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			goto xmit_world;
477618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		}
478618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
479618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		dest = macvlan_hash_lookup(port, eth->h_dest);
480618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		if (dest && dest->mode == MACVLAN_MODE_BRIDGE) {
481a37dd3332319260cce81ac91ce25fcc3a31de997David Ward			/* send to lowerdev first for its network taps */
482cb2d0f3e968bff7c6d262aca3e3ab8d4184e69b2David Ward			dev_forward_skb(vlan->lowerdev, skb);
483618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
484618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			return NET_XMIT_SUCCESS;
485618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		}
486618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	}
487618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
488618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannxmit_world:
48959b9997baba5242997ddc7bd96b1391f5275a5a4David S. Miller	skb->dev = vlan->lowerdev;
490618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	return dev_queue_xmit(skb);
491618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann}
492618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
493688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic inline netdev_tx_t macvlan_netpoll_send_skb(struct macvlan_dev *vlan, struct sk_buff *skb)
494688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{
495688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER
496688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	if (vlan->netpoll)
497688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		netpoll_send_skb(vlan->netpoll, skb);
498688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#else
499688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	BUG();
500688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif
501688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	return NETDEV_TX_OK;
502688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong}
503688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
5040db901bd33f09b0dbf39d12261f689812e343c26stephen hemmingerstatic netdev_tx_t macvlan_start_xmit(struct sk_buff *skb,
5050db901bd33f09b0dbf39d12261f689812e343c26stephen hemminger				      struct net_device *dev)
506b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
507b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unsigned int len = skb->len;
508b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int ret;
509688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct macvlan_dev *vlan = netdev_priv(dev);
510688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
511688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	if (unlikely(netpoll_tx_running(dev)))
512688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		return macvlan_netpoll_send_skb(vlan, skb);
513b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
514a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	if (vlan->fwd_priv) {
515a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		skb->dev = vlan->lowerdev;
516f663dd9aaf9ed124f25f0f8452edf238f087ad50Jason Wang		ret = dev_queue_xmit_accel(skb, vlan->fwd_priv);
517a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	} else {
518a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		ret = macvlan_queue_xmit(skb, dev);
519a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	}
520a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend
5212d6c9ffcca7808f42ba6b953da0ba60e19a9cbbdEric Dumazet	if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
522cdf3e274cf1b36e9a2fef2d175cabc566af841b2Li RongQing		struct vlan_pcpu_stats *pcpu_stats;
5232c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
5248ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		pcpu_stats = this_cpu_ptr(vlan->pcpu_stats);
5258ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		u64_stats_update_begin(&pcpu_stats->syncp);
5268ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		pcpu_stats->tx_packets++;
5278ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		pcpu_stats->tx_bytes += len;
5288ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		u64_stats_update_end(&pcpu_stats->syncp);
5298ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet	} else {
5308ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		this_cpu_inc(vlan->pcpu_stats->tx_dropped);
5318ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet	}
532cbbef5e183079455763fc470ccf69008f92ab4b6Patrick McHardy	return ret;
533b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
534b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
535b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev,
5363b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger			       unsigned short type, const void *daddr,
5373b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger			       const void *saddr, unsigned len)
538b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
539b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_dev *vlan = netdev_priv(dev);
540b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
541b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
5420c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger	return dev_hard_header(skb, lowerdev, type, daddr,
5430c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger			       saddr ? : dev->dev_addr, len);
544b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
545b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
5463b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemmingerstatic const struct header_ops macvlan_hard_header_ops = {
5473b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.create  	= macvlan_hard_header,
5483b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.rebuild	= eth_rebuild_header,
5493b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.parse		= eth_header_parse,
5503b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.cache		= eth_header_cache,
5513b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.cache_update	= eth_header_cache_update,
5523b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger};
5533b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger
554b13ba1b83f524732523db1079e56478b32c85c96Jason Wangstatic struct rtnl_link_ops macvlan_link_ops;
555b13ba1b83f524732523db1079e56478b32c85c96Jason Wang
556b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_open(struct net_device *dev)
557b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
558b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
559b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
560b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
561b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
562eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	if (vlan->port->passthru) {
563787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) {
564787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin			err = dev_set_promiscuity(lowerdev, 1);
565787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin			if (err < 0)
566787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin				goto out;
567787381415cf967c5d6d1d7c5b5bd893376945eddMichael S. Tsirkin		}
568eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		goto hash_add;
569eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	}
570eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala
571b13ba1b83f524732523db1079e56478b32c85c96Jason Wang	if (lowerdev->features & NETIF_F_HW_L2FW_DOFFLOAD &&
572b13ba1b83f524732523db1079e56478b32c85c96Jason Wang	    dev->rtnl_link_ops == &macvlan_link_ops) {
573a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		vlan->fwd_priv =
574a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		      lowerdev->netdev_ops->ndo_dfwd_add_station(lowerdev, dev);
575a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend
576a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		/* If we get a NULL pointer back, or if we get an error
577a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		 * then we should just fall through to the non accelerated path
578a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		 */
579a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		if (IS_ERR_OR_NULL(vlan->fwd_priv)) {
580a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend			vlan->fwd_priv = NULL;
581f663dd9aaf9ed124f25f0f8452edf238f087ad50Jason Wang		} else
582a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend			return 0;
583a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	}
584a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend
585f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	err = -EBUSY;
586f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	if (macvlan_addr_busy(vlan->port, dev->dev_addr))
587f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		goto out;
588f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
589a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko	err = dev_uc_add(lowerdev, dev->dev_addr);
590b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (err < 0)
591b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		goto out;
592b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	if (dev->flags & IFF_ALLMULTI) {
593b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		err = dev_set_allmulti(lowerdev, 1);
594b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		if (err < 0)
595b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen			goto del_unicast;
596b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	}
597eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala
598eb06acdc85585f28864261f28659157848762ee4Sridhar Samudralahash_add:
599f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	macvlan_hash_add(vlan);
600b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
601b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen
602b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chendel_unicast:
603a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko	dev_uc_del(lowerdev, dev->dev_addr);
604b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chenout:
605a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	if (vlan->fwd_priv) {
606a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev,
607a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend							   vlan->fwd_priv);
608a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		vlan->fwd_priv = NULL;
609a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	}
610b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	return err;
611b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
612b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
613b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_stop(struct net_device *dev)
614b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
615b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
616b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
617b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
618a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	if (vlan->fwd_priv) {
619a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev,
620a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend							   vlan->fwd_priv);
621a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		vlan->fwd_priv = NULL;
622a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend		return 0;
623a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	}
624a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend
625df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	dev_uc_unsync(lowerdev, dev);
626df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	dev_mc_unsync(lowerdev, dev);
627df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
628eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	if (vlan->port->passthru) {
629df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC))
630df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend			dev_set_promiscuity(lowerdev, -1);
631eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		goto hash_del;
632eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	}
633eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala
634b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (dev->flags & IFF_ALLMULTI)
635b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		dev_set_allmulti(lowerdev, -1);
636b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
637a748ee2426817a95b1f03012d8f339c45c722ae1Jiri Pirko	dev_uc_del(lowerdev, dev->dev_addr);
638b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
639eb06acdc85585f28864261f28659157848762ee4Sridhar Samudralahash_del:
640449f4544267e73d5db372971da63634707c32299Eric Dumazet	macvlan_hash_del(vlan, !dev->dismantle);
641b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
642b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
643b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
644e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhongstatic int macvlan_sync_address(struct net_device *dev, unsigned char *addr)
645ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy{
646ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
647ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
648ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	int err;
649ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
650f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	if (!(dev->flags & IFF_UP)) {
651f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		/* Just copy in the new address */
652e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		ether_addr_copy(dev->dev_addr, addr);
653f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	} else {
654f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		/* Rehash and update the device filters */
655e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		if (macvlan_addr_busy(vlan->port, addr))
656f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman			return -EBUSY;
657ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
658e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		if (!vlan->port->passthru) {
659e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong			err = dev_uc_add(lowerdev, addr);
660e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong			if (err)
661e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong				return err;
662ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
663e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong			dev_uc_del(lowerdev, dev->dev_addr);
664e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		}
665f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
666e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		macvlan_hash_change_addr(vlan, addr);
667f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	}
668ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	return 0;
669ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy}
670ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
671e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhongstatic int macvlan_set_mac_address(struct net_device *dev, void *p)
672e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong{
673e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	struct macvlan_dev *vlan = netdev_priv(dev);
674e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	struct sockaddr *addr = p;
675e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
676e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	if (!is_valid_ether_addr(addr->sa_data))
677e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		return -EADDRNOTAVAIL;
678e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
679e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	if (vlan->mode == MACVLAN_MODE_PASSTHRU) {
680e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		dev_set_mac_address(vlan->lowerdev, addr);
681e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		return 0;
682e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	}
683e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
684e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	return macvlan_sync_address(dev, addr->sa_data);
685e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong}
686e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
687b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_change_rx_flags(struct net_device *dev, int change)
688b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
689b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
690b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
691b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
692bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen	if (dev->flags & IFF_UP) {
693bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen		if (change & IFF_ALLMULTI)
694bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen			dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1);
695bbeb0eadcf9fe74fb2b9b1a6fea82cd538b1e556Peter Christensen	}
696b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
697b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
698df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabendstatic void macvlan_set_mac_lists(struct net_device *dev)
699b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
700b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
701b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
702cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet	if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) {
703cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		bitmap_fill(vlan->mc_filter, MACVLAN_MC_FILTER_SZ);
704cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet	} else {
705cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		struct netdev_hw_addr *ha;
706cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		DECLARE_BITMAP(filter, MACVLAN_MC_FILTER_SZ);
707cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet
708cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		bitmap_zero(filter, MACVLAN_MC_FILTER_SZ);
709cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		netdev_for_each_mc_addr(ha, dev) {
7103807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet			__set_bit(mc_hash(vlan, ha->addr), filter);
711cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		}
712d527043040740f41192dfd71793f905a998ee4f6Eric Dumazet
7133807ff5899f892abb4f06747c245fd648a2acdc5Eric Dumazet		__set_bit(mc_hash(vlan, dev->broadcast), filter);
714d527043040740f41192dfd71793f905a998ee4f6Eric Dumazet
715cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet		bitmap_copy(vlan->mc_filter, filter, MACVLAN_MC_FILTER_SZ);
716cd431e738509e74726055390c9e5e81e8e7e03ecEric Dumazet	}
717df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	dev_uc_sync(vlan->lowerdev, dev);
718b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev_mc_sync(vlan->lowerdev, dev);
719b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
720b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
721b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_change_mtu(struct net_device *dev, int new_mtu)
722b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
723b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
724b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
725b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu)
726b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
727b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->mtu = new_mtu;
728b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
729b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
730b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
731b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy/*
732b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * macvlan network devices have devices nesting below it and are a special
733b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * "super class" of normal network devices; split their locks off into a
734b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * separate class since they always nest.
735b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy */
736b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct lock_class_key macvlan_netdev_xmit_lock_key;
737cf508b1211dbe576778ff445ea1b4b0bcfa5c4eaDavid S. Millerstatic struct lock_class_key macvlan_netdev_addr_lock_key;
738b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
7398b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich#define ALWAYS_ON_FEATURES \
7408b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich	(NETIF_F_SG | NETIF_F_GEN_CSUM | NETIF_F_GSO_SOFTWARE | NETIF_F_LLTX)
7418b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich
742b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_FEATURES \
743b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	(NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
744b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	 NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
7458d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	 NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \
74628d2b136ca6c7bf7173a43a90f747ecda5b0520dPatrick McHardy	 NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER)
747b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
748b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_STATE_MASK \
749b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))
750b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
751c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevichstatic int macvlan_get_nest_level(struct net_device *dev)
752c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich{
753c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich	return ((struct macvlan_dev *)netdev_priv(dev))->nest_level;
754c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich}
755c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich
756e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Millerstatic void macvlan_set_lockdep_class_one(struct net_device *dev,
757e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller					  struct netdev_queue *txq,
758e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller					  void *_unused)
759c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{
760c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller	lockdep_set_class(&txq->_xmit_lock,
761c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller			  &macvlan_netdev_xmit_lock_key);
762c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller}
763c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
764c773e847ea8f6812804e40f52399c6921a00eab1David S. Millerstatic void macvlan_set_lockdep_class(struct net_device *dev)
765c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{
766c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich	lockdep_set_class_and_subclass(&dev->addr_list_lock,
767c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich				       &macvlan_netdev_addr_lock_key,
768c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich				       macvlan_get_nest_level(dev));
769e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller	netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL);
770c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller}
771c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
772b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_init(struct net_device *dev)
773b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
774b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
775b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct net_device *lowerdev = vlan->lowerdev;
776b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
777b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->state		= (dev->state & ~MACVLAN_STATE_MASK) |
778b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy				  (lowerdev->state & MACVLAN_STATE_MASK);
779b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->features 		= lowerdev->features & MACVLAN_FEATURES;
7808b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich	dev->features		|= ALWAYS_ON_FEATURES;
781081e83a78db9b0ae1f5eabc2dedecc865f509b98Vlad Yasevich	dev->vlan_features	= lowerdev->vlan_features & MACVLAN_FEATURES;
7828c2acc53fd7987493f11640e266cf7130591e764Patrick McHardy	dev->gso_max_size	= lowerdev->gso_max_size;
783b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->iflink		= lowerdev->ifindex;
784ef5c89967d50042b29937fb724e057c1aa3c5207sg.tweak@gmail.com	dev->hard_header_len	= lowerdev->hard_header_len;
785b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
786c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller	macvlan_set_lockdep_class(dev);
787c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
7881c213bd24ad04f4430031d20d740d7783162b099WANG Cong	vlan->pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats);
7898ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet	if (!vlan->pcpu_stats)
790fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		return -ENOMEM;
791fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
792b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
793b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
794b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
795fccaf71011b171883efee5bae321eac4760584d1Eric Dumazetstatic void macvlan_uninit(struct net_device *dev)
796fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{
797fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct macvlan_dev *vlan = netdev_priv(dev);
798d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman	struct macvlan_port *port = vlan->port;
799fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
8008ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet	free_percpu(vlan->pcpu_stats);
801d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman
80279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	macvlan_flush_sources(port, vlan);
8035e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller	port->count -= 1;
8045e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller	if (!port->count)
805d5cd92448fded12c91f7574e49747c5f7d975a8dEric W. Biederman		macvlan_port_destroy(port->dev);
806fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet}
807fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
80828172739f0a276eb8d6ca917b3974c2edb036da3Eric Dumazetstatic struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev,
80928172739f0a276eb8d6ca917b3974c2edb036da3Eric Dumazet							 struct rtnl_link_stats64 *stats)
810fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{
811fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct macvlan_dev *vlan = netdev_priv(dev);
812fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
8138ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet	if (vlan->pcpu_stats) {
814cdf3e274cf1b36e9a2fef2d175cabc566af841b2Li RongQing		struct vlan_pcpu_stats *p;
8158ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes;
8168ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		u32 rx_errors = 0, tx_dropped = 0;
817bc66154efe163a80f269d448572f7906756e9338Eric Dumazet		unsigned int start;
818fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		int i;
819fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
820fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		for_each_possible_cpu(i) {
8218ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			p = per_cpu_ptr(vlan->pcpu_stats, i);
822bc66154efe163a80f269d448572f7906756e9338Eric Dumazet			do {
82357a7744e09867ebcfa0ccf1d6d529caa7728d552Eric W. Biederman				start = u64_stats_fetch_begin_irq(&p->syncp);
824bc66154efe163a80f269d448572f7906756e9338Eric Dumazet				rx_packets	= p->rx_packets;
825bc66154efe163a80f269d448572f7906756e9338Eric Dumazet				rx_bytes	= p->rx_bytes;
826bc66154efe163a80f269d448572f7906756e9338Eric Dumazet				rx_multicast	= p->rx_multicast;
8278ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet				tx_packets	= p->tx_packets;
8288ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet				tx_bytes	= p->tx_bytes;
82957a7744e09867ebcfa0ccf1d6d529caa7728d552Eric W. Biederman			} while (u64_stats_fetch_retry_irq(&p->syncp, start));
8308ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet
8318ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			stats->rx_packets	+= rx_packets;
8328ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			stats->rx_bytes		+= rx_bytes;
8338ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			stats->multicast	+= rx_multicast;
8348ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			stats->tx_packets	+= tx_packets;
8358ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			stats->tx_bytes		+= tx_bytes;
8368ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			/* rx_errors & tx_dropped are u32, updated
8378ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			 * without syncp protection.
8388ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			 */
8398ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			rx_errors	+= p->rx_errors;
8408ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet			tx_dropped	+= p->tx_dropped;
841fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		}
8428ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		stats->rx_errors	= rx_errors;
8438ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		stats->rx_dropped	= rx_errors;
8448ffab51b3dfc54876f145f15b351c41f3f703195Eric Dumazet		stats->tx_dropped	= tx_dropped;
845fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	}
846fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	return stats;
847fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet}
848fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
8498e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirkostatic int macvlan_vlan_rx_add_vid(struct net_device *dev,
85080d5c3689b886308247da295a228a54df49a44f6Patrick McHardy				   __be16 proto, u16 vid)
8518d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend{
8528d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	struct macvlan_dev *vlan = netdev_priv(dev);
8538d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	struct net_device *lowerdev = vlan->lowerdev;
8548d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend
85580d5c3689b886308247da295a228a54df49a44f6Patrick McHardy	return vlan_vid_add(lowerdev, proto, vid);
8568d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend}
8578d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend
8588e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirkostatic int macvlan_vlan_rx_kill_vid(struct net_device *dev,
85980d5c3689b886308247da295a228a54df49a44f6Patrick McHardy				    __be16 proto, u16 vid)
8608d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend{
8618d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	struct macvlan_dev *vlan = netdev_priv(dev);
8628d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	struct net_device *lowerdev = vlan->lowerdev;
8638d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend
86480d5c3689b886308247da295a228a54df49a44f6Patrick McHardy	vlan_vid_del(lowerdev, proto, vid);
8658e586137e6b63af1e881b328466ab5ffbe562510Jiri Pirko	return 0;
8668d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend}
8678d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend
868edc7d57327bd08bfd04f41531d49b176369db218stephen hemmingerstatic int macvlan_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
869df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend			   struct net_device *dev,
8706b6e27255f29a6191ef8ad96bfcc392ab2ef6c71stephen hemminger			   const unsigned char *addr,
871df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend			   u16 flags)
872df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend{
873df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	struct macvlan_dev *vlan = netdev_priv(dev);
874df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	int err = -EINVAL;
875df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
8768a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	/* Support unicast filter only on passthru devices.
8778a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	 * Multicast filter should be allowed on all devices.
8788a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	 */
8798a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	if (!vlan->port->passthru && is_unicast_ether_addr(addr))
880df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		return -EOPNOTSUPP;
881df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
882ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter	if (flags & NLM_F_REPLACE)
883ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter		return -EOPNOTSUPP;
884ab2cfbb2bddb7c7bc4394e52e91044d5ff645cb4Thomas Richter
885df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	if (is_unicast_ether_addr(addr))
886df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		err = dev_uc_add_excl(dev, addr);
887df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	else if (is_multicast_ether_addr(addr))
888df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		err = dev_mc_add_excl(dev, addr);
889df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
890df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	return err;
891df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend}
892df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
8931690be63a27b20ae65c792729a44f5970561ffa4Vlad Yasevichstatic int macvlan_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
894df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend			   struct net_device *dev,
8956b6e27255f29a6191ef8ad96bfcc392ab2ef6c71stephen hemminger			   const unsigned char *addr)
896df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend{
897df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	struct macvlan_dev *vlan = netdev_priv(dev);
898df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	int err = -EINVAL;
899df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
9008a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	/* Support unicast filter only on passthru devices.
9018a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	 * Multicast filter should be allowed on all devices.
9028a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	 */
9038a50f11c3b176d7a1df8cd5e29cbe965905e51eeVlad Yasevich	if (!vlan->port->passthru && is_unicast_ether_addr(addr))
904df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		return -EOPNOTSUPP;
905df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
906df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	if (is_unicast_ether_addr(addr))
907df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		err = dev_uc_del(dev, addr);
908df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	else if (is_multicast_ether_addr(addr))
909df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		err = dev_mc_del(dev, addr);
910df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
911df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	return err;
912df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend}
913df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
914b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_ethtool_get_drvinfo(struct net_device *dev,
915b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy					struct ethtool_drvinfo *drvinfo)
916b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
9177826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko	strlcpy(drvinfo->driver, "macvlan", sizeof(drvinfo->driver));
9187826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko	strlcpy(drvinfo->version, "0.1", sizeof(drvinfo->version));
919b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
920b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
9219edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemmingerstatic int macvlan_ethtool_get_settings(struct net_device *dev,
9229edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger					struct ethtool_cmd *cmd)
9239edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger{
9249edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	const struct macvlan_dev *vlan = netdev_priv(dev);
9254bc71cb983fd2844e603bf633df2bb53385182d2Jiri Pirko
9264bc71cb983fd2844e603bf633df2bb53385182d2Jiri Pirko	return __ethtool_get_settings(vlan->lowerdev, cmd);
9279edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger}
9289edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger
9292be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevichstatic netdev_features_t macvlan_fix_features(struct net_device *dev,
9302be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich					      netdev_features_t features)
9312be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich{
9322be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich	struct macvlan_dev *vlan = netdev_priv(dev);
933797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	netdev_features_t mask;
9342be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich
935797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	features |= NETIF_F_ALL_FOR_ALL;
936797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	features &= (vlan->set_features | ~MACVLAN_FEATURES);
937797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	mask = features;
938797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal
939797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	features = netdev_increment_features(vlan->lowerdev->features,
940797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal					     features,
941797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal					     mask);
9428b4703e9bd1172a5f8244276ebb94302e6153e26Vlad Yasevich	features |= ALWAYS_ON_FEATURES;
9430d0162e7a33d3710b9604e7c68c0f31f5c457428Francesco Ruggeri	features &= ~NETIF_F_NETNS_LOCAL;
944797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal
945797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal	return features;
9462be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich}
9472be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich
948688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER
949688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic void macvlan_dev_poll_controller(struct net_device *dev)
950688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{
951688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	return;
952688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong}
953688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
954688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic int macvlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo)
955688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{
956688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct macvlan_dev *vlan = netdev_priv(dev);
957688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct net_device *real_dev = vlan->lowerdev;
958688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct netpoll *netpoll;
959688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	int err = 0;
960688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
961688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL);
962688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	err = -ENOMEM;
963688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	if (!netpoll)
964688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		goto out;
965688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
966688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	err = __netpoll_setup(netpoll, real_dev);
967688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	if (err) {
968688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		kfree(netpoll);
969688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		goto out;
970688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	}
971688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
972688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	vlan->netpoll = netpoll;
973688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
974688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongout:
975688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	return err;
976688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong}
977688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
978688cea83f4396fa98b77a126ed278b89daccccdcdingtianhongstatic void macvlan_dev_netpoll_cleanup(struct net_device *dev)
979688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong{
980688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct macvlan_dev *vlan = netdev_priv(dev);
981688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	struct netpoll *netpoll = vlan->netpoll;
982688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
983688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	if (!netpoll)
984688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong		return;
985688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
986688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	vlan->netpoll = NULL;
987688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
988688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	__netpoll_free_async(netpoll);
989688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong}
990688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif	/* CONFIG_NET_POLL_CONTROLLER */
991688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong
992b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic const struct ethtool_ops macvlan_ethtool_ops = {
993b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.get_link		= ethtool_op_get_link,
9949edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	.get_settings		= macvlan_ethtool_get_settings,
995b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.get_drvinfo		= macvlan_ethtool_get_drvinfo,
996b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
997b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
99854a30c975b6b27c0c9268461b647576b146d39bbStephen Hemmingerstatic const struct net_device_ops macvlan_netdev_ops = {
99954a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_init		= macvlan_init,
1000fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	.ndo_uninit		= macvlan_uninit,
100154a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_open		= macvlan_open,
100254a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_stop		= macvlan_stop,
1003008298231abbeb91bc7be9e8b078607b816d1a4aStephen Hemminger	.ndo_start_xmit		= macvlan_start_xmit,
100454a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_change_mtu		= macvlan_change_mtu,
10052be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich	.ndo_fix_features	= macvlan_fix_features,
100654a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_change_rx_flags	= macvlan_change_rx_flags,
100754a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_set_mac_address	= macvlan_set_mac_address,
1008df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	.ndo_set_rx_mode	= macvlan_set_mac_lists,
1009bc66154efe163a80f269d448572f7906756e9338Eric Dumazet	.ndo_get_stats64	= macvlan_dev_get_stats64,
101054a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_validate_addr	= eth_validate_addr,
10118d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	.ndo_vlan_rx_add_vid	= macvlan_vlan_rx_add_vid,
10128d13e670d3fb83f4668c9e37196c3bbf5b9f094cJohn Fastabend	.ndo_vlan_rx_kill_vid	= macvlan_vlan_rx_kill_vid,
1013df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	.ndo_fdb_add		= macvlan_fdb_add,
1014df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	.ndo_fdb_del		= macvlan_fdb_del,
1015df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	.ndo_fdb_dump		= ndo_dflt_fdb_dump,
1016c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich	.ndo_get_lock_subclass  = macvlan_get_nest_level,
1017688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#ifdef CONFIG_NET_POLL_CONTROLLER
1018688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	.ndo_poll_controller	= macvlan_dev_poll_controller,
1019688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	.ndo_netpoll_setup	= macvlan_dev_netpoll_setup,
1020688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong	.ndo_netpoll_cleanup	= macvlan_dev_netpoll_cleanup,
1021688cea83f4396fa98b77a126ed278b89daccccdcdingtianhong#endif
102254a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger};
102354a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger
10248a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xuvoid macvlan_common_setup(struct net_device *dev)
1025b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1026b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	ether_setup(dev);
1027b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1028550fd08c2cebad61c548def135f67aba284c6162Neil Horman	dev->priv_flags	       &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING);
102987ab7f6f2874f1115817e394a7ed2dea1c72549eVlad Yasevich	dev->priv_flags	       |= IFF_UNICAST_FLT;
103054a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	dev->netdev_ops		= &macvlan_netdev_ops;
1031b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->destructor		= free_netdev;
10327174012955d0e545e5253192e2cd37fedbc405f9Lutz Jaenicke	dev->header_ops		= &macvlan_hard_header_ops;
1033b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->ethtool_ops	= &macvlan_ethtool_ops;
10348a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu}
10358a35747a5d13b99e076b0222729e0caa48cb69b6Herbert XuEXPORT_SYMBOL_GPL(macvlan_common_setup);
10368a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu
10378a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xustatic void macvlan_setup(struct net_device *dev)
10388a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu{
10398a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu	macvlan_common_setup(dev);
1040b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->tx_queue_len	= 0;
1041b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1042b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1043b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_port_create(struct net_device *dev)
1044b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1045b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
1046b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unsigned int i;
1047ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko	int err;
1048b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1049b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK)
1050b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
1051b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1052b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port = kzalloc(sizeof(*port), GFP_KERNEL);
1053b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (port == NULL)
1054b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -ENOMEM;
1055b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1056eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	port->passthru = false;
1057b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port->dev = dev;
1058b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	INIT_LIST_HEAD(&port->vlans);
1059b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	for (i = 0; i < MACVLAN_HASH_SIZE; i++)
1060b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		INIT_HLIST_HEAD(&port->vlan_hash[i]);
106179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	for (i = 0; i < MACVLAN_HASH_SIZE; i++)
106279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		INIT_HLIST_HEAD(&port->vlan_source_hash[i]);
1063ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko
1064412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	skb_queue_head_init(&port->bc_queue);
1065412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	INIT_WORK(&port->bc_work, macvlan_process_broadcast);
1066412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu
1067a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko	err = netdev_rx_handler_register(dev, macvlan_handle_frame, port);
1068a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko	if (err)
1069ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko		kfree(port);
1070d93515611bbc70c2fe4db232e5feb448ed8e4cc9Eric Dumazet	else
1071d93515611bbc70c2fe4db232e5feb448ed8e4cc9Eric Dumazet		dev->priv_flags |= IFF_MACVLAN_PORT;
1072ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko	return err;
1073b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1074b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1075b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_port_destroy(struct net_device *dev)
1076b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1077e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet	struct macvlan_port *port = macvlan_port_get_rtnl(dev);
1078b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1079412ca1550cbecb2cbed6086df51af08aa3452c86Herbert Xu	cancel_work_sync(&port->bc_work);
1080a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko	dev->priv_flags &= ~IFF_MACVLAN_PORT;
1081ab95bfe01f9872459c8678572ccadbf646badad0Jiri Pirko	netdev_rx_handler_unregister(dev);
10826e070aecd9e304264a6b8655f49aa7e6db0e55f2Lai Jiangshan	kfree_rcu(port, rcu);
1083b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1084b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1085b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])
1086b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1087b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (tb[IFLA_ADDRESS]) {
1088b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
1089b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return -EINVAL;
1090b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
1091b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return -EADDRNOTAVAIL;
1092b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
109327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
10941512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin	if (data && data[IFLA_MACVLAN_FLAGS] &&
10951512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin	    nla_get_u16(data[IFLA_MACVLAN_FLAGS]) & ~MACVLAN_FLAG_NOPROMISC)
10961512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin		return -EINVAL;
10971512747820367c8b3b8b72035f0f78c62f2bf1e9Michael S. Tsirkin
109827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	if (data && data[IFLA_MACVLAN_MODE]) {
109927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) {
110027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		case MACVLAN_MODE_PRIVATE:
110127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		case MACVLAN_MODE_VEPA:
110227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		case MACVLAN_MODE_BRIDGE:
1103eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		case MACVLAN_MODE_PASSTHRU:
110479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		case MACVLAN_MODE_SOURCE:
110579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			break;
110679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		default:
110779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
110879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		}
110979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
111079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
111179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
111279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		switch (nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE])) {
111379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		case MACVLAN_MACADDR_ADD:
111479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		case MACVLAN_MACADDR_DEL:
111579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		case MACVLAN_MACADDR_FLUSH:
111679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		case MACVLAN_MACADDR_SET:
111727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann			break;
111827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		default:
111927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann			return -EINVAL;
112027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		}
112127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	}
112279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
112379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data && data[IFLA_MACVLAN_MACADDR]) {
112479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (nla_len(data[IFLA_MACVLAN_MACADDR]) != ETH_ALEN)
112579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
112679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
112779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (!is_valid_ether_addr(nla_data(data[IFLA_MACVLAN_MACADDR])))
112879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EADDRNOTAVAIL;
112979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
113079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
113179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data && data[IFLA_MACVLAN_MACADDR_COUNT])
113279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		return -EINVAL;
113379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
113479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	return 0;
113579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun}
113679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
113779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun/**
113879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * reconfigure list of remote source mac address
113979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * (only for macvlan devices in source mode)
114079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * Note regarding alignment: all netlink data is aligned to 4 Byte, which
114179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun * suffices for both ether_addr_copy and ether_addr_equal_64bits usage.
114279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun */
114379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic int macvlan_changelink_sources(struct macvlan_dev *vlan, u32 mode,
114479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				      struct nlattr *data[])
114579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{
114679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	char *addr = NULL;
114779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	int ret, rem, len;
114879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct nlattr *nla, *head;
114979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct macvlan_source_entry *entry;
115079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
115179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data[IFLA_MACVLAN_MACADDR])
115279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		addr = nla_data(data[IFLA_MACVLAN_MACADDR]);
115379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
115479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (mode == MACVLAN_MACADDR_ADD) {
115579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (!addr)
115679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
115779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
115879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		return macvlan_hash_add_source(vlan, addr);
115979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
116079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	} else if (mode == MACVLAN_MACADDR_DEL) {
116179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (!addr)
116279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
116379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
116479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		entry = macvlan_hash_lookup_source(vlan, addr);
116579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (entry) {
116679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			macvlan_hash_del_source(entry);
116779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			vlan->macaddr_count--;
116879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		}
116979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	} else if (mode == MACVLAN_MACADDR_FLUSH) {
117079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macvlan_flush_sources(vlan->port, vlan);
117179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	} else if (mode == MACVLAN_MACADDR_SET) {
117279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macvlan_flush_sources(vlan->port, vlan);
117379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
117479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (addr) {
117579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			ret = macvlan_hash_add_source(vlan, addr);
117679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			if (ret)
117779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				return ret;
117879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		}
117979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
118079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (!data || !data[IFLA_MACVLAN_MACADDR_DATA])
118179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return 0;
118279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
118379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		head = nla_data(data[IFLA_MACVLAN_MACADDR_DATA]);
118479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		len = nla_len(data[IFLA_MACVLAN_MACADDR_DATA]);
118579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
118679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		nla_for_each_attr(nla, head, len, rem) {
118779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			if (nla_type(nla) != IFLA_MACVLAN_MACADDR ||
118879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			    nla_len(nla) != ETH_ALEN)
118979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				continue;
119079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
119179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			addr = nla_data(nla);
119279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			ret = macvlan_hash_add_source(vlan, addr);
119379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			if (ret)
119479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				return ret;
119579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		}
119679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	} else {
119779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		return -EINVAL;
119879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
119979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
1200b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
1201b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1202b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1203fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannint macvlan_common_newlink(struct net *src_net, struct net_device *dev,
12042f6a1b6607fd6b0eb9501843a40e0c7555f37b4aVlad Yasevich			   struct nlattr *tb[], struct nlattr *data[])
1205b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1206b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
1207b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
1208b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev;
1209b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
121079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	int macmode;
1211b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1212b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_LINK])
1213b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
1214b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
121581adee47dfb608df3ad0b91d230fb3cef75f0060Eric W. Biederman	lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
1216b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (lowerdev == NULL)
1217b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -ENODEV;
1218b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1219d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace	/* When creating macvlans or macvtaps on top of other macvlans - use
1220b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman	 * the real device as the lowerdev.
1221a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy	 */
1222d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace	if (netif_is_macvlan(lowerdev))
1223d70f2cf520cf8c86c6b467fc5dcea524ec51dc2fKevin Wallace		lowerdev = macvlan_dev_real_dev(lowerdev);
1224a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy
1225b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_MTU])
1226b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		dev->mtu = lowerdev->mtu;
1227b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	else if (dev->mtu > lowerdev->mtu)
1228b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
1229b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1230b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_ADDRESS])
12317ce5d222190cb3ce3ae88bafde7c4fa52a5103e0Danny Kukawka		eth_hw_addr_random(dev);
1232b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1233a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko	if (!macvlan_port_exists(lowerdev)) {
1234b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		err = macvlan_port_create(lowerdev);
1235b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (err < 0)
1236b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return err;
1237b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
1238e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet	port = macvlan_port_get_rtnl(lowerdev);
1239b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1240eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	/* Only 1 macvlan device can be created in passthru mode */
1241eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	if (port->passthru)
1242eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		return -EINVAL;
1243eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala
1244b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->lowerdev = lowerdev;
1245b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->dev      = dev;
1246b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->port     = port;
12472be5c76794b0e570aa87b012df5ac864ce668a74Vlad Yasevich	vlan->set_features = MACVLAN_FEATURES;
1248c674ac30c549596295eb0a5af7f4714c0b905b6fVlad Yasevich	vlan->nest_level = dev_get_nest_level(lowerdev, netif_is_macvlan) + 1;
1249b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
125027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	vlan->mode     = MACVLAN_MODE_VEPA;
125127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	if (data && data[IFLA_MACVLAN_MODE])
125227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);
125327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
1254df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	if (data && data[IFLA_MACVLAN_FLAGS])
1255df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		vlan->flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]);
1256df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend
1257eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	if (vlan->mode == MACVLAN_MODE_PASSTHRU) {
12585e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller		if (port->count)
1259eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala			return -EINVAL;
1260eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala		port->passthru = true;
12618b98604e398418b9f1a1e44ac79fbbc134818f50Bjørn Mork		eth_hw_addr_inherit(dev, lowerdev);
1262eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala	}
1263eb06acdc85585f28864261f28659157848762ee4Sridhar Samudrala
126479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
126579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (vlan->mode != MACVLAN_MODE_SOURCE)
126679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
126779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]);
126879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		err = macvlan_changelink_sources(vlan, macmode, data);
126979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (err)
127079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return err;
127179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
127279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
12735e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller	port->count += 1;
127447d4ab91e4472723f181075c81627374ca86816cJohn Fastabend	err = register_netdevice(dev);
127547d4ab91e4472723f181075c81627374ca86816cJohn Fastabend	if (err < 0)
127647d4ab91e4472723f181075c81627374ca86816cJohn Fastabend		goto destroy_port;
127747d4ab91e4472723f181075c81627374ca86816cJohn Fastabend
1278a6cc0cfa72e0b6d9f2c8fd858aacc32313c4f272John Fastabend	dev->priv_flags |= IFF_MACVLAN;
12797cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko	err = netdev_upper_dev_link(lowerdev, dev);
12807cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko	if (err)
1281da37705cef30841616ed644ff33455bbc7374db0Cong Wang		goto unregister_netdev;
1282b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1283233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko	list_add_tail_rcu(&vlan->list, &port->vlans);
1284fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney	netif_stacked_transfer_operstate(lowerdev, dev);
1285f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko
1286b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
1287f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko
1288da37705cef30841616ed644ff33455bbc7374db0Cong Wangunregister_netdev:
1289da37705cef30841616ed644ff33455bbc7374db0Cong Wang	unregister_netdevice(dev);
1290f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirkodestroy_port:
12915e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller	port->count -= 1;
12925e3c516b512c0f8f18359413b04918f6347f67e7David S. Miller	if (!port->count)
1293f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko		macvlan_port_destroy(lowerdev);
1294f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko
1295f16d3d57486cd079b29ae7a6c3b31c90e69c9c44Jiri Pirko	return err;
1296b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1297fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_common_newlink);
1298b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1299fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannstatic int macvlan_newlink(struct net *src_net, struct net_device *dev,
1300fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann			   struct nlattr *tb[], struct nlattr *data[])
1301fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann{
13022f6a1b6607fd6b0eb9501843a40e0c7555f37b4aVlad Yasevich	return macvlan_common_newlink(src_net, dev, tb, data);
1303fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann}
1304fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann
1305fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannvoid macvlan_dellink(struct net_device *dev, struct list_head *head)
1306b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1307b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
1308b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
130979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (vlan->mode == MACVLAN_MODE_SOURCE)
131079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macvlan_flush_sources(vlan->port, vlan);
1311233c7df0821c4190e2d3f4be0f2ca0ab40a5ed8cJiri Pirko	list_del_rcu(&vlan->list);
131223289a37e2b127dfc4de1313fba15bb4c9f0cd5bEric Dumazet	unregister_netdevice_queue(dev, head);
13137cd43db77eed83ce9c2086edb402748256e05f14Jiri Pirko	netdev_upper_dev_unlink(vlan->lowerdev, dev);
1314b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1315fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_dellink);
1316b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
131727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic int macvlan_changelink(struct net_device *dev,
131827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann		struct nlattr *tb[], struct nlattr *data[])
131927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{
132027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	struct macvlan_dev *vlan = netdev_priv(dev);
1321266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	enum macvlan_mode mode;
1322266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	bool set_mode = false;
132379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	enum macvlan_macaddr_mode macmode;
132479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	int ret;
1325266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin
1326266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	/* Validate mode, but don't set yet: setting flags may fail. */
1327266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	if (data && data[IFLA_MACVLAN_MODE]) {
1328266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		set_mode = true;
1329266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);
1330266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		/* Passthrough mode can't be set or cleared dynamically */
1331266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		if ((mode == MACVLAN_MODE_PASSTHRU) !=
1332266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		    (vlan->mode == MACVLAN_MODE_PASSTHRU))
1333266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin			return -EINVAL;
133479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (vlan->mode == MACVLAN_MODE_SOURCE &&
133579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		    vlan->mode != mode)
133679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			macvlan_flush_sources(vlan->port, vlan);
1337266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	}
133899ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin
1339df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	if (data && data[IFLA_MACVLAN_FLAGS]) {
1340df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		__u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]);
1341df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC;
134299ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin		if (vlan->port->passthru && promisc) {
134399ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin			int err;
134499ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin
134599ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin			if (flags & MACVLAN_FLAG_NOPROMISC)
134699ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin				err = dev_set_promiscuity(vlan->lowerdev, -1);
134799ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin			else
134899ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin				err = dev_set_promiscuity(vlan->lowerdev, 1);
134999ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin			if (err < 0)
135099ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin				return err;
135199ffc3e74fb0d9d321d2f19c6021e0dbaff2f4b2Michael S. Tsirkin		}
1352df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		vlan->flags = flags;
1353df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	}
1354266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin	if (set_mode)
1355266e83474c98e9f18d31f4837cfe05819a660d32Michael S. Tsirkin		vlan->mode = mode;
135679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
135779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (vlan->mode != MACVLAN_MODE_SOURCE)
135879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return -EINVAL;
135979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]);
136079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		ret = macvlan_changelink_sources(vlan, macmode, data);
136179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (ret)
136279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return ret;
136379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
136427c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	return 0;
136527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann}
136627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
136779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic size_t macvlan_get_size_mac(const struct macvlan_dev *vlan)
136879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{
136979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (vlan->macaddr_count == 0)
137079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		return 0;
137179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	return nla_total_size(0) /* IFLA_MACVLAN_MACADDR_DATA */
137279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		+ vlan->macaddr_count * nla_total_size(sizeof(u8) * ETH_ALEN);
137379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun}
137479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
137527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic size_t macvlan_get_size(const struct net_device *dev)
137627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{
137779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct macvlan_dev *vlan = netdev_priv(dev);
137879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
137901fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet	return (0
138001fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet		+ nla_total_size(4) /* IFLA_MACVLAN_MODE */
138101fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet		+ nla_total_size(2) /* IFLA_MACVLAN_FLAGS */
138279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		+ nla_total_size(4) /* IFLA_MACVLAN_MACADDR_COUNT */
138379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		+ macvlan_get_size_mac(vlan) /* IFLA_MACVLAN_MACADDR */
138401fe944f1024bd4e5c327ddbe8d657656b66af2fEric Dumazet		);
138527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann}
138627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
138779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braunstatic int macvlan_fill_info_macaddr(struct sk_buff *skb,
138879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				     const struct macvlan_dev *vlan,
138979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				     const int i)
139079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun{
139179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct hlist_head *h = &vlan->port->vlan_source_hash[i];
139279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct macvlan_source_entry *entry;
139379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
139479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	hlist_for_each_entry_rcu(entry, h, hlist) {
139579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (entry->vlan != vlan)
139679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			continue;
139779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (nla_put(skb, IFLA_MACVLAN_MACADDR, ETH_ALEN, entry->addr))
139879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			return 1;
139979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
140079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	return 0;
140179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun}
140279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
140327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic int macvlan_fill_info(struct sk_buff *skb,
140427c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann				const struct net_device *dev)
140527c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann{
140627c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	struct macvlan_dev *vlan = netdev_priv(dev);
140779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	int i;
140879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	struct nlattr *nest;
140927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
1410ead9a76ceec34df18dc84cb22053253bd5564376David S. Miller	if (nla_put_u32(skb, IFLA_MACVLAN_MODE, vlan->mode))
1411ead9a76ceec34df18dc84cb22053253bd5564376David S. Miller		goto nla_put_failure;
1412df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	if (nla_put_u16(skb, IFLA_MACVLAN_FLAGS, vlan->flags))
1413df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend		goto nla_put_failure;
141479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (nla_put_u32(skb, IFLA_MACVLAN_MACADDR_COUNT, vlan->macaddr_count))
141579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		goto nla_put_failure;
141679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	if (vlan->macaddr_count > 0) {
141779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		nest = nla_nest_start(skb, IFLA_MACVLAN_MACADDR_DATA);
141879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		if (nest == NULL)
141979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			goto nla_put_failure;
142079cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun
142179cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
142279cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun			if (macvlan_fill_info_macaddr(skb, vlan, i))
142379cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun				goto nla_put_failure;
142479cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		}
142579cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun		nla_nest_end(skb, nest);
142679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	}
142727c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	return 0;
142827c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
142927c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannnla_put_failure:
143027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann	return -EMSGSIZE;
143127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann}
143227c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
143327c0b1a850cdea6298f573d835782f3337be913cArnd Bergmannstatic const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = {
1434df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	[IFLA_MACVLAN_MODE]  = { .type = NLA_U32 },
1435df8ef8f3aaa6692970a436204c4429210addb23aJohn Fastabend	[IFLA_MACVLAN_FLAGS] = { .type = NLA_U16 },
143679cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	[IFLA_MACVLAN_MACADDR_MODE] = { .type = NLA_U32 },
143779cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	[IFLA_MACVLAN_MACADDR] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
143879cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	[IFLA_MACVLAN_MACADDR_DATA] = { .type = NLA_NESTED },
143979cf79abce71eb7dbc40e2f3121048ca5405cb47Michael Braun	[IFLA_MACVLAN_MACADDR_COUNT] = { .type = NLA_U32 },
144027c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann};
144127c0b1a850cdea6298f573d835782f3337be913cArnd Bergmann
1442fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannint macvlan_link_register(struct rtnl_link_ops *ops)
1443fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann{
1444fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	/* common fields */
1445fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->priv_size		= sizeof(struct macvlan_dev);
1446fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->validate		= macvlan_validate;
1447fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->maxtype		= IFLA_MACVLAN_MAX;
1448fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->policy		= macvlan_policy;
1449fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->changelink		= macvlan_changelink;
1450fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->get_size		= macvlan_get_size;
1451fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	ops->fill_info		= macvlan_fill_info;
1452fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann
1453fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	return rtnl_link_register(ops);
1454fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann};
1455fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd BergmannEXPORT_SYMBOL_GPL(macvlan_link_register);
1456fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann
1457fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmannstatic struct rtnl_link_ops macvlan_link_ops = {
1458b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.kind		= "macvlan",
14598a35747a5d13b99e076b0222729e0caa48cb69b6Herbert Xu	.setup		= macvlan_setup,
1460b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.newlink	= macvlan_newlink,
1461b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.dellink	= macvlan_dellink,
1462b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
1463b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1464b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_device_event(struct notifier_block *unused,
1465b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy				unsigned long event, void *ptr)
1466b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1467351638e7deeed2ec8ce451b53d33921b3da68f83Jiri Pirko	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
1468b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan, *next;
1469b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
1470226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet	LIST_HEAD(list_kill);
1471b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1472a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko	if (!macvlan_port_exists(dev))
1473b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return NOTIFY_DONE;
1474b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1475e052f7e64daae6aa7a7ccd003b3c285d99755afbEric Dumazet	port = macvlan_port_get_rtnl(dev);
1476a35e2c1b6d90544b3c688783869817628e5f9607Jiri Pirko
1477b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	switch (event) {
1478b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_CHANGE:
1479b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry(vlan, &port->vlans, list)
1480fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney			netif_stacked_transfer_operstate(vlan->lowerdev,
1481fc4a7489663250360cd40d5adf06a08d1c5d54dfPatrick Mullaney							 vlan->dev);
1482b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
1483b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_FEAT_CHANGE:
1484b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry(vlan, &port->vlans, list) {
14858c2acc53fd7987493f11640e266cf7130591e764Patrick McHardy			vlan->dev->gso_max_size = dev->gso_max_size;
1486797f87f83b60685ff8a13fa0572d2f10393c50d3Florian Westphal			netdev_update_features(vlan->dev);
1487b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		}
1488b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
14893763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong	case NETDEV_CHANGEMTU:
14903763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong		list_for_each_entry(vlan, &port->vlans, list) {
14913763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong			if (vlan->dev->mtu <= dev->mtu)
14923763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong				continue;
14933763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong			dev_set_mtu(vlan->dev, dev->mtu);
14943763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong		}
14953763e7ef17143f5e9ae044638e65d2b0c0305fcfdingtianhong		break;
1496e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong	case NETDEV_CHANGEADDR:
1497e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		if (!port->passthru)
1498e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong			return NOTIFY_DONE;
1499e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
1500e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		vlan = list_first_entry_or_null(&port->vlans,
1501e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong						struct macvlan_dev,
1502e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong						list);
1503e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
1504e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		if (macvlan_sync_address(vlan->dev, dev->dev_addr))
1505e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong			return NOTIFY_BAD;
1506e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong
1507e289fd28176b78de7e54bf6c8e2b558afefaf6dfdingtianhong		break;
1508b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_UNREGISTER:
15093b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter		/* twiddle thumbs on netns device moves */
15103b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter		if (dev->reg_state != NETREG_UNREGISTERING)
15113b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter			break;
15123b27e105550f7c4a79ecb6d6a9c49c651c59ae9bDavid Lamparter
1513b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry_safe(vlan, next, &port->vlans, list)
1514226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet			vlan->dev->rtnl_link_ops->dellink(vlan->dev, &list_kill);
1515226bd3411471af42f7edbdfaf73f2d54ebb62a66Eric Dumazet		unregister_netdevice_many(&list_kill);
1516b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
15171c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko	case NETDEV_PRE_TYPE_CHANGE:
15181c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko		/* Forbid underlaying device to change its type. */
15191c01fe14a87332cc88266fbd6e598319322eb96fJiri Pirko		return NOTIFY_BAD;
15204c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich
15214c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich	case NETDEV_NOTIFY_PEERS:
15224c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich	case NETDEV_BONDING_FAILOVER:
15234c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich	case NETDEV_RESEND_IGMP:
15244c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich		/* Propagate to all vlans */
15254c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich		list_for_each_entry(vlan, &port->vlans, list)
15264c9912556867bf89e7bb6946fd218a40b1d12139Vlad Yasevich			call_netdevice_notifiers(event, vlan->dev);
1527b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
1528b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return NOTIFY_DONE;
1529b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1530b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1531b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct notifier_block macvlan_notifier_block __read_mostly = {
1532b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.notifier_call	= macvlan_device_event,
1533b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
1534b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1535b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int __init macvlan_init_module(void)
1536b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1537b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
1538b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1539b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	register_netdevice_notifier(&macvlan_notifier_block);
1540b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1541fc0663d6b5e6d8e9b57f872a644c0aafd82361b7Arnd Bergmann	err = macvlan_link_register(&macvlan_link_ops);
1542b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (err < 0)
1543b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		goto err1;
1544b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
1545b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyerr1:
1546b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unregister_netdevice_notifier(&macvlan_notifier_block);
1547b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return err;
1548b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1549b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1550b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void __exit macvlan_cleanup_module(void)
1551b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
1552b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	rtnl_link_unregister(&macvlan_link_ops);
1553b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unregister_netdevice_notifier(&macvlan_notifier_block);
1554b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
1555b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1556b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_init(macvlan_init_module);
1557b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_exit(macvlan_cleanup_module);
1558b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
1559b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_LICENSE("GPL");
1560b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
1561b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_DESCRIPTION("Driver for MAC address based VLANs");
1562b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_ALIAS_RTNL_LINK("macvlan");
1563