macvlan.c 38.8 KB
Newer Older
P
Patrick McHardy 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 * Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * The code this is based on carried the following copyright notice:
 * ---
 * (C) Copyright 2001-2006
 * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com
 * Re-worked by Ben Greear <greearb@candelatech.com>
 * ---
 */
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/string.h>
23
#include <linux/rculist.h>
P
Patrick McHardy 已提交
24 25 26 27 28
#include <linux/notifier.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/if_arp.h>
29
#include <linux/if_vlan.h>
P
Patrick McHardy 已提交
30 31
#include <linux/if_link.h>
#include <linux/if_macvlan.h>
E
Eric Dumazet 已提交
32
#include <linux/hash.h>
33
#include <linux/workqueue.h>
P
Patrick McHardy 已提交
34
#include <net/rtnetlink.h>
35
#include <net/xfrm.h>
D
dingtianhong 已提交
36
#include <linux/netpoll.h>
P
Patrick McHardy 已提交
37

M
Michael Braun 已提交
38 39
#define MACVLAN_HASH_BITS	8
#define MACVLAN_HASH_SIZE	(1<<MACVLAN_HASH_BITS)
40
#define MACVLAN_BC_QUEUE_LEN	1000
P
Patrick McHardy 已提交
41 42 43 44 45

struct macvlan_port {
	struct net_device	*dev;
	struct hlist_head	vlan_hash[MACVLAN_HASH_SIZE];
	struct list_head	vlans;
J
Jiri Pirko 已提交
46
	struct rcu_head		rcu;
47 48
	struct sk_buff_head	bc_queue;
	struct work_struct	bc_work;
49
	bool 			passthru;
50
	int			count;
M
Michael Braun 已提交
51 52 53 54 55 56 57 58
	struct hlist_head	vlan_source_hash[MACVLAN_HASH_SIZE];
};

struct macvlan_source_entry {
	struct hlist_node	hlist;
	struct macvlan_dev	*vlan;
	unsigned char		addr[6+2] __aligned(sizeof(u16));
	struct rcu_head		rcu;
P
Patrick McHardy 已提交
59 60
};

61 62 63 64 65 66
struct macvlan_skb_cb {
	const struct macvlan_dev *src;
};

#define MACVLAN_SKB_CB(__skb) ((struct macvlan_skb_cb *)&((__skb)->cb[0]))

67 68
static void macvlan_port_destroy(struct net_device *dev);

M
Michael Braun 已提交
69 70 71 72 73 74 75 76 77 78 79 80 81 82
/* Hash Ethernet address */
static u32 macvlan_eth_hash(const unsigned char *addr)
{
	u64 value = get_unaligned((u64 *)addr);

	/* only want 6 bytes */
#ifdef __BIG_ENDIAN
	value >>= 16;
#else
	value <<= 16;
#endif
	return hash_64(value, MACVLAN_HASH_BITS);
}

E
Eric Dumazet 已提交
83 84 85 86 87 88 89 90 91 92
static struct macvlan_port *macvlan_port_get_rcu(const struct net_device *dev)
{
	return rcu_dereference(dev->rx_handler_data);
}

static struct macvlan_port *macvlan_port_get_rtnl(const struct net_device *dev)
{
	return rtnl_dereference(dev->rx_handler_data);
}

93 94
#define macvlan_port_exists(dev) (dev->priv_flags & IFF_MACVLAN_PORT)

P
Patrick McHardy 已提交
95 96 97 98
static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port,
					       const unsigned char *addr)
{
	struct macvlan_dev *vlan;
M
Michael Braun 已提交
99
	u32 idx = macvlan_eth_hash(addr);
P
Patrick McHardy 已提交
100

M
Michael Braun 已提交
101
	hlist_for_each_entry_rcu(vlan, &port->vlan_hash[idx], hlist) {
102
		if (ether_addr_equal_64bits(vlan->dev->dev_addr, addr))
P
Patrick McHardy 已提交
103 104 105 106 107
			return vlan;
	}
	return NULL;
}

M
Michael Braun 已提交
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147
static struct macvlan_source_entry *macvlan_hash_lookup_source(
	const struct macvlan_dev *vlan,
	const unsigned char *addr)
{
	struct macvlan_source_entry *entry;
	u32 idx = macvlan_eth_hash(addr);
	struct hlist_head *h = &vlan->port->vlan_source_hash[idx];

	hlist_for_each_entry_rcu(entry, h, hlist) {
		if (ether_addr_equal_64bits(entry->addr, addr) &&
		    entry->vlan == vlan)
			return entry;
	}
	return NULL;
}

static int macvlan_hash_add_source(struct macvlan_dev *vlan,
				   const unsigned char *addr)
{
	struct macvlan_port *port = vlan->port;
	struct macvlan_source_entry *entry;
	struct hlist_head *h;

	entry = macvlan_hash_lookup_source(vlan, addr);
	if (entry)
		return 0;

	entry = kmalloc(sizeof(*entry), GFP_KERNEL);
	if (!entry)
		return -ENOMEM;

	ether_addr_copy(entry->addr, addr);
	entry->vlan = vlan;
	h = &port->vlan_source_hash[macvlan_eth_hash(addr)];
	hlist_add_head_rcu(&entry->hlist, h);
	vlan->macaddr_count++;

	return 0;
}

148 149 150 151
static void macvlan_hash_add(struct macvlan_dev *vlan)
{
	struct macvlan_port *port = vlan->port;
	const unsigned char *addr = vlan->dev->dev_addr;
M
Michael Braun 已提交
152
	u32 idx = macvlan_eth_hash(addr);
153

M
Michael Braun 已提交
154 155 156 157 158 159 160
	hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[idx]);
}

static void macvlan_hash_del_source(struct macvlan_source_entry *entry)
{
	hlist_del_rcu(&entry->hlist);
	kfree_rcu(entry, rcu);
161 162
}

163
static void macvlan_hash_del(struct macvlan_dev *vlan, bool sync)
164 165
{
	hlist_del_rcu(&vlan->hlist);
166 167
	if (sync)
		synchronize_rcu();
168 169 170 171 172
}

static void macvlan_hash_change_addr(struct macvlan_dev *vlan,
					const unsigned char *addr)
{
173
	macvlan_hash_del(vlan, true);
174 175 176 177 178 179 180 181 182 183 184 185 186 187
	/* Now that we are unhashed it is safe to change the device
	 * address without confusing packet delivery.
	 */
	memcpy(vlan->dev->dev_addr, addr, ETH_ALEN);
	macvlan_hash_add(vlan);
}

static int macvlan_addr_busy(const struct macvlan_port *port,
				const unsigned char *addr)
{
	/* Test to see if the specified multicast address is
	 * currently in use by the underlying device or
	 * another macvlan.
	 */
188
	if (ether_addr_equal_64bits(port->dev->dev_addr, addr))
189 190 191 192 193 194 195 196
		return 1;

	if (macvlan_hash_lookup(port, addr))
		return 1;

	return 0;
}

A
Arnd Bergmann 已提交
197

198 199
static int macvlan_broadcast_one(struct sk_buff *skb,
				 const struct macvlan_dev *vlan,
200
				 const struct ethhdr *eth, bool local)
A
Arnd Bergmann 已提交
201
{
202
	struct net_device *dev = vlan->dev;
A
Arnd Bergmann 已提交
203

204
	if (local)
205
		return __dev_forward_skb(dev, skb);
206

A
Arnd Bergmann 已提交
207
	skb->dev = dev;
208
	if (ether_addr_equal_64bits(eth->h_dest, dev->broadcast))
A
Arnd Bergmann 已提交
209 210 211 212
		skb->pkt_type = PACKET_BROADCAST;
	else
		skb->pkt_type = PACKET_MULTICAST;

213
	return 0;
A
Arnd Bergmann 已提交
214 215
}

E
Eric Dumazet 已提交
216 217 218 219 220 221 222 223
static u32 macvlan_hash_mix(const struct macvlan_dev *vlan)
{
	return (u32)(((unsigned long)vlan) >> L1_CACHE_SHIFT);
}


static unsigned int mc_hash(const struct macvlan_dev *vlan,
			    const unsigned char *addr)
E
Eric Dumazet 已提交
224 225 226
{
	u32 val = __get_unaligned_cpu32(addr + 2);

E
Eric Dumazet 已提交
227
	val ^= macvlan_hash_mix(vlan);
E
Eric Dumazet 已提交
228 229 230
	return hash_32(val, MACVLAN_MC_FILTER_BITS);
}

P
Patrick McHardy 已提交
231
static void macvlan_broadcast(struct sk_buff *skb,
232 233 234
			      const struct macvlan_port *port,
			      struct net_device *src,
			      enum macvlan_mode mode)
P
Patrick McHardy 已提交
235 236 237 238 239
{
	const struct ethhdr *eth = eth_hdr(skb);
	const struct macvlan_dev *vlan;
	struct sk_buff *nskb;
	unsigned int i;
A
Arnd Bergmann 已提交
240
	int err;
E
Eric Dumazet 已提交
241
	unsigned int hash;
P
Patrick McHardy 已提交
242

243 244 245
	if (skb->protocol == htons(ETH_P_PAUSE))
		return;

P
Patrick McHardy 已提交
246
	for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
247
		hlist_for_each_entry_rcu(vlan, &port->vlan_hash[i], hlist) {
248 249 250
			if (vlan->dev == src || !(vlan->mode & mode))
				continue;

E
Eric Dumazet 已提交
251
			hash = mc_hash(vlan, eth->h_dest);
E
Eric Dumazet 已提交
252 253
			if (!test_bit(hash, vlan->mc_filter))
				continue;
254 255

			err = NET_RX_DROP;
P
Patrick McHardy 已提交
256
			nskb = skb_clone(skb, GFP_ATOMIC);
257 258 259
			if (likely(nskb))
				err = macvlan_broadcast_one(
					nskb, vlan, eth,
260 261
					mode == MACVLAN_MODE_BRIDGE) ?:
				      netif_rx_ni(nskb);
A
Arnd Bergmann 已提交
262
			macvlan_count_rx(vlan, skb->len + ETH_HLEN,
263
					 err == NET_RX_SUCCESS, true);
P
Patrick McHardy 已提交
264 265 266 267
		}
	}
}

268
static void macvlan_process_broadcast(struct work_struct *w)
P
Patrick McHardy 已提交
269
{
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284
	struct macvlan_port *port = container_of(w, struct macvlan_port,
						 bc_work);
	struct sk_buff *skb;
	struct sk_buff_head list;

	skb_queue_head_init(&list);

	spin_lock_bh(&port->bc_queue.lock);
	skb_queue_splice_tail_init(&port->bc_queue, &list);
	spin_unlock_bh(&port->bc_queue.lock);

	while ((skb = __skb_dequeue(&list))) {
		const struct macvlan_dev *src = MACVLAN_SKB_CB(skb)->src;

		rcu_read_lock();
P
Patrick McHardy 已提交
285

286 287 288 289 290
		if (!src)
			/* frame comes from an external address */
			macvlan_broadcast(skb, port, NULL,
					  MACVLAN_MODE_PRIVATE |
					  MACVLAN_MODE_VEPA    |
291
					  MACVLAN_MODE_PASSTHRU|
292 293 294 295 296 297
					  MACVLAN_MODE_BRIDGE);
		else if (src->mode == MACVLAN_MODE_VEPA)
			/* flood to everyone except source */
			macvlan_broadcast(skb, port, src->dev,
					  MACVLAN_MODE_VEPA |
					  MACVLAN_MODE_BRIDGE);
298
		else
299 300 301 302 303 304
			/*
			 * flood only to VEPA ports, bridge ports
			 * already saw the frame on the way out.
			 */
			macvlan_broadcast(skb, port, src->dev,
					  MACVLAN_MODE_VEPA);
305 306 307 308 309 310 311 312 313 314

		rcu_read_unlock();

		kfree_skb(skb);
	}
}

static void macvlan_broadcast_enqueue(struct macvlan_port *port,
				      struct sk_buff *skb)
{
315
	struct sk_buff *nskb;
316 317
	int err = -ENOMEM;

318 319
	nskb = skb_clone(skb, GFP_ATOMIC);
	if (!nskb)
320 321 322
		goto err;

	spin_lock(&port->bc_queue.lock);
323
	if (skb_queue_len(&port->bc_queue) < MACVLAN_BC_QUEUE_LEN) {
324
		__skb_queue_tail(&port->bc_queue, nskb);
325 326 327 328 329
		err = 0;
	}
	spin_unlock(&port->bc_queue.lock);

	if (err)
330
		goto free_nskb;
331 332 333 334

	schedule_work(&port->bc_work);
	return;

335 336
free_nskb:
	kfree_skb(nskb);
337 338 339 340
err:
	atomic_long_inc(&skb->dev->rx_dropped);
}

M
Michael Braun 已提交
341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
static void macvlan_flush_sources(struct macvlan_port *port,
				  struct macvlan_dev *vlan)
{
	int i;

	for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
		struct hlist_node *h, *n;

		hlist_for_each_safe(h, n, &port->vlan_source_hash[i]) {
			struct macvlan_source_entry *entry;

			entry = hlist_entry(h, struct macvlan_source_entry,
					    hlist);
			if (entry->vlan == vlan)
				macvlan_hash_del_source(entry);
		}
	}
	vlan->macaddr_count = 0;
}

static void macvlan_forward_source_one(struct sk_buff *skb,
				       struct macvlan_dev *vlan)
{
	struct sk_buff *nskb;
	struct net_device *dev;
	int len;
	int ret;

	dev = vlan->dev;
	if (unlikely(!(dev->flags & IFF_UP)))
		return;

	nskb = skb_clone(skb, GFP_ATOMIC);
	if (!nskb)
		return;

	len = nskb->len + ETH_HLEN;
	nskb->dev = dev;
	nskb->pkt_type = PACKET_HOST;

	ret = netif_rx(nskb);
382
	macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, false);
M
Michael Braun 已提交
383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
}

static void macvlan_forward_source(struct sk_buff *skb,
				   struct macvlan_port *port,
				   const unsigned char *addr)
{
	struct macvlan_source_entry *entry;
	u32 idx = macvlan_eth_hash(addr);
	struct hlist_head *h = &port->vlan_source_hash[idx];

	hlist_for_each_entry_rcu(entry, h, hlist) {
		if (ether_addr_equal_64bits(entry->addr, addr))
			if (entry->vlan->dev->flags & IFF_UP)
				macvlan_forward_source_one(skb, entry->vlan);
	}
}

400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417
/* called under rcu_read_lock() from netif_receive_skb */
static rx_handler_result_t macvlan_handle_frame(struct sk_buff **pskb)
{
	struct macvlan_port *port;
	struct sk_buff *skb = *pskb;
	const struct ethhdr *eth = eth_hdr(skb);
	const struct macvlan_dev *vlan;
	const struct macvlan_dev *src;
	struct net_device *dev;
	unsigned int len = 0;
	int ret = NET_RX_DROP;

	port = macvlan_port_get_rcu(skb->dev);
	if (is_multicast_ether_addr(eth->h_dest)) {
		skb = ip_check_defrag(skb, IP_DEFRAG_MACVLAN);
		if (!skb)
			return RX_HANDLER_CONSUMED;
		eth = eth_hdr(skb);
M
Michael Braun 已提交
418
		macvlan_forward_source(skb, port, eth->h_source);
419 420 421
		src = macvlan_hash_lookup(port, eth->h_source);
		if (src && src->mode != MACVLAN_MODE_VEPA &&
		    src->mode != MACVLAN_MODE_BRIDGE) {
422 423
			/* forward to original port. */
			vlan = src;
424 425
			ret = macvlan_broadcast_one(skb, vlan, eth, 0) ?:
			      netif_rx(skb);
426 427 428
			goto out;
		}

429 430 431
		MACVLAN_SKB_CB(skb)->src = src;
		macvlan_broadcast_enqueue(port, skb);

432
		return RX_HANDLER_PASS;
P
Patrick McHardy 已提交
433 434
	}

M
Michael Braun 已提交
435
	macvlan_forward_source(skb, port, eth->h_source);
436
	if (port->passthru)
437 438
		vlan = list_first_or_null_rcu(&port->vlans,
					      struct macvlan_dev, list);
439 440
	else
		vlan = macvlan_hash_lookup(port, eth->h_dest);
P
Patrick McHardy 已提交
441
	if (vlan == NULL)
442
		return RX_HANDLER_PASS;
P
Patrick McHardy 已提交
443 444 445 446

	dev = vlan->dev;
	if (unlikely(!(dev->flags & IFF_UP))) {
		kfree_skb(skb);
447
		return RX_HANDLER_CONSUMED;
P
Patrick McHardy 已提交
448
	}
A
Arnd Bergmann 已提交
449
	len = skb->len + ETH_HLEN;
P
Patrick McHardy 已提交
450
	skb = skb_share_check(skb, GFP_ATOMIC);
A
Arnd Bergmann 已提交
451
	if (!skb)
452
		goto out;
P
Patrick McHardy 已提交
453 454 455 456

	skb->dev = dev;
	skb->pkt_type = PACKET_HOST;

457
	ret = netif_rx(skb);
458 459

out:
460
	macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, false);
461
	return RX_HANDLER_CONSUMED;
P
Patrick McHardy 已提交
462 463
}

464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev)
{
	const struct macvlan_dev *vlan = netdev_priv(dev);
	const struct macvlan_port *port = vlan->port;
	const struct macvlan_dev *dest;

	if (vlan->mode == MACVLAN_MODE_BRIDGE) {
		const struct ethhdr *eth = (void *)skb->data;

		/* send to other bridge ports directly */
		if (is_multicast_ether_addr(eth->h_dest)) {
			macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE);
			goto xmit_world;
		}

		dest = macvlan_hash_lookup(port, eth->h_dest);
		if (dest && dest->mode == MACVLAN_MODE_BRIDGE) {
481
			/* send to lowerdev first for its network taps */
482
			dev_forward_skb(vlan->lowerdev, skb);
483 484 485 486 487 488

			return NET_XMIT_SUCCESS;
		}
	}

xmit_world:
489
	skb->dev = vlan->lowerdev;
490 491 492
	return dev_queue_xmit(skb);
}

D
dingtianhong 已提交
493 494 495 496 497 498 499 500 501 502 503
static inline netdev_tx_t macvlan_netpoll_send_skb(struct macvlan_dev *vlan, struct sk_buff *skb)
{
#ifdef CONFIG_NET_POLL_CONTROLLER
	if (vlan->netpoll)
		netpoll_send_skb(vlan->netpoll, skb);
#else
	BUG();
#endif
	return NETDEV_TX_OK;
}

S
stephen hemminger 已提交
504 505
static netdev_tx_t macvlan_start_xmit(struct sk_buff *skb,
				      struct net_device *dev)
P
Patrick McHardy 已提交
506 507 508
{
	unsigned int len = skb->len;
	int ret;
D
dingtianhong 已提交
509 510 511 512
	struct macvlan_dev *vlan = netdev_priv(dev);

	if (unlikely(netpoll_tx_running(dev)))
		return macvlan_netpoll_send_skb(vlan, skb);
P
Patrick McHardy 已提交
513

514 515
	if (vlan->fwd_priv) {
		skb->dev = vlan->lowerdev;
516
		ret = dev_queue_xmit_accel(skb, vlan->fwd_priv);
517 518 519 520
	} else {
		ret = macvlan_queue_xmit(skb, dev);
	}

521
	if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
522
		struct vlan_pcpu_stats *pcpu_stats;
523

E
Eric Dumazet 已提交
524 525 526 527 528 529 530 531
		pcpu_stats = this_cpu_ptr(vlan->pcpu_stats);
		u64_stats_update_begin(&pcpu_stats->syncp);
		pcpu_stats->tx_packets++;
		pcpu_stats->tx_bytes += len;
		u64_stats_update_end(&pcpu_stats->syncp);
	} else {
		this_cpu_inc(vlan->pcpu_stats->tx_dropped);
	}
532
	return ret;
P
Patrick McHardy 已提交
533 534 535
}

static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev,
536 537
			       unsigned short type, const void *daddr,
			       const void *saddr, unsigned len)
P
Patrick McHardy 已提交
538 539 540 541
{
	const struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;

542 543
	return dev_hard_header(skb, lowerdev, type, daddr,
			       saddr ? : dev->dev_addr, len);
P
Patrick McHardy 已提交
544 545
}

546 547 548 549 550 551 552 553
static const struct header_ops macvlan_hard_header_ops = {
	.create  	= macvlan_hard_header,
	.rebuild	= eth_rebuild_header,
	.parse		= eth_header_parse,
	.cache		= eth_header_cache,
	.cache_update	= eth_header_cache_update,
};

554 555
static struct rtnl_link_ops macvlan_link_ops;

P
Patrick McHardy 已提交
556 557 558 559 560 561
static int macvlan_open(struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;
	int err;

562
	if (vlan->port->passthru) {
563 564 565 566 567
		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) {
			err = dev_set_promiscuity(lowerdev, 1);
			if (err < 0)
				goto out;
		}
568 569 570
		goto hash_add;
	}

571 572
	if (lowerdev->features & NETIF_F_HW_L2FW_DOFFLOAD &&
	    dev->rtnl_link_ops == &macvlan_link_ops) {
573 574 575 576 577 578 579 580
		vlan->fwd_priv =
		      lowerdev->netdev_ops->ndo_dfwd_add_station(lowerdev, dev);

		/* If we get a NULL pointer back, or if we get an error
		 * then we should just fall through to the non accelerated path
		 */
		if (IS_ERR_OR_NULL(vlan->fwd_priv)) {
			vlan->fwd_priv = NULL;
581
		} else
582 583 584
			return 0;
	}

585 586 587 588
	err = -EBUSY;
	if (macvlan_addr_busy(vlan->port, dev->dev_addr))
		goto out;

589
	err = dev_uc_add(lowerdev, dev->dev_addr);
P
Patrick McHardy 已提交
590
	if (err < 0)
591 592 593 594 595 596
		goto out;
	if (dev->flags & IFF_ALLMULTI) {
		err = dev_set_allmulti(lowerdev, 1);
		if (err < 0)
			goto del_unicast;
	}
597 598

hash_add:
599
	macvlan_hash_add(vlan);
P
Patrick McHardy 已提交
600
	return 0;
601 602

del_unicast:
603
	dev_uc_del(lowerdev, dev->dev_addr);
604
out:
605 606 607 608 609
	if (vlan->fwd_priv) {
		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev,
							   vlan->fwd_priv);
		vlan->fwd_priv = NULL;
	}
610
	return err;
P
Patrick McHardy 已提交
611 612 613 614 615 616 617
}

static int macvlan_stop(struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;

618 619 620 621 622 623 624
	if (vlan->fwd_priv) {
		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev,
							   vlan->fwd_priv);
		vlan->fwd_priv = NULL;
		return 0;
	}

625 626 627
	dev_uc_unsync(lowerdev, dev);
	dev_mc_unsync(lowerdev, dev);

628
	if (vlan->port->passthru) {
629 630
		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC))
			dev_set_promiscuity(lowerdev, -1);
631 632 633
		goto hash_del;
	}

P
Patrick McHardy 已提交
634 635 636
	if (dev->flags & IFF_ALLMULTI)
		dev_set_allmulti(lowerdev, -1);

637
	dev_uc_del(lowerdev, dev->dev_addr);
P
Patrick McHardy 已提交
638

639
hash_del:
640
	macvlan_hash_del(vlan, !dev->dismantle);
P
Patrick McHardy 已提交
641 642 643
	return 0;
}

644
static int macvlan_sync_address(struct net_device *dev, unsigned char *addr)
645 646 647 648 649
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;
	int err;

650 651
	if (!(dev->flags & IFF_UP)) {
		/* Just copy in the new address */
652
		ether_addr_copy(dev->dev_addr, addr);
653 654
	} else {
		/* Rehash and update the device filters */
655
		if (macvlan_addr_busy(vlan->port, addr))
656
			return -EBUSY;
657

658 659 660 661
		if (!vlan->port->passthru) {
			err = dev_uc_add(lowerdev, addr);
			if (err)
				return err;
662

663 664
			dev_uc_del(lowerdev, dev->dev_addr);
		}
665

666
		macvlan_hash_change_addr(vlan, addr);
667
	}
668 669 670
	return 0;
}

671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
static int macvlan_set_mac_address(struct net_device *dev, void *p)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	if (vlan->mode == MACVLAN_MODE_PASSTHRU) {
		dev_set_mac_address(vlan->lowerdev, addr);
		return 0;
	}

	return macvlan_sync_address(dev, addr->sa_data);
}

P
Patrick McHardy 已提交
687 688 689 690 691
static void macvlan_change_rx_flags(struct net_device *dev, int change)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;

692 693 694 695
	if (dev->flags & IFF_UP) {
		if (change & IFF_ALLMULTI)
			dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1);
	}
P
Patrick McHardy 已提交
696 697
}

698
static void macvlan_set_mac_lists(struct net_device *dev)
P
Patrick McHardy 已提交
699 700 701
{
	struct macvlan_dev *vlan = netdev_priv(dev);

E
Eric Dumazet 已提交
702 703 704 705 706 707 708 709
	if (dev->flags & (IFF_PROMISC | IFF_ALLMULTI)) {
		bitmap_fill(vlan->mc_filter, MACVLAN_MC_FILTER_SZ);
	} else {
		struct netdev_hw_addr *ha;
		DECLARE_BITMAP(filter, MACVLAN_MC_FILTER_SZ);

		bitmap_zero(filter, MACVLAN_MC_FILTER_SZ);
		netdev_for_each_mc_addr(ha, dev) {
E
Eric Dumazet 已提交
710
			__set_bit(mc_hash(vlan, ha->addr), filter);
E
Eric Dumazet 已提交
711
		}
712

E
Eric Dumazet 已提交
713
		__set_bit(mc_hash(vlan, dev->broadcast), filter);
714

E
Eric Dumazet 已提交
715 716
		bitmap_copy(vlan->mc_filter, filter, MACVLAN_MC_FILTER_SZ);
	}
717
	dev_uc_sync(vlan->lowerdev, dev);
P
Patrick McHardy 已提交
718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736
	dev_mc_sync(vlan->lowerdev, dev);
}

static int macvlan_change_mtu(struct net_device *dev, int new_mtu)
{
	struct macvlan_dev *vlan = netdev_priv(dev);

	if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu)
		return -EINVAL;
	dev->mtu = new_mtu;
	return 0;
}

/*
 * macvlan network devices have devices nesting below it and are a special
 * "super class" of normal network devices; split their locks off into a
 * separate class since they always nest.
 */
static struct lock_class_key macvlan_netdev_xmit_lock_key;
737
static struct lock_class_key macvlan_netdev_addr_lock_key;
P
Patrick McHardy 已提交
738

739 740 741
#define ALWAYS_ON_FEATURES \
	(NETIF_F_SG | NETIF_F_GEN_CSUM | NETIF_F_GSO_SOFTWARE | NETIF_F_LLTX)

P
Patrick McHardy 已提交
742 743 744
#define MACVLAN_FEATURES \
	(NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \
	 NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \
745
	 NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \
746
	 NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER)
P
Patrick McHardy 已提交
747 748 749 750

#define MACVLAN_STATE_MASK \
	((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT))

751 752 753 754 755
static int macvlan_get_nest_level(struct net_device *dev)
{
	return ((struct macvlan_dev *)netdev_priv(dev))->nest_level;
}

756 757 758
static void macvlan_set_lockdep_class_one(struct net_device *dev,
					  struct netdev_queue *txq,
					  void *_unused)
759 760 761 762 763 764 765
{
	lockdep_set_class(&txq->_xmit_lock,
			  &macvlan_netdev_xmit_lock_key);
}

static void macvlan_set_lockdep_class(struct net_device *dev)
{
766 767 768
	lockdep_set_class_and_subclass(&dev->addr_list_lock,
				       &macvlan_netdev_addr_lock_key,
				       macvlan_get_nest_level(dev));
769
	netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL);
770 771
}

P
Patrick McHardy 已提交
772 773 774 775 776 777 778 779
static int macvlan_init(struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	const struct net_device *lowerdev = vlan->lowerdev;

	dev->state		= (dev->state & ~MACVLAN_STATE_MASK) |
				  (lowerdev->state & MACVLAN_STATE_MASK);
	dev->features 		= lowerdev->features & MACVLAN_FEATURES;
780
	dev->features		|= ALWAYS_ON_FEATURES;
781
	dev->vlan_features	= lowerdev->vlan_features & MACVLAN_FEATURES;
782
	dev->gso_max_size	= lowerdev->gso_max_size;
P
Patrick McHardy 已提交
783
	dev->iflink		= lowerdev->ifindex;
784
	dev->hard_header_len	= lowerdev->hard_header_len;
P
Patrick McHardy 已提交
785

786 787
	macvlan_set_lockdep_class(dev);

788
	vlan->pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats);
E
Eric Dumazet 已提交
789
	if (!vlan->pcpu_stats)
790 791
		return -ENOMEM;

P
Patrick McHardy 已提交
792 793 794
	return 0;
}

795 796 797
static void macvlan_uninit(struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
798
	struct macvlan_port *port = vlan->port;
799

E
Eric Dumazet 已提交
800
	free_percpu(vlan->pcpu_stats);
801

M
Michael Braun 已提交
802
	macvlan_flush_sources(port, vlan);
803 804
	port->count -= 1;
	if (!port->count)
805
		macvlan_port_destroy(port->dev);
806 807
}

808 809
static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev,
							 struct rtnl_link_stats64 *stats)
810 811 812
{
	struct macvlan_dev *vlan = netdev_priv(dev);

E
Eric Dumazet 已提交
813
	if (vlan->pcpu_stats) {
814
		struct vlan_pcpu_stats *p;
E
Eric Dumazet 已提交
815 816
		u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes;
		u32 rx_errors = 0, tx_dropped = 0;
E
Eric Dumazet 已提交
817
		unsigned int start;
818 819 820
		int i;

		for_each_possible_cpu(i) {
E
Eric Dumazet 已提交
821
			p = per_cpu_ptr(vlan->pcpu_stats, i);
E
Eric Dumazet 已提交
822
			do {
823
				start = u64_stats_fetch_begin_irq(&p->syncp);
E
Eric Dumazet 已提交
824 825 826
				rx_packets	= p->rx_packets;
				rx_bytes	= p->rx_bytes;
				rx_multicast	= p->rx_multicast;
E
Eric Dumazet 已提交
827 828
				tx_packets	= p->tx_packets;
				tx_bytes	= p->tx_bytes;
829
			} while (u64_stats_fetch_retry_irq(&p->syncp, start));
E
Eric Dumazet 已提交
830 831 832 833 834 835 836 837 838 839 840

			stats->rx_packets	+= rx_packets;
			stats->rx_bytes		+= rx_bytes;
			stats->multicast	+= rx_multicast;
			stats->tx_packets	+= tx_packets;
			stats->tx_bytes		+= tx_bytes;
			/* rx_errors & tx_dropped are u32, updated
			 * without syncp protection.
			 */
			rx_errors	+= p->rx_errors;
			tx_dropped	+= p->tx_dropped;
841
		}
E
Eric Dumazet 已提交
842 843 844
		stats->rx_errors	= rx_errors;
		stats->rx_dropped	= rx_errors;
		stats->tx_dropped	= tx_dropped;
845 846 847 848
	}
	return stats;
}

849
static int macvlan_vlan_rx_add_vid(struct net_device *dev,
850
				   __be16 proto, u16 vid)
851 852 853 854
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;

855
	return vlan_vid_add(lowerdev, proto, vid);
856 857
}

858
static int macvlan_vlan_rx_kill_vid(struct net_device *dev,
859
				    __be16 proto, u16 vid)
860 861 862 863
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *lowerdev = vlan->lowerdev;

864
	vlan_vid_del(lowerdev, proto, vid);
865
	return 0;
866 867
}

868
static int macvlan_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
869
			   struct net_device *dev,
870
			   const unsigned char *addr,
871 872 873 874 875
			   u16 flags)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	int err = -EINVAL;

876 877 878 879
	/* Support unicast filter only on passthru devices.
	 * Multicast filter should be allowed on all devices.
	 */
	if (!vlan->port->passthru && is_unicast_ether_addr(addr))
880 881
		return -EOPNOTSUPP;

T
Thomas Richter 已提交
882 883 884
	if (flags & NLM_F_REPLACE)
		return -EOPNOTSUPP;

885 886 887 888 889 890 891 892
	if (is_unicast_ether_addr(addr))
		err = dev_uc_add_excl(dev, addr);
	else if (is_multicast_ether_addr(addr))
		err = dev_mc_add_excl(dev, addr);

	return err;
}

893
static int macvlan_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
894
			   struct net_device *dev,
895
			   const unsigned char *addr)
896 897 898 899
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	int err = -EINVAL;

900 901 902 903
	/* Support unicast filter only on passthru devices.
	 * Multicast filter should be allowed on all devices.
	 */
	if (!vlan->port->passthru && is_unicast_ether_addr(addr))
904 905 906 907 908 909 910 911 912 913
		return -EOPNOTSUPP;

	if (is_unicast_ether_addr(addr))
		err = dev_uc_del(dev, addr);
	else if (is_multicast_ether_addr(addr))
		err = dev_mc_del(dev, addr);

	return err;
}

P
Patrick McHardy 已提交
914 915 916
static void macvlan_ethtool_get_drvinfo(struct net_device *dev,
					struct ethtool_drvinfo *drvinfo)
{
917 918
	strlcpy(drvinfo->driver, "macvlan", sizeof(drvinfo->driver));
	strlcpy(drvinfo->version, "0.1", sizeof(drvinfo->version));
P
Patrick McHardy 已提交
919 920
}

921 922 923 924
static int macvlan_ethtool_get_settings(struct net_device *dev,
					struct ethtool_cmd *cmd)
{
	const struct macvlan_dev *vlan = netdev_priv(dev);
925 926

	return __ethtool_get_settings(vlan->lowerdev, cmd);
927 928
}

929 930 931 932
static netdev_features_t macvlan_fix_features(struct net_device *dev,
					      netdev_features_t features)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
933
	netdev_features_t mask;
934

935 936 937 938 939 940 941
	features |= NETIF_F_ALL_FOR_ALL;
	features &= (vlan->set_features | ~MACVLAN_FEATURES);
	mask = features;

	features = netdev_increment_features(vlan->lowerdev->features,
					     features,
					     mask);
942
	features |= ALWAYS_ON_FEATURES;
943
	features &= ~NETIF_F_NETNS_LOCAL;
944 945

	return features;
946 947
}

D
dingtianhong 已提交
948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991
#ifdef CONFIG_NET_POLL_CONTROLLER
static void macvlan_dev_poll_controller(struct net_device *dev)
{
	return;
}

static int macvlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct net_device *real_dev = vlan->lowerdev;
	struct netpoll *netpoll;
	int err = 0;

	netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL);
	err = -ENOMEM;
	if (!netpoll)
		goto out;

	err = __netpoll_setup(netpoll, real_dev);
	if (err) {
		kfree(netpoll);
		goto out;
	}

	vlan->netpoll = netpoll;

out:
	return err;
}

static void macvlan_dev_netpoll_cleanup(struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct netpoll *netpoll = vlan->netpoll;

	if (!netpoll)
		return;

	vlan->netpoll = NULL;

	__netpoll_free_async(netpoll);
}
#endif	/* CONFIG_NET_POLL_CONTROLLER */

P
Patrick McHardy 已提交
992 993
static const struct ethtool_ops macvlan_ethtool_ops = {
	.get_link		= ethtool_op_get_link,
994
	.get_settings		= macvlan_ethtool_get_settings,
P
Patrick McHardy 已提交
995 996 997
	.get_drvinfo		= macvlan_ethtool_get_drvinfo,
};

998 999
static const struct net_device_ops macvlan_netdev_ops = {
	.ndo_init		= macvlan_init,
1000
	.ndo_uninit		= macvlan_uninit,
1001 1002
	.ndo_open		= macvlan_open,
	.ndo_stop		= macvlan_stop,
1003
	.ndo_start_xmit		= macvlan_start_xmit,
1004
	.ndo_change_mtu		= macvlan_change_mtu,
1005
	.ndo_fix_features	= macvlan_fix_features,
1006 1007
	.ndo_change_rx_flags	= macvlan_change_rx_flags,
	.ndo_set_mac_address	= macvlan_set_mac_address,
1008
	.ndo_set_rx_mode	= macvlan_set_mac_lists,
E
Eric Dumazet 已提交
1009
	.ndo_get_stats64	= macvlan_dev_get_stats64,
1010
	.ndo_validate_addr	= eth_validate_addr,
1011 1012
	.ndo_vlan_rx_add_vid	= macvlan_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid	= macvlan_vlan_rx_kill_vid,
1013 1014 1015
	.ndo_fdb_add		= macvlan_fdb_add,
	.ndo_fdb_del		= macvlan_fdb_del,
	.ndo_fdb_dump		= ndo_dflt_fdb_dump,
1016
	.ndo_get_lock_subclass  = macvlan_get_nest_level,
D
dingtianhong 已提交
1017 1018 1019 1020 1021
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= macvlan_dev_poll_controller,
	.ndo_netpoll_setup	= macvlan_dev_netpoll_setup,
	.ndo_netpoll_cleanup	= macvlan_dev_netpoll_cleanup,
#endif
1022 1023
};

H
Herbert Xu 已提交
1024
void macvlan_common_setup(struct net_device *dev)
P
Patrick McHardy 已提交
1025 1026 1027
{
	ether_setup(dev);

1028 1029
	dev->priv_flags	       &= ~IFF_TX_SKB_SHARING;
	netif_keep_dst(dev);
1030
	dev->priv_flags	       |= IFF_UNICAST_FLT;
1031
	dev->netdev_ops		= &macvlan_netdev_ops;
P
Patrick McHardy 已提交
1032
	dev->destructor		= free_netdev;
L
Lutz Jaenicke 已提交
1033
	dev->header_ops		= &macvlan_hard_header_ops;
P
Patrick McHardy 已提交
1034
	dev->ethtool_ops	= &macvlan_ethtool_ops;
H
Herbert Xu 已提交
1035 1036 1037 1038 1039 1040
}
EXPORT_SYMBOL_GPL(macvlan_common_setup);

static void macvlan_setup(struct net_device *dev)
{
	macvlan_common_setup(dev);
P
Patrick McHardy 已提交
1041 1042 1043 1044 1045 1046 1047
	dev->tx_queue_len	= 0;
}

static int macvlan_port_create(struct net_device *dev)
{
	struct macvlan_port *port;
	unsigned int i;
1048
	int err;
P
Patrick McHardy 已提交
1049 1050 1051 1052 1053 1054 1055 1056

	if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK)
		return -EINVAL;

	port = kzalloc(sizeof(*port), GFP_KERNEL);
	if (port == NULL)
		return -ENOMEM;

1057
	port->passthru = false;
P
Patrick McHardy 已提交
1058 1059 1060 1061
	port->dev = dev;
	INIT_LIST_HEAD(&port->vlans);
	for (i = 0; i < MACVLAN_HASH_SIZE; i++)
		INIT_HLIST_HEAD(&port->vlan_hash[i]);
M
Michael Braun 已提交
1062 1063
	for (i = 0; i < MACVLAN_HASH_SIZE; i++)
		INIT_HLIST_HEAD(&port->vlan_source_hash[i]);
1064

1065 1066 1067
	skb_queue_head_init(&port->bc_queue);
	INIT_WORK(&port->bc_work, macvlan_process_broadcast);

1068 1069
	err = netdev_rx_handler_register(dev, macvlan_handle_frame, port);
	if (err)
1070
		kfree(port);
1071 1072
	else
		dev->priv_flags |= IFF_MACVLAN_PORT;
1073
	return err;
P
Patrick McHardy 已提交
1074 1075 1076 1077
}

static void macvlan_port_destroy(struct net_device *dev)
{
E
Eric Dumazet 已提交
1078
	struct macvlan_port *port = macvlan_port_get_rtnl(dev);
P
Patrick McHardy 已提交
1079

1080
	cancel_work_sync(&port->bc_work);
1081
	dev->priv_flags &= ~IFF_MACVLAN_PORT;
1082
	netdev_rx_handler_unregister(dev);
1083
	kfree_rcu(port, rcu);
P
Patrick McHardy 已提交
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093
}

static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])
{
	if (tb[IFLA_ADDRESS]) {
		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
			return -EINVAL;
		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
			return -EADDRNOTAVAIL;
	}
1094

M
Michael S. Tsirkin 已提交
1095 1096 1097 1098
	if (data && data[IFLA_MACVLAN_FLAGS] &&
	    nla_get_u16(data[IFLA_MACVLAN_FLAGS]) & ~MACVLAN_FLAG_NOPROMISC)
		return -EINVAL;

1099 1100 1101 1102 1103
	if (data && data[IFLA_MACVLAN_MODE]) {
		switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) {
		case MACVLAN_MODE_PRIVATE:
		case MACVLAN_MODE_VEPA:
		case MACVLAN_MODE_BRIDGE:
1104
		case MACVLAN_MODE_PASSTHRU:
M
Michael Braun 已提交
1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
		case MACVLAN_MODE_SOURCE:
			break;
		default:
			return -EINVAL;
		}
	}

	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
		switch (nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE])) {
		case MACVLAN_MACADDR_ADD:
		case MACVLAN_MACADDR_DEL:
		case MACVLAN_MACADDR_FLUSH:
		case MACVLAN_MACADDR_SET:
1118 1119 1120 1121 1122
			break;
		default:
			return -EINVAL;
		}
	}
M
Michael Braun 已提交
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200

	if (data && data[IFLA_MACVLAN_MACADDR]) {
		if (nla_len(data[IFLA_MACVLAN_MACADDR]) != ETH_ALEN)
			return -EINVAL;

		if (!is_valid_ether_addr(nla_data(data[IFLA_MACVLAN_MACADDR])))
			return -EADDRNOTAVAIL;
	}

	if (data && data[IFLA_MACVLAN_MACADDR_COUNT])
		return -EINVAL;

	return 0;
}

/**
 * reconfigure list of remote source mac address
 * (only for macvlan devices in source mode)
 * Note regarding alignment: all netlink data is aligned to 4 Byte, which
 * suffices for both ether_addr_copy and ether_addr_equal_64bits usage.
 */
static int macvlan_changelink_sources(struct macvlan_dev *vlan, u32 mode,
				      struct nlattr *data[])
{
	char *addr = NULL;
	int ret, rem, len;
	struct nlattr *nla, *head;
	struct macvlan_source_entry *entry;

	if (data[IFLA_MACVLAN_MACADDR])
		addr = nla_data(data[IFLA_MACVLAN_MACADDR]);

	if (mode == MACVLAN_MACADDR_ADD) {
		if (!addr)
			return -EINVAL;

		return macvlan_hash_add_source(vlan, addr);

	} else if (mode == MACVLAN_MACADDR_DEL) {
		if (!addr)
			return -EINVAL;

		entry = macvlan_hash_lookup_source(vlan, addr);
		if (entry) {
			macvlan_hash_del_source(entry);
			vlan->macaddr_count--;
		}
	} else if (mode == MACVLAN_MACADDR_FLUSH) {
		macvlan_flush_sources(vlan->port, vlan);
	} else if (mode == MACVLAN_MACADDR_SET) {
		macvlan_flush_sources(vlan->port, vlan);

		if (addr) {
			ret = macvlan_hash_add_source(vlan, addr);
			if (ret)
				return ret;
		}

		if (!data || !data[IFLA_MACVLAN_MACADDR_DATA])
			return 0;

		head = nla_data(data[IFLA_MACVLAN_MACADDR_DATA]);
		len = nla_len(data[IFLA_MACVLAN_MACADDR_DATA]);

		nla_for_each_attr(nla, head, len, rem) {
			if (nla_type(nla) != IFLA_MACVLAN_MACADDR ||
			    nla_len(nla) != ETH_ALEN)
				continue;

			addr = nla_data(nla);
			ret = macvlan_hash_add_source(vlan, addr);
			if (ret)
				return ret;
		}
	} else {
		return -EINVAL;
	}

P
Patrick McHardy 已提交
1201 1202 1203
	return 0;
}

1204
int macvlan_common_newlink(struct net *src_net, struct net_device *dev,
1205
			   struct nlattr *tb[], struct nlattr *data[])
P
Patrick McHardy 已提交
1206 1207 1208 1209 1210
{
	struct macvlan_dev *vlan = netdev_priv(dev);
	struct macvlan_port *port;
	struct net_device *lowerdev;
	int err;
M
Michael Braun 已提交
1211
	int macmode;
P
Patrick McHardy 已提交
1212 1213 1214 1215

	if (!tb[IFLA_LINK])
		return -EINVAL;

1216
	lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
P
Patrick McHardy 已提交
1217 1218 1219
	if (lowerdev == NULL)
		return -ENODEV;

1220
	/* When creating macvlans or macvtaps on top of other macvlans - use
1221
	 * the real device as the lowerdev.
1222
	 */
1223 1224
	if (netif_is_macvlan(lowerdev))
		lowerdev = macvlan_dev_real_dev(lowerdev);
1225

P
Patrick McHardy 已提交
1226 1227 1228 1229 1230 1231
	if (!tb[IFLA_MTU])
		dev->mtu = lowerdev->mtu;
	else if (dev->mtu > lowerdev->mtu)
		return -EINVAL;

	if (!tb[IFLA_ADDRESS])
1232
		eth_hw_addr_random(dev);
P
Patrick McHardy 已提交
1233

1234
	if (!macvlan_port_exists(lowerdev)) {
P
Patrick McHardy 已提交
1235 1236 1237 1238
		err = macvlan_port_create(lowerdev);
		if (err < 0)
			return err;
	}
E
Eric Dumazet 已提交
1239
	port = macvlan_port_get_rtnl(lowerdev);
P
Patrick McHardy 已提交
1240

1241 1242 1243 1244
	/* Only 1 macvlan device can be created in passthru mode */
	if (port->passthru)
		return -EINVAL;

P
Patrick McHardy 已提交
1245 1246 1247
	vlan->lowerdev = lowerdev;
	vlan->dev      = dev;
	vlan->port     = port;
1248
	vlan->set_features = MACVLAN_FEATURES;
1249
	vlan->nest_level = dev_get_nest_level(lowerdev, netif_is_macvlan) + 1;
P
Patrick McHardy 已提交
1250

1251 1252 1253 1254
	vlan->mode     = MACVLAN_MODE_VEPA;
	if (data && data[IFLA_MACVLAN_MODE])
		vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);

1255 1256 1257
	if (data && data[IFLA_MACVLAN_FLAGS])
		vlan->flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]);

1258
	if (vlan->mode == MACVLAN_MODE_PASSTHRU) {
1259
		if (port->count)
1260 1261
			return -EINVAL;
		port->passthru = true;
1262
		eth_hw_addr_inherit(dev, lowerdev);
1263 1264
	}

M
Michael Braun 已提交
1265 1266 1267 1268 1269 1270 1271 1272 1273
	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
		if (vlan->mode != MACVLAN_MODE_SOURCE)
			return -EINVAL;
		macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]);
		err = macvlan_changelink_sources(vlan, macmode, data);
		if (err)
			return err;
	}

1274
	port->count += 1;
1275 1276 1277 1278
	err = register_netdevice(dev);
	if (err < 0)
		goto destroy_port;

1279
	dev->priv_flags |= IFF_MACVLAN;
J
Jiri Pirko 已提交
1280 1281
	err = netdev_upper_dev_link(lowerdev, dev);
	if (err)
1282
		goto unregister_netdev;
P
Patrick McHardy 已提交
1283

1284
	list_add_tail_rcu(&vlan->list, &port->vlans);
1285
	netif_stacked_transfer_operstate(lowerdev, dev);
1286

P
Patrick McHardy 已提交
1287
	return 0;
1288

1289 1290
unregister_netdev:
	unregister_netdevice(dev);
1291
destroy_port:
1292 1293
	port->count -= 1;
	if (!port->count)
1294 1295 1296
		macvlan_port_destroy(lowerdev);

	return err;
P
Patrick McHardy 已提交
1297
}
1298
EXPORT_SYMBOL_GPL(macvlan_common_newlink);
P
Patrick McHardy 已提交
1299

1300 1301 1302
static int macvlan_newlink(struct net *src_net, struct net_device *dev,
			   struct nlattr *tb[], struct nlattr *data[])
{
1303
	return macvlan_common_newlink(src_net, dev, tb, data);
1304 1305 1306
}

void macvlan_dellink(struct net_device *dev, struct list_head *head)
P
Patrick McHardy 已提交
1307 1308 1309
{
	struct macvlan_dev *vlan = netdev_priv(dev);

M
Michael Braun 已提交
1310 1311
	if (vlan->mode == MACVLAN_MODE_SOURCE)
		macvlan_flush_sources(vlan->port, vlan);
1312
	list_del_rcu(&vlan->list);
1313
	unregister_netdevice_queue(dev, head);
J
Jiri Pirko 已提交
1314
	netdev_upper_dev_unlink(vlan->lowerdev, dev);
P
Patrick McHardy 已提交
1315
}
1316
EXPORT_SYMBOL_GPL(macvlan_dellink);
P
Patrick McHardy 已提交
1317

1318 1319 1320 1321
static int macvlan_changelink(struct net_device *dev,
		struct nlattr *tb[], struct nlattr *data[])
{
	struct macvlan_dev *vlan = netdev_priv(dev);
1322 1323
	enum macvlan_mode mode;
	bool set_mode = false;
M
Michael Braun 已提交
1324 1325
	enum macvlan_macaddr_mode macmode;
	int ret;
1326 1327 1328 1329 1330 1331 1332 1333 1334

	/* Validate mode, but don't set yet: setting flags may fail. */
	if (data && data[IFLA_MACVLAN_MODE]) {
		set_mode = true;
		mode = nla_get_u32(data[IFLA_MACVLAN_MODE]);
		/* Passthrough mode can't be set or cleared dynamically */
		if ((mode == MACVLAN_MODE_PASSTHRU) !=
		    (vlan->mode == MACVLAN_MODE_PASSTHRU))
			return -EINVAL;
M
Michael Braun 已提交
1335 1336 1337
		if (vlan->mode == MACVLAN_MODE_SOURCE &&
		    vlan->mode != mode)
			macvlan_flush_sources(vlan->port, vlan);
1338
	}
1339

1340 1341 1342
	if (data && data[IFLA_MACVLAN_FLAGS]) {
		__u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]);
		bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC;
1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
		if (vlan->port->passthru && promisc) {
			int err;

			if (flags & MACVLAN_FLAG_NOPROMISC)
				err = dev_set_promiscuity(vlan->lowerdev, -1);
			else
				err = dev_set_promiscuity(vlan->lowerdev, 1);
			if (err < 0)
				return err;
		}
1353 1354
		vlan->flags = flags;
	}
1355 1356
	if (set_mode)
		vlan->mode = mode;
M
Michael Braun 已提交
1357 1358 1359 1360 1361 1362 1363 1364
	if (data && data[IFLA_MACVLAN_MACADDR_MODE]) {
		if (vlan->mode != MACVLAN_MODE_SOURCE)
			return -EINVAL;
		macmode = nla_get_u32(data[IFLA_MACVLAN_MACADDR_MODE]);
		ret = macvlan_changelink_sources(vlan, macmode, data);
		if (ret)
			return ret;
	}
1365 1366 1367
	return 0;
}

M
Michael Braun 已提交
1368 1369 1370 1371 1372 1373 1374 1375
static size_t macvlan_get_size_mac(const struct macvlan_dev *vlan)
{
	if (vlan->macaddr_count == 0)
		return 0;
	return nla_total_size(0) /* IFLA_MACVLAN_MACADDR_DATA */
		+ vlan->macaddr_count * nla_total_size(sizeof(u8) * ETH_ALEN);
}

1376 1377
static size_t macvlan_get_size(const struct net_device *dev)
{
M
Michael Braun 已提交
1378 1379
	struct macvlan_dev *vlan = netdev_priv(dev);

E
Eric Dumazet 已提交
1380 1381 1382
	return (0
		+ nla_total_size(4) /* IFLA_MACVLAN_MODE */
		+ nla_total_size(2) /* IFLA_MACVLAN_FLAGS */
M
Michael Braun 已提交
1383 1384
		+ nla_total_size(4) /* IFLA_MACVLAN_MACADDR_COUNT */
		+ macvlan_get_size_mac(vlan) /* IFLA_MACVLAN_MACADDR */
E
Eric Dumazet 已提交
1385
		);
1386 1387
}

M
Michael Braun 已提交
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403
static int macvlan_fill_info_macaddr(struct sk_buff *skb,
				     const struct macvlan_dev *vlan,
				     const int i)
{
	struct hlist_head *h = &vlan->port->vlan_source_hash[i];
	struct macvlan_source_entry *entry;

	hlist_for_each_entry_rcu(entry, h, hlist) {
		if (entry->vlan != vlan)
			continue;
		if (nla_put(skb, IFLA_MACVLAN_MACADDR, ETH_ALEN, entry->addr))
			return 1;
	}
	return 0;
}

1404 1405 1406 1407
static int macvlan_fill_info(struct sk_buff *skb,
				const struct net_device *dev)
{
	struct macvlan_dev *vlan = netdev_priv(dev);
M
Michael Braun 已提交
1408 1409
	int i;
	struct nlattr *nest;
1410

1411 1412
	if (nla_put_u32(skb, IFLA_MACVLAN_MODE, vlan->mode))
		goto nla_put_failure;
1413 1414
	if (nla_put_u16(skb, IFLA_MACVLAN_FLAGS, vlan->flags))
		goto nla_put_failure;
M
Michael Braun 已提交
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427
	if (nla_put_u32(skb, IFLA_MACVLAN_MACADDR_COUNT, vlan->macaddr_count))
		goto nla_put_failure;
	if (vlan->macaddr_count > 0) {
		nest = nla_nest_start(skb, IFLA_MACVLAN_MACADDR_DATA);
		if (nest == NULL)
			goto nla_put_failure;

		for (i = 0; i < MACVLAN_HASH_SIZE; i++) {
			if (macvlan_fill_info_macaddr(skb, vlan, i))
				goto nla_put_failure;
		}
		nla_nest_end(skb, nest);
	}
1428 1429 1430 1431 1432 1433 1434
	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = {
1435 1436
	[IFLA_MACVLAN_MODE]  = { .type = NLA_U32 },
	[IFLA_MACVLAN_FLAGS] = { .type = NLA_U16 },
M
Michael Braun 已提交
1437 1438 1439 1440
	[IFLA_MACVLAN_MACADDR_MODE] = { .type = NLA_U32 },
	[IFLA_MACVLAN_MACADDR] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
	[IFLA_MACVLAN_MACADDR_DATA] = { .type = NLA_NESTED },
	[IFLA_MACVLAN_MACADDR_COUNT] = { .type = NLA_U32 },
1441 1442
};

1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458
int macvlan_link_register(struct rtnl_link_ops *ops)
{
	/* common fields */
	ops->priv_size		= sizeof(struct macvlan_dev);
	ops->validate		= macvlan_validate;
	ops->maxtype		= IFLA_MACVLAN_MAX;
	ops->policy		= macvlan_policy;
	ops->changelink		= macvlan_changelink;
	ops->get_size		= macvlan_get_size;
	ops->fill_info		= macvlan_fill_info;

	return rtnl_link_register(ops);
};
EXPORT_SYMBOL_GPL(macvlan_link_register);

static struct rtnl_link_ops macvlan_link_ops = {
P
Patrick McHardy 已提交
1459
	.kind		= "macvlan",
H
Herbert Xu 已提交
1460
	.setup		= macvlan_setup,
P
Patrick McHardy 已提交
1461 1462 1463 1464 1465 1466 1467
	.newlink	= macvlan_newlink,
	.dellink	= macvlan_dellink,
};

static int macvlan_device_event(struct notifier_block *unused,
				unsigned long event, void *ptr)
{
1468
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
P
Patrick McHardy 已提交
1469 1470
	struct macvlan_dev *vlan, *next;
	struct macvlan_port *port;
1471
	LIST_HEAD(list_kill);
P
Patrick McHardy 已提交
1472

1473
	if (!macvlan_port_exists(dev))
P
Patrick McHardy 已提交
1474 1475
		return NOTIFY_DONE;

E
Eric Dumazet 已提交
1476
	port = macvlan_port_get_rtnl(dev);
1477

P
Patrick McHardy 已提交
1478 1479 1480
	switch (event) {
	case NETDEV_CHANGE:
		list_for_each_entry(vlan, &port->vlans, list)
1481 1482
			netif_stacked_transfer_operstate(vlan->lowerdev,
							 vlan->dev);
P
Patrick McHardy 已提交
1483 1484 1485
		break;
	case NETDEV_FEAT_CHANGE:
		list_for_each_entry(vlan, &port->vlans, list) {
1486
			vlan->dev->gso_max_size = dev->gso_max_size;
1487
			netdev_update_features(vlan->dev);
P
Patrick McHardy 已提交
1488 1489
		}
		break;
1490 1491 1492 1493 1494 1495
	case NETDEV_CHANGEMTU:
		list_for_each_entry(vlan, &port->vlans, list) {
			if (vlan->dev->mtu <= dev->mtu)
				continue;
			dev_set_mtu(vlan->dev, dev->mtu);
		}
1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507
		break;
	case NETDEV_CHANGEADDR:
		if (!port->passthru)
			return NOTIFY_DONE;

		vlan = list_first_entry_or_null(&port->vlans,
						struct macvlan_dev,
						list);

		if (macvlan_sync_address(vlan->dev, dev->dev_addr))
			return NOTIFY_BAD;

1508
		break;
P
Patrick McHardy 已提交
1509
	case NETDEV_UNREGISTER:
1510 1511 1512 1513
		/* twiddle thumbs on netns device moves */
		if (dev->reg_state != NETREG_UNREGISTERING)
			break;

P
Patrick McHardy 已提交
1514
		list_for_each_entry_safe(vlan, next, &port->vlans, list)
1515 1516
			vlan->dev->rtnl_link_ops->dellink(vlan->dev, &list_kill);
		unregister_netdevice_many(&list_kill);
P
Patrick McHardy 已提交
1517
		break;
1518 1519 1520
	case NETDEV_PRE_TYPE_CHANGE:
		/* Forbid underlaying device to change its type. */
		return NOTIFY_BAD;
V
Vlad Yasevich 已提交
1521 1522 1523 1524 1525 1526 1527

	case NETDEV_NOTIFY_PEERS:
	case NETDEV_BONDING_FAILOVER:
	case NETDEV_RESEND_IGMP:
		/* Propagate to all vlans */
		list_for_each_entry(vlan, &port->vlans, list)
			call_netdevice_notifiers(event, vlan->dev);
P
Patrick McHardy 已提交
1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541
	}
	return NOTIFY_DONE;
}

static struct notifier_block macvlan_notifier_block __read_mostly = {
	.notifier_call	= macvlan_device_event,
};

static int __init macvlan_init_module(void)
{
	int err;

	register_netdevice_notifier(&macvlan_notifier_block);

1542
	err = macvlan_link_register(&macvlan_link_ops);
P
Patrick McHardy 已提交
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563
	if (err < 0)
		goto err1;
	return 0;
err1:
	unregister_netdevice_notifier(&macvlan_notifier_block);
	return err;
}

static void __exit macvlan_cleanup_module(void)
{
	rtnl_link_unregister(&macvlan_link_ops);
	unregister_netdevice_notifier(&macvlan_notifier_block);
}

module_init(macvlan_init_module);
module_exit(macvlan_cleanup_module);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>");
MODULE_DESCRIPTION("Driver for MAC address based VLANs");
MODULE_ALIAS_RTNL_LINK("macvlan");