macvlan.c revision 618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9
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>
29b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/if_link.h>
30b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <linux/if_macvlan.h>
31b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#include <net/rtnetlink.h>
32618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann#include <net/xfrm.h>
33b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
34b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_HASH_SIZE	(1 << BITS_PER_BYTE)
35b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
36618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannenum macvlan_mode {
37618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	MACVLAN_MODE_PRIVATE	= 1,
38618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	MACVLAN_MODE_VEPA	= 2,
39618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	MACVLAN_MODE_BRIDGE	= 4,
40618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann};
41618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
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;
46b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
47b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
48fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet/**
49fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet *	struct macvlan_rx_stats - MACVLAN percpu rx stats
50fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet *	@rx_packets: number of received packets
51fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet *	@rx_bytes: number of received bytes
52fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet *	@multicast: number of received multicast packets
53fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet *	@rx_errors: number of errors
54fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet */
55fccaf71011b171883efee5bae321eac4760584d1Eric Dumazetstruct macvlan_rx_stats {
56fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	unsigned long rx_packets;
57fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	unsigned long rx_bytes;
58fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	unsigned long multicast;
59fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	unsigned long rx_errors;
60fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet};
61fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
62b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystruct macvlan_dev {
63b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device	*dev;
64b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct list_head	list;
65b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct hlist_node	hlist;
66b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port	*port;
67b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device	*lowerdev;
68fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct macvlan_rx_stats *rx_stats;
69618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	enum macvlan_mode	mode;
70b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
71b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
72b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
73b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port,
74b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy					       const unsigned char *addr)
75b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
76b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan;
77b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct hlist_node *n;
78b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
79b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) {
80ac06713d55d450cbc9ef871b1b238409238f0fe0Eric Dumazet		if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr))
81b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return vlan;
82b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
83b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return NULL;
84b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
85b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
86f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic void macvlan_hash_add(struct macvlan_dev *vlan)
87f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{
88f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	struct macvlan_port *port = vlan->port;
89f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	const unsigned char *addr = vlan->dev->dev_addr;
90f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
91f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]);
92f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman}
93f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
94f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic void macvlan_hash_del(struct macvlan_dev *vlan)
95f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{
96f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	hlist_del_rcu(&vlan->hlist);
97f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	synchronize_rcu();
98f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman}
99f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
100f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic void macvlan_hash_change_addr(struct macvlan_dev *vlan,
101f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman					const unsigned char *addr)
102f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{
103f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	macvlan_hash_del(vlan);
104f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	/* Now that we are unhashed it is safe to change the device
105f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	 * address without confusing packet delivery.
106f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	 */
107f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	memcpy(vlan->dev->dev_addr, addr, ETH_ALEN);
108f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	macvlan_hash_add(vlan);
109f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman}
110f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
111f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biedermanstatic int macvlan_addr_busy(const struct macvlan_port *port,
112f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman				const unsigned char *addr)
113f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman{
114f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	/* Test to see if the specified multicast address is
115f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	 * currently in use by the underlying device or
116f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	 * another macvlan.
117f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	 */
118ac06713d55d450cbc9ef871b1b238409238f0fe0Eric Dumazet	if (!compare_ether_addr_64bits(port->dev->dev_addr, addr))
119f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		return 1;
120f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
121f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	if (macvlan_hash_lookup(port, addr))
122f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		return 1;
123f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
124f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	return 0;
125f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman}
126f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
127a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmannstatic inline void macvlan_count_rx(const struct macvlan_dev *vlan,
128a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann				    unsigned int len, bool success,
129a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann				    bool multicast)
130a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann{
131a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	struct macvlan_rx_stats *rx_stats;
132a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann
133a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	rx_stats = per_cpu_ptr(vlan->rx_stats, smp_processor_id());
134a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	if (likely(success)) {
135a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		rx_stats->rx_packets++;;
136a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		rx_stats->rx_bytes += len;
137a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		if (multicast)
138a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann			rx_stats->multicast++;
139a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	} else {
140a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		rx_stats->rx_errors++;
141a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	}
142a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann}
143a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann
144a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmannstatic int macvlan_broadcast_one(struct sk_buff *skb, struct net_device *dev,
145618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann				 const struct ethhdr *eth, bool local)
146a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann{
147a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	if (!skb)
148a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		return NET_RX_DROP;
149a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann
150618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	if (local)
151618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		return dev_forward_skb(dev, skb);
152618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
153a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	skb->dev = dev;
154a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	if (!compare_ether_addr_64bits(eth->h_dest,
155a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann				       dev->broadcast))
156a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		skb->pkt_type = PACKET_BROADCAST;
157a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	else
158a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann		skb->pkt_type = PACKET_MULTICAST;
159a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann
160a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	return netif_rx(skb);
161a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann}
162a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann
163b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_broadcast(struct sk_buff *skb,
164618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			      const struct macvlan_port *port,
165618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			      struct net_device *src,
166618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			      enum macvlan_mode mode)
167b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
168b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct ethhdr *eth = eth_hdr(skb);
169b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_dev *vlan;
170b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct hlist_node *n;
171b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct sk_buff *nskb;
172b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unsigned int i;
173a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	int err;
174b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
175efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy	if (skb->protocol == htons(ETH_P_PAUSE))
176efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy		return;
177efbbced361f3ff4ff9e85310ccff894185c4d904Patrick McHardy
178b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
179b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) {
180618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			if (vlan->dev == src || !(vlan->mode & mode))
181618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann				continue;
182618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
183b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			nskb = skb_clone(skb, GFP_ATOMIC);
184618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			err = macvlan_broadcast_one(nskb, vlan->dev, eth,
185618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					 mode == MACVLAN_MODE_BRIDGE);
186a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann			macvlan_count_rx(vlan, skb->len + ETH_HLEN,
187a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann					 err == NET_RX_SUCCESS, 1);
188b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		}
189b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
190b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
191b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
192b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy/* called under rcu_read_lock() from netif_receive_skb */
193b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct sk_buff *macvlan_handle_frame(struct sk_buff *skb)
194b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
195b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct ethhdr *eth = eth_hdr(skb);
196b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_port *port;
197b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_dev *vlan;
198618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_dev *src;
199b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *dev;
200a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	unsigned int len;
201b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
202b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port = rcu_dereference(skb->dev->macvlan_port);
203b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (port == NULL)
204b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return skb;
205b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
206b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (is_multicast_ether_addr(eth->h_dest)) {
207618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		src = macvlan_hash_lookup(port, eth->h_source);
208618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		if (!src)
209618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			/* frame comes from an external address */
210618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_broadcast(skb, port, NULL,
211618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_PRIVATE |
212618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_VEPA    |
213618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_BRIDGE);
214618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		else if (src->mode == MACVLAN_MODE_VEPA)
215618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			/* flood to everyone except source */
216618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_broadcast(skb, port, src->dev,
217618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_VEPA |
218618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_BRIDGE);
219618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		else if (src->mode == MACVLAN_MODE_BRIDGE)
220618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			/*
221618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			 * flood only to VEPA ports, bridge ports
222618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			 * already saw the frame on the way out.
223618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			 */
224618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_broadcast(skb, port, src->dev,
225618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					  MACVLAN_MODE_VEPA);
226b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return skb;
227b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
228b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
229b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan = macvlan_hash_lookup(port, eth->h_dest);
230b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (vlan == NULL)
231b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return skb;
232b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
233b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev = vlan->dev;
234b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (unlikely(!(dev->flags & IFF_UP))) {
235b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		kfree_skb(skb);
236b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return NULL;
237b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
238a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	len = skb->len + ETH_HLEN;
239b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb = skb_share_check(skb, GFP_ATOMIC);
240a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	macvlan_count_rx(vlan, len, skb != NULL, 0);
241a1e514c5d0397b5581721aad9b303f7df83b103dArnd Bergmann	if (!skb)
242b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return NULL;
243b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
244b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb->dev = dev;
245b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	skb->pkt_type = PACKET_HOST;
246b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
247b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	netif_rx(skb);
248b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return NULL;
249b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
250b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
251618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannstatic int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev)
252618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann{
253618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_dev *vlan = netdev_priv(dev);
254618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_port *port = vlan->port;
255618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	const struct macvlan_dev *dest;
256618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
257618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	if (vlan->mode == MACVLAN_MODE_BRIDGE) {
258618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		const struct ethhdr *eth = (void *)skb->data;
259618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
260618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		/* send to other bridge ports directly */
261618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		if (is_multicast_ether_addr(eth->h_dest)) {
262618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE);
263618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			goto xmit_world;
264618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		}
265618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
266618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		dest = macvlan_hash_lookup(port, eth->h_dest);
267618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		if (dest && dest->mode == MACVLAN_MODE_BRIDGE) {
268618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			unsigned int length = skb->len + ETH_HLEN;
269618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			int ret = dev_forward_skb(dest->dev, skb);
270618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			macvlan_count_rx(dest, length,
271618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann					 ret == NET_RX_SUCCESS, 0);
272618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
273618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann			return NET_XMIT_SUCCESS;
274618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann		}
275618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	}
276618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
277618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmannxmit_world:
278618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	skb->dev = vlan->lowerdev;
279618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	return dev_queue_xmit(skb);
280618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann}
281618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann
282424efe9caf6047ffbcd6b383ff4d2347254aabf1Stephen Hemmingerstatic netdev_tx_t macvlan_start_xmit(struct sk_buff *skb,
283424efe9caf6047ffbcd6b383ff4d2347254aabf1Stephen Hemminger				      struct net_device *dev)
284b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
2852c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	int i = skb_get_queue_mapping(skb);
2862c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	struct netdev_queue *txq = netdev_get_tx_queue(dev, i);
287b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unsigned int len = skb->len;
288b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int ret;
289b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
290618e1b7482f7a8a4c6c6e8ccbe140e4c331df4e9Arnd Bergmann	ret = macvlan_queue_xmit(skb, dev);
291b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (likely(ret == NET_XMIT_SUCCESS)) {
2922c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet		txq->tx_packets++;
2932c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet		txq->tx_bytes += len;
2942c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	} else
2952c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet		txq->tx_dropped++;
2962c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
297cbbef5e183079455763fc470ccf69008f92ab4b6Patrick McHardy	return ret;
298b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
299b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
300b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev,
3013b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger			       unsigned short type, const void *daddr,
3023b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger			       const void *saddr, unsigned len)
303b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
304b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_dev *vlan = netdev_priv(dev);
305b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
306b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
3070c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger	return dev_hard_header(skb, lowerdev, type, daddr,
3080c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger			       saddr ? : dev->dev_addr, len);
309b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
310b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
3113b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemmingerstatic const struct header_ops macvlan_hard_header_ops = {
3123b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.create  	= macvlan_hard_header,
3133b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.rebuild	= eth_rebuild_header,
3143b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.parse		= eth_header_parse,
3153b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.cache		= eth_header_cache,
3163b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	.cache_update	= eth_header_cache_update,
3173b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger};
3183b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger
319b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_open(struct net_device *dev)
320b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
321b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
322b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
323b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
324b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
325f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	err = -EBUSY;
326f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	if (macvlan_addr_busy(vlan->port, dev->dev_addr))
327f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		goto out;
328f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
329ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko	err = dev_unicast_add(lowerdev, dev->dev_addr);
330b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (err < 0)
331b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		goto out;
332b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	if (dev->flags & IFF_ALLMULTI) {
333b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		err = dev_set_allmulti(lowerdev, 1);
334b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen		if (err < 0)
335b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen			goto del_unicast;
336b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	}
337f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	macvlan_hash_add(vlan);
338b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
339b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen
340b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chendel_unicast:
341ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko	dev_unicast_delete(lowerdev, dev->dev_addr);
342b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chenout:
343b89fb7da2f9a69dd34ff10d45f66baa40ff8c0e5Wang Chen	return err;
344b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
345b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
346b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_stop(struct net_device *dev)
347b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
348b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
349b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
350b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
351b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev_mc_unsync(lowerdev, dev);
352b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (dev->flags & IFF_ALLMULTI)
353b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		dev_set_allmulti(lowerdev, -1);
354b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
355ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko	dev_unicast_delete(lowerdev, dev->dev_addr);
356b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
357f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	macvlan_hash_del(vlan);
358b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
359b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
360b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
361ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardystatic int macvlan_set_mac_address(struct net_device *dev, void *p)
362ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy{
363ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
364ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
365ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	struct sockaddr *addr = p;
366ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	int err;
367ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
368ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	if (!is_valid_ether_addr(addr->sa_data))
369ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy		return -EADDRNOTAVAIL;
370ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
371f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	if (!(dev->flags & IFF_UP)) {
372f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		/* Just copy in the new address */
373f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN);
374f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	} else {
375f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		/* Rehash and update the device filters */
376f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		if (macvlan_addr_busy(vlan->port, addr->sa_data))
377f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman			return -EBUSY;
378ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
379ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko		err = dev_unicast_add(lowerdev, addr->sa_data);
380ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko		if (err)
381f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman			return err;
382ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
383ccffad25b5136958d4769ed6de5e87992dd9c65cJiri Pirko		dev_unicast_delete(lowerdev, dev->dev_addr);
384f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman
385f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman		macvlan_hash_change_addr(vlan, addr->sa_data);
386f9ac30f080d23ef0a2d4a1b7c6806c9a21c0f324Eric Biederman	}
387ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy	return 0;
388ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy}
389ad5d20a63940fcfb40af76ba06148f36d5d0b433Patrick McHardy
390b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_change_rx_flags(struct net_device *dev, int change)
391b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
392b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
393b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev = vlan->lowerdev;
394b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
395b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (change & IFF_ALLMULTI)
396b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1);
397b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
398b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
399b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_set_multicast_list(struct net_device *dev)
400b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
401b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
402b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
403b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev_mc_sync(vlan->lowerdev, dev);
404b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
405b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
406b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_change_mtu(struct net_device *dev, int new_mtu)
407b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
408b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
409b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
410b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu)
411b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
412b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->mtu = new_mtu;
413b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
414b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
415b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
416b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy/*
417b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * macvlan network devices have devices nesting below it and are a special
418b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * "super class" of normal network devices; split their locks off into a
419b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy * separate class since they always nest.
420b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy */
421b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct lock_class_key macvlan_netdev_xmit_lock_key;
422cf508b1211dbe576778ff445ea1b4b0bcfa5c4eaDavid S. Millerstatic struct lock_class_key macvlan_netdev_addr_lock_key;
423b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
424b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_FEATURES \
425b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	(NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
426b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	 NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
427b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	 NETIF_F_TSO_ECN | NETIF_F_TSO6)
428b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
429b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy#define MACVLAN_STATE_MASK \
430b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))
431b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
432e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Millerstatic void macvlan_set_lockdep_class_one(struct net_device *dev,
433e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller					  struct netdev_queue *txq,
434e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller					  void *_unused)
435c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{
436c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller	lockdep_set_class(&txq->_xmit_lock,
437c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller			  &macvlan_netdev_xmit_lock_key);
438c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller}
439c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
440c773e847ea8f6812804e40f52399c6921a00eab1David S. Millerstatic void macvlan_set_lockdep_class(struct net_device *dev)
441c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller{
442cf508b1211dbe576778ff445ea1b4b0bcfa5c4eaDavid S. Miller	lockdep_set_class(&dev->addr_list_lock,
443cf508b1211dbe576778ff445ea1b4b0bcfa5c4eaDavid S. Miller			  &macvlan_netdev_addr_lock_key);
444e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller	netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL);
445c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller}
446c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
447b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_init(struct net_device *dev)
448b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
449b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
450b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct net_device *lowerdev = vlan->lowerdev;
451b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
452b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->state		= (dev->state & ~MACVLAN_STATE_MASK) |
453b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy				  (lowerdev->state & MACVLAN_STATE_MASK);
454b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->features 		= lowerdev->features & MACVLAN_FEATURES;
455b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->iflink		= lowerdev->ifindex;
456ef5c89967d50042b29937fb724e057c1aa3c5207sg.tweak@gmail.com	dev->hard_header_len	= lowerdev->hard_header_len;
457b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
458c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller	macvlan_set_lockdep_class(dev);
459c773e847ea8f6812804e40f52399c6921a00eab1David S. Miller
460fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	vlan->rx_stats = alloc_percpu(struct macvlan_rx_stats);
461fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	if (!vlan->rx_stats)
462fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		return -ENOMEM;
463fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
464b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
465b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
466b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
467fccaf71011b171883efee5bae321eac4760584d1Eric Dumazetstatic void macvlan_uninit(struct net_device *dev)
468fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{
469fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct macvlan_dev *vlan = netdev_priv(dev);
470fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
471fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	free_percpu(vlan->rx_stats);
472fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet}
473fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
474fccaf71011b171883efee5bae321eac4760584d1Eric Dumazetstatic struct net_device_stats *macvlan_dev_get_stats(struct net_device *dev)
475fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet{
476fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct net_device_stats *stats = &dev->stats;
477fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	struct macvlan_dev *vlan = netdev_priv(dev);
478fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
479fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	dev_txq_stats_fold(dev, stats);
480fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
481fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	if (vlan->rx_stats) {
482fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		struct macvlan_rx_stats *p, rx = {0};
483fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		int i;
484fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
485fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		for_each_possible_cpu(i) {
486fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet			p = per_cpu_ptr(vlan->rx_stats, i);
487fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet			rx.rx_packets += p->rx_packets;
488fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet			rx.rx_bytes   += p->rx_bytes;
489fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet			rx.rx_errors  += p->rx_errors;
490fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet			rx.multicast  += p->multicast;
491fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		}
492fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		stats->rx_packets = rx.rx_packets;
493fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		stats->rx_bytes   = rx.rx_bytes;
494fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		stats->rx_errors  = rx.rx_errors;
495fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		stats->rx_dropped = rx.rx_errors;
496fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet		stats->multicast  = rx.multicast;
497fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	}
498fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	return stats;
499fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet}
500fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet
501b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_ethtool_get_drvinfo(struct net_device *dev,
502b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy					struct ethtool_drvinfo *drvinfo)
503b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
504b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	snprintf(drvinfo->driver, 32, "macvlan");
505b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	snprintf(drvinfo->version, 32, "0.1");
506b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
507b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
508b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic u32 macvlan_ethtool_get_rx_csum(struct net_device *dev)
509b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
510b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct macvlan_dev *vlan = netdev_priv(dev);
511b1b67dd45a6b629eb41553856805aaa1614fbb83Patrick McHardy	return dev_ethtool_get_rx_csum(vlan->lowerdev);
512b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
513b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
5149edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemmingerstatic int macvlan_ethtool_get_settings(struct net_device *dev,
5159edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger					struct ethtool_cmd *cmd)
5169edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger{
5179edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	const struct macvlan_dev *vlan = netdev_priv(dev);
518b1b67dd45a6b629eb41553856805aaa1614fbb83Patrick McHardy	return dev_ethtool_get_settings(vlan->lowerdev, cmd);
5199edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger}
5209edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger
5219edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemmingerstatic u32 macvlan_ethtool_get_flags(struct net_device *dev)
5229edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger{
5239edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	const struct macvlan_dev *vlan = netdev_priv(dev);
524b1b67dd45a6b629eb41553856805aaa1614fbb83Patrick McHardy	return dev_ethtool_get_flags(vlan->lowerdev);
5259edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger}
5269edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger
527b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic const struct ethtool_ops macvlan_ethtool_ops = {
528b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.get_link		= ethtool_op_get_link,
5299edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	.get_settings		= macvlan_ethtool_get_settings,
530b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.get_rx_csum		= macvlan_ethtool_get_rx_csum,
531b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.get_drvinfo		= macvlan_ethtool_get_drvinfo,
5329edb8bb68b5ea63061ba833831b00c229ac9fbd2Stephen Hemminger	.get_flags		= macvlan_ethtool_get_flags,
533b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
534b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
53554a30c975b6b27c0c9268461b647576b146d39bbStephen Hemmingerstatic const struct net_device_ops macvlan_netdev_ops = {
53654a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_init		= macvlan_init,
537fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	.ndo_uninit		= macvlan_uninit,
53854a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_open		= macvlan_open,
53954a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_stop		= macvlan_stop,
540008298231abbeb91bc7be9e8b078607b816d1a4aStephen Hemminger	.ndo_start_xmit		= macvlan_start_xmit,
54154a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_change_mtu		= macvlan_change_mtu,
54254a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_change_rx_flags	= macvlan_change_rx_flags,
54354a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_set_mac_address	= macvlan_set_mac_address,
54454a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_set_multicast_list	= macvlan_set_multicast_list,
545fccaf71011b171883efee5bae321eac4760584d1Eric Dumazet	.ndo_get_stats		= macvlan_dev_get_stats,
54654a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	.ndo_validate_addr	= eth_validate_addr,
54754a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger};
54854a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger
549b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_setup(struct net_device *dev)
550b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
551b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	ether_setup(dev);
552b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
55393f154b594fe47e4a7e5358b309add449a046cd3Eric Dumazet	dev->priv_flags	       &= ~IFF_XMIT_DST_RELEASE;
55454a30c975b6b27c0c9268461b647576b146d39bbStephen Hemminger	dev->netdev_ops		= &macvlan_netdev_ops;
555b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->destructor		= free_netdev;
5563b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemminger	dev->header_ops		= &macvlan_hard_header_ops,
557b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->ethtool_ops	= &macvlan_ethtool_ops;
558b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	dev->tx_queue_len	= 0;
559b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
560b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
561b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_port_create(struct net_device *dev)
562b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
563b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
564b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unsigned int i;
565b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
566b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK)
567b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
568b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
569b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port = kzalloc(sizeof(*port), GFP_KERNEL);
570b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (port == NULL)
571b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -ENOMEM;
572b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
573b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port->dev = dev;
574b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	INIT_LIST_HEAD(&port->vlans);
575b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	for (i = 0; i < MACVLAN_HASH_SIZE; i++)
576b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		INIT_HLIST_HEAD(&port->vlan_hash[i]);
577b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	rcu_assign_pointer(dev->macvlan_port, port);
578b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
579b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
580b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
581b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_port_destroy(struct net_device *dev)
582b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
583b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port = dev->macvlan_port;
584b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
585b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	rcu_assign_pointer(dev->macvlan_port, NULL);
586b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	synchronize_rcu();
587b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	kfree(port);
588b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
589b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
590b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void macvlan_transfer_operstate(struct net_device *dev)
591b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
592b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
593b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	const struct net_device *lowerdev = vlan->lowerdev;
594b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
595b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (lowerdev->operstate == IF_OPER_DORMANT)
596b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		netif_dormant_on(dev);
597b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	else
598b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		netif_dormant_off(dev);
599b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
600b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (netif_carrier_ok(lowerdev)) {
601b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (!netif_carrier_ok(dev))
602b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			netif_carrier_on(dev);
603b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	} else {
604f12ca5f97b7f99288aff1dc32a91f21c3230fefePatrick McHardy		if (netif_carrier_ok(dev))
605b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			netif_carrier_off(dev);
606b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
607b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
608b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
609b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])
610b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
611b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (tb[IFLA_ADDRESS]) {
612b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
613b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return -EINVAL;
614b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
615b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return -EADDRNOTAVAIL;
616b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
617b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
618b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
619b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
6202c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazetstatic int macvlan_get_tx_queues(struct net *net,
6212c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet				 struct nlattr *tb[],
6222c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet				 unsigned int *num_tx_queues,
6232c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet				 unsigned int *real_num_tx_queues)
6242c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet{
6252c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	struct net_device *real_dev;
6262c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
6272c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	if (!tb[IFLA_LINK])
6282c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet		return -EINVAL;
6292c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
6302c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	real_dev = __dev_get_by_index(net, nla_get_u32(tb[IFLA_LINK]));
6312c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	if (!real_dev)
6322c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet		return -ENODEV;
6332c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
6342c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	*num_tx_queues      = real_dev->num_tx_queues;
6352c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	*real_num_tx_queues = real_dev->real_num_tx_queues;
6362c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	return 0;
6372c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet}
6382c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet
63981adee47dfb608df3ad0b91d230fb3cef75f0060Eric W. Biedermanstatic int macvlan_newlink(struct net *src_net, struct net_device *dev,
640b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			   struct nlattr *tb[], struct nlattr *data[])
641b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
642b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
643b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
644b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *lowerdev;
645b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
646b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
647b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_LINK])
648b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
649b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
65081adee47dfb608df3ad0b91d230fb3cef75f0060Eric W. Biederman	lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
651b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (lowerdev == NULL)
652b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -ENODEV;
653b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
654b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman	/* When creating macvlans on top of other macvlans - use
655b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman	 * the real device as the lowerdev.
656a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy	 */
657b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman	if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) {
658b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman		struct macvlan_dev *lowervlan = netdev_priv(lowerdev);
659b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman		lowerdev = lowervlan->lowerdev;
660b0832a2961022a076c812384435b5f0290b3fc91Eric Biederman	}
661a6ca5f1dbe40470fcb1ecc921769d792a1e77ed9Patrick McHardy
662b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_MTU])
663b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		dev->mtu = lowerdev->mtu;
664b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	else if (dev->mtu > lowerdev->mtu)
665b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return -EINVAL;
666b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
667b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (!tb[IFLA_ADDRESS])
668b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		random_ether_addr(dev->dev_addr);
669b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
670b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (lowerdev->macvlan_port == NULL) {
671b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		err = macvlan_port_create(lowerdev);
672b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		if (err < 0)
673b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			return err;
674b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
675b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port = lowerdev->macvlan_port;
676b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
677b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->lowerdev = lowerdev;
678b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->dev      = dev;
679b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	vlan->port     = port;
680b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
681b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	err = register_netdevice(dev);
682b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (err < 0)
683b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return err;
684b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
685b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	list_add_tail(&vlan->list, &port->vlans);
686b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	macvlan_transfer_operstate(dev);
687b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
688b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
689b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
69023289a37e2b127dfc4de1313fba15bb4c9f0cd5bEric Dumazetstatic void macvlan_dellink(struct net_device *dev, struct list_head *head)
691b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
692b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan = netdev_priv(dev);
693b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port = vlan->port;
694b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
695b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	list_del(&vlan->list);
69623289a37e2b127dfc4de1313fba15bb4c9f0cd5bEric Dumazet	unregister_netdevice_queue(dev, head);
697b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
698b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (list_empty(&port->vlans))
6997312096454b6cd71267eaa3d0efb408e449e9ff3Patrick McHardy		macvlan_port_destroy(port->dev);
700b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
701b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
702b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct rtnl_link_ops macvlan_link_ops __read_mostly = {
703b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.kind		= "macvlan",
704b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.priv_size	= sizeof(struct macvlan_dev),
7052c11455321f37da6fe6cc36353149f9ac9183334Eric Dumazet	.get_tx_queues  = macvlan_get_tx_queues,
706b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.setup		= macvlan_setup,
707b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.validate	= macvlan_validate,
708b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.newlink	= macvlan_newlink,
709b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.dellink	= macvlan_dellink,
710b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
711b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
712b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int macvlan_device_event(struct notifier_block *unused,
713b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy				unsigned long event, void *ptr)
714b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
715b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct net_device *dev = ptr;
716b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_dev *vlan, *next;
717b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	struct macvlan_port *port;
718b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
719b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	port = dev->macvlan_port;
720b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (port == NULL)
721b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		return NOTIFY_DONE;
722b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
723b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	switch (event) {
724b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_CHANGE:
725b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry(vlan, &port->vlans, list)
726b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			macvlan_transfer_operstate(vlan->dev);
727b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
728b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_FEAT_CHANGE:
729b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry(vlan, &port->vlans, list) {
730b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			vlan->dev->features = dev->features & MACVLAN_FEATURES;
731b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy			netdev_features_change(vlan->dev);
732b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		}
733b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
734b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	case NETDEV_UNREGISTER:
735b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		list_for_each_entry_safe(vlan, next, &port->vlans, list)
73623289a37e2b127dfc4de1313fba15bb4c9f0cd5bEric Dumazet			macvlan_dellink(vlan->dev, NULL);
737b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		break;
738b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	}
739b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return NOTIFY_DONE;
740b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
741b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
742b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic struct notifier_block macvlan_notifier_block __read_mostly = {
743b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	.notifier_call	= macvlan_device_event,
744b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy};
745b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
746b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic int __init macvlan_init_module(void)
747b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
748b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	int err;
749b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
750b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	register_netdevice_notifier(&macvlan_notifier_block);
751b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	macvlan_handle_frame_hook = macvlan_handle_frame;
752b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
753b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	err = rtnl_link_register(&macvlan_link_ops);
754b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	if (err < 0)
755b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy		goto err1;
756b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return 0;
757b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyerr1:
75852913246e0056c9c6215a778a3b31b6b9ce5c3efRami Rosen	macvlan_handle_frame_hook = NULL;
759b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unregister_netdevice_notifier(&macvlan_notifier_block);
760b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	return err;
761b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
762b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
763b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardystatic void __exit macvlan_cleanup_module(void)
764b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy{
765b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	rtnl_link_unregister(&macvlan_link_ops);
766b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	macvlan_handle_frame_hook = NULL;
767b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy	unregister_netdevice_notifier(&macvlan_notifier_block);
768b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy}
769b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
770b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_init(macvlan_init_module);
771b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardymodule_exit(macvlan_cleanup_module);
772b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardy
773b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_LICENSE("GPL");
774b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
775b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_DESCRIPTION("Driver for MAC address based VLANs");
776b863ceb7ddcea8c55fcf1d7b2ac591d50aa7ed53Patrick McHardyMODULE_ALIAS_RTNL_LINK("macvlan");
777