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; 40*8b37ef0aSJiri Pirko struct rcu_head rcu; 41b863ceb7SPatrick McHardy }; 42b863ceb7SPatrick McHardy 43b863ceb7SPatrick McHardy static struct macvlan_dev *macvlan_hash_lookup(const struct macvlan_port *port, 44b863ceb7SPatrick McHardy const unsigned char *addr) 45b863ceb7SPatrick McHardy { 46b863ceb7SPatrick McHardy struct macvlan_dev *vlan; 47b863ceb7SPatrick McHardy struct hlist_node *n; 48b863ceb7SPatrick McHardy 49b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[addr[5]], hlist) { 50ac06713dSEric Dumazet if (!compare_ether_addr_64bits(vlan->dev->dev_addr, addr)) 51b863ceb7SPatrick McHardy return vlan; 52b863ceb7SPatrick McHardy } 53b863ceb7SPatrick McHardy return NULL; 54b863ceb7SPatrick McHardy } 55b863ceb7SPatrick McHardy 56f9ac30f0SEric Biederman static void macvlan_hash_add(struct macvlan_dev *vlan) 57f9ac30f0SEric Biederman { 58f9ac30f0SEric Biederman struct macvlan_port *port = vlan->port; 59f9ac30f0SEric Biederman const unsigned char *addr = vlan->dev->dev_addr; 60f9ac30f0SEric Biederman 61f9ac30f0SEric Biederman hlist_add_head_rcu(&vlan->hlist, &port->vlan_hash[addr[5]]); 62f9ac30f0SEric Biederman } 63f9ac30f0SEric Biederman 64f9ac30f0SEric Biederman static void macvlan_hash_del(struct macvlan_dev *vlan) 65f9ac30f0SEric Biederman { 66f9ac30f0SEric Biederman hlist_del_rcu(&vlan->hlist); 67f9ac30f0SEric Biederman synchronize_rcu(); 68f9ac30f0SEric Biederman } 69f9ac30f0SEric Biederman 70f9ac30f0SEric Biederman static void macvlan_hash_change_addr(struct macvlan_dev *vlan, 71f9ac30f0SEric Biederman const unsigned char *addr) 72f9ac30f0SEric Biederman { 73f9ac30f0SEric Biederman macvlan_hash_del(vlan); 74f9ac30f0SEric Biederman /* Now that we are unhashed it is safe to change the device 75f9ac30f0SEric Biederman * address without confusing packet delivery. 76f9ac30f0SEric Biederman */ 77f9ac30f0SEric Biederman memcpy(vlan->dev->dev_addr, addr, ETH_ALEN); 78f9ac30f0SEric Biederman macvlan_hash_add(vlan); 79f9ac30f0SEric Biederman } 80f9ac30f0SEric Biederman 81f9ac30f0SEric Biederman static int macvlan_addr_busy(const struct macvlan_port *port, 82f9ac30f0SEric Biederman const unsigned char *addr) 83f9ac30f0SEric Biederman { 84f9ac30f0SEric Biederman /* Test to see if the specified multicast address is 85f9ac30f0SEric Biederman * currently in use by the underlying device or 86f9ac30f0SEric Biederman * another macvlan. 87f9ac30f0SEric Biederman */ 88ac06713dSEric Dumazet if (!compare_ether_addr_64bits(port->dev->dev_addr, addr)) 89f9ac30f0SEric Biederman return 1; 90f9ac30f0SEric Biederman 91f9ac30f0SEric Biederman if (macvlan_hash_lookup(port, addr)) 92f9ac30f0SEric Biederman return 1; 93f9ac30f0SEric Biederman 94f9ac30f0SEric Biederman return 0; 95f9ac30f0SEric Biederman } 96f9ac30f0SEric Biederman 97a1e514c5SArnd Bergmann 98fc0663d6SArnd Bergmann static int macvlan_broadcast_one(struct sk_buff *skb, 99fc0663d6SArnd Bergmann const struct macvlan_dev *vlan, 100618e1b74SArnd Bergmann const struct ethhdr *eth, bool local) 101a1e514c5SArnd Bergmann { 102fc0663d6SArnd Bergmann struct net_device *dev = vlan->dev; 103a1e514c5SArnd Bergmann if (!skb) 104a1e514c5SArnd Bergmann return NET_RX_DROP; 105a1e514c5SArnd Bergmann 106618e1b74SArnd Bergmann if (local) 107fc0663d6SArnd Bergmann return vlan->forward(dev, skb); 108618e1b74SArnd Bergmann 109a1e514c5SArnd Bergmann skb->dev = dev; 110a1e514c5SArnd Bergmann if (!compare_ether_addr_64bits(eth->h_dest, 111a1e514c5SArnd Bergmann dev->broadcast)) 112a1e514c5SArnd Bergmann skb->pkt_type = PACKET_BROADCAST; 113a1e514c5SArnd Bergmann else 114a1e514c5SArnd Bergmann skb->pkt_type = PACKET_MULTICAST; 115a1e514c5SArnd Bergmann 116fc0663d6SArnd Bergmann return vlan->receive(skb); 117a1e514c5SArnd Bergmann } 118a1e514c5SArnd Bergmann 119b863ceb7SPatrick McHardy static void macvlan_broadcast(struct sk_buff *skb, 120618e1b74SArnd Bergmann const struct macvlan_port *port, 121618e1b74SArnd Bergmann struct net_device *src, 122618e1b74SArnd Bergmann enum macvlan_mode mode) 123b863ceb7SPatrick McHardy { 124b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 125b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 126b863ceb7SPatrick McHardy struct hlist_node *n; 127b863ceb7SPatrick McHardy struct sk_buff *nskb; 128b863ceb7SPatrick McHardy unsigned int i; 129a1e514c5SArnd Bergmann int err; 130b863ceb7SPatrick McHardy 131efbbced3SPatrick McHardy if (skb->protocol == htons(ETH_P_PAUSE)) 132efbbced3SPatrick McHardy return; 133efbbced3SPatrick McHardy 134b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) { 135b863ceb7SPatrick McHardy hlist_for_each_entry_rcu(vlan, n, &port->vlan_hash[i], hlist) { 136618e1b74SArnd Bergmann if (vlan->dev == src || !(vlan->mode & mode)) 137618e1b74SArnd Bergmann continue; 138618e1b74SArnd Bergmann 139b863ceb7SPatrick McHardy nskb = skb_clone(skb, GFP_ATOMIC); 140fc0663d6SArnd Bergmann err = macvlan_broadcast_one(nskb, vlan, eth, 141618e1b74SArnd Bergmann mode == MACVLAN_MODE_BRIDGE); 142a1e514c5SArnd Bergmann macvlan_count_rx(vlan, skb->len + ETH_HLEN, 143a1e514c5SArnd Bergmann err == NET_RX_SUCCESS, 1); 144b863ceb7SPatrick McHardy } 145b863ceb7SPatrick McHardy } 146b863ceb7SPatrick McHardy } 147b863ceb7SPatrick McHardy 148b863ceb7SPatrick McHardy /* called under rcu_read_lock() from netif_receive_skb */ 149ab95bfe0SJiri Pirko static struct sk_buff *macvlan_handle_frame(struct sk_buff *skb) 150b863ceb7SPatrick McHardy { 151ab95bfe0SJiri Pirko struct macvlan_port *port; 152b863ceb7SPatrick McHardy const struct ethhdr *eth = eth_hdr(skb); 153b863ceb7SPatrick McHardy const struct macvlan_dev *vlan; 154618e1b74SArnd Bergmann const struct macvlan_dev *src; 155b863ceb7SPatrick McHardy struct net_device *dev; 156a1e514c5SArnd Bergmann unsigned int len; 157b863ceb7SPatrick McHardy 158ab95bfe0SJiri Pirko port = rcu_dereference(skb->dev->macvlan_port); 159b863ceb7SPatrick McHardy if (is_multicast_ether_addr(eth->h_dest)) { 160618e1b74SArnd Bergmann src = macvlan_hash_lookup(port, eth->h_source); 161618e1b74SArnd Bergmann if (!src) 162618e1b74SArnd Bergmann /* frame comes from an external address */ 163618e1b74SArnd Bergmann macvlan_broadcast(skb, port, NULL, 164618e1b74SArnd Bergmann MACVLAN_MODE_PRIVATE | 165618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 166618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 167618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_VEPA) 168618e1b74SArnd Bergmann /* flood to everyone except source */ 169618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 170618e1b74SArnd Bergmann MACVLAN_MODE_VEPA | 171618e1b74SArnd Bergmann MACVLAN_MODE_BRIDGE); 172618e1b74SArnd Bergmann else if (src->mode == MACVLAN_MODE_BRIDGE) 173618e1b74SArnd Bergmann /* 174618e1b74SArnd Bergmann * flood only to VEPA ports, bridge ports 175618e1b74SArnd Bergmann * already saw the frame on the way out. 176618e1b74SArnd Bergmann */ 177618e1b74SArnd Bergmann macvlan_broadcast(skb, port, src->dev, 178618e1b74SArnd Bergmann MACVLAN_MODE_VEPA); 179b863ceb7SPatrick McHardy return skb; 180b863ceb7SPatrick McHardy } 181b863ceb7SPatrick McHardy 182b863ceb7SPatrick McHardy vlan = macvlan_hash_lookup(port, eth->h_dest); 183b863ceb7SPatrick McHardy if (vlan == NULL) 184b863ceb7SPatrick McHardy return skb; 185b863ceb7SPatrick McHardy 186b863ceb7SPatrick McHardy dev = vlan->dev; 187b863ceb7SPatrick McHardy if (unlikely(!(dev->flags & IFF_UP))) { 188b863ceb7SPatrick McHardy kfree_skb(skb); 189b863ceb7SPatrick McHardy return NULL; 190b863ceb7SPatrick McHardy } 191a1e514c5SArnd Bergmann len = skb->len + ETH_HLEN; 192b863ceb7SPatrick McHardy skb = skb_share_check(skb, GFP_ATOMIC); 193a1e514c5SArnd Bergmann macvlan_count_rx(vlan, len, skb != NULL, 0); 194a1e514c5SArnd Bergmann if (!skb) 195b863ceb7SPatrick McHardy return NULL; 196b863ceb7SPatrick McHardy 197b863ceb7SPatrick McHardy skb->dev = dev; 198b863ceb7SPatrick McHardy skb->pkt_type = PACKET_HOST; 199b863ceb7SPatrick McHardy 200fc0663d6SArnd Bergmann vlan->receive(skb); 201b863ceb7SPatrick McHardy return NULL; 202b863ceb7SPatrick McHardy } 203b863ceb7SPatrick McHardy 204618e1b74SArnd Bergmann static int macvlan_queue_xmit(struct sk_buff *skb, struct net_device *dev) 205618e1b74SArnd Bergmann { 206618e1b74SArnd Bergmann const struct macvlan_dev *vlan = netdev_priv(dev); 207618e1b74SArnd Bergmann const struct macvlan_port *port = vlan->port; 208618e1b74SArnd Bergmann const struct macvlan_dev *dest; 209618e1b74SArnd Bergmann 210618e1b74SArnd Bergmann if (vlan->mode == MACVLAN_MODE_BRIDGE) { 211618e1b74SArnd Bergmann const struct ethhdr *eth = (void *)skb->data; 212618e1b74SArnd Bergmann 213618e1b74SArnd Bergmann /* send to other bridge ports directly */ 214618e1b74SArnd Bergmann if (is_multicast_ether_addr(eth->h_dest)) { 215618e1b74SArnd Bergmann macvlan_broadcast(skb, port, dev, MACVLAN_MODE_BRIDGE); 216618e1b74SArnd Bergmann goto xmit_world; 217618e1b74SArnd Bergmann } 218618e1b74SArnd Bergmann 219618e1b74SArnd Bergmann dest = macvlan_hash_lookup(port, eth->h_dest); 220618e1b74SArnd Bergmann if (dest && dest->mode == MACVLAN_MODE_BRIDGE) { 221618e1b74SArnd Bergmann unsigned int length = skb->len + ETH_HLEN; 222fc0663d6SArnd Bergmann int ret = dest->forward(dest->dev, skb); 223618e1b74SArnd Bergmann macvlan_count_rx(dest, length, 224618e1b74SArnd Bergmann ret == NET_RX_SUCCESS, 0); 225618e1b74SArnd Bergmann 226618e1b74SArnd Bergmann return NET_XMIT_SUCCESS; 227618e1b74SArnd Bergmann } 228618e1b74SArnd Bergmann } 229618e1b74SArnd Bergmann 230618e1b74SArnd Bergmann xmit_world: 2318a83a00bSArnd Bergmann skb_set_dev(skb, vlan->lowerdev); 232618e1b74SArnd Bergmann return dev_queue_xmit(skb); 233618e1b74SArnd Bergmann } 234618e1b74SArnd Bergmann 235fc0663d6SArnd Bergmann netdev_tx_t macvlan_start_xmit(struct sk_buff *skb, 236424efe9cSStephen Hemminger struct net_device *dev) 237b863ceb7SPatrick McHardy { 2382c114553SEric Dumazet int i = skb_get_queue_mapping(skb); 2392c114553SEric Dumazet struct netdev_queue *txq = netdev_get_tx_queue(dev, i); 240b863ceb7SPatrick McHardy unsigned int len = skb->len; 241b863ceb7SPatrick McHardy int ret; 242b863ceb7SPatrick McHardy 243618e1b74SArnd Bergmann ret = macvlan_queue_xmit(skb, dev); 2442d6c9ffcSEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 2452c114553SEric Dumazet txq->tx_packets++; 2462c114553SEric Dumazet txq->tx_bytes += len; 2472c114553SEric Dumazet } else 2482c114553SEric Dumazet txq->tx_dropped++; 2492c114553SEric Dumazet 250cbbef5e1SPatrick McHardy return ret; 251b863ceb7SPatrick McHardy } 252fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_start_xmit); 253b863ceb7SPatrick McHardy 254b863ceb7SPatrick McHardy static int macvlan_hard_header(struct sk_buff *skb, struct net_device *dev, 2553b04dddeSStephen Hemminger unsigned short type, const void *daddr, 2563b04dddeSStephen Hemminger const void *saddr, unsigned len) 257b863ceb7SPatrick McHardy { 258b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 259b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 260b863ceb7SPatrick McHardy 2610c4e8581SStephen Hemminger return dev_hard_header(skb, lowerdev, type, daddr, 262b863ceb7SPatrick McHardy saddr ? : dev->dev_addr, len); 263b863ceb7SPatrick McHardy } 264b863ceb7SPatrick McHardy 2653b04dddeSStephen Hemminger static const struct header_ops macvlan_hard_header_ops = { 2663b04dddeSStephen Hemminger .create = macvlan_hard_header, 2673b04dddeSStephen Hemminger .rebuild = eth_rebuild_header, 2683b04dddeSStephen Hemminger .parse = eth_header_parse, 2693b04dddeSStephen Hemminger .cache = eth_header_cache, 2703b04dddeSStephen Hemminger .cache_update = eth_header_cache_update, 2713b04dddeSStephen Hemminger }; 2723b04dddeSStephen Hemminger 273b863ceb7SPatrick McHardy static int macvlan_open(struct net_device *dev) 274b863ceb7SPatrick McHardy { 275b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 276b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 277b863ceb7SPatrick McHardy int err; 278b863ceb7SPatrick McHardy 279f9ac30f0SEric Biederman err = -EBUSY; 280f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, dev->dev_addr)) 281f9ac30f0SEric Biederman goto out; 282f9ac30f0SEric Biederman 283a748ee24SJiri Pirko err = dev_uc_add(lowerdev, dev->dev_addr); 284b863ceb7SPatrick McHardy if (err < 0) 285b89fb7daSWang Chen goto out; 286b89fb7daSWang Chen if (dev->flags & IFF_ALLMULTI) { 287b89fb7daSWang Chen err = dev_set_allmulti(lowerdev, 1); 288b89fb7daSWang Chen if (err < 0) 289b89fb7daSWang Chen goto del_unicast; 290b89fb7daSWang Chen } 291f9ac30f0SEric Biederman macvlan_hash_add(vlan); 292b863ceb7SPatrick McHardy return 0; 293b89fb7daSWang Chen 294b89fb7daSWang Chen del_unicast: 295a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 296b89fb7daSWang Chen out: 297b89fb7daSWang Chen return err; 298b863ceb7SPatrick McHardy } 299b863ceb7SPatrick McHardy 300b863ceb7SPatrick McHardy static int macvlan_stop(struct net_device *dev) 301b863ceb7SPatrick McHardy { 302b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 303b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 304b863ceb7SPatrick McHardy 305b863ceb7SPatrick McHardy dev_mc_unsync(lowerdev, dev); 306b863ceb7SPatrick McHardy if (dev->flags & IFF_ALLMULTI) 307b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, -1); 308b863ceb7SPatrick McHardy 309a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 310b863ceb7SPatrick McHardy 311f9ac30f0SEric Biederman macvlan_hash_del(vlan); 312b863ceb7SPatrick McHardy return 0; 313b863ceb7SPatrick McHardy } 314b863ceb7SPatrick McHardy 315ad5d20a6SPatrick McHardy static int macvlan_set_mac_address(struct net_device *dev, void *p) 316ad5d20a6SPatrick McHardy { 317ad5d20a6SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 318ad5d20a6SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 319ad5d20a6SPatrick McHardy struct sockaddr *addr = p; 320ad5d20a6SPatrick McHardy int err; 321ad5d20a6SPatrick McHardy 322ad5d20a6SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 323ad5d20a6SPatrick McHardy return -EADDRNOTAVAIL; 324ad5d20a6SPatrick McHardy 325f9ac30f0SEric Biederman if (!(dev->flags & IFF_UP)) { 326f9ac30f0SEric Biederman /* Just copy in the new address */ 327f9ac30f0SEric Biederman memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); 328f9ac30f0SEric Biederman } else { 329f9ac30f0SEric Biederman /* Rehash and update the device filters */ 330f9ac30f0SEric Biederman if (macvlan_addr_busy(vlan->port, addr->sa_data)) 331f9ac30f0SEric Biederman return -EBUSY; 332ad5d20a6SPatrick McHardy 333a748ee24SJiri Pirko err = dev_uc_add(lowerdev, addr->sa_data); 334ccffad25SJiri Pirko if (err) 335ad5d20a6SPatrick McHardy return err; 336f9ac30f0SEric Biederman 337a748ee24SJiri Pirko dev_uc_del(lowerdev, dev->dev_addr); 338ad5d20a6SPatrick McHardy 339f9ac30f0SEric Biederman macvlan_hash_change_addr(vlan, addr->sa_data); 340f9ac30f0SEric Biederman } 341ad5d20a6SPatrick McHardy return 0; 342ad5d20a6SPatrick McHardy } 343ad5d20a6SPatrick McHardy 344b863ceb7SPatrick McHardy static void macvlan_change_rx_flags(struct net_device *dev, int change) 345b863ceb7SPatrick McHardy { 346b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 347b863ceb7SPatrick McHardy struct net_device *lowerdev = vlan->lowerdev; 348b863ceb7SPatrick McHardy 349b863ceb7SPatrick McHardy if (change & IFF_ALLMULTI) 350b863ceb7SPatrick McHardy dev_set_allmulti(lowerdev, dev->flags & IFF_ALLMULTI ? 1 : -1); 351b863ceb7SPatrick McHardy } 352b863ceb7SPatrick McHardy 353b863ceb7SPatrick McHardy static void macvlan_set_multicast_list(struct net_device *dev) 354b863ceb7SPatrick McHardy { 355b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 356b863ceb7SPatrick McHardy 357b863ceb7SPatrick McHardy dev_mc_sync(vlan->lowerdev, dev); 358b863ceb7SPatrick McHardy } 359b863ceb7SPatrick McHardy 360b863ceb7SPatrick McHardy static int macvlan_change_mtu(struct net_device *dev, int new_mtu) 361b863ceb7SPatrick McHardy { 362b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 363b863ceb7SPatrick McHardy 364b863ceb7SPatrick McHardy if (new_mtu < 68 || vlan->lowerdev->mtu < new_mtu) 365b863ceb7SPatrick McHardy return -EINVAL; 366b863ceb7SPatrick McHardy dev->mtu = new_mtu; 367b863ceb7SPatrick McHardy return 0; 368b863ceb7SPatrick McHardy } 369b863ceb7SPatrick McHardy 370b863ceb7SPatrick McHardy /* 371b863ceb7SPatrick McHardy * macvlan network devices have devices nesting below it and are a special 372b863ceb7SPatrick McHardy * "super class" of normal network devices; split their locks off into a 373b863ceb7SPatrick McHardy * separate class since they always nest. 374b863ceb7SPatrick McHardy */ 375b863ceb7SPatrick McHardy static struct lock_class_key macvlan_netdev_xmit_lock_key; 376cf508b12SDavid S. Miller static struct lock_class_key macvlan_netdev_addr_lock_key; 377b863ceb7SPatrick McHardy 378b863ceb7SPatrick McHardy #define MACVLAN_FEATURES \ 379b863ceb7SPatrick McHardy (NETIF_F_SG | NETIF_F_ALL_CSUM | NETIF_F_HIGHDMA | NETIF_F_FRAGLIST | \ 380b863ceb7SPatrick McHardy NETIF_F_GSO | NETIF_F_TSO | NETIF_F_UFO | NETIF_F_GSO_ROBUST | \ 3816eb3a855SPatrick Mullaney NETIF_F_TSO_ECN | NETIF_F_TSO6 | NETIF_F_GRO) 382b863ceb7SPatrick McHardy 383b863ceb7SPatrick McHardy #define MACVLAN_STATE_MASK \ 384b863ceb7SPatrick McHardy ((1<<__LINK_STATE_NOCARRIER) | (1<<__LINK_STATE_DORMANT)) 385b863ceb7SPatrick McHardy 386e8a0464cSDavid S. Miller static void macvlan_set_lockdep_class_one(struct net_device *dev, 387e8a0464cSDavid S. Miller struct netdev_queue *txq, 388e8a0464cSDavid S. Miller void *_unused) 389c773e847SDavid S. Miller { 390c773e847SDavid S. Miller lockdep_set_class(&txq->_xmit_lock, 391c773e847SDavid S. Miller &macvlan_netdev_xmit_lock_key); 392c773e847SDavid S. Miller } 393c773e847SDavid S. Miller 394c773e847SDavid S. Miller static void macvlan_set_lockdep_class(struct net_device *dev) 395c773e847SDavid S. Miller { 396cf508b12SDavid S. Miller lockdep_set_class(&dev->addr_list_lock, 397cf508b12SDavid S. Miller &macvlan_netdev_addr_lock_key); 398e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, macvlan_set_lockdep_class_one, NULL); 399c773e847SDavid S. Miller } 400c773e847SDavid S. Miller 401b863ceb7SPatrick McHardy static int macvlan_init(struct net_device *dev) 402b863ceb7SPatrick McHardy { 403b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 404b863ceb7SPatrick McHardy const struct net_device *lowerdev = vlan->lowerdev; 405b863ceb7SPatrick McHardy 406b863ceb7SPatrick McHardy dev->state = (dev->state & ~MACVLAN_STATE_MASK) | 407b863ceb7SPatrick McHardy (lowerdev->state & MACVLAN_STATE_MASK); 408b863ceb7SPatrick McHardy dev->features = lowerdev->features & MACVLAN_FEATURES; 4098c2acc53SPatrick McHardy dev->gso_max_size = lowerdev->gso_max_size; 410b863ceb7SPatrick McHardy dev->iflink = lowerdev->ifindex; 411ef5c8996Ssg.tweak@gmail.com dev->hard_header_len = lowerdev->hard_header_len; 412b863ceb7SPatrick McHardy 413c773e847SDavid S. Miller macvlan_set_lockdep_class(dev); 414c773e847SDavid S. Miller 415fccaf710SEric Dumazet vlan->rx_stats = alloc_percpu(struct macvlan_rx_stats); 416fccaf710SEric Dumazet if (!vlan->rx_stats) 417fccaf710SEric Dumazet return -ENOMEM; 418fccaf710SEric Dumazet 419b863ceb7SPatrick McHardy return 0; 420b863ceb7SPatrick McHardy } 421b863ceb7SPatrick McHardy 422fccaf710SEric Dumazet static void macvlan_uninit(struct net_device *dev) 423fccaf710SEric Dumazet { 424fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 425fccaf710SEric Dumazet 426fccaf710SEric Dumazet free_percpu(vlan->rx_stats); 427fccaf710SEric Dumazet } 428fccaf710SEric Dumazet 429fccaf710SEric Dumazet static struct net_device_stats *macvlan_dev_get_stats(struct net_device *dev) 430fccaf710SEric Dumazet { 431fccaf710SEric Dumazet struct net_device_stats *stats = &dev->stats; 432fccaf710SEric Dumazet struct macvlan_dev *vlan = netdev_priv(dev); 433fccaf710SEric Dumazet 434fccaf710SEric Dumazet dev_txq_stats_fold(dev, stats); 435fccaf710SEric Dumazet 436fccaf710SEric Dumazet if (vlan->rx_stats) { 437fccaf710SEric Dumazet struct macvlan_rx_stats *p, rx = {0}; 438fccaf710SEric Dumazet int i; 439fccaf710SEric Dumazet 440fccaf710SEric Dumazet for_each_possible_cpu(i) { 441fccaf710SEric Dumazet p = per_cpu_ptr(vlan->rx_stats, i); 442fccaf710SEric Dumazet rx.rx_packets += p->rx_packets; 443fccaf710SEric Dumazet rx.rx_bytes += p->rx_bytes; 444fccaf710SEric Dumazet rx.rx_errors += p->rx_errors; 445fccaf710SEric Dumazet rx.multicast += p->multicast; 446fccaf710SEric Dumazet } 447fccaf710SEric Dumazet stats->rx_packets = rx.rx_packets; 448fccaf710SEric Dumazet stats->rx_bytes = rx.rx_bytes; 449fccaf710SEric Dumazet stats->rx_errors = rx.rx_errors; 450fccaf710SEric Dumazet stats->rx_dropped = rx.rx_errors; 451fccaf710SEric Dumazet stats->multicast = rx.multicast; 452fccaf710SEric Dumazet } 453fccaf710SEric Dumazet return stats; 454fccaf710SEric Dumazet } 455fccaf710SEric Dumazet 456b863ceb7SPatrick McHardy static void macvlan_ethtool_get_drvinfo(struct net_device *dev, 457b863ceb7SPatrick McHardy struct ethtool_drvinfo *drvinfo) 458b863ceb7SPatrick McHardy { 459b863ceb7SPatrick McHardy snprintf(drvinfo->driver, 32, "macvlan"); 460b863ceb7SPatrick McHardy snprintf(drvinfo->version, 32, "0.1"); 461b863ceb7SPatrick McHardy } 462b863ceb7SPatrick McHardy 463b863ceb7SPatrick McHardy static u32 macvlan_ethtool_get_rx_csum(struct net_device *dev) 464b863ceb7SPatrick McHardy { 465b863ceb7SPatrick McHardy const struct macvlan_dev *vlan = netdev_priv(dev); 466b1b67dd4SPatrick McHardy return dev_ethtool_get_rx_csum(vlan->lowerdev); 467b863ceb7SPatrick McHardy } 468b863ceb7SPatrick McHardy 4699edb8bb6SStephen Hemminger static int macvlan_ethtool_get_settings(struct net_device *dev, 4709edb8bb6SStephen Hemminger struct ethtool_cmd *cmd) 4719edb8bb6SStephen Hemminger { 4729edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 473b1b67dd4SPatrick McHardy return dev_ethtool_get_settings(vlan->lowerdev, cmd); 4749edb8bb6SStephen Hemminger } 4759edb8bb6SStephen Hemminger 4769edb8bb6SStephen Hemminger static u32 macvlan_ethtool_get_flags(struct net_device *dev) 4779edb8bb6SStephen Hemminger { 4789edb8bb6SStephen Hemminger const struct macvlan_dev *vlan = netdev_priv(dev); 479b1b67dd4SPatrick McHardy return dev_ethtool_get_flags(vlan->lowerdev); 4809edb8bb6SStephen Hemminger } 4819edb8bb6SStephen Hemminger 482b863ceb7SPatrick McHardy static const struct ethtool_ops macvlan_ethtool_ops = { 483b863ceb7SPatrick McHardy .get_link = ethtool_op_get_link, 4849edb8bb6SStephen Hemminger .get_settings = macvlan_ethtool_get_settings, 485b863ceb7SPatrick McHardy .get_rx_csum = macvlan_ethtool_get_rx_csum, 486b863ceb7SPatrick McHardy .get_drvinfo = macvlan_ethtool_get_drvinfo, 4879edb8bb6SStephen Hemminger .get_flags = macvlan_ethtool_get_flags, 488b863ceb7SPatrick McHardy }; 489b863ceb7SPatrick McHardy 49054a30c97SStephen Hemminger static const struct net_device_ops macvlan_netdev_ops = { 49154a30c97SStephen Hemminger .ndo_init = macvlan_init, 492fccaf710SEric Dumazet .ndo_uninit = macvlan_uninit, 49354a30c97SStephen Hemminger .ndo_open = macvlan_open, 49454a30c97SStephen Hemminger .ndo_stop = macvlan_stop, 49500829823SStephen Hemminger .ndo_start_xmit = macvlan_start_xmit, 49654a30c97SStephen Hemminger .ndo_change_mtu = macvlan_change_mtu, 49754a30c97SStephen Hemminger .ndo_change_rx_flags = macvlan_change_rx_flags, 49854a30c97SStephen Hemminger .ndo_set_mac_address = macvlan_set_mac_address, 49954a30c97SStephen Hemminger .ndo_set_multicast_list = macvlan_set_multicast_list, 500fccaf710SEric Dumazet .ndo_get_stats = macvlan_dev_get_stats, 50154a30c97SStephen Hemminger .ndo_validate_addr = eth_validate_addr, 50254a30c97SStephen Hemminger }; 50354a30c97SStephen Hemminger 504b863ceb7SPatrick McHardy static void macvlan_setup(struct net_device *dev) 505b863ceb7SPatrick McHardy { 506b863ceb7SPatrick McHardy ether_setup(dev); 507b863ceb7SPatrick McHardy 50893f154b5SEric Dumazet dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; 50954a30c97SStephen Hemminger dev->netdev_ops = &macvlan_netdev_ops; 510b863ceb7SPatrick McHardy dev->destructor = free_netdev; 5113b04dddeSStephen Hemminger dev->header_ops = &macvlan_hard_header_ops, 512b863ceb7SPatrick McHardy dev->ethtool_ops = &macvlan_ethtool_ops; 513b863ceb7SPatrick McHardy dev->tx_queue_len = 0; 514b863ceb7SPatrick McHardy } 515b863ceb7SPatrick McHardy 516b863ceb7SPatrick McHardy static int macvlan_port_create(struct net_device *dev) 517b863ceb7SPatrick McHardy { 518b863ceb7SPatrick McHardy struct macvlan_port *port; 519b863ceb7SPatrick McHardy unsigned int i; 520ab95bfe0SJiri Pirko int err; 521b863ceb7SPatrick McHardy 522b863ceb7SPatrick McHardy if (dev->type != ARPHRD_ETHER || dev->flags & IFF_LOOPBACK) 523b863ceb7SPatrick McHardy return -EINVAL; 524b863ceb7SPatrick McHardy 525b863ceb7SPatrick McHardy port = kzalloc(sizeof(*port), GFP_KERNEL); 526b863ceb7SPatrick McHardy if (port == NULL) 527b863ceb7SPatrick McHardy return -ENOMEM; 528b863ceb7SPatrick McHardy 529b863ceb7SPatrick McHardy port->dev = dev; 530b863ceb7SPatrick McHardy INIT_LIST_HEAD(&port->vlans); 531b863ceb7SPatrick McHardy for (i = 0; i < MACVLAN_HASH_SIZE; i++) 532b863ceb7SPatrick McHardy INIT_HLIST_HEAD(&port->vlan_hash[i]); 533b863ceb7SPatrick McHardy rcu_assign_pointer(dev->macvlan_port, port); 534ab95bfe0SJiri Pirko 535ab95bfe0SJiri Pirko err = netdev_rx_handler_register(dev, macvlan_handle_frame); 536ab95bfe0SJiri Pirko if (err) { 537ab95bfe0SJiri Pirko rcu_assign_pointer(dev->macvlan_port, NULL); 538ab95bfe0SJiri Pirko kfree(port); 539ab95bfe0SJiri Pirko } 540ab95bfe0SJiri Pirko 541ab95bfe0SJiri Pirko return err; 542b863ceb7SPatrick McHardy } 543b863ceb7SPatrick McHardy 544*8b37ef0aSJiri Pirko static void macvlan_port_rcu_free(struct rcu_head *head) 545*8b37ef0aSJiri Pirko { 546*8b37ef0aSJiri Pirko struct macvlan_port *port; 547*8b37ef0aSJiri Pirko 548*8b37ef0aSJiri Pirko port = container_of(head, struct macvlan_port, rcu); 549*8b37ef0aSJiri Pirko kfree(port); 550*8b37ef0aSJiri Pirko } 551*8b37ef0aSJiri Pirko 552b863ceb7SPatrick McHardy static void macvlan_port_destroy(struct net_device *dev) 553b863ceb7SPatrick McHardy { 554b863ceb7SPatrick McHardy struct macvlan_port *port = dev->macvlan_port; 555b863ceb7SPatrick McHardy 556ab95bfe0SJiri Pirko netdev_rx_handler_unregister(dev); 557b863ceb7SPatrick McHardy rcu_assign_pointer(dev->macvlan_port, NULL); 558*8b37ef0aSJiri Pirko call_rcu(&port->rcu, macvlan_port_rcu_free); 559b863ceb7SPatrick McHardy } 560b863ceb7SPatrick McHardy 561b863ceb7SPatrick McHardy static int macvlan_validate(struct nlattr *tb[], struct nlattr *data[]) 562b863ceb7SPatrick McHardy { 563b863ceb7SPatrick McHardy if (tb[IFLA_ADDRESS]) { 564b863ceb7SPatrick McHardy if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) 565b863ceb7SPatrick McHardy return -EINVAL; 566b863ceb7SPatrick McHardy if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) 567b863ceb7SPatrick McHardy return -EADDRNOTAVAIL; 568b863ceb7SPatrick McHardy } 56927c0b1a8SArnd Bergmann 57027c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) { 57127c0b1a8SArnd Bergmann switch (nla_get_u32(data[IFLA_MACVLAN_MODE])) { 57227c0b1a8SArnd Bergmann case MACVLAN_MODE_PRIVATE: 57327c0b1a8SArnd Bergmann case MACVLAN_MODE_VEPA: 57427c0b1a8SArnd Bergmann case MACVLAN_MODE_BRIDGE: 57527c0b1a8SArnd Bergmann break; 57627c0b1a8SArnd Bergmann default: 57727c0b1a8SArnd Bergmann return -EINVAL; 57827c0b1a8SArnd Bergmann } 57927c0b1a8SArnd Bergmann } 580b863ceb7SPatrick McHardy return 0; 581b863ceb7SPatrick McHardy } 582b863ceb7SPatrick McHardy 5832c114553SEric Dumazet static int macvlan_get_tx_queues(struct net *net, 5842c114553SEric Dumazet struct nlattr *tb[], 5852c114553SEric Dumazet unsigned int *num_tx_queues, 5862c114553SEric Dumazet unsigned int *real_num_tx_queues) 5872c114553SEric Dumazet { 5882c114553SEric Dumazet struct net_device *real_dev; 5892c114553SEric Dumazet 5902c114553SEric Dumazet if (!tb[IFLA_LINK]) 5912c114553SEric Dumazet return -EINVAL; 5922c114553SEric Dumazet 5932c114553SEric Dumazet real_dev = __dev_get_by_index(net, nla_get_u32(tb[IFLA_LINK])); 5942c114553SEric Dumazet if (!real_dev) 5952c114553SEric Dumazet return -ENODEV; 5962c114553SEric Dumazet 5972c114553SEric Dumazet *num_tx_queues = real_dev->num_tx_queues; 5982c114553SEric Dumazet *real_num_tx_queues = real_dev->real_num_tx_queues; 5992c114553SEric Dumazet return 0; 6002c114553SEric Dumazet } 6012c114553SEric Dumazet 602fc0663d6SArnd Bergmann int macvlan_common_newlink(struct net *src_net, struct net_device *dev, 603fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[], 604fc0663d6SArnd Bergmann int (*receive)(struct sk_buff *skb), 605fc0663d6SArnd Bergmann int (*forward)(struct net_device *dev, 606fc0663d6SArnd Bergmann struct sk_buff *skb)) 607b863ceb7SPatrick McHardy { 608b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 609b863ceb7SPatrick McHardy struct macvlan_port *port; 610b863ceb7SPatrick McHardy struct net_device *lowerdev; 611b863ceb7SPatrick McHardy int err; 612b863ceb7SPatrick McHardy 613b863ceb7SPatrick McHardy if (!tb[IFLA_LINK]) 614b863ceb7SPatrick McHardy return -EINVAL; 615b863ceb7SPatrick McHardy 61681adee47SEric W. Biederman lowerdev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK])); 617b863ceb7SPatrick McHardy if (lowerdev == NULL) 618b863ceb7SPatrick McHardy return -ENODEV; 619b863ceb7SPatrick McHardy 620b0832a29SEric Biederman /* When creating macvlans on top of other macvlans - use 621b0832a29SEric Biederman * the real device as the lowerdev. 622a6ca5f1dSPatrick McHardy */ 623b0832a29SEric Biederman if (lowerdev->rtnl_link_ops == dev->rtnl_link_ops) { 624b0832a29SEric Biederman struct macvlan_dev *lowervlan = netdev_priv(lowerdev); 625b0832a29SEric Biederman lowerdev = lowervlan->lowerdev; 626b0832a29SEric Biederman } 627a6ca5f1dSPatrick McHardy 628b863ceb7SPatrick McHardy if (!tb[IFLA_MTU]) 629b863ceb7SPatrick McHardy dev->mtu = lowerdev->mtu; 630b863ceb7SPatrick McHardy else if (dev->mtu > lowerdev->mtu) 631b863ceb7SPatrick McHardy return -EINVAL; 632b863ceb7SPatrick McHardy 633b863ceb7SPatrick McHardy if (!tb[IFLA_ADDRESS]) 634b863ceb7SPatrick McHardy random_ether_addr(dev->dev_addr); 635b863ceb7SPatrick McHardy 636b863ceb7SPatrick McHardy if (lowerdev->macvlan_port == NULL) { 637b863ceb7SPatrick McHardy err = macvlan_port_create(lowerdev); 638b863ceb7SPatrick McHardy if (err < 0) 639b863ceb7SPatrick McHardy return err; 640b863ceb7SPatrick McHardy } 641b863ceb7SPatrick McHardy port = lowerdev->macvlan_port; 642b863ceb7SPatrick McHardy 643b863ceb7SPatrick McHardy vlan->lowerdev = lowerdev; 644b863ceb7SPatrick McHardy vlan->dev = dev; 645b863ceb7SPatrick McHardy vlan->port = port; 646fc0663d6SArnd Bergmann vlan->receive = receive; 647fc0663d6SArnd Bergmann vlan->forward = forward; 648b863ceb7SPatrick McHardy 64927c0b1a8SArnd Bergmann vlan->mode = MACVLAN_MODE_VEPA; 65027c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 65127c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 65227c0b1a8SArnd Bergmann 653b863ceb7SPatrick McHardy err = register_netdevice(dev); 654b863ceb7SPatrick McHardy if (err < 0) 655f16d3d57SJiri Pirko goto destroy_port; 656b863ceb7SPatrick McHardy 657b863ceb7SPatrick McHardy list_add_tail(&vlan->list, &port->vlans); 658fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(lowerdev, dev); 659f16d3d57SJiri Pirko 660b863ceb7SPatrick McHardy return 0; 661f16d3d57SJiri Pirko 662f16d3d57SJiri Pirko destroy_port: 663f16d3d57SJiri Pirko if (list_empty(&port->vlans)) 664f16d3d57SJiri Pirko macvlan_port_destroy(lowerdev); 665f16d3d57SJiri Pirko 666f16d3d57SJiri Pirko return err; 667b863ceb7SPatrick McHardy } 668fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_common_newlink); 669b863ceb7SPatrick McHardy 670fc0663d6SArnd Bergmann static int macvlan_newlink(struct net *src_net, struct net_device *dev, 671fc0663d6SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 672fc0663d6SArnd Bergmann { 673fc0663d6SArnd Bergmann return macvlan_common_newlink(src_net, dev, tb, data, 674fc0663d6SArnd Bergmann netif_rx, 675fc0663d6SArnd Bergmann dev_forward_skb); 676fc0663d6SArnd Bergmann } 677fc0663d6SArnd Bergmann 678fc0663d6SArnd Bergmann void macvlan_dellink(struct net_device *dev, struct list_head *head) 679b863ceb7SPatrick McHardy { 680b863ceb7SPatrick McHardy struct macvlan_dev *vlan = netdev_priv(dev); 681b863ceb7SPatrick McHardy struct macvlan_port *port = vlan->port; 682b863ceb7SPatrick McHardy 683b863ceb7SPatrick McHardy list_del(&vlan->list); 68423289a37SEric Dumazet unregister_netdevice_queue(dev, head); 685b863ceb7SPatrick McHardy 686b863ceb7SPatrick McHardy if (list_empty(&port->vlans)) 68773120964SPatrick McHardy macvlan_port_destroy(port->dev); 688b863ceb7SPatrick McHardy } 689fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_dellink); 690b863ceb7SPatrick McHardy 69127c0b1a8SArnd Bergmann static int macvlan_changelink(struct net_device *dev, 69227c0b1a8SArnd Bergmann struct nlattr *tb[], struct nlattr *data[]) 69327c0b1a8SArnd Bergmann { 69427c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 69527c0b1a8SArnd Bergmann if (data && data[IFLA_MACVLAN_MODE]) 69627c0b1a8SArnd Bergmann vlan->mode = nla_get_u32(data[IFLA_MACVLAN_MODE]); 69727c0b1a8SArnd Bergmann return 0; 69827c0b1a8SArnd Bergmann } 69927c0b1a8SArnd Bergmann 70027c0b1a8SArnd Bergmann static size_t macvlan_get_size(const struct net_device *dev) 70127c0b1a8SArnd Bergmann { 70227c0b1a8SArnd Bergmann return nla_total_size(4); 70327c0b1a8SArnd Bergmann } 70427c0b1a8SArnd Bergmann 70527c0b1a8SArnd Bergmann static int macvlan_fill_info(struct sk_buff *skb, 70627c0b1a8SArnd Bergmann const struct net_device *dev) 70727c0b1a8SArnd Bergmann { 70827c0b1a8SArnd Bergmann struct macvlan_dev *vlan = netdev_priv(dev); 70927c0b1a8SArnd Bergmann 71027c0b1a8SArnd Bergmann NLA_PUT_U32(skb, IFLA_MACVLAN_MODE, vlan->mode); 71127c0b1a8SArnd Bergmann return 0; 71227c0b1a8SArnd Bergmann 71327c0b1a8SArnd Bergmann nla_put_failure: 71427c0b1a8SArnd Bergmann return -EMSGSIZE; 71527c0b1a8SArnd Bergmann } 71627c0b1a8SArnd Bergmann 71727c0b1a8SArnd Bergmann static const struct nla_policy macvlan_policy[IFLA_MACVLAN_MAX + 1] = { 71827c0b1a8SArnd Bergmann [IFLA_MACVLAN_MODE] = { .type = NLA_U32 }, 71927c0b1a8SArnd Bergmann }; 72027c0b1a8SArnd Bergmann 721fc0663d6SArnd Bergmann int macvlan_link_register(struct rtnl_link_ops *ops) 722fc0663d6SArnd Bergmann { 723fc0663d6SArnd Bergmann /* common fields */ 724fc0663d6SArnd Bergmann ops->priv_size = sizeof(struct macvlan_dev); 725fc0663d6SArnd Bergmann ops->get_tx_queues = macvlan_get_tx_queues; 726fc0663d6SArnd Bergmann ops->setup = macvlan_setup; 727fc0663d6SArnd Bergmann ops->validate = macvlan_validate; 728fc0663d6SArnd Bergmann ops->maxtype = IFLA_MACVLAN_MAX; 729fc0663d6SArnd Bergmann ops->policy = macvlan_policy; 730fc0663d6SArnd Bergmann ops->changelink = macvlan_changelink; 731fc0663d6SArnd Bergmann ops->get_size = macvlan_get_size; 732fc0663d6SArnd Bergmann ops->fill_info = macvlan_fill_info; 733fc0663d6SArnd Bergmann 734fc0663d6SArnd Bergmann return rtnl_link_register(ops); 735fc0663d6SArnd Bergmann }; 736fc0663d6SArnd Bergmann EXPORT_SYMBOL_GPL(macvlan_link_register); 737fc0663d6SArnd Bergmann 738fc0663d6SArnd Bergmann static struct rtnl_link_ops macvlan_link_ops = { 739b863ceb7SPatrick McHardy .kind = "macvlan", 740b863ceb7SPatrick McHardy .newlink = macvlan_newlink, 741b863ceb7SPatrick McHardy .dellink = macvlan_dellink, 742b863ceb7SPatrick McHardy }; 743b863ceb7SPatrick McHardy 744b863ceb7SPatrick McHardy static int macvlan_device_event(struct notifier_block *unused, 745b863ceb7SPatrick McHardy unsigned long event, void *ptr) 746b863ceb7SPatrick McHardy { 747b863ceb7SPatrick McHardy struct net_device *dev = ptr; 748b863ceb7SPatrick McHardy struct macvlan_dev *vlan, *next; 749b863ceb7SPatrick McHardy struct macvlan_port *port; 750b863ceb7SPatrick McHardy 751b863ceb7SPatrick McHardy port = dev->macvlan_port; 752b863ceb7SPatrick McHardy if (port == NULL) 753b863ceb7SPatrick McHardy return NOTIFY_DONE; 754b863ceb7SPatrick McHardy 755b863ceb7SPatrick McHardy switch (event) { 756b863ceb7SPatrick McHardy case NETDEV_CHANGE: 757b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) 758fc4a7489SPatrick Mullaney netif_stacked_transfer_operstate(vlan->lowerdev, 759fc4a7489SPatrick Mullaney vlan->dev); 760b863ceb7SPatrick McHardy break; 761b863ceb7SPatrick McHardy case NETDEV_FEAT_CHANGE: 762b863ceb7SPatrick McHardy list_for_each_entry(vlan, &port->vlans, list) { 763b863ceb7SPatrick McHardy vlan->dev->features = dev->features & MACVLAN_FEATURES; 7648c2acc53SPatrick McHardy vlan->dev->gso_max_size = dev->gso_max_size; 765b863ceb7SPatrick McHardy netdev_features_change(vlan->dev); 766b863ceb7SPatrick McHardy } 767b863ceb7SPatrick McHardy break; 768b863ceb7SPatrick McHardy case NETDEV_UNREGISTER: 769b863ceb7SPatrick McHardy list_for_each_entry_safe(vlan, next, &port->vlans, list) 770fc0663d6SArnd Bergmann vlan->dev->rtnl_link_ops->dellink(vlan->dev, NULL); 771b863ceb7SPatrick McHardy break; 7721c01fe14SJiri Pirko case NETDEV_PRE_TYPE_CHANGE: 7731c01fe14SJiri Pirko /* Forbid underlaying device to change its type. */ 7741c01fe14SJiri Pirko return NOTIFY_BAD; 775b863ceb7SPatrick McHardy } 776b863ceb7SPatrick McHardy return NOTIFY_DONE; 777b863ceb7SPatrick McHardy } 778b863ceb7SPatrick McHardy 779b863ceb7SPatrick McHardy static struct notifier_block macvlan_notifier_block __read_mostly = { 780b863ceb7SPatrick McHardy .notifier_call = macvlan_device_event, 781b863ceb7SPatrick McHardy }; 782b863ceb7SPatrick McHardy 783b863ceb7SPatrick McHardy static int __init macvlan_init_module(void) 784b863ceb7SPatrick McHardy { 785b863ceb7SPatrick McHardy int err; 786b863ceb7SPatrick McHardy 787b863ceb7SPatrick McHardy register_netdevice_notifier(&macvlan_notifier_block); 788b863ceb7SPatrick McHardy 789fc0663d6SArnd Bergmann err = macvlan_link_register(&macvlan_link_ops); 790b863ceb7SPatrick McHardy if (err < 0) 791b863ceb7SPatrick McHardy goto err1; 792b863ceb7SPatrick McHardy return 0; 793b863ceb7SPatrick McHardy err1: 794b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 795b863ceb7SPatrick McHardy return err; 796b863ceb7SPatrick McHardy } 797b863ceb7SPatrick McHardy 798b863ceb7SPatrick McHardy static void __exit macvlan_cleanup_module(void) 799b863ceb7SPatrick McHardy { 800b863ceb7SPatrick McHardy rtnl_link_unregister(&macvlan_link_ops); 801b863ceb7SPatrick McHardy unregister_netdevice_notifier(&macvlan_notifier_block); 802b863ceb7SPatrick McHardy } 803b863ceb7SPatrick McHardy 804b863ceb7SPatrick McHardy module_init(macvlan_init_module); 805b863ceb7SPatrick McHardy module_exit(macvlan_cleanup_module); 806b863ceb7SPatrick McHardy 807b863ceb7SPatrick McHardy MODULE_LICENSE("GPL"); 808b863ceb7SPatrick McHardy MODULE_AUTHOR("Patrick McHardy <kaber@trash.net>"); 809b863ceb7SPatrick McHardy MODULE_DESCRIPTION("Driver for MAC address based VLANs"); 810b863ceb7SPatrick McHardy MODULE_ALIAS_RTNL_LINK("macvlan"); 811