1b863ceb7SPatrick McHardy /* 2b863ceb7SPatrick McHardy * Copyright (c) 2007 Patrick McHardy <kaber@trash.net> 3b863ceb7SPatrick McHardy * 4b863ceb7SPatrick McHardy * This program is free software; you can redistribute it and/or 5b863ceb7SPatrick McHardy * modify it under the terms of the GNU General Public License as 6b863ceb7SPatrick McHardy * published by the Free Software Foundation; either version 2 of 7b863ceb7SPatrick McHardy * the License, or (at your option) any later version. 8b863ceb7SPatrick McHardy * 9b863ceb7SPatrick McHardy * The code this is based on carried the following copyright notice: 10b863ceb7SPatrick McHardy * --- 11b863ceb7SPatrick McHardy * (C) Copyright 2001-2006 12b863ceb7SPatrick McHardy * Alex Zeffertt, Cambridge Broadband Ltd, ajz@cambridgebroadband.com 13b863ceb7SPatrick McHardy * Re-worked by Ben Greear <greearb@candelatech.com> 14b863ceb7SPatrick McHardy * --- 15b863ceb7SPatrick McHardy */ 16b863ceb7SPatrick McHardy #include <linux/kernel.h> 17b863ceb7SPatrick McHardy #include <linux/types.h> 18b863ceb7SPatrick McHardy #include <linux/module.h> 19b863ceb7SPatrick McHardy #include <linux/init.h> 20b863ceb7SPatrick McHardy #include <linux/errno.h> 21b863ceb7SPatrick McHardy #include <linux/slab.h> 22b863ceb7SPatrick McHardy #include <linux/string.h> 2382524746SFranck Bui-Huu #include <linux/rculist.h> 24b863ceb7SPatrick McHardy #include <linux/notifier.h> 25b863ceb7SPatrick McHardy #include <linux/netdevice.h> 26b863ceb7SPatrick McHardy #include <linux/etherdevice.h> 27b863ceb7SPatrick McHardy #include <linux/ethtool.h> 28b863ceb7SPatrick McHardy #include <linux/if_arp.h> 29b863ceb7SPatrick McHardy #include <linux/if_link.h> 30b863ceb7SPatrick McHardy #include <linux/if_macvlan.h> 31b863ceb7SPatrick McHardy #include <net/rtnetlink.h> 32618e1b74SArnd Bergmann #include <net/xfrm.h> 33b863ceb7SPatrick McHardy 34b863ceb7SPatrick McHardy #define MACVLAN_HASH_SIZE (1 << BITS_PER_BYTE) 35b863ceb7SPatrick McHardy 36b863ceb7SPatrick McHardy struct macvlan_port { 37b863ceb7SPatrick McHardy struct net_device *dev; 38b863ceb7SPatrick McHardy struct hlist_head vlan_hash[MACVLAN_HASH_SIZE]; 39b863ceb7SPatrick McHardy struct list_head vlans; 408b37ef0aSJiri Pirko struct rcu_head rcu; 41b863ceb7SPatrick McHardy }; 42b863ceb7SPatrick McHardy 43a35e2c1bSJiri Pirko #define macvlan_port_get_rcu(dev) \ 44a35e2c1bSJiri Pirko ((struct macvlan_port *) rcu_dereference(dev->rx_handler_data)) 45a35e2c1bSJiri Pirko #define macvlan_port_get(dev) ((struct macvlan_port *) dev->rx_handler_data) 46a35e2c1bSJiri Pirko #define macvlan_port_exists(dev) (dev->priv_flags & IFF_MACVLAN_PORT) 47a35e2c1bSJiri Pirko 48b863ceb7SPatrick McHardy static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port, 49b863ceb7SPatrick McHardy const unsigned char *addr) 50b863ceb7SPatrick McHardy { 51b863ceb7SPatrick McHardy struct macvlan_dev *vlan; 52b863ceb7SPatrick McHardy struct hlist_node *n; 53b863ceb7SPatrick McHardy 54b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) { 55ac06713dSEric Dumazet if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr)) 56b863ceb7SPatrick McHardy return vlan; 57b863ceb7SPatrick McHardy } 58b863ceb7SPatrick McHardy return NULL; 59b863ceb7SPatrick McHardy } 60b863ceb7SPatrick McHardy 61f9ac30f0SEric Biederman static void macvlan_hash_add(struct macvlan_dev *vlan) 62f9ac30f0SEric Biederman { 63f9ac30f0SEric Biederman struct macvlan_port *port = vlan->port; 64f9ac30f0SEric Biederman const unsigned char *addr = vlan->dev->dev_addr; 65f9ac30f0SEric Biederman 66f9ac30f0SEric Biederman hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]); 67f9ac30f0SEric Biederman } 68f9ac30f0SEric Biederman 69f9ac30f0SEric Biederman static void macvlan_hash_del(struct macvlan_dev *vlan) 70f9ac30f0SEric Biederman { 71f9ac30f0SEric Biederman hlist_del_rcu(&vlan->hlist); 72f9ac30f0SEric Biederman synchronize_rcu(); 73f9ac30f0SEric Biederman } 74f9ac30f0SEric Biederman 75f9ac30f0SEric Biederman static void macvlan_hash_change_addr(struct macvlan_dev *vlan, 76f9ac30f0SEric Biederman const unsigned char *addr) 77f9ac30f0SEric Biederman { 78f9ac30f0SEric Biederman macvlan_hash_del(vlan); 79f9ac30f0SEric Biederman /* Now that we are unhashed it is safe to change the device 80f9ac30f0SEric Biederman * address without confusing packet delivery. 81f9ac30f0SEric Biederman */ 82f9ac30f0SEric Biederman memcpy(vlan->dev->dev_addr, addr, ETH_ALEN); 83f9ac30f0SEric Biederman macvlan_hash_add(vlan); 84f9ac30f0SEric Biederman } 85f9ac30f0SEric Biederman 86f9ac30f0SEric Biederman static int macvlan_addr_busy(const struct macvlan_port *port, 87f9ac30f0SEric Biederman const unsigned char *addr) 88f9ac30f0SEric Biederman { 89f9ac30f0SEric Biederman /* Test to see if the specified multicast address is 90f9ac30f0SEric Biederman * currently in use by the underlying device or 91f9ac30f0SEric Biederman * another macvlan. 92f9ac30f0SEric Biederman */ 93ac06713dSEric Dumazet if (!compare_ether_addr_64bits(port->dev->dev_addr, addr)) 94f9ac30f0SEric Biederman return 1; 95f9ac30f0SEric Biederman 96f9ac30f0SEric Biederman if (macvlan_hash_lookup(port, addr)) 97f9ac30f0SEric Biederman return 1; 98f9ac30f0SEric Biederman 99f9ac30f0SEric Biederman return 0; 100f9ac30f0SEric Biederman } 101f9ac30f0SEric Biederman 102a1e514c5SArnd Bergmann 103fc0663d6SArnd Bergmann static int macvlan_broadcast_one(struct sk_buff *skb, 104fc0663d6SArnd Bergmann const struct macvlan_dev *vlan, 105618e1b74SArnd Bergmann const struct ethhdr *eth, bool local) 106a1e514c5SArnd Bergmann { 107fc0663d6SArnd Bergmann struct net_device *dev = vlan->dev; 108a1e514c5SArnd Bergmann if (!skb) 109a1e514c5SArnd Bergmann return NET_RX_DROP; 110a1e514c5SArnd Bergmann 111618e1b74SArnd Bergmann if (local) 112fc0663d6SArnd Bergmann return vlan->forward(dev, skb); 113618e1b74SArnd Bergmann 114a1e514c5SArnd Bergmann skb->dev = dev; 115a1e514c5SArnd Bergmann if (!compare_ether_addr_64bits(eth->h_dest, 116a1e514c5SArnd Bergmann dev->broadcast)) 117a1e514c5SArnd Bergmann skb->pkt_type = PACKET_BROADCAST; 118a1e514c5SArnd Bergmann else 119a1e514c5SArnd Bergmann skb->pkt_type = PACKET_MULTICAST; 120a1e514c5SArnd Bergmann 121fc0663d6SArnd Bergmann return vlan->receive(skb); 122a1e514c5SArnd Bergmann } 123a1e514c5SArnd Bergmann 124b863ceb7SPatrick McHardy static void macvlan_broadcast(struct sk_buff *skb, 125618e1b74SArnd Bergmann const struct macvlan_port *port, 126618e1b74SArnd Bergmann struct net_device *src, 127618e1b74SArnd Bergmann enum macvlan_mode mode) 128b863ceb7SPatrick McHardy { 129b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 130b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 131b863ceb7SPatrick McHardy struct hlist_node *n; 132b863ceb7SPatrick McHardy struct sk_buff *nskb; 133b863ceb7SPatrick McHardy unsigned int i; 134a1e514c5SArnd Bergmann int err; 135b863ceb7SPatrick McHardy 136efbbced3SPatrick McHardy if (skb->protocol == htons(ETH_P_PAUSE)) 137efbbced3SPatrick McHardy return; 138efbbced3SPatrick McHardy 139b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 140b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) { 141618e1b74SArnd Bergmann if (vlan->dev == src || !(vlan->mode & mode)) 142618e1b74SArnd Bergmann continue; 143618e1b74SArnd Bergmann 144b863ceb7SPatrick McHardy nskb = skb_clone(skb, GFP_ATOMIC); 145fc0663d6SArnd Bergmann err = macvlan_broadcast_one(nskb, vlan, eth, 146618e1b74SArnd Bergmann mode == MACVLAN_MODE_BRIDGE); 147a1e514c5SArnd Bergmann macvlan_count_rx(vlan, skb->len + ETH_HLEN, 148a1e514c5SArnd Bergmann err == NET_RX_SUCCESS, 1); 149b863ceb7SPatrick McHardy } 150b863ceb7SPatrick McHardy } 151b863ceb7SPatrick McHardy } 152b863ceb7SPatrick McHardy 153b863ceb7SPatrick McHardy /* called under rcu_read_lock() from netif_receive_skb */ 154ab95bfe0SJiri Pirko static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb) 155b863ceb7SPatrick McHardy { 156ab95bfe0SJiri Pirko struct macvlan_port *port; 157b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 158b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 159618e1b74SArnd Bergmann const struct macvlan_dev *src; 160b863ceb7SPatrick McHardy struct net_device *dev; 161a1e514c5SArnd Bergmann unsigned int len; 162b863ceb7SPatrick McHardy 163a35e2c1bSJiri Pirko port = macvlan_port_get_rcu(skb->dev); 164b863ceb7SPatrick McHardy if (is_multicast_ether_addr(eth->h_dest)) { 165618e1b74SArnd Bergmann src = macvlan_hash_lookup(port, eth->h_source); 166618e1b74SArnd Bergmann if (!src) 167618e1b74SArnd Bergmann /* frame comes from an external address */ 168618e1b74SArnd Bergmann macvlan_broadcast(skb, port, NULL, 169618e1b74SArnd Bergmann MACVLAN_MODE_PRIVATE | 170618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 171618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 172618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_VEPA) 173618e1b74SArnd Bergmann /* flood to everyone except source */ 174618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 175618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 176618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 177618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_BRIDGE) 178618e1b74SArnd Bergmann /* 179618e1b74SArnd Bergmann * flood only to VEPA ports, bridge ports 180618e1b74SArnd Bergmann * already saw the frame on the way out. 181618e1b74SArnd Bergmann */ 182618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 183618e1b74SArnd Bergmann MACVLAN_MODE_VEPA); 184b863ceb7SPatrick McHardy return skb; 185b863ceb7SPatrick McHardy } 186b863ceb7SPatrick McHardy 187b863ceb7SPatrick McHardy vlan = macvlan_hash_lookup(port, eth->h_dest); 188b863ceb7SPatrick McHardy if (vlan == NULL) 189b863ceb7SPatrick McHardy return skb; 190b863ceb7SPatrick McHardy 191b863ceb7SPatrick McHardy dev = vlan->dev; 192b863ceb7SPatrick McHardy if (unlikely(!(dev->flags & IFF_UP))) { 193b863ceb7SPatrick McHardy kfree_skb(skb); 194b863ceb7SPatrick McHardy return NULL; 195b863ceb7SPatrick McHardy } 196a1e514c5SArnd Bergmann len = skb->len + ETH_HLEN; 197b863ceb7SPatrick McHardy skb = skb_share_check(skb, GFP_ATOMIC); 198a1e514c5SArnd Bergmann macvlan_count_rx(vlan, len, skb != NULL, 0); 199a1e514c5SArnd Bergmann if (!skb) 200b863ceb7SPatrick McHardy return NULL; 201b863ceb7SPatrick McHardy 202b863ceb7SPatrick McHardy skb->dev = dev; 203b863ceb7SPatrick McHardy skb->pkt_type = PACKET_HOST; 204b863ceb7SPatrick McHardy 205fc0663d6SArnd Bergmann vlan->receive(skb); 206b863ceb7SPatrick McHardy return NULL; 207b863ceb7SPatrick McHardy } 208b863ceb7SPatrick McHardy 209618e1b74SArnd Bergmann static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) 210618e1b74SArnd Bergmann { 211618e1b74SArnd Bergmann const struct macvlan_dev *vlan = netdev_priv(dev); 212618e1b74SArnd Bergmann const struct macvlan_port *port = vlan->port; 213618e1b74SArnd Bergmann const struct macvlan_dev *dest; 214618e1b74SArnd Bergmann 215618e1b74SArnd Bergmann if (vlan->mode == MACVLAN_MODE_BRIDGE) { 216618e1b74SArnd Bergmann const struct ethhdr *eth = (void *)skb->data; 217618e1b74SArnd Bergmann 218618e1b74SArnd Bergmann /* send to other bridge ports directly */ 219618e1b74SArnd Bergmann if (is_multicast_ether_addr(eth->h_dest)) { 220618e1b74SArnd Bergmann macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE); 221618e1b74SArnd Bergmann goto xmit_world; 222618e1b74SArnd Bergmann } 223618e1b74SArnd Bergmann 224618e1b74SArnd Bergmann dest = macvlan_hash_lookup(port, eth->h_dest); 225618e1b74SArnd Bergmann if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { 226618e1b74SArnd Bergmann unsigned int length = skb->len + ETH_HLEN; 227fc0663d6SArnd Bergmann int ret = dest->forward(dest->dev, skb); 228618e1b74SArnd Bergmann macvlan_count_rx(dest, length, 229618e1b74SArnd Bergmann ret == NET_RX_SUCCESS, 0); 230618e1b74SArnd Bergmann 231618e1b74SArnd Bergmann return NET_XMIT_SUCCESS; 232618e1b74SArnd Bergmann } 233618e1b74SArnd Bergmann } 234618e1b74SArnd Bergmann 235618e1b74SArnd Bergmann xmit_world: 2368a83a00bSArnd Bergmann skb_set_dev(skb, vlan->lowerdev); 237618e1b74SArnd Bergmann return dev_queue_xmit(skb); 238618e1b74SArnd Bergmann } 239618e1b74SArnd Bergmann 240fc0663d6SArnd Bergmann netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, 241424efe9cSStephen Hemminger struct net_device *dev) 242b863ceb7SPatrick McHardy { 2432c114553SEric Dumazet int i = skb_get_queue_mapping(skb); 2442c114553SEric Dumazet struct netdev_queue *txq = netdev_get_tx_queue(dev, i); 245b863ceb7SPatrick McHardy unsigned int len = skb->len; 246b863ceb7SPatrick McHardy int ret; 247b863ceb7SPatrick McHardy 248618e1b74SArnd Bergmann ret = macvlan_queue_xmit(skb, dev); 2492d6c9ffcSEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 2502c114553SEric Dumazet txq->tx_packets++; 2512c114553SEric Dumazet txq->tx_bytes += len; 2522c114553SEric Dumazet } else 2532c114553SEric Dumazet txq->tx_dropped++; 2542c114553SEric Dumazet 255cbbef5e1SPatrick McHardy return ret; 256b863ceb7SPatrick McHardy } 257fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_start_xmit); 258b863ceb7SPatrick McHardy 259b863ceb7SPatrick McHardy static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev, 2603b04dddeSStephen Hemminger unsigned short type, const void *daddr, 2613b04dddeSStephen Hemminger const void *saddr, unsigned len) 262b863ceb7SPatrick McHardy { 263b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 264b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 265b863ceb7SPatrick McHardy 2660c4e8581SStephen Hemminger return dev_hard_header(skb, lowerdev, type, daddr, 267b863ceb7SPatrick McHardy saddr ? : dev->dev_addr, len); 268b863ceb7SPatrick McHardy } 269b863ceb7SPatrick McHardy 2703b04dddeSStephen Hemminger static const struct header_ops macvlan_hard_header_ops = { 2713b04dddeSStephen Hemminger .create = macvlan_hard_header, 2723b04dddeSStephen Hemminger .rebuild = eth_rebuild_header, 2733b04dddeSStephen Hemminger .parse = eth_header_parse, 2743b04dddeSStephen Hemminger .cache = eth_header_cache, 2753b04dddeSStephen Hemminger .cache_update = eth_header_cache_update, 2763b04dddeSStephen Hemminger }; 2773b04dddeSStephen Hemminger 278b863ceb7SPatrick McHardy static int macvlan_open(struct net_device *dev) 279b863ceb7SPatrick McHardy { 280b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 281b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 282b863ceb7SPatrick McHardy int err; 283b863ceb7SPatrick McHardy 284f9ac30f0SEric Biederman err = -EBUSY; 285f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, dev->dev_addr)) 286f9ac30f0SEric Biederman goto out; 287f9ac30f0SEric Biederman 288a748ee24SJiri Pirko err = dev_uc_add(lowerdev, dev->dev_addr); 289b863ceb7SPatrick McHardy if (err < 0) 290b89fb7daSWang Chen goto out; 291b89fb7daSWang Chen if (dev->flags & IFF_ALLMULTI) { 292b89fb7daSWang Chen err = dev_set_allmulti(lowerdev, 1); 293b89fb7daSWang Chen if (err < 0) 294b89fb7daSWang Chen goto del_unicast; 295b89fb7daSWang Chen } 296f9ac30f0SEric Biederman macvlan_hash_add(vlan); 297b863ceb7SPatrick McHardy return 0; 298b89fb7daSWang Chen 299b89fb7daSWang Chen del_unicast: 300a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 301b89fb7daSWang Chen out: 302b89fb7daSWang Chen return err; 303b863ceb7SPatrick McHardy } 304b863ceb7SPatrick McHardy 305b863ceb7SPatrick McHardy static int macvlan_stop(struct net_device *dev) 306b863ceb7SPatrick McHardy { 307b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 308b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 309b863ceb7SPatrick McHardy 310b863ceb7SPatrick McHardy dev_mc_unsync(lowerdev, dev); 311b863ceb7SPatrick McHardy if (dev->flags & IFF_ALLMULTI) 312b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, -1); 313b863ceb7SPatrick McHardy 314a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 315b863ceb7SPatrick McHardy 316f9ac30f0SEric Biederman macvlan_hash_del(vlan); 317b863ceb7SPatrick McHardy return 0; 318b863ceb7SPatrick McHardy } 319b863ceb7SPatrick McHardy 320ad5d20a6SPatrick McHardy static int macvlan_set_mac_address(struct net_device *dev, void *p) 321ad5d20a6SPatrick McHardy { 322ad5d20a6SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 323ad5d20a6SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 324ad5d20a6SPatrick McHardy struct sockaddr *addr = p; 325ad5d20a6SPatrick McHardy int err; 326ad5d20a6SPatrick McHardy 327ad5d20a6SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 328ad5d20a6SPatrick McHardy return -EADDRNOTAVAIL; 329ad5d20a6SPatrick McHardy 330f9ac30f0SEric Biederman if (!(dev->flags & IFF_UP)) { 331f9ac30f0SEric Biederman /* Just copy in the new address */ 332f9ac30f0SEric Biederman memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); 333f9ac30f0SEric Biederman } else { 334f9ac30f0SEric Biederman /* Rehash and update the device filters */ 335f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, addr->sa_data)) 336f9ac30f0SEric Biederman return -EBUSY; 337ad5d20a6SPatrick McHardy 338a748ee24SJiri Pirko err = dev_uc_add(lowerdev, addr->sa_data); 339ccffad25SJiri Pirko if (err) 340ad5d20a6SPatrick McHardy return err; 341f9ac30f0SEric Biederman 342a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 343ad5d20a6SPatrick McHardy 344f9ac30f0SEric Biederman macvlan_hash_change_addr(vlan, addr->sa_data); 345f9ac30f0SEric Biederman } 346ad5d20a6SPatrick McHardy return 0; 347ad5d20a6SPatrick McHardy } 348ad5d20a6SPatrick McHardy 349b863ceb7SPatrick McHardy static void macvlan_change_rx_flags(struct net_device *dev, int change) 350b863ceb7SPatrick McHardy { 351b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 352b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 353b863ceb7SPatrick McHardy 354b863ceb7SPatrick McHardy if (change & IFF_ALLMULTI) 355b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); 356b863ceb7SPatrick McHardy } 357b863ceb7SPatrick McHardy 358b863ceb7SPatrick McHardy static void macvlan_set_multicast_list(struct net_device *dev) 359b863ceb7SPatrick McHardy { 360b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 361b863ceb7SPatrick McHardy 362b863ceb7SPatrick McHardy dev_mc_sync(vlan->lowerdev, dev); 363b863ceb7SPatrick McHardy } 364b863ceb7SPatrick McHardy 365b863ceb7SPatrick McHardy static int macvlan_change_mtu(struct net_device *dev, int new_mtu) 366b863ceb7SPatrick McHardy { 367b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 368b863ceb7SPatrick McHardy 369b863ceb7SPatrick McHardy if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu) 370b863ceb7SPatrick McHardy return -EINVAL; 371b863ceb7SPatrick McHardy dev->mtu = new_mtu; 372b863ceb7SPatrick McHardy return 0; 373b863ceb7SPatrick McHardy } 374b863ceb7SPatrick McHardy 375b863ceb7SPatrick McHardy /* 376b863ceb7SPatrick McHardy * macvlan network devices have devices nesting below it and are a special 377b863ceb7SPatrick McHardy * "super class" of normal network devices; split their locks off into a 378b863ceb7SPatrick McHardy * separate class since they always nest. 379b863ceb7SPatrick McHardy */ 380b863ceb7SPatrick McHardy static struct lock_class_key macvlan_netdev_xmit_lock_key; 381cf508b12SDavid S. Miller static struct lock_class_key macvlan_netdev_addr_lock_key; 382b863ceb7SPatrick McHardy 383b863ceb7SPatrick McHardy #define MACVLAN_FEATURES \ 384b863ceb7SPatrick McHardy (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \ 385b863ceb7SPatrick McHardy NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \ 3866eb3a855SPatrick Mullaney NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO) 387b863ceb7SPatrick McHardy 388b863ceb7SPatrick McHardy #define MACVLAN_STATE_MASK \ 389b863ceb7SPatrick McHardy ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) 390b863ceb7SPatrick McHardy 391e8a0464cSDavid S. Miller static void macvlan_set_lockdep_class_one(struct net_device *dev, 392e8a0464cSDavid S. Miller struct netdev_queue *txq, 393e8a0464cSDavid S. Miller void *_unused) 394c773e847SDavid S. Miller { 395c773e847SDavid S. Miller lockdep_set_class(&txq->_xmit_lock, 396c773e847SDavid S. Miller &macvlan_netdev_xmit_lock_key); 397c773e847SDavid S. Miller } 398c773e847SDavid S. Miller 399c773e847SDavid S. Miller static void macvlan_set_lockdep_class(struct net_device *dev) 400c773e847SDavid S. Miller { 401cf508b12SDavid S. Miller lockdep_set_class(&dev->addr_list_lock, 402cf508b12SDavid S. Miller &macvlan_netdev_addr_lock_key); 403e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL); 404c773e847SDavid S. Miller } 405c773e847SDavid S. Miller 406b863ceb7SPatrick McHardy static int macvlan_init(struct net_device *dev) 407b863ceb7SPatrick McHardy { 408b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 409b863ceb7SPatrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 410b863ceb7SPatrick McHardy 411b863ceb7SPatrick McHardy dev->state = (dev->state & ~MACVLAN_STATE_MASK) | 412b863ceb7SPatrick McHardy (lowerdev->state & MACVLAN_STATE_MASK); 413b863ceb7SPatrick McHardy dev->features = lowerdev->features & MACVLAN_FEATURES; 4148c2acc53SPatrick McHardy dev->gso_max_size = lowerdev->gso_max_size; 415b863ceb7SPatrick McHardy dev->iflink = lowerdev->ifindex; 416ef5c8996Ssg.tweak@gmail.com dev->hard_header_len = lowerdev->hard_header_len; 417b863ceb7SPatrick McHardy 418c773e847SDavid S. Miller macvlan_set_lockdep_class(dev); 419c773e847SDavid S. Miller 420fccaf710SEric Dumazet vlan->rx_stats = alloc_percpu(struct macvlan_rx_stats); 421fccaf710SEric Dumazet if (!vlan->rx_stats) 422fccaf710SEric Dumazet return -ENOMEM; 423fccaf710SEric Dumazet 424b863ceb7SPatrick McHardy return 0; 425b863ceb7SPatrick McHardy } 426b863ceb7SPatrick McHardy 427fccaf710SEric Dumazet static void macvlan_uninit(struct net_device *dev) 428fccaf710SEric Dumazet { 429fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 430fccaf710SEric Dumazet 431fccaf710SEric Dumazet free_percpu(vlan->rx_stats); 432fccaf710SEric Dumazet } 433fccaf710SEric Dumazet 434*28172739SEric Dumazet static struct rtnl_link_stats64 *macvlan_dev_get_stats64(struct net_device *dev, 435*28172739SEric Dumazet struct rtnl_link_stats64 *stats) 436fccaf710SEric Dumazet { 437fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 438fccaf710SEric Dumazet 439*28172739SEric Dumazet dev_txq_stats_fold(dev, (struct net_device_stats *)stats); 440fccaf710SEric Dumazet 441fccaf710SEric Dumazet if (vlan->rx_stats) { 442bc66154eSEric Dumazet struct macvlan_rx_stats *p, accum = {0}; 443bc66154eSEric Dumazet u64 rx_packets, rx_bytes, rx_multicast; 444bc66154eSEric Dumazet unsigned int start; 445fccaf710SEric Dumazet int i; 446fccaf710SEric Dumazet 447fccaf710SEric Dumazet for_each_possible_cpu(i) { 448fccaf710SEric Dumazet p = per_cpu_ptr(vlan->rx_stats, i); 449bc66154eSEric Dumazet do { 450bc66154eSEric Dumazet start = u64_stats_fetch_begin_bh(&p->syncp); 451bc66154eSEric Dumazet rx_packets = p->rx_packets; 452bc66154eSEric Dumazet rx_bytes = p->rx_bytes; 453bc66154eSEric Dumazet rx_multicast = p->rx_multicast; 454bc66154eSEric Dumazet } while (u64_stats_fetch_retry_bh(&p->syncp, start)); 455bc66154eSEric Dumazet accum.rx_packets += rx_packets; 456bc66154eSEric Dumazet accum.rx_bytes += rx_bytes; 457bc66154eSEric Dumazet accum.rx_multicast += rx_multicast; 458bc66154eSEric Dumazet /* rx_errors is an ulong, updated without syncp protection */ 459bc66154eSEric Dumazet accum.rx_errors += p->rx_errors; 460fccaf710SEric Dumazet } 461bc66154eSEric Dumazet stats->rx_packets = accum.rx_packets; 462bc66154eSEric Dumazet stats->rx_bytes = accum.rx_bytes; 463bc66154eSEric Dumazet stats->rx_errors = accum.rx_errors; 464bc66154eSEric Dumazet stats->rx_dropped = accum.rx_errors; 465bc66154eSEric Dumazet stats->multicast = accum.rx_multicast; 466fccaf710SEric Dumazet } 467fccaf710SEric Dumazet return stats; 468fccaf710SEric Dumazet } 469fccaf710SEric Dumazet 470b863ceb7SPatrick McHardy static void macvlan_ethtool_get_drvinfo(struct net_device *dev, 471b863ceb7SPatrick McHardy struct ethtool_drvinfo *drvinfo) 472b863ceb7SPatrick McHardy { 473b863ceb7SPatrick McHardy snprintf(drvinfo->driver, 32, "macvlan"); 474b863ceb7SPatrick McHardy snprintf(drvinfo->version, 32, "0.1"); 475b863ceb7SPatrick McHardy } 476b863ceb7SPatrick McHardy 477b863ceb7SPatrick McHardy static u32 macvlan_ethtool_get_rx_csum(struct net_device *dev) 478b863ceb7SPatrick McHardy { 479b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 480b1b67dd4SPatrick McHardy return dev_ethtool_get_rx_csum(vlan->lowerdev); 481b863ceb7SPatrick McHardy } 482b863ceb7SPatrick McHardy 4839edb8bb6SStephen Hemminger static int macvlan_ethtool_get_settings(struct net_device *dev, 4849edb8bb6SStephen Hemminger struct ethtool_cmd *cmd) 4859edb8bb6SStephen Hemminger { 4869edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 487b1b67dd4SPatrick McHardy return dev_ethtool_get_settings(vlan->lowerdev, cmd); 4889edb8bb6SStephen Hemminger } 4899edb8bb6SStephen Hemminger 4909edb8bb6SStephen Hemminger static u32 macvlan_ethtool_get_flags(struct net_device *dev) 4919edb8bb6SStephen Hemminger { 4929edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 493b1b67dd4SPatrick McHardy return dev_ethtool_get_flags(vlan->lowerdev); 4949edb8bb6SStephen Hemminger } 4959edb8bb6SStephen Hemminger 496b863ceb7SPatrick McHardy static const struct ethtool_ops macvlan_ethtool_ops = { 497b863ceb7SPatrick McHardy .get_link = ethtool_op_get_link, 4989edb8bb6SStephen Hemminger .get_settings = macvlan_ethtool_get_settings, 499b863ceb7SPatrick McHardy .get_rx_csum = macvlan_ethtool_get_rx_csum, 500b863ceb7SPatrick McHardy .get_drvinfo = macvlan_ethtool_get_drvinfo, 5019edb8bb6SStephen Hemminger .get_flags = macvlan_ethtool_get_flags, 502b863ceb7SPatrick McHardy }; 503b863ceb7SPatrick McHardy 50454a30c97SStephen Hemminger static const struct net_device_ops macvlan_netdev_ops = { 50554a30c97SStephen Hemminger .ndo_init = macvlan_init, 506fccaf710SEric Dumazet .ndo_uninit = macvlan_uninit, 50754a30c97SStephen Hemminger .ndo_open = macvlan_open, 50854a30c97SStephen Hemminger .ndo_stop = macvlan_stop, 50900829823SStephen Hemminger .ndo_start_xmit = macvlan_start_xmit, 51054a30c97SStephen Hemminger .ndo_change_mtu = macvlan_change_mtu, 51154a30c97SStephen Hemminger .ndo_change_rx_flags = macvlan_change_rx_flags, 51254a30c97SStephen Hemminger .ndo_set_mac_address = macvlan_set_mac_address, 51354a30c97SStephen Hemminger .ndo_set_multicast_list = macvlan_set_multicast_list, 514bc66154eSEric Dumazet .ndo_get_stats64 = macvlan_dev_get_stats64, 51554a30c97SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 51654a30c97SStephen Hemminger }; 51754a30c97SStephen Hemminger 518b863ceb7SPatrick McHardy static void macvlan_setup(struct net_device *dev) 519b863ceb7SPatrick McHardy { 520b863ceb7SPatrick McHardy ether_setup(dev); 521b863ceb7SPatrick McHardy 52293f154b5SEric Dumazet dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; 52354a30c97SStephen Hemminger dev->netdev_ops = &macvlan_netdev_ops; 524b863ceb7SPatrick McHardy dev->destructor = free_netdev; 5253b04dddeSStephen Hemminger dev->header_ops = &macvlan_hard_header_ops, 526b863ceb7SPatrick McHardy dev->ethtool_ops = &macvlan_ethtool_ops; 527b863ceb7SPatrick McHardy dev->tx_queue_len = 0; 528b863ceb7SPatrick McHardy } 529b863ceb7SPatrick McHardy 530b863ceb7SPatrick McHardy static int macvlan_port_create(struct net_device *dev) 531b863ceb7SPatrick McHardy { 532b863ceb7SPatrick McHardy struct macvlan_port *port; 533b863ceb7SPatrick McHardy unsigned int i; 534ab95bfe0SJiri Pirko int err; 535b863ceb7SPatrick McHardy 536b863ceb7SPatrick McHardy if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) 537b863ceb7SPatrick McHardy return -EINVAL; 538b863ceb7SPatrick McHardy 539b863ceb7SPatrick McHardy port = kzalloc(sizeof(*port), GFP_KERNEL); 540b863ceb7SPatrick McHardy if (port == NULL) 541b863ceb7SPatrick McHardy return -ENOMEM; 542b863ceb7SPatrick McHardy 543b863ceb7SPatrick McHardy port->dev = dev; 544b863ceb7SPatrick McHardy INIT_LIST_HEAD(&port->vlans); 545b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) 546b863ceb7SPatrick McHardy INIT_HLIST_HEAD(&port->vlan_hash[i]); 547ab95bfe0SJiri Pirko 548a35e2c1bSJiri Pirko err = netdev_rx_handler_register(dev, macvlan_handle_frame, port); 549a35e2c1bSJiri Pirko if (err) 550ab95bfe0SJiri Pirko kfree(port); 551ab95bfe0SJiri Pirko 552a35e2c1bSJiri Pirko dev->priv_flags |= IFF_MACVLAN_PORT; 553ab95bfe0SJiri Pirko return err; 554b863ceb7SPatrick McHardy } 555b863ceb7SPatrick McHardy 5568b37ef0aSJiri Pirko static void macvlan_port_rcu_free(struct rcu_head *head) 5578b37ef0aSJiri Pirko { 5588b37ef0aSJiri Pirko struct macvlan_port *port; 5598b37ef0aSJiri Pirko 5608b37ef0aSJiri Pirko port = container_of(head, struct macvlan_port, rcu); 5618b37ef0aSJiri Pirko kfree(port); 5628b37ef0aSJiri Pirko } 5638b37ef0aSJiri Pirko 564b863ceb7SPatrick McHardy static void macvlan_port_destroy(struct net_device *dev) 565b863ceb7SPatrick McHardy { 566a35e2c1bSJiri Pirko struct macvlan_port *port = macvlan_port_get(dev); 567b863ceb7SPatrick McHardy 568a35e2c1bSJiri Pirko dev->priv_flags &= ~IFF_MACVLAN_PORT; 569ab95bfe0SJiri Pirko netdev_rx_handler_unregister(dev); 5708b37ef0aSJiri Pirko call_rcu(&port->rcu, macvlan_port_rcu_free); 571b863ceb7SPatrick McHardy } 572b863ceb7SPatrick McHardy 573b863ceb7SPatrick McHardy static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) 574b863ceb7SPatrick McHardy { 575b863ceb7SPatrick McHardy if (tb[IFLA_ADDRESS]) { 576b863ceb7SPatrick McHardy if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) 577b863ceb7SPatrick McHardy return -EINVAL; 578b863ceb7SPatrick McHardy if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) 579b863ceb7SPatrick McHardy return -EADDRNOTAVAIL; 580b863ceb7SPatrick McHardy } 58127c0b1a8SArnd Bergmann 58227c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) { 58327c0b1a8SArnd Bergmann switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) { 58427c0b1a8SArnd Bergmann case MACVLAN_MODE_PRIVATE: 58527c0b1a8SArnd Bergmann case MACVLAN_MODE_VEPA: 58627c0b1a8SArnd Bergmann case MACVLAN_MODE_BRIDGE: 58727c0b1a8SArnd Bergmann break; 58827c0b1a8SArnd Bergmann default: 58927c0b1a8SArnd Bergmann return -EINVAL; 59027c0b1a8SArnd Bergmann } 59127c0b1a8SArnd Bergmann } 592b863ceb7SPatrick McHardy return 0; 593b863ceb7SPatrick McHardy } 594b863ceb7SPatrick McHardy 5952c114553SEric Dumazet static int macvlan_get_tx_queues(struct net *net, 5962c114553SEric Dumazet struct nlattr *tb[], 5972c114553SEric Dumazet unsigned int *num_tx_queues, 5982c114553SEric Dumazet unsigned int *real_num_tx_queues) 5992c114553SEric Dumazet { 6002c114553SEric Dumazet struct net_device *real_dev; 6012c114553SEric Dumazet 6022c114553SEric Dumazet if (!tb[IFLA_LINK]) 6032c114553SEric Dumazet return -EINVAL; 6042c114553SEric Dumazet 6052c114553SEric Dumazet real_dev = __dev_get_by_index(net, nla_get_u32(tb[IFLA_LINK])); 6062c114553SEric Dumazet if (!real_dev) 6072c114553SEric Dumazet return -ENODEV; 6082c114553SEric Dumazet 6092c114553SEric Dumazet *num_tx_queues = real_dev->num_tx_queues; 6102c114553SEric Dumazet *real_num_tx_queues = real_dev->real_num_tx_queues; 6112c114553SEric Dumazet return 0; 6122c114553SEric Dumazet } 6132c114553SEric Dumazet 614fc0663d6SArnd Bergmann int macvlan_common_newlink(struct net *src_net, struct net_device *dev, 615fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[], 616fc0663d6SArnd Bergmann int (*receive)(struct sk_buff *skb), 617fc0663d6SArnd Bergmann int (*forward)(struct net_device *dev, 618fc0663d6SArnd Bergmann struct sk_buff *skb)) 619b863ceb7SPatrick McHardy { 620b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 621b863ceb7SPatrick McHardy struct macvlan_port *port; 622b863ceb7SPatrick McHardy struct net_device *lowerdev; 623b863ceb7SPatrick McHardy int err; 624b863ceb7SPatrick McHardy 625b863ceb7SPatrick McHardy if (!tb[IFLA_LINK]) 626b863ceb7SPatrick McHardy return -EINVAL; 627b863ceb7SPatrick McHardy 62881adee47SEric W. Biederman lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK])); 629b863ceb7SPatrick McHardy if (lowerdev == NULL) 630b863ceb7SPatrick McHardy return -ENODEV; 631b863ceb7SPatrick McHardy 632b0832a29SEric Biederman /* When creating macvlans on top of other macvlans - use 633b0832a29SEric Biederman * the real device as the lowerdev. 634a6ca5f1dSPatrick McHardy */ 635b0832a29SEric Biederman if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) { 636b0832a29SEric Biederman struct macvlan_dev *lowervlan = netdev_priv(lowerdev); 637b0832a29SEric Biederman lowerdev = lowervlan->lowerdev; 638b0832a29SEric Biederman } 639a6ca5f1dSPatrick McHardy 640b863ceb7SPatrick McHardy if (!tb[IFLA_MTU]) 641b863ceb7SPatrick McHardy dev->mtu = lowerdev->mtu; 642b863ceb7SPatrick McHardy else if (dev->mtu > lowerdev->mtu) 643b863ceb7SPatrick McHardy return -EINVAL; 644b863ceb7SPatrick McHardy 645b863ceb7SPatrick McHardy if (!tb[IFLA_ADDRESS]) 646b863ceb7SPatrick McHardy random_ether_addr(dev->dev_addr); 647b863ceb7SPatrick McHardy 648a35e2c1bSJiri Pirko if (!macvlan_port_exists(lowerdev)) { 649b863ceb7SPatrick McHardy err = macvlan_port_create(lowerdev); 650b863ceb7SPatrick McHardy if (err < 0) 651b863ceb7SPatrick McHardy return err; 652b863ceb7SPatrick McHardy } 653a35e2c1bSJiri Pirko port = macvlan_port_get(lowerdev); 654b863ceb7SPatrick McHardy 655b863ceb7SPatrick McHardy vlan->lowerdev = lowerdev; 656b863ceb7SPatrick McHardy vlan->dev = dev; 657b863ceb7SPatrick McHardy vlan->port = port; 658fc0663d6SArnd Bergmann vlan->receive = receive; 659fc0663d6SArnd Bergmann vlan->forward = forward; 660b863ceb7SPatrick McHardy 66127c0b1a8SArnd Bergmann vlan->mode = MACVLAN_MODE_VEPA; 66227c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 66327c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 66427c0b1a8SArnd Bergmann 665b863ceb7SPatrick McHardy err = register_netdevice(dev); 666b863ceb7SPatrick McHardy if (err < 0) 667f16d3d57SJiri Pirko goto destroy_port; 668b863ceb7SPatrick McHardy 669b863ceb7SPatrick McHardy list_add_tail(&vlan->list, &port->vlans); 670fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(lowerdev, dev); 671f16d3d57SJiri Pirko 672b863ceb7SPatrick McHardy return 0; 673f16d3d57SJiri Pirko 674f16d3d57SJiri Pirko destroy_port: 675f16d3d57SJiri Pirko if (list_empty(&port->vlans)) 676f16d3d57SJiri Pirko macvlan_port_destroy(lowerdev); 677f16d3d57SJiri Pirko 678f16d3d57SJiri Pirko return err; 679b863ceb7SPatrick McHardy } 680fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_common_newlink); 681b863ceb7SPatrick McHardy 682fc0663d6SArnd Bergmann static int macvlan_newlink(struct net *src_net, struct net_device *dev, 683fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 684fc0663d6SArnd Bergmann { 685fc0663d6SArnd Bergmann return macvlan_common_newlink(src_net, dev, tb, data, 686fc0663d6SArnd Bergmann netif_rx, 687fc0663d6SArnd Bergmann dev_forward_skb); 688fc0663d6SArnd Bergmann } 689fc0663d6SArnd Bergmann 690fc0663d6SArnd Bergmann void macvlan_dellink(struct net_device *dev, struct list_head *head) 691b863ceb7SPatrick McHardy { 692b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 693b863ceb7SPatrick McHardy struct macvlan_port *port = vlan->port; 694b863ceb7SPatrick McHardy 695b863ceb7SPatrick McHardy list_del(&vlan->list); 69623289a37SEric Dumazet unregister_netdevice_queue(dev, head); 697b863ceb7SPatrick McHardy 698b863ceb7SPatrick McHardy if (list_empty(&port->vlans)) 69973120964SPatrick McHardy macvlan_port_destroy(port->dev); 700b863ceb7SPatrick McHardy } 701fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_dellink); 702b863ceb7SPatrick McHardy 70327c0b1a8SArnd Bergmann static int macvlan_changelink(struct net_device *dev, 70427c0b1a8SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 70527c0b1a8SArnd Bergmann { 70627c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 70727c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 70827c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 70927c0b1a8SArnd Bergmann return 0; 71027c0b1a8SArnd Bergmann } 71127c0b1a8SArnd Bergmann 71227c0b1a8SArnd Bergmann static size_t macvlan_get_size(const struct net_device *dev) 71327c0b1a8SArnd Bergmann { 71427c0b1a8SArnd Bergmann return nla_total_size(4); 71527c0b1a8SArnd Bergmann } 71627c0b1a8SArnd Bergmann 71727c0b1a8SArnd Bergmann static int macvlan_fill_info(struct sk_buff *skb, 71827c0b1a8SArnd Bergmann const struct net_device *dev) 71927c0b1a8SArnd Bergmann { 72027c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 72127c0b1a8SArnd Bergmann 72227c0b1a8SArnd Bergmann NLA_PUT_U32(skb, IFLA_MACVLAN_MODE, vlan->mode); 72327c0b1a8SArnd Bergmann return 0; 72427c0b1a8SArnd Bergmann 72527c0b1a8SArnd Bergmann nla_put_failure: 72627c0b1a8SArnd Bergmann return -EMSGSIZE; 72727c0b1a8SArnd Bergmann } 72827c0b1a8SArnd Bergmann 72927c0b1a8SArnd Bergmann static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = { 73027c0b1a8SArnd Bergmann [IFLA_MACVLAN_MODE] = { .type = NLA_U32 }, 73127c0b1a8SArnd Bergmann }; 73227c0b1a8SArnd Bergmann 733fc0663d6SArnd Bergmann int macvlan_link_register(struct rtnl_link_ops *ops) 734fc0663d6SArnd Bergmann { 735fc0663d6SArnd Bergmann /* common fields */ 736fc0663d6SArnd Bergmann ops->priv_size = sizeof(struct macvlan_dev); 737fc0663d6SArnd Bergmann ops->get_tx_queues = macvlan_get_tx_queues; 738fc0663d6SArnd Bergmann ops->setup = macvlan_setup; 739fc0663d6SArnd Bergmann ops->validate = macvlan_validate; 740fc0663d6SArnd Bergmann ops->maxtype = IFLA_MACVLAN_MAX; 741fc0663d6SArnd Bergmann ops->policy = macvlan_policy; 742fc0663d6SArnd Bergmann ops->changelink = macvlan_changelink; 743fc0663d6SArnd Bergmann ops->get_size = macvlan_get_size; 744fc0663d6SArnd Bergmann ops->fill_info = macvlan_fill_info; 745fc0663d6SArnd Bergmann 746fc0663d6SArnd Bergmann return rtnl_link_register(ops); 747fc0663d6SArnd Bergmann }; 748fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_link_register); 749fc0663d6SArnd Bergmann 750fc0663d6SArnd Bergmann static struct rtnl_link_ops macvlan_link_ops = { 751b863ceb7SPatrick McHardy .kind = "macvlan", 752b863ceb7SPatrick McHardy .newlink = macvlan_newlink, 753b863ceb7SPatrick McHardy .dellink = macvlan_dellink, 754b863ceb7SPatrick McHardy }; 755b863ceb7SPatrick McHardy 756b863ceb7SPatrick McHardy static int macvlan_device_event(struct notifier_block *unused, 757b863ceb7SPatrick McHardy unsigned long event, void *ptr) 758b863ceb7SPatrick McHardy { 759b863ceb7SPatrick McHardy struct net_device *dev = ptr; 760b863ceb7SPatrick McHardy struct macvlan_dev *vlan, *next; 761b863ceb7SPatrick McHardy struct macvlan_port *port; 762b863ceb7SPatrick McHardy 763a35e2c1bSJiri Pirko if (!macvlan_port_exists(dev)) 764b863ceb7SPatrick McHardy return NOTIFY_DONE; 765b863ceb7SPatrick McHardy 766a35e2c1bSJiri Pirko port = macvlan_port_get(dev); 767a35e2c1bSJiri Pirko 768b863ceb7SPatrick McHardy switch (event) { 769b863ceb7SPatrick McHardy case NETDEV_CHANGE: 770b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) 771fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(vlan->lowerdev, 772fc4a7489SPatrick Mullaney vlan->dev); 773b863ceb7SPatrick McHardy break; 774b863ceb7SPatrick McHardy case NETDEV_FEAT_CHANGE: 775b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) { 776b863ceb7SPatrick McHardy vlan->dev->features = dev->features & MACVLAN_FEATURES; 7778c2acc53SPatrick McHardy vlan->dev->gso_max_size = dev->gso_max_size; 778b863ceb7SPatrick McHardy netdev_features_change(vlan->dev); 779b863ceb7SPatrick McHardy } 780b863ceb7SPatrick McHardy break; 781b863ceb7SPatrick McHardy case NETDEV_UNREGISTER: 782b863ceb7SPatrick McHardy list_for_each_entry_safe(vlan, next, &port->vlans, list) 783fc0663d6SArnd Bergmann vlan->dev->rtnl_link_ops->dellink(vlan->dev, NULL); 784b863ceb7SPatrick McHardy break; 7851c01fe14SJiri Pirko case NETDEV_PRE_TYPE_CHANGE: 7861c01fe14SJiri Pirko /* Forbid underlaying device to change its type. */ 7871c01fe14SJiri Pirko return NOTIFY_BAD; 788b863ceb7SPatrick McHardy } 789b863ceb7SPatrick McHardy return NOTIFY_DONE; 790b863ceb7SPatrick McHardy } 791b863ceb7SPatrick McHardy 792b863ceb7SPatrick McHardy static struct notifier_block macvlan_notifier_block __read_mostly = { 793b863ceb7SPatrick McHardy .notifier_call = macvlan_device_event, 794b863ceb7SPatrick McHardy }; 795b863ceb7SPatrick McHardy 796b863ceb7SPatrick McHardy static int __init macvlan_init_module(void) 797b863ceb7SPatrick McHardy { 798b863ceb7SPatrick McHardy int err; 799b863ceb7SPatrick McHardy 800b863ceb7SPatrick McHardy register_netdevice_notifier(&macvlan_notifier_block); 801b863ceb7SPatrick McHardy 802fc0663d6SArnd Bergmann err = macvlan_link_register(&macvlan_link_ops); 803b863ceb7SPatrick McHardy if (err < 0) 804b863ceb7SPatrick McHardy goto err1; 805b863ceb7SPatrick McHardy return 0; 806b863ceb7SPatrick McHardy err1: 807b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 808b863ceb7SPatrick McHardy return err; 809b863ceb7SPatrick McHardy } 810b863ceb7SPatrick McHardy 811b863ceb7SPatrick McHardy static void __exit macvlan_cleanup_module(void) 812b863ceb7SPatrick McHardy { 813b863ceb7SPatrick McHardy rtnl_link_unregister(&macvlan_link_ops); 814b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 815b863ceb7SPatrick McHardy } 816b863ceb7SPatrick McHardy 817b863ceb7SPatrick McHardy module_init(macvlan_init_module); 818b863ceb7SPatrick McHardy module_exit(macvlan_cleanup_module); 819b863ceb7SPatrick McHardy 820b863ceb7SPatrick McHardy MODULE_LICENSE("GPL"); 821b863ceb7SPatrick McHardy MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); 822b863ceb7SPatrick McHardy MODULE_DESCRIPTION("Driver for MAC address based VLANs"); 823b863ceb7SPatrick McHardy MODULE_ALIAS_RTNL_LINK("macvlan"); 824