11da177e4SLinus Torvalds /* -*- linux-c -*- 21da177e4SLinus Torvalds * INET 802.1Q VLAN 31da177e4SLinus Torvalds * Ethernet-type device handling. 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Authors: Ben Greear <greearb@candelatech.com> 6ad712087SPatrick McHardy * Please send support related email to: netdev@vger.kernel.org 71da177e4SLinus Torvalds * VLAN Home Page: http://www.candelatech.com/~greear/vlan.html 81da177e4SLinus Torvalds * 91da177e4SLinus Torvalds * Fixes: Mar 22 2001: Martin Bokaemper <mbokaemper@unispherenetworks.com> 101da177e4SLinus Torvalds * - reset skb->pkt_type on incoming packets when MAC was changed 111da177e4SLinus Torvalds * - see that changed MAC is saddr for outgoing packets 121da177e4SLinus Torvalds * Oct 20, 2001: Ard van Breeman: 131da177e4SLinus Torvalds * - Fix MC-list, finally. 141da177e4SLinus Torvalds * - Flush MC-list on VLAN destroy. 151da177e4SLinus Torvalds * 161da177e4SLinus Torvalds * 171da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or 181da177e4SLinus Torvalds * modify it under the terms of the GNU General Public License 191da177e4SLinus Torvalds * as published by the Free Software Foundation; either version 201da177e4SLinus Torvalds * 2 of the License, or (at your option) any later version. 211da177e4SLinus Torvalds */ 221da177e4SLinus Torvalds 23afab2d29SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 24afab2d29SJoe Perches 251da177e4SLinus Torvalds #include <linux/module.h> 265a0e3ad6STejun Heo #include <linux/slab.h> 271da177e4SLinus Torvalds #include <linux/skbuff.h> 281da177e4SLinus Torvalds #include <linux/netdevice.h> 2937dd9255SRichard Cochran #include <linux/net_tstamp.h> 301da177e4SLinus Torvalds #include <linux/etherdevice.h> 3175b8846aSPatrick McHardy #include <linux/ethtool.h> 32ec1d8ccbSHangbin Liu #include <linux/phy.h> 331da177e4SLinus Torvalds #include <net/arp.h> 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds #include "vlan.h" 361da177e4SLinus Torvalds #include "vlanproc.h" 371da177e4SLinus Torvalds #include <linux/if_vlan.h> 386d4cdf47SBenjamin LaHaise #include <linux/netpoll.h> 391da177e4SLinus Torvalds 401da177e4SLinus Torvalds /* 411da177e4SLinus Torvalds * Create the VLAN header for an arbitrary protocol layer 421da177e4SLinus Torvalds * 431da177e4SLinus Torvalds * saddr=NULL means use device source address 441da177e4SLinus Torvalds * daddr=NULL means leave destination address (eg unresolved arp) 451da177e4SLinus Torvalds * 461da177e4SLinus Torvalds * This is called when the SKB is moving down the stack towards the 471da177e4SLinus Torvalds * physical devices. 481da177e4SLinus Torvalds */ 49ef3eb3e5SPatrick McHardy static int vlan_dev_hard_header(struct sk_buff *skb, struct net_device *dev, 503b04dddeSStephen Hemminger unsigned short type, 51ef3eb3e5SPatrick McHardy const void *daddr, const void *saddr, 52ef3eb3e5SPatrick McHardy unsigned int len) 531da177e4SLinus Torvalds { 541fd9b1fcSPatrick McHardy struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 551da177e4SLinus Torvalds struct vlan_hdr *vhdr; 561349fe9aSPatrick McHardy unsigned int vhdrlen = 0; 579bb8582eSPatrick McHardy u16 vlan_tci = 0; 581349fe9aSPatrick McHardy int rc; 591da177e4SLinus Torvalds 600c0667a8SWang Sheng-Hui if (!(vlan->flags & VLAN_FLAG_REORDER_HDR)) { 61d58ff351SJohannes Berg vhdr = skb_push(skb, VLAN_HLEN); 621da177e4SLinus Torvalds 630c0667a8SWang Sheng-Hui vlan_tci = vlan->vlan_id; 64e267cb96SDavid S. Miller vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority); 659bb8582eSPatrick McHardy vhdr->h_vlan_TCI = htons(vlan_tci); 661da177e4SLinus Torvalds 671da177e4SLinus Torvalds /* 68bf9ae538SOctavian Purdila * Set the protocol type. For a packet of type ETH_P_802_3/2 we 69bf9ae538SOctavian Purdila * put the length in here instead. 701da177e4SLinus Torvalds */ 71bf9ae538SOctavian Purdila if (type != ETH_P_802_3 && type != ETH_P_802_2) 721da177e4SLinus Torvalds vhdr->h_vlan_encapsulated_proto = htons(type); 732029cc2cSPatrick McHardy else 741da177e4SLinus Torvalds vhdr->h_vlan_encapsulated_proto = htons(len); 75279e172aSJerome Borsboom 761fd9b1fcSPatrick McHardy skb->protocol = vlan->vlan_proto; 771fd9b1fcSPatrick McHardy type = ntohs(vlan->vlan_proto); 781349fe9aSPatrick McHardy vhdrlen = VLAN_HLEN; 791da177e4SLinus Torvalds } 801da177e4SLinus Torvalds 811da177e4SLinus Torvalds /* Before delegating work to the lower layer, enter our MAC-address */ 821da177e4SLinus Torvalds if (saddr == NULL) 831da177e4SLinus Torvalds saddr = dev->dev_addr; 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds /* Now make the underlying real hard header */ 860c0667a8SWang Sheng-Hui dev = vlan->real_dev; 871349fe9aSPatrick McHardy rc = dev_hard_header(skb, dev, type, daddr, saddr, len + vhdrlen); 880c4e8581SStephen Hemminger if (rc > 0) 891349fe9aSPatrick McHardy rc += vhdrlen; 901da177e4SLinus Torvalds return rc; 911da177e4SLinus Torvalds } 921da177e4SLinus Torvalds 936eacf8adSAmerigo Wang static inline netdev_tx_t vlan_netpoll_send_skb(struct vlan_dev_priv *vlan, struct sk_buff *skb) 946eacf8adSAmerigo Wang { 956eacf8adSAmerigo Wang #ifdef CONFIG_NET_POLL_CONTROLLER 966eacf8adSAmerigo Wang if (vlan->netpoll) 976eacf8adSAmerigo Wang netpoll_send_skb(vlan->netpoll, skb); 986eacf8adSAmerigo Wang #else 996eacf8adSAmerigo Wang BUG(); 1006eacf8adSAmerigo Wang #endif 1016eacf8adSAmerigo Wang return NETDEV_TX_OK; 1026eacf8adSAmerigo Wang } 1036eacf8adSAmerigo Wang 1046fef4c0cSStephen Hemminger static netdev_tx_t vlan_dev_hard_start_xmit(struct sk_buff *skb, 1056fef4c0cSStephen Hemminger struct net_device *dev) 1061da177e4SLinus Torvalds { 1076eacf8adSAmerigo Wang struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 1081da177e4SLinus Torvalds struct vlan_ethhdr *veth = (struct vlan_ethhdr *)(skb->data); 1091a123a31SEric Dumazet unsigned int len; 1101a123a31SEric Dumazet int ret; 11155b01e86SDavid S. Miller 1121da177e4SLinus Torvalds /* Handle non-VLAN frames if they are sent to us, for example by DHCP. 1131da177e4SLinus Torvalds * 1141da177e4SLinus Torvalds * NOTE: THIS ASSUMES DIX ETHERNET, SPECIFICALLY NOT SUPPORTING 1151da177e4SLinus Torvalds * OTHER THINGS LIKE FDDI/TokenRing/802.3 SNAPs... 1161da177e4SLinus Torvalds */ 1171fd9b1fcSPatrick McHardy if (veth->h_vlan_proto != vlan->vlan_proto || 1186eacf8adSAmerigo Wang vlan->flags & VLAN_FLAG_REORDER_HDR) { 1199bb8582eSPatrick McHardy u16 vlan_tci; 1206eacf8adSAmerigo Wang vlan_tci = vlan->vlan_id; 121e267cb96SDavid S. Miller vlan_tci |= vlan_dev_get_egress_qos_mask(dev, skb->priority); 122b960a0acSJiri Pirko __vlan_hwaccel_put_tag(skb, vlan->vlan_proto, vlan_tci); 123636e19a3SJohn Fastabend } 1241da177e4SLinus Torvalds 1256eacf8adSAmerigo Wang skb->dev = vlan->real_dev; 1261a123a31SEric Dumazet len = skb->len; 1276eacf8adSAmerigo Wang if (unlikely(netpoll_tx_running(dev))) 1286eacf8adSAmerigo Wang return vlan_netpoll_send_skb(vlan, skb); 1296eacf8adSAmerigo Wang 1301a123a31SEric Dumazet ret = dev_queue_xmit(skb); 1311a123a31SEric Dumazet 1322d6c9ffcSEric Dumazet if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) { 1334af429d2SEric Dumazet struct vlan_pcpu_stats *stats; 1344af429d2SEric Dumazet 1356eacf8adSAmerigo Wang stats = this_cpu_ptr(vlan->vlan_pcpu_stats); 1364af429d2SEric Dumazet u64_stats_update_begin(&stats->syncp); 1374af429d2SEric Dumazet stats->tx_packets++; 1384af429d2SEric Dumazet stats->tx_bytes += len; 139307f73dfSWei Yongjun u64_stats_update_end(&stats->syncp); 1404af429d2SEric Dumazet } else { 1416eacf8adSAmerigo Wang this_cpu_inc(vlan->vlan_pcpu_stats->tx_dropped); 1424af429d2SEric Dumazet } 1431a123a31SEric Dumazet 144cbbef5e1SPatrick McHardy return ret; 1451da177e4SLinus Torvalds } 1461da177e4SLinus Torvalds 147ef3eb3e5SPatrick McHardy static int vlan_dev_change_mtu(struct net_device *dev, int new_mtu) 1481da177e4SLinus Torvalds { 14918d3df3eSPaolo Abeni struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 15018d3df3eSPaolo Abeni unsigned int max_mtu = real_dev->mtu; 15118d3df3eSPaolo Abeni 15218d3df3eSPaolo Abeni if (netif_reduces_vlan_mtu(real_dev)) 15318d3df3eSPaolo Abeni max_mtu -= VLAN_HLEN; 15418d3df3eSPaolo Abeni if (max_mtu < new_mtu) 1551da177e4SLinus Torvalds return -ERANGE; 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds dev->mtu = new_mtu; 1581da177e4SLinus Torvalds 1591da177e4SLinus Torvalds return 0; 1601da177e4SLinus Torvalds } 1611da177e4SLinus Torvalds 162c17d8874SPatrick McHardy void vlan_dev_set_ingress_priority(const struct net_device *dev, 1639bb8582eSPatrick McHardy u32 skb_prio, u16 vlan_prio) 1641da177e4SLinus Torvalds { 1657da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 166b020cb48SPatrick McHardy 167b020cb48SPatrick McHardy if (vlan->ingress_priority_map[vlan_prio & 0x7] && !skb_prio) 168b020cb48SPatrick McHardy vlan->nr_ingress_mappings--; 169b020cb48SPatrick McHardy else if (!vlan->ingress_priority_map[vlan_prio & 0x7] && skb_prio) 170b020cb48SPatrick McHardy vlan->nr_ingress_mappings++; 171b020cb48SPatrick McHardy 172b020cb48SPatrick McHardy vlan->ingress_priority_map[vlan_prio & 0x7] = skb_prio; 1731da177e4SLinus Torvalds } 1741da177e4SLinus Torvalds 175c17d8874SPatrick McHardy int vlan_dev_set_egress_priority(const struct net_device *dev, 1769bb8582eSPatrick McHardy u32 skb_prio, u16 vlan_prio) 1771da177e4SLinus Torvalds { 1787da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 1791da177e4SLinus Torvalds struct vlan_priority_tci_mapping *mp = NULL; 1801da177e4SLinus Torvalds struct vlan_priority_tci_mapping *np; 18105423b24SEric Dumazet u32 vlan_qos = (vlan_prio << VLAN_PRIO_SHIFT) & VLAN_PRIO_MASK; 1821da177e4SLinus Torvalds 1831da177e4SLinus Torvalds /* See if a priority mapping exists.. */ 184b020cb48SPatrick McHardy mp = vlan->egress_priority_map[skb_prio & 0xF]; 1851da177e4SLinus Torvalds while (mp) { 1861da177e4SLinus Torvalds if (mp->priority == skb_prio) { 187b020cb48SPatrick McHardy if (mp->vlan_qos && !vlan_qos) 188b020cb48SPatrick McHardy vlan->nr_egress_mappings--; 189b020cb48SPatrick McHardy else if (!mp->vlan_qos && vlan_qos) 190b020cb48SPatrick McHardy vlan->nr_egress_mappings++; 191b020cb48SPatrick McHardy mp->vlan_qos = vlan_qos; 1921da177e4SLinus Torvalds return 0; 1931da177e4SLinus Torvalds } 1941da177e4SLinus Torvalds mp = mp->next; 1951da177e4SLinus Torvalds } 1961da177e4SLinus Torvalds 1971da177e4SLinus Torvalds /* Create a new mapping then. */ 198b020cb48SPatrick McHardy mp = vlan->egress_priority_map[skb_prio & 0xF]; 1991da177e4SLinus Torvalds np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL); 200c17d8874SPatrick McHardy if (!np) 201c17d8874SPatrick McHardy return -ENOBUFS; 202c17d8874SPatrick McHardy 2031da177e4SLinus Torvalds np->next = mp; 2041da177e4SLinus Torvalds np->priority = skb_prio; 205b020cb48SPatrick McHardy np->vlan_qos = vlan_qos; 2063e3aac49SEric Dumazet /* Before inserting this element in hash table, make sure all its fields 2073e3aac49SEric Dumazet * are committed to memory. 208e267cb96SDavid S. Miller * coupled with smp_rmb() in vlan_dev_get_egress_qos_mask() 2093e3aac49SEric Dumazet */ 2103e3aac49SEric Dumazet smp_wmb(); 211b020cb48SPatrick McHardy vlan->egress_priority_map[skb_prio & 0xF] = np; 212b020cb48SPatrick McHardy if (vlan_qos) 213b020cb48SPatrick McHardy vlan->nr_egress_mappings++; 2141da177e4SLinus Torvalds return 0; 2151da177e4SLinus Torvalds } 2161da177e4SLinus Torvalds 21784a2fba2SSun Lianwen /* Flags are defined in the vlan_flags enum in 21884a2fba2SSun Lianwen * include/uapi/linux/if_vlan.h file. 21984a2fba2SSun Lianwen */ 220b3ce0325SPatrick McHardy int vlan_dev_change_flags(const struct net_device *dev, u32 flags, u32 mask) 2211da177e4SLinus Torvalds { 2227da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 223b3ce0325SPatrick McHardy u32 old_flags = vlan->flags; 224b3ce0325SPatrick McHardy 2255e756593SPatrick McHardy if (mask & ~(VLAN_FLAG_REORDER_HDR | VLAN_FLAG_GVRP | 2268c8b3458SMike Manning VLAN_FLAG_LOOSE_BINDING | VLAN_FLAG_MVRP | 2278c8b3458SMike Manning VLAN_FLAG_BRIDGE_BINDING)) 2281da177e4SLinus Torvalds return -EINVAL; 229b3ce0325SPatrick McHardy 230b3ce0325SPatrick McHardy vlan->flags = (old_flags & ~mask) | (flags & mask); 23170c03b49SPatrick McHardy 23270c03b49SPatrick McHardy if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_GVRP) { 23370c03b49SPatrick McHardy if (vlan->flags & VLAN_FLAG_GVRP) 23470c03b49SPatrick McHardy vlan_gvrp_request_join(dev); 23570c03b49SPatrick McHardy else 23670c03b49SPatrick McHardy vlan_gvrp_request_leave(dev); 23770c03b49SPatrick McHardy } 23886fbe9bbSDavid Ward 23986fbe9bbSDavid Ward if (netif_running(dev) && (vlan->flags ^ old_flags) & VLAN_FLAG_MVRP) { 24086fbe9bbSDavid Ward if (vlan->flags & VLAN_FLAG_MVRP) 24186fbe9bbSDavid Ward vlan_mvrp_request_join(dev); 24286fbe9bbSDavid Ward else 24386fbe9bbSDavid Ward vlan_mvrp_request_leave(dev); 24486fbe9bbSDavid Ward } 245b3ce0325SPatrick McHardy return 0; 2461da177e4SLinus Torvalds } 2471da177e4SLinus Torvalds 248c17d8874SPatrick McHardy void vlan_dev_get_realdev_name(const struct net_device *dev, char *result) 2491da177e4SLinus Torvalds { 2507da82c06SJiri Pirko strncpy(result, vlan_dev_priv(dev)->real_dev->name, 23); 2511da177e4SLinus Torvalds } 2521da177e4SLinus Torvalds 253308453aaSMike Manning bool vlan_dev_inherit_address(struct net_device *dev, 254308453aaSMike Manning struct net_device *real_dev) 255308453aaSMike Manning { 256308453aaSMike Manning if (dev->addr_assign_type != NET_ADDR_STOLEN) 257308453aaSMike Manning return false; 258308453aaSMike Manning 259308453aaSMike Manning ether_addr_copy(dev->dev_addr, real_dev->dev_addr); 260308453aaSMike Manning call_netdevice_notifiers(NETDEV_CHANGEADDR, dev); 261308453aaSMike Manning return true; 262308453aaSMike Manning } 263308453aaSMike Manning 264ef3eb3e5SPatrick McHardy static int vlan_dev_open(struct net_device *dev) 2651da177e4SLinus Torvalds { 2667da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 2678c979c26SPatrick McHardy struct net_device *real_dev = vlan->real_dev; 2688c979c26SPatrick McHardy int err; 2698c979c26SPatrick McHardy 2705e756593SPatrick McHardy if (!(real_dev->flags & IFF_UP) && 2715e756593SPatrick McHardy !(vlan->flags & VLAN_FLAG_LOOSE_BINDING)) 2721da177e4SLinus Torvalds return -ENETDOWN; 2731da177e4SLinus Torvalds 274308453aaSMike Manning if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr) && 275308453aaSMike Manning !vlan_dev_inherit_address(dev, real_dev)) { 276a748ee24SJiri Pirko err = dev_uc_add(real_dev, dev->dev_addr); 2778c979c26SPatrick McHardy if (err < 0) 27889146504SWang Chen goto out; 2798c979c26SPatrick McHardy } 2808c979c26SPatrick McHardy 28189146504SWang Chen if (dev->flags & IFF_ALLMULTI) { 28289146504SWang Chen err = dev_set_allmulti(real_dev, 1); 28389146504SWang Chen if (err < 0) 28489146504SWang Chen goto del_unicast; 28589146504SWang Chen } 28689146504SWang Chen if (dev->flags & IFF_PROMISC) { 28789146504SWang Chen err = dev_set_promiscuity(real_dev, 1); 28889146504SWang Chen if (err < 0) 28989146504SWang Chen goto clear_allmulti; 29089146504SWang Chen } 29189146504SWang Chen 29207fc67beSJoe Perches ether_addr_copy(vlan->real_dev_addr, real_dev->dev_addr); 2936c78dcbdSPatrick McHardy 29470c03b49SPatrick McHardy if (vlan->flags & VLAN_FLAG_GVRP) 29570c03b49SPatrick McHardy vlan_gvrp_request_join(dev); 29670c03b49SPatrick McHardy 29786fbe9bbSDavid Ward if (vlan->flags & VLAN_FLAG_MVRP) 29886fbe9bbSDavid Ward vlan_mvrp_request_join(dev); 29986fbe9bbSDavid Ward 30076052d8cSMike Manning if (netif_carrier_ok(real_dev) && 30176052d8cSMike Manning !(vlan->flags & VLAN_FLAG_BRIDGE_BINDING)) 302adc667e8SJay Vosburgh netif_carrier_on(dev); 3031da177e4SLinus Torvalds return 0; 30489146504SWang Chen 30589146504SWang Chen clear_allmulti: 30689146504SWang Chen if (dev->flags & IFF_ALLMULTI) 30789146504SWang Chen dev_set_allmulti(real_dev, -1); 30889146504SWang Chen del_unicast: 30953a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 310a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 31189146504SWang Chen out: 312adc667e8SJay Vosburgh netif_carrier_off(dev); 31389146504SWang Chen return err; 3141da177e4SLinus Torvalds } 3151da177e4SLinus Torvalds 316ef3eb3e5SPatrick McHardy static int vlan_dev_stop(struct net_device *dev) 3171da177e4SLinus Torvalds { 3187da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 31970c03b49SPatrick McHardy struct net_device *real_dev = vlan->real_dev; 32070c03b49SPatrick McHardy 32156addd6eSPatrick McHardy dev_mc_unsync(real_dev, dev); 322a748ee24SJiri Pirko dev_uc_unsync(real_dev, dev); 3236c78dcbdSPatrick McHardy if (dev->flags & IFF_ALLMULTI) 3246c78dcbdSPatrick McHardy dev_set_allmulti(real_dev, -1); 3256c78dcbdSPatrick McHardy if (dev->flags & IFF_PROMISC) 3266c78dcbdSPatrick McHardy dev_set_promiscuity(real_dev, -1); 3276c78dcbdSPatrick McHardy 32853a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 329a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 3308c979c26SPatrick McHardy 33176052d8cSMike Manning if (!(vlan->flags & VLAN_FLAG_BRIDGE_BINDING)) 332adc667e8SJay Vosburgh netif_carrier_off(dev); 3331da177e4SLinus Torvalds return 0; 3341da177e4SLinus Torvalds } 3351da177e4SLinus Torvalds 336ef3eb3e5SPatrick McHardy static int vlan_dev_set_mac_address(struct net_device *dev, void *p) 33739aaac11SPatrick McHardy { 3387da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 33939aaac11SPatrick McHardy struct sockaddr *addr = p; 34039aaac11SPatrick McHardy int err; 34139aaac11SPatrick McHardy 34239aaac11SPatrick McHardy if (!is_valid_ether_addr(addr->sa_data)) 34339aaac11SPatrick McHardy return -EADDRNOTAVAIL; 34439aaac11SPatrick McHardy 34539aaac11SPatrick McHardy if (!(dev->flags & IFF_UP)) 34639aaac11SPatrick McHardy goto out; 34739aaac11SPatrick McHardy 34853a2b3a1SJoe Perches if (!ether_addr_equal(addr->sa_data, real_dev->dev_addr)) { 349a748ee24SJiri Pirko err = dev_uc_add(real_dev, addr->sa_data); 35039aaac11SPatrick McHardy if (err < 0) 35139aaac11SPatrick McHardy return err; 35239aaac11SPatrick McHardy } 35339aaac11SPatrick McHardy 35453a2b3a1SJoe Perches if (!ether_addr_equal(dev->dev_addr, real_dev->dev_addr)) 355a748ee24SJiri Pirko dev_uc_del(real_dev, dev->dev_addr); 35639aaac11SPatrick McHardy 35739aaac11SPatrick McHardy out: 35807fc67beSJoe Perches ether_addr_copy(dev->dev_addr, addr->sa_data); 35939aaac11SPatrick McHardy return 0; 36039aaac11SPatrick McHardy } 36139aaac11SPatrick McHardy 362ef3eb3e5SPatrick McHardy static int vlan_dev_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) 3631da177e4SLinus Torvalds { 3647da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 365656299f7SStephen Hemminger const struct net_device_ops *ops = real_dev->netdev_ops; 3661da177e4SLinus Torvalds struct ifreq ifrr; 3671da177e4SLinus Torvalds int err = -EOPNOTSUPP; 3681da177e4SLinus Torvalds 3691da177e4SLinus Torvalds strncpy(ifrr.ifr_name, real_dev->name, IFNAMSIZ); 3701da177e4SLinus Torvalds ifrr.ifr_ifru = ifr->ifr_ifru; 3711da177e4SLinus Torvalds 3721da177e4SLinus Torvalds switch (cmd) { 3731da177e4SLinus Torvalds case SIOCGMIIPHY: 3741da177e4SLinus Torvalds case SIOCGMIIREG: 3751da177e4SLinus Torvalds case SIOCSMIIREG: 376a6111d3cSStefan Sørensen case SIOCSHWTSTAMP: 377a6111d3cSStefan Sørensen case SIOCGHWTSTAMP: 378656299f7SStephen Hemminger if (netif_device_present(real_dev) && ops->ndo_do_ioctl) 379656299f7SStephen Hemminger err = ops->ndo_do_ioctl(real_dev, &ifrr, cmd); 3801da177e4SLinus Torvalds break; 3811da177e4SLinus Torvalds } 3821da177e4SLinus Torvalds 3831da177e4SLinus Torvalds if (!err) 3841da177e4SLinus Torvalds ifr->ifr_ifru = ifrr.ifr_ifru; 3851da177e4SLinus Torvalds 3861da177e4SLinus Torvalds return err; 3871da177e4SLinus Torvalds } 3881da177e4SLinus Torvalds 389cc883d16SFrank Blaschka static int vlan_dev_neigh_setup(struct net_device *dev, struct neigh_parms *pa) 390cc883d16SFrank Blaschka { 3917da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 392cc883d16SFrank Blaschka const struct net_device_ops *ops = real_dev->netdev_ops; 393cc883d16SFrank Blaschka int err = 0; 394cc883d16SFrank Blaschka 395cc883d16SFrank Blaschka if (netif_device_present(real_dev) && ops->ndo_neigh_setup) 3969d40bbdaSDavid S. Miller err = ops->ndo_neigh_setup(real_dev, pa); 397cc883d16SFrank Blaschka 398cc883d16SFrank Blaschka return err; 399cc883d16SFrank Blaschka } 400cc883d16SFrank Blaschka 401f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 402b85daa53SVasu Dev static int vlan_dev_fcoe_ddp_setup(struct net_device *dev, u16 xid, 403b85daa53SVasu Dev struct scatterlist *sgl, unsigned int sgc) 404b85daa53SVasu Dev { 4057da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 406b85daa53SVasu Dev const struct net_device_ops *ops = real_dev->netdev_ops; 407b85daa53SVasu Dev int rc = 0; 408b85daa53SVasu Dev 409b85daa53SVasu Dev if (ops->ndo_fcoe_ddp_setup) 410b85daa53SVasu Dev rc = ops->ndo_fcoe_ddp_setup(real_dev, xid, sgl, sgc); 411b85daa53SVasu Dev 412b85daa53SVasu Dev return rc; 413b85daa53SVasu Dev } 414b85daa53SVasu Dev 415b85daa53SVasu Dev static int vlan_dev_fcoe_ddp_done(struct net_device *dev, u16 xid) 416b85daa53SVasu Dev { 4177da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 418b85daa53SVasu Dev const struct net_device_ops *ops = real_dev->netdev_ops; 419b85daa53SVasu Dev int len = 0; 420b85daa53SVasu Dev 421b85daa53SVasu Dev if (ops->ndo_fcoe_ddp_done) 422b85daa53SVasu Dev len = ops->ndo_fcoe_ddp_done(real_dev, xid); 423b85daa53SVasu Dev 424b85daa53SVasu Dev return len; 425b85daa53SVasu Dev } 4260af46d99SYi Zou 4270af46d99SYi Zou static int vlan_dev_fcoe_enable(struct net_device *dev) 4280af46d99SYi Zou { 4297da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4300af46d99SYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4310af46d99SYi Zou int rc = -EINVAL; 4320af46d99SYi Zou 4330af46d99SYi Zou if (ops->ndo_fcoe_enable) 4340af46d99SYi Zou rc = ops->ndo_fcoe_enable(real_dev); 4350af46d99SYi Zou return rc; 4360af46d99SYi Zou } 4370af46d99SYi Zou 4380af46d99SYi Zou static int vlan_dev_fcoe_disable(struct net_device *dev) 4390af46d99SYi Zou { 4407da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4410af46d99SYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4420af46d99SYi Zou int rc = -EINVAL; 4430af46d99SYi Zou 4440af46d99SYi Zou if (ops->ndo_fcoe_disable) 4450af46d99SYi Zou rc = ops->ndo_fcoe_disable(real_dev); 4460af46d99SYi Zou return rc; 4470af46d99SYi Zou } 448d6534799SYi Zou 4494ea09c9cSYi Zou static int vlan_dev_fcoe_ddp_target(struct net_device *dev, u16 xid, 4504ea09c9cSYi Zou struct scatterlist *sgl, unsigned int sgc) 4514ea09c9cSYi Zou { 4527da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4534ea09c9cSYi Zou const struct net_device_ops *ops = real_dev->netdev_ops; 4544ea09c9cSYi Zou int rc = 0; 4554ea09c9cSYi Zou 4564ea09c9cSYi Zou if (ops->ndo_fcoe_ddp_target) 4574ea09c9cSYi Zou rc = ops->ndo_fcoe_ddp_target(real_dev, xid, sgl, sgc); 4584ea09c9cSYi Zou 4594ea09c9cSYi Zou return rc; 4604ea09c9cSYi Zou } 461b85daa53SVasu Dev #endif 462b85daa53SVasu Dev 4630a89eb92SChris Leech #ifdef NETDEV_FCOE_WWNN 4640a89eb92SChris Leech static int vlan_dev_fcoe_get_wwn(struct net_device *dev, u64 *wwn, int type) 4650a89eb92SChris Leech { 4660a89eb92SChris Leech struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4670a89eb92SChris Leech const struct net_device_ops *ops = real_dev->netdev_ops; 4680a89eb92SChris Leech int rc = -EINVAL; 4690a89eb92SChris Leech 4700a89eb92SChris Leech if (ops->ndo_fcoe_get_wwn) 4710a89eb92SChris Leech rc = ops->ndo_fcoe_get_wwn(real_dev, wwn, type); 4720a89eb92SChris Leech return rc; 4730a89eb92SChris Leech } 4740a89eb92SChris Leech #endif 4750a89eb92SChris Leech 476ef3eb3e5SPatrick McHardy static void vlan_dev_change_rx_flags(struct net_device *dev, int change) 4776c78dcbdSPatrick McHardy { 4787da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 4796c78dcbdSPatrick McHardy 480deede2faSMatthijs Kooijman if (dev->flags & IFF_UP) { 4816c78dcbdSPatrick McHardy if (change & IFF_ALLMULTI) 4826c78dcbdSPatrick McHardy dev_set_allmulti(real_dev, dev->flags & IFF_ALLMULTI ? 1 : -1); 4836c78dcbdSPatrick McHardy if (change & IFF_PROMISC) 4846c78dcbdSPatrick McHardy dev_set_promiscuity(real_dev, dev->flags & IFF_PROMISC ? 1 : -1); 4856c78dcbdSPatrick McHardy } 486deede2faSMatthijs Kooijman } 4876c78dcbdSPatrick McHardy 488e83a2ea8SChris Leech static void vlan_dev_set_rx_mode(struct net_device *vlan_dev) 4891da177e4SLinus Torvalds { 490d38569abSVlad Yasevich dev_mc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev); 491d38569abSVlad Yasevich dev_uc_sync(vlan_dev_priv(vlan_dev)->real_dev, vlan_dev); 4921da177e4SLinus Torvalds } 493ef3eb3e5SPatrick McHardy 494ef3eb3e5SPatrick McHardy /* 495ef3eb3e5SPatrick McHardy * vlan network devices have devices nesting below it, and are a special 496ef3eb3e5SPatrick McHardy * "super class" of normal network devices; split their locks off into a 497ef3eb3e5SPatrick McHardy * separate class since they always nest. 498ef3eb3e5SPatrick McHardy */ 499ef3eb3e5SPatrick McHardy static struct lock_class_key vlan_netdev_xmit_lock_key; 500cf508b12SDavid S. Miller static struct lock_class_key vlan_netdev_addr_lock_key; 501ef3eb3e5SPatrick McHardy 502e8a0464cSDavid S. Miller static void vlan_dev_set_lockdep_one(struct net_device *dev, 503e8a0464cSDavid S. Miller struct netdev_queue *txq, 504e8a0464cSDavid S. Miller void *_subclass) 505c773e847SDavid S. Miller { 506c773e847SDavid S. Miller lockdep_set_class_and_subclass(&txq->_xmit_lock, 507e8a0464cSDavid S. Miller &vlan_netdev_xmit_lock_key, 508e8a0464cSDavid S. Miller *(int *)_subclass); 509c773e847SDavid S. Miller } 510c773e847SDavid S. Miller 511c773e847SDavid S. Miller static void vlan_dev_set_lockdep_class(struct net_device *dev, int subclass) 512c773e847SDavid S. Miller { 513cf508b12SDavid S. Miller lockdep_set_class_and_subclass(&dev->addr_list_lock, 514cf508b12SDavid S. Miller &vlan_netdev_addr_lock_key, 515cf508b12SDavid S. Miller subclass); 516e8a0464cSDavid S. Miller netdev_for_each_tx_queue(dev, vlan_dev_set_lockdep_one, &subclass); 517c773e847SDavid S. Miller } 518c773e847SDavid S. Miller 519d38569abSVlad Yasevich static int vlan_dev_get_lock_subclass(struct net_device *dev) 520d38569abSVlad Yasevich { 521d38569abSVlad Yasevich return vlan_dev_priv(dev)->nest_level; 522d38569abSVlad Yasevich } 523d38569abSVlad Yasevich 524ef3eb3e5SPatrick McHardy static const struct header_ops vlan_header_ops = { 525ef3eb3e5SPatrick McHardy .create = vlan_dev_hard_header, 526ef3eb3e5SPatrick McHardy .parse = eth_header_parse, 527ef3eb3e5SPatrick McHardy }; 528ef3eb3e5SPatrick McHardy 5292205369aSDavid S. Miller static int vlan_passthru_hard_header(struct sk_buff *skb, struct net_device *dev, 5302205369aSDavid S. Miller unsigned short type, 5312205369aSDavid S. Miller const void *daddr, const void *saddr, 5322205369aSDavid S. Miller unsigned int len) 5332205369aSDavid S. Miller { 5342205369aSDavid S. Miller struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 5352205369aSDavid S. Miller struct net_device *real_dev = vlan->real_dev; 5362205369aSDavid S. Miller 537dd38743bSPeter Boström if (saddr == NULL) 538dd38743bSPeter Boström saddr = dev->dev_addr; 539dd38743bSPeter Boström 5402205369aSDavid S. Miller return dev_hard_header(skb, real_dev, type, daddr, saddr, len); 5412205369aSDavid S. Miller } 5422205369aSDavid S. Miller 5432205369aSDavid S. Miller static const struct header_ops vlan_passthru_header_ops = { 5442205369aSDavid S. Miller .create = vlan_passthru_hard_header, 5452205369aSDavid S. Miller .parse = eth_header_parse, 5462205369aSDavid S. Miller }; 5472205369aSDavid S. Miller 548e949b09bSDoug Goldstein static struct device_type vlan_type = { 549e949b09bSDoug Goldstein .name = "vlan", 550e949b09bSDoug Goldstein }; 551e949b09bSDoug Goldstein 552213b15caSEric Dumazet static const struct net_device_ops vlan_netdev_ops; 553f7d1b9f5SEric Dumazet 554ef3eb3e5SPatrick McHardy static int vlan_dev_init(struct net_device *dev) 555ef3eb3e5SPatrick McHardy { 55676052d8cSMike Manning struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 55776052d8cSMike Manning struct net_device *real_dev = vlan->real_dev; 558ef3eb3e5SPatrick McHardy 559adc667e8SJay Vosburgh netif_carrier_off(dev); 560adc667e8SJay Vosburgh 561ef3eb3e5SPatrick McHardy /* IFF_BROADCAST|IFF_MULTICAST; ??? */ 562194dbcc8SJohn Fastabend dev->flags = real_dev->flags & ~(IFF_UP | IFF_PROMISC | IFF_ALLMULTI | 563194dbcc8SJohn Fastabend IFF_MASTER | IFF_SLAVE); 564ef3eb3e5SPatrick McHardy dev->state = (real_dev->state & ((1<<__LINK_STATE_NOCARRIER) | 565ef3eb3e5SPatrick McHardy (1<<__LINK_STATE_DORMANT))) | 566ef3eb3e5SPatrick McHardy (1<<__LINK_STATE_PRESENT); 567ef3eb3e5SPatrick McHardy 56876052d8cSMike Manning if (vlan->flags & VLAN_FLAG_BRIDGE_BINDING) 56976052d8cSMike Manning dev->state |= (1 << __LINK_STATE_NOCARRIER); 57076052d8cSMike Manning 571a188222bSTom Herbert dev->hw_features = NETIF_F_HW_CSUM | NETIF_F_SG | 57253f6b708SToshiaki Makita NETIF_F_FRAGLIST | NETIF_F_GSO_SOFTWARE | 5737dad9937SDavide Caratti NETIF_F_GSO_ENCAP_ALL | 57453692b1dSTom Herbert NETIF_F_HIGHDMA | NETIF_F_SCTP_CRC | 57562f2a3a4SMichał Mirosław NETIF_F_ALL_FCOE; 57662f2a3a4SMichał Mirosław 57788997e42SAndrey Vagin dev->features |= dev->hw_features | NETIF_F_LLTX; 5781ae4be22SAlexander Duyck dev->gso_max_size = real_dev->gso_max_size; 579f6773c5eSEric Dumazet dev->gso_max_segs = real_dev->gso_max_segs; 5802adb956bSVlad Yasevich if (dev->features & NETIF_F_VLAN_FEATURES) 5812adb956bSVlad Yasevich netdev_warn(real_dev, "VLAN features are set incorrectly. Q-in-Q configurations may not work correctly.\n"); 5822adb956bSVlad Yasevich 5838d463504SToshiaki Makita dev->vlan_features = real_dev->vlan_features & ~NETIF_F_ALL_FCOE; 5847dad9937SDavide Caratti dev->hw_enc_features = vlan_tnl_features(real_dev); 5855fb13570SPatrick McHardy 586ef3eb3e5SPatrick McHardy /* ipv6 shared card related stuff */ 587ef3eb3e5SPatrick McHardy dev->dev_id = real_dev->dev_id; 588ef3eb3e5SPatrick McHardy 589308453aaSMike Manning if (is_zero_ether_addr(dev->dev_addr)) { 590308453aaSMike Manning ether_addr_copy(dev->dev_addr, real_dev->dev_addr); 591308453aaSMike Manning dev->addr_assign_type = NET_ADDR_STOLEN; 592308453aaSMike Manning } 593ef3eb3e5SPatrick McHardy if (is_zero_ether_addr(dev->broadcast)) 594ef3eb3e5SPatrick McHardy memcpy(dev->broadcast, real_dev->broadcast, dev->addr_len); 595ef3eb3e5SPatrick McHardy 596f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 597b85daa53SVasu Dev dev->fcoe_ddp_xid = real_dev->fcoe_ddp_xid; 598b85daa53SVasu Dev #endif 599b85daa53SVasu Dev 600d870bfb9SEric Dumazet dev->needed_headroom = real_dev->needed_headroom; 60176052d8cSMike Manning if (vlan_hw_offload_capable(real_dev->features, vlan->vlan_proto)) { 6022205369aSDavid S. Miller dev->header_ops = &vlan_passthru_header_ops; 603ef3eb3e5SPatrick McHardy dev->hard_header_len = real_dev->hard_header_len; 604ef3eb3e5SPatrick McHardy } else { 605ef3eb3e5SPatrick McHardy dev->header_ops = &vlan_header_ops; 606ef3eb3e5SPatrick McHardy dev->hard_header_len = real_dev->hard_header_len + VLAN_HLEN; 607636e19a3SJohn Fastabend } 608636e19a3SJohn Fastabend 609f7d1b9f5SEric Dumazet dev->netdev_ops = &vlan_netdev_ops; 610ef3eb3e5SPatrick McHardy 611e949b09bSDoug Goldstein SET_NETDEV_DEVTYPE(dev, &vlan_type); 612e949b09bSDoug Goldstein 613d38569abSVlad Yasevich vlan_dev_set_lockdep_class(dev, vlan_dev_get_lock_subclass(dev)); 6149793241fSEric Dumazet 61576052d8cSMike Manning vlan->vlan_pcpu_stats = netdev_alloc_pcpu_stats(struct vlan_pcpu_stats); 61676052d8cSMike Manning if (!vlan->vlan_pcpu_stats) 6179793241fSEric Dumazet return -ENOMEM; 6189793241fSEric Dumazet 619ef3eb3e5SPatrick McHardy return 0; 620ef3eb3e5SPatrick McHardy } 621ef3eb3e5SPatrick McHardy 62223556323SPavel Emelyanov static void vlan_dev_uninit(struct net_device *dev) 62323556323SPavel Emelyanov { 62423556323SPavel Emelyanov struct vlan_priority_tci_mapping *pm; 6257da82c06SJiri Pirko struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 62623556323SPavel Emelyanov int i; 62723556323SPavel Emelyanov 62823556323SPavel Emelyanov for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) { 62923556323SPavel Emelyanov while ((pm = vlan->egress_priority_map[i]) != NULL) { 63023556323SPavel Emelyanov vlan->egress_priority_map[i] = pm->next; 63123556323SPavel Emelyanov kfree(pm); 63223556323SPavel Emelyanov } 63323556323SPavel Emelyanov } 63423556323SPavel Emelyanov } 63523556323SPavel Emelyanov 636c8f44affSMichał Mirosław static netdev_features_t vlan_dev_fix_features(struct net_device *dev, 637c8f44affSMichał Mirosław netdev_features_t features) 6388a0427bbSMichał Mirosław { 6397da82c06SJiri Pirko struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 640b29d3145SBjørn Mork netdev_features_t old_features = features; 6418403debeSVlad Yasevich netdev_features_t lower_features; 6428a0427bbSMichał Mirosław 6438403debeSVlad Yasevich lower_features = netdev_intersect_features((real_dev->vlan_features | 6448403debeSVlad Yasevich NETIF_F_RXCSUM), 6458403debeSVlad Yasevich real_dev->features); 646712ae51aSShan Wei 6478403debeSVlad Yasevich /* Add HW_CSUM setting to preserve user ability to control 6488403debeSVlad Yasevich * checksum offload on the vlan device. 6498403debeSVlad Yasevich */ 6508403debeSVlad Yasevich if (lower_features & (NETIF_F_IP_CSUM|NETIF_F_IPV6_CSUM)) 6518403debeSVlad Yasevich lower_features |= NETIF_F_HW_CSUM; 6528403debeSVlad Yasevich features = netdev_intersect_features(features, lower_features); 65353f6b708SToshiaki Makita features |= old_features & (NETIF_F_SOFT_FEATURES | NETIF_F_GSO_SOFTWARE); 654f0a619ccSMichał Mirosław features |= NETIF_F_LLTX; 6558a0427bbSMichał Mirosław 6568a0427bbSMichał Mirosław return features; 6578a0427bbSMichał Mirosław } 6588a0427bbSMichał Mirosław 65957709798SDavid Decotigny static int vlan_ethtool_get_link_ksettings(struct net_device *dev, 66057709798SDavid Decotigny struct ethtool_link_ksettings *cmd) 661b3020061SStephen Hemminger { 6627da82c06SJiri Pirko const struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 6634bc71cb9SJiri Pirko 66457709798SDavid Decotigny return __ethtool_get_link_ksettings(vlan->real_dev, cmd); 665b3020061SStephen Hemminger } 666b3020061SStephen Hemminger 667b3020061SStephen Hemminger static void vlan_ethtool_get_drvinfo(struct net_device *dev, 668b3020061SStephen Hemminger struct ethtool_drvinfo *info) 669b3020061SStephen Hemminger { 6707826d43fSJiri Pirko strlcpy(info->driver, vlan_fullname, sizeof(info->driver)); 6717826d43fSJiri Pirko strlcpy(info->version, vlan_version, sizeof(info->version)); 6727826d43fSJiri Pirko strlcpy(info->fw_version, "N/A", sizeof(info->fw_version)); 673b3020061SStephen Hemminger } 674b3020061SStephen Hemminger 67537dd9255SRichard Cochran static int vlan_ethtool_get_ts_info(struct net_device *dev, 67637dd9255SRichard Cochran struct ethtool_ts_info *info) 67737dd9255SRichard Cochran { 67837dd9255SRichard Cochran const struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 67937dd9255SRichard Cochran const struct ethtool_ops *ops = vlan->real_dev->ethtool_ops; 680ec1d8ccbSHangbin Liu struct phy_device *phydev = vlan->real_dev->phydev; 68137dd9255SRichard Cochran 682ec1d8ccbSHangbin Liu if (phydev && phydev->drv && phydev->drv->ts_info) { 683ec1d8ccbSHangbin Liu return phydev->drv->ts_info(phydev, info); 684ec1d8ccbSHangbin Liu } else if (ops->get_ts_info) { 68537dd9255SRichard Cochran return ops->get_ts_info(vlan->real_dev, info); 68637dd9255SRichard Cochran } else { 68737dd9255SRichard Cochran info->so_timestamping = SOF_TIMESTAMPING_RX_SOFTWARE | 68837dd9255SRichard Cochran SOF_TIMESTAMPING_SOFTWARE; 68937dd9255SRichard Cochran info->phc_index = -1; 69037dd9255SRichard Cochran } 69137dd9255SRichard Cochran 69237dd9255SRichard Cochran return 0; 69337dd9255SRichard Cochran } 69437dd9255SRichard Cochran 695bc1f4470Sstephen hemminger static void vlan_dev_get_stats64(struct net_device *dev, 696bc1f4470Sstephen hemminger struct rtnl_link_stats64 *stats) 6979793241fSEric Dumazet { 6984af429d2SEric Dumazet struct vlan_pcpu_stats *p; 6994af429d2SEric Dumazet u32 rx_errors = 0, tx_dropped = 0; 7009793241fSEric Dumazet int i; 7019793241fSEric Dumazet 7029793241fSEric Dumazet for_each_possible_cpu(i) { 7034af429d2SEric Dumazet u64 rxpackets, rxbytes, rxmulticast, txpackets, txbytes; 7049618e2ffSEric Dumazet unsigned int start; 7059618e2ffSEric Dumazet 7067da82c06SJiri Pirko p = per_cpu_ptr(vlan_dev_priv(dev)->vlan_pcpu_stats, i); 7079618e2ffSEric Dumazet do { 70857a7744eSEric W. Biederman start = u64_stats_fetch_begin_irq(&p->syncp); 7099618e2ffSEric Dumazet rxpackets = p->rx_packets; 7109618e2ffSEric Dumazet rxbytes = p->rx_bytes; 7119618e2ffSEric Dumazet rxmulticast = p->rx_multicast; 7124af429d2SEric Dumazet txpackets = p->tx_packets; 7134af429d2SEric Dumazet txbytes = p->tx_bytes; 71457a7744eSEric W. Biederman } while (u64_stats_fetch_retry_irq(&p->syncp, start)); 7154af429d2SEric Dumazet 7164af429d2SEric Dumazet stats->rx_packets += rxpackets; 7174af429d2SEric Dumazet stats->rx_bytes += rxbytes; 7184af429d2SEric Dumazet stats->multicast += rxmulticast; 7194af429d2SEric Dumazet stats->tx_packets += txpackets; 7204af429d2SEric Dumazet stats->tx_bytes += txbytes; 7214af429d2SEric Dumazet /* rx_errors & tx_dropped are u32 */ 7224af429d2SEric Dumazet rx_errors += p->rx_errors; 7234af429d2SEric Dumazet tx_dropped += p->tx_dropped; 7249793241fSEric Dumazet } 7254af429d2SEric Dumazet stats->rx_errors = rx_errors; 7264af429d2SEric Dumazet stats->tx_dropped = tx_dropped; 7279793241fSEric Dumazet } 7289793241fSEric Dumazet 7296d4cdf47SBenjamin LaHaise #ifdef CONFIG_NET_POLL_CONTROLLER 730de93cb2eSEric Dumazet static void vlan_dev_poll_controller(struct net_device *dev) 7316d4cdf47SBenjamin LaHaise { 7326d4cdf47SBenjamin LaHaise return; 7336d4cdf47SBenjamin LaHaise } 7346d4cdf47SBenjamin LaHaise 735a8779ec1SEric W. Biederman static int vlan_dev_netpoll_setup(struct net_device *dev, struct netpoll_info *npinfo) 7366d4cdf47SBenjamin LaHaise { 737f3da3893SAmerigo Wang struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 738f3da3893SAmerigo Wang struct net_device *real_dev = vlan->real_dev; 7396d4cdf47SBenjamin LaHaise struct netpoll *netpoll; 7406d4cdf47SBenjamin LaHaise int err = 0; 7416d4cdf47SBenjamin LaHaise 742a8779ec1SEric W. Biederman netpoll = kzalloc(sizeof(*netpoll), GFP_KERNEL); 7436d4cdf47SBenjamin LaHaise err = -ENOMEM; 7446d4cdf47SBenjamin LaHaise if (!netpoll) 7456d4cdf47SBenjamin LaHaise goto out; 7466d4cdf47SBenjamin LaHaise 747a8779ec1SEric W. Biederman err = __netpoll_setup(netpoll, real_dev); 7486d4cdf47SBenjamin LaHaise if (err) { 7496d4cdf47SBenjamin LaHaise kfree(netpoll); 7506d4cdf47SBenjamin LaHaise goto out; 7516d4cdf47SBenjamin LaHaise } 7526d4cdf47SBenjamin LaHaise 753f3da3893SAmerigo Wang vlan->netpoll = netpoll; 7546d4cdf47SBenjamin LaHaise 7556d4cdf47SBenjamin LaHaise out: 7566d4cdf47SBenjamin LaHaise return err; 7576d4cdf47SBenjamin LaHaise } 7586d4cdf47SBenjamin LaHaise 759de93cb2eSEric Dumazet static void vlan_dev_netpoll_cleanup(struct net_device *dev) 7606d4cdf47SBenjamin LaHaise { 761f3da3893SAmerigo Wang struct vlan_dev_priv *vlan= vlan_dev_priv(dev); 762f3da3893SAmerigo Wang struct netpoll *netpoll = vlan->netpoll; 7636d4cdf47SBenjamin LaHaise 7646d4cdf47SBenjamin LaHaise if (!netpoll) 7656d4cdf47SBenjamin LaHaise return; 7666d4cdf47SBenjamin LaHaise 767f3da3893SAmerigo Wang vlan->netpoll = NULL; 768c9fbd71fSDebabrata Banerjee __netpoll_free(netpoll); 7696d4cdf47SBenjamin LaHaise } 7706d4cdf47SBenjamin LaHaise #endif /* CONFIG_NET_POLL_CONTROLLER */ 7716d4cdf47SBenjamin LaHaise 7722dbf6b50SNicolas Dichtel static int vlan_dev_get_iflink(const struct net_device *dev) 7732dbf6b50SNicolas Dichtel { 7742dbf6b50SNicolas Dichtel struct net_device *real_dev = vlan_dev_priv(dev)->real_dev; 7752dbf6b50SNicolas Dichtel 7762dbf6b50SNicolas Dichtel return real_dev->ifindex; 7772dbf6b50SNicolas Dichtel } 7782dbf6b50SNicolas Dichtel 77975b8846aSPatrick McHardy static const struct ethtool_ops vlan_ethtool_ops = { 78057709798SDavid Decotigny .get_link_ksettings = vlan_ethtool_get_link_ksettings, 781b3020061SStephen Hemminger .get_drvinfo = vlan_ethtool_get_drvinfo, 78275b8846aSPatrick McHardy .get_link = ethtool_op_get_link, 78337dd9255SRichard Cochran .get_ts_info = vlan_ethtool_get_ts_info, 78475b8846aSPatrick McHardy }; 78575b8846aSPatrick McHardy 786656299f7SStephen Hemminger static const struct net_device_ops vlan_netdev_ops = { 787656299f7SStephen Hemminger .ndo_change_mtu = vlan_dev_change_mtu, 788656299f7SStephen Hemminger .ndo_init = vlan_dev_init, 789656299f7SStephen Hemminger .ndo_uninit = vlan_dev_uninit, 790656299f7SStephen Hemminger .ndo_open = vlan_dev_open, 791656299f7SStephen Hemminger .ndo_stop = vlan_dev_stop, 792f7d1b9f5SEric Dumazet .ndo_start_xmit = vlan_dev_hard_start_xmit, 793f7d1b9f5SEric Dumazet .ndo_validate_addr = eth_validate_addr, 794f7d1b9f5SEric Dumazet .ndo_set_mac_address = vlan_dev_set_mac_address, 795f7d1b9f5SEric Dumazet .ndo_set_rx_mode = vlan_dev_set_rx_mode, 796f7d1b9f5SEric Dumazet .ndo_change_rx_flags = vlan_dev_change_rx_flags, 797f7d1b9f5SEric Dumazet .ndo_do_ioctl = vlan_dev_ioctl, 798cc883d16SFrank Blaschka .ndo_neigh_setup = vlan_dev_neigh_setup, 7999618e2ffSEric Dumazet .ndo_get_stats64 = vlan_dev_get_stats64, 800f4d5392eSAmerigo Wang #if IS_ENABLED(CONFIG_FCOE) 801b85daa53SVasu Dev .ndo_fcoe_ddp_setup = vlan_dev_fcoe_ddp_setup, 802b85daa53SVasu Dev .ndo_fcoe_ddp_done = vlan_dev_fcoe_ddp_done, 8030af46d99SYi Zou .ndo_fcoe_enable = vlan_dev_fcoe_enable, 8040af46d99SYi Zou .ndo_fcoe_disable = vlan_dev_fcoe_disable, 8054ea09c9cSYi Zou .ndo_fcoe_ddp_target = vlan_dev_fcoe_ddp_target, 806b85daa53SVasu Dev #endif 8070a89eb92SChris Leech #ifdef NETDEV_FCOE_WWNN 8080a89eb92SChris Leech .ndo_fcoe_get_wwn = vlan_dev_fcoe_get_wwn, 8090a89eb92SChris Leech #endif 8106d4cdf47SBenjamin LaHaise #ifdef CONFIG_NET_POLL_CONTROLLER 8116d4cdf47SBenjamin LaHaise .ndo_poll_controller = vlan_dev_poll_controller, 8126d4cdf47SBenjamin LaHaise .ndo_netpoll_setup = vlan_dev_netpoll_setup, 8136d4cdf47SBenjamin LaHaise .ndo_netpoll_cleanup = vlan_dev_netpoll_cleanup, 8146d4cdf47SBenjamin LaHaise #endif 8158a0427bbSMichał Mirosław .ndo_fix_features = vlan_dev_fix_features, 816d38569abSVlad Yasevich .ndo_get_lock_subclass = vlan_dev_get_lock_subclass, 8172dbf6b50SNicolas Dichtel .ndo_get_iflink = vlan_dev_get_iflink, 818f7d1b9f5SEric Dumazet }; 819f7d1b9f5SEric Dumazet 820a48e5fafSEric Dumazet static void vlan_dev_free(struct net_device *dev) 821a48e5fafSEric Dumazet { 822a48e5fafSEric Dumazet struct vlan_dev_priv *vlan = vlan_dev_priv(dev); 823a48e5fafSEric Dumazet 824a48e5fafSEric Dumazet free_percpu(vlan->vlan_pcpu_stats); 825a48e5fafSEric Dumazet vlan->vlan_pcpu_stats = NULL; 826a48e5fafSEric Dumazet } 827a48e5fafSEric Dumazet 828ef3eb3e5SPatrick McHardy void vlan_setup(struct net_device *dev) 829ef3eb3e5SPatrick McHardy { 830ef3eb3e5SPatrick McHardy ether_setup(dev); 831ef3eb3e5SPatrick McHardy 8322e659c05SPhil Sutter dev->priv_flags |= IFF_802_1Q_VLAN | IFF_NO_QUEUE; 833e817af27SZhang Shengju dev->priv_flags |= IFF_UNICAST_FLT; 83402875878SEric Dumazet dev->priv_flags &= ~IFF_TX_SKB_SHARING; 83502875878SEric Dumazet netif_keep_dst(dev); 836ef3eb3e5SPatrick McHardy 837656299f7SStephen Hemminger dev->netdev_ops = &vlan_netdev_ops; 838cf124db5SDavid S. Miller dev->needs_free_netdev = true; 839cf124db5SDavid S. Miller dev->priv_destructor = vlan_dev_free; 84075b8846aSPatrick McHardy dev->ethtool_ops = &vlan_ethtool_ops; 841ef3eb3e5SPatrick McHardy 84291572088SJarod Wilson dev->min_mtu = 0; 84391572088SJarod Wilson dev->max_mtu = ETH_MAX_MTU; 84491572088SJarod Wilson 845423049abSJoe Perches eth_zero_addr(dev->broadcast); 846ef3eb3e5SPatrick McHardy } 847