diff options
Diffstat (limited to 'drivers/net/macvlan.c')
| -rw-r--r-- | drivers/net/macvlan.c | 676 | 
1 files changed, 536 insertions, 140 deletions
diff --git a/drivers/net/macvlan.c b/drivers/net/macvlan.c index 6ed577b065d..958df383068 100644 --- a/drivers/net/macvlan.c +++ b/drivers/net/macvlan.c @@ -26,10 +26,14 @@  #include <linux/etherdevice.h>  #include <linux/ethtool.h>  #include <linux/if_arp.h> +#include <linux/if_vlan.h>  #include <linux/if_link.h>  #include <linux/if_macvlan.h> +#include <linux/hash.h> +#include <linux/workqueue.h>  #include <net/rtnetlink.h>  #include <net/xfrm.h> +#include <linux/netpoll.h>  #define MACVLAN_HASH_SIZE	(1 << BITS_PER_BYTE) @@ -38,22 +42,40 @@ struct macvlan_port {  	struct hlist_head	vlan_hash[MACVLAN_HASH_SIZE];  	struct list_head	vlans;  	struct rcu_head		rcu; +	struct sk_buff_head	bc_queue; +	struct work_struct	bc_work;  	bool 			passthru;  }; -#define macvlan_port_get_rcu(dev) \ -	((struct macvlan_port *) rcu_dereference(dev->rx_handler_data)) -#define macvlan_port_get(dev) ((struct macvlan_port *) dev->rx_handler_data) +#define MACVLAN_PORT_IS_EMPTY(port)    list_empty(&port->vlans) + +struct macvlan_skb_cb { +	const struct macvlan_dev *src; +}; + +#define MACVLAN_SKB_CB(__skb) ((struct macvlan_skb_cb *)&((__skb)->cb[0])) + +static void macvlan_port_destroy(struct net_device *dev); + +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); +} +  #define macvlan_port_exists(dev) (dev->priv_flags & IFF_MACVLAN_PORT)  static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port,  					       const unsigned char *addr)  {  	struct macvlan_dev *vlan; -	struct hlist_node *n; -	hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) { -		if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr)) +	hlist_for_each_entry_rcu(vlan, &port->vlan_hash[addr[5]], hlist) { +		if (ether_addr_equal_64bits(vlan->dev->dev_addr, addr))  			return vlan;  	}  	return NULL; @@ -67,16 +89,17 @@ static void macvlan_hash_add(struct macvlan_dev *vlan)  	hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]);  } -static void macvlan_hash_del(struct macvlan_dev *vlan) +static void macvlan_hash_del(struct macvlan_dev *vlan, bool sync)  {  	hlist_del_rcu(&vlan->hlist); -	synchronize_rcu(); +	if (sync) +		synchronize_rcu();  }  static void macvlan_hash_change_addr(struct macvlan_dev *vlan,  					const unsigned char *addr)  { -	macvlan_hash_del(vlan); +	macvlan_hash_del(vlan, true);  	/* Now that we are unhashed it is safe to change the device  	 * address without confusing packet delivery.  	 */ @@ -91,7 +114,7 @@ static int macvlan_addr_busy(const struct macvlan_port *port,  	 * currently in use by the underlying device or  	 * another macvlan.  	 */ -	if (!compare_ether_addr_64bits(port->dev->dev_addr, addr)) +	if (ether_addr_equal_64bits(port->dev->dev_addr, addr))  		return 1;  	if (macvlan_hash_lookup(port, addr)) @@ -106,20 +129,32 @@ static int macvlan_broadcast_one(struct sk_buff *skb,  				 const struct ethhdr *eth, bool local)  {  	struct net_device *dev = vlan->dev; -	if (!skb) -		return NET_RX_DROP;  	if (local) -		return vlan->forward(dev, skb); +		return __dev_forward_skb(dev, skb);  	skb->dev = dev; -	if (!compare_ether_addr_64bits(eth->h_dest, -				       dev->broadcast)) +	if (ether_addr_equal_64bits(eth->h_dest, dev->broadcast))  		skb->pkt_type = PACKET_BROADCAST;  	else  		skb->pkt_type = PACKET_MULTICAST; -	return vlan->receive(skb); +	return 0; +} + +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) +{ +	u32 val = __get_unaligned_cpu32(addr + 2); + +	val ^= macvlan_hash_mix(vlan); +	return hash_32(val, MACVLAN_MC_FILTER_BITS);  }  static void macvlan_broadcast(struct sk_buff *skb, @@ -129,42 +164,54 @@ static void macvlan_broadcast(struct sk_buff *skb,  {  	const struct ethhdr *eth = eth_hdr(skb);  	const struct macvlan_dev *vlan; -	struct hlist_node *n;  	struct sk_buff *nskb;  	unsigned int i;  	int err; +	unsigned int hash;  	if (skb->protocol == htons(ETH_P_PAUSE))  		return;  	for (i = 0; i < MACVLAN_HASH_SIZE; i++) { -		hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) { +		hlist_for_each_entry_rcu(vlan, &port->vlan_hash[i], hlist) {  			if (vlan->dev == src || !(vlan->mode & mode))  				continue; +			hash = mc_hash(vlan, eth->h_dest); +			if (!test_bit(hash, vlan->mc_filter)) +				continue; + +			err = NET_RX_DROP;  			nskb = skb_clone(skb, GFP_ATOMIC); -			err = macvlan_broadcast_one(nskb, vlan, eth, -					 mode == MACVLAN_MODE_BRIDGE); +			if (likely(nskb)) +				err = macvlan_broadcast_one( +					nskb, vlan, eth, +					mode == MACVLAN_MODE_BRIDGE) ?: +				      netif_rx_ni(nskb);  			macvlan_count_rx(vlan, skb->len + ETH_HLEN,  					 err == NET_RX_SUCCESS, 1);  		}  	}  } -/* called under rcu_read_lock() from netif_receive_skb */ -static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb) +static void macvlan_process_broadcast(struct work_struct *w)  { -	struct macvlan_port *port; -	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; +	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(); -	port = macvlan_port_get_rcu(skb->dev); -	if (is_multicast_ether_addr(eth->h_dest)) { -		src = macvlan_hash_lookup(port, eth->h_source);  		if (!src)  			/* frame comes from an external address */  			macvlan_broadcast(skb, port, NULL, @@ -177,27 +224,95 @@ static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb)  			macvlan_broadcast(skb, port, src->dev,  					  MACVLAN_MODE_VEPA |  					  MACVLAN_MODE_BRIDGE); -		else if (src->mode == MACVLAN_MODE_BRIDGE) +		else  			/*  			 * flood only to VEPA ports, bridge ports  			 * already saw the frame on the way out.  			 */  			macvlan_broadcast(skb, port, src->dev,  					  MACVLAN_MODE_VEPA); -		return skb; + +		rcu_read_unlock(); + +		kfree_skb(skb); +	} +} + +static void macvlan_broadcast_enqueue(struct macvlan_port *port, +				      struct sk_buff *skb) +{ +	struct sk_buff *nskb; +	int err = -ENOMEM; + +	nskb = skb_clone(skb, GFP_ATOMIC); +	if (!nskb) +		goto err; + +	spin_lock(&port->bc_queue.lock); +	if (skb_queue_len(&port->bc_queue) < skb->dev->tx_queue_len) { +		__skb_queue_tail(&port->bc_queue, nskb); +		err = 0; +	} +	spin_unlock(&port->bc_queue.lock); + +	if (err) +		goto free_nskb; + +	schedule_work(&port->bc_work); +	return; + +free_nskb: +	kfree_skb(nskb); +err: +	atomic_long_inc(&skb->dev->rx_dropped); +} + +/* 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); +		src = macvlan_hash_lookup(port, eth->h_source); +		if (src && src->mode != MACVLAN_MODE_VEPA && +		    src->mode != MACVLAN_MODE_BRIDGE) { +			/* forward to original port. */ +			vlan = src; +			ret = macvlan_broadcast_one(skb, vlan, eth, 0) ?: +			      netif_rx(skb); +			goto out; +		} + +		MACVLAN_SKB_CB(skb)->src = src; +		macvlan_broadcast_enqueue(port, skb); + +		return RX_HANDLER_PASS;  	}  	if (port->passthru) -		vlan = list_first_entry(&port->vlans, struct macvlan_dev, list); +		vlan = list_first_or_null_rcu(&port->vlans, +					      struct macvlan_dev, list);  	else  		vlan = macvlan_hash_lookup(port, eth->h_dest);  	if (vlan == NULL) -		return skb; +		return RX_HANDLER_PASS;  	dev = vlan->dev;  	if (unlikely(!(dev->flags & IFF_UP))) {  		kfree_skb(skb); -		return NULL; +		return RX_HANDLER_CONSUMED;  	}  	len = skb->len + ETH_HLEN;  	skb = skb_share_check(skb, GFP_ATOMIC); @@ -207,11 +322,11 @@ static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb)  	skb->dev = dev;  	skb->pkt_type = PACKET_HOST; -	ret = vlan->receive(skb); +	ret = netif_rx(skb);  out:  	macvlan_count_rx(vlan, len, ret == NET_RX_SUCCESS, 0); -	return NULL; +	return RX_HANDLER_CONSUMED;  }  static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) @@ -231,30 +346,48 @@ static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev)  		dest = macvlan_hash_lookup(port, eth->h_dest);  		if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { -			unsigned int length = skb->len + ETH_HLEN; -			int ret = dest->forward(dest->dev, skb); -			macvlan_count_rx(dest, length, -					 ret == NET_RX_SUCCESS, 0); +			/* send to lowerdev first for its network taps */ +			dev_forward_skb(vlan->lowerdev, skb);  			return NET_XMIT_SUCCESS;  		}  	}  xmit_world: -	skb_set_dev(skb, vlan->lowerdev); +	skb->dev = vlan->lowerdev;  	return dev_queue_xmit(skb);  } -netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, -			       struct net_device *dev) +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; +} + +static netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, +				      struct net_device *dev)  {  	unsigned int len = skb->len;  	int ret; -	const struct macvlan_dev *vlan = netdev_priv(dev); +	struct macvlan_dev *vlan = netdev_priv(dev); + +	if (unlikely(netpoll_tx_running(dev))) +		return macvlan_netpoll_send_skb(vlan, skb); + +	if (vlan->fwd_priv) { +		skb->dev = vlan->lowerdev; +		ret = dev_queue_xmit_accel(skb, vlan->fwd_priv); +	} else { +		ret = macvlan_queue_xmit(skb, dev); +	} -	ret = macvlan_queue_xmit(skb, dev);  	if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { -		struct macvlan_pcpu_stats *pcpu_stats; +		struct vlan_pcpu_stats *pcpu_stats;  		pcpu_stats = this_cpu_ptr(vlan->pcpu_stats);  		u64_stats_update_begin(&pcpu_stats->syncp); @@ -266,7 +399,6 @@ netdev_tx_t macvlan_start_xmit(struct sk_buff *skb,  	}  	return ret;  } -EXPORT_SYMBOL_GPL(macvlan_start_xmit);  static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev,  			       unsigned short type, const void *daddr, @@ -287,6 +419,8 @@ static const struct header_ops macvlan_hard_header_ops = {  	.cache_update	= eth_header_cache_update,  }; +static struct rtnl_link_ops macvlan_link_ops; +  static int macvlan_open(struct net_device *dev)  {  	struct macvlan_dev *vlan = netdev_priv(dev); @@ -294,10 +428,28 @@ static int macvlan_open(struct net_device *dev)  	int err;  	if (vlan->port->passthru) { -		dev_set_promiscuity(lowerdev, 1); +		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) { +			err = dev_set_promiscuity(lowerdev, 1); +			if (err < 0) +				goto out; +		}  		goto hash_add;  	} +	if (lowerdev->features & NETIF_F_HW_L2FW_DOFFLOAD && +	    dev->rtnl_link_ops == &macvlan_link_ops) { +		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; +		} else +			return 0; +	} +  	err = -EBUSY;  	if (macvlan_addr_busy(vlan->port, dev->dev_addr))  		goto out; @@ -318,6 +470,11 @@ hash_add:  del_unicast:  	dev_uc_del(lowerdev, dev->dev_addr);  out: +	if (vlan->fwd_priv) { +		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev, +							   vlan->fwd_priv); +		vlan->fwd_priv = NULL; +	}  	return err;  } @@ -326,64 +483,106 @@ static int macvlan_stop(struct net_device *dev)  	struct macvlan_dev *vlan = netdev_priv(dev);  	struct net_device *lowerdev = vlan->lowerdev; +	if (vlan->fwd_priv) { +		lowerdev->netdev_ops->ndo_dfwd_del_station(lowerdev, +							   vlan->fwd_priv); +		vlan->fwd_priv = NULL; +		return 0; +	} + +	dev_uc_unsync(lowerdev, dev); +	dev_mc_unsync(lowerdev, dev); +  	if (vlan->port->passthru) { -		dev_set_promiscuity(lowerdev, -1); +		if (!(vlan->flags & MACVLAN_FLAG_NOPROMISC)) +			dev_set_promiscuity(lowerdev, -1);  		goto hash_del;  	} -	dev_mc_unsync(lowerdev, dev);  	if (dev->flags & IFF_ALLMULTI)  		dev_set_allmulti(lowerdev, -1);  	dev_uc_del(lowerdev, dev->dev_addr);  hash_del: -	macvlan_hash_del(vlan); +	macvlan_hash_del(vlan, !dev->dismantle);  	return 0;  } -static int macvlan_set_mac_address(struct net_device *dev, void *p) +static int macvlan_sync_address(struct net_device *dev, unsigned char *addr)  {  	struct macvlan_dev *vlan = netdev_priv(dev);  	struct net_device *lowerdev = vlan->lowerdev; -	struct sockaddr *addr = p;  	int err; -	if (!is_valid_ether_addr(addr->sa_data)) -		return -EADDRNOTAVAIL; -  	if (!(dev->flags & IFF_UP)) {  		/* Just copy in the new address */ -		memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); +		ether_addr_copy(dev->dev_addr, addr);  	} else {  		/* Rehash and update the device filters */ -		if (macvlan_addr_busy(vlan->port, addr->sa_data)) +		if (macvlan_addr_busy(vlan->port, addr))  			return -EBUSY; -		err = dev_uc_add(lowerdev, addr->sa_data); -		if (err) -			return err; +		if (!vlan->port->passthru) { +			err = dev_uc_add(lowerdev, addr); +			if (err) +				return err; -		dev_uc_del(lowerdev, dev->dev_addr); +			dev_uc_del(lowerdev, dev->dev_addr); +		} -		macvlan_hash_change_addr(vlan, addr->sa_data); +		macvlan_hash_change_addr(vlan, addr);  	}  	return 0;  } +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); +} +  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; -	if (change & IFF_ALLMULTI) -		dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); +	if (dev->flags & IFF_UP) { +		if (change & IFF_ALLMULTI) +			dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); +	}  } -static void macvlan_set_multicast_list(struct net_device *dev) +static void macvlan_set_mac_lists(struct net_device *dev)  {  	struct macvlan_dev *vlan = netdev_priv(dev); +	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) { +			__set_bit(mc_hash(vlan, ha->addr), filter); +		} + +		__set_bit(mc_hash(vlan, dev->broadcast), filter); + +		bitmap_copy(vlan->mc_filter, filter, MACVLAN_MC_FILTER_SZ); +	} +	dev_uc_sync(vlan->lowerdev, dev);  	dev_mc_sync(vlan->lowerdev, dev);  } @@ -405,14 +604,23 @@ static int macvlan_change_mtu(struct net_device *dev, int new_mtu)  static struct lock_class_key macvlan_netdev_xmit_lock_key;  static struct lock_class_key macvlan_netdev_addr_lock_key; +#define ALWAYS_ON_FEATURES \ +	(NETIF_F_SG | NETIF_F_GEN_CSUM | NETIF_F_GSO_SOFTWARE | NETIF_F_LLTX) +  #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 | \ -	 NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO) +	 NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO | NETIF_F_RXCSUM | \ +	 NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER)  #define MACVLAN_STATE_MASK \  	((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) +static int macvlan_get_nest_level(struct net_device *dev) +{ +	return ((struct macvlan_dev *)netdev_priv(dev))->nest_level; +} +  static void macvlan_set_lockdep_class_one(struct net_device *dev,  					  struct netdev_queue *txq,  					  void *_unused) @@ -423,8 +631,9 @@ static void macvlan_set_lockdep_class_one(struct net_device *dev,  static void macvlan_set_lockdep_class(struct net_device *dev)  { -	lockdep_set_class(&dev->addr_list_lock, -			  &macvlan_netdev_addr_lock_key); +	lockdep_set_class_and_subclass(&dev->addr_list_lock, +				       &macvlan_netdev_addr_lock_key, +				       macvlan_get_nest_level(dev));  	netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL);  } @@ -436,14 +645,14 @@ static int macvlan_init(struct net_device *dev)  	dev->state		= (dev->state & ~MACVLAN_STATE_MASK) |  				  (lowerdev->state & MACVLAN_STATE_MASK);  	dev->features 		= lowerdev->features & MACVLAN_FEATURES; -	dev->features		|= NETIF_F_LLTX; +	dev->features		|= ALWAYS_ON_FEATURES;  	dev->gso_max_size	= lowerdev->gso_max_size;  	dev->iflink		= lowerdev->ifindex;  	dev->hard_header_len	= lowerdev->hard_header_len;  	macvlan_set_lockdep_class(dev); -	vlan->pcpu_stats = alloc_percpu(struct macvlan_pcpu_stats); +	vlan->pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats);  	if (!vlan->pcpu_stats)  		return -ENOMEM; @@ -453,8 +662,12 @@ static int macvlan_init(struct net_device *dev)  static void macvlan_uninit(struct net_device *dev)  {  	struct macvlan_dev *vlan = netdev_priv(dev); +	struct macvlan_port *port = vlan->port;  	free_percpu(vlan->pcpu_stats); + +	if (MACVLAN_PORT_IS_EMPTY(port)) +		macvlan_port_destroy(port->dev);  }  static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev, @@ -463,7 +676,7 @@ static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev,  	struct macvlan_dev *vlan = netdev_priv(dev);  	if (vlan->pcpu_stats) { -		struct macvlan_pcpu_stats *p; +		struct vlan_pcpu_stats *p;  		u64 rx_packets, rx_bytes, rx_multicast, tx_packets, tx_bytes;  		u32 rx_errors = 0, tx_dropped = 0;  		unsigned int start; @@ -472,13 +685,13 @@ static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev,  		for_each_possible_cpu(i) {  			p = per_cpu_ptr(vlan->pcpu_stats, i);  			do { -				start = u64_stats_fetch_begin_bh(&p->syncp); +				start = u64_stats_fetch_begin_irq(&p->syncp);  				rx_packets	= p->rx_packets;  				rx_bytes	= p->rx_bytes;  				rx_multicast	= p->rx_multicast;  				tx_packets	= p->tx_packets;  				tx_bytes	= p->tx_bytes; -			} while (u64_stats_fetch_retry_bh(&p->syncp, start)); +			} while (u64_stats_fetch_retry_irq(&p->syncp, start));  			stats->rx_packets	+= rx_packets;  			stats->rx_bytes		+= rx_bytes; @@ -498,38 +711,146 @@ static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev,  	return stats;  } -static void macvlan_ethtool_get_drvinfo(struct net_device *dev, -					struct ethtool_drvinfo *drvinfo) +static int macvlan_vlan_rx_add_vid(struct net_device *dev, +				   __be16 proto, u16 vid)  { -	snprintf(drvinfo->driver, 32, "macvlan"); -	snprintf(drvinfo->version, 32, "0.1"); +	struct macvlan_dev *vlan = netdev_priv(dev); +	struct net_device *lowerdev = vlan->lowerdev; + +	return vlan_vid_add(lowerdev, proto, vid);  } -static u32 macvlan_ethtool_get_rx_csum(struct net_device *dev) +static int macvlan_vlan_rx_kill_vid(struct net_device *dev, +				    __be16 proto, u16 vid)  { -	const struct macvlan_dev *vlan = netdev_priv(dev); -	return dev_ethtool_get_rx_csum(vlan->lowerdev); +	struct macvlan_dev *vlan = netdev_priv(dev); +	struct net_device *lowerdev = vlan->lowerdev; + +	vlan_vid_del(lowerdev, proto, vid); +	return 0; +} + +static int macvlan_fdb_add(struct ndmsg *ndm, struct nlattr *tb[], +			   struct net_device *dev, +			   const unsigned char *addr, +			   u16 flags) +{ +	struct macvlan_dev *vlan = netdev_priv(dev); +	int err = -EINVAL; + +	if (!vlan->port->passthru) +		return -EOPNOTSUPP; + +	if (flags & NLM_F_REPLACE) +		return -EOPNOTSUPP; + +	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; +} + +static int macvlan_fdb_del(struct ndmsg *ndm, struct nlattr *tb[], +			   struct net_device *dev, +			   const unsigned char *addr) +{ +	struct macvlan_dev *vlan = netdev_priv(dev); +	int err = -EINVAL; + +	if (!vlan->port->passthru) +		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; +} + +static void macvlan_ethtool_get_drvinfo(struct net_device *dev, +					struct ethtool_drvinfo *drvinfo) +{ +	strlcpy(drvinfo->driver, "macvlan", sizeof(drvinfo->driver)); +	strlcpy(drvinfo->version, "0.1", sizeof(drvinfo->version));  }  static int macvlan_ethtool_get_settings(struct net_device *dev,  					struct ethtool_cmd *cmd)  {  	const struct macvlan_dev *vlan = netdev_priv(dev); -	return dev_ethtool_get_settings(vlan->lowerdev, cmd); + +	return __ethtool_get_settings(vlan->lowerdev, cmd);  } -static u32 macvlan_ethtool_get_flags(struct net_device *dev) +static netdev_features_t macvlan_fix_features(struct net_device *dev, +					      netdev_features_t features)  { -	const struct macvlan_dev *vlan = netdev_priv(dev); -	return dev_ethtool_get_flags(vlan->lowerdev); +	struct macvlan_dev *vlan = netdev_priv(dev); +	netdev_features_t mask; + +	features |= NETIF_F_ALL_FOR_ALL; +	features &= (vlan->set_features | ~MACVLAN_FEATURES); +	mask = features; + +	features = netdev_increment_features(vlan->lowerdev->features, +					     features, +					     mask); +	features |= ALWAYS_ON_FEATURES; + +	return features; +} + +#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 */  static const struct ethtool_ops macvlan_ethtool_ops = {  	.get_link		= ethtool_op_get_link,  	.get_settings		= macvlan_ethtool_get_settings, -	.get_rx_csum		= macvlan_ethtool_get_rx_csum,  	.get_drvinfo		= macvlan_ethtool_get_drvinfo, -	.get_flags		= macvlan_ethtool_get_flags,  };  static const struct net_device_ops macvlan_netdev_ops = { @@ -539,21 +860,34 @@ static const struct net_device_ops macvlan_netdev_ops = {  	.ndo_stop		= macvlan_stop,  	.ndo_start_xmit		= macvlan_start_xmit,  	.ndo_change_mtu		= macvlan_change_mtu, +	.ndo_fix_features	= macvlan_fix_features,  	.ndo_change_rx_flags	= macvlan_change_rx_flags,  	.ndo_set_mac_address	= macvlan_set_mac_address, -	.ndo_set_multicast_list	= macvlan_set_multicast_list, +	.ndo_set_rx_mode	= macvlan_set_mac_lists,  	.ndo_get_stats64	= macvlan_dev_get_stats64,  	.ndo_validate_addr	= eth_validate_addr, +	.ndo_vlan_rx_add_vid	= macvlan_vlan_rx_add_vid, +	.ndo_vlan_rx_kill_vid	= macvlan_vlan_rx_kill_vid, +	.ndo_fdb_add		= macvlan_fdb_add, +	.ndo_fdb_del		= macvlan_fdb_del, +	.ndo_fdb_dump		= ndo_dflt_fdb_dump, +	.ndo_get_lock_subclass  = macvlan_get_nest_level, +#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  };  void macvlan_common_setup(struct net_device *dev)  {  	ether_setup(dev); -	dev->priv_flags	       &= ~IFF_XMIT_DST_RELEASE; +	dev->priv_flags	       &= ~(IFF_XMIT_DST_RELEASE | IFF_TX_SKB_SHARING); +	dev->priv_flags	       |= IFF_UNICAST_FLT;  	dev->netdev_ops		= &macvlan_netdev_ops;  	dev->destructor		= free_netdev; -	dev->header_ops		= &macvlan_hard_header_ops, +	dev->header_ops		= &macvlan_hard_header_ops;  	dev->ethtool_ops	= &macvlan_ethtool_ops;  }  EXPORT_SYMBOL_GPL(macvlan_common_setup); @@ -583,29 +917,25 @@ static int macvlan_port_create(struct net_device *dev)  	for (i = 0; i < MACVLAN_HASH_SIZE; i++)  		INIT_HLIST_HEAD(&port->vlan_hash[i]); +	skb_queue_head_init(&port->bc_queue); +	INIT_WORK(&port->bc_work, macvlan_process_broadcast); +  	err = netdev_rx_handler_register(dev, macvlan_handle_frame, port);  	if (err)  		kfree(port); - -	dev->priv_flags |= IFF_MACVLAN_PORT; +	else +		dev->priv_flags |= IFF_MACVLAN_PORT;  	return err;  } -static void macvlan_port_rcu_free(struct rcu_head *head) -{ -	struct macvlan_port *port; - -	port = container_of(head, struct macvlan_port, rcu); -	kfree(port); -} -  static void macvlan_port_destroy(struct net_device *dev)  { -	struct macvlan_port *port = macvlan_port_get(dev); +	struct macvlan_port *port = macvlan_port_get_rtnl(dev); +	cancel_work_sync(&port->bc_work);  	dev->priv_flags &= ~IFF_MACVLAN_PORT;  	netdev_rx_handler_unregister(dev); -	call_rcu(&port->rcu, macvlan_port_rcu_free); +	kfree_rcu(port, rcu);  }  static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) @@ -617,6 +947,10 @@ static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])  			return -EADDRNOTAVAIL;  	} +	if (data && data[IFLA_MACVLAN_FLAGS] && +	    nla_get_u16(data[IFLA_MACVLAN_FLAGS]) & ~MACVLAN_FLAG_NOPROMISC) +		return -EINVAL; +  	if (data && data[IFLA_MACVLAN_MODE]) {  		switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) {  		case MACVLAN_MODE_PRIVATE: @@ -632,10 +966,7 @@ static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[])  }  int macvlan_common_newlink(struct net *src_net, struct net_device *dev, -			   struct nlattr *tb[], struct nlattr *data[], -			   int (*receive)(struct sk_buff *skb), -			   int (*forward)(struct net_device *dev, -					  struct sk_buff *skb)) +			   struct nlattr *tb[], struct nlattr *data[])  {  	struct macvlan_dev *vlan = netdev_priv(dev);  	struct macvlan_port *port; @@ -649,13 +980,11 @@ int macvlan_common_newlink(struct net *src_net, struct net_device *dev,  	if (lowerdev == NULL)  		return -ENODEV; -	/* When creating macvlans on top of other macvlans - use +	/* When creating macvlans or macvtaps on top of other macvlans - use  	 * the real device as the lowerdev.  	 */ -	if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) { -		struct macvlan_dev *lowervlan = netdev_priv(lowerdev); -		lowerdev = lowervlan->lowerdev; -	} +	if (netif_is_macvlan(lowerdev)) +		lowerdev = macvlan_dev_real_dev(lowerdev);  	if (!tb[IFLA_MTU])  		dev->mtu = lowerdev->mtu; @@ -663,14 +992,14 @@ int macvlan_common_newlink(struct net *src_net, struct net_device *dev,  		return -EINVAL;  	if (!tb[IFLA_ADDRESS]) -		random_ether_addr(dev->dev_addr); +		eth_hw_addr_random(dev);  	if (!macvlan_port_exists(lowerdev)) {  		err = macvlan_port_create(lowerdev);  		if (err < 0)  			return err;  	} -	port = macvlan_port_get(lowerdev); +	port = macvlan_port_get_rtnl(lowerdev);  	/* Only 1 macvlan device can be created in passthru mode */  	if (port->passthru) @@ -679,31 +1008,41 @@ int macvlan_common_newlink(struct net *src_net, struct net_device *dev,  	vlan->lowerdev = lowerdev;  	vlan->dev      = dev;  	vlan->port     = port; -	vlan->receive  = receive; -	vlan->forward  = forward; +	vlan->set_features = MACVLAN_FEATURES; +	vlan->nest_level = dev_get_nest_level(lowerdev, netif_is_macvlan) + 1;  	vlan->mode     = MACVLAN_MODE_VEPA;  	if (data && data[IFLA_MACVLAN_MODE])  		vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); +	if (data && data[IFLA_MACVLAN_FLAGS]) +		vlan->flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); +  	if (vlan->mode == MACVLAN_MODE_PASSTHRU) { -		if (!list_empty(&port->vlans)) +		if (!MACVLAN_PORT_IS_EMPTY(port))  			return -EINVAL;  		port->passthru = true; -		memcpy(dev->dev_addr, lowerdev->dev_addr, ETH_ALEN); +		eth_hw_addr_inherit(dev, lowerdev);  	}  	err = register_netdevice(dev);  	if (err < 0)  		goto destroy_port; -	list_add_tail(&vlan->list, &port->vlans); +	dev->priv_flags |= IFF_MACVLAN; +	err = netdev_upper_dev_link(lowerdev, dev); +	if (err) +		goto unregister_netdev; + +	list_add_tail_rcu(&vlan->list, &port->vlans);  	netif_stacked_transfer_operstate(lowerdev, dev);  	return 0; +unregister_netdev: +	unregister_netdevice(dev);  destroy_port: -	if (list_empty(&port->vlans)) +	if (MACVLAN_PORT_IS_EMPTY(port))  		macvlan_port_destroy(lowerdev);  	return err; @@ -713,21 +1052,16 @@ EXPORT_SYMBOL_GPL(macvlan_common_newlink);  static int macvlan_newlink(struct net *src_net, struct net_device *dev,  			   struct nlattr *tb[], struct nlattr *data[])  { -	return macvlan_common_newlink(src_net, dev, tb, data, -				      netif_rx, -				      dev_forward_skb); +	return macvlan_common_newlink(src_net, dev, tb, data);  }  void macvlan_dellink(struct net_device *dev, struct list_head *head)  {  	struct macvlan_dev *vlan = netdev_priv(dev); -	struct macvlan_port *port = vlan->port; -	list_del(&vlan->list); +	list_del_rcu(&vlan->list);  	unregister_netdevice_queue(dev, head); - -	if (list_empty(&port->vlans)) -		macvlan_port_destroy(port->dev); +	netdev_upper_dev_unlink(vlan->lowerdev, dev);  }  EXPORT_SYMBOL_GPL(macvlan_dellink); @@ -735,14 +1069,45 @@ static int macvlan_changelink(struct net_device *dev,  		struct nlattr *tb[], struct nlattr *data[])  {  	struct macvlan_dev *vlan = netdev_priv(dev); -	if (data && data[IFLA_MACVLAN_MODE]) -		vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); +	enum macvlan_mode mode; +	bool set_mode = false; + +	/* 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; +	} + +	if (data && data[IFLA_MACVLAN_FLAGS]) { +		__u16 flags = nla_get_u16(data[IFLA_MACVLAN_FLAGS]); +		bool promisc = (flags ^ vlan->flags) & MACVLAN_FLAG_NOPROMISC; +		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; +		} +		vlan->flags = flags; +	} +	if (set_mode) +		vlan->mode = mode;  	return 0;  }  static size_t macvlan_get_size(const struct net_device *dev)  { -	return nla_total_size(4); +	return (0 +		+ nla_total_size(4) /* IFLA_MACVLAN_MODE */ +		+ nla_total_size(2) /* IFLA_MACVLAN_FLAGS */ +		);  }  static int macvlan_fill_info(struct sk_buff *skb, @@ -750,7 +1115,10 @@ static int macvlan_fill_info(struct sk_buff *skb,  {  	struct macvlan_dev *vlan = netdev_priv(dev); -	NLA_PUT_U32(skb, IFLA_MACVLAN_MODE, vlan->mode); +	if (nla_put_u32(skb, IFLA_MACVLAN_MODE, vlan->mode)) +		goto nla_put_failure; +	if (nla_put_u16(skb, IFLA_MACVLAN_FLAGS, vlan->flags)) +		goto nla_put_failure;  	return 0;  nla_put_failure: @@ -758,7 +1126,8 @@ nla_put_failure:  }  static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = { -	[IFLA_MACVLAN_MODE] = { .type = NLA_U32 }, +	[IFLA_MACVLAN_MODE]  = { .type = NLA_U32 }, +	[IFLA_MACVLAN_FLAGS] = { .type = NLA_U16 },  };  int macvlan_link_register(struct rtnl_link_ops *ops) @@ -786,14 +1155,15 @@ static struct rtnl_link_ops macvlan_link_ops = {  static int macvlan_device_event(struct notifier_block *unused,  				unsigned long event, void *ptr)  { -	struct net_device *dev = ptr; +	struct net_device *dev = netdev_notifier_info_to_dev(ptr);  	struct macvlan_dev *vlan, *next;  	struct macvlan_port *port; +	LIST_HEAD(list_kill);  	if (!macvlan_port_exists(dev))  		return NOTIFY_DONE; -	port = macvlan_port_get(dev); +	port = macvlan_port_get_rtnl(dev);  	switch (event) {  	case NETDEV_CHANGE: @@ -803,22 +1173,48 @@ static int macvlan_device_event(struct notifier_block *unused,  		break;  	case NETDEV_FEAT_CHANGE:  		list_for_each_entry(vlan, &port->vlans, list) { -			vlan->dev->features = dev->features & MACVLAN_FEATURES;  			vlan->dev->gso_max_size = dev->gso_max_size; -			netdev_features_change(vlan->dev); +			netdev_update_features(vlan->dev); +		} +		break; +	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);  		}  		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; + +		break;  	case NETDEV_UNREGISTER:  		/* twiddle thumbs on netns device moves */  		if (dev->reg_state != NETREG_UNREGISTERING)  			break;  		list_for_each_entry_safe(vlan, next, &port->vlans, list) -			vlan->dev->rtnl_link_ops->dellink(vlan->dev, NULL); +			vlan->dev->rtnl_link_ops->dellink(vlan->dev, &list_kill); +		unregister_netdevice_many(&list_kill);  		break;  	case NETDEV_PRE_TYPE_CHANGE:  		/* Forbid underlaying device to change its type. */  		return NOTIFY_BAD; + +	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);  	}  	return NOTIFY_DONE;  }  | 
